mirror of
https://github.com/ByteWelder/Tactility.git
synced 2026-02-18 19:03:16 +00:00
c1f55429b6
- Cleanup unused code and move ISR/IRQ checks to `Kernel.h` - Improve clang-format - Fix for LVGL lock transfer: ensure lock isn't activate when changing the lock - Implement SPI HAL - Remove `initHardware` HAL configuration entry - Fix `I2cScanner`: don't scan when port isn't started
80 lines
2.1 KiB
C++
80 lines
2.1 KiB
C++
#include "Tactility/Semaphore.h"
|
|
#include "Tactility/Check.h"
|
|
#include "Tactility/CoreDefines.h"
|
|
|
|
namespace tt {
|
|
|
|
static inline QueueHandle_t createHandle(uint32_t maxCount, uint32_t initialCount) {
|
|
assert((maxCount > 0U) && (initialCount <= maxCount));
|
|
|
|
if (maxCount == 1U) {
|
|
auto handle = xSemaphoreCreateBinary();
|
|
if ((handle != nullptr) && (initialCount != 0U)) {
|
|
if (xSemaphoreGive(handle) != pdPASS) {
|
|
vSemaphoreDelete(handle);
|
|
handle = nullptr;
|
|
}
|
|
}
|
|
return handle;
|
|
} else {
|
|
return xSemaphoreCreateCounting(maxCount, initialCount);
|
|
}
|
|
}
|
|
|
|
Semaphore::Semaphore(uint32_t maxAvailable, uint32_t initialAvailable) : handle(createHandle(maxAvailable, initialAvailable)) {
|
|
assert(!kernel::isIsr());
|
|
tt_check(handle != nullptr);
|
|
}
|
|
|
|
Semaphore::~Semaphore() {
|
|
assert(!kernel::isIsr());
|
|
}
|
|
|
|
bool Semaphore::acquire(TickType_t timeout) const {
|
|
if (kernel::isIsr()) {
|
|
if (timeout != 0U) {
|
|
return false;
|
|
} else {
|
|
BaseType_t yield = pdFALSE;
|
|
|
|
if (xSemaphoreTakeFromISR(handle.get(), &yield) != pdPASS) {
|
|
return false;
|
|
} else {
|
|
portYIELD_FROM_ISR(yield);
|
|
return true;
|
|
}
|
|
}
|
|
} else {
|
|
return xSemaphoreTake(handle.get(), timeout) == pdPASS;
|
|
}
|
|
}
|
|
|
|
bool Semaphore::release() const {
|
|
if (kernel::isIsr()) {
|
|
BaseType_t yield = pdFALSE;
|
|
if (xSemaphoreGiveFromISR(handle.get(), &yield) != pdTRUE) {
|
|
return false;
|
|
} else {
|
|
portYIELD_FROM_ISR(yield);
|
|
return true;
|
|
}
|
|
} else {
|
|
return xSemaphoreGive(handle.get()) == pdPASS;
|
|
}
|
|
}
|
|
|
|
uint32_t Semaphore::getAvailable() const {
|
|
if (kernel::isIsr()) {
|
|
// TODO: uxSemaphoreGetCountFromISR is not supported on esp-idf 5.1.2 - perhaps later on?
|
|
#ifdef uxSemaphoreGetCountFromISR
|
|
return uxSemaphoreGetCountFromISR(handle.get());
|
|
#else
|
|
return uxQueueMessagesWaitingFromISR(handle.get());
|
|
#endif
|
|
} else {
|
|
return uxSemaphoreGetCount(handle.get());
|
|
}
|
|
}
|
|
|
|
} // namespace
|