diff --git a/components/rgbd-sources/src/calibrate.cpp b/components/rgbd-sources/src/calibrate.cpp
index 3940520d2374661449c376020cb98c5802e2c674..fc99d701fa40a8b824248c775a7020ed7d449fd1 100644
--- a/components/rgbd-sources/src/calibrate.cpp
+++ b/components/rgbd-sources/src/calibrate.cpp
@@ -199,7 +199,7 @@ void Calibrate::_updateIntrinsics() {
 	// Set correct camera matrices for
 	// getCameraMatrix(), getCameraMatrixLeft(), getCameraMatrixRight()
 	Kl_ = Mat(P1, cv::Rect(0, 0, 3, 3));
-	Kr_ = Mat(P1, cv::Rect(0, 0, 3, 3));
+	Kr_ = Mat(P2, cv::Rect(0, 0, 3, 3));
 
 	initUndistortRectifyMap(K1_, D1_, R1, P1, img_size_, CV_32FC1, map1_.first, map2_.first);
 	initUndistortRectifyMap(K2_, D2_, R2, P2, img_size_, CV_32FC1, map1_.second, map2_.second);