120 lines
3.8 KiB
C++
120 lines
3.8 KiB
C++
#include "Mutex.h"
|
|
#include "../../serviceinterface/ServiceInterfaceStream.h"
|
|
#include "../../timemanager/Clock.h"
|
|
|
|
uint8_t Mutex::count = 0;
|
|
|
|
|
|
#include <cstring>
|
|
#include <errno.h>
|
|
|
|
Mutex::Mutex() {
|
|
pthread_mutexattr_t mutexAttr;
|
|
int status = pthread_mutexattr_init(&mutexAttr);
|
|
if (status != 0) {
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
sif::error << "Mutex: Attribute init failed with: " << strerror(status) << std::endl;
|
|
#endif
|
|
}
|
|
status = pthread_mutexattr_setprotocol(&mutexAttr, PTHREAD_PRIO_INHERIT);
|
|
if (status != 0) {
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
sif::error << "Mutex: Attribute set PRIO_INHERIT failed with: " << strerror(status)
|
|
<< std::endl;
|
|
#endif
|
|
}
|
|
status = pthread_mutex_init(&mutex, &mutexAttr);
|
|
if (status != 0) {
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
sif::error << "Mutex: creation with name, id " << mutex.__data.__count
|
|
<< ", " << " failed with " << strerror(status) << std::endl;
|
|
#endif
|
|
}
|
|
// After a mutex attributes object has been used to initialize one or more
|
|
// mutexes, any function affecting the attributes object
|
|
// (including destruction) shall not affect any previously initialized mutexes.
|
|
status = pthread_mutexattr_destroy(&mutexAttr);
|
|
if (status != 0) {
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
sif::error << "Mutex: Attribute destroy failed with " << strerror(status) << std::endl;
|
|
#endif
|
|
}
|
|
}
|
|
|
|
Mutex::~Mutex() {
|
|
//No Status check yet
|
|
pthread_mutex_destroy(&mutex);
|
|
}
|
|
|
|
ReturnValue_t Mutex::lockMutex(TimeoutType timeoutType, uint32_t timeoutMs) {
|
|
int status = 0;
|
|
|
|
if(timeoutType == TimeoutType::POLLING) {
|
|
status = pthread_mutex_trylock(&mutex);
|
|
}
|
|
else if (timeoutType == TimeoutType::WAITING) {
|
|
timespec timeOut;
|
|
clock_gettime(CLOCK_REALTIME, &timeOut);
|
|
uint64_t nseconds = timeOut.tv_sec * 1000000000 + timeOut.tv_nsec;
|
|
nseconds += timeoutMs * 1000000;
|
|
timeOut.tv_sec = nseconds / 1000000000;
|
|
timeOut.tv_nsec = nseconds - timeOut.tv_sec * 1000000000;
|
|
status = pthread_mutex_timedlock(&mutex, &timeOut);
|
|
}
|
|
else if(timeoutType == TimeoutType::BLOCKING) {
|
|
status = pthread_mutex_lock(&mutex);
|
|
}
|
|
|
|
switch (status) {
|
|
case EINVAL:
|
|
// The mutex was created with the protocol attribute having the value
|
|
// PTHREAD_PRIO_PROTECT and the calling thread's priority is higher
|
|
// than the mutex's current priority ceiling.
|
|
return WRONG_ATTRIBUTE_SETTING;
|
|
// The process or thread would have blocked, and the abs_timeout
|
|
// parameter specified a nanoseconds field value less than zero or
|
|
// greater than or equal to 1000 million.
|
|
// The value specified by mutex does not refer to an initialized mutex object.
|
|
//return MUTEX_NOT_FOUND;
|
|
case EBUSY:
|
|
// The mutex could not be acquired because it was already locked.
|
|
return MUTEX_ALREADY_LOCKED;
|
|
case ETIMEDOUT:
|
|
// The mutex could not be locked before the specified timeout expired.
|
|
return MUTEX_TIMEOUT;
|
|
case EAGAIN:
|
|
// The mutex could not be acquired because the maximum number of
|
|
// recursive locks for mutex has been exceeded.
|
|
return MUTEX_MAX_LOCKS;
|
|
case EDEADLK:
|
|
// A deadlock condition was detected or the current thread
|
|
// already owns the mutex.
|
|
return CURR_THREAD_ALREADY_OWNS_MUTEX;
|
|
case 0:
|
|
//Success
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
default:
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
};
|
|
}
|
|
|
|
ReturnValue_t Mutex::unlockMutex() {
|
|
int status = pthread_mutex_unlock(&mutex);
|
|
switch (status) {
|
|
case EINVAL:
|
|
//The value specified by mutex does not refer to an initialized mutex object.
|
|
return MUTEX_NOT_FOUND;
|
|
case EAGAIN:
|
|
//The mutex could not be acquired because the maximum number of recursive locks for mutex has been exceeded.
|
|
return MUTEX_MAX_LOCKS;
|
|
case EPERM:
|
|
//The current thread does not own the mutex.
|
|
return CURR_THREAD_DOES_NOT_OWN_MUTEX;
|
|
case 0:
|
|
//Success
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
default:
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
};
|
|
}
|