Browse Source

AP_RCTelemetry: fix ELRS systems spamming CRSF mode/rate messages

gps-1.3.1
Hwurzburg 4 years ago committed by Andrew Tridgell
parent
commit
ceeabb85a5
  1. 4
      libraries/AP_RCTelemetry/AP_CRSF_Telem.cpp

4
libraries/AP_RCTelemetry/AP_CRSF_Telem.cpp

@ -165,7 +165,9 @@ void AP_CRSF_Telem::process_rf_mode_changes() @@ -165,7 +165,9 @@ void AP_CRSF_Telem::process_rf_mode_changes()
// report a change in RF mode or a chnage of more than 10Hz if we haven't done so in the last 5s
if ((now - _telem_last_report_ms > 5000) &&
(_telem_rf_mode != current_rf_mode || abs(int16_t(_telem_last_avg_rate) - int16_t(_scheduler.avg_packet_rate)) > 25)) {
gcs().send_text(MAV_SEVERITY_INFO, "CRSF: RF mode %d, rate is %dHz", (uint8_t)current_rf_mode, _scheduler.avg_packet_rate);
if (!rc().suppress_crsf_message()) {
gcs().send_text(MAV_SEVERITY_INFO, "CRSF: RF mode %d, rate is %dHz", (uint8_t)current_rf_mode, _scheduler.avg_packet_rate);
}
update_custom_telemetry_rates(current_rf_mode);
_telem_rf_mode = current_rf_mode;
_telem_last_avg_rate = _scheduler.avg_packet_rate;

Loading…
Cancel
Save