Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-24 01:28:29 -04:00
Code Issues Packages Projects Releases Wiki Activity

Plane: fixed SERVO_OUTPUT_RAW for HIL

Browse Source
This commit is contained in:
Andrew Tridgell 2012-12-03 17:38:31 +11:00
parent ac8a6b7c3e
commit cd19cb6cc2
1 changed files with 16 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

16
ArduPlane/GCS_Mavlink.pde
View File

@ -328,6 +328,7 @@ static void NOINLINE send_radio_in(mavlink_channel_t chan)
static void NOINLINE send_radio_out(mavlink_channel_t chan) static void NOINLINE send_radio_out(mavlink_channel_t chan)
{ {
#if HIL_MODE == HIL_MODE_DISABLED || HIL_SERVOS
mavlink_msg_servo_output_raw_send( mavlink_msg_servo_output_raw_send(
chan, chan,
micros(), micros(),
@ -340,6 +341,21 @@ static void NOINLINE send_radio_out(mavlink_channel_t chan)
APM_RC.OutputCh_current(5), APM_RC.OutputCh_current(5),
APM_RC.OutputCh_current(6), APM_RC.OutputCh_current(6),
APM_RC.OutputCh_current(7)); APM_RC.OutputCh_current(7));
#else
extern RC_Channel* rc_ch[NUM_CHANNELS];
mavlink_msg_servo_output_raw_send(
chan,
micros(),
0, // port
rc_ch[0]->radio_out,
rc_ch[1]->radio_out,
rc_ch[2]->radio_out,
rc_ch[3]->radio_out,
rc_ch[4]->radio_out,
rc_ch[5]->radio_out,
rc_ch[6]->radio_out,
rc_ch[7]->radio_out);
#endif
} }
static void NOINLINE send_vfr_hud(mavlink_channel_t chan) static void NOINLINE send_vfr_hud(mavlink_channel_t chan)