diff --git a/firmware/hw_layer/microsecond_timer.cpp b/firmware/hw_layer/microsecond_timer.cpp index 71d5863a57..15445dac44 100644 --- a/firmware/hw_layer/microsecond_timer.cpp +++ b/firmware/hw_layer/microsecond_timer.cpp @@ -70,8 +70,9 @@ void setHardwareUsTimer(int32_t timeUs) { return; } - if (GPTDEVICE.state == GPT_ONESHOT) + if (GPTDEVICE.state == GPT_ONESHOT) { gptStopTimerI(&GPTDEVICE); + } if (GPTDEVICE.state != GPT_READY) { firmwareError(CUSTOM_ERR_6541, "HW timer state %d", GPTDEVICE.state); return;