MySensors_Queue.h

#include <cppQueue.h>
#include <core/MyMessage.h>
#include <core/MySensorsCore.h>

#if !defined(IMPLEMENTATION)
#define	IMPLEMENTATION	FIFO
#endif
#if !defined(QUEUE_SIZE)
#define QUEUE_SIZE 16
#endif

cppQueue	q(sizeof(MyMessage), QUEUE_SIZE, IMPLEMENTATION);	// Instantiate queue

void queue(MyMessage msg) {
    q.push(&msg);
}

void send() {
  if (!q.isEmpty()) {
    MyMessage msg;
    q.pop(&msg);
    send(msg);
  }
}