123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320 |
- /*
- * Copyright (c) 2006-2024 RT-Thread Development Team
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Change Logs:
- * Date Author Notes
- * 2019-05-06 Zero-Free first version
- * 2024-07-04 wdfk-prog lptimer is register with hwtimer, only supports pm calls,the timer function is not supported
- */
- #include <board.h>
- #include <drv_lptim.h>
- #include <rtdevice.h>
- #include "drv_config.h"
- /*#define DRV_DEBUG*/
- #define LOG_TAG "drv.lptim"
- #include <drv_log.h>
- #ifdef BSP_USING_LPTIM
- #define LPTIM_REG_MAX_VALUE (0xFFFF)
- enum
- {
- #ifdef BSP_USING_LPTIM1
- LPTIM1_INDEX,
- #endif
- #ifdef BSP_USING_LPTIM2
- LPTIM2_INDEX,
- #endif
- #ifdef BSP_USING_LPTIM3
- LPTIM3_INDEX,
- #endif
- };
- struct stm32_hw_lptimer
- {
- rt_hwtimer_t time_device;
- LPTIM_HandleTypeDef tim_handle;
- IRQn_Type tim_irqn;
- char *name;
- };
- static struct stm32_hw_lptimer stm32_hw_lptimer_obj[] =
- {
- #ifdef BSP_USING_LPTIM1
- LPTIM1_CONFIG,
- #endif
- #ifdef BSP_USING_LPTIM2
- LPTIM2_CONFIG,
- #endif
- #ifdef BSP_USING_LPTIM3
- LPTIM3_CONFIG,
- #endif
- };
- static const struct rt_hwtimer_info _info = LPTIM_DEV_INFO_CONFIG;
- static void timer_init(struct rt_hwtimer_device *timer, rt_uint32_t state)
- {
- if(timer == RT_NULL)
- {
- LOG_E("init timer is NULL");
- return;
- }
- if (state)
- {
- struct stm32_hw_lptimer *tim_device = rt_container_of(timer, struct stm32_hw_lptimer, time_device);
- LPTIM_HandleTypeDef *tim = (LPTIM_HandleTypeDef *)timer->parent.user_data;
- if(tim_device == RT_NULL)
- {
- LOG_E("start tim_device is NULL");
- return;
- }
- if(tim == RT_NULL)
- {
- LOG_E("start %s LPTIM_Handle is NULL", tim_device->name);
- return;
- }
- RCC_OscInitTypeDef RCC_OscInitStruct = {0};
- RCC_PeriphCLKInitTypeDef RCC_PeriphCLKInitStruct = {0};
- /* Enable LSI clock */
- RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_LSI;
- RCC_OscInitStruct.LSIState = RCC_LSI_ON;
- RCC_OscInitStruct.PLL.PLLState = RCC_PLL_NONE;
- HAL_RCC_OscConfig(&RCC_OscInitStruct);
- /* Select the LSI clock as LPTIM peripheral clock */
- RCC_PeriphCLKInitStruct.PeriphClockSelection = RCC_PERIPHCLK_LPTIM1;
- RCC_PeriphCLKInitStruct.Lptim1ClockSelection = RCC_LPTIM1CLKSOURCE_LSI;
- HAL_RCCEx_PeriphCLKConfig(&RCC_PeriphCLKInitStruct);
- tim->Init.Clock.Source = LPTIM_CLOCKSOURCE_APBCLOCK_LPOSC;
- tim->Init.Clock.Prescaler = LPTIM_PRESCALER_DIV32;
- tim->Init.Trigger.Source = LPTIM_TRIGSOURCE_SOFTWARE;
- tim->Init.OutputPolarity = LPTIM_OUTPUTPOLARITY_HIGH;
- tim->Init.UpdateMode = LPTIM_UPDATE_IMMEDIATE;
- tim->Init.CounterSource = LPTIM_COUNTERSOURCE_INTERNAL;
- HAL_StatusTypeDef ret = HAL_LPTIM_Init(tim);
- if (ret != HAL_OK)
- {
- LOG_E("%s init failed %d", tim_device->name, ret);
- }
- else
- {
- NVIC_ClearPendingIRQ(LPTIM1_IRQn);
- NVIC_SetPriority(LPTIM1_IRQn, 0);
- NVIC_EnableIRQ(LPTIM1_IRQn);
- LOG_D("%s init success", tim_device->name);
- }
- }
- }
- static rt_err_t timer_start(rt_hwtimer_t *timer, rt_uint32_t t, rt_hwtimer_mode_t opmode)
- {
- if(timer == RT_NULL)
- {
- LOG_E("start timer is NULL");
- return -RT_EINVAL;
- }
- struct stm32_hw_lptimer *tim_device = rt_container_of(timer, struct stm32_hw_lptimer, time_device);
- LPTIM_HandleTypeDef *tim = (LPTIM_HandleTypeDef *)timer->parent.user_data;
- if(tim_device == RT_NULL)
- {
- LOG_E("start tim_device is NULL");
- return -RT_EINVAL;
- }
- if(tim == RT_NULL)
- {
- LOG_E("start %s LPTIM_Handle is NULL", tim_device->name);
- return -RT_EINVAL;
- }
- HAL_StatusTypeDef ret = HAL_LPTIM_TimeOut_Start_IT(tim, LPTIM_REG_MAX_VALUE, t);
- if(ret != HAL_OK)
- {
- LOG_E("start %s failed %d", tim_device->name, ret);
- return -RT_ERROR;
- }
- else
- {
- LOG_D("start %s success", tim_device->name);
- return RT_EOK;
- }
- }
- static void timer_stop(rt_hwtimer_t *timer)
- {
- if(timer == RT_NULL)
- {
- LOG_E("stop timer is NULL");
- return;
- }
- struct stm32_hw_lptimer *tim_device = rt_container_of(timer, struct stm32_hw_lptimer, time_device);
- LPTIM_HandleTypeDef *tim = (LPTIM_HandleTypeDef *)timer->parent.user_data;
- if(tim_device == RT_NULL)
- {
- LOG_E("stop tim_device is NULL");
- return;
- }
- if(tim == RT_NULL)
- {
- LOG_E("stop %s LPTIM_Handle is NULL", tim_device->name);
- return;
- }
- HAL_StatusTypeDef ret = HAL_LPTIM_TimeOut_Stop_IT(tim);
- if(ret != HAL_OK)
- {
- LOG_E("stop %s failed %d", tim_device->name, ret);
- }
- else
- {
- LOG_D("stop %s success", tim_device->name);
- }
- }
- static rt_uint32_t timer_get_freq(LPTIM_HandleTypeDef *tim)
- {
- /*No calculation is performed. The default initial configuration is 1000hz*/
- return 1000;
- }
- static rt_uint32_t timer_counter_get(rt_hwtimer_t *timer)
- {
- LPTIM_HandleTypeDef *tim = (LPTIM_HandleTypeDef *)timer->parent.user_data;
- return HAL_LPTIM_ReadCounter(tim);
- }
- static rt_err_t timer_ctrl(rt_hwtimer_t *timer, rt_uint32_t cmd, void *arg)
- {
- if(timer == RT_NULL)
- {
- LOG_E("start timer is NULL");
- return -RT_EINVAL;
- }
- struct stm32_hw_lptimer *tim_device = rt_container_of(timer, struct stm32_hw_lptimer, time_device);
- LPTIM_HandleTypeDef *tim = (LPTIM_HandleTypeDef *)timer->parent.user_data;
- if(tim_device == RT_NULL)
- {
- LOG_E("start tim_device is NULL");
- return -RT_EINVAL;
- }
- if(tim == RT_NULL)
- {
- LOG_E("start %s LPTIM_Handle is NULL", tim_device->name);
- return -RT_EINVAL;
- }
- rt_err_t result = RT_EOK;
- switch (cmd)
- {
- case DRV_HW_LPTIMER_CTRL_GET_TICK_MAX:
- {
- *(rt_uint32_t *)arg = LPTIM_REG_MAX_VALUE;
- break;
- }
- case DRV_HW_LPTIMER_CTRL_GET_FREQ:
- {
- *(rt_uint32_t *)arg = timer_get_freq(tim);
- break;
- }
- case DRV_HW_LPTIMER_CTRL_START:
- {
- timer_start(timer, *(rt_uint32_t *)arg, HWTIMER_MODE_ONESHOT);
- break;
- }
- case DRV_HW_LPTIMER_CTRL_GET_COUNT:
- {
- *(rt_uint32_t *)arg = timer_counter_get(timer);
- break;
- }
- default:
- {
- result = -RT_ENOSYS;
- }
- break;
- }
- return result;
- }
- #ifdef BSP_USING_LPTIM1
- void LPTIM1_IRQHandler(void)
- {
- rt_interrupt_enter();
- HAL_LPTIM_IRQHandler(&stm32_hw_lptimer_obj[LPTIM1_INDEX].tim_handle);
- rt_interrupt_leave();
- }
- #endif
- #ifdef BSP_USING_LPTIM2
- void LPTIM2_IRQHandler(void)
- {
- rt_interrupt_enter();
- HAL_LPTIM_IRQHandler(&stm32_hw_lptimer_obj[LPTIM2_INDEX].tim_handle);
- rt_interrupt_leave();
- }
- #endif
- #ifdef BSP_USING_LPTIM3
- void LPTIM3_IRQHandler(void)
- {
- rt_interrupt_enter();
- HAL_LPTIM_IRQHandler(&stm32_hw_lptimer_obj[LPTIM3_INDEX].tim_handle);
- rt_interrupt_leave();
- }
- #endif
- static const struct rt_hwtimer_ops _ops =
- {
- .init = timer_init,
- .start = timer_start,
- .stop = timer_stop,
- .count_get = timer_counter_get,
- .control = timer_ctrl,
- };
- /**
- * This function initialize the lptim
- */
- static int stm32_hw_lptim_init(void)
- {
- int i = 0;
- int result = RT_EOK;
- for (i = 0; i < sizeof(stm32_hw_lptimer_obj) / sizeof(stm32_hw_lptimer_obj[0]); i++)
- {
- stm32_hw_lptimer_obj[i].time_device.info = &_info;
- stm32_hw_lptimer_obj[i].time_device.ops = &_ops;
- if (rt_device_hwtimer_register(&stm32_hw_lptimer_obj[i].time_device, stm32_hw_lptimer_obj[i].name, &stm32_hw_lptimer_obj[i].tim_handle) == RT_EOK)
- {
- LOG_D("%s register success", stm32_hw_lptimer_obj[i].name);
- }
- else
- {
- LOG_E("%s register failed", stm32_hw_lptimer_obj[i].name);
- result = -RT_ERROR;
- }
- }
- return result;
- }
- INIT_BOARD_EXPORT(stm32_hw_lptim_init);
- #endif /* BSP_USING_LPTIM */
|