177 lines
		
	
	
		
			4.7 KiB
		
	
	
	
		
			C
		
	
	
		
			Executable File
		
	
	
	
	
			
		
		
	
	
			177 lines
		
	
	
		
			4.7 KiB
		
	
	
	
		
			C
		
	
	
		
			Executable File
		
	
	
	
	
| /*
 | |
|  * Copyright (c) 2006-2023, RT-Thread Development Team
 | |
|  *
 | |
|  * SPDX-License-Identifier: Apache-2.0
 | |
|  *
 | |
|  * Change Logs:
 | |
|  * Date           Author       Notes
 | |
|  * 2021-10-11     zhangsz      the first version
 | |
|  */
 | |
| 
 | |
| #include <rtthread.h>
 | |
| #include <rthw.h>
 | |
| #include <drivers/lptimer.h>
 | |
| 
 | |
| static rt_list_t rt_soft_lptimer_list = RT_LIST_OBJECT_INIT(rt_soft_lptimer_list);
 | |
| 
 | |
| /* lptimer init */
 | |
| void rt_lptimer_init(rt_lptimer_t  timer,
 | |
|                    const char *name,
 | |
|                    void (*timeout)(void *parameter),
 | |
|                    void       *parameter,
 | |
|                    rt_tick_t   time,
 | |
|                    rt_uint8_t  flag)
 | |
| {
 | |
|     rt_timer_init(&timer->timer, name, timeout, parameter, time, flag);
 | |
|     rt_list_init(&timer->list);
 | |
| }
 | |
| 
 | |
| /* lptimer detach */
 | |
| rt_err_t rt_lptimer_detach(rt_lptimer_t timer)
 | |
