Commit 102a7ad2 authored by oscar's avatar oscar

提交代码

parent 6756f621
......@@ -15,7 +15,7 @@ void BaseTrack::Init(const std::vector<float>& data)
return;
Eigen::VectorXd observation = Eigen::VectorXd::Zero(size);
for (int i = 0; i < data.size(); i++)
observation(0, i) = data[i];
observation(i) = data[i];
kf_->x_.head(size) << observation;
hit_streak_++;
}
......@@ -45,7 +45,7 @@ void BaseTrack::Update(const std::vector<float>& data)
int size = data.size();
Eigen::VectorXd observation = Eigen::VectorXd::Zero(size);
for (int i = 0; i < data.size(); i++)
observation(0, i) = data[i];
observation(i) = data[i];
kf_->Update(observation);
}
int BaseTrack::GetStateData(std::vector<float>& data)
......
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