Changeset 126 in flair-src for trunk/lib/FlairCore/src/Semaphore_impl.cpp

Timestamp:

Jan 17, 2017, 10:47:02 AM (8 years ago)

Author:

Thomas Fuhrmann

Message:

Add timed semaphore and bool return

File:

• trunk/lib/FlairCore/src/Semaphore_impl.cpp (modified) (3 diffs)

trunk/lib/FlairCore/src/Semaphore_impl.cpp

@@ -20 +20 @@
 
 #include <string.h>
+#include <time.h>
 
 using std::string;
@@ -48 +49 @@
 }
 
-void Semaphore_impl::GetSemaphore(void) {
+bool Semaphore_impl::GetSemaphore(Time timeout) {
   int status;
+  bool returnValue = true;
 #ifdef __XENO__
-  status = rt_sem_p(&semaphore, TM_INFINITE);
+  status = rt_sem_p(&semaphore, timeout);
 #else
-  status = sem_wait(&semaphore);
+  if (timeout != 0) {
+    struct timespec semTimeout;
+    clock_gettime(CLOCK_REALTIME, &semTimeout);
+    semTimeout.tv_sec += timeout / 1000000000ULL;
+    semTimeout.tv_nsec += timeout % 1000000000ULL;
+    if (semTimeout.tv_nsec >= 1000000000ULL) {
+        semTimeout.tv_sec++;
+        semTimeout.tv_nsec -= 1000000000ULL;
+    }
+    status = sem_timedwait(&semaphore, &semTimeout);
+  } else {
+    status = sem_wait(&semaphore);
+  }
 #endif
-  if (status != 0)
-    self->Err("error getting the semaphore (%s)\n", strerror(-status));
+        if (status != 0) {
+                if (errno == ETIMEDOUT) {
+                        self->Warn("warning : semaphore timedout\n");   
+                } else {
+                    self->Err("error getting the semaphore (%s)\n", strerror(-status));
+                }
+    returnValue = false;
+  }
+  return returnValue;
 }
 
-void Semaphore_impl::ReleaseSemaphore(void) {
+bool Semaphore_impl::ReleaseSemaphore(void) {
   int status;
+  bool returnValue = true;
 #ifdef __XENO__
   status = rt_sem_v(&semaphore);
@@ -66 +88 @@
   status = sem_post(&semaphore);
 #endif
-  if (status != 0)
+  if (status != 0) {
     self->Err("error releasing the semaphore (%s)\n", strerror(-status));
+    returnValue = false;
+  }
+  return returnValue;
 }