/* ChibiOS - Copyright (C) 2006..2018 Giovanni Di Sirio Licensed under the Apache License, Version 2.0 (the "License"); you may not use this file except in compliance with the License. You may obtain a copy of the License at http://www.apache.org/licenses/LICENSE-2.0 Unless required by applicable law or agreed to in writing, software distributed under the License is distributed on an "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the License for the specific language governing permissions and limitations under the License. */ /** * @file SYSTICKv1/hal_st_lld.c * @brief ST Driver subsystem low level driver code. * * @addtogroup ST * @{ */ #include "hal.h" #if (OSAL_ST_MODE != OSAL_ST_MODE_NONE) || defined(__DOXYGEN__) /*===========================================================================*/ /* Driver local definitions. */ /*===========================================================================*/ #if OSAL_ST_MODE == OSAL_ST_MODE_FREERUNNING #if (OSAL_ST_RESOLUTION != 16) && (OSAL_ST_RESOLUTION != 32) #error "unsupported ST resolution" #endif #if (OSAL_ST_RESOLUTION == 32) #define ST_ARR_INIT 0xFFFFFFFFU #else #define ST_ARR_INIT 0x0000FFFFU #endif #if STM32_ST_USE_TIMER == 1 #if !STM32_HAS_TIM1 #error "TIM1 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM1_IS_32BITS #error "TIM1 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM1_CC_HANDLER #define ST_NUMBER STM32_TIM1_CC_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK1 #define ST_ENABLE_CLOCK() rccEnableTIM1(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM1_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WBXX) || defined(STM32WLXX) #define ST_ENABLE_STOP() DBGMCU->APB1FZR1 |= DBGMCU_APB1FZR1_DBG_TIM1_STOP #elif defined(STM32G0XX) #define ST_ENABLE_STOP() DBG->APBFZ1 |= DBG_APB_FZ1_DBG_TIM1_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB1LFZ1 |= DBGMCU_APB1LFZ1_DBG_TIM1 #else #define ST_ENABLE_STOP() DBGMCU->APB1FZ |= DBGMCU_APB1_FZ_DBG_TIM1_STOP #endif #elif STM32_ST_USE_TIMER == 2 #if !STM32_HAS_TIM2 #error "TIM2 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM2_IS_32BITS #error "TIM2 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM2_HANDLER #define ST_NUMBER STM32_TIM2_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK1 #define ST_ENABLE_CLOCK() rccEnableTIM2(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM2_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WBXX) || defined(STM32WLXX) #define ST_ENABLE_STOP() DBGMCU->APB1FZR1 |= DBGMCU_APB1FZR1_DBG_TIM2_STOP #elif defined(STM32G0XX) #define ST_ENABLE_STOP() DBG->APBFZ1 |= DBG_APB_FZ1_DBG_TIM2_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB1LFZ1 |= DBGMCU_APB1LFZ1_DBG_TIM2 #else #define ST_ENABLE_STOP() DBGMCU->APB1FZ |= DBGMCU_APB1_FZ_DBG_TIM2_STOP #endif #elif STM32_ST_USE_TIMER == 3 #if !STM32_HAS_TIM3 #error "TIM3 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM3_IS_32BITS #error "TIM3 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM3_HANDLER #define ST_NUMBER STM32_TIM3_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK1 #define ST_ENABLE_CLOCK() rccEnableTIM3(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM3_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WBXX) #define ST_ENABLE_STOP() DBGMCU->APB1FZR1 |= DBGMCU_APB1FZR1_DBG_TIM3_STOP #elif defined(STM32G0XX) #define ST_ENABLE_STOP() DBG->APBFZ1 |= DBG_APB_FZ1_DBG_TIM3_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB1LFZ1 |= DBGMCU_APB1LFZ1_DBG_TIM3 #else #define ST_ENABLE_STOP() DBGMCU->APB1FZ |= DBGMCU_APB1_FZ_DBG_TIM3_STOP #endif #elif STM32_ST_USE_TIMER == 4 #if !STM32_HAS_TIM4 #error "TIM4 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM4_IS_32BITS #error "TIM4 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM4_HANDLER #define ST_NUMBER STM32_TIM4_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK1 #define ST_ENABLE_CLOCK() rccEnableTIM4(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM4_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WBXX) #define ST_ENABLE_STOP() DBGMCU->APB1FZR1 |= DBGMCU_APB1FZR1_DBG_TIM4_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB1LFZ1 |= DBGMCU_APB1LFZ1_DBG_TIM4 #else #define ST_ENABLE_STOP() DBGMCU->APB1FZ |= DBGMCU_APB1_FZ_DBG_TIM4_STOP #endif #elif STM32_ST_USE_TIMER == 5 #if !STM32_HAS_TIM5 #error "TIM5 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM5_IS_32BITS #error "TIM5 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM5_HANDLER #define ST_NUMBER STM32_TIM5_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK1 #define ST_ENABLE_CLOCK() rccEnableTIM5(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM5_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WBXX) #define ST_ENABLE_STOP() DBGMCU->APB1FZR1 |= DBGMCU_APB1FZR1_DBG_TIM5_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB1LFZ1 |= DBGMCU_APB1LFZ1_DBG_TIM5 #else #define ST_ENABLE_STOP() DBGMCU->APB1FZ |= DBGMCU_APB1_FZ_DBG_TIM5_STOP #endif #elif STM32_ST_USE_TIMER == 8 #if !STM32_HAS_TIM8 #error "TIM8 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM2_IS_32BITS #error "TIM8 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM8_CC_HANDLER #define ST_NUMBER STM32_TIM8_CC_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK1 #define ST_ENABLE_CLOCK() rccEnableTIM8(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM8_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WBXX) || defined(STM32WLXX) #define ST_ENABLE_STOP() DBGMCU->APB1FZR1 |= DBGMCU_APB1FZR1_DBG_TIM8_STOP #elif defined(STM32G0XX) #define ST_ENABLE_STOP() DBG->APBFZ1 |= DBG_APB_FZ1_DBG_TIM8_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB1LFZ1 |= DBGMCU_APB1LFZ1_DBG_TIM8 #else #define ST_ENABLE_STOP() DBGMCU->APB1FZ |= DBGMCU_APB1_FZ_DBG_TIM8_STOP #endif #elif STM32_ST_USE_TIMER == 9 #if !STM32_HAS_TIM9 #error "TIM9 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM9_IS_32BITS #error "TIM9 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM9_HANDLER #define ST_NUMBER STM32_TIM9_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK2 #define ST_ENABLE_CLOCK() rccEnableTIM9(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM9_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WBXX) #define ST_ENABLE_STOP() DBGMCU->APB2FZR1 |= DBGMCU_APB2FZR1_DBG_TIM9_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB2LFZ1 |= DBGMCU_APB2LFZ1_DBG_TIM9 #else #define ST_ENABLE_STOP() DBGMCU->APB2FZ |= DBGMCU_APB2_FZ_DBG_TIM9_STOP #endif #elif STM32_ST_USE_TIMER == 10 #if !STM32_HAS_TIM10 #error "TIM10 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM10_IS_32BITS #error "TIM10 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM10_HANDLER #define ST_NUMBER STM32_TIM10_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK2 #define ST_ENABLE_CLOCK() rccEnableTIM10(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM10_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WBXX) #define ST_ENABLE_STOP() DBGMCU->APB2FZR1 |= DBGMCU_APB2FZR1_DBG_TIM10_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB2LFZ1 |= DBGMCU_APB2LFZ1_DBG_TIM10 #else #define ST_ENABLE_STOP() DBGMCU->APB2FZ |= DBGMCU_APB2_FZ_DBG_TIM10_STOP #endif #elif STM32_ST_USE_TIMER == 11 #if !STM32_HAS_TIM11 #error "TIM11 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM11_IS_32BITS #error "TIM11 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM11_HANDLER #define ST_NUMBER STM32_TIM11_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK2 #define ST_ENABLE_CLOCK() rccEnableTIM11(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM11_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WBXX) #define ST_ENABLE_STOP() DBGMCU->APB2FZR1 |= DBGMCU_APB2FZR1_DBG_TIM11_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB2LFZ1 |= DBGMCU_APB2LFZ1_DBG_TIM11 #else #define ST_ENABLE_STOP() DBGMCU->APB2FZ |= DBGMCU_APB2_FZ_DBG_TIM11_STOP #endif #elif STM32_ST_USE_TIMER == 12 #if !STM32_HAS_TIM12 #error "TIM12 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM12_IS_32BITS #error "TIM12 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM12_HANDLER #define ST_NUMBER STM32_TIM12_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK1 #define ST_ENABLE_CLOCK() rccEnableTIM12(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM12_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WBXX) #define ST_ENABLE_STOP() DBGMCU->APB1FZR1 |= DBGMCU_APB1FZR1_DBG_TIM12_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB1LFZ1 |= DBGMCU_APB1LFZ1_DBG_TIM12 #else #define ST_ENABLE_STOP() DBGMCU->APB1FZ |= DBGMCU_APB1_FZ_DBG_TIM12_STOP #endif #elif STM32_ST_USE_TIMER == 13 #if !STM32_HAS_TIM13 #error "TIM13 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM13_IS_32BITS #error "TIM13 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM13_HANDLER #define ST_NUMBER STM32_TIM13_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK1 #define ST_ENABLE_CLOCK() rccEnableTIM13(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM13_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WBXX) #define ST_ENABLE_STOP() DBGMCU->APB1FZR1 |= DBGMCU_APB1FZR1_DBG_TIM13_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB1LFZ1 |= DBGMCU_APB1LFZ1_DBG_TIM13 #else #define ST_ENABLE_STOP() DBGMCU->APB1FZ |= DBGMCU_APB1_FZ_DBG_TIM13_STOP #endif #elif STM32_ST_USE_TIMER == 14 #if !STM32_HAS_TIM14 #error "TIM14 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM14_IS_32BITS #error "TIM14 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM14_HANDLER #define ST_NUMBER STM32_TIM14_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK1 #define ST_ENABLE_CLOCK() rccEnableTIM14(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM14_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WBXX) #define ST_ENABLE_STOP() DBGMCU->APB1FZR1 |= DBGMCU_APB1FZR1_DBG_TIM14_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB1LFZ1 |= DBGMCU_APB1LFZ1_DBG_TIM14 #else #define ST_ENABLE_STOP() DBGMCU->APB1FZ |= DBGMCU_APB1_FZ_DBG_TIM14_STOP #endif #elif STM32_ST_USE_TIMER == 15 #if !STM32_HAS_TIM15 #error "TIM15 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM15_IS_32BITS #error "TIM15 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM15_HANDLER #define ST_NUMBER STM32_TIM15_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK2 #define ST_ENABLE_CLOCK() rccEnableTIM15(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM15_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WBXX) #define ST_ENABLE_STOP() DBGMCU->APB2FZ |= DBGMCU_APB2FZ_DBG_TIM15_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB2FZ1 |= DBGMCU_APB2FZ1_DBG_TIM15 #else #define ST_ENABLE_STOP() DBGMCU->APB2FZ |= DBGMCU_APB2_FZ_DBG_TIM15_STOP #endif #elif STM32_ST_USE_TIMER == 16 #if !STM32_HAS_TIM16 #error "TIM16 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM16_IS_32BITS #error "TIM16 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM16_HANDLER #define ST_NUMBER STM32_TIM16_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK2 #define ST_ENABLE_CLOCK() rccEnableTIM16(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM16_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WLXX) #define ST_ENABLE_STOP() DBGMCU->APB2FZ |= DBGMCU_APB2FZ_DBG_TIM16_STOP #elif defined(STM32WBXX) #define ST_ENABLE_STOP() DBGMCU->APB2FZR |= DBGMCU_APB2FZR_DBG_TIM16_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB2FZ1 |= DBGMCU_APB2FZ1_DBG_TIM16 #else #define ST_ENABLE_STOP() DBGMCU->APB2FZ |= DBGMCU_APB2_FZ_DBG_TIM16_STOP #endif #elif STM32_ST_USE_TIMER == 17 #if !STM32_HAS_TIM17 #error "TIM17 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM17_IS_32BITS #error "TIM17 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM17_HANDLER #define ST_NUMBER STM32_TIM17_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK2 #define ST_ENABLE_CLOCK() rccEnableTIM17(true) #if defined(STM32F1XX) #define ST_ENABLE_STOP() DBGMCU->CR |= DBGMCU_CR_DBG_TIM17_STOP #elif defined(STM32L4XX) || defined(STM32L4XXP) || defined(STM32G4XX) || \ defined(STM32L5XX) || defined(STM32WLXX) #define ST_ENABLE_STOP() DBGMCU->APB2FZ |= DBGMCU_APB2FZ_DBG_TIM17_STOP #elif defined(STM32WBXX) #define ST_ENABLE_STOP() DBGMCU->APB2FZR |= DBGMCU_APB2FZR_DBG_TIM17_STOP #elif defined(STM32H7XX) #define ST_ENABLE_STOP() DBGMCU->APB2FZ1 |= DBGMCU_APB2FZ1_DBG_TIM17 #else #define ST_ENABLE_STOP() DBGMCU->APB2FZ |= DBGMCU_APB2_FZ_DBG_TIM17_STOP #endif #elif STM32_ST_USE_TIMER == 21 #if !STM32_HAS_TIM21 #error "TIM21 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM21_IS_32BITS #error "TIM21 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM21_HANDLER #define ST_NUMBER STM32_TIM21_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK2 #define ST_ENABLE_CLOCK() rccEnableTIM21(true) #define ST_ENABLE_STOP() DBGMCU->APB2FZ |= DBGMCU_APB2_FZ_DBG_TIM21_STOP #elif STM32_ST_USE_TIMER == 22 #if !STM32_HAS_TIM22 #error "TIM22 not present in the selected device" #endif #if (OSAL_ST_RESOLUTION == 32) && !STM32_TIM22_IS_32BITS #error "TIM21 is not a 32bits timer" #endif #define ST_HANDLER STM32_TIM22_HANDLER #define ST_NUMBER STM32_TIM22_NUMBER #define ST_CLOCK_SRC STM32_TIMCLK2 #define ST_ENABLE_CLOCK() rccEnableTIM22(true) #define ST_ENABLE_STOP() DBGMCU->APB2FZ |= DBGMCU_APB2_FZ_DBG_TIM21_STOP #else #error "STM32_ST_USE_TIMER specifies an unsupported timer" #endif #if 0 /* TODO remove */ #if ST_CLOCK_SRC % OSAL_ST_FREQUENCY != 0 #error "the selected ST frequency is not obtainable because integer rounding" #endif #if (ST_CLOCK_SRC / OSAL_ST_FREQUENCY) - 1 > 0xFFFF #error "the selected ST frequency is not obtainable because TIM timer prescaler limits" #endif #endif #endif /* OSAL_ST_MODE == OSAL_ST_MODE_FREERUNNING */ #if OSAL_ST_MODE == OSAL_ST_MODE_PERIODIC #define ST_HANDLER SysTick_Handler #if defined(STM32_CORE_CK) #define SYSTICK_CK STM32_CORE_CK #else #define SYSTICK_CK STM32_HCLK #endif #if SYSTICK_CK % OSAL_ST_FREQUENCY != 0 #error "the selected ST frequency is not obtainable because integer rounding" #endif #if (SYSTICK_CK / OSAL_ST_FREQUENCY) - 1 > 0xFFFFFF #error "the selected ST frequency is not obtainable because SysTick timer counter limits" #endif #endif /* OSAL_ST_MODE == OSAL_ST_MODE_PERIODIC */ /*===========================================================================*/ /* Driver exported variables. */ /*===========================================================================*/ /*===========================================================================*/ /* Driver local types. */ /*===========================================================================*/ /*===========================================================================*/ /* Driver local variables and types. */ /*===========================================================================*/ /*===========================================================================*/ /* Driver local functions. */ /*===========================================================================*/ /*===========================================================================*/ /* Driver interrupt handlers. */ /*===========================================================================*/ #if !defined(STM32_SYSTICK_SUPPRESS_ISR) /** * @brief Interrupt handler. * * @isr */ OSAL_IRQ_HANDLER(ST_HANDLER) { OSAL_IRQ_PROLOGUE(); st_lld_serve_interrupt(); OSAL_IRQ_EPILOGUE(); } #endif /*===========================================================================*/ /* Driver exported functions. */ /*===========================================================================*/ /** * @brief Low level ST driver initialization. * * @notapi */ void st_lld_init(void) { #if OSAL_ST_MODE == OSAL_ST_MODE_FREERUNNING /* Free running counter mode.*/ osalDbgAssert((ST_CLOCK_SRC % OSAL_ST_FREQUENCY) == 0U, "clock rounding error"); osalDbgAssert(((ST_CLOCK_SRC / OSAL_ST_FREQUENCY) - 1U) < 0x10000, "clock prescaler overflow"); /* Enabling timer clock.*/ ST_ENABLE_CLOCK(); /* Enabling the stop mode during debug for this timer.*/ ST_ENABLE_STOP(); /* Initializing the counter in free running mode.*/ STM32_ST_TIM->PSC = (ST_CLOCK_SRC / OSAL_ST_FREQUENCY) - 1; STM32_ST_TIM->ARR = ST_ARR_INIT; STM32_ST_TIM->CCMR1 = 0; STM32_ST_TIM->CCR[0] = 0; #if ST_LLD_NUM_ALARMS > 1 STM32_ST_TIM->CCR[1] = 0; #endif #if ST_LLD_NUM_ALARMS > 2 STM32_ST_TIM->CCR[2] = 0; #endif #if ST_LLD_NUM_ALARMS > 3 STM32_ST_TIM->CCR[3] = 0; #endif STM32_ST_TIM->DIER = 0; STM32_ST_TIM->CR2 = 0; STM32_ST_TIM->EGR = TIM_EGR_UG; STM32_ST_TIM->CR1 = TIM_CR1_CEN; #if !defined(STM32_SYSTICK_SUPPRESS_ISR) /* IRQ enabled.*/ nvicEnableVector(ST_NUMBER, STM32_ST_IRQ_PRIORITY); #endif #endif /* OSAL_ST_MODE == OSAL_ST_MODE_FREERUNNING */ #if OSAL_ST_MODE == OSAL_ST_MODE_PERIODIC /* Periodic systick mode, the Cortex-Mx internal systick timer is used in this mode.*/ SysTick->LOAD = (SYSTICK_CK / OSAL_ST_FREQUENCY) - 1; SysTick->VAL = 0; SysTick->CTRL = SysTick_CTRL_CLKSOURCE_Msk | SysTick_CTRL_ENABLE_Msk | SysTick_CTRL_TICKINT_Msk; /* IRQ enabled.*/ nvicSetSystemHandlerPriority(HANDLER_SYSTICK, STM32_ST_IRQ_PRIORITY); #endif /* OSAL_ST_MODE == OSAL_ST_MODE_PERIODIC */ } /** * @brief IRQ handling code. */ void st_lld_serve_interrupt(void) { #if OSAL_ST_MODE == OSAL_ST_MODE_FREERUNNING uint32_t sr; stm32_tim_t *timp = STM32_ST_TIM; sr = timp->SR; sr &= timp->DIER & STM32_TIM_DIER_IRQ_MASK; timp->SR = ~sr; if ((sr & TIM_SR_CC1IF) != 0U) #endif { osalSysLockFromISR(); osalOsTimerHandlerI(); osalSysUnlockFromISR(); } #if OSAL_ST_MODE == OSAL_ST_MODE_FREERUNNING #if ST_LLD_NUM_ALARMS > 1 if ((sr & TIM_SR_CC2IF) != 0U) { if (st_callbacks[1] != NULL) { st_callbacks[1](1U); } } #endif #if ST_LLD_NUM_ALARMS > 2 if ((sr & TIM_SR_CC3IF) != 0U) { if (st_callbacks[2] != NULL) { st_callbacks[2](2U); } } #endif #if ST_LLD_NUM_ALARMS > 3 if ((sr & TIM_SR_CC4IF) != 0U) { if (st_callbacks[3] != NULL) { st_callbacks[3](3U); } } #endif #endif } #endif /* OSAL_ST_MODE != OSAL_ST_MODE_NONE */ /** @} */