1 files changed, 62 insertions, 0 deletions
diff --git a/c/src/exec/itron/src/twai_sem.c b/c/src/exec/itron/src/twai_sem.c
new file mode 100644
index 0000000000..4354c7cff3
--- /dev/null
+++ b/c/src/exec/itron/src/twai_sem.c
@@ -0,0 +1,62 @@
+/*
+ *  The license and distribution terms for this file may be
+ *  found in the file LICENSE in this distribution or at
+ *  http://www.OARcorp.com/rtems/license.html.
+ *
+ *  $Id$
+ */
+
+#include <itron.h>
+
+#include <rtems/itron/semaphore.h>
+#include <rtems/itron/task.h>
+#include <rtems/score/tod.h>
+
+/*
+ *  twai_sem - Wait on Semaphore with Timeout
+ *
+ *  This function implements the ITRON 3.0 twai_sem() service.
+ */
+
+ER twai_sem(
+  ID semid,
+  TMO tmout
+)
+{
+  ITRON_Semaphore_Control *the_semaphore;
+  Objects_Locations        location;
+  Watchdog_Interval        interval;
+  boolean                  wait;
+  CORE_semaphore_Status    status;
+  
+  interval = 0;
+  if ( tmout == TMO_POL ) {
+    wait = FALSE;
+  } else {
+    wait = TRUE;
+    if ( tmout != TMO_FEVR )
+      interval = TOD_MILLISECONDS_TO_TICKS(tmout);
+  }
+
+  if ( wait && _ITRON_Is_in_non_task_state() )
+    return E_CTX;
+  
+  the_semaphore = _ITRON_Semaphore_Get( semid, &location );
+  switch ( location ) {
+    case OBJECTS_REMOTE:               /* Multiprocessing not supported */
+    case OBJECTS_ERROR:
+      return _ITRON_Semaphore_Clarify_get_id_error( semid );
+
+    case OBJECTS_LOCAL:
+      _CORE_semaphore_Seize(
+        &the_semaphore->semaphore,
+        the_semaphore->Object.id,
+        wait,                           /* wait for a timeout */
+        interval                        /* timeout value */
+      );
+      _Thread_Enable_dispatch();
+      status = (CORE_semaphore_Status) _Thread_Executing->Wait.return_code;
+      return _ITRON_Semaphore_Translate_core_semaphore_return_code( status );
+  }
+  return E_OK;
+}