mirror of
https://github.com/ByteWelder/Tactility.git
synced 2026-02-18 10:53:17 +00:00
d86dc40472
- unPhone improvements related to power and boot (add boot count logging) - Cleanup of Mutex acquire/release - Removed `tt_assert()` in favour of `assert()` - Fix sim build (likely failed due to migration of GitHub Actions to Ubuntu 24.04)
78 lines
1.9 KiB
C++
78 lines
1.9 KiB
C++
#include "Semaphore.h"
|
|
#include "Check.h"
|
|
#include "CoreDefines.h"
|
|
|
|
namespace tt {
|
|
|
|
Semaphore::Semaphore(uint32_t maxCount, uint32_t initialCount) {
|
|
assert(!TT_IS_IRQ_MODE());
|
|
assert((maxCount > 0U) && (initialCount <= maxCount));
|
|
|
|
if (maxCount == 1U) {
|
|
handle = xSemaphoreCreateBinary();
|
|
if ((handle != nullptr) && (initialCount != 0U)) {
|
|
if (xSemaphoreGive(handle) != pdPASS) {
|
|
vSemaphoreDelete(handle);
|
|
handle = nullptr;
|
|
}
|
|
}
|
|
} else {
|
|
handle = xSemaphoreCreateCounting(maxCount, initialCount);
|
|
}
|
|
|
|
tt_check(handle);
|
|
}
|
|
|
|
Semaphore::~Semaphore() {
|
|
assert(!TT_IS_IRQ_MODE());
|
|
vSemaphoreDelete(handle);
|
|
}
|
|
|
|
bool Semaphore::acquire(uint32_t timeout) const {
|
|
if (TT_IS_IRQ_MODE()) {
|
|
if (timeout != 0U) {
|
|
return false;
|
|
} else {
|
|
BaseType_t yield = pdFALSE;
|
|
|
|
if (xSemaphoreTakeFromISR(handle, &yield) != pdPASS) {
|
|
return false;
|
|
} else {
|
|
portYIELD_FROM_ISR(yield);
|
|
return true;
|
|
}
|
|
}
|
|
} else {
|
|
return xSemaphoreTake(handle, (TickType_t)timeout) == pdPASS;
|
|
}
|
|
}
|
|
|
|
bool Semaphore::release() const {
|
|
if (TT_IS_IRQ_MODE()) {
|
|
BaseType_t yield = pdFALSE;
|
|
if (xSemaphoreGiveFromISR(handle, &yield) != pdTRUE) {
|
|
return false;
|
|
} else {
|
|
portYIELD_FROM_ISR(yield);
|
|
return true;
|
|
}
|
|
} else {
|
|
return xSemaphoreGive(handle) == pdPASS;
|
|
}
|
|
}
|
|
|
|
uint32_t Semaphore::getCount() const {
|
|
if (TT_IS_IRQ_MODE()) {
|
|
// TODO: uxSemaphoreGetCountFromISR is not supported on esp-idf 5.1.2 - perhaps later on?
|
|
#ifdef uxSemaphoreGetCountFromISR
|
|
return uxSemaphoreGetCountFromISR(handle);
|
|
#else
|
|
return uxQueueMessagesWaitingFromISR((QueueHandle_t)hSemaphore);
|
|
#endif
|
|
} else {
|
|
return uxSemaphoreGetCount(handle);
|
|
}
|
|
}
|
|
|
|
} // namespace
|