mirror of
https://github.com/firestar5683/StarPilot.git
synced 2026-07-19 08:12:07 +08:00
Use standstill flag in locationd (#20838)
old-commit-hash: fc3da5eaf9e9448825115e19dd59e1a2657ab249
This commit is contained in:
@@ -245,9 +245,8 @@ void Localizer::handle_gps(double current_time, const cereal::GpsLocationData::R
|
||||
}
|
||||
|
||||
void Localizer::handle_car_state(double current_time, const cereal::CarState::Reader& log) {
|
||||
//this->kf->predict_and_observe(current_time, OBSERVATION_ODOMETRIC_SPEED, { (VectorXd(1) << log.getVEgoRaw()).finished() });
|
||||
this->car_speed = std::abs(log.getVEgo());
|
||||
if (this->car_speed < 1e-3) {
|
||||
if (log.getStandstill()) {
|
||||
this->kf->predict_and_observe(current_time, OBSERVATION_NO_ROT, { Vector3d(0.0, 0.0, 0.0) });
|
||||
}
|
||||
}
|
||||
|
||||
@@ -1 +1 @@
|
||||
fcfadaaad7f452fdbb69c1057058327b0d2004bf
|
||||
e9db5723ef348954118643501a92cf0715402fea
|
||||
Reference in New Issue
Block a user