This is a nice project ! Many kudos to the OP.
The real challenge is to reverse engineer the Lens Chipset (controller) Registers Address Map. Some registers (among other) contain the lens Calibration Parameters.
Many of us, avid photograper hobbies, are aware of frequent Canon Lens focus accuracy issues. If the protocol is reversed, lens re-calibration may be done as a home project.