sadmen
/
jyoung
mirror of https://github.com/jyoung8607/openpilot.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Use standstill flag in locationd (#20838)

Browse Source 
old-commit-hash: fc3da5eaf9
vw-mqb-aeb
Willem Melching 5 years ago committed by GitHub
parent 3abb7639ed
commit 9cfda07c9e
2 changed files with 2 additions and 3 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Unified View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 3
      selfdrive/locationd/locationd.cc
  2. 2
      selfdrive/test/process_replay/ref_commit

3
selfdrive/locationd/locationd.cc
Unescape View File

@ -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) { 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()); 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) }); this->kf->predict_and_observe(current_time, OBSERVATION_NO_ROT, { Vector3d(0.0, 0.0, 0.0) });
} }
} }

2
selfdrive/test/process_replay/ref_commit
Unescape View File

@ -1 +1 @@
fcfadaaad7f452fdbb69c1057058327b0d2004bf e9db5723ef348954118643501a92cf0715402fea
Write Preview
Loading…
Cancel
Save