mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-16 22:03:33 +08:00
ekf2: Fix bug preventing first IMU failover bias reset
This commit is contained in:
committed by
Lorenz Meier
parent
0c9e07c95a
commit
589d58ce87
@@ -561,7 +561,8 @@ void Ekf2::run()
|
||||
|
||||
orb_check(sensor_selection_sub, &sensor_selection_updated);
|
||||
|
||||
if (sensor_selection_updated) {
|
||||
// Always update sensor selction first time through if time stamp is non zero
|
||||
if (sensor_selection_updated || (sensor_selection.timestamp == 0)) {
|
||||
sensor_selection_s sensor_selection_prev = sensor_selection;
|
||||
orb_copy(ORB_ID(sensor_selection), sensor_selection_sub, &sensor_selection);
|
||||
|
||||
|
||||
Reference in New Issue
Block a user