X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=kern%2Fproc.c;h=c0a45a7295649a956c9ce2729583cea2a61bf7bd;hb=9250b166f2d62d6e38bca6cea5c6210266a12128;hp=bfbc0c920f9fbdd0d909cdae8953c52ee7dbdf52;hpb=96f0ef786b54356c56cc3d4e4f0838df2505cfcc;p=bertos.git diff --git a/kern/proc.c b/kern/proc.c index bfbc0c92..c0a45a72 100755 --- a/kern/proc.c +++ b/kern/proc.c @@ -15,15 +15,46 @@ * \author Stefano Fedrigo */ -/* - * $Log$ - * Revision 1.2 2004/06/03 11:27:09 bernie - * Add dual-license information. - * - * Revision 1.1 2004/05/23 17:27:00 bernie - * Import kern/ subdirectory. - * - */ +/*#* + *#* $Log$ + *#* Revision 1.12 2004/08/25 14:12:09 rasky + *#* Aggiornato il comment block dei log RCS + *#* + *#* 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. + *#* + *#* Revision 1.2 2004/06/03 11:27:09 bernie + *#* Add dual-license information. + *#* + *#* Revision 1.1 2004/05/23 17:27:00 bernie + *#* Import kern/ subdirectory. + *#* + *#*/ #include "cpu.h" #include "proc_p.h" @@ -31,11 +62,15 @@ #include "event.h" #include "hw.h" #include +#include /* ARCH_EMUL */ #include /* 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 @@ -47,6 +82,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 @@ -64,12 +100,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 - INITEVENT_SIG(&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 @@ -79,15 +205,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); } @@ -97,9 +232,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 @@ -133,10 +269,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) @@ -155,6 +291,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; @@ -172,9 +309,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; } @@ -195,29 +336,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. @@ -274,6 +416,10 @@ void proc_exit(void) */ #endif /* ARCH_EMUL */ +#if CONFIG_KERN_MONITOR + monitor_remove(CurrentProcess); +#endif + CurrentProcess = NULL; proc_schedule(); /* not reached */ @@ -285,9 +431,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(); } @@ -300,6 +450,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 */ @@ -337,8 +494,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");