Mathieu Bresciani
d4258cc66d
yaw emergency: check angle between vel observation and estimate ( #975 )
...
use thresholds based on state and obs variance
* [AUTO COMMIT] update change indication
4 years ago
Loic Dubois
ffab483504
Waiting for the filter to be initialized to set global origin
4 years ago
Paul Riseborough
602e65146c
EKF: Remove unnecessary initialisation
4 years ago
Paul Riseborough
6f664abc4a
EKF: Non functional changes arising from review
4 years ago
Paul Riseborough
b87778e61d
EKF: Make clip detection logic easier to follow
4 years ago
Paul Riseborough
9aa8d93efc
EKF: Use isRecent function
4 years ago
Paul Riseborough
e948b3505f
EKF: Don't reject vertical aiding data if inertial solution is bad
...
Also reduce clipping count threshold
4 years ago
Paul Riseborough
c566318db5
EKF: misc improvements to handling of accel clipping
4 years ago
Paul Riseborough
9c89fa3b29
EKF: Use IMU clipping to adjudicate bad accel data check
4 years ago
bresch
cd38621dd6
flow terrain: use dedicated variable for last fusion time
...
This avoids confusion with the flow "for velocity" fusion in the main
EKF
4 years ago
PX4BuildBot
9521e81b09
[AUTO COMMIT] update change indication
4 years ago
PX4 BuildBot
ae0c054d75
Update geo_lookup WMM to latest Mon Feb 8 11:48:14 UTC 2021
4 years ago
bresch
5aaa6c6dde
lpos accuracy: bump variance if deadreckon time exceeded
4 years ago
Daniel Agar
46251db4a1
geo: explicitly link libm
4 years ago
Paul Riseborough
b919f3ddf4
EKF: Restore protection from extreme innovation values
4 years ago
Paul Riseborough
efb78deef9
EKF: Set position fusion gate option false by default
4 years ago
Paul Riseborough
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.
4 years ago
Paul Riseborough
99575d73e1
EKF: Add bad accel bias checking for EV and range finder height use cases
4 years ago
Paul Riseborough
ff3c0a6136
EKF: Fix bug preventing recovery from bad delta velocity bias estimates
4 years ago
priseborough
c25c97f8b5
[AUTO COMMIT] update change indication
4 years ago
Paul Riseborough
96418101e1
test: Allow for larger vel variance growth due to dvel bias variance
4 years ago
Paul Riseborough
1b1c049e81
test: Update unit test to match expected behaviour
4 years ago
Paul Riseborough
dd259a288f
EKF: Don't modify accel bias states and variances when inhibited
4 years ago
Paul Riseborough
3e1f2d8674
EKF: Set dvel bias variance to stored value when state is inactive
4 years ago
bresch
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.
4 years ago
Paul Riseborough
03fed323ab
EKF: Fix formatting
4 years ago
Paul Riseborough
31fca9c31d
EKF: Update GPS loss message
4 years ago
Paul Riseborough
c65cf13bb8
EKF; Treat combined sideslip and airspeed as a horizontal aiding source
4 years ago
bresch
211c84c85b
Rng finder unit test: cover "un-stuck" logic
4 years ago
Kamil Ritz
78ce46f007
Removing Matlab derivation
4 years ago
Mathieu Bresciani
18f334f4db
flow: add unit test for yaw motion ( #950 )
4 years ago
Kamil Ritz
df7f261e03
Add missing const modifier
4 years ago
Daniel Agar
a8e0e82858
EKF: update mag LPF immediately
4 years ago
Daniel Agar
398fe159ce
EKF: allow initialising without mag depending on configuration
...
- reduce initial number of required mag and baro samples before init
4 years ago
Daniel Agar
1237087d70
AlphaFilter add constructor that takes alpha and use in EKF
4 years ago
Daniel Agar
37e84b763a
README: fix zenodo badge (rename ecl -> PX4-ECL)
4 years ago
Mathieu Bresciani
5ccb8b457d
fakePosFusion: reset _last_known_posNE to current state when starting ( #943 )
...
* [AUTO COMMIT] update change indication
4 years ago
bresch
9d22f140dd
gps_alt: constrain var using 1.5 as a typical ratio of vacc/hacc
4 years ago
bresch
b0cf45e2d2
gps_alt: rename getGpsAltVar -> getGpsHeightVariance
4 years ago
bresch
62f2e26c49
gps_alt: reset GPS alt variance usign helper function
4 years ago
bresch
f7bddda3d5
gps_alt: do not scale up reported gps vertical accuracy
...
The comment said that the horizontal accuracy needs to be scaled up
using the typical epv/eph ratio but the epv (vacc) is already available,
so no scaling is required.
4 years ago
bresch
02369cd415
gps_alt: extract measurement variance computation and saturation
4 years ago
Daniel Agar
1541e4b414
EKF: update control status and fault status getters
...
- the fault status union exceeded 16 bits, but the getter was get_filter_fault_status(uint16_t *val)
4 years ago
zhaoxiaowei
fbf67bdef9
reset gps height use vacc
4 years ago
Mathieu Bresciani
8f3df7a97b
flow: restructure optical flow control logic ( #928 )
...
- extract motion checks performed on ground
- move all non-timing check to controlOpticalFlowFusion. This simplifies and standardirzes the setOpticalFlowData function. Furthermore, in some cases (SITL, PX4Flow), the dt is forced to 0 when the quality is 0 (which is usual on ground) so the ekf needs to ignore those values on ground to initialize properly the flow fusion.
- add filter convergence test
- move check for dt time max in setOpticalFlowData
- in the simulator, do not update dt as this is the sensor integration
period.
4 years ago
kritz
38358002bb
Auto update change indication by github actions
...
Co-authored-by: kamilritz <kamilritz@users.noreply.github.com>
4 years ago
Daniel Agar
688a054bdb
EKF: controlDragFusion() add parenthesis for readability
4 years ago
Paul Riseborough
944b18c63e
EKF: Remove non useful status print
...
Local position is never valid when filter is initialised so there is no use printing the status.
4 years ago
Paul Riseborough
ee94980a8f
EKF: Clean up wind state activation logic
...
Ensure wind states are deactivated in one place and always when in a non-position mode.
Activate wind states separately for each observation method.
4 years ago
Paul Riseborough
44ebfb8c43
EKF: Don't report local position as valid when in a non-position mode
4 years ago