Rework transformation functions
Add extrinsic calibration functions
Add image capture callback