diff --git a/targets/TARGET_STM/us_ticker_32b.c b/targets/TARGET_STM/us_ticker_32b.c index 90ce35aad1..f00705234a 100644 --- a/targets/TARGET_STM/us_ticker_32b.c +++ b/targets/TARGET_STM/us_ticker_32b.c @@ -44,14 +44,16 @@ uint32_t us_ticker_read() void us_ticker_set_interrupt(timestamp_t timestamp) { TimMasterHandle.Instance = TIM_MST; + // disable IT while we are handling the correct timestamp + __HAL_TIM_DISABLE_IT(&TimMasterHandle, TIM_IT_CC1); // Set new output compare value __HAL_TIM_SET_COMPARE(&TimMasterHandle, TIM_CHANNEL_1, (uint32_t)timestamp); - // Enable IT - __HAL_TIM_ENABLE_IT(&TimMasterHandle, TIM_IT_CC1); // Check if timestamp has already passed, and if so, set the event immediately if ((int32_t)(timestamp - TIM_MST->CNT) <= 0) { LL_TIM_GenerateEvent_CC1(TimMasterHandle.Instance); } + // Enable IT + __HAL_TIM_ENABLE_IT(&TimMasterHandle, TIM_IT_CC1); } void us_ticker_disable_interrupt(void)