kamilritz
3e3a66e9e9
Remove unnecessary operations
5 years ago
kamilritz
079a699556
Random cleanup
5 years ago
kamilritz
d18ddb3e92
Use ternary operator
5 years ago
kamilritz
122f58b94d
Bug: stop overwriting fault status of index 0 with index 1
5 years ago
kamilritz
9e211d6ca1
Stop overwriting fault status with false if one component is true
5 years ago
kamilritz
e5ddd912a4
Remove not needed else case
5 years ago
kamilritz
430497e2f7
Shift variable definition inside calculateOutputStates
5 years ago
kamilritz
f59343b343
Remove misplaced comment
5 years ago
kamilritz
673b309c45
Fix bug: pos gain used instead of vel gain
5 years ago
kamilritz
2af2696b63
Revert if-else condition to get rid of unnecessary indentation
5 years ago
kamilritz
fce4958d4f
Random cleanup
5 years ago
kritz
9eea44f4ab
Return type of resets ( #859 )
...
* Reset position/velocity return type is void
* Delete not needed comments
5 years ago
bresch
97e54df123
Gps control: add missing consts and reduce variable scope
5 years ago
bresch
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
5 years ago
bresch
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.
5 years ago
kamilritz
97225fcb74
Use matrix lib inside getState
5 years ago
kamilritz
16a00eae0b
Make Kfusion a Vector24f
5 years ago
kamilritz
356b2f6ffe
Stop setting zero to zero
5 years ago
kamilritz
552bf824ea
Add typedef for Matrix 24 types
5 years ago
kamilritz
5356077a32
Make flow_innov/-var a matrix Vector2f
5 years ago
kamilritz
c2801eb488
Add const modifier and increase matrix library usage
5 years ago
kamilritz
d9afc2f1e8
Remove repeated division by same value
5 years ago
kamilritz
d16b43a2da
Get rid of non functional piece of code
5 years ago
kamilritz
c3653e68ca
Add const modifier
5 years ago
kamilritz
48f0eb16da
Remove uninformative comments
5 years ago
kamilritz
4a69b41015
Increase matrix library usage even more
5 years ago
kamilritz
630be60930
Increase matrix library usage
5 years ago
kamilritz
22274b1d30
Add const modifier
5 years ago
kamilritz
61c139ea95
Remove unused variable
5 years ago
kamilritz
afd4f3f86b
Fix typo
5 years ago
kamilritz
a3706fdcef
Make relative wind computation more compact
5 years ago
kamilritz
b8f937666a
Make mag_innov/-var a Matrix::Vector3f
5 years ago
Daniel Agar
2927132954
clang-format set BreakBeforeBraces to Linux style
...
- this keeps things consistent with PX4/Firmware astyle
5 years ago
bresch
4b746a3fca
GPS Yaw: add consts and remove fusion starting message
...
The fusion status is captured in the status flags; the message is
superfluous, uses flash space and can impact real-time performance
5 years ago
bresch
2bafe9df08
GPS Yaw: wait to fuse at yaw at least once before declaring it faulty
...
This fixes the cases where the yaw message from the GNSS receiver would
take more time than the vel/pos. The estimator should wait and not
immediately fall back to an other aiding source after 5sec.
If it never comes, it will never fall back, but this is ok since the
user wants to fly with GPS aiding an not with something else.
5 years ago
bresch
51cd63d626
GPS Yaw: fall back to other yaw aiding source in case of bad data
...
If the user selects GPS yaw fusion but that there is no GPS yaw data in
the GPS message or if the fusion is rejected for some time, the GPS yaw
data is declared faulty and the fusion is stopped to allow an other
source of yaw aiding to start.
5 years ago
bresch
fe2a9d3018
GPS Yaw: move isfinite checks in control.cpp
5 years ago
bresch
3c6790f5d5
GPS Yaw: Always reset Yaw when GPS Yaw fusion is starting
...
Also avoid fusing fake mag data when an other source of yaw aiding
is active, even if in MAG_TYPE_NONE mode.
5 years ago
kamilritz
ff8b5ec69d
Extract general functions into utils
5 years ago
Matthias Grob
a296fe7d8c
Move AlphaFilter out of EKF
5 years ago
Matthias Grob
daec5ae608
AlphaFilter: replace isfinite with positive denominator check
5 years ago
Kamil Ritz
e835bc34c4
remove inline modifier
5 years ago
Kamil Ritz
74780aa512
Refactor gps fusion commencing
5 years ago
Matthias Grob
38cbd1a182
AlphaFilter: prevent setParameters division by zero
5 years ago
RomanBapst
b7d54b5477
gps: fixed filter initialization bug around gps
...
- do not gps reference altitude to zero in case gps checks pass before the
filter initialized
- reset the filtered gps position and position derivative filters in case
we are in air or there is movement on the ground
Signed-off-by: RomanBapst <bapstroman@gmail.com>
5 years ago
bresch
8f533cb878
terrain_estimator: fix sensor aid selection
5 years ago
bresch
aa96fa6d9e
Random style fixes in the code
5 years ago
Roman Bapst
b3dc06d0cb
Added height above ground source bitmask indicating which sensor is used
5 years ago
Paul Riseborough
59183f70ba
EKF: Reduce EKF-GSF vulnerability to large yaw gyro bias errors ( #831 )
...
* EKF: Reduce EKF-GSF vulnerability to large yaw gyro bias errors
* Update EKF/ekf_helper.cpp
* EKF: Fix comment typo
Co-authored-by: Roman Bapst <bapstroman@gmail.com>
Co-authored-by: Mathieu Bresciani <brescianimathieu@gmail.com>
Co-authored-by: Roman Bapst <bapstroman@gmail.com>
5 years ago
Kamil Ritz
86fc94b75a
Remove tilt align from position innovation check
5 years ago