mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-05-28 09:58:23 +08:00
[messages] added ahrs_aligner.status to FILTER_ALIGNER message
This commit is contained in:
@@ -1048,6 +1048,7 @@
|
||||
<field name="gr" type="int32" alt_unit="degres/s" alt_unit_coef="0.0139882"/>
|
||||
<field name="noise" type="int32"/>
|
||||
<field name="cnt" type="int32"/>
|
||||
<field name="status" type="uint8" values="UNINIT|RUNNING|LOCKED"/>
|
||||
</message>
|
||||
|
||||
<!-- 138 is free -->
|
||||
|
||||
@@ -304,15 +304,16 @@
|
||||
|
||||
#include "subsystems/ahrs/ahrs_aligner.h"
|
||||
#define PERIODIC_SEND_FILTER_ALIGNER(_trans, _dev) { \
|
||||
DOWNLINK_SEND_FILTER_ALIGNER(_trans, _dev, \
|
||||
&ahrs_aligner.lp_gyro.p, \
|
||||
&ahrs_aligner.lp_gyro.q, \
|
||||
&ahrs_aligner.lp_gyro.r, \
|
||||
&imu.gyro.p, \
|
||||
&imu.gyro.q, \
|
||||
&imu.gyro.r, \
|
||||
&ahrs_aligner.noise, \
|
||||
&ahrs_aligner.low_noise_cnt); \
|
||||
DOWNLINK_SEND_FILTER_ALIGNER(_trans, _dev, \
|
||||
&ahrs_aligner.lp_gyro.p, \
|
||||
&ahrs_aligner.lp_gyro.q, \
|
||||
&ahrs_aligner.lp_gyro.r, \
|
||||
&imu.gyro.p, \
|
||||
&imu.gyro.q, \
|
||||
&imu.gyro.r, \
|
||||
&ahrs_aligner.noise, \
|
||||
&ahrs_aligner.low_noise_cnt, \
|
||||
&ahrs_aligner.status); \
|
||||
}
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user