0d6c2c8ce9
EKF2: Error-State Kalman Filter ( #22262 )
...
* ekf derivation: change to error state formulation
* ekf2: update auto-generated code for error-state
* ekf2: adjust ekf2 code for error state formulation
* ekf2_tests: adjust unit tests for error-state EKF
* update change indicator for error-state EKF
* ekf2_derivation: allow disabling mag and wind states
---------
Co-authored-by: bresch <[brescianimathieu@gmail.com ](mailto:brescianimathieu@gmail.com )>
2023-10-31 10:02:18 -04:00
9c41c06325
square matrix: add function to uncorrelate part of the matrix
2023-09-19 09:37:50 -04:00
b612467593
square matrix: add partial trace computation
...
This is useful when we need the sum of some variances in a large
covariance matrix
2023-09-19 09:37:50 -04:00
01fc4c3cf1
SquareMatrix: add functions to copy upper and lower triangle
2023-08-08 12:09:56 -04:00
39e04d9712
lib: matrix: SquareMatrix: Deal with the special case of M=1
...
Signed-off-by: Patrick José Pereira <patrickelectric@gmail.com >
2023-07-06 08:24:33 +02:00
d03f242c04
DCM: use simplified conversion from unit quaternion
...
This is exactly equivalent for a unit quaternion (and only unit
quaternions should be used to encode a rotation)
2023-06-05 11:58:42 -04:00
04c5d70588
matrix: Describe emult, edivide functions
2023-05-09 16:14:55 +02:00
37d3218d11
matrix: add 2d rotation matrix
2023-04-15 21:57:40 +02:00
9f8fa99d70
matrix: use stack allocation for debug output string
2023-03-21 15:01:26 +01:00
b1435c6e34
matrix: use output stream function template
...
to enable proper automatic output in gtest unit tests
that compare two `Matrix`, `Vector` or two `Dual` objects.
Credits to @jwidauer for showing me this trick.
2023-03-21 15:01:26 +01:00
b0189d95af
Use new Vector4 class
2023-03-21 15:01:26 +01:00
08d6465ce5
matrix: add explicit Vector4 type
2023-03-21 15:01:26 +01:00
6e07af959f
fixed bug in Matrix library
...
Signed-off-by: RomanBapst <bapstroman@gmail.com >
2023-02-16 11:28:41 +01:00
34c852255e
Changed M_PI to M_PI_F in the matrix library since M_PI is non-standard. ( #20458 )
...
* Changed M_PI to M_PI_F in the matrix library since M_PI is non-standard.
* Added a new M_PI_PRECISE constant definition to px4_platform_common/defines.h to be
used in places when M_PI is desired but shouldn't be used because it is not C standard.
* Added the px4_platform_common/defines.h include to the matrix library math.hpp header to pull
in some non-standard M_PI constants and updated the test files to use those constants.
* Fixed PI constants in matrix helper test to prevent test failure
2022-10-31 11:51:23 -04:00
93de9567a5
Matrix: add isAllFinite() to check if every element is finite
2022-10-19 19:09:20 +02:00
a73efd9c4f
NuttX carry minimal c++ cmath (replacing Matrix stdlib_imports.hpp)
2022-07-12 08:05:06 -04:00
db7430aa65
matrix helper: remove needless comment line
2022-03-23 10:51:45 +01:00
4a5a8d59fe
matrix helper: add documentation for sign function
2022-03-23 08:47:52 +01:00
d0abcc1ca3
MatrixHelperTest: add unit tests for the signum function
2022-03-23 08:47:52 +01:00
03f836f79d
matrix helper: fix sign function zero case
2022-03-23 08:47:52 +01:00
9ab99a7689
MatrixHelperTest: don't rely on FLOAT_EQ accepting FLT_EPSILON inaccuracy
2022-03-18 13:35:18 +01:00
144697bb6a
MatrixHelperTest: correct wrap compare values
2022-03-18 13:35:18 +01:00
cde7b1bc41
Matrix: remove deprecated minimal test framework
2022-03-17 13:02:22 +01:00
91493307b9
Matrix: convert vector test to gtest
2022-03-17 13:02:22 +01:00
4b63f6b29a
Matrix: convert vector assignment test to gtest
2022-03-17 13:02:22 +01:00
f4b53d2762
Matrix: convert vector3 test to gtest
2022-03-17 13:02:22 +01:00
ddfd62dfc2
Matrix: convert vector2 test to gtest
2022-03-17 13:02:22 +01:00
be28aeb3ee
Matrix: convert upper right triangle test to gtest
2022-03-17 13:02:22 +01:00
4d43aad847
Matrix: convert transpose test to gtest
2022-03-17 13:02:22 +01:00
b3cc18c6de
Matrix: convert square test to gtest
2022-03-17 13:02:22 +01:00
555ed9b9d8
Matrix: convert slice test to gtest
2022-03-17 13:02:22 +01:00
46df8ab60c
Matrix: convert set identity test to gtest
2022-03-17 13:02:22 +01:00
831f0e9aac
Matrix: convert scalar multiplication test to gtest
2022-03-17 13:02:22 +01:00
38d742f1b5
Matrix: convert pseudo inverse test to gtest
2022-03-17 13:02:22 +01:00
57e443c4a4
Matrix: convert multiplication test to gtest
2022-03-17 13:02:22 +01:00
719898f1e3
Matrix: convert least squares test to gtest
2022-03-17 13:02:22 +01:00
fddcf342e9
Matrix: convert inverse test to gtest
2022-03-17 13:02:22 +01:00
f5ec4b2339
Matrix: convert integral test to gtest
2022-03-17 13:02:22 +01:00
7c9e28c168
Matrix: convert helper test to gtest
2022-03-17 13:02:22 +01:00
0c4c3a917c
Matrix: convert hat vee test to gtest
2022-03-17 13:02:22 +01:00
8f695a5613
Matrix: convert filter test to gtest
2022-03-17 13:02:22 +01:00
79e8152f05
Matrix: convert dual test to gtest
2022-03-17 13:02:22 +01:00
62571b6984
Matrix: convert copy to test to gtest
2022-03-17 13:02:22 +01:00
35b035e880
Matrix: convert attitude test to gtest
2022-03-17 13:02:22 +01:00
c33bf5b705
Matrix: convert assignment test to gtest
2022-03-17 13:02:22 +01:00
fa35635486
Matrix: change naming of sparse vector test
2022-03-17 13:02:22 +01:00
c4bc062714
helper_functions: generalize unwrapping function
2022-03-08 10:56:32 +01:00
c86c2db07f
helper_functions: simplify unwrap function
2022-03-08 10:56:32 +01:00
5a3aba9c21
matrix: add angle unwrapping method
2022-03-08 10:56:32 +01:00
68a0414622
Quaternion: rename function to rotate vectors
2022-03-07 20:03:54 -05:00
Mathieu Bresciani