diff gpf/osl/contrib/os_tim_ir.c @ 0:75a11d740a02

initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7
author Mychaela Falconia <falcon@freecalypso.org>
date Thu, 09 Jun 2016 00:02:41 +0000
parents
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/gpf/osl/contrib/os_tim_ir.c	Thu Jun 09 00:02:41 2016 +0000
@@ -0,0 +1,315 @@
+/*
+ * This C module is a reconstruction based on the disassembly of
+ * os_tim.obj in frame_na7_db_ir.lib from the Leonardo package.
+ */
+
+/* set of included headers from COFF symtab: */
+#include <stdio.h>
+#include "gpfconf.h"		/* FreeCalypso addition */
+#include "../../nucleus/nucleus.h"
+#include "typedefs.h"
+#include "os.h"
+#include "gdi.h"
+#include "os_types.h"
+#include "os_glob.h"
+
+extern unsigned os_time_to_tick_multiplier;
+extern unsigned os_tick_to_time_multiplier;
+
+extern T_OS_TIMER_ENTRY TimerTable[];
+extern T_OS_TIMER_TABLE_ENTRY *p_list[];
+
+extern int volatile t_list_access;
+extern unsigned t_start_ticks;
+extern T_OS_TIMER_TABLE_ENTRY * volatile t_running;
+extern int used_timers;
+extern int next_t_handle;
+extern NU_SEMAPHORE TimSemCB;
+extern NU_TIMER os_timer_cb;
+extern int max_used_timers;
+
+void os_Timeout(UNSIGNED t_handle);
+
+void timer_error(int err)
+{
+	err = 0;
+}
+
+static int os_remove_timer_from_list(T_OS_TIMER_TABLE_ENTRY *timer)
+{
+	OS_TICK c_ticks;
+
+	if (timer != t_running) {
+		if (timer->next != t_running)
+			timer->next->r_ticks += timer->r_ticks;
+	}
+	else {
+		c_ticks = NU_Retrieve_Clock();
+		if (timer->next == timer) {
+			t_running = 0;
+		} else {
+			timer->next->r_ticks =
+			    t_start_ticks + timer->r_ticks +
+			    timer->next->r_ticks - c_ticks;
+			t_running = timer->next;
+		}
+		NU_Control_Timer(&os_timer_cb, NU_DISABLE_TIMER);
+		if (t_running != NULL) {
+			t_start_ticks = c_ticks;
+			if (t_running->r_ticks != 0)
+				NU_Reset_Timer(&os_timer_cb, os_Timeout,
+						t_running->r_ticks, 0,
+						NU_ENABLE_TIMER);
+		}
+	}
+	if (timer->next != timer) {
+		timer->prev->next = timer->next;
+		timer->next->prev = timer->prev;
+	}
+	timer->next = NULL;
+	timer->prev = NULL;
+	timer->status = 1;
+	return 1;
+}
+
+static unsigned os_add_timer_to_list(T_OS_TIMER_TABLE_ENTRY *timer, OS_TICK ticks)
+{
+	T_OS_TIMER_TABLE_ENTRY *t_list;
+	OS_TICK c_ticks, r1_ticks, return_ticks;
+
+	if (ticks == 0)
+		ticks = 1;
+
+	c_ticks = NU_Retrieve_Clock();
+	t_list = t_running;
+	if (t_list != NULL) {
+		if (t_running->r_ticks >= c_ticks - t_start_ticks) {
+			r1_ticks =
+			    t_running->r_ticks - c_ticks + t_start_ticks;
+			t_running->r_ticks = r1_ticks;
+		} else {
+			r1_ticks = 0;
+			t_running->r_ticks = 0;
+		}
+		t_start_ticks = c_ticks;
+		return_ticks = 0;
+		while (ticks >= r1_ticks) {
+			ticks -= r1_ticks;
+			t_list = t_list->next;
+			if (t_list == t_running)
+				goto out;
+			r1_ticks = t_list->r_ticks;
+		}
+		t_list->r_ticks -= ticks;
+		if (t_list == t_running) {
+			t_running = timer;
+			t_start_ticks = c_ticks;
+			NU_Control_Timer(&os_timer_cb, NU_DISABLE_TIMER);
+			return_ticks = ticks;
+		}
+out:
+		timer->next = t_list;
+		timer->prev = t_list->prev;
+		t_list->prev->next = timer;
+		t_list->prev = timer;
+		timer->r_ticks = ticks;
+	} else {
+		timer->next = timer;
+		timer->prev = timer;
+		timer->r_ticks = ticks;
+		t_start_ticks = c_ticks;
+		t_running = timer;
+		return_ticks = ticks;
+	}
+	timer->status = 2;
+	return return_ticks;
+}
+
+GLOBAL LONG os_StartTimer(OS_HANDLE TaskHandle, OS_HANDLE TimerHandle,
+				USHORT Index, OS_TIME InitialTime,
+				OS_TIME RescheduleTime)
+{
+	T_OS_TIMER_TABLE_ENTRY *timer;
+	OS_TICK ticks;
+	USHORT status;
+	STATUS sts;
+
+	t_list_access = 1;
+	timer = &TimerTable[TimerHandle].entry;
+	if (TimerHandle > MaxSimultaneousTimer || timer->status == 0) {
+		t_list_access = 0;
+		return OS_ERROR;
+	}
+
+	sts = NU_Obtain_Semaphore(&TimSemCB, NU_SUSPEND);
+	/* FIXME: not sure about this
+	if (sts != NU_SUCCESS)
+		os_MyHandle(sts);
+	*/
+	status = timer->status;
+	if (status == 2)
+		status = os_remove_timer_from_list(timer);
+	timer->t_handle = TimerHandle;
+	timer->task_handle = os_MyHandle();
+	timer->entity_handle = TaskHandle;
+	timer->t_index = Index;
+	timer->p_ticks = TIME_TO_SYSTEM_TICKS(RescheduleTime);
+	ticks = os_add_timer_to_list(timer, TIME_TO_SYSTEM_TICKS(InitialTime));
+	if (ticks)
+		NU_Reset_Timer(&os_timer_cb, os_Timeout, ticks, 0, NU_ENABLE_TIMER);
+	if (sts == NU_SUCCESS)
+		NU_Release_Semaphore(&TimSemCB);
+	t_list_access = 0;
+	return OS_OK;
+}
+
+/* FIXME: t_handle is unused?! */
+void os_Timeout(UNSIGNED t_handle)
+{
+	UNSIGNED s_ticks;
+	OS_HANDLE task_handle;
+	OS_HANDLE e_handle;
+	int t_index, i, done;
+	T_OS_TIMER_TABLE_ENTRY **t_r4;
+	T_OS_TIMER_TABLE_ENTRY *timer;
+	void (*timeout_func) (OS_HANDLE, OS_HANDLE, USHORT);
+	OS_TIME InitialTime;
+
+	if (t_list_access) {
+		t_start_ticks++;
+		NU_Reset_Timer(&os_timer_cb, os_Timeout, 1, 0,
+				NU_ENABLE_TIMER);
+		return;
+	}
+
+	t_list_access = 1;
+	timer = t_running;
+	if (t_running) {
+		s_ticks = 0;
+		done = 0;
+		i = 0;
+		do {
+			timeout_func = timer->TimeoutProc;
+			if (timer->p_ticks)
+				p_list[i++] = timer;
+			task_handle = timer->task_handle;
+			e_handle = timer->entity_handle;
+			t_index = timer->t_index;
+			timer->status = 1;
+			if (timer->next == timer) {
+				t_running = NULL;
+				done = 1;
+			} else {
+				timer->prev->next = timer->next;
+				timer->next->prev = timer->prev;
+				if (timer->next->r_ticks) {
+					t_running = timer->next;
+					s_ticks = timer->r_ticks;
+					done = 1;
+				} else
+					timer = timer->next;
+			}
+			/* FIXME: IND$CALL() ? */
+		}
+		while (!done);
+
+		if (s_ticks) {
+			t_start_ticks = NU_Retrieve_Clock();
+			NU_Reset_Timer(&os_timer_cb, os_Timeout, s_ticks, 0,
+				       NU_ENABLE_TIMER);
+		}
+	}
+	for (t_r4 = p_list; *t_r4; t_r4++) {
+		timer = *t_r4;
+		InitialTime = SYSTEM_TICKS_TO_TIME(timer->p_ticks);
+		os_StartTimer(timer->entity_handle, timer->t_handle,
+				timer->t_index, InitialTime, InitialTime);
+		*t_r4 = NULL;
+	}
+
+	t_list_access = 0;
+	return;
+}
+
+/* FIXME: TaskHandle is unused?! */
+GLOBAL LONG os_StopTimer(OS_HANDLE TaskHandle, OS_HANDLE TimerHandle)
+{
+	T_OS_TIMER_ENTRY *timer_e;
+	STATUS sts;
+
+	t_list_access = 1;
+	timer_e = &TimerTable[TimerHandle];
+	if (TimerHandle > MaxSimultaneousTimer || timer_e->entry.status == 0) {
+		t_list_access = 0;
+		return OS_ERROR;
+	}
+	sts = NU_Obtain_Semaphore(&TimSemCB, NU_SUSPEND);
+	if (timer_e->entry.status == 2)
+		os_remove_timer_from_list(&timer_e->entry);
+	if (sts == NU_SUCCESS)
+		NU_Release_Semaphore(&TimSemCB);
+	t_list_access = 0;
+	return OS_OK;
+}
+
+GLOBAL LONG os_IncrementTick(OS_TICK ticks)
+{
+	return OS_OK;
+}
+
+/* FIXME: TaskHandle is unused?! */
+GLOBAL LONG os_DestroyTimer(OS_HANDLE TaskHandle, OS_HANDLE TimerHandle)
+{
+	STATUS sts;
+	T_OS_TIMER_ENTRY *timer_e;
+
+	t_list_access = 1;
+	sts = NU_Obtain_Semaphore(&TimSemCB, NU_SUSPEND);
+	timer_e = &TimerTable[TimerHandle];
+	if (TimerHandle > MaxSimultaneousTimer || timer_e->entry.status == 0) {
+		if (sts == NU_SUCCESS)
+			NU_Release_Semaphore(&TimSemCB);
+		t_list_access = 0;
+		return OS_ERROR;
+	}
+	timer_e->next_t_handle = next_t_handle;
+	timer_e->entry.status = 0;
+	used_timers--;
+	t_list_access = 0;
+	if (sts == NU_SUCCESS)
+		NU_Release_Semaphore(&TimSemCB);
+	return OS_OK;
+}
+
+/* FIXME: TaskHandle and MemPoolHandle are unused?! */
+GLOBAL LONG os_CreateTimer(OS_HANDLE TaskHandle,
+			   void (*TimeoutProc) (OS_HANDLE, OS_HANDLE, USHORT),
+			   OS_HANDLE *TimerHandle, OS_HANDLE MemPoolHandle)
+{
+	STATUS sts;
+	OS_HANDLE orig_next_t_handle;
+	T_OS_TIMER_ENTRY *timer_e;
+
+	t_list_access = 1;
+	sts = NU_Obtain_Semaphore(&TimSemCB, NU_SUSPEND);
+	orig_next_t_handle = next_t_handle;
+	if (next_t_handle == 0) { /* INVALID_HANDLE */
+		if (sts == NU_SUCCESS)
+			NU_Release_Semaphore(&TimSemCB);
+		t_list_access = 0;
+		return OS_ERROR;
+	}
+
+	timer_e = &TimerTable[next_t_handle];
+	timer_e->entry.status = 1;
+	timer_e->entry.TimeoutProc = TimeoutProc;
+	*TimerHandle = orig_next_t_handle;
+	next_t_handle = timer_e->next_t_handle;
+	used_timers++;
+	if (max_used_timers < used_timers)
+		max_used_timers = used_timers;
+	if (sts == NU_SUCCESS)
+		NU_Release_Semaphore(&TimSemCB);
+	t_list_access = 0;
+	return OS_OK;
+}