提交上午测试改动

TrackingRosEx.cpp

@@ -145,7 +145,7 @@ void get_camera_tolidar_loc(float u, float v, float& x, float& y)
     x = trans_pos_[0];
     y = trans_pos_[1];
     x = x < 30 ? x + x/20 : (x + (x-25)/5);
-    if(x < 30)
+    if(x < 20)
         y = y > 0 ? (y + 2* abs(y)/10) : (y - 2* abs(y)/10);
     //Eigen::Matrix<double, 3, 3> cam_trans;
     //cam_trans << -6.60431137e-02, 1.93080567e+00, -8.78993882e+02,//camera to point cloud transfrom