diff src/gpf/osl/os_tim_fl.c @ 6:8b2a9a374324

src/gpf: addition of Magnetite src/gpf2
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 15 Jul 2018 08:15:49 +0000
parents
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/src/gpf/osl/os_tim_fl.c	Sun Jul 15 08:15:49 2018 +0000
@@ -0,0 +1,184 @@
+/*
+ * This C module is a reconstruction based on the disassembly of
+ * os_tim.obj in frame_na7_db_fl.lib from the Leonardo package,
+ * subsequently reworked by Space Falcon.
+ */
+
+/* set of included headers from COFF symtab: */
+#include <stdio.h>
+#include "nucleus.h"
+#include "typedefs.h"
+#include "os.h"
+#include "gdi.h"
+#include "os_types.h"
+#include "os_glob.h"
+
+extern UNSIGNED TMD_Timer;
+extern INT      TMD_Timer_State;
+
+extern T_OS_TIMER_ENTRY TimerTable[];
+extern T_OS_TIMER_TABLE_ENTRY *p_list[];
+
+extern void os_Timeout(UNSIGNED t_handle);
+extern void timer_error(int err);
+
+unsigned os_time_to_tick_multiplier = TIME_TO_TICK_TDMA_FRAME_MULTIPLIER;
+unsigned os_tick_to_time_multiplier = TICK_TO_TIME_TDMA_FRAME_MULTIPLIER;
+
+unsigned volatile t_start_ticks;
+T_OS_TIMER_TABLE_ENTRY *t_running;
+int used_timers;
+int next_t_handle;
+int volatile t_list_access;
+int max_used_timers;
+NU_SEMAPHORE TimSemCB;
+NU_TIMER os_timer_cb;
+
+#ifdef __GNUC__
+#define	BARRIER	asm volatile ("": : :"memory")
+#else
+#define	BARRIER	/* prayer */
+#endif
+
+GLOBAL LONG
+os_set_tick(int os_system_tick)
+{
+	switch (os_system_tick) {
+	case SYSTEM_TICK_TDMA_FRAME:
+		os_time_to_tick_multiplier = TIME_TO_TICK_TDMA_FRAME_MULTIPLIER;
+		os_tick_to_time_multiplier = TICK_TO_TIME_TDMA_FRAME_MULTIPLIER;
+		return(OS_OK);
+	case SYSTEM_TICK_10_MS:
+		os_time_to_tick_multiplier = TIME_TO_TICK_10MS_MULTIPLIER;
+		os_tick_to_time_multiplier = TICK_TO_TIME_10MS_MULTIPLIER;
+		return(OS_OK);
+	default:
+		return(OS_ERROR);
+	}
+}
+
+GLOBAL LONG
+os_TimerInformation(USHORT Index, char *Buffer)
+{
+	static int t_info_read;
+
+	if (t_info_read) {
+		t_info_read = 0;
+		return(OS_ERROR);
+	}
+	sprintf(Buffer, "Maximum %d of %d available timers running",
+		max_used_timers, MaxSimultaneousTimer);
+	t_info_read = 1;
+	return(OS_OK);
+}
+
+GLOBAL LONG
+os_TimInit(void)
+{
+	int i;
+
+	if (NU_Create_Semaphore(&TimSemCB, "TIMSEM", 1, NU_PRIORITY)
+			!= NU_SUCCESS)
+		return(OS_ERROR);
+	if (NU_Create_Timer(&os_timer_cb, "OS_TIMER", os_Timeout, 0, 1, 0,
+			    NU_DISABLE_TIMER) != NU_SUCCESS)
+		return(OS_ERROR);
+	used_timers = 0;
+	max_used_timers = 0;
+	next_t_handle = 1;
+	t_list_access = 0;
+	t_start_ticks = 0;
+	p_list[0] = 0;
+	for (i = 1; i < MaxSimultaneousTimer; i++) {
+		TimerTable[i].entry.status = TMR_FREE;
+		TimerTable[i].entry.next = 0;
+		TimerTable[i].entry.prev = 0;
+		TimerTable[i].next_t_handle = i + 1;
+		p_list[i] = 0;
+	}
+	TimerTable[MaxSimultaneousTimer].entry.status = TMR_FREE;
+	TimerTable[MaxSimultaneousTimer].next_t_handle = 0;
+	t_running = 0;
+	return(OS_OK);
+}
+
+GLOBAL LONG
+os_RecoverTick(OS_TICK ticks)
+{
+	UNSIGNED current_system_clock;
+
+	current_system_clock = NU_Retrieve_Clock();
+	NU_Set_Clock(current_system_clock + ticks);
+	if (TMD_Timer_State == TM_ACTIVE) {
+		if (TMD_Timer <= ticks) {
+			TMD_Timer_State = TM_EXPIRED;
+			TMD_Timer = 0;
+		} else
+			TMD_Timer -= ticks;
+	}
+	return(OS_OK);
+}
+
+GLOBAL LONG
+os_QueryTimer(OS_HANDLE TaskHandle, OS_HANDLE TimerHandle,
+		OS_TIME *RemainingTime)
+{
+	T_OS_TIMER_TABLE_ENTRY *timer, *t_iter;
+	OS_TICK c_ticks, r_ticks, e_ticks;
+	STATUS sts;
+
+	if (TimerHandle > MaxSimultaneousTimer)
+		return(OS_ERROR);
+	sts = NU_Obtain_Semaphore(&TimSemCB, NU_SUSPEND);
+	timer = &TimerTable[TimerHandle].entry;
+	if (timer->status == TMR_FREE) {
+		if (sts == NU_SUCCESS)
+			NU_Release_Semaphore(&TimSemCB);
+		return(OS_ERROR);
+	}
+	t_list_access = 1;
+	BARRIER;
+	if (!t_running) {
+		r_ticks = 0;
+		goto out;
+	}
+	c_ticks = NU_Retrieve_Clock();
+	e_ticks = c_ticks - t_start_ticks;
+	t_iter = t_running;
+	if (t_iter->r_ticks >= e_ticks)
+		r_ticks = t_iter->r_ticks - e_ticks;
+	else
+		r_ticks = 0;
+	while (t_iter != timer) {
+		t_iter = t_iter->next;
+		if (t_iter == t_running) {
+			r_ticks = 0;
+			goto out;
+		}
+		r_ticks += t_iter->r_ticks;
+	}
+out:	BARRIER;
+	t_list_access = 0;
+	if (sts == NU_SUCCESS)
+		NU_Release_Semaphore(&TimSemCB);
+	*RemainingTime = SYSTEM_TICKS_TO_TIME(r_ticks);
+	return(OS_OK);
+}
+
+GLOBAL LONG
+os_InactivityTicks(int *next_event, OS_TICK *next_event_ticks)
+{
+	*next_event = 1;
+	switch (TMD_Timer_State) {
+	case TM_ACTIVE:
+		*next_event_ticks = TMD_Timer;
+		return(OS_OK);
+	case TM_NOT_ACTIVE:
+		*next_event_ticks = 0;
+		*next_event = 0;
+		return(OS_OK);
+	default:
+		*next_event_ticks = 0;
+		return(OS_OK);
+	}
+}