added camera Calibration functions

TODO test and debug more