Remove redundant redundancy.
[bertos.git] / kern / proc.c
index b735846dff82490fdfc6ddeefffbe89ecdb43767..4b16c74b3cc05aff5062ca314dbb6a33e19b71cc 100755 (executable)
 
 /*
  * $Log$
+ * Revision 1.11  2004/08/24 16:09:08  bernie
+ * Add missing header.
+ *
+ * Revision 1.10  2004/08/24 16:07:01  bernie
+ * Use kputs()/kputchar() when possible.
+ *
+ * Revision 1.9  2004/08/24 14:26:57  bernie
+ * monitor_debug_stacks(): Conditionally compile on CONFIG_KERN_MONITOR.
+ *
+ * Revision 1.8  2004/08/14 19:37:57  rasky
+ * Merge da SC: macros.h, pool.h, BIT_CHANGE, nome dei processi, etc.
+ *
+ * Revision 1.7  2004/08/02 20:20:29  aleph
+ * Merge from project_ks
+ *
+ * Revision 1.6  2004/07/30 14:24:16  rasky
+ * Task switching con salvataggio perfetto stato di interrupt (SR)
+ * Kernel monitor per dump informazioni su stack dei processi
+ *
+ * Revision 1.5  2004/07/14 14:18:09  rasky
+ * Merge da SC: Rimosso timer dentro il task, che รจ uno spreco di memoria per troppi task
+ *
+ * Revision 1.4  2004/07/13 19:21:28  aleph
+ * Avoid warning for unused arg when compiled without some CONFIG_KERN_xx options
+ *
  * Revision 1.3  2004/06/06 18:37:57  bernie
  * Rename event macros to look like regular functions.
  *
 #include "event.h"
 #include "hw.h"
 #include <drv/kdebug.h>
+#include <arch_config.h>  /* ARCH_EMUL */
 
 #include <string.h> /* memset() */
 
-/* CPU dependent context switching routines */
+/*! CPU dependent context switching routines
+ *  \note This function *MUST* preserve also the status of the interrupts.
+ */
 extern void asm_switch_context(cpustack_t **new_sp, cpustack_t **save_sp);
+extern int asm_switch_version(void);
 
 /*
  * The scheduer tracks ready and waiting processes
@@ -50,6 +79,7 @@ extern void asm_switch_context(cpustack_t **new_sp, cpustack_t **save_sp);
 REGISTER Process *CurrentProcess;
 REGISTER List     ProcReadyList;
 
+
 #if CONFIG_KERN_PREEMPTIVE
 /*
  * The time sharing scheduler forces a task switch when
@@ -67,12 +97,102 @@ extern List StackFreeList;
 /* The main process (the one that executes main()) */
 struct Process MainProcess;
 
