2021-07-14 10:50:44 +02:00
|
|
|
#include "fsfw/osal/rtems/Mutex.h"
|
2022-02-02 10:29:30 +01:00
|
|
|
|
2021-07-14 10:50:44 +02:00
|
|
|
#include "fsfw/serviceinterface/ServiceInterface.h"
|
2018-07-12 16:29:32 +02:00
|
|
|
|
|
|
|
uint8_t Mutex::count = 0;
|
|
|
|
|
2021-01-28 11:28:28 +01:00
|
|
|
Mutex::Mutex() {
|
2022-02-02 10:29:30 +01:00
|
|
|
rtems_name mutexName = ('M' << 24) + ('T' << 16) + ('X' << 8) + count++;
|
|
|
|
rtems_status_code status = rtems_semaphore_create(
|
|
|
|
mutexName, 1, RTEMS_BINARY_SEMAPHORE | RTEMS_PRIORITY | RTEMS_INHERIT_PRIORITY, 0, &mutexId);
|
|
|
|
if (status != RTEMS_SUCCESSFUL) {
|
2021-01-04 15:34:08 +01:00
|
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
2022-02-02 10:29:30 +01:00
|
|
|
sif::error << "Mutex::Mutex: Creation with name, id " << mutexName << ", " << mutexId
|
|
|
|
<< " failed with " << status << std::endl;
|
2021-01-28 11:28:28 +01:00
|
|
|
#else
|
2022-02-02 10:29:30 +01:00
|
|
|
sif::printError("Mutex::Mutex: Creation with name, id %s, %d failed with %d\n", mutexName,
|
|
|
|
static_cast<int>(mutexId), static_cast<int>(status));
|
2021-01-04 15:34:08 +01:00
|
|
|
#endif
|
2022-02-02 10:29:30 +01:00
|
|
|
}
|
2018-07-12 16:29:32 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
Mutex::~Mutex() {
|
2022-02-02 10:29:30 +01:00
|
|
|
rtems_status_code status = rtems_semaphore_delete(mutexId);
|
|
|
|
if (status != RTEMS_SUCCESSFUL) {
|
2021-01-04 15:34:08 +01:00
|
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
2022-02-02 10:29:30 +01:00
|
|
|
sif::error << "Mutex: deletion for id " << mutexId << " failed with " << status << std::endl;
|
2021-01-04 15:34:08 +01:00
|
|
|
#endif
|
2022-02-02 10:29:30 +01:00
|
|
|
}
|
2018-07-12 16:29:32 +02:00
|
|
|
}
|
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
ReturnValue_t Mutex::lockMutex(TimeoutType timeoutType = TimeoutType::BLOCKING,
|
|
|
|
uint32_t timeoutMs) {
|
|
|
|
rtems_status_code status = RTEMS_INVALID_ID;
|
|
|
|
if (timeoutType == MutexIF::TimeoutType::BLOCKING) {
|
|
|
|
status = rtems_semaphore_obtain(mutexId, RTEMS_WAIT, RTEMS_NO_TIMEOUT);
|
|
|
|
} else if (timeoutType == MutexIF::TimeoutType::POLLING) {
|
|
|
|
timeoutMs = RTEMS_NO_TIMEOUT;
|
|
|
|
status = rtems_semaphore_obtain(mutexId, RTEMS_NO_WAIT, 0);
|
|
|
|
} else {
|
|
|
|
status = rtems_semaphore_obtain(mutexId, RTEMS_WAIT, timeoutMs);
|
|
|
|
}
|
2020-06-09 13:26:27 +02:00
|
|
|
|
2022-02-02 10:29:30 +01:00
|
|
|
switch (status) {
|
|
|
|
case RTEMS_SUCCESSFUL:
|
|
|
|
// semaphore obtained successfully
|
|
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
|
|
case RTEMS_UNSATISFIED:
|
|
|
|
// semaphore not available
|
|
|
|
return MUTEX_NOT_FOUND;
|
|
|
|
case RTEMS_TIMEOUT:
|
|
|
|
// timed out waiting for semaphore
|
|
|
|
return MUTEX_TIMEOUT;
|
|
|
|
case RTEMS_OBJECT_WAS_DELETED:
|
|
|
|
// semaphore deleted while waiting
|
|
|
|
return MUTEX_DESTROYED_WHILE_WAITING;
|
|
|
|
case RTEMS_INVALID_ID:
|
|
|
|
// invalid semaphore id
|
|
|
|
return MUTEX_INVALID_ID;
|
|
|
|
default:
|
|
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
|
|
}
|
2018-07-12 16:29:32 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
ReturnValue_t Mutex::unlockMutex() {
|
2022-02-02 10:29:30 +01:00
|
|
|
rtems_status_code status = rtems_semaphore_release(mutexId);
|
|
|
|
switch (status) {
|
|
|
|
case RTEMS_SUCCESSFUL:
|
|
|
|
// semaphore obtained successfully
|
|
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
|
|
case RTEMS_NOT_OWNER_OF_RESOURCE:
|
|
|
|
// semaphore not available
|
|
|
|
return CURR_THREAD_DOES_NOT_OWN_MUTEX;
|
|
|
|
case RTEMS_INVALID_ID:
|
|
|
|
// invalid semaphore id
|
|
|
|
return MUTEX_INVALID_ID;
|
|
|
|
default:
|
|
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
|
|
}
|
2018-07-12 16:29:32 +02:00
|
|
|
}
|