0bffd951ec
AlphaFilter: include float.h for FLT_EPSILON
2020-07-28 15:41:58 -04:00
88c52aba5e
Refactor ev fusion start into helper functions ( #872 )
2020-07-27 11:42:52 +02:00
8c65ca29e4
Only run firmware build test on pull_request
2020-07-26 10:11:52 -04:00
049f59d7de
Fix firmware-build-test
2020-07-26 10:11:52 -04:00
185f22b094
geo_lookup: copyright header consistency and minor update
...
Minor consistency fixes for the copyright header and update the tables to current. PX4Buildbot will periodically update the tables automatically from this point.
2020-07-20 13:01:56 -04:00
9aa7991654
geo_lookup: upgrade table size (2 bytes per element) and add testing
...
- updated table to 2 bytes (int16) per element and scaled the inclination/declination/strength tables to use most of the range without being too awkward
- tables have been extended to include the full latitude range
- expanded the API slightly to offer declination/inclination in both degrees/radians and the magnetic strength in Gauss and Tesla
- generated some simple testing that verifies interpolation between points
2020-07-19 18:53:47 -04:00
3651ed37fb
Do not update time_last_imu outside of setGpsData
2020-07-17 11:06:36 +02:00
89bfcc2167
Introduce checkAndFixCovarianceUpdate(KHP) function
2020-07-16 18:25:06 +02:00
5c4a3d4576
Make observation jacobian a Vector24f when possible
2020-07-16 18:25:06 +02:00
b5e1397c0f
Add const modifier
...
const modifier
Add missing const modifier
2020-07-16 18:25:06 +02:00
e357376797
Bring declaration and initialization together
2020-07-16 18:25:06 +02:00
796afd5f98
Rename yaw_use_inhibit -> is_yaw_fusion_inhibited
...
Temp
2020-07-16 18:25:06 +02:00
4cb2d1c645
Remove duplicated code snippets
...
by combining x and y ballistic coeff inverse a vector
2020-07-16 18:25:06 +02:00
b0ad9f0226
Replace componentwise with matrix operation
2020-07-16 18:25:06 +02:00
b5765eb3b4
Move variable declaration to better place &
...
remove airspeed_innov_var_temp variable. setting to global variable even when fusion is aborted is okay
2020-07-16 18:25:06 +02:00
05855b7fc1
Update time of last fusion event really only if fused
...
Except for the velpos fusion
2020-07-16 18:25:06 +02:00
efd96db49d
Avoid setting 0 to 0
2020-07-16 18:25:06 +02:00
5ef18f8823
Style improvement
2020-07-16 18:25:06 +02:00
01515b9a9c
Replace min(max()) with constrain
2020-07-16 18:25:06 +02:00
b0458fbded
Refactor output buffer updates into separate functions
2020-07-16 18:25:06 +02:00
3d82d822ae
Add const modifier
2020-07-16 18:25:06 +02:00
93011ed52c
Use ternary operator
2020-07-16 18:25:06 +02:00
46a5e6e428
Replace divisions with multiplications
2020-07-02 15:55:24 +02:00
3e3a66e9e9
Remove unnecessary operations
2020-07-02 15:55:24 +02:00
079a699556
Random cleanup
2020-07-02 15:55:24 +02:00
d18ddb3e92
Use ternary operator
2020-07-02 15:55:24 +02:00
122f58b94d
Bug: stop overwriting fault status of index 0 with index 1
2020-07-02 15:55:24 +02:00
9e211d6ca1
Stop overwriting fault status with false if one component is true
2020-07-02 15:55:24 +02:00
e5ddd912a4
Remove not needed else case
2020-07-02 15:55:24 +02:00
430497e2f7
Shift variable definition inside calculateOutputStates
2020-07-02 15:55:24 +02:00
f59343b343
Remove misplaced comment
2020-07-02 15:55:24 +02:00
673b309c45
Fix bug: pos gain used instead of vel gain
2020-07-02 15:55:24 +02:00
2af2696b63
Revert if-else condition to get rid of unnecessary indentation
2020-07-02 15:55:24 +02:00
fce4958d4f
Random cleanup
2020-07-02 15:55:24 +02:00
9eea44f4ab
Return type of resets ( #859 )
...
* Reset position/velocity return type is void
* Delete not needed comments
2020-07-02 14:53:59 +02:00
97e54df123
Gps control: add missing consts and reduce variable scope
2020-07-02 13:35:13 +02:00
b0f79caf34
GPS yaw: Extract and refactor GPS yaw control logic
...
- Rename GPS yaw fusion functions:
resetGpsAntYaw -> resetYawToGps
fuseGpsAntYaw -> fuseGpsYaw
- Move last fusion time in reset function
2020-07-02 13:35:13 +02:00
7f4fedde6a
GPS Yaw: fix heading initialisation and add unit tests
...
When the antennas are not parallel to the x body axis, the GPS message
contains the angular offset but the data is already corrected in the
driver. EKF2 should then not add this offset during the initialisation.
2020-07-02 13:35:13 +02:00
97225fcb74
Use matrix lib inside getState
2020-07-02 09:02:24 +02:00
16a00eae0b
Make Kfusion a Vector24f
2020-07-02 09:02:24 +02:00
356b2f6ffe
Stop setting zero to zero
2020-07-02 09:02:24 +02:00
552bf824ea
Add typedef for Matrix 24 types
2020-07-02 09:02:24 +02:00
5356077a32
Make flow_innov/-var a matrix Vector2f
2020-06-26 08:26:26 +02:00
c2801eb488
Add const modifier and increase matrix library usage
2020-06-26 08:26:26 +02:00
d9afc2f1e8
Remove repeated division by same value
2020-06-26 08:26:26 +02:00
d16b43a2da
Get rid of non functional piece of code
2020-06-26 08:26:26 +02:00
c3653e68ca
Add const modifier
2020-06-26 08:26:26 +02:00
48f0eb16da
Remove uninformative comments
2020-06-26 08:26:26 +02:00
4a69b41015
Increase matrix library usage even more
2020-06-26 08:26:26 +02:00
630be60930
Increase matrix library usage
2020-06-26 08:26:26 +02:00
Matthias Grob