|
|
|
@ -184,7 +184,9 @@ void Ekf::controlFusionModes()
@@ -184,7 +184,9 @@ void Ekf::controlFusionModes()
|
|
|
|
|
_control_status.flags.rng_hgt = false; |
|
|
|
|
// adjust the height offset so we can use the GPS
|
|
|
|
|
_hgt_sensor_offset = _state.pos(2) + gps_init.hgt - _gps_alt_ref; |
|
|
|
|
printf("EKF baro hgt timeout - switching to gps\n"); |
|
|
|
|
if (!baro_hgt_available) { |
|
|
|
|
printf("EKF baro hgt timeout - switching to gps\n"); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|