/**************************************************************************
*                                                uC/OS-II
*                                          The Real-Time Kernel
*                                         EVENT FLAG  MANAGEMENT
*
*                            (c) Copyright 2001, Jean J. Labrosse, Weston, FL
*                                           All Rights Reserved
*
* File : OS_FLAG.C
* By   : Jean J. Labrosse
**************************************************************************/


/*** BeginHeader */
#ifndef __MCOS_FLAGS_LIB
#define __MCOS_FLAGS_LIB

// uC/OS-2 version: 1.05
/*** EndHeader */

/**************************************************************************
*                                         EVENT FLAGS MANAGEMENT
**************************************************************************/

/*** BeginHeader OSFlagAccept, OSFlagCreate, OSFlagDel, OSFlagPend, OSFlagPost,
                 OSFlagQuery, OS_FlagBlock, OS_FlagInit, OS_FlagTaskRdy, OS_FlagUnlink */

#if (OS_VERSION >= 251) && (OS_FLAG_EN > 0) && (OS_MAX_FLAGS > 0)

#if OS_FLAG_ACCEPT_EN > 0
OS_FLAGS  OSFlagAccept (OS_FLAG_GRP *pgrp, OS_FLAGS flags, INT8U wait_type, INT8U *err);
#endif

#if OS_FLAG_DEL_EN > 0
OS_FLAG_GRP  *OSFlagDel (OS_FLAG_GRP *pgrp, INT8U opt, INT8U *err);
#endif

#if OS_FLAG_QUERY_EN > 0
OS_FLAGS  OSFlagQuery (OS_FLAG_GRP *pgrp, INT8U *err);
#endif

OS_FLAG_GRP  *OSFlagCreate (OS_FLAGS flags, INT8U *err);
OS_FLAGS  OSFlagPend (OS_FLAG_GRP *pgrp, OS_FLAGS flags, INT8U wait_type, INT16U timeout, INT8U *err);
OS_FLAGS  OSFlagPost (OS_FLAG_GRP *pgrp, OS_FLAGS flags, INT8U opt, INT8U *err);
void  OS_FlagBlock (OS_FLAG_GRP *pgrp, OS_FLAG_NODE *pnode, OS_FLAGS flags, INT8U wait_type, INT16U timeout);
void  OS_FlagInit (void);
BOOLEAN  OS_FlagTaskRdy (OS_FLAG_NODE *pnode, OS_FLAGS flags_rdy);
void  OS_FlagUnlink (OS_FLAG_NODE *pnode);
#endif
/*** EndHeader */


/*
*********************************************************************************************************
*                              CHECK THE STATUS OF FLAGS IN AN EVENT FLAG GROUP
*********************************************************************************************************
*/

#if (OS_VERSION >= 251) && (OS_FLAG_EN > 0) && (OS_MAX_FLAGS > 0)

/* START FUNCTION DESCRIPTION ********************************************
OSFlagAccept                                                <UCOS.LIB>

SYNTAX:       	OS_FLAGS  OSFlagAccept (OS_FLAG_GRP *pgrp, OS_FLAGS flags,
                                       INT8U wait_type, INT8U *err);

DESCRIPTION:  This function is called to check the status of a combination
              of bits to be set or cleared in an event flag group.  Your
              application can check for ANY bit to be set/cleared or ALL
              bits to be set/cleared.

              This call does not block if the desired flags are not
              present.

PARAMETER1:   Pointer to the desired event flag group.

PARAMETER2:   Bit pattern indicating which bit(s) (i.e. flags) you wish to
              check.  The bits you want are specified by setting the
              corresponding bits in 'flags'.  e.g. if your application
              wants to wait for bits 0 and 1 then 'flags' would contain
              0x03.

PARAMETER3:   specifies whether you want ALL bits to be set/cleared or ANY
              of the bits to be set/cleared.
              You can specify the following argument:

              OS_FLAG_WAIT_CLR_ALL   You will check ALL bits in 'flags' to
                                     be clear (0)
              OS_FLAG_WAIT_CLR_ANY   You will check ANY bit  in 'flags' to
                                     be clear (0)
              OS_FLAG_WAIT_SET_ALL   You will check ALL bits in 'flags' to
                                     be set   (1)
              OS_FLAG_WAIT_SET_ANY   You will check ANY bit  in 'flags' to
                                     be set   (1)

              NOTE: Add OS_FLAG_CONSUME if you want the event flag to be
                    'consumed' by the call.  Example, to wait for any flag
                    in a group AND then clear the flags that are present,
                    set 'wait_type' to:

                    OS_FLAG_WAIT_SET_ANY + OS_FLAG_CONSUME

PARAMETER4:   Pointer to an error code and can be:
              OS_NO_ERR              No error
              OS_ERR_EVENT_TYPE      You are not pointing to an event flag
                                     group
              OS_FLAG_ERR_WAIT_TYPE  You didn't specify a proper
                                     'wait_type' argument.
              OS_FLAG_INVALID_PGRP   You passed a NULL pointer instead of
                                     the event flag group handle.
              OS_FLAG_ERR_NOT_RDY    The desired flags you are waiting for are not
                                     available.

RETURN VALUE: The state of the flags in the event flag group.

END DESCRIPTION **********************************************************/

