Changeset 2085 for Whitix/branches/netchannel/kernel/timer.c

Timestamp:

05/20/10 16:05:25 (2 years ago)

Author:

mwhitworth

Message:

Add to TCP/IP stack.

Files:

• Whitix/branches/netchannel/kernel/timer.c (modified) (2 diffs)

Whitix/branches/netchannel/kernel/timer.c

@@ -23 +23 @@
 #include <error.h>
 #include <task.h>
+#include <sys.h>
 #include <malloc.h>
+#include <event.h>
+#include <print.h>
 
 LIST_HEAD(timerList);
@@ -185 +188 @@
 SYMBOL_EXPORT(Sleep);
 
+#define KE_TIMER_ALLOC_STEP             10
+
+void TimerWakeup(void* data)
+{
+        struct KeTimer* timer = (struct KeTimer*)data;
+
+        EventFire(timer->thread, timer->uInfo.func, timer->uInfo.data);
+}
+
 /* Kernel system calls for timers */
-int SysTimerCreate()
-{
-        return 0;
-}
-
-int SysTimerDestroy()
-{
-        return 0;
-}
+int SysTimerCreate(struct UserTimer* timerDesc)
+{
+        int i;
+        struct KeTimer* curr;
+
+        SpinLock(&current->timerListLock);
+
+        if (!current->timers)
+        {
+                current->numTimers = KE_TIMER_ALLOC_STEP;
+                current->timers = (struct KeTimer**)MemAlloc(sizeof(struct KeTimer) * KE_TIMER_ALLOC_STEP);
+        }
+
+        for (i = 0; i < current->numTimers; i++)
+                if (!current->timers[i])
+                        break;
+
+        if (i == current->numTimers)
+        {
+                KePrint("TODO: Extend array\n");
+        }
+
+        current->timers[i] = (struct KeTimer*)MemAlloc(sizeof(struct KeTimer));
+        curr = current->timers[i];
+
+        curr->thread = currThread;
+        memcpy(&curr->uInfo, timerDesc, sizeof(struct UserTimer));
+        curr->timer.func = TimerWakeup;
+        curr->timer.data = curr;
+
+        SpinUnlock(&current->timerListLock);
+
+        return i;
+}
+
+struct KeTimer* TimerGet(struct Process* process, int timer)
+{
+        if (timer < 0 || timer > process->numTimers)
+                return NULL;
+
+        return process->timers[timer];
+}
+
+int SysTimerModify(int tid, struct UserTimerSpec* newValue, struct UserTimerSpec* oldValue)
+{
+        struct KeTimer* timer;
+
+        timer = TimerGet(current, tid);
+
+        if (oldValue)
+        {
+                KePrint("oldValue != NULL\n");
+                return -ENOTIMPL;
+        }
+
+        if (!newValue)
+                return -EFAULT;
+
+        /* TODO: Check if timer is already on list */
+
+        timer->timer.expires = newValue->secs * 1000;
+        /* useconds */
+        TimerAdd(&timer->timer);
+
+        return 0;
+}
+
+int SysTimerDestroy(int timer)
+{
+        KePrint("SysTimerDestroy(%d)\n", timer);
+        return 0;
+}
+
+int TimerProcessRemove(struct Process* process)
+{
+        if (process->timers)
+        {
+                KePrint("Free timers\n");
+        }
+
+        return 0;
+}
+
+static struct SysCall timerSysCallTable[]=
+{
+        SysEntry(SysTimerCreate, 4),
+        SysEntry(SysTimerModify, 12),
+        SysEntry(SysTimerDestroy, 4),
+        SysEntryEnd()
+};
+
+int TimerInit()
+{
+        SysRegisterRange(SYS_TIMER_BASE, timerSysCallTable);
+        return 0;
+}