mirror of
https://github.com/sunnypilot/sunnypilot.git
synced 2026-07-19 03:52:05 +08:00
@@ -281,7 +281,7 @@ void Localizer::handle_gps(double current_time, const cereal::GpsLocationData::R
|
||||
LOGE("Locationd vs ubloxLocation orientation difference too large, kalman reset");
|
||||
this->reset_kalman(NAN, initial_pose_ecef_quat, ecef_pos);
|
||||
this->kf->predict_and_observe(current_time, OBSERVATION_ECEF_ORIENTATION_FROM_GPS, { initial_pose_ecef_quat });
|
||||
} else if (gps_est_error > 50.0) {
|
||||
} else if (gps_est_error > 100.0) {
|
||||
LOGE("Locationd vs ubloxLocation position difference too large, kalman reset");
|
||||
this->reset_kalman(NAN, initial_pose_ecef_quat, ecef_pos);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user