Update ROSImageStreamThread.cpp

fixed P camera info....
venkateshbs · Sep 25, 2014 · 08a6506 · 08a6506
1 parent bfe5fa6
commit 08a6506
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/lsd_slam_core/src/IOWrapper/ROS/ROSImageStreamThread.cpp b/lsd_slam_core/src/IOWrapper/ROS/ROSImageStreamThread.cpp
@@ -147,9 +147,9 @@ void ROSImageStreamThread::infoCb(const sensor_msgs::CameraInfoConstPtr info)
 	if(!haveCalib)
 	{
 		fx_ = info->P[0];
-		fy_ = info->P[4];
+		fy_ = info->P[5];
 		cx_ = info->P[2];
-		cy_ = info->P[5];
+		cy_ = info->P[6];
 
 		if(fx_ == 0 || fy_==0)
 		{