mavlink: add simple incoming message stats to status

This commit is contained in:
Daniel Agar
2021-09-27 09:48:00 -04:00
parent feff564882
commit 333f539900
3 changed files with 133 additions and 18 deletions
+7
View File
@@ -2883,6 +2883,10 @@ Mavlink::start(int argc, char *argv[])
void
Mavlink::display_status()
{
#if !defined(CONSTRAINED_FLASH)
_receiver.enable_message_statistics();
#endif // !CONSTRAINED_FLASH
if (_tstatus.heartbeat_type_gcs) {
printf("\tGCS heartbeat valid\n");
}
@@ -2922,7 +2926,10 @@ Mavlink::display_status()
printf("\t tx rate max: %i B/s\n", _datarate);
printf("\t rx: %.1f B/s\n", (double)_tstatus.rx_rate_avg);
printf("\t rx loss: %.1f%%\n", (double)_tstatus.rx_message_lost_rate);
#if !defined(CONSTRAINED_FLASH)
_receiver.print_detailed_rx_stats();
#endif // !CONSTRAINED_FLASH
if (_mavlink_ulog) {
printf("\tULog rate: %.1f%% of max %.1f%%\n", (double)_mavlink_ulog->current_data_rate() * 100.,