rotate accel/gyro FIFO before publish and fix angular velocity filter resets

- rotates accel & gyro FIFO data before publication both to simplify downstream usage (including log review) and fix other issues
     - to best handle int16_t data rotations are now either performed with swaps if possible, otherwise promoted to float, rotated using the full rotation matrix, then rounded back to int16_t
 - fix sensors/vehicle_angular_velocity filter reset both with proper rotation and new calibration uncorrect helper
      - in FIFO case filtering is done before calibration is applied, but we need to handle a possible reset from a completely different sensor (vehicle body angular velocity -> sensor frame uncorrected data)
This commit is contained in:
Daniel Agar
2021-03-22 12:01:12 -04:00
committed by GitHub
parent d4dd019578
commit e57aaaaa5e
13 changed files with 419 additions and 359 deletions

View File

@@ -71,7 +71,7 @@ px4_add_board(
navigator
rc_update
sensors
sih
#sih
temperature_compensation
#vmount
SYSTEMCMDS
@@ -94,6 +94,7 @@ px4_add_board(
reboot
reflect
sd_bench
#serial_test
system_time
top
topic_listener
@@ -102,7 +103,6 @@ px4_add_board(
usb_connected
ver
work_queue
serial_test
EXAMPLES
## fixedwing_control # Tutorial code from https://px4.io/dev/example_fixedwing_control
# hello