| {
 | |
|     rt_base_t level;
 | |
|     rt_err_t ret = RT_EOK;
 | |
|     RT_ASSERT(timer != RT_NULL);
 | |
| 
 | |
|     /* disable interrupt */
 | |
|     level = rt_hw_interrupt_disable();
 | |
| 
 | |
|     ret = rt_timer_detach(&timer->timer);
 | |
|     rt_list_remove(&timer->list);
 | |
| 
 | |
|     /* enable interrupt */
 | |
|     rt_hw_interrupt_enable(level);
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| /* lptimer start */
 | |
| rt_err_t rt_lptimer_start(rt_lptimer_t timer)
 | |
| {
 | |
|     rt_base_t level;
 | |
| 
 | |
|     RT_ASSERT(timer != RT_NULL);
 | |
| 
 | |
|     /* disable interrupt */
 | |
|     level = rt_hw_interrupt_disable();
 | |
|     rt_list_remove(&timer->list); /* remove first */
 | |
|     if (rt_timer_start(&timer->timer) == RT_EOK)
 | |
|     {
 | |
|         /* insert to lptimer list */
 | |
|         rt_list_insert_after(&rt_soft_lptimer_list, &(timer->list));
 | |
|     }
 | |
|     else
 | |
|     {
 | |
|         /* enable interrupt */
 | |
|         rt_hw_interrupt_enable(level);
 | |
|         return -RT_ERROR;
 | |
|     }
 | |
| 
 | |
|     /* enable interrupt */
 | |
|     rt_hw_interrupt_enable(level);
 | |
|     return RT_EOK;
 | |
| }
 | |
| 
 | |
| /* lptimer stop */
 | |
| rt_err_t rt_lptimer_stop(rt_lptimer_t timer)
 | |
| {
 | |
|     rt_base_t level;
 | |
|     RT_ASSERT(timer != RT_NULL);
 | |
| 
 | |
|     /* disable interrupt */
 | |
|     level = rt_hw_interrupt_disable();
 | |
|     rt_list_remove(&timer->list);
 | |
|     if (rt_timer_stop(&timer->timer) == RT_EOK)
 | |
|     {
 | |
|         /* enable interrupt */
 | |
|         rt_hw_interrupt_enable(level);
 | |
|         return RT_EOK;
 | |
|     }
 | |
|     else
 | |
|     {
 | |
|         /* enable interrupt */
 | |
|         rt_hw_interrupt_enable(level);
 | |
|         return -RT_ERROR;
 | |
|     }
 | |
| }
 | |
| 
 | |
| rt_err_t rt_lptimer_control(rt_lptimer_t timer, int cmd, void *arg)
 | |
| {
 | |
|     RT_ASSERT(timer != RT_NULL);
 | |
| 
 | |
|     return rt_timer_control(&timer->timer, cmd, arg);
 | |
| }
 | |
| 
 | |
| /* get the next soft lptimer timeout */
 | |
| rt_tick_t rt_lptimer_next_timeout_tick(void)
 | |
| {
 | |
|     struct rt_lptimer *timer;
 | |
|     rt_base_t level;
 | |
|     rt_tick_t timeout_tick = RT_TICK_MAX;
 | |
|     struct rt_list_node *node = RT_NULL;
 | |
|     rt_tick_t temp_tick = 0;
 | |
|     rt_tick_t min_tick = RT_TICK_MAX;
 | |
|     rt_tick_t cur_tick = rt_tick_get();
 | |
| 
 | |
|     /* disable interrupt */
 | |
|     level = rt_hw_interrupt_disable();
 | |
| 
 | |
|     if (!rt_list_isempty(&rt_soft_lptimer_list))
 | |
|     {
 | |
|         /* find the first active timer's timeout */
 | |
|         rt_list_for_each(node, &rt_soft_lptimer_list)
 | |
|         {
 | |
|             timer = rt_list_entry(node, struct rt_lptimer, list);
 | |
|             if (timer->timer.parent.flag & RT_TIMER_FLAG_ACTIVATED)
 | |
|             {
 | |
|                 temp_tick = timer->timer.timeout_tick - cur_tick;
 | |
| 
 | |
|                 /* find the least timeout_tick */
 | |
|                 if (min_tick > temp_tick)
 | |
|                 {
 | |
|                     min_tick = temp_tick;
 | |
|                     timeout_tick = timer->timer.timeout_tick;
 | |
|                 }
 | |
|             }
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     /* enable interrupt */
 | |
|     rt_hw_interrupt_enable(level);
 | |
| 
 | |
|     return timeout_tick;
 | |
| }
 | |
| 
 | |
| void lptimer_dump(void)
 | |
| {
 | |
|     struct rt_lptimer *timer;
 | |
|     rt_base_t level;
 | |
|     struct rt_list_node *node = RT_NULL;
 | |
| 
 | |
|     /* disable interrupt */
 | |
|     level = rt_hw_interrupt_disable();
 | |
| 
 | |
|     rt_kprintf("| lptimer       | periodic   | timeout    |  flag       |\n");
 | |
|     rt_kprintf("+---------------+------------+------------+-------------+\n");
 | |
| 
 | |
|     if (!rt_list_isempty(&rt_soft_lptimer_list))
 | |
|     {
 | |
|         rt_list_for_each(node, &rt_soft_lptimer_list)
 | |
|         {
 | |
|             timer = rt_list_entry(node, struct rt_lptimer, list);
 | |
|             rt_kprintf("| %-13s | 0x%08x | 0x%08x |",
 | |
|                 timer->timer.parent.name, timer->timer.init_tick,
 | |
|                 timer->timer.timeout_tick);
 | |
|             if (timer->timer.parent.flag & RT_TIMER_FLAG_ACTIVATED)
 | |
|                 rt_kprintf(" activated   |\n");
 | |
|             else
 | |
|                 rt_kprintf(" deactivated |\n");
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     /* enable interrupt */
 | |
|     rt_hw_interrupt_enable(level);
 | |
|     rt_kprintf("+---------------+------------+------------+-------------+\n");
 | |
| }
 | |
| 
 | |
| MSH_CMD_EXPORT(lptimer_dump, soft lptimer dump);
 |