dispatch is now a shared SMP command

3 files changed, 61 insertions, 0 deletions

diff --git a/schedsim/shell/shared/Makefile.am b/schedsim/shell/shared/Makefile.am
index c90824e..6940f41 100644
--- a/schedsim/shell/shared/Makefile.am
+++ b/schedsim/shell/shared/Makefile.am
@@ -54,6 +54,7 @@ libschedsim_a_SOURCES += shell_makeargs.c
 if HAS_SMP
 libschedsim_a_SOURCES += smp_stub.c
 libschedsim_a_SOURCES += main_currentcpu.c
+libschedsim_a_SOURCES += main_dispatch.c
 libschedsim_a_SOURCES += main_taskgetaffinity.c
 libschedsim_a_SOURCES += main_tasksetaffinity.c
 endif
diff --git a/schedsim/shell/shared/commands.c b/schedsim/shell/shared/commands.c
index 483c7ef..5a75181 100644
--- a/schedsim/shell/shared/commands.c
+++ b/schedsim/shell/shared/commands.c
@@ -35,6 +35,7 @@ extern rtems_shell_cmd_t rtems_shell_TASK_WAKE_AFTER_Command;
   extern rtems_shell_cmd_t rtems_shell_TASK_GET_AFFINITY_Command;
   extern rtems_shell_cmd_t rtems_shell_TASK_SET_AFFINITY_Command;
   extern rtems_shell_cmd_t rtems_shell_CURRENT_CPU_Command;
+  extern rtems_shell_cmd_t rtems_shell_DISPATCH_Command;
 #endif
 
 extern rtems_shell_cmd_t rtems_shell_CLOCK_TICK_Command;
@@ -49,6 +50,7 @@ extern rtems_shell_cmd_t rtems_shell_TASK_EXECUTING_Command;
 extern rtems_shell_cmd_t rtems_shell_TASK_HEIR_Command;
 extern rtems_shell_cmd_t rtems_shell_CPUS_Command;
 
+
 rtems_shell_cmd_t *rtems_shell_Initial_commands[] = {
   /* Generic Commands */
   &rtems_shell_ECHO_Command,
@@ -67,6 +69,7 @@ rtems_shell_cmd_t *rtems_shell_Initial_commands[] = {
     &rtems_shell_TASK_GET_AFFINITY_Command,
     &rtems_shell_TASK_SET_AFFINITY_Command,
     &rtems_shell_CURRENT_CPU_Command,
+    &rtems_shell_DISPATCH_Command,
   #endif
 
   &rtems_shell_CLOCK_TICK_Command,
diff --git a/schedsim/shell/shared/main_dispatch.c b/schedsim/shell/shared/main_dispatch.c
new file mode 100644
index 0000000..abb7050
--- /dev/null
+++ b/schedsim/shell/shared/main_dispatch.c
@@ -0,0 +1,57 @@
+/**
+ *  @file
+ *  @brief Invoke Dispatch on all Cores Command
+ */
+
+/*
+ *  COPYRIGHT (c) 1989-2014.
+ *  On-Line Applications Research Corporation (OAR).
+ *
+ *  The license and distribution terms for this file may be
+ *  found in the file LICENSE in this distribution or at
+ *  http://www.rtems.com/license/LICENSE.
+ */
+
+#include <newlib/getopt.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <ctype.h>
+
+#include "shell.h"
+#include "rtems_sched.h"
+
+#include <rtems.h>
+#include <rtems/score/percpu.h>
+#include <rtems/score/smp.h>
+#include <rtems/score/schedulersimplesmp.h>
+#include <rtems/score/threaddispatch.h>
+
+extern uint32_t Schedsim_Current_cpu;
+
+int rtems_shell_main_dispatch(int argc, char **argv)
+{
+  uint32_t   cpu;
+  uint32_t   current_cpu;
+
+  current_cpu = Schedsim_Current_cpu;
+  for ( cpu=0 ; cpu < _SMP_Processor_count ; cpu++ ) {
+    if ( _Per_CPU_Information[cpu].per_cpu.dispatch_necessary ) {
+      printf( "=== Invoke Thread Dispatch on CPU %d\n", cpu );
+       Schedsim_Current_cpu = cpu;
+      _Thread_Dispatch();
+    }
+  }
+
+  Schedsim_Current_cpu = current_cpu;
+  return 0;
+}
+
+rtems_shell_cmd_t rtems_shell_DISPATCH_Command = {
+  "dispatch",                    /* name */
+  "dispatch",                    /* usage */
+  "rtems",                       /* topic */
+  rtems_shell_main_dispatch,     /* command */
+  NULL,                          /* alias */
+  NULL                           /* next */
+};