/space/home/slher/rel/Beken/v6_4_5/macsw/modules/ke/src/ke_queue.c

Go to the documentation of this file.

/*
 * INCLUDE FILES
 ****************************************************************************************
 */
#include <stddef.h>
#include "co_int.h"
#include "co_bool.h"
#include "dbg_assert.h"

#include "ke_config.h"
#include "ke_queue.h"
#include "ke_mem.h"

struct co_list_hdr *ke_queue_extract(struct co_list * const queue,
                                 bool (*func)(struct co_list_hdr const * elmt, uint32_t arg),
                                 uint32_t arg)
{
    struct co_list_hdr *prev = NULL;
    struct co_list_hdr *element  = queue->first;

    while (element)
    {
        if (func(element, arg))
        {
            if (prev)
            {
                // second or more
                prev->next = element->next;
            }
            else
            {
                // first message
                queue->first = element->next;
            }

            if (element->next)
            {
                // not the last
                element->next = NULL;
            }
            else
            {
                // last message
                queue->last = prev;
            }

            break;
        }

        prev = element;
        element = element->next;
    }

    #if KE_PROFILING
    if(element != NULL)
    {
        queue->cnt--;
        if(queue->mincnt > queue->cnt)
        {
            queue->mincnt = queue->cnt;
        }
    }
    #endif //KE_PROFILING

    return element;
}

---