qpc/source/qf_qeq.c

/**
* @file
* @brief QEQueue implementation
* @ingroup qf
* @cond
******************************************************************************
* Last updated for version 5.9.6
* Last updated on  2017-08-01
*
*                    Q u a n t u m     L e a P s
*                    ---------------------------
*                    innovating embedded systems
*
* Copyright (C) Quantum Leaps, LLC. All rights reserved.
*
* This program is open source software: you can redistribute it and/or
* modify it under the terms of the GNU General Public License as published
* by the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* Alternatively, this program may be distributed and modified under the
* terms of Quantum Leaps commercial licenses, which expressly supersede
* the GNU General Public License and are specifically designed for
* licensees interested in retaining the proprietary status of their code.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*
* Contact information:
* https://state-machine.com
* mailto:info@state-machine.com
******************************************************************************
* @endcond
*/
#define QP_IMPL           /* this is QP implementation */
#include "qf_port.h"      /* QF port */
#include "qf_pkg.h"       /* QF package-scope interface */
#include "qassert.h"      /* QP embedded systems-friendly assertions */
#ifdef Q_SPY              /* QS software tracing enabled? */
    #include "qs_port.h"  /* include QS port */
#else
    #include "qs_dummy.h" /* disable the QS software tracing */
#endif /* Q_SPY */

Q_DEFINE_THIS_MODULE("qf_qeq")


/****************************************************************************/
/**
* @description
* Initialize the event queue by giving it the storage for the ring buffer.
*
* @param[in,out] me   pointer (see @ref oop)
* @param[in]     qSto an array of pointers to ::QEvt to sereve as the
*                     ring buffer for the event queue
* @param[in]     qLen the length of the qSto[] buffer (in ::QEvt pointers)
*
* @note The actual capacity of the queue is qLen + 1, because of the extra
* location forntEvt.
*
* @note This function is also used to initialize the event queues of active
* objects in the built-int QV and QK kernels, as well as other
* QP ports to OSes/RTOSes that do provide a suitable message queue.
*/
void QEQueue_init(QEQueue * const me, QEvt const *qSto[],
                  uint_fast16_t const qLen)
{
    QS_CRIT_STAT_

    me->frontEvt = (QEvt const *)0; /* no events in the queue */
    me->ring     = &qSto[0];        /* the beginning of the ring buffer */
    me->end      = (QEQueueCtr)qLen;
    if (qLen != (uint_fast16_t)0) {
        me->head = (QEQueueCtr)0;
        me->tail = (QEQueueCtr)0;
    }
    me->nFree    = (QEQueueCtr)(qLen + (uint_fast16_t)1); /*+1 for frontEvt */
    me->nMin     = me->nFree;

    QS_BEGIN_(QS_QF_EQUEUE_INIT, QS_priv_.locFilter[EQ_OBJ], me)
        QS_OBJ_(me);          /* this QEQueue object */
        QS_EQC_(me->end);     /* the length of the queue */
    QS_END_()
}

/**
* @note this function is used for the "raw" thread-safe queues and NOT
* for the queues of active objects.
*/