#if OS_FLAG_ACCEPT_EN > 0
nodebug
OS_FLAGS  OSFlagAccept (OS_FLAG_GRP *pgrp, OS_FLAGS flags, INT8U wait_type, INT8U *err)
{
#if OS_CRITICAL_METHOD == 3                                /* Allocate storage for CPU status register */
    auto OS_CPU_SR     cpu_sr;
#endif
    auto OS_FLAGS      flags_cur;
    auto OS_FLAGS      flags_rdy;
    auto BOOLEAN       consume;


#if OS_ARG_CHK_EN > 0
    if (pgrp == (OS_FLAG_GRP *)0) {                        /* Validate 'pgrp'                          */
        *err = OS_FLAG_INVALID_PGRP;
        return ((OS_FLAGS)0);
    }
    if (pgrp->OSFlagType != OS_EVENT_TYPE_FLAG) {          /* Validate event block type                */
        *err = OS_ERR_EVENT_TYPE;
        return ((OS_FLAGS)0);
    }
#endif
    if (wait_type & OS_FLAG_CONSUME) {                     /* See if we need to consume the flags      */
        wait_type &= ~OS_FLAG_CONSUME;
        consume    = TRUE;
    } else {
        consume    = FALSE;
    }
    *err = OS_NO_ERR;                                      /* Assume NO error until proven otherwise.  */
    OS_ENTER_CRITICAL();
    switch (wait_type) {
        case OS_FLAG_WAIT_SET_ALL:                         /* See if all required flags are set        */
             flags_rdy = pgrp->OSFlagFlags & flags;        /* Extract only the bits we want            */
             if (flags_rdy == flags) {                     /* Must match ALL the bits that we want     */
                 if (consume == TRUE) {                    /* See if we need to consume the flags      */
                     pgrp->OSFlagFlags &= ~flags_rdy;      /* Clear ONLY the flags that we wanted      */
                 }
             } else {
                 *err  = OS_FLAG_ERR_NOT_RDY;
             }
             flags_cur = pgrp->OSFlagFlags;                /* Will return the state of the group       */
             OS_EXIT_CRITICAL();
             break;

        case OS_FLAG_WAIT_SET_ANY:
             flags_rdy = pgrp->OSFlagFlags & flags;        /* Extract only the bits we want            */
             if (flags_rdy != (OS_FLAGS)0) {               /* See if any flag set                      */
                 if (consume == TRUE) {                    /* See if we need to consume the flags      */
                     pgrp->OSFlagFlags &= ~flags_rdy;      /* Clear ONLY the flags that we got         */
                 }
             } else {
                 *err  = OS_FLAG_ERR_NOT_RDY;
             }
             flags_cur = pgrp->OSFlagFlags;                /* Will return the state of the group       */
             OS_EXIT_CRITICAL();
             break;

#if OS_FLAG_WAIT_CLR_EN > 0
        case OS_FLAG_WAIT_CLR_ALL:                         /* See if all required flags are cleared    */
             flags_rdy = ~pgrp->OSFlagFlags & flags;       /* Extract only the bits we want            */
             if (flags_rdy == flags) {                     /* Must match ALL the bits that we want     */
                 if (consume == TRUE) {                    /* See if we need to consume the flags      */
                     pgrp->OSFlagFlags |= flags_rdy;       /* Set ONLY the flags that we wanted        */
                 }
             } else {
                 *err  = OS_FLAG_ERR_NOT_RDY;
             }
             flags_cur = pgrp->OSFlagFlags;                /* Will return the state of the group       */
             OS_EXIT_CRITICAL();
             break;

        case OS_FLAG_WAIT_CLR_ANY:
             flags_rdy = ~pgrp->OSFlagFlags & flags;       /* Extract only the bits we want            */
             if (flags_rdy != (OS_FLAGS)0) {               /* See if any flag cleared                  */
                 if (consume == TRUE) {                    /* See if we need to consume the flags      */
                     pgrp->OSFlagFlags |= flags_rdy;       /* Set ONLY the flags that we got           */
                 }
             } else {
                 *err  = OS_FLAG_ERR_NOT_RDY;
             }
             flags_cur = pgrp->OSFlagFlags;                /* Will return the state of the group       */
             OS_EXIT_CRITICAL();
             break;
#endif

        default:
             OS_EXIT_CRITICAL();
             flags_cur = (OS_FLAGS)0;
             *err      = OS_FLAG_ERR_WAIT_TYPE;
             break;
    }
    return (flags_cur);
}
#endif    

/*
*********************************************************************************************************
*                                           CREATE AN EVENT FLAG
*********************************************************************************************************
*/

/* START FUNCTION DESCRIPTION ********************************************
OSFlagCreate                                                <UCOS.LIB>

SYNTAX:       	OS_FLAG_GRP  *OSFlagCreate (OS_FLAGS flags, INT8U *err);

DESCRIPTION:	This function is called to create an event flag group.

PARAMETER1:    Contains the initial value to store in the event flag group.

PARAMETER2:    Pointer to an error code which will be returned to your
               application:
               OS_NO_ERR              if the call was successful.
               OS_ERR_CREATE_ISR      if you attempted to create an Event
                                      Flag from an ISR.
               OS_FLAG_GRP_DEPLETED   if there are no more event flag
                                      groups

RETURN VALUE:  A pointer to an event flag group or a NULL pointer if no
               more groups are available.
                            
END DESCRIPTION **********************************************************/

nodebug
OS_FLAG_GRP  *OSFlagCreate (OS_FLAGS flags, INT8U *err)
{
#if OS_CRITICAL_METHOD == 3                         /* Allocate storage for CPU status register        */
    auto OS_CPU_SR    cpu_sr;
#endif    
    auto OS_FLAG_GRP *pgrp;


    if (bios_intnesting > 0) {                      /* See if called from ISR ...                      */
        *err = OS_ERR_CREATE_ISR;                   /* ... can't CREATE from an ISR                    */
        return ((OS_FLAG_GRP *)0);               
    }
    OS_ENTER_CRITICAL();
    pgrp = OSFlagFreeList;                          /* Get next free event flag                        */
    if (pgrp != (OS_FLAG_GRP *)0) {                 /* See if we have event flag groups available      */
                                                    /* Adjust free list                                */
        OSFlagFreeList       = (OS_FLAG_GRP *)OSFlagFreeList->OSFlagWaitList;
        pgrp->OSFlagType     = OS_EVENT_TYPE_FLAG;  /* Set to event flag group type                    */
        pgrp->OSFlagFlags    = flags;               /* Set to desired initial value                    */
        pgrp->OSFlagWaitList = 0;                   /* Clear list of tasks waiting on flags            */
        OS_EXIT_CRITICAL();
        *err                 = OS_NO_ERR;
    } else {
        OS_EXIT_CRITICAL();
        *err                 = OS_FLAG_GRP_DEPLETED;
    }
    return (pgrp);                                  /* Return pointer to event flag group              */
}

