Merge branch "preempt" in "trunk".
[bertos.git] / bertos / kern / proc_test.c
index ea071a472b2dd226f19f3c048c54ebdbee709e3a..5b5bf3ff663f842ac20c121c7a3b5e871c69c581 100644 (file)
  * invalidate any other reasons why the executable file might be covered by
  * the GNU General Public License.
  *
- * Copyright 2008 Develer S.r.l. (http://www.develer.com/)
+ * Copyright 2009 Develer S.r.l. (http://www.develer.com/)
  * -->
  *
  *
- * \brief Test kernel process.
+ * \brief Test kernel preemption.
+ *
+ * This testcase spawns TASKS parallel threads that runs for TIME seconds. They
+ * continuously spin updating a global counter (one counter for each thread).
+ *
+ * At exit each thread checks if the others have been che chance to update
+ * their own counter. If not, it means the preemption didn't occur and the
+ * testcase returns an error message.
+ *
+ * Otherwise, if all the threads have been able to update their own counter it
+ * means preemption successfully occurs, since there is no active sleep inside
+ * each thread's implementation.
+ *
+ * \author Andrea Righi <arighi@develer.com>
+ *
+ * $test$: cp bertos/cfg/cfg_proc.h $cfgdir/
+ * $test$: echo  "#undef CONFIG_KERN" >> $cfgdir/cfg_proc.h
+ * $test$: echo "#define CONFIG_KERN 1" >> $cfgdir/cfg_proc.h
+ * $test$: echo  "#undef CONFIG_KERN_PRI" >> $cfgdir/cfg_proc.h
+ * $test$: echo "#define CONFIG_KERN_PRI 1" >> $cfgdir/cfg_proc.h
+ * $test$: echo  "#undef CONFIG_KERN_PREEMPT" >> $cfgdir/cfg_proc.h
+ * $test$: echo "#define CONFIG_KERN_PREEMPT 1" >> $cfgdir/cfg_proc.h
+ * $test$: cp bertos/cfg/cfg_monitor.h $cfgdir/
+ * $test$: sed -i "s/CONFIG_KERN_MONITOR 0/CONFIG_KERN_MONITOR 1/" $cfgdir/cfg_monitor.h
+ * $test$: cp bertos/cfg/cfg_signal.h $cfgdir/
+ * $test$: echo  "#undef CONFIG_KERN_SIGNALS" >> $cfgdir/cfg_signal.h
+ * $test$: echo "#define CONFIG_KERN_SIGNALS 1" >> $cfgdir/cfg_signal.h
  *
- * \version $Id$
- * \author Daniele Basile <asterix@develer.com>
  */
 
+#include <stdio.h> // sprintf
+#include <string.h> // memset
+
 #include <kern/proc.h>
 #include <kern/irq.h>
+#include <kern/monitor.h>
+
 #include <drv/timer.h>
 #include <cfg/test.h>
+#include <cfg/cfg_proc.h>
 
-/*
- * Proc scheduling test subthread 1
- */
-static void proc_test1(void)
+enum
+{
+       TEST_OK = 1,
+       TEST_FAIL = 2,
+};
+
+/* Number of tasks to spawn */
+#define TASKS  8
+
+static char name[TASKS][32];
+
+static unsigned int done[TASKS];
+
+#define WORKER_STACK_SIZE KERN_MINSTACKSIZE * 3
+
+/* Base time delay for processes using timer_delay() */
+#define DELAY  5
+
+// Define process stacks for test.
+static cpu_stack_t worker_stack[TASKS][WORKER_STACK_SIZE / sizeof(cpu_stack_t)];
+
+static int prime_numbers[] =
+{
+       1, 3, 5, 7, 11, 13, 17, 19,
+       23, 29, 31, 37, 41, 43, 47, 53,
+};
+
+STATIC_ASSERT(TASKS <= countof(prime_numbers));
+
+static void worker(void)
+{
+       long pid = (long)proc_currentUserData();
+       long tot = prime_numbers[pid - 1];
+       unsigned int my_count = 0;
+       int i;
+
+       for (i = 0; i < tot; i++)
+       {
+               my_count++;
+               PROC_ATOMIC(kprintf("> %s[%ld] running\n", __func__, pid));
+               timer_delay(tot * DELAY);
+       }
+       done[pid - 1] = 1;
+       PROC_ATOMIC(kprintf("> %s[%ld] completed\n", __func__, pid));
+}
+
+static int worker_test(void)
 {
-       for (int i = 0; i < 30; ++i)
+       long i;
+
+       // Init the test processes
+       kputs("Run Proc test..\n");
+       for (i = 0; i < TASKS; i++)
        {
-               kputs("> test1\n");
-               timer_delay(50);
+               sprintf(&name[i][0], "worker_%ld", i + 1);
+               proc_new_with_name(name[i], worker, (iptr_t)(i + 1),
+                               WORKER_STACK_SIZE, &worker_stack[i][0]);
+       }
+       kputs("> Main: Processes started\n");
+       while (1)
+       {
+               for (i = 0; i < TASKS; i++)
+               {
+                       if (!done[i])
+                               break;
+               }
+               if (i == TASKS)
+                       break;
+               monitor_report();
+               timer_delay(93);
+       }
+       kputs("> Main: process test finished..ok!\n");
+       return 0;
+}
+
+#if CONFIG_KERN_PREEMPT
+/* Time to run each preemptible thread (in seconds) */
+#define TIME   10
+
+static char preempt_name[TASKS][32];
+
+static cpu_atomic_t barrier[TASKS];
+static cpu_atomic_t main_barrier;
+
+static unsigned int preempt_counter[TASKS];
+static unsigned int preempt_done[TASKS];
+
+static cpu_stack_t preempt_worker_stack[TASKS][WORKER_STACK_SIZE / sizeof(cpu_stack_t)];
+
+static void preempt_worker(void)
+{
+       long pid = (long)proc_currentUserData();
+       unsigned int *my_count = &preempt_counter[pid - 1];
+       ticks_t start, stop;
+       int i;
+
+       barrier[pid - 1] = 1;
+       /* Synchronize on the main barrier */
+       while (!main_barrier)
                proc_yield();
+       PROC_ATOMIC(kprintf("> %s[%ld] running\n", __func__, pid));
+       start = timer_clock();
+       stop  = ms_to_ticks(TIME * 1000);
+       while (timer_clock() - start < stop)
+       {
+               IRQ_ASSERT_ENABLED();
+               (*my_count)++;
+               /* be sure to wrap to a value different than 0 */
+               if (UNLIKELY(*my_count == (unsigned int)~0))
+                       *my_count = 1;
        }
+       PROC_ATOMIC(kprintf("> %s[%ld] completed: (counter = %d)\n",
+                               __func__, pid, *my_count));
+       for (i = 0; i < TASKS; i++)
+               if (!preempt_counter[i])
+               {
+                       preempt_done[pid - 1] = TEST_FAIL;
+                       return;
+               }
+       preempt_done[pid - 1] = TEST_OK;
 }
 
-/*
- * Proc scheduling test subthread 2
- */
-static void proc_test2(void)
+static int preempt_worker_test(void)
 {
-       for (int i = 0; i < 30; ++i)
+       unsigned long score = 0;
+       long i;
+
+       // Init the test processes
+       kputs("Run Preemption test..\n");
+       for (i = 0; i < TASKS; i++)
+       {
+               sprintf(&preempt_name[i][0], "preempt_worker_%ld", i + 1);
+               proc_new_with_name(preempt_name[i], preempt_worker, (iptr_t)(i + 1),
+                               WORKER_STACK_SIZE, &preempt_worker_stack[i][0]);
+       }
+       kputs("> Main: Processes created\n");
+       /* Synchronize on start */
+       while (1)
        {
-               kputs("> test2\n");
-               timer_delay(75);
+               for (i = 0; i < TASKS; i++)
+                       if (!barrier[i])
+                               break;
+               if (i == TASKS)
+                       break;
+               proc_yield();
        }
+       /* Now all threads have been created, start them all */
+       main_barrier = 1;
+       MEMORY_BARRIER;
+       kputs("> Main: Processes started\n");
+       while (1)
+       {
+               for (i = 0; i < TASKS; i++)
+               {
+                       if (!preempt_done[i])
+                               break;
+                       else if (preempt_done[i] == TEST_FAIL)
+                       {
+                               kputs("> Main: process test finished..fail!\n");
+                               return -1;
+                       }
+               }
+               if (i == TASKS)
+                       break;
+               monitor_report();
+               timer_delay(1000);
+       }
+       for (i = 0; i < TASKS; i++)
+               score += preempt_counter[i];
+       kputs("> Main: process test finished..ok!\n");
+       kprintf("> Score: %lu\n", score);
+       return 0;
 }
+#endif /* CONFIG_KERN_PREEMPT */
+
+#if CONFIG_KERN_SIGNALS & CONFIG_KERN_PRI
 
-static cpu_stack_t proc_test1_stack[CONFIG_KERN_MINSTACKSIZE / sizeof(cpu_stack_t)];
-static cpu_stack_t proc_test2_stack[CONFIG_KERN_MINSTACKSIZE / sizeof(cpu_stack_t)];
+#define PROC_PRI_TEST_STACK(num)  PROC_DEFINE_STACK(proc_test##num##_stack, KERN_MINSTACKSIZE);
+
+// Define params to test priority
+#define PROC_PRI_TEST(num) static void proc_pri_test##num(void) \
+{ \
+       struct Process *main_proc = (struct Process *) proc_currentUserData(); \
+       kputs("> Process: " #num "\n"); \
+       sig_signal(main_proc, SIG_USER##num); \
+}
 
+// Default priority is 0
+#define PROC_PRI_TEST_INIT(num, proc)                                  \
+do {                                                                   \
+       struct Process *p = proc_new(proc_pri_test##num, (proc),        \
+                                       sizeof(proc_test##num##_stack), \
+                                       proc_test##num##_stack);        \
+       proc_setPri(p, num + 1);                                        \
+} while (0)
+
+PROC_PRI_TEST_STACK(0)
+PROC_PRI_TEST_STACK(1)
+PROC_PRI_TEST_STACK(2)
+
+PROC_PRI_TEST(0)
+PROC_PRI_TEST(1)
+PROC_PRI_TEST(2)
+
+static int prio_worker_test(void)
+{
+       struct Process *curr = proc_current();
+       int orig_pri = curr->link.pri;
+       int ret = 0;
+
+       // test process priority
+       // main process must have the higher priority to check signals received
+       proc_setPri(proc_current(), 10);
+
+       kputs("Run Priority test..\n");
+       // the order in which the processes are created is important!
+       PROC_PRI_TEST_INIT(0, curr);
+       PROC_PRI_TEST_INIT(1, curr);
+       PROC_PRI_TEST_INIT(2, curr);
+
+       // signals must be: USER2, 1, 0 in order
+       sigmask_t signals = sig_wait(SIG_USER0 | SIG_USER1 | SIG_USER2);
+       if (!(signals & SIG_USER2))
+       {
+               ret = -1;
+               goto out;
+       }
+       signals = sig_wait(SIG_USER0 | SIG_USER1 | SIG_USER2);
+       if (!(signals & SIG_USER1))
+       {
+               ret = -1;
+               goto out;
+       }
+       signals = sig_wait(SIG_USER0 | SIG_USER1 | SIG_USER2);
+       if (!(signals & SIG_USER0))
+       {
+               ret = -1;
+               goto out;
+       }
+       // All processes must have quit by now, but just in case...
+       signals = sig_waitTimeout(SIG_USER0 | SIG_USER1 | SIG_USER2, 200);
+       if (signals & (SIG_USER0 | SIG_USER1 | SIG_USER2))
+       {
+               ret = -1;
+               goto out;
+       }
+       if (signals & SIG_TIMEOUT)
+       {
+               kputs("Priority test successfull.\n");
+       }
+out:
+       proc_setPri(proc_current(), orig_pri);
+       if (ret != 0)
+               kputs("Priority test failed.\n");
+       return ret;
+}
+#endif /* CONFIG_KERN_SIGNALS & CONFIG_KERN_PRI */
 
 /**
  * Process scheduling test
  */
 int proc_testRun(void)
 {
-       proc_new(proc_test1, NULL, sizeof(proc_test1_stack), proc_test1_stack);
-       proc_new(proc_test2, NULL, sizeof(proc_test2_stack), proc_test2_stack);
-       kputs("Processes created\n");
+#if CONFIG_KERN_PREEMPT
+       // Clear shared data (this is needed when this testcase is embedded in
+       // the demo application).
+       memset(preempt_counter, 0, sizeof(preempt_counter));
+       memset(preempt_done, 0, sizeof(preempt_done));
+       memset(barrier, 0, sizeof(barrier));
+       main_barrier = 0;
+#endif /* CONFIG_KERN_PREEMPT */
+       memset(done, 0, sizeof(done));
 
-       for (int i = 0; i < 30; ++i)
-       {
-               kputs("> main\n");
-               timer_delay(93);
-               proc_yield();
-       }
+       /* Start tests */
+       worker_test();
+#if CONFIG_KERN_PREEMPT
+       preempt_worker_test();
+#endif /* CONFIG_KERN_PREEMPT */
+#if CONFIG_KERN_SIGNALS & CONFIG_KERN_PRI
+       prio_worker_test();
+#endif /* CONFIG_KERN_SIGNALS & CONFIG_KERN_PRI */
        return 0;
 }
 
-#if UNIT_TEST
-
 int proc_testSetup(void)
 {
        kdbg_init();
 
-       #if CONFIG_KERN_PREEMPT
-               irq_init();
-       #endif
-
+       kprintf("Init Timer..");
        timer_init();
+       kprintf("Done.\n");
 
+       kprintf("Init Process..");
        proc_init();
+       kprintf("Done.\n");
+
        return 0;
 }
 
 int proc_testTearDown(void)
 {
+       kputs("TearDown Process test.\n");
        return 0;
 }
 
-#include <drv/kdebug.c>
-#include <drv/timer.c>
-#include <kern/idle.c>
-#include <kern/monitor.c>
-#include <kern/signal.c>
-#if CONFIG_KERN_PREEMPT
-       #include <kern/preempt.c>
-       #include <kern/irq.c>
-#else
-       #include <kern/coop.c>
-       // FIXME: we need to link with the switch asm code too!
-#endif
-#include <kern/proc.c>
-#include <mware/formatwr.c>
-#include <mware/hex.c>
-#include <mware/event.c>
-#include <os/hptime.c>
-
 TEST_MAIN(proc);
-
-#endif // _TEST