From 0baa6dcc9c487fd94b7c97dc79393ac45bfe9504 Mon Sep 17 00:00:00 2001 From: bernie Date: Sun, 3 Oct 2004 20:39:03 +0000 Subject: [PATCH] Import in DevLib. git-svn-id: https://src.develer.com/svnoss/bertos/trunk@231 38d2e660-2303-0410-9eaa-f027e97ec537 --- kern/monitor.c | 157 +++++++++++++++++++++++++++++++++++++++++++++++++ kern/monitor.h | 63 ++++++++++++++++++++ 2 files changed, 220 insertions(+) create mode 100755 kern/monitor.c create mode 100755 kern/monitor.h diff --git a/kern/monitor.c b/kern/monitor.c new file mode 100755 index 00000000..80a77329 --- /dev/null +++ b/kern/monitor.c @@ -0,0 +1,157 @@ +/*! + * \file + * + * + * \brief Monitor to check for stack overflows + * + * \version $Id$ + * + * \author Giovanni Bajo + */ + +/*#* + *#* $Log$ + *#* Revision 1.1 2004/10/03 20:39:03 bernie + *#* Import in DevLib. + *#* + *#* Revision 1.2 2004/10/03 20:36:43 bernie + *#* Use debug.h instead of drv/kdebug.h; Misc spacing/header fixes. + *#* + *#* Revision 1.1 2004/09/30 23:19:30 rasky + *#* Estratto il monitor degli stack da proc.c in due file a parte: monitor.c/h + *#* Rinominata monitor_debug_stacks in monitor_report + *#*/ + +#include "monitor.h" + +#if CONFIG_KERN_MONITOR + +#include "proc_p.h" +#include +#include +#include +#include +#include + + +static List MonitorProcs; + + +void monitor_init(void) +{ + INITLIST(&MonitorProcs); +} + + +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); +} + + +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; +} + + +void monitor_report(void) +{ + 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); + } +} + + +static void monitor(void) +{ + struct Process* p; + + while (1) + { + 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); + + if (free < 0x20) + { + kprintf("MONITOR: ***************************************\n"); + kprintf("MONITOR: WARNING: Free stack for process '%s' is only %04x chars\n", p->monitor.name, free); + kprintf("MONITOR: ***************************************\n\n"); + } + + timer_delay(500); + } + } +} + + +void monitor_start(size_t stacksize, cpustack_t *stack) +{ + proc_new(monitor, NULL, stacksize, stack); +} + +#endif /* CONFIG_KERN_MONITOR */ diff --git a/kern/monitor.h b/kern/monitor.h new file mode 100755 index 00000000..3e544752 --- /dev/null +++ b/kern/monitor.h @@ -0,0 +1,63 @@ +/*! + * \file + * + * + * \brief Monitor to check for stack overflows + * + * \version $Id$ + * + * \author Giovanni Bajo + */ + +/*#* + *#* $Log$ + *#* Revision 1.1 2004/10/03 20:39:03 bernie + *#* Import in DevLib. + *#* + *#* Revision 1.1 2004/09/30 23:19:30 rasky + *#* Estratto il monitor degli stack da proc.c in due file a parte: monitor.c/h + *#* Rinominata monitor_debug_stacks in monitor_report + *#* + *#*/ + +#ifndef KERN_MONITOR_H +#define KERN_MONITOR_H + +#include +#include + +#if CONFIG_KERN_MONITOR + +/*! + * Start the kernel monitor. It is a special process which checks every second the stacks of the + * running processes trying to detect stack overflows. + * + * \param stacksize Size of stack in chars + * \param stack Pointer to the stack that will be used by the monitor + * + * \note The stack is provided by the caller so that there is no wasted space if the monitor + * is not used. + */ +void monitor_start(size_t stacksize, cpustack_t *stack); + + +/*! + * Manually check if a given stack has overflown. This is used to check for stacks + * of processes handled externally form the kernel, or for other stacks (for instance + * the interrupt supervisor stack). + * + * \note For this function to work, the stack must have been filled at startup with + * CONFIG_KERN_STACKFILLCODE. + */ +size_t monitor_check_stack(cpustack_t* stack_base, size_t stack_size); + + +/*! Print a report of the stack status through kdebug */ +void monitor_report(void); + + +#endif /* CONFIG_KERN_MONITOR */ +#endif /* KERN_MONITOR_H */ -- 2.25.1