/*
*********************************************************************************************************
*                                     DELETE AN EVENT FLAG GROUP
*********************************************************************************************************
*/


/* START FUNCTION DESCRIPTION ********************************************
OSFlagDel                                                   <UCOS.LIB>

SYNTAX:       	OS_FLAG_GRP  *OSFlagDel (OS_FLAG_GRP *pgrp,
                                        INT8U opt, INT8U *err);

DESCRIPTION:	This function deletes an event flag group and readies all
               tasks pending on the event flag group. Note that:
               1) This function must be used with care.  Tasks that would
                  normally expect the presence of the event flag group MUST
                  check the return code of OSFlagAccept() and OSFlagPend().
               2) This call can potentially disable interrupts for a long
                  time. The interrupt disable time is directly proportional
                  to the number of tasks waiting on the event flag group.

PARAMETER1:    Pointer to the desired event flag group.

PARAMETER2:    determines delete options as follows:
               opt == OS_DEL_NO_PEND   Deletes the event flag group ONLY if
                                       no task pending
               opt == OS_DEL_ALWAYS    Deletes the event flag group even if
                                       tasks are waiting.  In this case,
                                       all the tasks pending will be
                                       readied.

PARAMETER3:    Pointer to an error code that can contain one of the
               following values:
               OS_NO_ERR             The call was successful and the event
                                     flag group was deleted
               OS_ERR_DEL_ISR        If you attempted to delete the event
                                     flag group from an ISR
               OS_FLAG_INVALID_PGRP  If 'pgrp' is a NULL pointer.
               OS_ERR_EVENT_TYPE     You are not pointing to an event flag
                                     group
               OS_ERR_EVENT_TYPE     If you didn't pass a pointer to an
                                     event flag group
               OS_ERR_INVALID_OPT    An invalid option was specified
               OS_ERR_TASK_WAITING   One or more tasks were waiting on the
                                     event flag group.


RETURN VALUE:  pevent        upon error
               (OS_EVENT *)0 if the semaphore was successfully deleted.

END DESCRIPTION **********************************************************/

#if OS_FLAG_DEL_EN > 0
nodebug
OS_FLAG_GRP  *OSFlagDel (OS_FLAG_GRP *pgrp, INT8U opt, INT8U *err)
{
#if OS_CRITICAL_METHOD == 3                                /* Allocate storage for CPU status register */
    auto OS_CPU_SR     cpu_sr;
#endif
    auto BOOLEAN       tasks_waiting;
    auto OS_FLAG_NODE  pnode;
    auto INT8U         done;


    if (bios_intnesting > 0) {                             /* See if called from ISR ...               */
        *err = OS_ERR_DEL_ISR;                             /* ... can't DELETE from an ISR             */
        return (pgrp);
    }
#if OS_ARG_CHK_EN > 0
    if (pgrp == (OS_FLAG_GRP *)0) {                        /* Validate 'pgrp'                          */
        *err = OS_FLAG_INVALID_PGRP;
        return (pgrp);
    }
    if (pgrp->OSFlagType != OS_EVENT_TYPE_FLAG) {          /* Validate event group type                */
        *err = OS_ERR_EVENT_TYPE;
        return (pgrp);
    }
#endif
    OS_ENTER_CRITICAL();
    if (pgrp->OSFlagWaitList != 0) {                       /* See if any tasks waiting on event flags  */
        tasks_waiting = TRUE;                              /* Yes                                      */
    } else {
        tasks_waiting = FALSE;                             /* No                                       */
    }
    switch (opt) {
        case OS_DEL_NO_PEND:                               /* Delete group if no task waiting          */
             if (tasks_waiting == FALSE) {
                 pgrp->OSFlagType     = OS_EVENT_TYPE_UNUSED;
                 pgrp->OSFlagWaitList = (INT32U)OSFlagFreeList;    /* Return group to free list           */
                 OSFlagFreeList       = pgrp;
                 OS_EXIT_CRITICAL();
                 *err                 = OS_NO_ERR;
                 return ((OS_FLAG_GRP *)0);                /* Event Flag Group has been deleted        */
             } else {
                 OS_EXIT_CRITICAL();
                 *err                 = OS_ERR_TASK_WAITING;
                 return (pgrp);
             }

        case OS_DEL_ALWAYS:                                /* Always delete the event flag group       */
             xmem2root(&pnode, pgrp->OSFlagWaitList, sizeof(pnode));					
             done = 0;
             while(!done) {
                OS_FlagTaskRdy(&pnode, (OS_FLAGS)0);
                if(pnode.OSFlagNodeNext) {
                    xmem2root(&pnode, pnode.OSFlagNodeNext, sizeof(pnode));
                } else {
                    done = 1;
                }                  
             }
             pgrp->OSFlagType     = OS_EVENT_TYPE_UNUSED;
             pgrp->OSFlagWaitList = (INT32U)OSFlagFreeList;/* Return group to free list                */
             OSFlagFreeList       = pgrp;
             OS_EXIT_CRITICAL();
             if (tasks_waiting == TRUE) {                  /* Reschedule only if task(s) were waiting  */
                 OS_Sched();                               /* Find highest priority task ready to run  */
             }
             *err = OS_NO_ERR;
             return ((OS_FLAG_GRP *)0);                    /* Event Flag Group has been deleted        */

        default:
             OS_EXIT_CRITICAL();
             *err = OS_ERR_INVALID_OPT;
             return (pgrp);
    }
}
#endif

/*
*********************************************************************************************************
*                                        WAIT ON AN EVENT FLAG GROUP
*********************************************************************************************************
*/

