Commit 4870afb6 authored by oscar's avatar oscar

测试

parent e0ff76fa
......@@ -289,6 +289,7 @@ void Track3D::UpdateDataCheck(const std::vector<float>& data, std::vector<float>
if (m_points.size() >= 5 && (abs(m_points[4].x - m_points[0].x) > DIST_THRED || abs(m_points[4].y - m_points[0].y) > DIST_THRED))
{
double center_rot_y = correct_angle(m_points);
SDK_LOG(SDK_INFO, "center_rot_y = %f,rot_y = %f", center_rot_y,rot_y);
double rotate = abs(center_rot_y - rot_y);
while (rotate > _PI_)
rotate -= 2 * _PI_;
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment