6561edb9a5
EKF: Clean up terrain estimation functionality.
...
This is a functionally equivalent. It moves all of the code for the terrain estimator into a single function call from the main filter update, making it clear that it is independent of the main filter.
8 years ago
cf9c8de167
EKF: Add arbitrary pitch offset for range sensor
8 years ago
21270bb06a
EKF: Use last known position when resuming OF aiding
8 years ago
3c4c09593f
EKF: Rationalise console messages
...
Combine the observation action buffer and alignment messages
Ensure all data timeout messages are warnings.
Use consistent terminology.
8 years ago
a776b2c549
EKF: Fix bug preventing reset to GPS position when using optical flow
8 years ago
460c9e5250
EKF: Don't try to fuse air data if not in normal aiding mode
...
Taking off before passing GPS checks would cause airspeed or sideslip to be fused when the filter was still using a constant position assumption. This would cause large airspeed innovations, invalid wind estimates and degrade filter performance after GPS was gained and position and velocity was reset.
8 years ago
951c8b77af
EKF: Improve wind state reset logic
...
Enables wind estimation without an airspeed sensor and enables synthetic sideslip to be used with an airspeed sensor for improved wind state estimation.
Wind states and covariances are reset differently depending on whether airspeed is available.
8 years ago
352b4ca177
EKF: Allow sideslip fusion with airspeed fusion
8 years ago
a9182259a5
fixed bug in beta fusion
8 years ago
e1d9d503e3
updated logic of when to fuse beta. Now synthetic sideslip measurements are fused after 5 seconds of cruise flight with airspeed sensor activated
8 years ago
dec686afd7
updated parameters
8 years ago
5205a8198b
added function to control when to fuse beta
8 years ago
8aee45dd96
EKF: Fix bug causing repeated resets if GPS sensor disconnected
8 years ago
968cfae632
EKF: Fix bug preventing fallback from GPS mode if GPS is lost
8 years ago
63cf3d50be
ekf gps reset: do not bother checking for need of reset if gps is not
...
available
Signed-off-by: Roman <bapstroman@gmail.com>
8 years ago
c5f750dcca
ekf reset: more granular reset / timeout strategy for gps fusion
...
- if both gps position and velocity measurements are rejected for 7 seconds
do a reset
- if only gps position measurements are rejected then wait for 14 seconds
as we still have velocity measurements to constrain the drift in position
- introduced ecl internal parameter for the timeout
Signed-off-by: Roman <bapstroman@gmail.com>
8 years ago
f80b3481a4
reset the newest output sample for all possible resets
...
Signed-off-by: Roman <bapstroman@gmail.com>
8 years ago
51c8715638
fixed issue with airspeed never fused
9 years ago
d1d56d9e5e
EKF: Add logic to to control wind state estimation
9 years ago
df0f8fed45
fixed wrong condition on which gps height would be fused ( #180 )
...
- this solves the issue where height innovations would jump
between two regimes
Signed-off-by: Roman <bapstroman@gmail.com>
9 years ago
eb2afc522d
EKF: fix bug preventing use of baro as a backup height source
9 years ago
573f252b73
EKF: fix bug preventing GPS use as a backup height source
9 years ago
5f9752cac8
EKF: Improve function names
9 years ago
7bc9217f00
EKF: Clean up control of observation fusion
...
All the decision for a sensor are made within a specific function for that sensor and when there is data to process at the fusion time horizon.
Information and warning messages are improved.
9 years ago
081e17729c
EKF: delay commencement of 3D mag fusion until clear of ground
...
Wait until enough height has been gained to be clear of ground based magnetic anomalies. Failure to do so can result in incorrect earth field initialisation.
9 years ago
f08aee0a7d
EKF: Fix covariance index bug
9 years ago
b8e2f79005
EKF: correct include paths
9 years ago
ecfd8c867a
EKF: use ECL printfs everywhere
...
- Changes all printfs to ECL printfs
- Add ECL_ERR.
- Include ecl.h where needed.
- Add forgotten pragma once.
9 years ago
6a55d908c5
EKF: replace reset event times with event counters
...
Using a 64bit integer was unnecessary given it was only being used to detect a new reset event.
9 years ago
3ec9221c18
EKF: update output observer and capture reset event for EV yaw resets
9 years ago
9f81b8f09e
EKF: provide reset protection for external vision height
9 years ago
1b6c5bbafd
EKF: Enable height source to be selected independent of EV aiding
9 years ago
0fafc49a49
fixed typos ( #147 )
9 years ago
c1b02eaa91
EKF: Don't use 3-axis magnetometer fusion until the tilt is aligned
9 years ago
aaac867da8
EKF: Adjust tilt alignment threshold
9 years ago
1540e937b1
EKF: Improve tilt alignment monitoring
...
Convert quaternion covariances into an angular alignment variance vector and discard the z component so that yaw uncertainty does not affect the result.
9 years ago
920d83d68c
EKF: Fix bugs preventing use of external vision yaw data
9 years ago
13c3a95bc1
EKF: Add missing line returns
9 years ago
b985e58333
EKF: clean up control function
...
With the addition of new observation types, the control function has become too large and needed be broken up into separate functions
9 years ago
f4a0f69f6e
EKF: print to console when starting EV fusion
9 years ago
ac9b7a3df6
EKF: Ensure use of EV aiding inhibits use of other height sources
9 years ago
e917d6c7f2
EKF: Add fusion of external yaw data
9 years ago
37a09c61bc
EKF: Don't use delayed data to start EV aiding
9 years ago
81469d6621
EKF: Add position, height and velocity reset for EV aiding
9 years ago
481c624975
EKF: Remove use of vehicle arm status
...
Use single externally set in-air status for all decisions
9 years ago
161ac2e051
EKF: ensure position co-variances are reset
...
When transitioning into optical flow nav from a non-aiding condition during ground operation, ensure position covariances are reset as they could be invalid.
9 years ago
724280fd1f
EKF: move calculation of optical flow observation variance into a function
...
Allows it to be used when calculating initial state variance
9 years ago
25682dce91
EKF: Prevent badly conditioned covariance calculation when starting or resetting to optical flow
9 years ago
da9d894441
EKF: Improvements to covariance reset
9 years ago
a7d08d08fc
EKF: Relax tilt alignment check
9 years ago
Paul Riseborough
CarlOlsson
Roman
Julian Oes