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

[telemetry] fix some remaining telemetry messages

Browse Source
This commit is contained in:
Gautier Hattenberger
2013-11-04 10:52:43 +01:00
parent 7d87b888a8
commit e3830578fb
4 changed files with 19 additions and 28 deletions
Download Patch File Download Diff File Expand all files Collapse all files
sw/airborne/firmwares/fixedwing/datalink.c
+1 -2
View File
@@ -139,8 +139,7 @@ void dl_parse_msg(void) {
DOWNLINK_SEND_WP_MOVED(DefaultChannel, DefaultDevice, &wp_id, &utm.east, &utm.north, &a, &nav_utm_zone0);
} else if (msg_id == DL_BLOCK && DL_BLOCK_ac_id(dl_buffer) == AC_ID) {
nav_goto_block(DL_BLOCK_block_id(dl_buffer));
// FIXME
//SEND_NAVIGATION(DefaultChannel, DefaultDevice);
SEND_NAVIGATION(DefaultChannel, DefaultDevice);
} else
#endif /** NAV */
#ifdef WIND_INFO
sw/airborne/firmwares/rotorcraft/guidance/guidance_h.c
+14 -19
View File
@@ -139,25 +139,19 @@ static void send_href(void) {
&guidance_h_speed_ref.y, &guidance_h_accel_ref.y);
}
// FIXME no idea where to put this one
//#ifndef AHRS_FLOAT
//#define PERIODIC_SEND_ROTORCRAFT_TUNE_HOVER(DefaultChannel, DefaultDevice) {
// DOWNLINK_SEND_ROTORCRAFT_TUNE_HOVER(DefaultChannel, DefaultDevice,
// &radio_control.values[RADIO_ROLL],
// &radio_control.values[RADIO_PITCH],
// &radio_control.values[RADIO_YAW],
// &stabilization_cmd[COMMAND_ROLL],
// &stabilization_cmd[COMMAND_PITCH],
// &stabilization_cmd[COMMAND_YAW],
// &stabilization_cmd[COMMAND_THRUST],
// &ahrs_impl.ltp_to_imu_euler.phi,
// &ahrs_impl.ltp_to_imu_euler.theta,
// &ahrs_impl.ltp_to_imu_euler.psi,
// &(stateGetNedToBodyEulers_i()->phi),
// &(stateGetNedToBodyEulers_i()->theta),
// &(stateGetNedToBodyEulers_i()->psi));
//}
//#endif
static void send_tune_hover(void) {
DOWNLINK_SEND_ROTORCRAFT_TUNE_HOVER(DefaultChannel, DefaultDevice,
&radio_control.values[RADIO_ROLL],
&radio_control.values[RADIO_PITCH],
&radio_control.values[RADIO_YAW],
&stabilization_cmd[COMMAND_ROLL],
&stabilization_cmd[COMMAND_PITCH],
&stabilization_cmd[COMMAND_YAW],
&stabilization_cmd[COMMAND_THRUST],
&(stateGetNedToBodyEulers_i()->phi),
&(stateGetNedToBodyEulers_i()->theta),
&(stateGetNedToBodyEulers_i()->psi));
}
#endif
@@ -182,6 +176,7 @@ void guidance_h_init(void) {
register_periodic_telemetry(DefaultPeriodic, "GUIDANCE_H_INT", send_gh);
register_periodic_telemetry(DefaultPeriodic, "HOVER_LOOP", send_hover_loop);
register_periodic_telemetry(DefaultPeriodic, "GUIDANCE_H_REF", send_href);
register_periodic_telemetry(DefaultPeriodic, "ROTORCRAFT_TUNE_HOVER", send_tune_hover);
#endif
}