Calibrate a Camera for Motion Planning