-static void proc_init_struct(Process* proc)
+
+#if CONFIG_KERN_MONITOR
+List MonitorProcs;
+
+static void monitor_init(void)
+{
+       INITLIST(&MonitorProcs);
+}
+
+static void monitor_add(Process* proc, const char* name, cpustack_t* stack_base, size_t stack_size)
+{
+       proc->monitor.name = name;
+       proc->monitor.stack_base = stack_base;
+       proc->monitor.stack_size = stack_size;
+
+       ADDTAIL(&MonitorProcs, &proc->monitor.link);
+}
+
+static void monitor_remove(Process* proc)
+{
+       REMOVE(&proc->monitor.link);
+}
+
+#define MONITOR_NODE_TO_PROCESS(node) \
+       (struct Process*)((char*)(node) - offsetof(struct Process, monitor.link))
+
+size_t monitor_check_stack(cpustack_t* stack_base, size_t stack_size)
+{
+       cpustack_t* beg;
+       cpustack_t* cur;
+       cpustack_t* end;
+       size_t sp_free;
+
+       beg = stack_base;
+       end = stack_base + stack_size / sizeof(cpustack_t) - 1;
+
+       if (CPU_STACK_GROWS_UPWARD)
+       {
+               cur = beg;
+               beg = end;
+               end = cur;
+       }
+
+       cur = beg;
+       while (cur != end)
+       {
+               if (*cur != CONFIG_KERN_STACKFILLCODE)
+                       break;
+
+               if (CPU_STACK_GROWS_UPWARD)
+                       cur--;
+               else
+                       cur++;
+       }
+
+       sp_free = ABS(cur - beg) * sizeof(cpustack_t);
+       return sp_free;
+}
+
+#if CONFIG_KERN_MONITOR
+
+void monitor_debug_stacks(void)
 {
-#if CONFIG_KERN_TIMER
-       event_initSignal(&proc->proc_timer.expire, proc, SIG_SINGLE);
+       struct Process* p;
+       int i;
+
+       if (ISLISTEMPTY(&MonitorProcs))
+       {
+               kputs("No stacks registered in the monitor\n");
+               return;
+       }
+
+       kprintf("%-24s    %-6s%-8s%-8s%-8s\n", "Process name", "TCB", "SPbase", "SPsize", "SPfree");
+       for (i=0;i<56;i++)
+               kputchar('-');
+       kputchar('\n');
+
+       for (p = MONITOR_NODE_TO_PROCESS(MonitorProcs.head);
+                p->monitor.link.succ;
+                p = MONITOR_NODE_TO_PROCESS(p->monitor.link.succ))
+       {
+               size_t free = monitor_check_stack(p->monitor.stack_base, p->monitor.stack_size);
+               kprintf("%-24s    %04x    %04x    %4x    %4x\n", p->monitor.name, (uint16_t)p, (uint16_t)p->monitor.stack_base, (uint16_t)p->monitor.stack_size, (uint16_t)free);
+       }
+}
+
+#endif /* CONFIG_KERN_MONITOR */
+
 #endif
 
+
+static void proc_init_struct(Process* proc)
+{
+       /* Avoid warning for unused argument */
+       (void)proc;
+
 #if CONFIG_KERN_SIGNALS
        proc->sig_recv = 0;
 #endif
@@ -82,15 +202,24 @@ static void proc_init_struct(Process* proc)
 #endif
 }
 
+
 void proc_init(void)
 {
        INITLIST(&ProcReadyList);
 
+#if CONFIG_KERN_MONITOR
+       monitor_init();
+#endif
+
        /* We "promote" the current context into a real process. The only thing we have
-          to do is create a PCB and make it current. We don't need to setup the stack
-          pointer because it will be written the first time we switch to another process. */
+        * to do is create a PCB and make it current. We don't need to setup the stack
+        * pointer because it will be written the first time we switch to another process.
+        */
        proc_init_struct(&MainProcess);
        CurrentProcess = &MainProcess;
+
+       /* Make sure the assembly routine is up-to-date with us */
+       ASSERT(asm_switch_version() == 1);
 }
 
 
@@ -100,9 +229,10 @@ void proc_init(void)
  * \return Process structure of new created process
  *         if successful, NULL otherwise.
  */
-Process *proc_new(void (*entry)(void), size_t stacksize, cpustack_t *stack_base)
+struct Process *proc_new_with_name(UNUSED(const char*, name), void (*entry)(void), IPTR data, size_t stacksize, cpustack_t *stack_base)
 {
        Process *proc;
+       cpuflags_t flags;
        size_t i;
        size_t proc_size_words = ROUND2(sizeof(Process), sizeof(cpustack_t)) / sizeof(cpustack_t);
 #if CONFIG_KERN_HEAP
@@ -136,10 +266,10 @@ Process *proc_new(void (*entry)(void), size_t stacksize, cpustack_t *stack_base)
        ASSERT(stacksize);
 #endif
 
-#ifdef _DEBUG
+#if CONFIG_KERN_MONITOR
        /* Fill-in the stack with a special marker to help debugging */
        memset(stack_base, CONFIG_KERN_STACKFILLCODE, stacksize / sizeof(cpustack_t));
-#endif /* _DEBUG */
+#endif
 
        /* Initialize the process control block */
        if (CPU_STACK_GROWS_UPWARD)
@@ -158,6 +288,7 @@ Process *proc_new(void (*entry)(void), size_t stacksize, cpustack_t *stack_base)
        }
 
        proc_init_struct(proc);
+       proc->user_data = data;
 
 #if CONFIG_KERN_HEAP
        proc->stack_base = stack_base;
