1 files changed, 142 insertions, 0 deletions
diff --git a/testsuites/smptests/smpfatal03/init.c b/testsuites/smptests/smpfatal03/init.c
new file mode 100644
index 0000000000..3e5ebe2e8f
--- /dev/null
+++ b/testsuites/smptests/smpfatal03/init.c
@@ -0,0 +1,142 @@
+/*
+ * Copyright (c) 2014 embedded brains GmbH.  All rights reserved.
+ *
+ *  embedded brains GmbH
+ *  Dornierstr. 4
+ *  82178 Puchheim
+ *  Germany
+ *  <rtems@embedded-brains.de>
+ *
+ * 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.
+ */
+
+#ifdef HAVE_CONFIG_H
+  #include "config.h"
+#endif
+
+#include <rtems.h>
+#include <rtems/counter.h>
+#include <rtems/score/smpbarrier.h>
+#include <rtems/score/smpimpl.h>
+#include <rtems/score/threaddispatch.h>
+
+#include <assert.h>
+#include <stdlib.h>
+
+#define CPU_COUNT 2
+
+static uint32_t main_cpu;
+
+static SMP_barrier_Control barrier = SMP_BARRIER_CONTROL_INITIALIZER;
+
+static void end_of_test(void)
+{
+  printk( "*** END OF TEST SMPFATAL 3 ***\n" );
+}
+
+static void acquire_giant_and_fatal_task(rtems_task_argument arg)
+{
+  SMP_barrier_State state = SMP_BARRIER_STATE_INITIALIZER;
+  int i;
+
+  for (i = 0; i < 13; ++i) {
+    _Giant_Acquire();
+  }
+
+  _SMP_barrier_Wait(&barrier, &state, CPU_COUNT);
+
+  /*
+   * Now we have to wait some time so that the other thread can actually start
+   * with the _Giant_Acquire() procedure.
+   */
+  rtems_counter_delay_nanoseconds(1000000);
+
+  rtems_fatal(RTEMS_FATAL_SOURCE_APPLICATION, 0xdeadbeef);
+}
+
+static void wait_for_giant(void)
+{
+  SMP_barrier_State state = SMP_BARRIER_STATE_INITIALIZER;
+
+  _SMP_barrier_Wait(&barrier, &state, CPU_COUNT);
+
+  _Giant_Acquire();
+}
+
+static void Init(rtems_task_argument arg)
+{
+  uint32_t self = rtems_smp_get_current_processor();
+  uint32_t cpu_count = rtems_smp_get_processor_count();
+
+  printk("\n\n*** TEST SMPFATAL 3 ***\n");
+
+  main_cpu = self;
+
+  if (cpu_count >= CPU_COUNT) {
+    rtems_status_code sc;
+    rtems_id id;
+
+    sc = rtems_task_create(
+      rtems_build_name( 'W', 'A', 'I', 'T' ),
+      1,
+      RTEMS_MINIMUM_STACK_SIZE,
+      RTEMS_DEFAULT_MODES,
+      RTEMS_DEFAULT_ATTRIBUTES,
+      &id
+    );
+    assert(sc == RTEMS_SUCCESSFUL);
+
+    sc = rtems_task_start(id, acquire_giant_and_fatal_task, 0);
+    assert(sc == RTEMS_SUCCESSFUL);
+
+    wait_for_giant();
+  } else {
+    end_of_test();
+    exit(0);
+  }
+}
+
+static void fatal_extension(
+  rtems_fatal_source source,
+  bool is_internal,
+  rtems_fatal_code code
+)
+{
+  if (
+    source == RTEMS_FATAL_SOURCE_APPLICATION
+      || source == RTEMS_FATAL_SOURCE_SMP
+  ) {
+    uint32_t self = rtems_smp_get_current_processor();
+
+    assert(!is_internal);
+
+    if (self == main_cpu) {
+      assert(source == RTEMS_FATAL_SOURCE_SMP);
+      assert(code == SMP_FATAL_SHUTDOWN);
+
+      end_of_test();
+    } else {
+      assert(source == RTEMS_FATAL_SOURCE_APPLICATION);
+      assert(code == 0xdeadbeef);
+    }
+  }
+}
+
+#define CONFIGURE_APPLICATION_DOES_NOT_NEED_CLOCK_DRIVER
+#define CONFIGURE_APPLICATION_NEEDS_CONSOLE_DRIVER
+
+#define CONFIGURE_INITIAL_EXTENSIONS { .fatal = fatal_extension }
+
+#define CONFIGURE_SMP_APPLICATION
+
+#define CONFIGURE_SMP_MAXIMUM_PROCESSORS CPU_COUNT
+
+#define CONFIGURE_MAXIMUM_TASKS 2
+
+#define CONFIGURE_RTEMS_INIT_TASKS_TABLE
+
+#define CONFIGURE_INIT
+
+#include <rtems/confdefs.h>