Paul Riseborough
9f3b1351f7
EKF: Don't initialise velocity to GPS on initial alignment
...
For initial alignment the velocity and position should start at zero
9 years ago
Paul Riseborough
687fcc70be
EKF: Explicitly define type conversion for GPS height
9 years ago
Paul Riseborough
e334a5dc57
EKF: Add check for NaN's on attitude states
9 years ago
Paul Riseborough
6b2e2dba90
EKF: Add GPS height option and improve height recovery
9 years ago
Paul Riseborough
63b0cf4360
EKF: Fix baro height offset bug
9 years ago
Paul Riseborough
4bd79c9e5d
Merge pull request #76 from PX4/pr-fixRngHgtMode
...
EKF: Fix bugs preventing use of range finder as primary height source
Flight testing completed and I have checked that the other pending PR #75 rebases cleanly on it.
9 years ago
Paul Riseborough
49023f3d7e
EKF: fix travis build error
9 years ago
Paul Riseborough
7677a162aa
EKF: Don't start the output observer before the main filter has initialised
...
This prevents the possibility of output transients if alignment is delayed.
9 years ago
Paul Riseborough
d2407c3463
EKF: code style updates
9 years ago
Paul Riseborough
c58ab3e256
EKF: Enable fallback to baro alt when using range finder for height
9 years ago
Paul Riseborough
370f643f42
EKF: Enable use of range finder for primary height source
9 years ago
Lorenz Meier
699ec17cc3
Removed spurious print in wheel controller
9 years ago
Paul Riseborough
2882c53246
Merge pull request #74 from PX4/pr-optflow-reworked
...
Add fusion of optical flow LOS rate measurements
9 years ago
Paul Riseborough
109e0e6dfc
EKF: When commencing GPS aiding, don't reset local position and velocity if using optical flow
9 years ago
Paul Riseborough
26238bc2f5
EKF: Allow for change in position when defining the WGS-84 origin position
...
This allows GPS aiding to commence later in flight without step changes in local position output
9 years ago
Paul Riseborough
e0fcce1463
EKF: Make position and velocity reset publish success
...
Some users of the position and velocity reset functions will need to know if the reset has been successful.
9 years ago
Paul Riseborough
48f980b054
EKF: Fix syntax causing posix build to fail
9 years ago
Paul Riseborough
eab0ef4266
EKF: Update default process noise for terrain estimator
9 years ago
Paul Riseborough
962fd0aaf2
EKF: Adjust terrain process noise for gradient effect
9 years ago
Paul Riseborough
1a2da887ab
EKF: Fix bug in calculation of terrain estimator Kalman gain
9 years ago
Paul Riseborough
cc5512905a
EKF: prevent optical flow, GPS and baro fusion from blocking each other
9 years ago
Paul Riseborough
e9ccfdd484
EKF: Update derivation scripts and outputs
...
Work around limitation in Symbolic toolbox environment space by incrementally saving and clearing workspace
Remove vehicle vertical position from optical flow prediction equations (use range measurement instead) and regenerate auto-code
Remove legacy optical flow auto-code conversion method as it is not required now a work around for symbolic toolbox limitations has been developed
Fix out of date syntax
9 years ago
Paul Riseborough
ffebaf384f
EKF: Set initial optical flow fusion monitor outputs to zero
9 years ago
Paul Riseborough
5acd1cbac4
EKF: Make definitions of parameters clearer for external use
9 years ago
Paul Riseborough
dd1d58bab5
EKF: Remove unnecessary matrix operations from optical flow fusion
...
The updated formulation means that H_LOS[][8] is always zero, so these operations are no longer required.
9 years ago
Paul Riseborough
b3b0f1347a
EKF: Make normal GPS mode the default
9 years ago
Paul Riseborough
d97d308ca7
EKF: Add control of optical flow and range finder fusion
9 years ago
Paul Riseborough
836fe39070
EKF: Update external interface functions to support optical flow
9 years ago
Paul Riseborough
2ff338048d
EKF: Add support for range-finder fusion as primary height reference
9 years ago
Paul Riseborough
2c2850c0ce
EKF: Add functions to get position and velocity state variance
9 years ago
Paul Riseborough
32b03819ef
EKF: Add function to calculate global position validity
9 years ago
Paul Riseborough
270451e17b
EKF: Update height reset to support range finder height use
9 years ago
Paul Riseborough
dca186c6e8
EKF: Add required declarations for optical flow
9 years ago
Paul Riseborough
75b22c95ac
EKF: Add new source files to cmake
9 years ago
Paul Riseborough
122dd9c531
EKF: Add source file for optical flow LOS rate fusion
9 years ago
Paul Riseborough
82cbfafb34
EKF: Add source file for terrain vertical position estimator
...
Implements a single state Kalman filter to estimate terrain vertical position relative to the NED origin.
9 years ago
Paul Riseborough
829e0f1e65
Merge pull request #73 from mcsauder/master
...
Conversion error correction and additional function overloads to allow standalone compilation.
9 years ago
mcsauder
6a61f9ba77
Remove a define that might not be required for compilations in other scnearios outside of C99 restrictions to minimize Pull Request modifications.
9 years ago
mcsauder
115c87a0ea
Remove an include that was unnecessary.
9 years ago
mcsauder
1aee1b895a
Uncomment commented lines that removed Eigen namespaces and dependencies.
9 years ago
mcsauder
f9be23933b
Correct deg to rad conversion inversion. Add additional functionality to mathlib to allow standalone compile without Limits.cpp and Limits.hpp files from PX4.
9 years ago
Paul Riseborough
b163efeae2
Merge pull request #72 from PX4/pr-MagFusionBug
...
Fix bug in declination fusion and standardise covariance update
9 years ago
Paul Riseborough
5242af84af
EKF: Standardise covariance update and use static arrays for large matrices
9 years ago
Paul Riseborough
1414d591ce
EKF: Fix bug in declination fusion indexing
9 years ago
Daniel Agar
2108466a00
initialize ECL_L1 variables
9 years ago
Roman Bapst
b2744f965d
use in_air flag from land detector to determine if we are on the ground
9 years ago
Paul Riseborough
569886a4fc
EKF: Fix bug in velocity and position innovation consistency checks
9 years ago
mcsauder
f9e3db0504
Move variable initializations from header file to constructor to allow C99 compliance.
9 years ago
Paul Riseborough
d8627c6aaf
EKF: Reset the vertical position states if height fusion times out
9 years ago
Paul Riseborough
f7a53d69f2
EKF: Improve height reset function
...
Add a method to reset the vertical velocity to enable in-flight resets
Reset to GPS height if baro height is not available.
9 years ago