93dd4e5754
fix unit tests
2021-03-04 19:43:01 +11:00
5d441d65e1
Accelerate tilt fine alignment by reducing obs noise when at rest
...
Fine tilt alignment is accomplished by fusing fake position data after
a coarse tilt leveling. The observation noise can be reduced if the
vehicle is at rest to speed up the process.
2021-03-04 19:43:01 +11:00
098d5ce5c0
EKF allow range aid without horizontal aiding
...
- skip range aid velocity check when horizontal aiding isn't active
2021-02-22 11:55:56 -05:00
29943a2c09
EKF test ratio status return current height source test ratio
2021-02-22 09:22:45 -05:00
164e53bad3
Add unit tests and update ekf_helper setEkfGlobalOrigin() method to allow for condition when current position is unitialized.
2021-02-19 08:59:47 -05:00
63f64b57c1
EKF: set global origin method
...
EKF: add convergence after global origin reset test
2021-02-19 08:59:47 -05:00
81937370ac
[AUTO COMMIT] update change indication
2021-02-18 10:11:51 +01:00
04844a04ed
ekf control: move time_last_in_air/on_ground out of GPS control logic
2021-02-18 10:11:51 +01:00
b00d4a9237
mag fusion: improve on ground forced mag fusion logic
...
While a yaw test ration > 1 rejects the mag data in air, the fusion is
forced with a limited innovation on ground to fix gyro bias and local
magnetic effects problems pre-takeoff. However, the same logic is
applied after landing and immediately after the land detector detects
landing. In some cases, this can disturb the other EKF states which can
lead to a state change of the land detector.
To avoid such a loop, the start of this forced yaw fusion is delayed by
5 seconds after landing.
2021-02-18 10:11:51 +01:00
310f415175
EKF add const state reset status access
2021-02-16 10:33:43 -05:00
0c5291d194
Heading reset to magnetometer from GPS or EV ( #969 )
2021-02-16 14:37:34 +01:00
d4258cc66d
yaw emergency: check angle between vel observation and estimate ( #975 )
...
use thresholds based on state and obs variance
* [AUTO COMMIT] update change indication
2021-02-15 10:31:16 +01:00
ffab483504
Waiting for the filter to be initialized to set global origin
2021-02-11 12:55:25 -05:00
602e65146c
EKF: Remove unnecessary initialisation
2021-02-09 19:55:32 +11:00
6f664abc4a
EKF: Non functional changes arising from review
2021-02-09 19:55:32 +11:00
b87778e61d
EKF: Make clip detection logic easier to follow
2021-02-09 19:55:32 +11:00
9aa8d93efc
EKF: Use isRecent function
2021-02-09 19:55:32 +11:00
e948b3505f
EKF: Don't reject vertical aiding data if inertial solution is bad
...
Also reduce clipping count threshold
2021-02-09 19:55:32 +11:00
c566318db5
EKF: misc improvements to handling of accel clipping
2021-02-09 19:55:32 +11:00
9c89fa3b29
EKF: Use IMU clipping to adjudicate bad accel data check
2021-02-09 19:55:32 +11:00
cd38621dd6
flow terrain: use dedicated variable for last fusion time
...
This avoids confusion with the flow "for velocity" fusion in the main
EKF
2021-02-08 23:26:33 -05:00
9521e81b09
[AUTO COMMIT] update change indication
2021-02-08 09:43:53 -05:00
ae0c054d75
Update geo_lookup WMM to latest Mon Feb 8 11:48:14 UTC 2021
2021-02-08 09:43:53 -05:00
5aaa6c6dde
lpos accuracy: bump variance if deadreckon time exceeded
2021-02-08 09:01:51 -05:00
46251db4a1
geo: explicitly link libm
2021-02-05 19:00:53 -05:00
b919f3ddf4
EKF: Restore protection from extreme innovation values
2021-01-21 20:55:42 +11:00
efb78deef9
EKF: Set position fusion gate option false by default
2021-01-21 20:55:42 +11:00
556a195320
EKF: Improve handling of non position mode large position innovations
...
These changes fix a bug that allowed IMU gyro errors that cause large tilt errors prior to start of aiding not resulting in large innovation test ratios.
2021-01-21 20:55:42 +11:00
99575d73e1
EKF: Add bad accel bias checking for EV and range finder height use cases
2021-01-09 11:03:31 -05:00
ff3c0a6136
EKF: Fix bug preventing recovery from bad delta velocity bias estimates
2021-01-09 11:03:31 -05:00
c25c97f8b5
[AUTO COMMIT] update change indication
2021-01-09 11:03:31 -05:00
96418101e1
test: Allow for larger vel variance growth due to dvel bias variance
2021-01-09 11:03:31 -05:00
1b1c049e81
test: Update unit test to match expected behaviour
2021-01-09 11:03:31 -05:00
dd259a288f
EKF: Don't modify accel bias states and variances when inhibited
2021-01-09 11:03:31 -05:00
3e1f2d8674
EKF: Set dvel bias variance to stored value when state is inactive
2021-01-09 11:03:31 -05:00
c212975abe
rng height: reset to baro using common logic
...
The failsafe from rng height to baro height should occur after a reset
to baro triggered by the controlHeightSensorTimeouts function and not in
the fusion selector.
Until now, the EKF was fusing baro measurements between rng updates if
the range finder ODR was slower than the EKF update rate. This is not
the case anymore as the height reset occurs after 5 seconds.
The unit test has been extended to show this behavior.
2021-01-07 10:07:57 +01:00
03fed323ab
EKF: Fix formatting
2021-01-05 21:08:28 +11:00
31fca9c31d
EKF: Update GPS loss message
2021-01-05 21:08:28 +11:00
c65cf13bb8
EKF; Treat combined sideslip and airspeed as a horizontal aiding source
2021-01-05 21:08:28 +11:00
211c84c85b
Rng finder unit test: cover "un-stuck" logic
2021-01-05 20:04:17 +11:00
78ce46f007
Removing Matlab derivation
2021-01-02 06:29:11 +11:00
18f334f4db
flow: add unit test for yaw motion ( #950 )
2020-12-25 09:47:14 +01:00
df7f261e03
Add missing const modifier
2020-12-20 14:04:29 +01:00
a8e0e82858
EKF: update mag LPF immediately
2020-12-17 10:46:04 +01:00
398fe159ce
EKF: allow initialising without mag depending on configuration
...
- reduce initial number of required mag and baro samples before init
2020-12-17 19:55:51 +11:00
1237087d70
AlphaFilter add constructor that takes alpha and use in EKF
2020-12-16 13:55:59 -05:00
37e84b763a
README: fix zenodo badge (rename ecl -> PX4-ECL)
2020-12-16 10:47:21 -05:00
5ccb8b457d
fakePosFusion: reset _last_known_posNE to current state when starting ( #943 )
...
* [AUTO COMMIT] update change indication
2020-12-15 10:09:01 +01:00
9d22f140dd
gps_alt: constrain var using 1.5 as a typical ratio of vacc/hacc
2020-12-13 14:39:50 +11:00
b0cf45e2d2
gps_alt: rename getGpsAltVar -> getGpsHeightVariance
2020-12-13 14:39:50 +11:00
bresch
Daniel Agar
Nicolas MARTIN
mcsauder
bresch
isidroas
Loic Dubois
Paul Riseborough
PX4BuildBot
PX4 BuildBot
priseborough
Kamil Ritz