/* START FUNCTION DESCRIPTION ********************************************
OSFlagPend                                                   <UCOS.LIB>

SYNTAX:       	OS_FLAGS  OSFlagPend (OS_FLAG_GRP *pgrp, OS_FLAGS flags,
                         INT8U wait_type, INT16U timeout, INT8U *err);

DESCRIPTION:	This function is called to wait for a combination of bits to
               be set in an event flag group.  Your application can wait
               for ANY bit to be set or ALL bits to be set.

PARAMETER1:    Pointer to the desired event flag group.

PARAMETER2:    Bit pattern indicating which bit(s) (i.e. flags) you wish to
               wait for. The bits you want are specified by setting the
               corresponding bits in 'flags'.  e.g. if your application
               wants to wait for bits 0 and 1 then 'flags' would contain
               0x03.

PARAMETER3:    Specifies whether you want ALL bits to be set or ANY of the
               bits to be set.  You can specify the following argument:

               OS_FLAG_WAIT_CLR_ALL   You will wait for ALL bits in 'mask'
                                      to be clear (0)
               OS_FLAG_WAIT_SET_ALL   You will wait for ALL bits in 'mask'
                                      to be set   (1)
               OS_FLAG_WAIT_CLR_ANY   You will wait for ANY bit  in 'mask'
                                      to be clear (0)
               OS_FLAG_WAIT_SET_ANY   You will wait for ANY bit  in 'mask'
                                      to be set   (1)

               NOTE: Add OS_FLAG_CONSUME if you want the event flag to be
               'consumed' by the call.  Example, to wait for any flag in a
               group AND then clear the flags that are present, set
               'wait_type' to:

               OS_FLAG_WAIT_SET_ANY + OS_FLAG_CONSUME

PARAMETER4:    An optional timeout (in clock ticks) that your task will
               wait for the desired bit combination.  If you specify 0,
               however, your task will wait forever at the specified event
               flag group or, until a message arrives.

PARAMETER4:    Pointer to an error code and can be:
               OS_NO_ERR              The desired bits have been set within
                                      the specified 'timeout'.
               OS_ERR_PEND_ISR        If you tried to PEND from an ISR
               OS_FLAG_INVALID_PGRP   If 'pgrp' is a NULL pointer.
               OS_ERR_EVENT_TYPE      You are not pointing to an event flag
                                      group
               OS_TIMEOUT             The bit(s) have not been set in the
                                      specified 'timeout'.
               OS_FLAG_ERR_WAIT_TYPE  You didn't specify a proper
                                      'wait_type' argument.

RETURN VALUE:  The new state of the flags in the event flag group when the
               task is resumed or, 0 if a timeout or an error occurred.

END DESCRIPTION **********************************************************/

