AP_BLHeli: fix eRPM conversion

This commit is contained in:
vierfuffzig 2019-10-28 09:30:54 +01:00 committed by Randy Mackay
parent ec01ae4ce7
commit 7fd3364304

View File

@ -1342,7 +1342,7 @@ void AP_BLHeli::read_telemetry_packet(void)
td.voltage = (buf[1]<<8) | buf[2];
td.current = (buf[3]<<8) | buf[4];
td.consumption = (buf[5]<<8) | buf[6];
td.rpm = ((buf[7]<<8) | buf[8]) * motor_poles;
td.rpm = ((buf[7]<<8) | buf[8]) * 100 * 2 / motor_poles;
td.timestamp_ms = AP_HAL::millis();
last_telem[last_telem_esc] = td;