Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_ESC_Telem: prevent possible overrun

This commit is contained in:
Pierre Kancir 2021-08-11 00:14:19 +02:00 committed by Peter Barker
parent 7739ddefd0
commit adf86357aa
1 changed files with 10 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
libraries/AP_ESC_Telem/AP_ESC_Telem.cpp
View File

@ -89,9 +89,13 @@ uint8_t AP_ESC_Telem::get_num_active_escs() const {
// get an individual ESC's slewed rpm if available, returns true on success
bool AP_ESC_Telem::get_rpm(uint8_t esc_index, float& rpm) const
{
if (esc_index >= ESC_TELEM_MAX_ESCS) {
return false;
}
const volatile AP_ESC_Telem_Backend::RpmData& rpmdata = _rpm_data[esc_index];
if (esc_index >= ESC_TELEM_MAX_ESCS || is_zero(rpmdata.update_rate_hz)) {
if (is_zero(rpmdata.update_rate_hz)) {
return false;
}
@ -108,12 +112,15 @@ bool AP_ESC_Telem::get_rpm(uint8_t esc_index, float& rpm) const
// get an individual ESC's raw rpm if available, returns true on success
bool AP_ESC_Telem::get_raw_rpm(uint8_t esc_index, float& rpm) const
{
if (esc_index >= ESC_TELEM_MAX_ESCS) {
return false;
}
const volatile AP_ESC_Telem_Backend::RpmData& rpmdata = _rpm_data[esc_index];
const uint32_t now = AP_HAL::micros();
if (esc_index >= ESC_TELEM_MAX_ESCS || now < rpmdata.last_update_us
|| now - rpmdata.last_update_us > ESC_RPM_DATA_TIMEOUT_US) {
if (now < rpmdata.last_update_us || now - rpmdata.last_update_us > ESC_RPM_DATA_TIMEOUT_US) {
return false;
}