nodebug
OS_FLAGS  OSFlagPend (OS_FLAG_GRP *pgrp, OS_FLAGS flags, INT8U wait_type, INT16U timeout, INT8U *err)
{
#if OS_CRITICAL_METHOD == 3                                /* Allocate storage for CPU status register */
    auto OS_CPU_SR     cpu_sr;
#endif    
    auto OS_FLAG_NODE  node;
    auto OS_FLAGS      flags_cur;
    auto OS_FLAGS      flags_rdy;
    auto BOOLEAN       consume;


    if (bios_intnesting > 0) {                             /* See if called from ISR ...               */
        *err = OS_ERR_PEND_ISR;                            /* ... can't PEND from an ISR               */
        return ((OS_FLAGS)0);
    }
#if OS_ARG_CHK_EN > 0
    if (pgrp == (OS_FLAG_GRP *)0) {                        /* Validate 'pgrp'                          */
        *err = OS_FLAG_INVALID_PGRP;
        return ((OS_FLAGS)0);
    }
    if (pgrp->OSFlagType != OS_EVENT_TYPE_FLAG) {          /* Validate event block type                */
        *err = OS_ERR_EVENT_TYPE;
        return ((OS_FLAGS)0);
    }
#endif
    if (wait_type & OS_FLAG_CONSUME) {                     /* See if we need to consume the flags      */
        wait_type &= ~OS_FLAG_CONSUME;
        consume    = TRUE;
    } else {
        consume    = FALSE;
    }
    OS_ENTER_CRITICAL();
    switch (wait_type) {
        case OS_FLAG_WAIT_SET_ALL:                         /* See if all required flags are set        */
             flags_rdy = pgrp->OSFlagFlags & flags;        /* Extract only the bits we want            */
             if (flags_rdy == flags) {                     /* Must match ALL the bits that we want     */
                 if (consume == TRUE) {                    /* See if we need to consume the flags      */
                     pgrp->OSFlagFlags &= ~flags_rdy;      /* Clear ONLY the flags that we wanted      */
                 }
                 flags_cur = pgrp->OSFlagFlags;            /* Will return the state of the group       */
                 OS_EXIT_CRITICAL();                       /* Yes, condition met, return to caller     */
                 *err      = OS_NO_ERR;
                 return (flags_cur);
             } else {                                      /* Block task until events occur or timeout */
                 OS_FlagBlock(pgrp, &node, flags, wait_type, timeout); 
                 OS_EXIT_CRITICAL();
             }
             break;

        case OS_FLAG_WAIT_SET_ANY:
             flags_rdy = pgrp->OSFlagFlags & flags;        /* Extract only the bits we want            */
             if (flags_rdy != (OS_FLAGS)0) {               /* See if any flag set                      */
                 if (consume == TRUE) {                    /* See if we need to consume the flags      */
                     pgrp->OSFlagFlags &= ~flags_rdy;      /* Clear ONLY the flags that we got         */
                 }
                 flags_cur = pgrp->OSFlagFlags;            /* Will return the state of the group       */
                 OS_EXIT_CRITICAL();                       /* Yes, condition met, return to caller     */
                 *err      = OS_NO_ERR;
                 return (flags_cur);
             } else {                                      /* Block task until events occur or timeout */
                 OS_FlagBlock(pgrp, &node, flags, wait_type, timeout); 
                 OS_EXIT_CRITICAL();
             }
             break;

#if OS_FLAG_WAIT_CLR_EN > 0
        case OS_FLAG_WAIT_CLR_ALL:                         /* See if all required flags are cleared    */
             flags_rdy = ~pgrp->OSFlagFlags & flags;       /* Extract only the bits we want            */
             if (flags_rdy == flags) {                     /* Must match ALL the bits that we want     */
                 if (consume == TRUE) {                    /* See if we need to consume the flags      */
                     pgrp->OSFlagFlags |= flags_rdy;       /* Set ONLY the flags that we wanted        */
                 }
                 flags_cur = pgrp->OSFlagFlags;            /* Will return the state of the group       */
                 OS_EXIT_CRITICAL();                       /* Yes, condition met, return to caller     */
                 *err      = OS_NO_ERR;
                 return (flags_cur);
             } else {                                      /* Block task until events occur or timeout */
                 OS_FlagBlock(pgrp, &node, flags, wait_type, timeout); 
                 OS_EXIT_CRITICAL();
             }
             break;

        case OS_FLAG_WAIT_CLR_ANY:
             flags_rdy = ~pgrp->OSFlagFlags & flags;       /* Extract only the bits we want            */
             if (flags_rdy != (OS_FLAGS)0) {               /* See if any flag cleared                  */
                 if (consume == TRUE) {                    /* See if we need to consume the flags      */
                     pgrp->OSFlagFlags |= flags_rdy;       /* Set ONLY the flags that we got           */
                 }
                 flags_cur = pgrp->OSFlagFlags;            /* Will return the state of the group       */
                 OS_EXIT_CRITICAL();                       /* Yes, condition met, return to caller     */
                 *err      = OS_NO_ERR;
                 return (flags_cur);
             } else {                                      /* Block task until events occur or timeout */
                 OS_FlagBlock(pgrp, &node, flags, wait_type, timeout); 
                 OS_EXIT_CRITICAL();
             }
             break;
#endif

        default:
             OS_EXIT_CRITICAL();
             flags_cur = (OS_FLAGS)0;
             *err      = OS_FLAG_ERR_WAIT_TYPE;
             return (flags_cur);
    }
    OS_Sched();                                            /* Find next HPT ready to run               */
    OS_ENTER_CRITICAL();
    if (OSTCBCur->OSTCBStat & OS_STAT_FLAG) {              /* Have we timed-out?                       */
        OS_FlagUnlink(&node);
        OSTCBCur->OSTCBStat = OS_STAT_RDY;                 /* Yes, make task ready-to-run              */
        OS_EXIT_CRITICAL();
        flags_cur           = (OS_FLAGS)0;
        *err                = OS_TIMEOUT;                  /* Indicate that we timed-out waiting       */
    } else {
        if (consume == TRUE) {                             /* See if we need to consume the flags      */
            switch (wait_type) {
                case OS_FLAG_WAIT_SET_ALL:
                case OS_FLAG_WAIT_SET_ANY:                 /* Clear ONLY the flags we got              */
                     pgrp->OSFlagFlags &= ~OSTCBCur->OSTCBFlagsRdy;
                     break;
                     
#if OS_FLAG_WAIT_CLR_EN > 0
                case OS_FLAG_WAIT_CLR_ALL:
                case OS_FLAG_WAIT_CLR_ANY:                 /* Set   ONLY the flags we got              */
                     pgrp->OSFlagFlags |= OSTCBCur->OSTCBFlagsRdy;
                     break;
#endif
            }
        }
        flags_cur = pgrp->OSFlagFlags;
        OS_EXIT_CRITICAL();
        *err      = OS_NO_ERR;                             /* Event(s) must have occurred              */
    }
    return (flags_cur);
}

/*
*********************************************************************************************************
*                                         POST EVENT FLAG BIT(S)
*********************************************************************************************************
*/


/* START FUNCTION DESCRIPTION ********************************************
OSFlagPost                                                   <UCOS.LIB>

SYNTAX:       	OS_FLAGS  OSFlagPost (OS_FLAG_GRP *pgrp, OS_FLAGS flags,
                                     INT8U opt, INT8U *err);

DESCRIPTION:	This function is called to set or clear some bits in an
               event flag group.  The bits to set or clear are specified by
               a 'bit mask'.  Warnings:

               1) The execution time of this function depends on the number
                  of tasks waiting on the event flag group.
               2) The amount of time interrupts are DISABLED depends on the
                  number of tasks waiting on the event flag group.

PARAMETER1:    Pointer to the desired event flag group.

PARAMETER2:    If 'opt' (see below) is OS_FLAG_SET, each bit that is set in
               'flags' will set the corresponding bit in the event flag
               group. e.g. to set bits 0, 4 and 5 you would set 'flags' to:

                   0x31     (note, bit 0 is least significant bit)

               If 'opt' (see below) is OS_FLAG_CLR, each bit that is set in
               'flags' will CLEAR the corresponding bit in the event flag
               group.  e.g. to clear bits 0, 4 and 5 you would specify
               'flags' as:

                   0x31     (note, bit 0 is least significant bit)

PARAMETER3:    indicates whether the flags will be:
               set     (OS_FLAG_SET) or
               cleared (OS_FLAG_CLR)

PARAMETER4:    is a pointer to an error code and can be:
               OS_NO_ERR              The call was successfull
               OS_FLAG_INVALID_PGRP   You passed a NULL pointer
               OS_ERR_EVENT_TYPE      You are not pointing to an event flag
                                      group
               OS_FLAG_INVALID_OPT    You specified an invalid option



PARAMETER5:    Pointer to an error code that can contain one of the
               following values:
               OS_NO_ERR             The call was successful and the event
                                     flag group was deleted
               OS_ERR_DEL_ISR        If you attempted to delete the event
                                     flag group from an ISR
               OS_FLAG_INVALID_PGRP  If 'pgrp' is a NULL pointer.
               OS_ERR_EVENT_TYPE     You are not pointing to an event flag
                                     group
               OS_ERR_EVENT_TYPE     If you didn't pass a pointer to an
                                     event
                                     flag group
               OS_ERR_INVALID_OPT    An invalid option was specified
               OS_ERR_TASK_WAITING   One or more tasks were waiting on the
                                     event flag group.


RETURN VALUE:  the new value of the event flags bits that are still set.

END DESCRIPTION **********************************************************/

