AP_BLHeli: fix eRPM conversion

This commit is contained in:
vierfuffzig 2019-10-28 09:30:54 +01:00 committed by Andrew Tridgell
parent a4e51f3942
commit c97f785443

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;