PacketQueueService.h

#ifndef _LORAMESHER_PACKET_QUEUE_SERVICE_H
#define _LORAMESHER_PACKET_QUEUE_SERVICE_H
 
#include <Arduino.h>
 
#include "ArduinoLog.h"
 
#include "entities/packets/QueuePacket.h"
 
#include "services/PacketService.h"
 
#include "utilities/LinkedQueue.hpp"
 
class PacketQueueService {
public:
 
    template<class T>
    static QueuePacket<T>* createQueuePacket(T* p, uint8_t priority, uint16_t number = 0) {
        QueuePacket<T>* qp = new QueuePacket<T>();
        qp->priority = priority;
        qp->number = number;
        qp->packet = p;
        return qp;
    }
 
    template<class T>
    static QueuePacket<T>* findPacketQueue(LM_LinkedList<QueuePacket<T>>* queue, uint8_t num) {
        queue->setInUse();
 
        if (queue->moveToStart()) {
            do {
                QueuePacket<T>* current = queue->getCurrent();
 
                if (current->number == num) {
                    queue->releaseInUse();
                    return current;
                }
 
            } while (queue->next());
        }
 
        queue->releaseInUse();
 
        return nullptr;
    }
 
    static void addOrdered(LM_LinkedList<QueuePacket<Packet<uint8_t>>>* list, QueuePacket<Packet<uint8_t>>* qp);
 
    static void deleteQueuePacketAndPacket(QueuePacket<Packet<uint8_t>>* pq) {
        Log.traceln(F("Deleting packet"));
        free(pq->packet);
 
        Log.traceln(F("Deleting packet queue"));
        delete pq;
    }
 
    template <typename T>
    static void deleteQueuePacketAndPacket(QueuePacket<T>* pq) {
        deleteQueuePacketAndPacket(reinterpret_cast<QueuePacket<Packet<uint8_t>>*>(pq));
    }
 
};
 
#endif