提交更新

TrackingRosEx.cpp

@@ -177,6 +177,9 @@ TrackingRos::~TrackingRos()
 
 void TrackingRos::Init(ros::NodeHandle& nh)
 {
+    float x, y;
+    get_camera_tolidar_loc(200, 200, x, y);
+
     std::string folder,yaml;
     nh.param<std::string>("project_path", folder, "/home/nvidia/catkin_ws/src/jfxrosperceiver");
     nh.param<std::string>("yaml_config", yaml, "/jfx_tracking/config/7-1.yaml");
@@ -281,8 +284,7 @@ void TrackingRos::Init(ros::NodeHandle& nh)
     angle = correct_angle(tests);
     SDK_LOG(SDK_INFO, "test4 correct_angle = %f", angle);
 
-    float x, y;
-    get_camera_tolidar_loc(200, 200, x, y);
+
 
 }