From a23999d0f08b456dee4794ffe1d3fba0d209e26f Mon Sep 17 00:00:00 2001 From: Peter Barker Date: Wed, 9 Jun 2021 21:31:35 +1000 Subject: [PATCH] GCS_MAVLink: remove HIL support --- libraries/GCS_MAVLink/GCS.h | 2 -- libraries/GCS_MAVLink/GCS_Common.cpp | 21 +++------------------ 2 files changed, 3 insertions(+), 20 deletions(-) diff --git a/libraries/GCS_MAVLink/GCS.h b/libraries/GCS_MAVLink/GCS.h index c8a2108ad6..c41a2d8a51 100644 --- a/libraries/GCS_MAVLink/GCS.h +++ b/libraries/GCS_MAVLink/GCS.h @@ -342,8 +342,6 @@ public: protected: - virtual bool in_hil_mode() const { return false; } - bool mavlink_coordinate_frame_to_location_alt_frame(MAV_FRAME coordinate_frame, Location::AltFrame &frame); diff --git a/libraries/GCS_MAVLink/GCS_Common.cpp b/libraries/GCS_MAVLink/GCS_Common.cpp index e44045d8e0..4f98f71d5a 100644 --- a/libraries/GCS_MAVLink/GCS_Common.cpp +++ b/libraries/GCS_MAVLink/GCS_Common.cpp @@ -877,16 +877,6 @@ bool GCS_MAVLINK::should_send_message_in_delay_callback(const ap_message id) con // No ID we return true for may take more than a few hundred // microseconds to return! - if (in_hil_mode()) { - // in HIL we need to keep sending servo values to ensure - // the simulator doesn't pause, otherwise our sensor - // calibration could stall - if (id == MSG_SERVO_OUT || - id == MSG_SERVO_OUTPUT_RAW) { - return true; - } - } - switch (id) { case MSG_HEARTBEAT: case MSG_NEXT_PARAM: @@ -2668,13 +2658,8 @@ bool GCS_MAVLINK::telemetry_delayed() const void GCS_MAVLINK::send_servo_output_raw() { uint16_t values[16] {}; - if (in_hil_mode()) { - for (uint8_t i=0; i<16; i++) { - values[i] = SRV_Channels::srv_channel(i)->get_output_pwm(); - } - } else { - hal.rcout->read(values, 16); - } + hal.rcout->read(values, 16); + for (uint8_t i=0; i<16; i++) { if (values[i] == 65535) { values[i] = 0; @@ -3216,7 +3201,7 @@ void GCS_MAVLINK::handle_command_ack(const mavlink_message_t &msg) } } -// allow override of RC channel values for HIL or for complete GCS +// allow override of RC channel values for complete GCS // control of switch position and RC PWM values. void GCS_MAVLINK::handle_rc_channels_override(const mavlink_message_t &msg) {