OS_FLAG.C
上传用户:tzjinxin1
上传日期:2022-08-08
资源大小:272k
文件大小:44k
开发平台:

Visual C++

  1. /*
  2. *********************************************************************************************************
  3. *                                                uC/OS-II
  4. *                                          The Real-Time Kernel
  5. *                                         EVENT FLAG  MANAGEMENT
  6. *
  7. *                            (c) Copyright 2001, Jean J. Labrosse, Weston, FL
  8. *                                           All Rights Reserved
  9. *
  10. * File : OS_FLAG.C
  11. * By   : Jean J. Labrosse
  12. *********************************************************************************************************
  13. */
  14. #ifndef  OS_MASTER_FILE
  15. #include "sourceincludes.h"
  16. #endif
  17. #if (OS_VERSION >= 251) && (OS_FLAG_EN > 0) && (OS_MAX_FLAGS > 0)
  18. /*
  19. *********************************************************************************************************
  20. *                                            LOCAL PROTOTYPES
  21. *********************************************************************************************************
  22. */
  23. static  void     OS_FlagBlock(OS_FLAG_GRP *pgrp, OS_FLAG_NODE *pnode, OS_FLAGS flags, INT8U wait_type, INT16U timeout) reentrant;
  24. static  BOOLEAN  OS_FlagTaskRdy(OS_FLAG_NODE *pnode, OS_FLAGS flags_rdy) reentrant;
  25. /*$PAGE*/
  26. /*
  27. *********************************************************************************************************
  28. *                              CHECK THE STATUS OF FLAGS IN AN EVENT FLAG GROUP
  29. *
  30. * Description: This function is called to check the status of a combination of bits to be set or cleared
  31. *              in an event flag group.  Your application can check for ANY bit to be set/cleared or ALL 
  32. *              bits to be set/cleared.
  33. *
  34. *              This call does not block if the desired flags are not present.
  35. *
  36. * Arguments  : pgrp          is a pointer to the desired event flag group.
  37. *
  38. *              flags         Is a bit pattern indicating which bit(s) (i.e. flags) you wish to check.  
  39. *                            The bits you want are specified by setting the corresponding bits in 
  40. *                            'flags'.  e.g. if your application wants to wait for bits 0 and 1 then 
  41. *                            'flags' would contain 0x03.
  42. *
  43. *              wait_type     specifies whether you want ALL bits to be set/cleared or ANY of the bits 
  44. *                            to be set/cleared.
  45. *                            You can specify the following argument:
  46. *
  47. *                            OS_FLAG_WAIT_CLR_ALL   You will check ALL bits in 'flags' to be clear (0)
  48. *                            OS_FLAG_WAIT_CLR_ANY   You will check ANY bit  in 'flags' to be clear (0)
  49. *                            OS_FLAG_WAIT_SET_ALL   You will check ALL bits in 'flags' to be set   (1)
  50. *                            OS_FLAG_WAIT_SET_ANY   You will check ANY bit  in 'flags' to be set   (1)
  51. *
  52. *                            NOTE: Add OS_FLAG_CONSUME if you want the event flag to be 'consumed' by
  53. *                                  the call.  Example, to wait for any flag in a group AND then clear
  54. *                                  the flags that are present, set 'wait_type' to:
  55. *
  56. *                                  OS_FLAG_WAIT_SET_ANY + OS_FLAG_CONSUME
  57. *
  58. *              err           is a pointer to an error code and can be:
  59. *                            OS_NO_ERR              No error
  60. *                            OS_ERR_EVENT_TYPE      You are not pointing to an event flag group
  61. *                            OS_FLAG_ERR_WAIT_TYPE  You didn't specify a proper 'wait_type' argument.
  62. *                            OS_FLAG_INVALID_PGRP   You passed a NULL pointer instead of the event flag
  63. *                                                   group handle.
  64. *                            OS_FLAG_ERR_NOT_RDY    The desired flags you are waiting for are not 
  65. *                                                   available.
  66. *
  67. * Returns    : The state of the flags in the event flag group.
  68. *
  69. * Called from: Task or ISR
  70. *********************************************************************************************************
  71. */
  72. #if OS_FLAG_ACCEPT_EN > 0
  73. OS_FLAGS  OSFlagAccept (OS_FLAG_GRP *pgrp, OS_FLAGS flags, INT8U wait_type, INT8U *err) reentrant
  74. {
  75. #if OS_CRITICAL_METHOD == 3                                /* Allocate storage for CPU status register */
  76.     OS_CPU_SR     cpu_sr;
  77. #endif    
  78.     OS_FLAGS      flags_cur;
  79.     OS_FLAGS      flags_rdy;
  80.     BOOLEAN       consume;
  81. #if OS_ARG_CHK_EN > 0
  82.     if (pgrp == (OS_FLAG_GRP *)0) {                        /* Validate 'pgrp'                          */
  83.         *err = OS_FLAG_INVALID_PGRP;
  84.         return ((OS_FLAGS)0);
  85.     }
  86.     if (pgrp->OSFlagType != OS_EVENT_TYPE_FLAG) {          /* Validate event block type                */
  87.         *err = OS_ERR_EVENT_TYPE;
  88.         return ((OS_FLAGS)0);
  89.     }
  90. #endif
  91.     if (wait_type & OS_FLAG_CONSUME) {                     /* See if we need to consume the flags      */
  92.         wait_type &= ~OS_FLAG_CONSUME;
  93.         consume    = TRUE;
  94.     } else {
  95.         consume    = FALSE;
  96.     }
  97. /*$PAGE*/
  98.     *err = OS_NO_ERR;                                      /* Assume NO error until proven otherwise.  */
  99.     OS_ENTER_CRITICAL();
  100.     switch (wait_type) {
  101.         case OS_FLAG_WAIT_SET_ALL:                         /* See if all required flags are set        */
  102.              flags_rdy = pgrp->OSFlagFlags & flags;        /* Extract only the bits we want            */
  103.              if (flags_rdy == flags) {                     /* Must match ALL the bits that we want     */
  104.                  if (consume == TRUE) {                    /* See if we need to consume the flags      */
  105.                      pgrp->OSFlagFlags &= ~flags_rdy;      /* Clear ONLY the flags that we wanted      */
  106.                  }
  107.              } else {
  108.                  *err  = OS_FLAG_ERR_NOT_RDY;
  109.              }
  110.              flags_cur = pgrp->OSFlagFlags;                /* Will return the state of the group       */
  111.              OS_EXIT_CRITICAL();
  112.              break;
  113.         case OS_FLAG_WAIT_SET_ANY:
  114.              flags_rdy = pgrp->OSFlagFlags & flags;        /* Extract only the bits we want            */
  115.              if (flags_rdy != (OS_FLAGS)0) {               /* See if any flag set                      */
  116.                  if (consume == TRUE) {                    /* See if we need to consume the flags      */
  117.                      pgrp->OSFlagFlags &= ~flags_rdy;      /* Clear ONLY the flags that we got         */
  118.                  }
  119.              } else {
  120.                  *err  = OS_FLAG_ERR_NOT_RDY;
  121.              }
  122.              flags_cur = pgrp->OSFlagFlags;                /* Will return the state of the group       */
  123.              OS_EXIT_CRITICAL();
  124.              break;
  125. #if OS_FLAG_WAIT_CLR_EN > 0
  126.         case OS_FLAG_WAIT_CLR_ALL:                         /* See if all required flags are cleared    */
  127.              flags_rdy = ~pgrp->OSFlagFlags & flags;       /* Extract only the bits we want            */
  128.              if (flags_rdy == flags) {                     /* Must match ALL the bits that we want     */
  129.                  if (consume == TRUE) {                    /* See if we need to consume the flags      */
  130.                      pgrp->OSFlagFlags |= flags_rdy;       /* Set ONLY the flags that we wanted        */
  131.                  }
  132.              } else {
  133.                  *err  = OS_FLAG_ERR_NOT_RDY;
  134.              }
  135.              flags_cur = pgrp->OSFlagFlags;                /* Will return the state of the group       */
  136.              OS_EXIT_CRITICAL();
  137.              break;
  138.         case OS_FLAG_WAIT_CLR_ANY:
  139.              flags_rdy = ~pgrp->OSFlagFlags & flags;       /* Extract only the bits we want            */
  140.              if (flags_rdy != (OS_FLAGS)0) {               /* See if any flag cleared                  */
  141.                  if (consume == TRUE) {                    /* See if we need to consume the flags      */
  142.                      pgrp->OSFlagFlags |= flags_rdy;       /* Set ONLY the flags that we got           */
  143.                  }
  144.              } else {
  145.                  *err  = OS_FLAG_ERR_NOT_RDY;
  146.              }
  147.              flags_cur = pgrp->OSFlagFlags;                /* Will return the state of the group       */
  148.              OS_EXIT_CRITICAL();
  149.              break;
  150. #endif
  151.         default:
  152.              OS_EXIT_CRITICAL();
  153.              flags_cur = (OS_FLAGS)0;
  154.              *err      = OS_FLAG_ERR_WAIT_TYPE;
  155.              break;
  156.     }
  157.     return (flags_cur);
  158. }
  159. #endif    
  160. /*$PAGE*/
  161. /*
  162. *********************************************************************************************************
  163. *                                           CREATE AN EVENT FLAG
  164. *
  165. * Description: This function is called to create an event flag group.
  166. *
  167. * Arguments  : flags         Contains the initial value to store in the event flag group.
  168. *
  169. *              err           is a pointer to an error code which will be returned to your application:
  170. *                               OS_NO_ERR                if the call was successful.
  171. *                               OS_ERR_CREATE_ISR        if you attempted to create an Event Flag from an 
  172. *                                                        ISR.
  173. *                               OS_FLAG_GRP_DEPLETED     if there are no more event flag groups
  174. *
  175. * Returns    : A pointer to an event flag group or a NULL pointer if no more groups are available.
  176. *
  177. * Called from: Task ONLY
  178. *********************************************************************************************************
  179. */
  180. OS_FLAG_GRP  *OSFlagCreate (OS_FLAGS flags, INT8U *err) reentrant
  181. {
  182. #if OS_CRITICAL_METHOD == 3                         /* Allocate storage for CPU status register        */
  183.     OS_CPU_SR    cpu_sr;
  184. #endif    
  185.     OS_FLAG_GRP *pgrp;
  186.     if (OSIntNesting > 0) {                         /* See if called from ISR ...                      */
  187.         *err = OS_ERR_CREATE_ISR;                   /* ... can't CREATE from an ISR                    */
  188.         return ((OS_FLAG_GRP *)0);               
  189.     }
  190.     OS_ENTER_CRITICAL();
  191.     pgrp = OSFlagFreeList;                          /* Get next free event flag                        */
  192.     if (pgrp != (OS_FLAG_GRP *)0) {                 /* See if we have event flag groups available      */
  193.                                                     /* Adjust free list                                */
  194.         OSFlagFreeList       = (OS_FLAG_GRP *)OSFlagFreeList->OSFlagWaitList;
  195.         pgrp->OSFlagType     = OS_EVENT_TYPE_FLAG;  /* Set to event flag group type                    */
  196.         pgrp->OSFlagFlags    = flags;               /* Set to desired initial value                    */
  197.         pgrp->OSFlagWaitList = (void *)0;           /* Clear list of tasks waiting on flags            */
  198.         OS_EXIT_CRITICAL();
  199.         *err                 = OS_NO_ERR;
  200.     } else {
  201.         OS_EXIT_CRITICAL();
  202.         *err                 = OS_FLAG_GRP_DEPLETED;
  203.     }
  204.     return (pgrp);                                  /* Return pointer to event flag group              */
  205. }
  206. /*$PAGE*/
  207. /*
  208. *********************************************************************************************************
  209. *                                     DELETE AN EVENT FLAG GROUP
  210. *
  211. * Description: This function deletes an event flag group and readies all tasks pending on the event flag
  212. *              group.
  213. *
  214. * Arguments  : pgrp          is a pointer to the desired event flag group.
  215. *
  216. *              opt           determines delete options as follows:
  217. *                            opt == OS_DEL_NO_PEND   Deletes the event flag group ONLY if no task pending
  218. *                            opt == OS_DEL_ALWAYS    Deletes the event flag group even if tasks are 
  219. *                                                    waiting.  In this case, all the tasks pending will be 
  220. *                                                    readied.
  221. *
  222. *              err           is a pointer to an error code that can contain one of the following values:
  223. *                            OS_NO_ERR               The call was successful and the event flag group was 
  224. *                                                    deleted
  225. *                            OS_ERR_DEL_ISR          If you attempted to delete the event flag group from 
  226. *                                                    an ISR
  227. *                            OS_FLAG_INVALID_PGRP    If 'pgrp' is a NULL pointer.
  228. *                            OS_ERR_EVENT_TYPE       You are not pointing to an event flag group
  229. *                            OS_ERR_EVENT_TYPE       If you didn't pass a pointer to an event flag group
  230. *                            OS_ERR_INVALID_OPT      An invalid option was specified
  231. *                            OS_ERR_TASK_WAITING     One or more tasks were waiting on the event flag 
  232. *                                                    group.
  233. *
  234. * Returns    : pevent        upon error
  235. *              (OS_EVENT *)0 if the semaphore was successfully deleted.
  236. *
  237. * Note(s)    : 1) This function must be used with care.  Tasks that would normally expect the presence of
  238. *                 the event flag group MUST check the return code of OSFlagAccept() and OSFlagPend().
  239. *              2) This call can potentially disable interrupts for a long time.  The interrupt disable
  240. *                 time is directly proportional to the number of tasks waiting on the event flag group.
  241. *********************************************************************************************************
  242. */
  243. #if OS_FLAG_DEL_EN > 0
  244. OS_FLAG_GRP  *OSFlagDel (OS_FLAG_GRP *pgrp, INT8U opt, INT8U *err) reentrant
  245. {
  246. #if OS_CRITICAL_METHOD == 3                                /* Allocate storage for CPU status register */
  247.     OS_CPU_SR     cpu_sr;
  248. #endif    
  249.     BOOLEAN       tasks_waiting;
  250.     OS_FLAG_NODE *pnode;
  251.     if (OSIntNesting > 0) {                                /* See if called from ISR ...               */
  252.         *err = OS_ERR_DEL_ISR;                             /* ... can't DELETE from an ISR             */
  253.         return (pgrp);
  254.     }
  255. #if OS_ARG_CHK_EN > 0
  256.     if (pgrp == (OS_FLAG_GRP *)0) {                        /* Validate 'pgrp'                          */
  257.         *err = OS_FLAG_INVALID_PGRP;
  258.         return (pgrp);
  259.     }
  260.     if (pgrp->OSFlagType != OS_EVENT_TYPE_FLAG) {          /* Validate event group type                */
  261.         *err = OS_ERR_EVENT_TYPE;
  262.         return (pgrp);
  263.     }
  264. #endif
  265.     OS_ENTER_CRITICAL();
  266.     if (pgrp->OSFlagWaitList != (void *)0) {               /* See if any tasks waiting on event flags  */
  267.         tasks_waiting = TRUE;                              /* Yes                                      */
  268.     } else {
  269.         tasks_waiting = FALSE;                             /* No                                       */
  270.     }
  271.     switch (opt) {
  272.         case OS_DEL_NO_PEND:                               /* Delete group if no task waiting          */
  273.              if (tasks_waiting == FALSE) {
  274.                  pgrp->OSFlagType     = OS_EVENT_TYPE_UNUSED;
  275.                  pgrp->OSFlagWaitList = (void *)OSFlagFreeList; /* Return group to free list           */
  276.                  OSFlagFreeList       = pgrp;
  277.                  OS_EXIT_CRITICAL();
  278.                  *err                 = OS_NO_ERR;
  279.                  return ((OS_FLAG_GRP *)0);                /* Event Flag Group has been deleted        */
  280.              } else {
  281.                  OS_EXIT_CRITICAL();
  282.                  *err                 = OS_ERR_TASK_WAITING;
  283.                  return (pgrp);
  284.              }
  285.         case OS_DEL_ALWAYS:                                /* Always delete the event flag group       */
  286.              pnode = pgrp->OSFlagWaitList;
  287.              while (pnode != (OS_FLAG_NODE *)0) {          /* Ready ALL tasks waiting for flags        */
  288.                  OS_FlagTaskRdy(pnode, (OS_FLAGS)0);
  289.                  pnode = pnode->OSFlagNodeNext;
  290.              }
  291.              pgrp->OSFlagType     = OS_EVENT_TYPE_UNUSED;
  292.              pgrp->OSFlagWaitList = (void *)OSFlagFreeList;/* Return group to free list                */
  293.              OSFlagFreeList       = pgrp;
  294.              OS_EXIT_CRITICAL();
  295.              if (tasks_waiting == TRUE) {                  /* Reschedule only if task(s) were waiting  */
  296.                  OS_Sched();                               /* Find highest priority task ready to run  */
  297.              }
  298.              *err = OS_NO_ERR;
  299.              return ((OS_FLAG_GRP *)0);                    /* Event Flag Group has been deleted        */
  300.         default:
  301.              OS_EXIT_CRITICAL();
  302.              *err = OS_ERR_INVALID_OPT;
  303.              return (pgrp);
  304.     }
  305. }
  306. #endif
  307. /*$PAGE*/
  308. /*
  309. *********************************************************************************************************
  310. *                                        WAIT ON AN EVENT FLAG GROUP
  311. *
  312. * Description: This function is called to wait for a combination of bits to be set in an event flag 
  313. *              group.  Your application can wait for ANY bit to be set or ALL bits to be set.
  314. *
  315. * Arguments  : pgrp          is a pointer to the desired event flag group.
  316. *
  317. *              flags         Is a bit pattern indicating which bit(s) (i.e. flags) you wish to wait for.  
  318. *                            The bits you want are specified by setting the corresponding bits in 
  319. *                            'flags'.  e.g. if your application wants to wait for bits 0 and 1 then 
  320. *                            'flags' would contain 0x03.
  321. *
  322. *              wait_type     specifies whether you want ALL bits to be set or ANY of the bits to be set.
  323. *                            You can specify the following argument:
  324. *
  325. *                            OS_FLAG_WAIT_CLR_ALL   You will wait for ALL bits in 'mask' to be clear (0)
  326. *                            OS_FLAG_WAIT_SET_ALL   You will wait for ALL bits in 'mask' to be set   (1)
  327. *                            OS_FLAG_WAIT_CLR_ANY   You will wait for ANY bit  in 'mask' to be clear (0)
  328. *                            OS_FLAG_WAIT_SET_ANY   You will wait for ANY bit  in 'mask' to be set   (1)
  329. *
  330. *                            NOTE: Add OS_FLAG_CONSUME if you want the event flag to be 'consumed' by
  331. *                                  the call.  Example, to wait for any flag in a group AND then clear
  332. *                                  the flags that are present, set 'wait_type' to:
  333. *
  334. *                                  OS_FLAG_WAIT_SET_ANY + OS_FLAG_CONSUME
  335. *
  336. *              timeout       is an optional timeout (in clock ticks) that your task will wait for the
  337. *                            desired bit combination.  If you specify 0, however, your task will wait
  338. *                            forever at the specified event flag group or, until a message arrives.
  339. *
  340. *              err           is a pointer to an error code and can be:
  341. *                            OS_NO_ERR              The desired bits have been set within the specified
  342. *                                                   'timeout'.
  343. *                            OS_ERR_PEND_ISR        If you tried to PEND from an ISR
  344. *                            OS_FLAG_INVALID_PGRP   If 'pgrp' is a NULL pointer.
  345. *                            OS_ERR_EVENT_TYPE      You are not pointing to an event flag group
  346. *                            OS_TIMEOUT             The bit(s) have not been set in the specified 
  347. *                                                   'timeout'.
  348. *                            OS_FLAG_ERR_WAIT_TYPE  You didn't specify a proper 'wait_type' argument.
  349. *
  350. * Returns    : The new state of the flags in the event flag group when the task is resumed or,
  351. *              0 if a timeout or an error occurred.
  352. *
  353. * Called from: Task ONLY
  354. *********************************************************************************************************
  355. */
  356. OS_FLAGS  OSFlagPend (OS_FLAG_GRP *pgrp, OS_FLAGS flags, INT8U wait_type, INT16U timeout, INT8U *err) reentrant
  357. {
  358. #if OS_CRITICAL_METHOD == 3                                /* Allocate storage for CPU status register */
  359.     OS_CPU_SR     cpu_sr;
  360. #endif    
  361.     OS_FLAG_NODE  node;
  362.     OS_FLAGS      flags_cur;
  363.     OS_FLAGS      flags_rdy;
  364.     BOOLEAN       consume;
  365.     if (OSIntNesting > 0) {                                /* See if called from ISR ...               */
  366.         *err = OS_ERR_PEND_ISR;                            /* ... can't PEND from an ISR               */
  367.         return ((OS_FLAGS)0);
  368.     }
  369. #if OS_ARG_CHK_EN > 0
  370.     if (pgrp == (OS_FLAG_GRP *)0) {                        /* Validate 'pgrp'                          */
  371.         *err = OS_FLAG_INVALID_PGRP;
  372.         return ((OS_FLAGS)0);
  373.     }
  374.     if (pgrp->OSFlagType != OS_EVENT_TYPE_FLAG) {          /* Validate event block type                */
  375.         *err = OS_ERR_EVENT_TYPE;
  376.         return ((OS_FLAGS)0);
  377.     }
  378. #endif
  379.     if (wait_type & OS_FLAG_CONSUME) {                     /* See if we need to consume the flags      */
  380.         wait_type &= ~OS_FLAG_CONSUME;
  381.         consume    = TRUE;
  382.     } else {
  383.         consume    = FALSE;
  384.     }
  385. /*$PAGE*/
  386.     OS_ENTER_CRITICAL();
  387.     switch (wait_type) {
  388.         case OS_FLAG_WAIT_SET_ALL:                         /* See if all required flags are set        */
  389.              flags_rdy = pgrp->OSFlagFlags & flags;        /* Extract only the bits we want            */
  390.              if (flags_rdy == flags) {                     /* Must match ALL the bits that we want     */
  391.                  if (consume == TRUE) {                    /* See if we need to consume the flags      */
  392.                      pgrp->OSFlagFlags &= ~flags_rdy;      /* Clear ONLY the flags that we wanted      */
  393.                  }
  394.                  flags_cur = pgrp->OSFlagFlags;            /* Will return the state of the group       */
  395.                  OS_EXIT_CRITICAL();                       /* Yes, condition met, return to caller     */
  396.                  *err      = OS_NO_ERR;
  397.                  return (flags_cur);
  398.              } else {                                      /* Block task until events occur or timeout */
  399.                  OS_FlagBlock(pgrp, &node, flags, wait_type, timeout); 
  400.                  OS_EXIT_CRITICAL();
  401.              }
  402.              break;
  403.         case OS_FLAG_WAIT_SET_ANY:
  404.              flags_rdy = pgrp->OSFlagFlags & flags;        /* Extract only the bits we want            */
  405.              if (flags_rdy != (OS_FLAGS)0) {               /* See if any flag set                      */
  406.                  if (consume == TRUE) {                    /* See if we need to consume the flags      */
  407.                      pgrp->OSFlagFlags &= ~flags_rdy;      /* Clear ONLY the flags that we got         */
  408.                  }
  409.                  flags_cur = pgrp->OSFlagFlags;            /* Will return the state of the group       */
  410.                  OS_EXIT_CRITICAL();                       /* Yes, condition met, return to caller     */
  411.                  *err      = OS_NO_ERR;
  412.                  return (flags_cur);
  413.              } else {                                      /* Block task until events occur or timeout */
  414.                  OS_FlagBlock(pgrp, &node, flags, wait_type, timeout); 
  415.                  OS_EXIT_CRITICAL();
  416.              }
  417.              break;
  418. #if OS_FLAG_WAIT_CLR_EN > 0
  419.         case OS_FLAG_WAIT_CLR_ALL:                         /* See if all required flags are cleared    */
  420.              flags_rdy = ~pgrp->OSFlagFlags & flags;       /* Extract only the bits we want            */
  421.              if (flags_rdy == flags) {                     /* Must match ALL the bits that we want     */
  422.                  if (consume == TRUE) {                    /* See if we need to consume the flags      */
  423.                      pgrp->OSFlagFlags |= flags_rdy;       /* Set ONLY the flags that we wanted        */
  424.                  }
  425.                  flags_cur = pgrp->OSFlagFlags;            /* Will return the state of the group       */
  426.                  OS_EXIT_CRITICAL();                       /* Yes, condition met, return to caller     */
  427.                  *err      = OS_NO_ERR;
  428.                  return (flags_cur);
  429.              } else {                                      /* Block task until events occur or timeout */
  430.                  OS_FlagBlock(pgrp, &node, flags, wait_type, timeout); 
  431.                  OS_EXIT_CRITICAL();
  432.              }
  433.              break;
  434.         case OS_FLAG_WAIT_CLR_ANY:
  435.              flags_rdy = ~pgrp->OSFlagFlags & flags;       /* Extract only the bits we want            */
  436.              if (flags_rdy != (OS_FLAGS)0) {               /* See if any flag cleared                  */
  437.                  if (consume == TRUE) {                    /* See if we need to consume the flags      */
  438.                      pgrp->OSFlagFlags |= flags_rdy;       /* Set ONLY the flags that we got           */
  439.                  }
  440.                  flags_cur = pgrp->OSFlagFlags;            /* Will return the state of the group       */
  441.                  OS_EXIT_CRITICAL();                       /* Yes, condition met, return to caller     */
  442.                  *err      = OS_NO_ERR;
  443.                  return (flags_cur);
  444.              } else {                                      /* Block task until events occur or timeout */
  445.                  OS_FlagBlock(pgrp, &node, flags, wait_type, timeout); 
  446.                  OS_EXIT_CRITICAL();
  447.              }
  448.              break;
  449. #endif
  450.         default:
  451.              OS_EXIT_CRITICAL();
  452.              flags_cur = (OS_FLAGS)0;
  453.              *err      = OS_FLAG_ERR_WAIT_TYPE;
  454.              return (flags_cur);
  455.     }
  456.     OS_Sched();                                            /* Find next HPT ready to run               */
  457.     OS_ENTER_CRITICAL();
  458.     if (OSTCBCur->OSTCBStat & OS_STAT_FLAG) {              /* Have we timed-out?                       */
  459.         OS_FlagUnlink(&node);
  460.         OSTCBCur->OSTCBStat = OS_STAT_RDY;                 /* Yes, make task ready-to-run              */
  461.         OS_EXIT_CRITICAL();
  462.         flags_cur           = (OS_FLAGS)0;
  463.         *err                = OS_TIMEOUT;                  /* Indicate that we timed-out waiting       */
  464.     } else {
  465.         if (consume == TRUE) {                             /* See if we need to consume the flags      */
  466.             switch (wait_type) {
  467.                 case OS_FLAG_WAIT_SET_ALL:
  468.                 case OS_FLAG_WAIT_SET_ANY:                 /* Clear ONLY the flags we got              */
  469.                      pgrp->OSFlagFlags &= ~OSTCBCur->OSTCBFlagsRdy;
  470.                      break;
  471.                      
  472. #if OS_FLAG_WAIT_CLR_EN > 0
  473.                 case OS_FLAG_WAIT_CLR_ALL:
  474.                 case OS_FLAG_WAIT_CLR_ANY:                 /* Set   ONLY the flags we got              */
  475.                      pgrp->OSFlagFlags |= OSTCBCur->OSTCBFlagsRdy;
  476.                      break;
  477. #endif
  478.             }
  479.         }
  480.         flags_cur = pgrp->OSFlagFlags;
  481.         OS_EXIT_CRITICAL();
  482.         *err      = OS_NO_ERR;                             /* Event(s) must have occurred              */
  483.     }
  484.     return (flags_cur);
  485. }
  486. /*$PAGE*/
  487. /*
  488. *********************************************************************************************************
  489. *                                         POST EVENT FLAG BIT(S)
  490. *
  491. * Description: This function is called to set or clear some bits in an event flag group.  The bits to 
  492. *              set or clear are specified by a 'bit mask'.
  493. *
  494. * Arguments  : pgrp          is a pointer to the desired event flag group.
  495. *
  496. *              flags         If 'opt' (see below) is OS_FLAG_SET, each bit that is set in 'flags' will 
  497. *                            set the corresponding bit in the event flag group.  e.g. to set bits 0, 4 
  498. *                            and 5 you would set 'flags' to:
  499. *
  500. *                                0x31     (note, bit 0 is least significant bit)
  501. *
  502. *                            If 'opt' (see below) is OS_FLAG_CLR, each bit that is set in 'flags' will 
  503. *                            CLEAR the corresponding bit in the event flag group.  e.g. to clear bits 0, 
  504. *                            4 and 5 you would specify 'flags' as:
  505. *
  506. *                                0x31     (note, bit 0 is least significant bit)
  507. *
  508. *              opt           indicates whether the flags will be:
  509. *                                set     (OS_FLAG_SET) or 
  510. *                                cleared (OS_FLAG_CLR)
  511. *
  512. *              err           is a pointer to an error code and can be:
  513. *                            OS_NO_ERR              The call was successfull
  514. *                            OS_FLAG_INVALID_PGRP   You passed a NULL pointer
  515. *                            OS_ERR_EVENT_TYPE      You are not pointing to an event flag group
  516. *                            OS_FLAG_INVALID_OPT    You specified an invalid option
  517. *
  518. * Returns    : the new value of the event flags bits that are still set.
  519. *
  520. * Called From: Task or ISR
  521. *
  522. * WARNING(s) : 1) The execution time of this function depends on the number of tasks waiting on the event 
  523. *                 flag group.
  524. *              2) The amount of time interrupts are DISABLED depends on the number of tasks waiting on
  525. *                 the event flag group.        
  526. *********************************************************************************************************
  527. */
  528. OS_FLAGS  OSFlagPost (OS_FLAG_GRP *pgrp, OS_FLAGS flags, INT8U opt, INT8U *err) reentrant
  529. {
  530. #if OS_CRITICAL_METHOD == 3                          /* Allocate storage for CPU status register       */
  531.     OS_CPU_SR     cpu_sr;
  532. #endif    
  533.     OS_FLAG_NODE *pnode;
  534.     BOOLEAN       sched;
  535.     OS_FLAGS      flags_cur;
  536.     OS_FLAGS      flags_rdy;
  537. #if OS_ARG_CHK_EN > 0
  538.     if (pgrp == (OS_FLAG_GRP *)0) {                  /* Validate 'pgrp'                                */
  539.         *err = OS_FLAG_INVALID_PGRP;
  540.         return ((OS_FLAGS)0);
  541.     }
  542.     if (pgrp->OSFlagType != OS_EVENT_TYPE_FLAG) {    /* Make sure we are pointing to an event flag grp */
  543.         *err = OS_ERR_EVENT_TYPE;
  544.         return ((OS_FLAGS)0);
  545.     }
  546. #endif
  547. /*$PAGE*/
  548.     OS_ENTER_CRITICAL();
  549.     switch (opt) {
  550.         case OS_FLAG_CLR:
  551.              pgrp->OSFlagFlags &= ~flags;            /* Clear the flags specified in the group         */
  552.              break;
  553.              
  554.         case OS_FLAG_SET:
  555.              pgrp->OSFlagFlags |=  flags;            /* Set   the flags specified in the group         */
  556.              break;
  557.           
  558.         default:
  559.              OS_EXIT_CRITICAL();                     /* INVALID option                                 */
  560.              *err = OS_FLAG_INVALID_OPT;
  561.              return ((OS_FLAGS)0);
  562.     }
  563.     sched = FALSE;                                   /* Indicate that we don't need rescheduling       */
  564.     pnode = pgrp->OSFlagWaitList;                
  565.     while (pnode != (OS_FLAG_NODE *)0) {             /* Go through all tasks waiting on event flag(s)  */
  566.         switch (pnode->OSFlagNodeWaitType) {
  567.             case OS_FLAG_WAIT_SET_ALL:               /* See if all req. flags are set for current node */
  568.                  flags_rdy = pgrp->OSFlagFlags & pnode->OSFlagNodeFlags;
  569.                  if (flags_rdy == pnode->OSFlagNodeFlags) {     
  570.                      if (OS_FlagTaskRdy(pnode, flags_rdy) == TRUE) { /* Make task RTR, event(s) Rx'd   */
  571.                          sched = TRUE;                               /* When done we will reschedule   */
  572.                      }
  573.                  }
  574.                  break;
  575.             case OS_FLAG_WAIT_SET_ANY:               /* See if any flag set                            */
  576.                  flags_rdy = pgrp->OSFlagFlags & pnode->OSFlagNodeFlags;
  577.                  if (flags_rdy != (OS_FLAGS)0) {    
  578.                      if (OS_FlagTaskRdy(pnode, flags_rdy) == TRUE) { /* Make task RTR, event(s) Rx'd   */
  579.                          sched = TRUE;                               /* When done we will reschedule   */
  580.                      }
  581.                  }
  582.                  break;
  583. #if OS_FLAG_WAIT_CLR_EN > 0
  584.             case OS_FLAG_WAIT_CLR_ALL:               /* See if all req. flags are set for current node */
  585.                  flags_rdy = ~pgrp->OSFlagFlags & pnode->OSFlagNodeFlags;
  586.                  if (flags_rdy == pnode->OSFlagNodeFlags) {     
  587.                      if (OS_FlagTaskRdy(pnode, flags_rdy) == TRUE) { /* Make task RTR, event(s) Rx'd   */
  588.                          sched = TRUE;                               /* When done we will reschedule   */
  589.                      }
  590.                  }
  591.                  break;
  592.             case OS_FLAG_WAIT_CLR_ANY:               /* See if any flag set                            */
  593.                  flags_rdy = ~pgrp->OSFlagFlags & pnode->OSFlagNodeFlags;
  594.                  if (flags_rdy != (OS_FLAGS)0) {    
  595.                      if (OS_FlagTaskRdy(pnode, flags_rdy) == TRUE) { /* Make task RTR, event(s) Rx'd   */
  596.                          sched = TRUE;                               /* When done we will reschedule   */
  597.                      }
  598.                  }
  599.                  break;
  600. #endif                 
  601.         }
  602.         pnode = pnode->OSFlagNodeNext;               /* Point to next task waiting for event flag(s)   */
  603.     }
  604.     OS_EXIT_CRITICAL();
  605.     if (sched == TRUE) {
  606.         OS_Sched();
  607.     }
  608.     OS_ENTER_CRITICAL();
  609.     flags_cur = pgrp->OSFlagFlags;
  610.     OS_EXIT_CRITICAL();
  611.     *err      = OS_NO_ERR;
  612.     return (flags_cur);
  613. }
  614. /*$PAGE*/
  615. /*
  616. *********************************************************************************************************
  617. *                                           QUERY EVENT FLAG 
  618. *
  619. * Description: This function is used to check the value of the event flag group.
  620. *
  621. * Arguments  : pgrp         is a pointer to the desired event flag group.
  622. *
  623. *              err           is a pointer to an error code returned to the called:
  624. *                            OS_NO_ERR              The call was successfull
  625. *                            OS_FLAG_INVALID_PGRP   You passed a NULL pointer
  626. *                            OS_ERR_EVENT_TYPE      You are not pointing to an event flag group
  627. *
  628. * Returns    : The current value of the event flag group.
  629. *
  630. * Called From: Task or ISR
  631. *********************************************************************************************************
  632. */
  633. #if OS_FLAG_QUERY_EN > 0
  634. OS_FLAGS  OSFlagQuery (OS_FLAG_GRP *pgrp, INT8U *err) reentrant
  635. {
  636. #if OS_CRITICAL_METHOD == 3                       /* Allocate storage for CPU status register          */
  637.     OS_CPU_SR  cpu_sr;
  638. #endif    
  639.     OS_FLAGS   flags;
  640. #if OS_ARG_CHK_EN > 0
  641.     if (pgrp == (OS_FLAG_GRP *)0) {               /* Validate 'pgrp'                                   */
  642.         *err = OS_FLAG_INVALID_PGRP;
  643.         return ((OS_FLAGS)0);
  644.     }
  645.     if (pgrp->OSFlagType != OS_EVENT_TYPE_FLAG) { /* Validate event block type                         */
  646.         *err = OS_ERR_EVENT_TYPE;
  647.         return ((OS_FLAGS)0);
  648.     }
  649. #endif    
  650.     OS_ENTER_CRITICAL();
  651.     flags = pgrp->OSFlagFlags;
  652.     OS_EXIT_CRITICAL();
  653.     *err = OS_NO_ERR;
  654.     return (flags);                               /* Return the current value of the event flags       */
  655. }
  656. #endif
  657. /*$PAGE*/
  658. /*
  659. *********************************************************************************************************
  660. *                         SUSPEND TASK UNTIL EVENT FLAG(s) RECEIVED OR TIMEOUT OCCURS
  661. *
  662. * Description: This function is internal to uC/OS-II and is used to put a task to sleep until the desired
  663. *              event flag bit(s) are set.
  664. *
  665. * Arguments  : pgrp          is a pointer to the desired event flag group.
  666. *
  667. *              pnode         is a pointer to a structure which contains data about the task waiting for 
  668. *                            event flag bit(s) to be set.
  669. *
  670. *              flags         Is a bit pattern indicating which bit(s) (i.e. flags) you wish to check.  
  671. *                            The bits you want are specified by setting the corresponding bits in 
  672. *                            'flags'.  e.g. if your application wants to wait for bits 0 and 1 then 
  673. *                            'flags' would contain 0x03.
  674. *
  675. *              wait_type     specifies whether you want ALL bits to be set/cleared or ANY of the bits 
  676. *                            to be set/cleared.
  677. *                            You can specify the following argument:
  678. *
  679. *                            OS_FLAG_WAIT_CLR_ALL   You will check ALL bits in 'mask' to be clear (0)
  680. *                            OS_FLAG_WAIT_CLR_ANY   You will check ANY bit  in 'mask' to be clear (0)
  681. *                            OS_FLAG_WAIT_SET_ALL   You will check ALL bits in 'mask' to be set   (1)
  682. *                            OS_FLAG_WAIT_SET_ANY   You will check ANY bit  in 'mask' to be set   (1)
  683. *
  684. *              timeout       is the desired amount of time that the task will wait for the event flag 
  685. *                            bit(s) to be set.
  686. *
  687. * Returns    : none
  688. *
  689. * Called by  : OSFlagPend()  OS_FLAG.C
  690. *
  691. * Note(s)    : This function is INTERNAL to uC/OS-II and your application should not call it.
  692. *********************************************************************************************************
  693. */
  694. static  void  OS_FlagBlock (OS_FLAG_GRP *pgrp, OS_FLAG_NODE *pnode, OS_FLAGS flags, INT8U wait_type, INT16U timeout) reentrant
  695. {
  696.     OS_FLAG_NODE  *pnode_next;
  697.     OSTCBCur->OSTCBStat      |= OS_STAT_FLAG;
  698.     OSTCBCur->OSTCBDly        = timeout;              /* Store timeout in task's TCB                   */
  699. #if OS_TASK_DEL_EN > 0
  700.     OSTCBCur->OSTCBFlagNode   = pnode;                /* TCB to link to node                           */
  701. #endif    
  702.     pnode->OSFlagNodeFlags    = flags;                /* Save the flags that we need to wait for       */
  703.     pnode->OSFlagNodeWaitType = wait_type;            /* Save the type of wait we are doing            */
  704.     pnode->OSFlagNodeTCB      = (void *)OSTCBCur;     /* Link to task's TCB                            */
  705.     pnode->OSFlagNodeNext     = pgrp->OSFlagWaitList; /* Add node at beginning of event flag wait list */
  706.     pnode->OSFlagNodePrev     = (void *)0;
  707.     pnode->OSFlagNodeFlagGrp  = (void *)pgrp;         /* Link to Event Flag Group                      */
  708.     pnode_next                = pgrp->OSFlagWaitList;
  709.     if (pnode_next != (void *)0) {                    /* Is this the first NODE to insert?             */
  710.         pnode_next->OSFlagNodePrev = pnode;           /* No, link in doubly linked list                */
  711.     } 
  712.     pgrp->OSFlagWaitList = (void *)pnode;
  713.                                                       /* Suspend current task until flag(s) received   */
  714.     if ((OSRdyTbl[OSTCBCur->OSTCBY] &= ~OSTCBCur->OSTCBBitX) == 0) {
  715.         OSRdyGrp &= ~OSTCBCur->OSTCBBitY;
  716.     }
  717. }
  718. /*$PAGE*/
  719. /*
  720. *********************************************************************************************************
  721. *                                    INITIALIZE THE EVENT FLAG MODULE
  722. *
  723. * Description: This function is called by uC/OS-II to initialize the event flag module.  Your application
  724. *              MUST NOT call this function.  In other words, this function is internal to uC/OS-II.
  725. *
  726. * Arguments  : none
  727. *
  728. * Returns    : none
  729. *
  730. * WARNING    : You MUST NOT call this function from your code.  This is an INTERNAL function to uC/OS-II.
  731. *********************************************************************************************************
  732. */
  733. void  OS_FlagInit (void) reentrant
  734. {
  735. #if OS_MAX_FLAGS == 1
  736.     OSFlagFreeList                 = (OS_FLAG_GRP *)&OSFlagTbl[0];  /* Only ONE event flag group!      */
  737.     OSFlagFreeList->OSFlagType     = OS_EVENT_TYPE_UNUSED;
  738.     OSFlagFreeList->OSFlagWaitList = (void *)0;
  739. #endif
  740. #if OS_MAX_FLAGS >= 2
  741.     INT8U        i;
  742.     OS_FLAG_GRP *pgrp1;
  743.     OS_FLAG_GRP *pgrp2;
  744.     pgrp1 = &OSFlagTbl[0];
  745.     pgrp2 = &OSFlagTbl[1];
  746.     for (i = 0; i < (OS_MAX_FLAGS - 1); i++) {                      /* Init. list of free EVENT FLAGS  */
  747.         pgrp1->OSFlagType     = OS_EVENT_TYPE_UNUSED;
  748.         pgrp1->OSFlagWaitList = (void *)pgrp2;
  749.         pgrp1++;
  750.         pgrp2++;
  751.     }
  752.     pgrp1->OSFlagWaitList = (void *)0;
  753.     OSFlagFreeList        = (OS_FLAG_GRP *)&OSFlagTbl[0];
  754. #endif    
  755. }
  756. /*$PAGE*/
  757. /*
  758. *********************************************************************************************************
  759. *                              MAKE TASK READY-TO-RUN, EVENT(s) OCCURRED
  760. *
  761. * Description: This function is internal to uC/OS-II and is used to make a task ready-to-run because the
  762. *              desired event flag bits have been set.
  763. *
  764. * Arguments  : pnode         is a pointer to a structure which contains data about the task waiting for 
  765. *                            event flag bit(s) to be set.
  766. *
  767. *              flags_rdy     contains the bit pattern of the event flags that cause the task to become
  768. *                            ready-to-run.
  769. *
  770. * Returns    : none
  771. *
  772. * Called by  : OSFlagsPost() OS_FLAG.C
  773. *
  774. * Note(s)    : 1) This function assumes that interrupts are disabled.
  775. *              2) This function is INTERNAL to uC/OS-II and your application should not call it.
  776. *********************************************************************************************************
  777. */
  778. static  BOOLEAN  OS_FlagTaskRdy (OS_FLAG_NODE *pnode, OS_FLAGS flags_rdy) reentrant
  779. {
  780.     OS_TCB   *ptcb;
  781.     BOOLEAN   sched;
  782.           
  783.                                                         
  784.     ptcb                = (OS_TCB *)pnode->OSFlagNodeTCB;  /* Point to TCB of waiting task             */
  785.     ptcb->OSTCBDly      = 0;
  786.     ptcb->OSTCBFlagsRdy = flags_rdy;
  787.     ptcb->OSTCBStat    &= ~OS_STAT_FLAG;
  788.     if (ptcb->OSTCBStat == OS_STAT_RDY) {                  /* Put task into ready list                 */
  789.         OSRdyGrp               |= ptcb->OSTCBBitY;
  790.         OSRdyTbl[ptcb->OSTCBY] |= ptcb->OSTCBBitX;
  791.         sched                   = TRUE;
  792.     } else {
  793.         sched                   = FALSE;
  794.     }
  795.     OS_FlagUnlink(pnode);
  796.     return (sched);
  797. }
  798. /*$PAGE*/
  799. /*
  800. *********************************************************************************************************
  801. *                                  UNLINK EVENT FLAG NODE FROM WAITING LIST
  802. *
  803. * Description: This function is internal to uC/OS-II and is used to unlink an event flag node from a
  804. *              list of tasks waiting for the event flag.
  805. *
  806. * Arguments  : pnode         is a pointer to a structure which contains data about the task waiting for 
  807. *                            event flag bit(s) to be set.
  808. *
  809. * Returns    : none
  810. *
  811. * Called by  : OS_FlagTaskRdy() OS_FLAG.C
  812. *              OSFlagPend()     OS_FLAG.C
  813. *              OSTaskDel()      OS_TASK.C
  814. *
  815. * Note(s)    : 1) This function assumes that interrupts are disabled.
  816. *              2) This function is INTERNAL to uC/OS-II and your application should not call it.
  817. *********************************************************************************************************
  818. */
  819. void  OS_FlagUnlink (OS_FLAG_NODE *pnode) reentrant
  820. {
  821.     OS_TCB       *ptcb;
  822.     OS_FLAG_GRP  *pgrp;
  823.     OS_FLAG_NODE *pnode_prev;
  824.     OS_FLAG_NODE *pnode_next;
  825.     
  826.     
  827.     pnode_prev = pnode->OSFlagNodePrev;
  828.     pnode_next = pnode->OSFlagNodeNext;
  829.     if (pnode_prev == (OS_FLAG_NODE *)0) {                      /* Is it first node in wait list?      */
  830.         pgrp                 = pnode->OSFlagNodeFlagGrp;        /* Yes, Point to event flag group      */
  831.         pgrp->OSFlagWaitList = (void *)pnode_next;              /*      Update list for new 1st node   */
  832.         if (pnode_next != (OS_FLAG_NODE *)0) {       
  833.             pnode_next->OSFlagNodePrev = (OS_FLAG_NODE *)0;     /*      Link new 1st node PREV to NULL */
  834.         }
  835.     } else {                                                    /* No,  A node somewhere in the list   */
  836.         pnode_prev->OSFlagNodeNext = pnode_next;                /*      Link around the node to unlink */
  837.         if (pnode_next != (OS_FLAG_NODE *)0) {                  /*      Was this the LAST node?        */
  838.             pnode_next->OSFlagNodePrev = pnode_prev;            /*      No, Link around current node   */
  839.         }
  840.     }
  841.     ptcb                = (OS_TCB *)pnode->OSFlagNodeTCB;
  842. #if OS_TASK_DEL_EN > 0
  843.     ptcb->OSTCBFlagNode = (void *)0;
  844. #endif
  845. }
  846. #endif