irq_msg_util.c

#include "irq_msg_util.h"
#include "stdbool.h"
#include "stddef.h"
#include "CBUF.h"
#include "nrf_util.h"
#include "string.h"
#include "nrf_assert.h"

//For all the code not public for file, message is shortened to msg

#define msgbuf_SIZE  16

#if (!(!(msgbuf_SIZE & (msgbuf_SIZE-1)) && msgbuf_SIZE))
#error msgbuf_SIZE must be a power of 2
#endif

struct message
{
    irq_msg_types type;
    void * more_data;
};

volatile static struct
{
    uint32_t m_getIdx;
    uint32_t m_putIdx;
    struct message m_entry[msgbuf_SIZE];
} msgbuf;

irq_msg_callbacks cb_list = { NULL, NULL };

void irq_msg_init(irq_msg_callbacks * cb_ptr)
{
    CBUF_Init(msgbuf);

    ASSERT((cb_ptr->next_interval_cb != NULL)
            && (cb_ptr->state_change_cb != NULL));

    cb_list.next_interval_cb = cb_ptr->next_interval_cb;
    cb_list.state_change_cb = cb_ptr->state_change_cb;
}

void irq_msg_push(irq_msg_types pushed_msg, void * more_data)
{
    CRITICAL_REGION_ENTER();

    struct message msg;
    msg.type = pushed_msg;
    msg.more_data = more_data;

    CBUF_Push(msgbuf, msg);

    CRITICAL_REGION_EXIT();
}

void irq_msg_process(void)
{
    while (CBUF_Len(msgbuf))
    {
        struct message msg = CBUF_Pop(msgbuf);

//    log_printf("_%x\n",msg.type);
        switch (msg.type)
        {
        case MSG_NEXT_INTERVAL:
            cb_list.next_interval_cb(
                    (uint32_t) (msg.more_data));
            break;
        case MSG_STATE_CHANGE:
            cb_list.state_change_cb(
                    (uint32_t) (msg.more_data));
            break;
        default:
            break;
        }
    }
}