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

AP_RCProtocol: add debug for further CRSF messages

Browse Source 
add better frame debug info to CRSF
This commit is contained in:
Andy Piper 2020-10-20 22:41:52 +01:00 committed by Andrew Tridgell
parent dbe5b90398
commit 7f3f135dc5
1 changed files with 12 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

16
libraries/AP_RCProtocol/AP_RCProtocol_CRSF.cpp
View File

@ -80,11 +80,14 @@ static const char* get_frame_type(uint8_t byte)
return "ATTITUDE";
case AP_RCProtocol_CRSF::CRSF_FRAMETYPE_FLIGHT_MODE:
return "FLIGHT_MODE";
case AP_RCProtocol_CRSF::CRSF_FRAMETYPE_PARAM_DEVICE_INFO:
return "DEVICE_INFO";
case AP_RCProtocol_CRSF::CRSF_FRAMETYPE_PARAMETER_READ:
return "PARAM_READ";
case AP_RCProtocol_CRSF::CRSF_FRAMETYPE_PARAMETER_SETTINGS_ENTRY:
return "SETTINGS_ENTRY";
case AP_RCProtocol_CRSF::CRSF_FRAMETYPE_LINK_STATISTICS:
case AP_RCProtocol_CRSF::CRSF_FRAMETYPE_RC_CHANNELS_PACKED:
case AP_RCProtocol_CRSF::CRSF_FRAMETYPE_PARAM_DEVICE_INFO:
case AP_RCProtocol_CRSF::CRSF_FRAMETYPE_PARAMETER_SETTINGS_ENTRY:
case AP_RCProtocol_CRSF::CRSF_FRAMETYPE_PARAMETER_READ:
case AP_RCProtocol_CRSF::CRSF_FRAMETYPE_PARAMETER_WRITE:
return "UNKNOWN";
}
@ -259,7 +262,12 @@ void AP_RCProtocol_CRSF::write_frame(Frame* frame)
#ifdef CRSF_DEBUG
hal.console->printf("CRSF: writing %s:", get_frame_type(frame->type));
for (uint8_t i = 0; i < frame->length + 2; i++) {
hal.console->printf(" 0x%x", ((uint8_t*)frame)[i]);
uint8_t val = ((uint8_t*)frame)[i];
if (val >= 32 && val <= 126) {
hal.console->printf(" 0x%x '%c'", val, (char)val);
} else {
hal.console->printf(" 0x%x", val);
}
}
hal.console->printf("\n");
#endif