os_task.c
上传用户:yj_qqy
上传日期:2017-01-28
资源大小:2911k
文件大小:55k
源码类别:

uCOS

开发平台:

C/C++

  1. /*
  2. *********************************************************************************************************
  3. *                                                uC/OS-II
  4. *                                          The Real-Time Kernel
  5. *                                            TASK MANAGEMENT
  6. *
  7. *                              (c) Copyright 1992-2009, Micrium, Weston, FL
  8. *                                           All Rights Reserved
  9. *
  10. * File    : OS_TASK.C
  11. * By      : Jean J. Labrosse
  12. * Version : V2.88
  13. *
  14. * LICENSING TERMS:
  15. * ---------------
  16. *   uC/OS-II is provided in source form for FREE evaluation, for educational use or for peaceful research.  
  17. * If you plan on using  uC/OS-II  in a commercial product you need to contact Micri祄 to properly license 
  18. * its use in your product. We provide ALL the source code for your convenience and to help you experience 
  19. * uC/OS-II.   The fact that the  source is provided does  NOT  mean that you can use it without  paying a 
  20. * licensing fee.
  21. *********************************************************************************************************
  22. */
  23. #ifndef  OS_MASTER_FILE
  24. #include <ucos_ii.h>
  25. #endif
  26. /*$PAGE*/
  27. /*
  28. *********************************************************************************************************
  29. *                                        CHANGE PRIORITY OF A TASK
  30. *
  31. * Description: This function allows you to change the priority of a task dynamically.  Note that the new
  32. *              priority MUST be available.
  33. *
  34. * Arguments  : oldp     is the old priority
  35. *
  36. *              newp     is the new priority
  37. *
  38. * Returns    : OS_ERR_NONE            is the call was successful
  39. *              OS_ERR_PRIO_INVALID    if the priority you specify is higher that the maximum allowed
  40. *                                     (i.e. >= OS_LOWEST_PRIO)
  41. *              OS_ERR_PRIO_EXIST      if the new priority already exist.
  42. *              OS_ERR_PRIO            there is no task with the specified OLD priority (i.e. the OLD task does
  43. *                                     not exist.
  44. *              OS_ERR_TASK_NOT_EXIST  if the task is assigned to a Mutex PIP.
  45. *********************************************************************************************************
  46. */
  47. #if OS_TASK_CHANGE_PRIO_EN > 0
  48. INT8U  OSTaskChangePrio (INT8U  oldprio,
  49.                          INT8U  newprio)
  50. {
  51. #if (OS_EVENT_EN)
  52.     OS_EVENT  *pevent;
  53. #if (OS_EVENT_MULTI_EN > 0)
  54.     OS_EVENT **pevents;
  55. #endif
  56. #endif
  57.     OS_TCB    *ptcb;
  58.     INT8U      y_new;
  59.     INT8U      x_new;
  60.     INT8U      y_old;
  61. #if OS_LOWEST_PRIO <= 63
  62.     INT8U      bity_new;
  63.     INT8U      bitx_new;
  64.     INT8U      bity_old;
  65.     INT8U      bitx_old;
  66. #else
  67.     INT16U     bity_new;
  68.     INT16U     bitx_new;
  69.     INT16U     bity_old;
  70.     INT16U     bitx_old;
  71. #endif
  72. #if OS_CRITICAL_METHOD == 3
  73.     OS_CPU_SR  cpu_sr = 0;                                  /* Storage for CPU status register         */
  74. #endif
  75. /*$PAGE*/
  76. #if OS_ARG_CHK_EN > 0
  77.     if (oldprio >= OS_LOWEST_PRIO) {
  78.         if (oldprio != OS_PRIO_SELF) {
  79.             return (OS_ERR_PRIO_INVALID);
  80.         }
  81.     }
  82.     if (newprio >= OS_LOWEST_PRIO) {
  83.         return (OS_ERR_PRIO_INVALID);
  84.     }
  85. #endif
  86.     OS_ENTER_CRITICAL();
  87.     if (OSTCBPrioTbl[newprio] != (OS_TCB *)0) {             /* New priority must not already exist     */
  88.         OS_EXIT_CRITICAL();
  89.         return (OS_ERR_PRIO_EXIST);
  90.     }
  91.     if (oldprio == OS_PRIO_SELF) {                          /* See if changing self                    */
  92.         oldprio = OSTCBCur->OSTCBPrio;                      /* Yes, get priority                       */
  93.     }
  94.     ptcb = OSTCBPrioTbl[oldprio];
  95.     if (ptcb == (OS_TCB *)0) {                              /* Does task to change exist?              */
  96.         OS_EXIT_CRITICAL();                                 /* No, can't change its priority!          */
  97.         return (OS_ERR_PRIO);
  98.     }
  99.     if (ptcb == OS_TCB_RESERVED) {                          /* Is task assigned to Mutex               */
  100.         OS_EXIT_CRITICAL();                                 /* No, can't change its priority!          */
  101.         return (OS_ERR_TASK_NOT_EXIST);
  102.     }
  103. #if OS_LOWEST_PRIO <= 63
  104.     y_new                 = (INT8U)(newprio >> 3);          /* Yes, compute new TCB fields             */
  105.     x_new                 = (INT8U)(newprio & 0x07);
  106.     bity_new              = (INT8U)(1 << y_new);
  107.     bitx_new              = (INT8U)(1 << x_new);
  108. #else
  109.     y_new                 = (INT8U)((newprio >> 4) & 0x0F);
  110.     x_new                 = (INT8U)( newprio & 0x0F);
  111.     bity_new              = (INT16U)(1 << y_new);
  112.     bitx_new              = (INT16U)(1 << x_new);
  113. #endif
  114.     OSTCBPrioTbl[oldprio] = (OS_TCB *)0;                    /* Remove TCB from old priority            */
  115.     OSTCBPrioTbl[newprio] =  ptcb;                          /* Place pointer to TCB @ new priority     */
  116.     y_old                 =  ptcb->OSTCBY;
  117.     bity_old              =  ptcb->OSTCBBitY;
  118.     bitx_old              =  ptcb->OSTCBBitX;
  119.     if ((OSRdyTbl[y_old] &   bitx_old) != 0) {              /* If task is ready make it not            */
  120.          OSRdyTbl[y_old] &= ~bitx_old;
  121.          if (OSRdyTbl[y_old] == 0) {
  122.              OSRdyGrp &= ~bity_old;
  123.          }
  124.          OSRdyGrp        |= bity_new;                       /* Make new priority ready to run          */
  125.          OSRdyTbl[y_new] |= bitx_new;
  126.     }
  127. #if (OS_EVENT_EN)
  128.     pevent = ptcb->OSTCBEventPtr;
  129.     if (pevent != (OS_EVENT *)0) {
  130.         pevent->OSEventTbl[y_old] &= ~bitx_old;             /* Remove old task prio from wait list     */
  131.         if (pevent->OSEventTbl[y_old] == 0) {
  132.             pevent->OSEventGrp    &= ~bity_old;
  133.         }
  134.         pevent->OSEventGrp        |= bity_new;              /* Add    new task prio to   wait list     */
  135.         pevent->OSEventTbl[y_new] |= bitx_new;
  136.     }
  137. #if (OS_EVENT_MULTI_EN > 0)
  138.     if (ptcb->OSTCBEventMultiPtr != (OS_EVENT **)0) {
  139.         pevents =  ptcb->OSTCBEventMultiPtr;
  140.         pevent  = *pevents;
  141.         while (pevent != (OS_EVENT *)0) {
  142.             pevent->OSEventTbl[y_old] &= ~bitx_old;         /* Remove old task prio from wait lists    */
  143.             if (pevent->OSEventTbl[y_old] == 0) {
  144.                 pevent->OSEventGrp    &= ~bity_old;
  145.             }
  146.             pevent->OSEventGrp        |= bity_new;          /* Add    new task prio to   wait lists    */
  147.             pevent->OSEventTbl[y_new] |= bitx_new;
  148.             pevents++;
  149.             pevent                     = *pevents;
  150.         }
  151.     }
  152. #endif
  153. #endif
  154.     ptcb->OSTCBPrio = newprio;                              /* Set new task priority                   */
  155.     ptcb->OSTCBY    = y_new;
  156.     ptcb->OSTCBX    = x_new;
  157.     ptcb->OSTCBBitY = bity_new;
  158.     ptcb->OSTCBBitX = bitx_new;
  159.     OS_EXIT_CRITICAL();
  160.     if (OSRunning == OS_TRUE) {
  161.         OS_Sched();                                         /* Find new highest priority task          */
  162.     }
  163.     return (OS_ERR_NONE);
  164. }
  165. #endif
  166. /*$PAGE*/
  167. /*
  168. *********************************************************************************************************
  169. *                                            CREATE A TASK
  170. *
  171. * Description: This function is used to have uC/OS-II manage the execution of a task.  Tasks can either
  172. *              be created prior to the start of multitasking or by a running task.  A task cannot be
  173. *              created by an ISR.
  174. *
  175. * Arguments  : task     is a pointer to the task's code
  176. *
  177. *              p_arg    is a pointer to an optional data area which can be used to pass parameters to
  178. *                       the task when the task first executes.  Where the task is concerned it thinks
  179. *                       it was invoked and passed the argument 'p_arg' as follows:
  180. *
  181. *                           void Task (void *p_arg)
  182. *                           {
  183. *                               for (;;) {
  184. *                                   Task code;
  185. *                               }
  186. *                           }
  187. *
  188. *              ptos     is a pointer to the task's top of stack.  If the configuration constant
  189. *                       OS_STK_GROWTH is set to 1, the stack is assumed to grow downward (i.e. from high
  190. *                       memory to low memory).  'pstk' will thus point to the highest (valid) memory
  191. *                       location of the stack.  If OS_STK_GROWTH is set to 0, 'pstk' will point to the
  192. *                       lowest memory location of the stack and the stack will grow with increasing
  193. *                       memory locations.
  194. *
  195. *              prio     is the task's priority.  A unique priority MUST be assigned to each task and the
  196. *                       lower the number, the higher the priority.
  197. *
  198. * Returns    : OS_ERR_NONE             if the function was successful.
  199. *              OS_PRIO_EXIT            if the task priority already exist
  200. *                                      (each task MUST have a unique priority).
  201. *              OS_ERR_PRIO_INVALID     if the priority you specify is higher that the maximum allowed
  202. *                                      (i.e. >= OS_LOWEST_PRIO)
  203. *              OS_ERR_TASK_CREATE_ISR  if you tried to create a task from an ISR.
  204. *********************************************************************************************************
  205. */
  206. #if OS_TASK_CREATE_EN > 0
  207. INT8U  OSTaskCreate (void   (*task)(void *p_arg), 
  208.                      void    *p_arg, 
  209.                      OS_STK  *ptos, 
  210.                      INT8U    prio)
  211. {
  212.     OS_STK    *psp;
  213.     INT8U      err;
  214. #if OS_CRITICAL_METHOD == 3                  /* Allocate storage for CPU status register               */
  215.     OS_CPU_SR  cpu_sr = 0;
  216. #endif
  217. #if OS_ARG_CHK_EN > 0
  218.     if (prio > OS_LOWEST_PRIO) {             /* Make sure priority is within allowable range           */
  219.         return (OS_ERR_PRIO_INVALID);
  220.     }
  221. #endif
  222.     OS_ENTER_CRITICAL();
  223.     if (OSIntNesting > 0) {                  /* Make sure we don't create the task from within an ISR  */
  224.         OS_EXIT_CRITICAL();
  225.         return (OS_ERR_TASK_CREATE_ISR);
  226.     }
  227.     if (OSTCBPrioTbl[prio] == (OS_TCB *)0) { /* Make sure task doesn't already exist at this priority  */
  228.         OSTCBPrioTbl[prio] = OS_TCB_RESERVED;/* Reserve the priority to prevent others from doing ...  */
  229.                                              /* ... the same thing until task is created.              */
  230.         OS_EXIT_CRITICAL();
  231.         psp = OSTaskStkInit(task, p_arg, ptos, 0);              /* Initialize the task's stack         */
  232.         err = OS_TCBInit(prio, psp, (OS_STK *)0, 0, 0, (void *)0, 0);
  233.         if (err == OS_ERR_NONE) {
  234.             if (OSRunning == OS_TRUE) {      /* Find highest priority task if multitasking has started */
  235.                 OS_Sched();
  236.             }
  237.         } else {
  238.             OS_ENTER_CRITICAL();
  239.             OSTCBPrioTbl[prio] = (OS_TCB *)0;/* Make this priority available to others                 */
  240.             OS_EXIT_CRITICAL();
  241.         }
  242.         return (err);
  243.     }
  244.     OS_EXIT_CRITICAL();
  245.     return (OS_ERR_PRIO_EXIST);
  246. }
  247. #endif
  248. /*$PAGE*/
  249. /*
  250. *********************************************************************************************************
  251. *                                     CREATE A TASK (Extended Version)
  252. *
  253. * Description: This function is used to have uC/OS-II manage the execution of a task.  Tasks can either
  254. *              be created prior to the start of multitasking or by a running task.  A task cannot be
  255. *              created by an ISR.  This function is similar to OSTaskCreate() except that it allows
  256. *              additional information about a task to be specified.
  257. *
  258. * Arguments  : task      is a pointer to the task's code
  259. *
  260. *              p_arg     is a pointer to an optional data area which can be used to pass parameters to
  261. *                        the task when the task first executes.  Where the task is concerned it thinks
  262. *                        it was invoked and passed the argument 'p_arg' as follows:
  263. *
  264. *                            void Task (void *p_arg)
  265. *                            {
  266. *                                for (;;) {
  267. *                                    Task code;
  268. *                                }
  269. *                            }
  270. *
  271. *              ptos      is a pointer to the task's top of stack.  If the configuration constant
  272. *                        OS_STK_GROWTH is set to 1, the stack is assumed to grow downward (i.e. from high
  273. *                        memory to low memory).  'ptos' will thus point to the highest (valid) memory
  274. *                        location of the stack.  If OS_STK_GROWTH is set to 0, 'ptos' will point to the
  275. *                        lowest memory location of the stack and the stack will grow with increasing
  276. *                        memory locations.  'ptos' MUST point to a valid 'free' data item.
  277. *
  278. *              prio      is the task's priority.  A unique priority MUST be assigned to each task and the
  279. *                        lower the number, the higher the priority.
  280. *
  281. *              id        is the task's ID (0..65535)
  282. *
  283. *              pbos      is a pointer to the task's bottom of stack.  If the configuration constant
  284. *                        OS_STK_GROWTH is set to 1, the stack is assumed to grow downward (i.e. from high
  285. *                        memory to low memory).  'pbos' will thus point to the LOWEST (valid) memory
  286. *                        location of the stack.  If OS_STK_GROWTH is set to 0, 'pbos' will point to the
  287. *                        HIGHEST memory location of the stack and the stack will grow with increasing
  288. *                        memory locations.  'pbos' MUST point to a valid 'free' data item.
  289. *
  290. *              stk_size  is the size of the stack in number of elements.  If OS_STK is set to INT8U,
  291. *                        'stk_size' corresponds to the number of bytes available.  If OS_STK is set to
  292. *                        INT16U, 'stk_size' contains the number of 16-bit entries available.  Finally, if
  293. *                        OS_STK is set to INT32U, 'stk_size' contains the number of 32-bit entries
  294. *                        available on the stack.
  295. *
  296. *              pext      is a pointer to a user supplied memory location which is used as a TCB extension.
  297. *                        For example, this user memory can hold the contents of floating-point registers
  298. *                        during a context switch, the time each task takes to execute, the number of times
  299. *                        the task has been switched-in, etc.
  300. *
  301. *              opt       contains additional information (or options) about the behavior of the task.  The
  302. *                        LOWER 8-bits are reserved by uC/OS-II while the upper 8 bits can be application
  303. *                        specific.  See OS_TASK_OPT_??? in uCOS-II.H.  Current choices are:
  304. *
  305. *                        OS_TASK_OPT_STK_CHK      Stack checking to be allowed for the task
  306. *                        OS_TASK_OPT_STK_CLR      Clear the stack when the task is created
  307. *                        OS_TASK_OPT_SAVE_FP      If the CPU has floating-point registers, save them
  308. *                                                 during a context switch.
  309. *
  310. * Returns    : OS_ERR_NONE             if the function was successful.
  311. *              OS_PRIO_EXIT            if the task priority already exist
  312. *                                      (each task MUST have a unique priority).
  313. *              OS_ERR_PRIO_INVALID     if the priority you specify is higher that the maximum allowed
  314. *                                      (i.e. > OS_LOWEST_PRIO)
  315. *              OS_ERR_TASK_CREATE_ISR  if you tried to create a task from an ISR.
  316. *********************************************************************************************************
  317. */
  318. /*$PAGE*/
  319. #if OS_TASK_CREATE_EXT_EN > 0
  320. INT8U  OSTaskCreateExt (void   (*task)(void *p_arg),
  321.                         void    *p_arg,
  322.                         OS_STK  *ptos,
  323.                         INT8U    prio,
  324.                         INT16U   id,
  325.                         OS_STK  *pbos,
  326.                         INT32U   stk_size,
  327.                         void    *pext,
  328.                         INT16U   opt)
  329. {
  330.     OS_STK    *psp;
  331.     INT8U      err;
  332. #if OS_CRITICAL_METHOD == 3                  /* Allocate storage for CPU status register               */
  333.     OS_CPU_SR  cpu_sr = 0;
  334. #endif
  335. #if OS_ARG_CHK_EN > 0
  336.     if (prio > OS_LOWEST_PRIO) {             /* Make sure priority is within allowable range           */
  337.         return (OS_ERR_PRIO_INVALID);
  338.     }
  339. #endif
  340.     OS_ENTER_CRITICAL();
  341.     if (OSIntNesting > 0) {                  /* Make sure we don't create the task from within an ISR  */
  342.         OS_EXIT_CRITICAL();
  343.         return (OS_ERR_TASK_CREATE_ISR);
  344.     }
  345.     if (OSTCBPrioTbl[prio] == (OS_TCB *)0) { /* Make sure task doesn't already exist at this priority  */
  346.         OSTCBPrioTbl[prio] = OS_TCB_RESERVED;/* Reserve the priority to prevent others from doing ...  */
  347.                                              /* ... the same thing until task is created.              */
  348.         OS_EXIT_CRITICAL();
  349. #if (OS_TASK_STAT_STK_CHK_EN > 0)
  350.         OS_TaskStkClr(pbos, stk_size, opt);                    /* Clear the task stack (if needed)     */
  351. #endif
  352.         psp = OSTaskStkInit(task, p_arg, ptos, opt);           /* Initialize the task's stack          */
  353.         err = OS_TCBInit(prio, psp, pbos, id, stk_size, pext, opt);
  354.         if (err == OS_ERR_NONE) {
  355.             if (OSRunning == OS_TRUE) {                        /* Find HPT if multitasking has started */
  356.                 OS_Sched();
  357.             }
  358.         } else {
  359.             OS_ENTER_CRITICAL();
  360.             OSTCBPrioTbl[prio] = (OS_TCB *)0;                  /* Make this priority avail. to others  */
  361.             OS_EXIT_CRITICAL();
  362.         }
  363.         return (err);
  364.     }
  365.     OS_EXIT_CRITICAL();
  366.     return (OS_ERR_PRIO_EXIST);
  367. }
  368. #endif
  369. /*$PAGE*/
  370. /*
  371. *********************************************************************************************************
  372. *                                            DELETE A TASK
  373. *
  374. * Description: This function allows you to delete a task.  The calling task can delete itself by
  375. *              its own priority number.  The deleted task is returned to the dormant state and can be
  376. *              re-activated by creating the deleted task again.
  377. *
  378. * Arguments  : prio    is the priority of the task to delete.  Note that you can explicitely delete
  379. *                      the current task without knowing its priority level by setting 'prio' to
  380. *                      OS_PRIO_SELF.
  381. *
  382. * Returns    : OS_ERR_NONE             if the call is successful
  383. *              OS_ERR_TASK_DEL_IDLE    if you attempted to delete uC/OS-II's idle task
  384. *              OS_ERR_PRIO_INVALID     if the priority you specify is higher that the maximum allowed
  385. *                                      (i.e. >= OS_LOWEST_PRIO) or, you have not specified OS_PRIO_SELF.
  386. *              OS_ERR_TASK_DEL         if the task is assigned to a Mutex PIP.   
  387. *              OS_ERR_TASK_NOT_EXIST   if the task you want to delete does not exist.
  388. *              OS_ERR_TASK_DEL_ISR     if you tried to delete a task from an ISR
  389. *
  390. * Notes      : 1) To reduce interrupt latency, OSTaskDel() 'disables' the task:
  391. *                    a) by making it not ready
  392. *                    b) by removing it from any wait lists
  393. *                    c) by preventing OSTimeTick() from making the task ready to run.
  394. *                 The task can then be 'unlinked' from the miscellaneous structures in uC/OS-II.
  395. *              2) The function OS_Dummy() is called after OS_EXIT_CRITICAL() because, on most processors,
  396. *                 the next instruction following the enable interrupt instruction is ignored.
  397. *              3) An ISR cannot delete a task.
  398. *              4) The lock nesting counter is incremented because, for a brief instant, if the current
  399. *                 task is being deleted, the current task would not be able to be rescheduled because it
  400. *                 is removed from the ready list.  Incrementing the nesting counter prevents another task
  401. *                 from being schedule.  This means that an ISR would return to the current task which is
  402. *                 being deleted.  The rest of the deletion would thus be able to be completed.
  403. *********************************************************************************************************
  404. */
  405. #if OS_TASK_DEL_EN > 0
  406. INT8U  OSTaskDel (INT8U prio)
  407. {
  408. #if (OS_FLAG_EN > 0) && (OS_MAX_FLAGS > 0)
  409.     OS_FLAG_NODE *pnode;
  410. #endif
  411.     OS_TCB       *ptcb;
  412. #if OS_CRITICAL_METHOD == 3                             /* Allocate storage for CPU status register    */
  413.     OS_CPU_SR     cpu_sr = 0;
  414. #endif
  415.     if (OSIntNesting > 0) {                             /* See if trying to delete from ISR            */
  416.         return (OS_ERR_TASK_DEL_ISR);
  417.     }
  418.     if (prio == OS_TASK_IDLE_PRIO) {                    /* Not allowed to delete idle task             */
  419.         return (OS_ERR_TASK_DEL_IDLE);
  420.     }
  421. #if OS_ARG_CHK_EN > 0
  422.     if (prio >= OS_LOWEST_PRIO) {                       /* Task priority valid ?                       */
  423.         if (prio != OS_PRIO_SELF) {
  424.             return (OS_ERR_PRIO_INVALID);
  425.         }
  426.     }
  427. #endif
  428. /*$PAGE*/
  429.     OS_ENTER_CRITICAL();
  430.     if (prio == OS_PRIO_SELF) {                         /* See if requesting to delete self            */
  431.         prio = OSTCBCur->OSTCBPrio;                     /* Set priority to delete to current           */
  432.     }
  433.     ptcb = OSTCBPrioTbl[prio];
  434.     if (ptcb == (OS_TCB *)0) {                          /* Task to delete must exist                   */
  435.         OS_EXIT_CRITICAL();
  436.         return (OS_ERR_TASK_NOT_EXIST);
  437.     }
  438.     if (ptcb == OS_TCB_RESERVED) {                      /* Must not be assigned to Mutex               */
  439.         OS_EXIT_CRITICAL();
  440.         return (OS_ERR_TASK_DEL);
  441.     }
  442.     OSRdyTbl[ptcb->OSTCBY] &= ~ptcb->OSTCBBitX;
  443.     if (OSRdyTbl[ptcb->OSTCBY] == 0) {                  /* Make task not ready                         */
  444.         OSRdyGrp           &= ~ptcb->OSTCBBitY;
  445.     }
  446.     
  447. #if (OS_EVENT_EN)
  448.     if (ptcb->OSTCBEventPtr != (OS_EVENT *)0) {
  449.         OS_EventTaskRemove(ptcb, ptcb->OSTCBEventPtr);  /* Remove this task from any event   wait list */
  450.     }
  451. #if (OS_EVENT_MULTI_EN > 0)
  452.     if (ptcb->OSTCBEventMultiPtr != (OS_EVENT **)0) {   /* Remove this task from any events' wait lists*/
  453.         OS_EventTaskRemoveMulti(ptcb, ptcb->OSTCBEventMultiPtr);
  454.     }
  455. #endif
  456. #endif
  457. #if (OS_FLAG_EN > 0) && (OS_MAX_FLAGS > 0)
  458.     pnode = ptcb->OSTCBFlagNode;
  459.     if (pnode != (OS_FLAG_NODE *)0) {                   /* If task is waiting on event flag            */
  460.         OS_FlagUnlink(pnode);                           /* Remove from wait list                       */
  461.     }
  462. #endif
  463.     ptcb->OSTCBDly      = 0;                            /* Prevent OSTimeTick() from updating          */
  464.     ptcb->OSTCBStat     = OS_STAT_RDY;                  /* Prevent task from being resumed             */
  465.     ptcb->OSTCBStatPend = OS_STAT_PEND_OK;
  466.     if (OSLockNesting < 255u) {                         /* Make sure we don't context switch           */
  467.         OSLockNesting++;
  468.     }
  469.     OS_EXIT_CRITICAL();                                 /* Enabling INT. ignores next instruc.         */
  470.     OS_Dummy();                                         /* ... Dummy ensures that INTs will be         */
  471.     OS_ENTER_CRITICAL();                                /* ... disabled HERE!                          */
  472.     if (OSLockNesting > 0) {                            /* Remove context switch lock                  */
  473.         OSLockNesting--;
  474.     }
  475.     OSTaskDelHook(ptcb);                                /* Call user defined hook                      */
  476.     OSTaskCtr--;                                        /* One less task being managed                 */
  477.     OSTCBPrioTbl[prio] = (OS_TCB *)0;                   /* Clear old priority entry                    */
  478.     if (ptcb->OSTCBPrev == (OS_TCB *)0) {               /* Remove from TCB chain                       */
  479.         ptcb->OSTCBNext->OSTCBPrev = (OS_TCB *)0;
  480.         OSTCBList                  = ptcb->OSTCBNext;
  481.     } else {
  482.         ptcb->OSTCBPrev->OSTCBNext = ptcb->OSTCBNext;
  483.         ptcb->OSTCBNext->OSTCBPrev = ptcb->OSTCBPrev;
  484.     }
  485.     ptcb->OSTCBNext     = OSTCBFreeList;                /* Return TCB to free TCB list                 */
  486.     OSTCBFreeList       = ptcb;
  487. #if OS_TASK_NAME_EN > 0
  488.     ptcb->OSTCBTaskName = "?";                          /* Unknown name                                */
  489. #endif
  490.     OS_EXIT_CRITICAL();
  491.     if (OSRunning == OS_TRUE) {
  492.         OS_Sched();                                     /* Find new highest priority task              */
  493.     }
  494.     return (OS_ERR_NONE);
  495. }
  496. #endif
  497. /*$PAGE*/
  498. /*
  499. *********************************************************************************************************
  500. *                                    REQUEST THAT A TASK DELETE ITSELF
  501. *
  502. * Description: This function is used to:
  503. *                   a) notify a task to delete itself.
  504. *                   b) to see if a task requested that the current task delete itself.
  505. *              This function is a little tricky to understand.  Basically, you have a task that needs
  506. *              to be deleted however, this task has resources that it has allocated (memory buffers,
  507. *              semaphores, mailboxes, queues etc.).  The task cannot be deleted otherwise these
  508. *              resources would not be freed.  The requesting task calls OSTaskDelReq() to indicate that
  509. *              the task needs to be deleted.  Deleting of the task is however, deferred to the task to
  510. *              be deleted.  For example, suppose that task #10 needs to be deleted.  The requesting task
  511. *              example, task #5, would call OSTaskDelReq(10).  When task #10 gets to execute, it calls
  512. *              this function by specifying OS_PRIO_SELF and monitors the returned value.  If the return
  513. *              value is OS_ERR_TASK_DEL_REQ, another task requested a task delete.  Task #10 would look like
  514. *              this:
  515. *
  516. *                   void Task(void *p_arg)
  517. *                   {
  518. *                       .
  519. *                       .
  520. *                       while (1) {
  521. *                           OSTimeDly(1);
  522. *                           if (OSTaskDelReq(OS_PRIO_SELF) == OS_ERR_TASK_DEL_REQ) {
  523. *                               Release any owned resources;
  524. *                               De-allocate any dynamic memory;
  525. *                               OSTaskDel(OS_PRIO_SELF);
  526. *                           }
  527. *                       }
  528. *                   }
  529. *
  530. * Arguments  : prio    is the priority of the task to request the delete from
  531. *
  532. * Returns    : OS_ERR_NONE            if the task exist and the request has been registered
  533. *              OS_ERR_TASK_NOT_EXIST  if the task has been deleted.  This allows the caller to know whether
  534. *                                     the request has been executed.
  535. *              OS_ERR_TASK_DEL        if the task is assigned to a Mutex.
  536. *              OS_ERR_TASK_DEL_IDLE   if you requested to delete uC/OS-II's idle task
  537. *              OS_ERR_PRIO_INVALID    if the priority you specify is higher that the maximum allowed
  538. *                                     (i.e. >= OS_LOWEST_PRIO) or, you have not specified OS_PRIO_SELF.
  539. *              OS_ERR_TASK_DEL_REQ    if a task (possibly another task) requested that the running task be
  540. *                                     deleted.
  541. *********************************************************************************************************
  542. */
  543. /*$PAGE*/
  544. #if OS_TASK_DEL_EN > 0
  545. INT8U  OSTaskDelReq (INT8U prio)
  546. {
  547.     INT8U      stat;
  548.     OS_TCB    *ptcb;
  549. #if OS_CRITICAL_METHOD == 3                      /* Allocate storage for CPU status register           */
  550.     OS_CPU_SR  cpu_sr = 0;
  551. #endif
  552.     if (prio == OS_TASK_IDLE_PRIO) {                            /* Not allowed to delete idle task     */
  553.         return (OS_ERR_TASK_DEL_IDLE);
  554.     }
  555. #if OS_ARG_CHK_EN > 0
  556.     if (prio >= OS_LOWEST_PRIO) {                               /* Task priority valid ?               */
  557.         if (prio != OS_PRIO_SELF) {
  558.             return (OS_ERR_PRIO_INVALID);
  559.         }
  560.     }
  561. #endif
  562.     if (prio == OS_PRIO_SELF) {                                 /* See if a task is requesting to ...  */
  563.         OS_ENTER_CRITICAL();                                    /* ... this task to delete itself      */
  564.         stat = OSTCBCur->OSTCBDelReq;                           /* Return request status to caller     */
  565.         OS_EXIT_CRITICAL();
  566.         return (stat);
  567.     }
  568.     OS_ENTER_CRITICAL();
  569.     ptcb = OSTCBPrioTbl[prio];
  570.     if (ptcb == (OS_TCB *)0) {                                  /* Task to delete must exist           */
  571.         OS_EXIT_CRITICAL();
  572.         return (OS_ERR_TASK_NOT_EXIST);                         /* Task must already be deleted        */
  573.     }
  574.     if (ptcb == OS_TCB_RESERVED) {                              /* Must NOT be assigned to a Mutex     */
  575.         OS_EXIT_CRITICAL();
  576.         return (OS_ERR_TASK_DEL);
  577.     }
  578.     ptcb->OSTCBDelReq = OS_ERR_TASK_DEL_REQ;                    /* Set flag indicating task to be DEL. */
  579.     OS_EXIT_CRITICAL();
  580.     return (OS_ERR_NONE);
  581. }
  582. #endif
  583. /*$PAGE*/
  584. /*
  585. *********************************************************************************************************
  586. *                                        GET THE NAME OF A TASK
  587. *
  588. * Description: This function is called to obtain the name of a task.
  589. *
  590. * Arguments  : prio      is the priority of the task that you want to obtain the name from.
  591. *
  592. *              pname     is a pointer to an ASCII string that will receive the name of the task.  
  593. *
  594. *              perr      is a pointer to an error code that can contain one of the following values:
  595. *
  596. *                        OS_ERR_NONE                if the requested task is resumed
  597. *                        OS_ERR_TASK_NOT_EXIST      if the task has not been created or is assigned to a Mutex
  598. *                        OS_ERR_PRIO_INVALID        if you specified an invalid priority:
  599. *                                                   A higher value than the idle task or not OS_PRIO_SELF.
  600. *                        OS_ERR_PNAME_NULL          You passed a NULL pointer for 'pname'
  601. *                        OS_ERR_NAME_GET_ISR        You called this function from an ISR
  602. *                        
  603. *
  604. * Returns    : The length of the string or 0 if the task does not exist.
  605. *********************************************************************************************************
  606. */
  607. #if OS_TASK_NAME_EN > 0
  608. INT8U  OSTaskNameGet (INT8U   prio, 
  609.                       INT8U  *pname, 
  610.                       INT8U  *perr)
  611. {
  612.     OS_TCB    *ptcb;
  613.     INT8U      len;
  614. #if OS_CRITICAL_METHOD == 3                              /* Allocate storage for CPU status register   */
  615.     OS_CPU_SR  cpu_sr = 0;
  616. #endif
  617. #if OS_ARG_CHK_EN > 0
  618.     if (perr == (INT8U *)0) {                            /* Validate 'perr'                            */
  619.         return (0);
  620.     }
  621.     if (prio > OS_LOWEST_PRIO) {                         /* Task priority valid ?                      */
  622.         if (prio != OS_PRIO_SELF) {
  623.             *perr = OS_ERR_PRIO_INVALID;                 /* No                                         */
  624.             return (0);
  625.         }
  626.     }
  627.     if (pname == (INT8U *)0) {                           /* Is 'pname' a NULL pointer?                 */
  628.         *perr = OS_ERR_PNAME_NULL;                       /* Yes                                        */
  629.         return (0);
  630.     }
  631. #endif
  632.     if (OSIntNesting > 0) {                              /* See if trying to call from an ISR          */
  633.         *perr = OS_ERR_NAME_GET_ISR;
  634.         return (0);
  635.     }
  636.     OS_ENTER_CRITICAL();
  637.     if (prio == OS_PRIO_SELF) {                          /* See if caller desires it's own name        */
  638.         prio = OSTCBCur->OSTCBPrio;
  639.     }
  640.     ptcb = OSTCBPrioTbl[prio];
  641.     if (ptcb == (OS_TCB *)0) {                           /* Does task exist?                           */
  642.         OS_EXIT_CRITICAL();                              /* No                                         */
  643.         *perr = OS_ERR_TASK_NOT_EXIST;
  644.         return (0);
  645.     }
  646.     if (ptcb == OS_TCB_RESERVED) {                       /* Task assigned to a Mutex?                  */
  647.         OS_EXIT_CRITICAL();                              /* Yes                                        */
  648.         *perr = OS_ERR_TASK_NOT_EXIST;
  649.         return (0);
  650.     }
  651.     pname = ptcb->OSTCBTaskName;
  652.     len   = OS_StrLen(pname); 
  653.     OS_EXIT_CRITICAL();
  654.     *perr = OS_ERR_NONE;
  655.     return (len);
  656. }
  657. #endif
  658. /*$PAGE*/
  659. /*
  660. *********************************************************************************************************
  661. *                                        ASSIGN A NAME TO A TASK
  662. *
  663. * Description: This function is used to set the name of a task.
  664. *
  665. * Arguments  : prio      is the priority of the task that you want the assign a name to.
  666. *
  667. *              pname     is a pointer to an ASCII string that contains the name of the task.
  668. *
  669. *              perr       is a pointer to an error code that can contain one of the following values:
  670. *
  671. *                        OS_ERR_NONE                if the requested task is resumed
  672. *                        OS_ERR_TASK_NOT_EXIST      if the task has not been created or is assigned to a Mutex
  673. *                        OS_ERR_PNAME_NULL          You passed a NULL pointer for 'pname'
  674. *                        OS_ERR_PRIO_INVALID        if you specified an invalid priority:
  675. *                                                   A higher value than the idle task or not OS_PRIO_SELF.
  676. *                        OS_ERR_NAME_SET_ISR        if you called this function from an ISR
  677. *
  678. * Returns    : None
  679. *********************************************************************************************************
  680. */
  681. #if OS_TASK_NAME_EN > 0
  682. void  OSTaskNameSet (INT8U   prio, 
  683.                      INT8U  *pname, 
  684.                      INT8U  *perr)
  685. {
  686.     OS_TCB    *ptcb;
  687. #if OS_CRITICAL_METHOD == 3                          /* Allocate storage for CPU status register       */
  688.     OS_CPU_SR  cpu_sr = 0;
  689. #endif
  690. #if OS_ARG_CHK_EN > 0
  691.     if (perr == (INT8U *)0) {                        /* Validate 'perr'                                */
  692.         return;
  693.     }
  694.     if (prio > OS_LOWEST_PRIO) {                     /* Task priority valid ?                          */
  695.         if (prio != OS_PRIO_SELF) {
  696.             *perr = OS_ERR_PRIO_INVALID;             /* No                                             */
  697.             return;
  698.         }
  699.     }
  700.     if (pname == (INT8U *)0) {                       /* Is 'pname' a NULL pointer?                     */
  701.         *perr = OS_ERR_PNAME_NULL;                   /* Yes                                            */
  702.         return;
  703.     }
  704. #endif
  705.     if (OSIntNesting > 0) {                          /* See if trying to call from an ISR              */
  706.         *perr = OS_ERR_NAME_SET_ISR;
  707.         return;
  708.     }
  709.     OS_ENTER_CRITICAL();
  710.     if (prio == OS_PRIO_SELF) {                      /* See if caller desires to set it's own name     */
  711.         prio = OSTCBCur->OSTCBPrio;
  712.     }
  713.     ptcb = OSTCBPrioTbl[prio];
  714.     if (ptcb == (OS_TCB *)0) {                       /* Does task exist?                               */
  715.         OS_EXIT_CRITICAL();                          /* No                                             */
  716.         *perr = OS_ERR_TASK_NOT_EXIST;
  717.         return;
  718.     }
  719.     if (ptcb == OS_TCB_RESERVED) {                   /* Task assigned to a Mutex?                      */
  720.         OS_EXIT_CRITICAL();                          /* Yes                                            */
  721.         *perr = OS_ERR_TASK_NOT_EXIST;
  722.         return;
  723.     }
  724.     ptcb->OSTCBTaskName = pname;
  725.     OS_EXIT_CRITICAL();
  726.     *perr               = OS_ERR_NONE;
  727. }
  728. #endif
  729. /*$PAGE*/
  730. /*
  731. *********************************************************************************************************
  732. *                                        RESUME A SUSPENDED TASK
  733. *
  734. * Description: This function is called to resume a previously suspended task.  This is the only call that
  735. *              will remove an explicit task suspension.
  736. *
  737. * Arguments  : prio     is the priority of the task to resume.
  738. *
  739. * Returns    : OS_ERR_NONE                if the requested task is resumed
  740. *              OS_ERR_PRIO_INVALID        if the priority you specify is higher that the maximum allowed
  741. *                                         (i.e. >= OS_LOWEST_PRIO)
  742. *              OS_ERR_TASK_RESUME_PRIO    if the task to resume does not exist
  743. *              OS_ERR_TASK_NOT_EXIST      if the task is assigned to a Mutex PIP
  744. *              OS_ERR_TASK_NOT_SUSPENDED  if the task to resume has not been suspended
  745. *********************************************************************************************************
  746. */
  747. #if OS_TASK_SUSPEND_EN > 0
  748. INT8U  OSTaskResume (INT8U prio)
  749. {
  750.     OS_TCB    *ptcb;
  751. #if OS_CRITICAL_METHOD == 3                                   /* Storage for CPU status register       */
  752.     OS_CPU_SR  cpu_sr = 0;
  753. #endif
  754. #if OS_ARG_CHK_EN > 0
  755.     if (prio >= OS_LOWEST_PRIO) {                             /* Make sure task priority is valid      */
  756.         return (OS_ERR_PRIO_INVALID);
  757.     }
  758. #endif
  759.     OS_ENTER_CRITICAL();
  760.     ptcb = OSTCBPrioTbl[prio];
  761.     if (ptcb == (OS_TCB *)0) {                                /* Task to suspend must exist            */
  762.         OS_EXIT_CRITICAL();
  763.         return (OS_ERR_TASK_RESUME_PRIO);
  764.     }
  765.     if (ptcb == OS_TCB_RESERVED) {                            /* See if assigned to Mutex              */
  766.         OS_EXIT_CRITICAL();
  767.         return (OS_ERR_TASK_NOT_EXIST);
  768.     }
  769.     if ((ptcb->OSTCBStat & OS_STAT_SUSPEND) != OS_STAT_RDY) { /* Task must be suspended                */
  770.         ptcb->OSTCBStat &= ~(INT8U)OS_STAT_SUSPEND;           /* Remove suspension                     */
  771.         if (ptcb->OSTCBStat == OS_STAT_RDY) {                 /* See if task is now ready              */
  772.             if (ptcb->OSTCBDly == 0) {
  773.                 OSRdyGrp               |= ptcb->OSTCBBitY;    /* Yes, Make task ready to run           */
  774.                 OSRdyTbl[ptcb->OSTCBY] |= ptcb->OSTCBBitX;
  775.                 OS_EXIT_CRITICAL();
  776.                 if (OSRunning == OS_TRUE) {
  777.                     OS_Sched();                               /* Find new highest priority task        */
  778.                 }
  779.             } else {
  780.                 OS_EXIT_CRITICAL();
  781.             }
  782.         } else {                                              /* Must be pending on event              */
  783.             OS_EXIT_CRITICAL();
  784.         }
  785.         return (OS_ERR_NONE);
  786.     }
  787.     OS_EXIT_CRITICAL();
  788.     return (OS_ERR_TASK_NOT_SUSPENDED);
  789. }
  790. #endif
  791. /*$PAGE*/
  792. /*
  793. *********************************************************************************************************
  794. *                                             STACK CHECKING
  795. *
  796. * Description: This function is called to check the amount of free memory left on the specified task's
  797. *              stack.
  798. *
  799. * Arguments  : prio          is the task priority
  800. *
  801. *              p_stk_data    is a pointer to a data structure of type OS_STK_DATA.
  802. *
  803. * Returns    : OS_ERR_NONE            upon success
  804. *              OS_ERR_PRIO_INVALID    if the priority you specify is higher that the maximum allowed
  805. *                                     (i.e. > OS_LOWEST_PRIO) or, you have not specified OS_PRIO_SELF.
  806. *              OS_ERR_TASK_NOT_EXIST  if the desired task has not been created or is assigned to a Mutex PIP
  807. *              OS_ERR_TASK_OPT        if you did NOT specified OS_TASK_OPT_STK_CHK when the task was created
  808. *              OS_ERR_PDATA_NULL      if 'p_stk_data' is a NULL pointer
  809. *********************************************************************************************************
  810. */
  811. #if (OS_TASK_STAT_STK_CHK_EN > 0) && (OS_TASK_CREATE_EXT_EN > 0)
  812. INT8U  OSTaskStkChk (INT8U         prio, 
  813.                      OS_STK_DATA  *p_stk_data)
  814. {
  815.     OS_TCB    *ptcb;
  816.     OS_STK    *pchk;
  817.     INT32U     nfree;
  818.     INT32U     size;
  819. #if OS_CRITICAL_METHOD == 3                            /* Allocate storage for CPU status register     */
  820.     OS_CPU_SR  cpu_sr = 0;
  821. #endif
  822. #if OS_ARG_CHK_EN > 0
  823.     if (prio > OS_LOWEST_PRIO) {                       /* Make sure task priority is valid             */
  824.         if (prio != OS_PRIO_SELF) {
  825.             return (OS_ERR_PRIO_INVALID);
  826.         }
  827.     }
  828.     if (p_stk_data == (OS_STK_DATA *)0) {              /* Validate 'p_stk_data'                        */
  829.         return (OS_ERR_PDATA_NULL);
  830.     }
  831. #endif
  832.     p_stk_data->OSFree = 0;                            /* Assume failure, set to 0 size                */
  833.     p_stk_data->OSUsed = 0;
  834.     OS_ENTER_CRITICAL();
  835.     if (prio == OS_PRIO_SELF) {                        /* See if check for SELF                        */
  836.         prio = OSTCBCur->OSTCBPrio;
  837.     }
  838.     ptcb = OSTCBPrioTbl[prio];
  839.     if (ptcb == (OS_TCB *)0) {                         /* Make sure task exist                         */
  840.         OS_EXIT_CRITICAL();
  841.         return (OS_ERR_TASK_NOT_EXIST);
  842.     }
  843.     if (ptcb == OS_TCB_RESERVED) {
  844.         OS_EXIT_CRITICAL();
  845.         return (OS_ERR_TASK_NOT_EXIST);
  846.     }
  847.     if ((ptcb->OSTCBOpt & OS_TASK_OPT_STK_CHK) == 0) { /* Make sure stack checking option is set       */
  848.         OS_EXIT_CRITICAL();
  849.         return (OS_ERR_TASK_OPT);
  850.     }
  851.     nfree = 0;
  852.     size  = ptcb->OSTCBStkSize;
  853.     pchk  = ptcb->OSTCBStkBottom;
  854.     OS_EXIT_CRITICAL();
  855. #if OS_STK_GROWTH == 1
  856.     while (*pchk++ == (OS_STK)0) {                    /* Compute the number of zero entries on the stk */
  857.         nfree++;
  858.     }
  859. #else
  860.     while (*pchk-- == (OS_STK)0) {
  861.         nfree++;
  862.     }
  863. #endif
  864.     p_stk_data->OSFree = nfree * sizeof(OS_STK);          /* Compute number of free bytes on the stack */
  865.     p_stk_data->OSUsed = (size - nfree) * sizeof(OS_STK); /* Compute number of bytes used on the stack */
  866.     return (OS_ERR_NONE);
  867. }
  868. #endif
  869. /*$PAGE*/
  870. /*
  871. *********************************************************************************************************
  872. *                                            SUSPEND A TASK
  873. *
  874. * Description: This function is called to suspend a task.  The task can be the calling task if the
  875. *              priority passed to OSTaskSuspend() is the priority of the calling task or OS_PRIO_SELF.
  876. *
  877. * Arguments  : prio     is the priority of the task to suspend.  If you specify OS_PRIO_SELF, the
  878. *                       calling task will suspend itself and rescheduling will occur.
  879. *
  880. * Returns    : OS_ERR_NONE               if the requested task is suspended
  881. *              OS_ERR_TASK_SUSPEND_IDLE  if you attempted to suspend the idle task which is not allowed.
  882. *              OS_ERR_PRIO_INVALID       if the priority you specify is higher that the maximum allowed
  883. *                                        (i.e. >= OS_LOWEST_PRIO) or, you have not specified OS_PRIO_SELF.
  884. *              OS_ERR_TASK_SUSPEND_PRIO  if the task to suspend does not exist
  885. *              OS_ERR_TASK_NOT_EXITS     if the task is assigned to a Mutex PIP
  886. *
  887. * Note       : You should use this function with great care.  If you suspend a task that is waiting for
  888. *              an event (i.e. a message, a semaphore, a queue ...) you will prevent this task from
  889. *              running when the event arrives.
  890. *********************************************************************************************************
  891. */
  892. #if OS_TASK_SUSPEND_EN > 0
  893. INT8U  OSTaskSuspend (INT8U prio)
  894. {
  895.     BOOLEAN    self;
  896.     OS_TCB    *ptcb;
  897.     INT8U      y;
  898. #if OS_CRITICAL_METHOD == 3                      /* Allocate storage for CPU status register           */
  899.     OS_CPU_SR  cpu_sr = 0;
  900. #endif
  901. #if OS_ARG_CHK_EN > 0
  902.     if (prio == OS_TASK_IDLE_PRIO) {                            /* Not allowed to suspend idle task    */
  903.         return (OS_ERR_TASK_SUSPEND_IDLE);
  904.     }
  905.     if (prio >= OS_LOWEST_PRIO) {                               /* Task priority valid ?               */
  906.         if (prio != OS_PRIO_SELF) {
  907.             return (OS_ERR_PRIO_INVALID);
  908.         }
  909.     }
  910. #endif
  911.     OS_ENTER_CRITICAL();
  912.     if (prio == OS_PRIO_SELF) {                                 /* See if suspend SELF                 */
  913.         prio = OSTCBCur->OSTCBPrio;
  914.         self = OS_TRUE;
  915.     } else if (prio == OSTCBCur->OSTCBPrio) {                   /* See if suspending self              */
  916.         self = OS_TRUE;
  917.     } else {
  918.         self = OS_FALSE;                                        /* No suspending another task          */
  919.     }
  920.     ptcb = OSTCBPrioTbl[prio];
  921.     if (ptcb == (OS_TCB *)0) {                                  /* Task to suspend must exist          */
  922.         OS_EXIT_CRITICAL();
  923.         return (OS_ERR_TASK_SUSPEND_PRIO);
  924.     }
  925.     if (ptcb == OS_TCB_RESERVED) {                              /* See if assigned to Mutex            */
  926.         OS_EXIT_CRITICAL();
  927.         return (OS_ERR_TASK_NOT_EXIST);
  928.     }
  929.     y            = ptcb->OSTCBY;
  930.     OSRdyTbl[y] &= ~ptcb->OSTCBBitX;                            /* Make task not ready                 */
  931.     if (OSRdyTbl[y] == 0) {
  932.         OSRdyGrp &= ~ptcb->OSTCBBitY;
  933.     }
  934.     ptcb->OSTCBStat |= OS_STAT_SUSPEND;                         /* Status of task is 'SUSPENDED'       */
  935.     OS_EXIT_CRITICAL();
  936.     if (self == OS_TRUE) {                                      /* Context switch only if SELF         */
  937.         OS_Sched();                                             /* Find new highest priority task      */
  938.     }
  939.     return (OS_ERR_NONE);
  940. }
  941. #endif
  942. /*$PAGE*/
  943. /*
  944. *********************************************************************************************************
  945. *                                            QUERY A TASK
  946. *
  947. * Description: This function is called to obtain a copy of the desired task's TCB.
  948. *
  949. * Arguments  : prio         is the priority of the task to obtain information from.
  950. *
  951. *              p_task_data  is a pointer to where the desired task's OS_TCB will be stored.
  952. *
  953. * Returns    : OS_ERR_NONE            if the requested task is suspended
  954. *              OS_ERR_PRIO_INVALID    if the priority you specify is higher that the maximum allowed
  955. *                                     (i.e. > OS_LOWEST_PRIO) or, you have not specified OS_PRIO_SELF.
  956. *              OS_ERR_PRIO            if the desired task has not been created
  957. *              OS_ERR_TASK_NOT_EXIST  if the task is assigned to a Mutex PIP
  958. *              OS_ERR_PDATA_NULL      if 'p_task_data' is a NULL pointer
  959. *********************************************************************************************************
  960. */
  961. #if OS_TASK_QUERY_EN > 0
  962. INT8U  OSTaskQuery (INT8U    prio, 
  963.                     OS_TCB  *p_task_data)
  964. {
  965.     OS_TCB    *ptcb;
  966. #if OS_CRITICAL_METHOD == 3                      /* Allocate storage for CPU status register           */
  967.     OS_CPU_SR  cpu_sr = 0;
  968. #endif
  969. #if OS_ARG_CHK_EN > 0
  970.     if (prio > OS_LOWEST_PRIO) {                 /* Task priority valid ?                              */
  971.         if (prio != OS_PRIO_SELF) {
  972.             return (OS_ERR_PRIO_INVALID);
  973.         }
  974.     }
  975.     if (p_task_data == (OS_TCB *)0) {            /* Validate 'p_task_data'                             */
  976.         return (OS_ERR_PDATA_NULL);
  977.     }
  978. #endif
  979.     OS_ENTER_CRITICAL();
  980.     if (prio == OS_PRIO_SELF) {                  /* See if suspend SELF                                */
  981.         prio = OSTCBCur->OSTCBPrio;
  982.     }
  983.     ptcb = OSTCBPrioTbl[prio];
  984.     if (ptcb == (OS_TCB *)0) {                   /* Task to query must exist                           */
  985.         OS_EXIT_CRITICAL();
  986.         return (OS_ERR_PRIO);
  987.     }
  988.     if (ptcb == OS_TCB_RESERVED) {               /* Task to query must not be assigned to a Mutex      */
  989.         OS_EXIT_CRITICAL();
  990.         return (OS_ERR_TASK_NOT_EXIST);
  991.     }
  992.                                                  /* Copy TCB into user storage area                    */
  993.     OS_MemCopy((INT8U *)p_task_data, (INT8U *)ptcb, sizeof(OS_TCB));
  994.     OS_EXIT_CRITICAL();
  995.     return (OS_ERR_NONE);
  996. }
  997. #endif
  998. /*$PAGE*/
  999. /*
  1000. *********************************************************************************************************
  1001. *                                 GET THE CURRENT VALUE OF A TASK REGISTER
  1002. *
  1003. * Description: This function is called to obtain the current value of a task register.  Task registers
  1004. *              are application specific and can be used to store task specific values such as 'error 
  1005. *              numbers' (i.e. errno), statistics, etc.  Each task register can hold a 32-bit value.
  1006. *
  1007. * Arguments  : prio      is the priority of the task you want to get the task register from.  If you
  1008. *                        specify OS_PRIO_SELF then the task register of the current task will be obtained.
  1009. *
  1010. *              id        is the 'id' of the desired task register.  Note that the 'id' must be less
  1011. *                        than OS_TASK_REG_TBL_SIZE
  1012. *
  1013. *              perr      is a pointer to a variable that will hold an error code related to this call.
  1014. *
  1015. *                        OS_ERR_NONE            if the call was successful
  1016. *                        OS_ERR_PRIO_INVALID    if you specified an invalid priority
  1017. *                        OS_ERR_ID_INVALID      if the 'id' is not between 0 and OS_TASK_REG_TBL_SIZE-1
  1018. *
  1019. * Returns    : The current value of the task's register or 0 if an error is detected.
  1020. *
  1021. * Note(s)    : The maximum number of task variables is 254
  1022. *********************************************************************************************************
  1023. */
  1024. #if OS_TASK_REG_TBL_SIZE > 0
  1025. INT32U  OSTaskRegGet (INT8U   prio,
  1026.                       INT8U   id,
  1027.                       INT8U  *perr)
  1028. {
  1029. #if OS_CRITICAL_METHOD == 3                      /* Allocate storage for CPU status register           */
  1030.     OS_CPU_SR  cpu_sr = 0;
  1031. #endif
  1032.     INT32U     value;
  1033.     OS_TCB    *ptcb;
  1034. #if OS_ARG_CHK_EN > 0
  1035.     if (prio >= OS_LOWEST_PRIO) {
  1036.         if (prio != OS_PRIO_SELF) {
  1037.             *perr = OS_ERR_PRIO_INVALID;
  1038.             return (0);
  1039.         }
  1040.     }
  1041.     if (id >= OS_TASK_REG_TBL_SIZE) {
  1042.         *perr = OS_ERR_ID_INVALID;
  1043.         return (0);
  1044.     }
  1045. #endif
  1046.     OS_ENTER_CRITICAL();
  1047.     if (prio == OS_PRIO_SELF) {                  /* See if need to get register from current task      */
  1048.         ptcb = OSTCBCur;
  1049.     } else {
  1050.         ptcb = OSTCBPrioTbl[prio];
  1051.     }
  1052.     value = ptcb->OSTCBRegTbl[id];
  1053.     OS_EXIT_CRITICAL();
  1054.     *perr = OS_ERR_NONE;
  1055.     return (value);    
  1056. }                                       
  1057. #endif                                       
  1058.                                        
  1059. /*$PAGE*/
  1060. /*
  1061. *********************************************************************************************************
  1062. *                                 SET THE CURRENT VALUE OF A TASK VARIABLE
  1063. *
  1064. * Description: This function is called to change the current value of a task register.  Task registers
  1065. *              are application specific and can be used to store task specific values such as 'error 
  1066. *              numbers' (i.e. errno), statistics, etc.  Each task register can hold a 32-bit value.
  1067. *
  1068. * Arguments  : prio      is the priority of the task you want to set the task register for.  If you
  1069. *                        specify OS_PRIO_SELF then the task register of the current task will be obtained.
  1070. *
  1071. *              var_id    is the 'id' of the desired task register.  Note that the 'id' must be less
  1072. *                        than OS_TASK_REG_TBL_SIZE
  1073. *
  1074. *              value     is the desired value for the task register.
  1075. *
  1076. *              perr      is a pointer to a variable that will hold an error code related to this call.
  1077. *
  1078. *                        OS_ERR_NONE            if the call was successful
  1079. *                        OS_ERR_PRIO_INVALID    if you specified an invalid priority
  1080. *                        OS_ERR_ID_INVALID      if the 'id' is not between 0 and OS_TASK_REG_TBL_SIZE-1
  1081. *
  1082. * Returns    : The current value of the task's variable or 0 if an error is detected.
  1083. *
  1084. * Note(s)    : The maximum number of task variables is 254
  1085. *********************************************************************************************************
  1086. */
  1087. #if OS_TASK_REG_TBL_SIZE > 0
  1088. void  OSTaskRegSet (INT8U    prio,
  1089.                     INT8U    id,
  1090.                     INT32U   value,
  1091.                     INT8U   *perr)
  1092. {
  1093. #if OS_CRITICAL_METHOD == 3                      /* Allocate storage for CPU status register           */
  1094.     OS_CPU_SR  cpu_sr = 0;
  1095. #endif
  1096.     OS_TCB    *ptcb;
  1097. #if OS_ARG_CHK_EN > 0
  1098.     if (prio >= OS_LOWEST_PRIO) {
  1099.         if (prio != OS_PRIO_SELF) {
  1100.             *perr = OS_ERR_PRIO_INVALID;
  1101.             return;
  1102.         }
  1103.     }
  1104.     if (id >= OS_TASK_REG_TBL_SIZE) {
  1105.         *perr = OS_ERR_ID_INVALID;
  1106.         return;
  1107.     }
  1108. #endif
  1109.     OS_ENTER_CRITICAL();
  1110.     if (prio == OS_PRIO_SELF) {                  /* See if need to get register from current task      */
  1111.         ptcb = OSTCBCur;
  1112.     } else {
  1113.         ptcb = OSTCBPrioTbl[prio];
  1114.     }
  1115.     ptcb->OSTCBRegTbl[id] = value;
  1116.     OS_EXIT_CRITICAL();
  1117.     *perr                 = OS_ERR_NONE;
  1118. }
  1119. #endif
  1120.                                        
  1121. /*
  1122. *********************************************************************************************************
  1123. *                                        CLEAR TASK STACK
  1124. *
  1125. * Description: This function is used to clear the stack of a task (i.e. write all zeros)
  1126. *
  1127. * Arguments  : pbos     is a pointer to the task's bottom of stack.  If the configuration constant
  1128. *                       OS_STK_GROWTH is set to 1, the stack is assumed to grow downward (i.e. from high
  1129. *                       memory to low memory).  'pbos' will thus point to the lowest (valid) memory
  1130. *                       location of the stack.  If OS_STK_GROWTH is set to 0, 'pbos' will point to the
  1131. *                       highest memory location of the stack and the stack will grow with increasing
  1132. *                       memory locations.  'pbos' MUST point to a valid 'free' data item.
  1133. *
  1134. *              size     is the number of 'stack elements' to clear.
  1135. *
  1136. *              opt      contains additional information (or options) about the behavior of the task.  The
  1137. *                       LOWER 8-bits are reserved by uC/OS-II while the upper 8 bits can be application
  1138. *                       specific.  See OS_TASK_OPT_??? in uCOS-II.H.
  1139. *
  1140. * Returns    : none
  1141. *********************************************************************************************************
  1142. */
  1143. #if (OS_TASK_STAT_STK_CHK_EN > 0) && (OS_TASK_CREATE_EXT_EN > 0)
  1144. void  OS_TaskStkClr (OS_STK  *pbos, 
  1145.                      INT32U   size, 
  1146.                      INT16U   opt)
  1147. {
  1148.     if ((opt & OS_TASK_OPT_STK_CHK) != 0x0000) {       /* See if stack checking has been enabled       */
  1149.         if ((opt & OS_TASK_OPT_STK_CLR) != 0x0000) {   /* See if stack needs to be cleared             */
  1150. #if OS_STK_GROWTH == 1
  1151.             while (size > 0) {                         /* Stack grows from HIGH to LOW memory          */
  1152.                 size--;
  1153.                 *pbos++ = (OS_STK)0;                   /* Clear from bottom of stack and up!           */
  1154.             }
  1155. #else
  1156.             while (size > 0) {                         /* Stack grows from LOW to HIGH memory          */
  1157.                 size--;
  1158.                 *pbos-- = (OS_STK)0;                   /* Clear from bottom of stack and down          */
  1159.             }
  1160. #endif
  1161.         }
  1162.     }
  1163. }
  1164. #endif