/****************************************************************************/
/**
* @description
* Post an event to the "raw" thread-safe event queue using the
* First-In-First-Out (FIFO) order.
*
* @param[in,out] me     pointer (see @ref oop)
* @param[in]     e      pointer to the event to be posted to the queue
* @param[in]     margin number of required free slots in the queue after
*                       posting the event. The special value #QF_NO_MARGIN
*                       means that this function will assert if posting
* @note
* The #QF_NO_MARGIN value of the @p margin parameter is special and
* denotes situation when the post() operation is assumed to succeed (event
* delivery guarantee). An assertion fires, when the event cannot be
* delivered in this case.
*
* @returns 'true' (success) when the posting succeeded with the provided
* margin and 'false' (failure) when the posting fails.
*
* @note This function can be called from any task context or ISR context.
*
* @sa QEQueue_postLIFO(), QEQueue_get()
*/
bool QEQueue_post(QEQueue * const me, QEvt const * const e,
                  uint_fast16_t const margin)
{
    QEQueueCtr nFree; /* temporary to avoid UB for volatile access */
    bool status;
    QF_CRIT_STAT_

    /* @pre event must be valid */
    Q_REQUIRE_ID(200, e != (QEvt const *)0);

    QF_CRIT_ENTRY_();
    nFree = me->nFree; /* get volatile into the temporary */

    /* required margin available? */
    if (((margin == QF_NO_MARGIN) && (nFree > (QEQueueCtr)0))
        || (nFree > (QEQueueCtr)margin))
    {

        QS_BEGIN_NOCRIT_(QS_QF_EQUEUE_POST_FIFO,
                         QS_priv_.locFilter[EQ_OBJ], me)
            QS_TIME_();                      /* timestamp */
            QS_SIG_(e->sig);                 /* the signal of this event */
            QS_OBJ_(me);                     /* this queue object */
            QS_2U8_(e->poolId_, e->refCtr_); /* pool Id & ref Count */
            QS_EQC_(nFree);                  /* number of free entries */
            QS_EQC_(me->nMin);               /* min number of free entries */
        QS_END_NOCRIT_()

        /* is it a pool event? */
        if (e->poolId_ != (uint8_t)0) {
            QF_EVT_REF_CTR_INC_(e); /* increment the reference counter */
        }

        --nFree; /* one free entry just used up */
        me->nFree = nFree; /* update the volatile */
        if (me->nMin > nFree) {
            me->nMin = nFree; /* update minimum so far */
        }

        /* was the queue empty? */
        if (me->frontEvt == (QEvt const *)0) {
            me->frontEvt = e; /* deliver event directly */
        }
        /* queue was not empty, insert event into the ring-buffer */
        else {
            /* insert event into the ring buffer (FIFO)... */
            QF_PTR_AT_(me->ring, me->head) = e; /* insert e into buffer */
            /* need to wrap the head? */
            if (me->head == (QEQueueCtr)0) {
                me->head = me->end; /* wrap around */
            }
            --me->head;
        }
        status = true; /* event posted successfully */
    }
    else {
        /** @note assert if event cannot be posted and dropping events is
        * not acceptable
        */
        Q_ASSERT_ID(210, margin != QF_NO_MARGIN);

        QS_BEGIN_NOCRIT_(QS_QF_EQUEUE_POST_ATTEMPT,
                         QS_priv_.locFilter[EQ_OBJ], me)
            QS_TIME_();                      /* timestamp */
            QS_SIG_(e->sig);                 /* the signal of this event */
            QS_OBJ_(me);                     /* this queue object */
            QS_2U8_(e->poolId_, e->refCtr_); /* pool Id & ref Count */
            QS_EQC_(nFree);                  /* number of free entries */
            QS_EQC_(margin);                 /* margin requested */
        QS_END_NOCRIT_()

        status = false;
    }
    QF_CRIT_EXIT_();

    return status;
}

