提交测试

BaseTracker/Track3D.cpp

@@ -34,11 +34,12 @@ double correct_angle(std::vector<point2d>& points)
     Eigen::SelfAdjointEigenSolver<Eigen::MatrixXd> eig(C); // 产生的vec和val按照特征值升序排列
     vec = eig.eigenvectors();
     val = eig.eigenvalues();
+    SDK_LOG(SDK_INFO, "vec = [%f,%f,%f,%f]", vec(0, 0), vec(0, 1), vec(1, 0), vec(1, 1));
+    SDK_LOG(SDK_INFO, "val = [%f,%f]", val(0,0), val(0.1));
     // 打印
     //cout << "X_copy: " << endl << X_copy
     Eigen::Vector2d dX(points[4].x - points[0].x, points[4].y - points[0].y);
     Eigen::Vector2d orientation(vec(0, 0), vec(0, 1));
-    SDK_LOG(SDK_INFO, "vec = [%f,%f,%f,%f]",vec(0,0), vec(0,1), vec(1,0), vec(1,1));
     double alpha = dX.transpose() * orientation;
     if (alpha < 0)
         orientation = -orientation;