Commit Graph

1065 Commits

Author SHA1 Message Date
kamilritz 4fb2d1b02e Update range finder interface 2020-01-23 09:34:07 +11:00
kamilritz 9f0d8ed59e Update mag interface 2020-01-23 09:34:07 +11:00
kamilritz 856961ba85 Update airspeed interface 2020-01-23 09:34:07 +11:00
kamilritz b8a3ed5f09 Update baro interface 2020-01-23 09:34:07 +11:00
kamilritz 74ec80cdc7 Update gps interface 2020-01-23 09:34:07 +11:00
Paul Riseborough a19c29e708 EKF: Rework yaw fusion to remove singularity at +-90 deg yaw 2020-01-23 09:23:56 +11:00
kamilritz 83b2abe434 protect against overflow 2020-01-21 10:09:48 +03:00
kamilritz 4be9ae8029 Compute the timestamp of average sample correctly 2020-01-21 10:09:48 +03:00
kamilritz 29c5954690 Move baro downsampling and dynamic pressure comp to ECL 2020-01-21 10:09:48 +03:00
kamilritz d7d7b56519 Move mag down sampling to ECL lib 2020-01-21 09:36:02 +03:00
bresch 0f4439d281 optical flow: inhibit flow fusion only when the terrain estimate gets invalid 2020-01-15 16:07:17 +11:00
bresch d06dc33ded range_finder_checks: do not override range_hgt_valid flag with rng_stuck flag
Thif fixes the issue where the range finder data is always set to valid
if not stuck.
2020-01-15 16:07:17 +11:00
bresch d0fe1f032a mag_fusion: re-introduce delay between mag reset and fusion, this was
dropped during the mag fusion refactor PR #662
2020-01-15 14:40:06 +11:00
Tom Wang 4044abdd20 fixed output state variable name state_variance to state_variances 2020-01-10 19:57:39 +05:30
kamilritz cd9e81539c Expand IMU Down Sampling tests 2020-01-09 19:43:29 +11:00
kamilritz de58ab9167 inline newly added function save 60Bytes 2020-01-09 19:43:29 +11:00
kamilritz be11516dd6 Refactor IMU downsampling into its own class 2020-01-09 19:43:29 +11:00
kamilritz c7e074276f Save flash space
This commit saves roughly 400-500 Bytes in flash space
2020-01-09 19:43:29 +11:00
kamilritz 94484f01ce save flash space 2020-01-08 14:36:03 +01:00
kamilritz 84dcb32bd8 Extend auxVel interface to support 3d velocity 2020-01-08 14:36:03 +01:00
kamilritz 07e8e88e88 Support full vision variance 2020-01-08 14:36:03 +01:00
kamilritz 4ab3dd50c9 pass Vector by const reference 2020-01-08 09:00:31 +01:00
kamilritz 2657e4fc0c Improve naming and white space 2020-01-08 09:00:31 +01:00
kamilritz 1fcfd394dd Various small non-functional improvements 2020-01-08 09:00:31 +01:00
kamilritz deeac03d6a Clean up height reset logic booleans 2020-01-08 09:00:31 +01:00
kamilritz cec6d76577 Raise awareness for drag variance(!=stdDev) bug 2020-01-08 09:00:31 +01:00
kamilritz 0b18143745 Improve readibility 2020-01-08 09:00:31 +01:00
kamilritz 3daf25763e Remove unnecessary comments 2020-01-08 09:00:31 +01:00
kamilritz 36da8d82c8 Clean up white space 2020-01-08 09:00:31 +01:00
kamilritz 48787c0160 Improve Matrix library usage 2020-01-08 09:00:31 +01:00
kamilritz a21a7cd5b9 Remove output argument from calcEarthRateNed 2020-01-08 09:00:31 +01:00
kamilritz 9e6d27fafb Add missing const qualifier 2020-01-08 09:00:31 +01:00
kamilritz 066392ef02 Improve naming 2020-01-07 08:14:59 +11:00
kamilritz f99dbd8ca3 Improve naming and brackets 2020-01-07 08:14:59 +11:00
kamilritz 1c68709949 Rename mag ambiguous mag abbreviations with magnitude 2020-01-07 08:14:59 +11:00
kamilritz a24aaad861 CleanUp GPS drift checks 2020-01-07 08:14:59 +11:00
kamilritz c6e3f389d2 Replace calculation of earth NED rotation vector 2020-01-07 08:14:59 +11:00
kamilritz 9f053cb8c1 Simplify covariance getters 2020-01-02 19:26:57 +11:00
Paul Riseborough 0d0f46ec1c EKF: Don't run unnecessary makeRowColSymmetric operation
This operation is expensive when done to the whole covariance matrix and unnecessary after covariance prediction because we calculate the upper diagonal and copy across so it is already symmetric.
2020-01-02 19:26:57 +11:00
Paul Riseborough 166d260058 EKF: Provide auto-code output that uses (row, col) syntax for covariance matrix 2020-01-02 19:26:57 +11:00
kamilritz 92ba618f57 Improve on flash memory usage 2020-01-02 19:26:57 +11:00
kamilritz 459b76f9fd Make covariance matrices of type matrix::SquareMatrix
and use functions from Matrix to reset covariances.
2020-01-02 19:26:57 +11:00
kamilritz 490c749f80 Revert if statement swap in resetMagHeading 2019-12-18 10:06:31 +01:00
kamilritz a6bbafc7b0 Remove unnecessary initialiseCovariance
It is already called in reset()
2019-12-18 09:46:32 +01:00
kamilritz ef9f1053d0 Random improvements 2019-12-18 09:46:32 +01:00
kritz 01495ede97 Clean initialiseFilter function (#687)
* Clean initialiseFilter

* Add const qualifiers
2019-12-17 13:36:28 +01:00
kritz 532c9abd4a Expand test framework and test cases (#685)
* Fix comment

* Ekf wrapper for testing

Add utility function for accessing information in the ekf object

* Add step function for Gps sensor

* Add RangeFinder and Flow to simulated sensors

* Add first fusion logic tests

* Add units to function name

* Use EXPECT_TRUE

* Adding missing qualifiers

* Improve EXPECT_ calls

* Improve naming
2019-12-17 11:35:45 +01:00
kritz 6c25ac5731 Tilt Initialisation: Average Filter -> LowPass Filter (#686)
* Tilt Initialisation: Average Filter -> LowPass Filter

* Add _is_first_imu_sample variable

* Remove not needed comments
2019-12-17 11:01:25 +01:00
Daniel Agar 98a1aae494 EKF: use Matrix cross product 2019-12-17 09:35:08 +01:00
kamilritz 85e0e6e89c Remove resetStates(AndCovariances) function 2019-12-13 16:50:56 +01:00