/****************************************************************************/
/**
* @description
* Post an event to the "raw" thread-safe event queue using the
* Last-In-First-Out (LIFO) order.
*
* @param[in,out] me  pointer (see @ref oop)
* @param[in]     e   pointer to the event to be posted to the queue
*
* @attention
* The LIFO policy should be used only with great __caution__, because
* it alters the order of events in the queue.
*
* @note This function can be called from any task context or ISR context.
*
* @note this function is used for the "raw" thread-safe queues and __not__
* for the queues of active objects.
*
* @sa QEQueue_post(), QEQueue_get(), QActive_defer()
*/
void QEQueue_postLIFO(QEQueue * const me, QEvt const * const e) {
    QEvt const *frontEvt; /* temporary to avoid UB for volatile access */
    QEQueueCtr nFree;     /* temporary to avoid UB for volatile access */
    QF_CRIT_STAT_

    QF_CRIT_ENTRY_();
    nFree = me->nFree;    /* get volatile into the temporary */

    /** @pre the queue must be able to accept the event (cannot overflow) */
    Q_REQUIRE_ID(300, nFree != (QEQueueCtr)0);

    QS_BEGIN_NOCRIT_(QS_QF_EQUEUE_POST_LIFO, QS_priv_.locFilter[EQ_OBJ], me)
        QS_TIME_();              /* timestamp */
        QS_SIG_(e->sig);         /* the signal of this event */
        QS_OBJ_(me);             /* this queue object */
        QS_2U8_(e->poolId_, e->refCtr_);/* pool Id & ref Count of the event */
        QS_EQC_(nFree);          /* number of free entries */
        QS_EQC_(me->nMin);       /* min number of free entries */
    QS_END_NOCRIT_()

    /* is it a pool event? */
    if (e->poolId_ != (uint8_t)0) {
        QF_EVT_REF_CTR_INC_(e);  /* increment the reference counter */
    }

    --nFree;  /* one free entry just used up */
    me->nFree = nFree; /* update the volatile */
    if (me->nMin > nFree) {
        me->nMin = nFree; /* update minimum so far */
    }

    frontEvt = me->frontEvt; /* read volatile into the temporary */
    me->frontEvt = e; /* deliver event directly to the front of the queue */

    /* was the queue not empty? */
    if (frontEvt != (QEvt const *)0) {
        ++me->tail;
        if (me->tail == me->end) {     /* need to wrap the tail? */
            me->tail = (QEQueueCtr)0;  /* wrap around */
        }
        QF_PTR_AT_(me->ring, me->tail) = frontEvt; /* save old front evt */
    }
    QF_CRIT_EXIT_();
}

/****************************************************************************/
/**
* @description
* Retrieves an event from the front of the "raw" thread-safe queue and
* returns a pointer to this event to the caller.
*
* @param[in,out] me     pointer (see @ref oop)
*
* @returns pointer to event at the front of the queue, if the queue is
* not empty and NULL if the queue is empty.
*
* @note this function is used for the "raw" thread-safe queues and __not__
* for the queues of active objects.
*
* @sa QEQueue_post(), QEQueue_postLIFO(), QActive_recall()
*/
QEvt const *QEQueue_get(QEQueue * const me) {
    QEvt const *e;
    QF_CRIT_STAT_

    QF_CRIT_ENTRY_();
    e = me->frontEvt; /* always remove the event from the front location */

    /* was the queue not empty? */
    if (e != (QEvt const *)0) {
        /* use a temporary variable to increment volatile me->nFree */
        QEQueueCtr nFree = me->nFree + (QEQueueCtr)1;
        me->nFree = nFree; /* update the number of free */

        /* any events in the ring buffer? */
        if (nFree <= me->end) {
            me->frontEvt = QF_PTR_AT_(me->ring, me->tail); /* get from tail */
            if (me->tail == (QEQueueCtr)0) { /* need to wrap the tail? */
                me->tail = me->end; /* wrap around */
            }
            --me->tail;

            QS_BEGIN_NOCRIT_(QS_QF_EQUEUE_GET, QS_priv_.locFilter[EQ_OBJ], me)
                QS_TIME_();           /* timestamp */
                QS_SIG_(e->sig);      /* the signal of this event */
                QS_OBJ_(me);          /* this queue object */
                QS_2U8_(e->poolId_, e->refCtr_);/* pool Id & ref Count */
                QS_EQC_(nFree);       /* number of free entries */
            QS_END_NOCRIT_()
        }
        else {
            me->frontEvt = (QEvt const *)0; /* queue becomes empty */

            /* all entries in the queue must be free (+1 for fronEvt) */
            Q_ASSERT_ID(410, nFree == (me->end + (QEQueueCtr)1));

            QS_BEGIN_NOCRIT_(QS_QF_EQUEUE_GET_LAST,
                             QS_priv_.locFilter[EQ_OBJ], me)
                QS_TIME_();           /* timestamp */
                QS_SIG_(e->sig);      /* the signal of this event */
                QS_OBJ_(me);          /* this queue object */
                QS_2U8_(e->poolId_, e->refCtr_); /* pool Id & ref Count */
            QS_END_NOCRIT_()
        }
    }
    QF_CRIT_EXIT_();
    return e;
}