Commit 114f46e5 authored by oscar's avatar oscar

提交逻辑漏的内容

parent 6e24124e
......@@ -298,7 +298,13 @@ void Track3D::UpdateDataCheck(const std::vector<float>& data, std::vector<float>
{
if (kf_ == nullptr)
return;
double rot_y = data[3];
if (data.size() != 8)
{
SDK_LOG(SDK_INFO, "UpdateDataCheck data size is not 8");
return;
}
std::vector<float> tmp(data.begin() + 1, data.end());
double rot_y = tmp[3];
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);
......@@ -334,7 +340,7 @@ void Track3D::UpdateDataCheck(const std::vector<float>& data, std::vector<float>
}
float detaT = abs(deta) > abs(deta2) ? deta2:deta;
rot_y = x_angle + detaT;
out = data;
out = tmp;
out[3] = 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