Mirrors_Framework/paparazzi
1
0
Fork 0
mirror of https://github.com/paparazzi/paparazzi.git synced 2026-05-23 04:45:37 +08:00
Code Issues Actions 25 Packages Projects Releases Wiki Activity

[telemetry] workaround for disabling send_mag_calib on dualApFbw

Browse Source
This commit is contained in:
Felix Ruess
2013-11-06 17:37:23 +01:00
parent 3c9dd7c937
commit 90dcff721d
1 changed files with 4 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
sw/airborne/subsystems/imu.c
+4
View File
@@ -95,12 +95,14 @@ static void send_mag(void) {
}
// TODO this could be a special module ?
#if !defined(AP) || (defined(AP) && defined(FBW))
#include "subsystems/electrical.h"
static void send_mag_calib(void) {
DOWNLINK_SEND_IMU_MAG_CURRENT_CALIBRATION(DefaultChannel, DefaultDevice,
&imu.mag_unscaled.x, &imu.mag_unscaled.y, &imu.mag_unscaled.z,
&electrical.current);
}
#endif
#endif // !USE_IMU_FLOAT
@@ -151,7 +153,9 @@ INFO("Magnetometer neutrals are set to zero, you should calibrate!")
register_periodic_telemetry(DefaultPeriodic, "IMU_MAG_RAW", send_mag_raw);
register_periodic_telemetry(DefaultPeriodic, "IMU_MAG_SCALED", send_mag_scaled);
register_periodic_telemetry(DefaultPeriodic, "IMU_MAG", send_mag);
#if !defined(AP) || (defined(AP) && defined(FBW))
register_periodic_telemetry(DefaultPeriodic, "IMU_MAG_CURRENT_CALIBRATION", send_mag_calib);
#endif
#endif // !USE_IMU_FLOAT
#endif // DOWNLINK