Add switch context module.

[bertos.git] / bertos / benchmark / context_switch.c

diff --git a/bertos/benchmark/context_switch.c b/bertos/benchmark/context_switch.c
new file mode 100644 (file)
index 0000000..92d9d9d
--- /dev/null
+++ b/bertos/benchmark/context_switch.c
@@ -0,0 +1,135 @@
+/**
+ * \file
+ * <!--
+ * This file is part of BeRTOS.
+ *
+ * Bertos is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+ *
+ * As a special exception, you may use this file as part of a free software
+ * library without restriction.  Specifically, if other files instantiate
+ * templates or use macros or inline functions from this file, or you compile
+ * this file and link it with other files to produce an executable, this
+ * file does not by itself cause the resulting executable to be covered by
+ * the GNU General Public License.  This exception does not however
+ * invalidate any other reasons why the executable file might be covered by
+ * the GNU General Public License.
+ *
+ * Copyright 2010 Develer S.r.l. (http://www.develer.com/)
+ *
+ * -->
+ *
+ * \brief Context switch benchmark
+ *
+ * \author Andrea Righi <arighi@develer.com>
+ * \author Daniele Basiele <asterix@develer.com>
+ */
+
+#include "context_switch.h"
+
+#include "hw/hw_led.h"
+
+#include "cfg/cfg_context_switch.h"
+#include <cfg/debug.h>
+
+#include <cpu/irq.h>
+#include <cpu/power.h>
+
+#include <drv/timer.h>
+#include <drv/ser.h>
+
+#include <kern/proc.h>
+
+#define PROC_STACK_SIZE           1024
+
+static PROC_DEFINE_STACK(hp_stack, PROC_STACK_SIZE);
+static PROC_DEFINE_STACK(lp_stack, PROC_STACK_SIZE);
+
+static Process *hp_proc, *lp_proc, *main_proc;
+Serial out;
+
+#if CONFIG_USE_HP_TIMER
+
+static hptime_t start, end;
+
+#endif
+
+static void NORETURN hp_process(void)
+{
+       proc_setPri(hp_proc, 2);
+
+       while (1)
+       {
+               sig_wait(SIG_USER0);
+               #if CONFIG_USE_HP_TIMER
+                       end = timer_clock_hp();
+               #endif
+               #if CONFIG_USE_LED
+                       LED_ON();
+               #endif
+               timer_delay(100);
+               sig_send(main_proc, SIG_USER1);
+       }
+}
+
+static void NORETURN lp_process(void)
+{
+       proc_setPri(lp_proc, 1);
+
+       while (1)
+       {
+               sig_wait(SIG_USER1);
+               #if CONFIG_USE_HP_TIMER
+                       start = timer_clock_hp();
+               #endif
+               #if CONFIG_USE_LED
+                       LED_ON();
+                       LED_OFF();
+               #endif
+
+               sig_send(hp_proc, SIG_USER0);
+       }
+}
+
+
+void NORETURN context_switch(void)
+{
+       IRQ_ENABLE;
+       timer_init();
+       proc_init();
+
+       ser_init(&out, CONFIG_CTX_DEBUG_PORT);
+       ser_setbaudrate(&out, CONFIG_CTX_DEBUG_BAUDRATE);
+
+       #if CONFIG_USE_LED
+               LED_INIT();
+       #endif
+
+       hp_proc = proc_new(hp_process, NULL, PROC_STACK_SIZE, hp_stack);
+       lp_proc = proc_new(lp_process, NULL, PROC_STACK_SIZE, lp_stack);
+       main_proc = proc_current();
+
+       while (1)
+       {
+               #if CONFIG_USE_HP_TIMER
+                       kfile_printf(&out.fd, "Switch: %lu.%lu usec\n",
+                                                       hptime_to_us((end - start)),
+                                                       hptime_to_us((end - start) * 1000) % 1000);
+               #endif
+
+               sig_send(lp_proc, SIG_USER1);
+               sig_wait(SIG_USER1);
+       }
+
+}