mirror of
https://github.com/esphome/esphome.git
synced 2026-09-20 11:38:48 +00:00
J. Nick Koston
586e37c864
BK72xx's FreeRTOS does not enable configSUPPORT_STATIC_ALLOCATION, so xQueueCreateStatic is unavailable. Fall back to xQueueCreate which is a one-time heap allocation during setup.
74 lines
1.7 KiB
C++
74 lines
1.7 KiB
C++
#pragma once
|
|
|
|
#include "esphome/core/defines.h"
|
|
|
|
#ifdef ESPHOME_THREAD_MULTI_NO_ATOMICS
|
|
|
|
#include <cstddef>
|
|
#include <cstdint>
|
|
|
|
#include <FreeRTOS.h>
|
|
#include <queue.h>
|
|
|
|
/*
|
|
* FreeRTOS queue wrapper for single-producer single-consumer scenarios on
|
|
* platforms without hardware atomic support (e.g. BK72xx ARM968E-S).
|
|
*
|
|
* Provides the same API as LockFreeQueue (push, pop, get_and_reset_dropped_count,
|
|
* empty, full, size) but uses xQueue internally, which synchronizes via
|
|
* FreeRTOS critical sections.
|
|
*
|
|
* @tparam T The type of elements stored in the queue (stored as pointers)
|
|
* @tparam SIZE The maximum number of elements
|
|
*/
|
|
|
|
namespace esphome {
|
|
|
|
template<class T, uint8_t SIZE> class FreeRTOSQueue {
|
|
public:
|
|
FreeRTOSQueue() : dropped_count_(0) { this->handle_ = xQueueCreate(SIZE, sizeof(T *)); }
|
|
|
|
bool push(T *element) {
|
|
if (element == nullptr)
|
|
return false;
|
|
|
|
if (xQueueSend(this->handle_, &element, 0) != pdPASS) {
|
|
this->dropped_count_++;
|
|
return false;
|
|
}
|
|
return true;
|
|
}
|
|
|
|
T *pop() {
|
|
T *element;
|
|
if (xQueueReceive(this->handle_, &element, 0) != pdTRUE) {
|
|
return nullptr;
|
|
}
|
|
return element;
|
|
}
|
|
|
|
uint16_t get_and_reset_dropped_count() {
|
|
uint16_t count = this->dropped_count_;
|
|
if (count == 0)
|
|
return 0;
|
|
this->dropped_count_ = 0;
|
|
return count;
|
|
}
|
|
|
|
void increment_dropped_count() { this->dropped_count_++; }
|
|
|
|
bool empty() const { return uxQueueMessagesWaiting(this->handle_) == 0; }
|
|
|
|
bool full() const { return uxQueueSpacesAvailable(this->handle_) == 0; }
|
|
|
|
size_t size() const { return uxQueueMessagesWaiting(this->handle_); }
|
|
|
|
protected:
|
|
QueueHandle_t handle_;
|
|
volatile uint16_t dropped_count_;
|
|
};
|
|
|
|
} // namespace esphome
|
|
|
|
#endif // ESPHOME_THREAD_MULTI_NO_ATOMICS
|