Paul Riseborough
0c9433873c
ArduPlane: Modify ekf failsafe checks
...
Restore velocity check and make the logic closer to what ArduCopter does.
Remove unnecessary initialisation.
2020-05-14 10:40:48 +10:00
Paul Riseborough
85e53d53e1
ArduPlane: Don't use optical flow health when assessing EKF nav health
...
Plane currently doesn't use optical flow for navigation - it is used fo terrain height estimation.
2020-05-14 10:40:48 +10:00
Paul Riseborough
3a10838c65
ArduPlane: Don't check variances if not available
2020-05-14 10:40:48 +10:00
Paul Riseborough
70a02f31ab
ArduPlane: More efficient type use
2020-05-14 10:40:48 +10:00
Paul Riseborough
5b312e9f09
ArduPlane: Fix logic error
2020-05-14 10:40:48 +10:00
Paul Riseborough
cd5714d059
ArduPlane: Allow EKF dead reckoning to continue after loss of GPS
2020-05-14 10:40:48 +10:00
Paul Riseborough
40cc5a5006
ArduPlane: Improve EKF failsafe in VTOL modes
...
Replicates Copter behaviour with a three step process if the EKF sustains a loss of navigation as detected by high GPS innovation test ratios:
1) Attempts a yaw reset using the GSF estimate if available
2) Attempts a lane switch
3) Falls back to a non-position mode
2020-05-14 10:40:48 +10:00