Rework transformation functions
Add extrinsic calibration functions
Add image capture callback
Extrinsic func modifs