idle.c 5.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219
  1. /*
  2. * Copyright (c) 2006-2022, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2006-03-23 Bernard the first version
  9. * 2010-11-10 Bernard add cleanup callback function in thread exit.
  10. * 2012-12-29 Bernard fix compiling warning.
  11. * 2013-12-21 Grissiom let rt_thread_idle_excute loop until there is no
  12. * dead thread.
  13. * 2016-08-09 ArdaFu add method to get the handler of the idle thread.
  14. * 2018-02-07 Bernard lock scheduler to protect tid->cleanup.
  15. * 2018-07-14 armink add idle hook list
  16. * 2018-11-22 Jesven add per cpu idle task
  17. * combine the code of primary and secondary cpu
  18. * 2021-11-15 THEWON Remove duplicate work between idle and _thread_exit
  19. * 2023-09-15 xqyjlj perf rt_hw_interrupt_disable/enable
  20. * 2023-11-07 xqyjlj fix thread exit
  21. * 2023-12-10 xqyjlj add _hook_spinlock
  22. */
  23. #include <rthw.h>
  24. #include <rtthread.h>
  25. #ifdef RT_USING_MODULE
  26. #include <dlmodule.h>
  27. #endif /* RT_USING_MODULE */
  28. #ifdef RT_USING_HOOK
  29. #ifndef RT_USING_IDLE_HOOK
  30. #define RT_USING_IDLE_HOOK
  31. #endif /* RT_USING_IDLE_HOOK */
  32. #endif /* RT_USING_HOOK */
  33. #ifndef IDLE_THREAD_STACK_SIZE
  34. #if defined (RT_USING_IDLE_HOOK) || defined(RT_USING_HEAP)
  35. #define IDLE_THREAD_STACK_SIZE 256
  36. #else
  37. #define IDLE_THREAD_STACK_SIZE 128
  38. #endif /* (RT_USING_IDLE_HOOK) || defined(RT_USING_HEAP) */
  39. #endif /* IDLE_THREAD_STACK_SIZE */
  40. #define _CPUS_NR RT_CPUS_NR
  41. static struct rt_thread idle_thread[_CPUS_NR];
  42. rt_align(RT_ALIGN_SIZE)
  43. static rt_uint8_t idle_thread_stack[_CPUS_NR][IDLE_THREAD_STACK_SIZE];
  44. #ifdef RT_USING_IDLE_HOOK
  45. #ifndef RT_IDLE_HOOK_LIST_SIZE
  46. #define RT_IDLE_HOOK_LIST_SIZE 4
  47. #endif /* RT_IDLE_HOOK_LIST_SIZE */
  48. static void (*idle_hook_list[RT_IDLE_HOOK_LIST_SIZE])(void);
  49. static struct rt_spinlock _hook_spinlock;
  50. /**
  51. * @brief This function sets a hook function to idle thread loop. When the system performs
  52. * idle loop, this hook function should be invoked.
  53. *
  54. * @param hook the specified hook function.
  55. *
  56. * @return RT_EOK: set OK.
  57. * -RT_EFULL: hook list is full.
  58. *
  59. * @note the hook function must be simple and never be blocked or suspend.
  60. */
  61. rt_err_t rt_thread_idle_sethook(void (*hook)(void))
  62. {
  63. rt_size_t i;
  64. rt_err_t ret = -RT_EFULL;
  65. rt_base_t level;
  66. level = rt_spin_lock_irqsave(&_hook_spinlock);
  67. for (i = 0; i < RT_IDLE_HOOK_LIST_SIZE; i++)
  68. {
  69. if (idle_hook_list[i] == RT_NULL)
  70. {
  71. idle_hook_list[i] = hook;
  72. ret = RT_EOK;
  73. break;
  74. }
  75. }
  76. rt_spin_unlock_irqrestore(&_hook_spinlock, level);
  77. return ret;
  78. }
  79. /**
  80. * @brief delete the idle hook on hook list.
  81. *
  82. * @param hook the specified hook function.
  83. *
  84. * @return RT_EOK: delete OK.
  85. * -RT_ENOSYS: hook was not found.
  86. */
  87. rt_err_t rt_thread_idle_delhook(void (*hook)(void))
  88. {
  89. rt_size_t i;
  90. rt_err_t ret = -RT_ENOSYS;
  91. rt_base_t level;
  92. level = rt_spin_lock_irqsave(&_hook_spinlock);
  93. for (i = 0; i < RT_IDLE_HOOK_LIST_SIZE; i++)
  94. {
  95. if (idle_hook_list[i] == hook)
  96. {
  97. idle_hook_list[i] = RT_NULL;
  98. ret = RT_EOK;
  99. break;
  100. }
  101. }
  102. rt_spin_unlock_irqrestore(&_hook_spinlock, level);
  103. return ret;
  104. }
  105. #endif /* RT_USING_IDLE_HOOK */
  106. static void idle_thread_entry(void *parameter)
  107. {
  108. RT_UNUSED(parameter);
  109. #ifdef RT_USING_SMP
  110. if (rt_cpu_get_id() != 0)
  111. {
  112. while (1)
  113. {
  114. rt_hw_secondary_cpu_idle_exec();
  115. }
  116. }
  117. #endif /* RT_USING_SMP */
  118. while (1)
  119. {
  120. #ifdef RT_USING_IDLE_HOOK
  121. rt_size_t i;
  122. void (*idle_hook)(void);
  123. for (i = 0; i < RT_IDLE_HOOK_LIST_SIZE; i++)
  124. {
  125. idle_hook = idle_hook_list[i];
  126. if (idle_hook != RT_NULL)
  127. {
  128. idle_hook();
  129. }
  130. }
  131. #endif /* RT_USING_IDLE_HOOK */
  132. #if !defined(RT_USING_SMP) && !defined(RT_USING_SMART)
  133. rt_defunct_execute();
  134. #endif
  135. #ifdef RT_USING_PM
  136. void rt_system_power_manager(void);
  137. rt_system_power_manager();
  138. #endif /* RT_USING_PM */
  139. }
  140. }
  141. /**
  142. * @brief This function will initialize idle thread, then start it.
  143. *
  144. * @note this function must be invoked when system init.
  145. */
  146. void rt_thread_idle_init(void)
  147. {
  148. rt_ubase_t i;
  149. #if RT_NAME_MAX > 0
  150. char idle_thread_name[RT_NAME_MAX];
  151. #endif /* RT_NAME_MAX > 0 */
  152. #ifdef RT_USING_IDLE_HOOK
  153. rt_spin_lock_init(&_hook_spinlock);
  154. #endif
  155. for (i = 0; i < _CPUS_NR; i++)
  156. {
  157. #if RT_NAME_MAX > 0
  158. rt_snprintf(idle_thread_name, RT_NAME_MAX, "tidle%d", i);
  159. #endif /* RT_NAME_MAX > 0 */
  160. rt_thread_init(&idle_thread[i],
  161. #if RT_NAME_MAX > 0
  162. idle_thread_name,
  163. #else
  164. "tidle",
  165. #endif /* RT_NAME_MAX > 0 */
  166. idle_thread_entry,
  167. RT_NULL,
  168. &idle_thread_stack[i][0],
  169. sizeof(idle_thread_stack[i]),
  170. RT_THREAD_PRIORITY_MAX - 1,
  171. 32);
  172. #ifdef RT_USING_SMP
  173. rt_thread_control(&idle_thread[i], RT_THREAD_CTRL_BIND_CPU, (void*)i);
  174. #endif /* RT_USING_SMP */
  175. /* update */
  176. rt_cpu_index(i)->idle_thread = &idle_thread[i];
  177. /* startup */
  178. rt_thread_startup(&idle_thread[i]);
  179. }
  180. }
  181. /**
  182. * @brief This function will get the handler of the idle thread.
  183. */
  184. rt_thread_t rt_thread_idle_gethandler(void)
  185. {
  186. int id = rt_cpu_get_id();
  187. return (rt_thread_t)(&idle_thread[id]);
  188. }