fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-02 05:04:08 +08:00
Code Issues Packages Projects Releases Wiki Activity
1,624 Commits 852 Branches 161 Tags
Commit Graph

1624 Commits

This Branch
This Branch
All Branches
Author SHA1 Message Date
Paul Riseborough
eab0ef4266 EKF: Update default process noise for terrain estimator 2016-03-11 11:03:43 +11:00
Paul Riseborough
962fd0aaf2 EKF: Adjust terrain process noise for gradient effect 2016-03-11 11:03:43 +11:00
Paul Riseborough
1a2da887ab EKF: Fix bug in calculation of terrain estimator Kalman gain 2016-03-11 11:03:43 +11:00
Paul Riseborough
cc5512905a EKF: prevent optical flow, GPS and baro fusion from blocking each other 2016-03-11 11:03:43 +11:00
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
 2016-03-11 11:03:43 +11:00
Paul Riseborough
ffebaf384f EKF: Set initial optical flow fusion monitor outputs to zero 2016-03-11 11:03:43 +11:00
Paul Riseborough
5acd1cbac4 EKF: Make definitions of parameters clearer for external use 2016-03-11 11:03:43 +11:00
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.
 2016-03-11 11:03:43 +11:00
Paul Riseborough
b3b0f1347a EKF: Make normal GPS mode the default 2016-03-11 11:03:43 +11:00
Paul Riseborough
d97d308ca7 EKF: Add control of optical flow and range finder fusion 2016-03-11 11:03:43 +11:00
Paul Riseborough
836fe39070 EKF: Update external interface functions to support optical flow 2016-03-11 11:03:43 +11:00
Paul Riseborough
2ff338048d EKF: Add support for range-finder fusion as primary height reference 2016-03-11 11:03:43 +11:00
Paul Riseborough
2c2850c0ce EKF: Add functions to get position and velocity state variance 2016-03-11 11:03:43 +11:00
Paul Riseborough
32b03819ef EKF: Add function to calculate global position validity 2016-03-11 11:03:43 +11:00
Paul Riseborough
270451e17b EKF: Update height reset to support range finder height use 2016-03-11 11:03:43 +11:00
Paul Riseborough
dca186c6e8 EKF: Add required declarations for optical flow 2016-03-11 11:03:43 +11:00
Paul Riseborough
75b22c95ac EKF: Add new source files to cmake 2016-03-11 11:03:43 +11:00
Paul Riseborough
122dd9c531 EKF: Add source file for optical flow LOS rate fusion 2016-03-11 11:03:43 +11:00
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.
 2016-03-11 11:03:43 +11:00
Paul Riseborough
829e0f1e65 Merge pull request #73 from mcsauder/master 
Conversion error correction and additional function overloads to allow standalone compilation.
 2016-03-11 11:02:32 +11:00
mcsauder
6a61f9ba77 Remove a define that might not be required for compilations in other scnearios outside of C99 restrictions to minimize Pull Request modifications. 2016-03-05 02:17:55 -07:00
mcsauder
115c87a0ea Remove an include that was unnecessary. 2016-03-05 02:15:04 -07:00
mcsauder
1aee1b895a Uncomment commented lines that removed Eigen namespaces and dependencies. 2016-03-05 02:12:26 -07:00
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. 2016-03-05 01:58:58 -07:00
Paul Riseborough
b163efeae2 Merge pull request #72 from PX4/pr-MagFusionBug 
Fix bug in declination fusion and standardise covariance update
 2016-03-05 11:34:19 +11:00
Paul Riseborough
5242af84af EKF: Standardise covariance update and use static arrays for large matrices 2016-03-05 08:58:19 +11:00
Paul Riseborough
1414d591ce EKF: Fix bug in declination fusion indexing 2016-03-05 08:43:33 +11:00
Daniel Agar
2108466a00 initialize ECL_L1 variables 2016-03-03 11:22:07 +01:00
Roman Bapst
b2744f965d use in_air flag from land detector to determine if we are on the ground 2016-03-03 10:53:39 +01:00
Paul Riseborough
569886a4fc EKF: Fix bug in velocity and position innovation consistency checks 2016-03-03 17:15:22 +11:00
mcsauder
f9e3db0504 Move variable initializations from header file to constructor to allow C99 compliance. 2016-03-02 08:42:38 +01:00
Paul Riseborough
d8627c6aaf EKF: Reset the vertical position states if height fusion times out 2016-03-02 08:39:07 +01:00
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.
 2016-03-02 08:39:07 +01:00
Paul Riseborough
a6da73fa83 EKF: Add missing div0 protection 2016-03-01 18:03:35 +11:00
Paul Riseborough
d5e47d21db EKF: miscellaneous comment and format changes 2016-03-01 15:35:45 +11:00
Paul Riseborough
7c83ac4b6d EKF: Use heading fusion as default for startup and ground operation 2016-03-01 15:35:17 +11:00
Paul Riseborough
57d4064d7b EKF: Increase default heading observation noise 
Improves robustness when operating in a bad magnetic field environment
 2016-03-01 15:28:53 +11:00
Paul Riseborough
97df006a6a EKF: Update direct heading fusion 
Adds a 312 Euler rotation sequence option for magnetic heading fusion.
Switches between it and the normal 321 sequence option depending on orientation.
 2016-03-01 15:25:22 +11:00
Paul Riseborough
ea29e39e5b EKF: Updated derivation of Jacobians for direct heading measurement 
Adds an alternative using a 312 Euler sequence.
 2016-03-01 15:21:36 +11:00
Paul Riseborough
2c9a814de1 Merge pull request #64 from mcsauder/master 
Additional filter variable initializations required to fully reset the filter variables
 2016-02-26 23:06:56 +11:00
Paul Riseborough
78d6f6941c Merge pull request #61 from PX4/pr-ImprovedAccuracyReporting 
EKF: Improve Position Accuracy Reporting
 2016-02-26 22:48:44 +11:00
Paul Riseborough
f058fc817f Merge pull request #63 from PX4/att_reset 
Attitude reset after heading reset
 2016-02-26 22:35:14 +11:00
mcsauder
5fb48a2e7b Merge remote-tracking branch 'upstream/master' 2016-02-25 22:51:58 -07:00
mcsauder
5fec0df70d Additional initializations required to reset complimentary filter values if the state estimate ever diverges and requires re-initiailization. 2016-02-25 22:51:14 -07:00
Roman Bapst
9192ced7bb do not reset output attitude state after heading reset to avoid jumps in attitude 2016-02-25 18:20:29 +01:00
Lorenz Meier
cd5857e900 Add vibration magnitude estimation 2016-02-25 16:54:24 +01:00
Paul Riseborough
cd0cac066a EKF: Calculate and publish horizontal and vertical position accuracy 
This calculation takes into account the uncertainty of the origin.
Dead reckoning status is also published
 2016-02-25 10:38:07 +11:00
Paul Riseborough
a30830a7a9 EKF: Scale position observation noise with GPS quality 
This allows the filter to adapt to variations in GPs quality.
The range of adjustment in observation noise is limited to the range between a lower limit set by the GPS observation noise parameter and an upper limit set by the no-aiding observation noise.
 2016-02-25 10:16:32 +11:00
Paul Riseborough
5483e7a477 Merge pull request #60 from PX4/pr-ReduceMagModeSwitchKick 
EKF: Fix Bug Causing Roll/pitch Disturbances On Mag Fusion Mode Switch
 2016-02-25 09:42:18 +11:00
Paul Riseborough
f55a0bff53 EKF: Fix code style 2016-02-25 08:17:50 +11:00