65 lines
1.4 KiB
C
65 lines
1.4 KiB
C
|
// Copied from https://github.com/esphome/esphome/blob/dev/esphome/components/esp32_ble_tracker/queue.h
|
||
|
|
#pragma once
|
||
|
|
|
||
|
|
#include "esphome/core/component.h"
|
||
|
|
#include "esphome/core/helpers.h"
|
||
|
|
|
||
|
|
#include <queue>
|
||
|
|
#include <mutex>
|
||
|
|
#include <cstring>
|
||
|
|
|
||
|
|
#include <freertos/FreeRTOS.h>
|
||
|
|
#include <freertos/semphr.h>
|
||
|
|
|
||
|
|
/*
|
||
|
|
* BLE events come in from a separate Task (thread) in the ESP32 stack. Rather
|
||
|
|
* than trying to deal with various locking strategies, all incoming GAP and GATT
|
||
|
|
* events will simply be placed on a semaphore guarded queue. The next time the
|
||
|
|
* component runs loop(), these events are popped off the queue and handed at
|
||
|
|
* this safer time.
|
||
|
|
*/
|
||
|
|
|
||
|
|
namespace esphome
|
||
|
|
{
|
||
|
|
namespace nimble_tracker
|
||
|
|
{
|
||
|
|
|
||
|
|
template <class T>
|
||
|
|
class Queue
|
||
|
|
{
|
||
|
|
public:
|
||
|
|
Queue() { m_ = xSemaphoreCreateMutex(); }
|
||
|
|
|
||
|
|
void push(T *element)
|
||
|
|
{
|
||
|
|
if (element == nullptr)
|
||
|
|
return;
|
||
|
|
if (xSemaphoreTake(m_, 5L / portTICK_PERIOD_MS))
|
||
|
|
{
|
||
|
|
q_.push(element);
|
||
|
|
xSemaphoreGive(m_);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
T *pop()
|
||
|
|
{
|
||
|
|
T *element = nullptr;
|
||
|
|
|
||
|
|
if (xSemaphoreTake(m_, 5L / portTICK_PERIOD_MS))
|
||
|
|
{
|
||
|
|
if (!q_.empty())
|
||
|
|
{
|
||
|
|
element = q_.front();
|
||
|
|
q_.pop();
|
||
|
|
}
|
||
|
|
xSemaphoreGive(m_);
|
||
|
|
}
|
||
|
|
return element;
|
||
|
|
}
|
||
|
|
|
||
|
|
protected:
|
||
|
|
std::queue<T *> q_;
|
||
|
|
SemaphoreHandle_t m_;
|
||
|
|
};
|
||
|
|
} // namespace nimble_tracker
|
||
|
|
} // namespace esphome
|