nodebug
OS_FLAGS  OSFlagPost (OS_FLAG_GRP *pgrp, OS_FLAGS flags, INT8U opt, INT8U *err)
{
#if OS_CRITICAL_METHOD == 3                          /* Allocate storage for CPU status register       */
    auto OS_CPU_SR     cpu_sr;
#endif
    auto OS_FLAG_NODE  pnode;
    auto BOOLEAN       sched;
    auto OS_FLAGS      flags_cur;
    auto OS_FLAGS      flags_rdy;
    auto INT8U         done;

 
#if OS_ARG_CHK_EN > 0
    if (pgrp == (OS_FLAG_GRP *)0) {                  /* Validate 'pgrp'                                */
        *err = OS_FLAG_INVALID_PGRP;
        return ((OS_FLAGS)0);
    }
    if (pgrp->OSFlagType != OS_EVENT_TYPE_FLAG) {    /* Make sure we are pointing to an event flag grp */
        *err = OS_ERR_EVENT_TYPE;
        return ((OS_FLAGS)0);
    }
#endif
    OS_ENTER_CRITICAL();
    switch (opt) {
        case OS_FLAG_CLR:
             pgrp->OSFlagFlags &= ~flags;            /* Clear the flags specified in the group         */
             break;
             
        case OS_FLAG_SET:
             pgrp->OSFlagFlags |=  flags;            /* Set   the flags specified in the group         */
             break;
          
        default:
             OS_EXIT_CRITICAL();                     /* INVALID option                                 */
             *err = OS_FLAG_INVALID_OPT;
             return ((OS_FLAGS)0);
    }
    sched = FALSE;                                   /* Indicate that we don't need rescheduling       */
    if(pgrp->OSFlagWaitList) {    
        xmem2root(&pnode, pgrp->OSFlagWaitList, sizeof(pnode));
        done = 0;
        while(!done) {                                             /* Go through all tasks waiting on event flag(s)  */
            switch (pnode.OSFlagNodeWaitType) {
                case OS_FLAG_WAIT_SET_ALL:               /* See if all req. flags are set for current node */
                     flags_rdy = pgrp->OSFlagFlags & pnode.OSFlagNodeFlags;
                     if (flags_rdy == pnode.OSFlagNodeFlags) {     
                         if (OS_FlagTaskRdy(&pnode, flags_rdy) == TRUE) { /* Make task RTR, event(s) Rx'd   */
                              sched = TRUE;                               /* When done we will reschedule   */
                         }
                     }
                     break;

                case OS_FLAG_WAIT_SET_ANY:               /* See if any flag set                            */
                     flags_rdy = pgrp->OSFlagFlags & pnode.OSFlagNodeFlags;
                     if (flags_rdy != (OS_FLAGS)0) {    
                         if (OS_FlagTaskRdy(&pnode, flags_rdy) == TRUE) { /* Make task RTR, event(s) Rx'd   */
                             sched = TRUE;                                /* When done we will reschedule   */
                         }
                     }
                     break;

#if OS_FLAG_WAIT_CLR_EN > 0
                case OS_FLAG_WAIT_CLR_ALL:               /* See if all req. flags are set for current node */
                     flags_rdy = ~pgrp->OSFlagFlags & pnode.OSFlagNodeFlags;
                     if (flags_rdy == pnode.OSFlagNodeFlags) {     
                         if (OS_FlagTaskRdy(&pnode, flags_rdy) == TRUE) { /* Make task RTR, event(s) Rx'd   */
                              sched = TRUE;                               /* When done we will reschedule   */
                         }
                     }
                     break;

                case OS_FLAG_WAIT_CLR_ANY:               /* See if any flag set                            */
                     flags_rdy = ~pgrp->OSFlagFlags & pnode.OSFlagNodeFlags;
                     if (flags_rdy != (OS_FLAGS)0) {    
                         if (OS_FlagTaskRdy(&pnode, flags_rdy) == TRUE) { /* Make task RTR, event(s) Rx'd   */
                             sched = TRUE;                                /* When done we will reschedule   */
                         }
                     }
                     break;
#endif
            }
            if(pnode.OSFlagNodeNext) {
                xmem2root(&pnode, pnode.OSFlagNodeNext, sizeof(pnode));               /* Point to next task waiting for event flag(s)   */
            }
            else {
               done = 1;
            }
        }
    }
    OS_EXIT_CRITICAL();
    if (sched == TRUE) {
        OS_Sched();
    }
    OS_ENTER_CRITICAL();
    flags_cur = pgrp->OSFlagFlags;
    OS_EXIT_CRITICAL();
    *err      = OS_NO_ERR;
    return (flags_cur);
}

/*
*********************************************************************************************************
*                                           QUERY EVENT FLAG 
*********************************************************************************************************
*/

/* START FUNCTION DESCRIPTION ********************************************
OSFlagQuery                                                  <UCOS.LIB>

SYNTAX:       	OS_FLAGS  OSFlagQuery (OS_FLAG_GRP *pgrp, INT8U *err);

DESCRIPTION:   This function is used to check the value of the event flag
               group.

PARAMETER1:    Pointer to the desired event flag group.

PARAMETER2:    Pointer to an error code returned to the called:
               OS_NO_ERR              The call was successfull
               OS_FLAG_INVALID_PGRP   You passed a NULL pointer
               OS_ERR_EVENT_TYPE      You are not pointing to an event flag
                                      group 

RETURN VALUE:  The current value of the event flag group.
                            
END DESCRIPTION **********************************************************/

