timer.c 2.7 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192
  1. #include "timer.h"
  2. #include <common/kprint.h>
  3. #include <exception/softirq.h>
  4. #include <mm/slab.h>
  5. #include <driver/timers/HPET/HPET.h>
  6. #include <process/process.h>
  7. struct timer_func_list_t timer_func_head;
  8. // 定时器循环阈值,每次最大执行10个定时器任务
  9. #define TIMER_RUN_CYCLE_THRESHOLD 10
  10. void test_timer()
  11. {
  12. printk_color(ORANGE, BLACK, "(test_timer)");
  13. }
  14. void timer_init()
  15. {
  16. timer_jiffies = 0;
  17. timer_func_init(&timer_func_head, NULL, NULL, -1UL);
  18. register_softirq(TIMER_SIRQ, &do_timer_softirq, NULL);
  19. struct timer_func_list_t *tmp = (struct timer_func_list_t *)kmalloc(sizeof(struct timer_func_list_t), 0);
  20. timer_func_init(tmp, &test_timer, NULL, 5);
  21. timer_func_add(tmp);
  22. kdebug("timer func initialized.");
  23. }
  24. void do_timer_softirq(void *data)
  25. {
  26. struct timer_func_list_t *tmp = container_of(list_next(&timer_func_head.list), struct timer_func_list_t, list);
  27. int cycle_count = 0;
  28. while ((!list_empty(&timer_func_head.list)) && (tmp->expire_jiffies <= timer_jiffies))
  29. {
  30. timer_func_del(tmp);
  31. tmp->func(tmp->data);
  32. kfree(tmp);
  33. ++cycle_count;
  34. // 当前定时器达到阈值
  35. if(cycle_count == TIMER_RUN_CYCLE_THRESHOLD)
  36. break;
  37. tmp = container_of(list_next(&timer_func_head.list), struct timer_func_list_t, list);
  38. }
  39. }
  40. /**
  41. * @brief 初始化定时功能
  42. *
  43. * @param timer_func 队列结构体
  44. * @param func 定时功能处理函数
  45. * @param data 传输的数据
  46. * @param expire_ms 定时时长(单位:ms)
  47. */
  48. void timer_func_init(struct timer_func_list_t *timer_func, void (*func)(void *data), void *data, uint64_t expire_ms)
  49. {
  50. list_init(&timer_func->list);
  51. timer_func->func = func;
  52. timer_func->data = data,
  53. // timer_func->expire_jiffies = timer_jiffies + expire_ms / 5 + expire_ms % HPET0_INTERVAL ? 1 : 0; // 设置过期的时间片
  54. timer_func->expire_jiffies = cal_next_n_ms_jiffies(expire_ms); // 设置过期的时间片
  55. }
  56. /**
  57. * @brief 将定时功能添加到列表中
  58. *
  59. * @param timer_func 待添加的定时功能
  60. */
  61. void timer_func_add(struct timer_func_list_t *timer_func)
  62. {
  63. struct timer_func_list_t *tmp = container_of(list_next(&timer_func_head.list), struct timer_func_list_t, list);
  64. if (list_empty(&timer_func_head.list) == false)
  65. while (tmp->expire_jiffies < timer_func->expire_jiffies)
  66. tmp = container_of(list_next(&tmp->list), struct timer_func_list_t, list);
  67. list_add(&tmp->list, &(timer_func->list));
  68. }
  69. /**
  70. * @brief 将定时功能从列表中删除
  71. *
  72. * @param timer_func
  73. */
  74. void timer_func_del(struct timer_func_list_t *timer_func)
  75. {
  76. list_del(&timer_func->list);
  77. }