@@ -175,9 +306,13 @@ Process *proc_new(void (*entry)(void), size_t stacksize, cpustack_t *stack_base)
                CPU_PUSH_WORD(proc->stack, CPU_REG_INIT_VALUE(i));
 
        /* Add to ready list */
-       DISABLE_INTS;
+       DISABLE_IRQSAVE(flags);
        SCHED_ENQUEUE(proc);
-       ENABLE_INTS;
+       ENABLE_IRQRESTORE(flags);
+
+#if CONFIG_KERN_MONITOR
+       monitor_add(proc, name, stack_base, stacksize);
+#endif
 
        return proc;
 }
@@ -198,29 +333,30 @@ void proc_schedule(void)
         * being switched out.
         */
        static Process *old_process;
+       static cpuflags_t flags;
 
        /* Remember old process to save its context later */
        old_process = CurrentProcess;
-       CurrentProcess = NULL;
 
-       /* Poll on the ready queue for the first ready process
-        */
-       for(;;) /* forever */
+       /* Poll on the ready queue for the first ready process */
+       DISABLE_IRQSAVE(flags);
+       while (!(CurrentProcess = (struct Process*)REMHEAD(&ProcReadyList)))
        {
-               /* Do CPU specific idle processing (ARGH, should be moved to the end of the loop!) */
+               /*
+                * Make sure we physically reenable interrupts here, no matter what
+                * the current task status is. This is important because if we
+                * are idle-spinning, we must allow interrupts, otherwise no
+                * process will ever wake up.
+                *
+                * \todo If there was a way to code sig_wait so that it does not
+                * disable interrupts while waiting, there would not be any
+                * reason to do this.
+                */
+               ENABLE_INTS;
                SCHEDULER_IDLE;
-
                DISABLE_INTS;
-               if (!ISLISTEMPTY(&ProcReadyList))
-               {
-                       /* Get process from ready list */
-                       CurrentProcess = (Process *)ProcReadyList.head;
-                       REMOVE((Node *)CurrentProcess);
-                       ENABLE_INTS;
-                       break;
-               }
-               ENABLE_INTS;
        }
+       ENABLE_IRQRESTORE(flags);
 
        /* Optimization: don't switch contexts when the active
         * process has not changed.
@@ -277,6 +413,10 @@ void proc_exit(void)
         */
 #endif /* ARCH_EMUL */
 
+#if CONFIG_KERN_MONITOR
+       monitor_remove(CurrentProcess);
+#endif
+
        CurrentProcess = NULL;
        proc_schedule();
        /* not reached */
@@ -288,9 +428,13 @@ void proc_exit(void)
  */
 void proc_switch(void)
 {
-       DISABLE_INTS;
+       /* Just like proc_schedule, this function must not have auto variables. */
+       static cpuflags_t flags;
+
+       DISABLE_IRQSAVE(flags);
        SCHED_ENQUEUE(CurrentProcess);
-       ENABLE_INTS;
+       ENABLE_IRQRESTORE(flags);
+
        proc_schedule();
 }
 
@@ -303,6 +447,13 @@ struct Process *proc_current(void)
        return CurrentProcess;
 }
 
+/*!
+ * Get the pointer to the user data of the current process
+ */
+IPTR proc_current_user_data(void)
+{
+       return CurrentProcess->user_data;
+}
 
 #if 0 /* Simple testcase for the scheduler */
 
@@ -340,8 +491,8 @@ static cpustack_t proc_test_stack2[CONFIG_KERN_DEFSTACKSIZE/sizeof(cpustack_t)];
  */
 void NORETURN proc_test(void)
 {
-       proc_new(proc_test_thread1, sizeof(proc_test_stack1), proc_test_stack1);
-       proc_new(proc_test_thread2, sizeof(proc_test_stack2), proc_test_stack2);
+       proc_new(proc_test_thread1, NULL, sizeof(proc_test_stack1), proc_test_stack1);
+       proc_new(proc_test_thread2, NULL, sizeof(proc_test_stack2), proc_test_stack2);
        kputs("Created tasks\n");
 
        kputs("stack1:\n");