#if OS_FLAG_QUERY_EN > 0
nodebug
OS_FLAGS  OSFlagQuery (OS_FLAG_GRP *pgrp, INT8U *err)
{
#if OS_CRITICAL_METHOD == 3                       /* Allocate storage for CPU status register          */
    auto OS_CPU_SR  cpu_sr;
#endif    
    auto OS_FLAGS   flags;


#if OS_ARG_CHK_EN > 0
    if (pgrp == (OS_FLAG_GRP *)0) {               /* Validate 'pgrp'                                   */
        *err = OS_FLAG_INVALID_PGRP;
        return ((OS_FLAGS)0);
    }
    if (pgrp->OSFlagType != OS_EVENT_TYPE_FLAG) { /* Validate event block type                         */
        *err = OS_ERR_EVENT_TYPE;
        return ((OS_FLAGS)0);
    }
#endif    
    OS_ENTER_CRITICAL();
    flags = pgrp->OSFlagFlags;
    OS_EXIT_CRITICAL();
    *err = OS_NO_ERR;
    return (flags);                               /* Return the current value of the event flags       */
}
#endif

/*
*********************************************************************************************************
*                         SUSPEND TASK UNTIL EVENT FLAG(s) RECEIVED OR TIMEOUT OCCURS
*********************************************************************************************************
*/

/* START FUNCTION DESCRIPTION ********************************************
OSFlagBlock                                                   <UCOS.LIB>

SYNTAX:       	void  OS_FlagBlock (OS_FLAG_GRP *pgrp, OS_FLAG_NODE *pnode,
                     OS_FLAGS flags, INT8U wait_type, INT16U timeout);

DESCRIPTION:   This function is internal to uC/OS-II and is used to put a
               task to sleep until the desired event flag bit(s) are set.
               This function is INTERNAL to uC/OS-II and your application
               should not call it.

PARAMETER1:    Pointer to the desired event flag group.

PARAMETER2:    Pointer to a structure which contains data about the task
               waiting for event flag bit(s) to be set.

PARAMETER3:    Bit pattern indicating which bit(s) (i.e. flags) you wish to
               check. The bits you want are specified by setting the
               corresponding bits in 'flags'.  e.g. if your application
               wants to wait for bits 0 and 1 then 'flags' would contain
               0x03.

PARAMETER4:    specifies whether you want ALL bits to be set/cleared or ANY
               of the bits to be set/cleared. You can specify the following
               argument:

               OS_FLAG_WAIT_CLR_ALL   You will check ALL bits in 'mask' to
                                      be clear (0)
               OS_FLAG_WAIT_CLR_ANY   You will check ANY bit  in 'mask' to
                                      be clear (0)
               OS_FLAG_WAIT_SET_ALL   You will check ALL bits in 'mask' to
                                      be set   (1)
               OS_FLAG_WAIT_SET_ANY   You will check ANY bit  in 'mask' to
                                      be set   (1)


PARAMETER5:    Desired amount of time that the task will wait for the event
               flag bit(s) to be set.

RETURN VALUE:  None

END DESCRIPTION **********************************************************/

nodebug
void  OS_FlagBlock (OS_FLAG_GRP *pgrp, OS_FLAG_NODE *pnode, OS_FLAGS flags, INT8U wait_type, INT16U timeout)
{
    auto OS_FLAG_NODE  pnode_next;


    OSTCBCur->OSTCBStat      |= OS_STAT_FLAG;
    OSTCBCur->OSTCBDly        = timeout;              /* Store timeout in task's TCB                   */
#if OS_TASK_DEL_EN > 0
    OSTCBCur->OSTCBFlagNode   = paddrSS(pnode);       /* TCB to link to node                           */
#endif    
    pnode->OSFlagNodeFlags    = flags;                /* Save the flags that we need to wait for       */
    pnode->OSFlagNodeWaitType = wait_type;            /* Save the type of wait we are doing            */
    pnode->OSFlagNodeTCB      = (void *)OSTCBCur;     /* Link to task's TCB                            */
    pnode->OSFlagNodeNext     = pgrp->OSFlagWaitList; /* Add node at beginning of event flag wait list */
    pnode->OSFlagNodePrev     = 0;
    pnode->OSFlagNodeFlagGrp  = (void *)pgrp;         /* Link to Event Flag Group                      */
    if(pgrp->OSFlagWaitList != 0) {                       /* Is this the first NODE to insert?             */
        xmem2root(&pnode_next, pgrp->OSFlagWaitList, sizeof(pnode_next));
        pnode_next.OSFlagNodePrev = paddrSS(pnode);   /* No, link in doubly linked list                */
        root2xmem(pgrp->OSFlagWaitList, &pnode_next, sizeof(pnode_next));
    }
    pgrp->OSFlagWaitList = paddrSS(pnode);    
                                                      /* Suspend current task until flag(s) received   */
    if ((OSRdyTbl[OSTCBCur->OSTCBY] &= ~OSTCBCur->OSTCBBitX) == 0) {
        OSRdyGrp &= ~OSTCBCur->OSTCBBitY;
    }
}

/*
*********************************************************************************************************
*                                    INITIALIZE THE EVENT FLAG MODULE
*********************************************************************************************************
*/

/* START FUNCTION DESCRIPTION ********************************************
OS_FlagInit                                                  <UCOS.LIB>

SYNTAX:       	void  OS_FlagInit (void);

DESCRIPTION:   This function is called by uC/OS-II to initialize the event
               flag module.  Your application MUST NOT call this function.
               In other words, this function is internal to uC/OS-II.

RETURN VALUE:  None
                            
END DESCRIPTION **********************************************************/

