Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-18 06:38:29 -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 Andrew Tridgell
parent 2c22bca1a9
commit d6ba508cb9
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

@ -82,7 +82,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++) { for (uint8_t i = 0; i < ESC_TELEM_MAX_ESCS && i < nfreqs; i++) {
float rpm; float rpm;
if (get_rpm(i, 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;
} }
} }