os_cpu_c.c
上传用户:yyyd609
上传日期:2022-07-18
资源大小:183k
文件大小:13k
源码类别:

微处理器开发

开发平台:

C/C++

  1. /*
  2. *********************************************************************************************************
  3. *                                               uC/OS-II
  4. *                                         The Real-Time Kernel
  5. *
  6. *
  7. *                             (c) Copyright 1992-2004, Micrium, Weston, FL
  8. *                                          All Rights Reserved
  9. *
  10. *                                           Generic ARM Port
  11. *
  12. * File      : OS_CPU_C.C
  13. * Version   : V1.60
  14. * By        : Jean J. Labrosse
  15. *
  16. * For       : ARM7 or ARM9
  17. * Mode      : ARM or Thumb
  18. * Toolchain : ARM Developer Suite Version 1.2 and higher
  19. *********************************************************************************************************
  20. */
  21. #define  OS_CPU_GLOBALS
  22. #include <ucos_ii.h>
  23. #define  OS_VIEW_MODULE   0
  24. #if      OS_VIEW_MODULE > 0
  25. #include <OS_VIEWc.H>
  26. #include <OS_VIEW.H>
  27. #endif
  28. #define  ARM_MODE_ARM     0x00000000
  29. #define  ARM_MODE_THUMB   0x00000020
  30. #ifdef __thumb
  31. #define  ARM_SVC_MODE    (0x00000013L + ARM_MODE_THUMB)
  32. #else
  33. #define  ARM_SVC_MODE    (0x00000013L + ARM_MODE_ARM)
  34. #endif
  35. /*
  36. *********************************************************************************************************
  37. *                                       OS INITIALIZATION HOOK
  38. *                                            (BEGINNING)
  39. *
  40. * Description: This function is called by OSInit() at the beginning of OSInit().
  41. *
  42. * Arguments  : none
  43. *
  44. * Note(s)    : 1) Interrupts should be disabled during this call.
  45. *********************************************************************************************************
  46. */
  47. #if OS_CPU_HOOKS_EN > 0 && OS_VERSION > 203
  48. void  OSInitHookBegin (void)
  49. {
  50. }
  51. #endif
  52. /*
  53. *********************************************************************************************************
  54. *                                       OS INITIALIZATION HOOK
  55. *                                               (END)
  56. *
  57. * Description: This function is called by OSInit() at the end of OSInit().
  58. *
  59. * Arguments  : none
  60. *
  61. * Note(s)    : 1) Interrupts should be disabled during this call.
  62. *********************************************************************************************************
  63. */
  64. #if OS_CPU_HOOKS_EN > 0 && OS_VERSION > 203
  65. void  OSInitHookEnd (void)
  66. {
  67. #if OS_CPU_INT_DIS_MEAS_EN > 0
  68.     OS_CPU_IntDisMeasInit();
  69. #endif
  70. }
  71. #endif
  72. /*
  73. *********************************************************************************************************
  74. *                                          TASK CREATION HOOK
  75. *
  76. * Description: This function is called when a task is created.
  77. *
  78. * Arguments  : ptcb   is a pointer to the task control block of the task being created.
  79. *
  80. * Note(s)    : 1) Interrupts are disabled during this call.
  81. *********************************************************************************************************
  82. */
  83. #if OS_CPU_HOOKS_EN > 0
  84. void  OSTaskCreateHook (OS_TCB *ptcb)
  85. {
  86. #if OS_VIEW_MODULE > 0
  87.     OSView_TaskCreateHook(ptcb);
  88. #else
  89.     ptcb = ptcb;                       /* Prevent compiler warning                                     */
  90. #endif
  91. }
  92. #endif
  93. /*
  94. *********************************************************************************************************
  95. *                                           TASK DELETION HOOK
  96. *
  97. * Description: This function is called when a task is deleted.
  98. *
  99. * Arguments  : ptcb   is a pointer to the task control block of the task being deleted.
  100. *
  101. * Note(s)    : 1) Interrupts are disabled during this call.
  102. *********************************************************************************************************
  103. */
  104. #if OS_CPU_HOOKS_EN > 0
  105. void  OSTaskDelHook (OS_TCB *ptcb)
  106. {
  107.     ptcb = ptcb;                       /* Prevent compiler warning                                     */
  108. }
  109. #endif
  110. /*
  111. *********************************************************************************************************
  112. *                                             IDLE TASK HOOK
  113. *
  114. * Description: This function is called by the idle task.  This hook has been added to allow you to do
  115. *              such things as STOP the CPU to conserve power.
  116. *
  117. * Arguments  : none
  118. *
  119. * Note(s)    : 1) Interrupts are enabled during this call.
  120. *********************************************************************************************************
  121. */
  122. #if OS_CPU_HOOKS_EN > 0 && OS_VERSION >= 251
  123. void  OSTaskIdleHook (void)
  124. {
  125. }
  126. #endif
  127. /*
  128. *********************************************************************************************************
  129. *                                           STATISTIC TASK HOOK
  130. *
  131. * Description: This function is called every second by uC/OS-II's statistics task.  This allows your
  132. *              application to add functionality to the statistics task.
  133. *
  134. * Arguments  : none
  135. *********************************************************************************************************
  136. */
  137. #if OS_CPU_HOOKS_EN > 0
  138. void  OSTaskStatHook (void)
  139. {
  140. }
  141. #endif
  142. /*
  143. *********************************************************************************************************
  144. *                                        INITIALIZE A TASK'S STACK
  145. *
  146. * Description: This function is called by either OSTaskCreate() or OSTaskCreateExt() to initialize the
  147. *              stack frame of the task being created.  This function is highly processor specific.
  148. *
  149. * Arguments  : task          is a pointer to the task code
  150. *
  151. *              p_arg         is a pointer to a user supplied data area that will be passed to the task
  152. *                            when the task first executes.
  153. *
  154. *              ptos          is a pointer to the top of stack.  It is assumed that 'ptos' points to
  155. *                            a 'free' entry on the task stack.  If OS_STK_GROWTH is set to 1 then
  156. *                            'ptos' will contain the HIGHEST valid address of the stack.  Similarly, if
  157. *                            OS_STK_GROWTH is set to 0, the 'ptos' will contains the LOWEST valid address
  158. *                            of the stack.
  159. *
  160. *              opt           specifies options that can be used to alter the behavior of OSTaskStkInit().
  161. *                            (see uCOS_II.H for OS_TASK_OPT_xxx).
  162. *
  163. * Returns    : Always returns the location of the new top-of-stack' once the processor registers have
  164. *              been placed on the stack in the proper order.
  165. *
  166. * Note(s)    : 1) Interrupts are enabled when your task starts executing.
  167. *              2) All tasks run in SYS mode.
  168. *********************************************************************************************************
  169. */
  170. OS_STK *OSTaskStkInit (void (*task)(void *p_arg), void *p_arg, OS_STK *ptos, INT16U opt)
  171. {
  172.     OS_STK *stk;
  173.     opt      = opt;                         /* 'opt' is not used, prevent warning                      */
  174.     stk      = ptos;                        /* Load stack pointer                                      */
  175.     *(stk)   = (OS_STK)task;                /* Entry Point                                             */
  176.     *(--stk) = (INT32U)0x14141414L;         /* R14 (LR)                                                */
  177.     *(--stk) = (INT32U)0x12121212L;         /* R12                                                     */
  178.     *(--stk) = (INT32U)0x11111111L;         /* R11                                                     */
  179.     *(--stk) = (INT32U)0x10101010L;         /* R10                                                     */
  180.     *(--stk) = (INT32U)0x09090909L;         /* R9                                                      */
  181.     *(--stk) = (INT32U)0x08080808L;         /* R8                                                      */
  182.     *(--stk) = (INT32U)0x07070707L;         /* R7                                                      */
  183.     *(--stk) = (INT32U)0x06060606L;         /* R6                                                      */
  184.     *(--stk) = (INT32U)0x05050505L;         /* R5                                                      */
  185.     *(--stk) = (INT32U)0x04040404L;         /* R4                                                      */
  186.     *(--stk) = (INT32U)0x03030303L;         /* R3                                                      */
  187.     *(--stk) = (INT32U)0x02020202L;         /* R2                                                      */
  188.     *(--stk) = (INT32U)0x01010101L;         /* R1                                                      */
  189.     *(--stk) = (INT32U)p_arg;               /* R0 : argument                                           */
  190.     *(--stk) = (INT32U)ARM_SVC_MODE;        /* CPSR  (Enable both IRQ and FIQ interrupts)              */
  191.     return (stk);
  192. }
  193. /*
  194. *********************************************************************************************************
  195. *                                           TASK SWITCH HOOK
  196. *
  197. * Description: This function is called when a task switch is performed.  This allows you to perform other
  198. *              operations during a context switch.
  199. *
  200. * Arguments  : none
  201. *
  202. * Note(s)    : 1) Interrupts are disabled during this call.
  203. *              2) It is assumed that the global pointer 'OSTCBHighRdy' points to the TCB of the task that
  204. *                 will be 'switched in' (i.e. the highest priority task) and, 'OSTCBCur' points to the
  205. *                 task being switched out (i.e. the preempted task).
  206. *********************************************************************************************************
  207. */
  208. #if (OS_CPU_HOOKS_EN > 0) && (OS_TASK_SW_HOOK_EN > 0)
  209. void  OSTaskSwHook (void)
  210. {
  211. #if OS_VIEW_MODULE > 0
  212.     OSView_TaskSwHook();
  213. #endif
  214. }
  215. #endif
  216. /*
  217. *********************************************************************************************************
  218. *                                           OS_TCBInit() HOOK
  219. *
  220. * Description: This function is called by OS_TCBInit() after setting up most of the TCB.
  221. *
  222. * Arguments  : ptcb    is a pointer to the TCB of the task being created.
  223. *
  224. * Note(s)    : 1) Interrupts may or may not be ENABLED during this call.
  225. *********************************************************************************************************
  226. */
  227. #if OS_CPU_HOOKS_EN > 0 && OS_VERSION > 203
  228. void  OSTCBInitHook (OS_TCB *ptcb)
  229. {
  230.     ptcb = ptcb;                                           /* Prevent Compiler warning                 */
  231. }
  232. #endif
  233. /*
  234. *********************************************************************************************************
  235. *                                               TICK HOOK
  236. *
  237. * Description: This function is called every tick.
  238. *
  239. * Arguments  : none
  240. *
  241. * Note(s)    : 1) Interrupts may or may not be ENABLED during this call.
  242. *********************************************************************************************************
  243. */
  244. #if (OS_CPU_HOOKS_EN > 0) && (OS_TIME_TICK_HOOK_EN > 0)
  245. void  OSTimeTickHook (void)
  246. {
  247. #if OS_VIEW_MODULE > 0
  248.     OSView_TickHook();
  249. #endif
  250. }
  251. #endif
  252. /*
  253. *********************************************************************************************************
  254. *                             INTERRUPT DISABLE TIME MEASUREMENT, START
  255. *********************************************************************************************************
  256. */
  257. #if OS_CPU_INT_DIS_MEAS_EN > 0
  258. void  OS_CPU_IntDisMeasInit (void)
  259. {
  260.     OS_CPU_IntDisMeasNestingCtr = 0;
  261.     OS_CPU_IntDisMeasCntsEnter  = 0;
  262.     OS_CPU_IntDisMeasCntsExit   = 0;
  263.     OS_CPU_IntDisMeasCntsMax    = 0;
  264.     OS_CPU_IntDisMeasCntsDelta  = 0;
  265.     OS_CPU_IntDisMeasCntsOvrhd  = 0;
  266.     OS_CPU_IntDisMeasStart();                              /* Measure the overhead of the functions    */
  267.     OS_CPU_IntDisMeasStop();
  268.     OS_CPU_IntDisMeasCntsOvrhd  = OS_CPU_IntDisMeasCntsDelta;
  269. }
  270. void  OS_CPU_IntDisMeasStart (void)
  271. {
  272.     OS_CPU_IntDisMeasNestingCtr++;
  273.     if (OS_CPU_IntDisMeasNestingCtr == 1) {                /* Only measure at the first nested level   */
  274.         OS_CPU_IntDisMeasCntsEnter = OS_CPU_IntDisMeasTmrRd();
  275.     }
  276. }
  277. void  OS_CPU_IntDisMeasStop (void)
  278. {
  279.     OS_CPU_IntDisMeasNestingCtr--;                                         /* Decrement nesting ctr    */
  280.     if (OS_CPU_IntDisMeasNestingCtr == 0) {
  281.         OS_CPU_IntDisMeasCntsExit  = OS_CPU_IntDisMeasTmrRd();
  282.         OS_CPU_IntDisMeasCntsDelta = OS_CPU_IntDisMeasCntsExit - OS_CPU_IntDisMeasCntsEnter;
  283.         if (OS_CPU_IntDisMeasCntsDelta > OS_CPU_IntDisMeasCntsOvrhd) {     /* Ensure overhead < delta  */
  284.             OS_CPU_IntDisMeasCntsDelta -= OS_CPU_IntDisMeasCntsOvrhd;
  285.         } else {
  286.             OS_CPU_IntDisMeasCntsDelta  = OS_CPU_IntDisMeasCntsOvrhd;
  287.         }
  288.         if (OS_CPU_IntDisMeasCntsDelta > OS_CPU_IntDisMeasCntsMax) {       /* Track MAXIMUM            */
  289.             OS_CPU_IntDisMeasCntsMax = OS_CPU_IntDisMeasCntsDelta;
  290.         }
  291.     }
  292. }
  293. #endif