nodebug
void  OS_FlagInit (void)
{
#if OS_MAX_FLAGS == 1
    OSFlagFreeList                 = (OS_FLAG_GRP *)&OSFlagTbl[0];  /* Only ONE event flag group!      */
    OSFlagFreeList->OSFlagType     = OS_EVENT_TYPE_UNUSED;
    OSFlagFreeList->OSFlagWaitList = 0;
#endif

#if OS_MAX_FLAGS >= 2
    INT8U        i;
    OS_FLAG_GRP *pgrp1;
    OS_FLAG_GRP *pgrp2;


    pgrp1 = &OSFlagTbl[0];
    pgrp2 = &OSFlagTbl[1];
    for (i = 0; i < (OS_MAX_FLAGS - 1); i++) {                      /* Init. list of free EVENT FLAGS  */
        pgrp1->OSFlagType     = OS_EVENT_TYPE_UNUSED;
        pgrp1->OSFlagWaitList = (INT32U)pgrp2;
        pgrp1++;
        pgrp2++;
    }
    pgrp1->OSFlagWaitList = 0;
    OSFlagFreeList        = (OS_FLAG_GRP *)&OSFlagTbl[0];
#endif
}

/*
*********************************************************************************************************
*                              MAKE TASK READY-TO-RUN, EVENT(s) OCCURRED
*********************************************************************************************************
*/

/* START FUNCTION DESCRIPTION ********************************************
OS_FlagTaskRdy                                                <UCOS.LIB>

SYNTAX:       	BOOLEAN  OS_FlagTaskRdy (OS_FLAG_NODE *pnode, OS_FLAGS
               flags_rdy);

DESCRIPTION:   This function is internal to uC/OS-II and is used to make a
               task ready-to-run because the desired event flag bits have
               been set.
               Note that:

               1) This function assumes that interrupts are disabled.
               2) This function is INTERNAL to uC/OS-II and your
                  application should not call it.

PARAMETER1:    Pointer to a structure which contains data about the task
               waiting for event flag bit(s) to be set.

PARAMETER2:    contains the bit pattern of the event flags that cause the
               task to become ready-to-run.

RETURN VALUE:  none
                            
END DESCRIPTION **********************************************************/

nodebug
BOOLEAN  OS_FlagTaskRdy (OS_FLAG_NODE *pnode, OS_FLAGS flags_rdy)
{
    auto OS_TCB   *ptcb;
    auto BOOLEAN   sched;
          
                                                        
    ptcb                = (OS_TCB *)pnode->OSFlagNodeTCB;  /* Point to TCB of waiting task             */
    ptcb->OSTCBDly      = 0;
    ptcb->OSTCBFlagsRdy = flags_rdy;
    ptcb->OSTCBStat    &= ~OS_STAT_FLAG;
    if (ptcb->OSTCBStat == OS_STAT_RDY) {                  /* Put task into ready list                 */
        OSRdyGrp               |= ptcb->OSTCBBitY;
        OSRdyTbl[ptcb->OSTCBY] |= ptcb->OSTCBBitX;
        sched                   = TRUE;
    } else {
        sched                   = FALSE;
    }
    OS_FlagUnlink(pnode);
    return (sched);
}

/*
*********************************************************************************************************
*                                  UNLINK EVENT FLAG NODE FROM WAITING LIST
*********************************************************************************************************
*/

/* START FUNCTION DESCRIPTION ********************************************
OS_FlagUnlink                                                 <UCOS.LIB>

SYNTAX:       	void  OS_FlagUnlink (OS_FLAG_NODE *pnode);

DESCRIPTION:   This function is internal to uC/OS-II and is used to unlink
               an event flag node from a list of tasks waiting for the
               event flag.
               Note that:
               1) This function assumes that interrupts are disabled.
               2) This function is INTERNAL to uC/OS-II and your
                  application should not call it.

PARAMETER1:    Pointer to a structure which contains data about the task
               waiting for event flag bit(s) to be set.

RETURN VALUE:  None
                            
END DESCRIPTION **********************************************************/

nodebug
void  OS_FlagUnlink (OS_FLAG_NODE *pnode)
{
    auto OS_TCB       *ptcb;
    auto OS_FLAG_GRP  *pgrp;
    auto OS_FLAG_NODE  pnode_prev;
    auto OS_FLAG_NODE  pnode_next;
    
    if (pnode->OSFlagNodePrev == 0) {                           /* Is it first node in wait list?      */
        pgrp                 = pnode->OSFlagNodeFlagGrp;        /* Yes, Point to event flag group      */
        pgrp->OSFlagWaitList = pnode->OSFlagNodeNext;           /*      Update list for new 1st node   */
        if (pnode->OSFlagNodeNext != 0) {       
				xmem2root(&pnode_next, pnode->OSFlagNodeNext, sizeof(pnode_next));
            pnode_next.OSFlagNodePrev = 0;                      /*      Link new 1st node PREV to NULL */
            root2xmem(pnode->OSFlagNodeNext, &pnode_next, sizeof(pnode_next));
        }
    } else {                                                    /* No,  A node somewhere in the list   */
        xmem2root(&pnode_prev, pnode->OSFlagNodePrev, sizeof(pnode_prev));
        pnode_prev.OSFlagNodeNext = pnode->OSFlagNodeNext;      /*      Link around the node to unlink */
        root2xmem(pnode->OSFlagNodePrev, &pnode_prev, sizeof(pnode_prev));
        if (pnode->OSFlagNodeNext != 0) {                       /*      Was this the LAST node?        */
            xmem2root(&pnode_next, pnode->OSFlagNodeNext, sizeof(pnode_next));
            pnode_next.OSFlagNodePrev = pnode->OSFlagNodePrev;  /*      No, Link around current node   */
            root2xmem(pnode->OSFlagNodeNext, &pnode_next, sizeof(pnode_next));
        }
    }
    ptcb                = (OS_TCB *)pnode->OSFlagNodeTCB;
#if OS_TASK_DEL_EN > 0
    ptcb->OSTCBFlagNode = 0;
#endif
}

#endif

/*** BeginHeader */
#endif
/*** EndHeader */