Update PnPProblem.cpp

berak · berak · commit dc265071d0c5 · 2015-09-04T10:57:33.000+02:00
diff --git a/samples/cpp/tutorial_code/calib3d/real_time_pose_estimation/src/PnPProblem.cpp b/samples/cpp/tutorial_code/calib3d/real_time_pose_estimation/src/PnPProblem.cpp
@@ -99,6 +99,7 @@ void PnPProblem::set_P_matrix( const cv::Mat &R_matrix, const cv::Mat &t_matrix)
   _P_matrix.at<double>(1,2) = R_matrix.at<double>(1,2);
   _P_matrix.at<double>(2,0) = R_matrix.at<double>(2,0);
   _P_matrix.at<double>(2,1) = R_matrix.at<double>(2,1);
+  _P_matrix.at<double>(2,2) = R_matrix.at<double>(2,2);
   _P_matrix.at<double>(0,3) = t_matrix.at<double>(0);
   _P_matrix.at<double>(1,3) = t_matrix.at<double>(1);
   _P_matrix.at<double>(2,3) = t_matrix.at<double>(2);
