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

AP_ESC_Telem: keep RPM updates in the correct order

Browse Source
This commit is contained in:
Andy Piper 2022-08-06 21:30:56 +01:00 committed by Randy Mackay
parent 40f8424ab6
commit 7d5162181f
1 changed files with 4 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
libraries/AP_ESC_Telem/AP_ESC_Telem.cpp
View File

@ -67,7 +67,10 @@ uint8_t AP_ESC_Telem::get_motor_frequencies_hz(uint8_t nfreqs, float* freqs) con
for (uint8_t i = 0; i < ESC_TELEM_MAX_ESCS && i < nfreqs; i++) {
float rpm;
if (get_rpm(i, rpm)) {
freqs[valid_escs++] = rpm * (1.0f / 60.0f);
freqs[i] = rpm * (1.0f / 60.0f);
valid_escs++;
} else {
freqs[i] = 0.0f;
}
}