提交测试

BaseTracker/Track3D.cpp

@@ -103,14 +103,6 @@ Track3D::Track3D():BaseTrack(10, 7)
 
     m_iou_threshold = 0.01;
 
-    std::vector<point2d> tests;
-    tests.push_back(point2d(1, 1));
-    tests.push_back(point2d(2, 2));
-    tests.push_back(point2d(3, 3));
-    tests.push_back(point2d(4, 4));
-    tests.push_back(point2d(5,5));
-    double angle = correct_angle(tests);
-    SDK_LOG(SDK_INFO, "test correct_angle = %f",angle);
 }
 void Track3D::Init(const std::vector<float>& data)
 {

BaseTracker/Track3D.h

@@ -46,3 +46,5 @@ public:
 
     std::vector<point2d> m_points;//保存最近的5个移动的点位
 };
+
+double correct_angle(std::vector<point2d>& points);

TrackingRos.cpp

@@ -211,6 +211,15 @@ void TrackingRos::Init(ros::NodeHandle& nh)
     memcpy(m, f, sizeof(float) * 4);
 
     SDK_LOG(SDK_INFO, "data = %f,%f,%f,%f", m[0], m[1], m[2], m[3]);
+
+    std::vector<point2d> tests;
+    tests.push_back(point2d(1, 1));
+    tests.push_back(point2d(2, 2));
+    tests.push_back(point2d(3, 3));
+    tests.push_back(point2d(4, 4));
+    tests.push_back(point2d(5, 5));
+    double angle = correct_angle(tests);
+    SDK_LOG(SDK_INFO, "test correct_angle = %f", angle);
 }
 
 void TrackingRos::TrackingCallBackFunc(const jfx_common_msgs::det_tracking_arrayConstPtr& msg)//接受ros发过来的消息