esp-fc

#pragma once

// https://www.raspberrypi.com/documentation/pico-sdk/high_level.html#queue
// https://techtutorialsx.com/2017/08/20/esp32-arduino-freertos-queues/
// https://www.freertos.org/a00116.html

namespace Espfc {

enum EventType
{
  EVENT_IDLE,
  EVENT_GYRO_READ,
  EVENT_ACCEL_READ,
  EVENT_DISARM,
};

struct Event
{
  Event(): type(EVENT_IDLE) {}
  Event(EventType t): type(t) {}
  Event(const Event& e) = default;
  EventType type;
};

} // namespace Espfc

#if defined(ARCH_RP2040)
#include <pico/util/queue.h>
using TargetQueueHandle = queue_t;
#elif defined(ESPFC_FREE_RTOS_QUEUE)
#include <freertos/queue.h>
using TargetQueueHandle = QueueHandle_t;
#elif defined(ESPFC_ATOMIC_QUEUE)
#include "QueueAtomic.h"
using TargetQueueHandle = Espfc::QueueAtomic<Espfc::Event, 63>;
#elif defined(UNIT_TEST) || !defined(ESPFC_MULTI_CORE)
using TargetQueueHandle = int;
#else
#error "Not yet implelented multicore queue"
#endif

namespace Espfc::Target {

class Queue
{
public:
  void begin();
  void send(const Event& e);
  Event receive();
  bool isEmpty() const;
  bool isFull() const;

private:
  TargetQueueHandle _q;
};

} // namespace Espfc::Target