Commit 99d95c65 authored by oscar's avatar oscar

修改计算方向的逻辑

parent 604a9794
......@@ -361,7 +361,7 @@ void Track3D::UpdateDataCheck(const std::vector<float>& data, std::vector<float>
rot_y = center_rot_y;
}
else//没有距离差就使用最后一次的方向
rot_y = center_rot_y;
rot_y = m_center_rot_y;
}
double x_angle = kf_->x_[3];
double deta = rot_y - x_angle;
......
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