Camera Pose Estimation Python Code