diff --git a/platforms/nuttx/src/px4/stm/stm32_common/dshot/dshot.c b/platforms/nuttx/src/px4/stm/stm32_common/dshot/dshot.c index 22e9fda161..48e12dd8f7 100644 --- a/platforms/nuttx/src/px4/stm/stm32_common/dshot/dshot.c +++ b/platforms/nuttx/src/px4/stm/stm32_common/dshot/dshot.c @@ -553,7 +553,7 @@ void process_capture_results(uint8_t timer_index, uint8_t channel_index) } else { // Convert the period to eRPM - _erpms[output_channel] = (1000000 * 60) / period; + _erpms[output_channel] = (1000000 * 60 / 100 + period / 2) / period; } // We set it ready anyway, not to hold up other channels when used in round robin.