Revert "Revert "Camera Calibration code""

This reverts commit 35b95ee60524c76fff9616709368ec6fd0917cdb.