Commit 2e5b4a22 authored by oscar's avatar oscar

修改初始化数据

parent 049cc793
......@@ -107,7 +107,9 @@ Track3D::Track3D():BaseTrack(10, 7)
}
void Track3D::Init(const std::vector<float>& data)
{
std::vector<float> tmp = data;
if (data.size() != 8)
return;
std::vector<float> tmp(data[1],data[2],data[3],data[4],data[5],data[6],data[7]);
//修正角度在-PI到PI
while (tmp[3] > _PI_)
tmp[3] -= 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