Skip to content
This repository has been archived by the owner on May 1, 2024. It is now read-only.

EKF: Treat combined sideslip and airspeed as a horizontal aiding source #952

Merged
merged 3 commits into from
Jan 5, 2021

Conversation

priseborough
Copy link
Collaborator

The combination of airspeed and sideslip fusion acts to constrain horizontal velocity drift with wind relative dead reckoning, however this was not being recognised in the code. This change treats the combination of airspeed and sideslip fusion as an equivalent horizontal velocity aiding source and ensures the solution status velocity_horiz flag will remain true if a fixed wing aircraft with airspeed and sideslip fusion loses GPS.

@priseborough priseborough self-assigned this Dec 29, 2020
@priseborough priseborough added bug potential bug Used for defects in the code that have the potential to create unwanted behaviour labels Dec 29, 2020
EKF/estimator_interface.cpp Outdated Show resolved Hide resolved
@priseborough
Copy link
Collaborator Author

This was tested in SITL using gazebo_plane with takeoff initiated using 'commander takeoff' and GPs failed once in loiter using 'failure gps on'. The EKF reported the loss of GPS, eg:

WARN [ecl/EKF] 589068000: GPS data stopped, using only EV, OF or air data

and continued to dead reckon with a steadily increasing reported position uncertainty for several minutes before the commander triggered a failsafe when the reported horizontal position uncertainty exceeded 45m = 2.5 x COM_POS_FS_EPH (default of 15).

WARN [commander] Failsafe enabled: no global position

Screen Shot 2021-01-05 at 8 43 36 pm

@priseborough priseborough merged commit 03fed32 into PX4:master Jan 5, 2021
@priseborough priseborough deleted the pr-ekfHorizAidSourceFix branch January 5, 2021 10:08
Sign up for free to subscribe to this conversation on GitHub. Already have an account? Sign in.
Labels
bug potential bug Used for defects in the code that have the potential to create unwanted behaviour v1.12-Release-Notes
Projects
None yet
Development

Successfully merging this pull request may close these issues.

3 participants