diff --git a/libraries/AP_HAL_ChibiOS/Util.cpp b/libraries/AP_HAL_ChibiOS/Util.cpp index 51b98cf3b32..af58bf0a7d8 100644 --- a/libraries/AP_HAL_ChibiOS/Util.cpp +++ b/libraries/AP_HAL_ChibiOS/Util.cpp @@ -253,3 +253,10 @@ bool Util::get_system_id(char buf[40]) buf[39] = 0; return true; } + +bool Util::get_system_id_unformatted(uint8_t buf[], uint8_t &len) +{ + len = MIN(12, len); + memcpy(buf, (const void *)UDID_START, len); + return true; +} diff --git a/libraries/AP_HAL_ChibiOS/Util.h b/libraries/AP_HAL_ChibiOS/Util.h index 8ce16487dcc..068d3a14dd2 100644 --- a/libraries/AP_HAL_ChibiOS/Util.h +++ b/libraries/AP_HAL_ChibiOS/Util.h @@ -44,7 +44,8 @@ public: // get system ID as a string bool get_system_id(char buf[40]) override; - + bool get_system_id_unformatted(uint8_t buf[], uint8_t &len) override; + #ifdef HAL_PWM_ALARM bool toneAlarm_init() override; void toneAlarm_set_buzzer_tone(float frequency, float volume, uint32_t duration_ms) override;