Commit 73abd3f1 authored by oscar's avatar oscar

修改为朝向使用接近的朝向,否则会出现来回摇摆。

parent 73ca9400
......@@ -364,7 +364,7 @@ void Track3D::UpdateDataCheck(const std::vector<float>& data, std::vector<float>
{
rot_y += _PI_;
}
isCheck = 1;
// isCheck = 1;
}
else if (dataSource > 1 && m_points.size() >= 5 )
{
......@@ -373,7 +373,7 @@ void Track3D::UpdateDataCheck(const std::vector<float>& data, std::vector<float>
double center_rot_y = correct_angle(m_points);
m_center_rot_y = center_rot_y;
rot_y = center_rot_y;
isCheck = 1;
// isCheck = 1;
}
else//没有距离差就使用最后一次的方向
rot_y = m_center_rot_y;
......
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