[rtems commit] spcache01: Instruction cache invalidate workaround
Sebastian Huber
sebh at rtems.org
Wed Apr 5 07:57:25 UTC 2017
Module: rtems
Branch: master
Commit: 75e71b2df9054014aec92e79f30e2359edd50930
Changeset: http://git.rtems.org/rtems/commit/?id=75e71b2df9054014aec92e79f30e2359edd50930
Author: Sebastian Huber <sebastian.huber at embedded-brains.de>
Date: Wed Apr 5 09:55:45 2017 +0200
spcache01: Instruction cache invalidate workaround
On some systems, the instruction cache invalidation is not allowed by
the MMU.
---
testsuites/sptests/spcache01/init.c | 45 +++++++++++++++++++++++++++++++++----
1 file changed, 41 insertions(+), 4 deletions(-)
diff --git a/testsuites/sptests/spcache01/init.c b/testsuites/sptests/spcache01/init.c
index 368616b..a595e99 100644
--- a/testsuites/sptests/spcache01/init.c
+++ b/testsuites/sptests/spcache01/init.c
@@ -1,5 +1,5 @@
/*
- * Copyright (c) 2014 embedded brains GmbH. All rights reserved.
+ * Copyright (c) 2014, 2017 embedded brains GmbH. All rights reserved.
*
* embedded brains GmbH
* Dornierstr. 4
@@ -16,9 +16,10 @@
#include "config.h"
#endif
+#include <inttypes.h>
+#include <setjmp.h>
#include <stdio.h>
#include <stdlib.h>
-#include <inttypes.h>
#include <rtems.h>
#include <rtems/counter.h>
@@ -43,6 +44,10 @@ const char rtems_test_name[] = "SPCACHE 1";
CPU_STRUCTURE_ALIGNMENT static int data[1024];
+static bool do_longjmp;
+
+static jmp_buf instruction_invalidate_return_context;
+
static void test_data_flush_and_invalidate(void)
{
if (rtems_cache_get_data_line_size() > 0) {
@@ -179,6 +184,7 @@ static void test_timing(void)
uint64_t d[3];
uint32_t cache_level;
size_t cache_size;
+ bool exception;
rtems_interrupt_lock_initialize(&lock, "test");
@@ -363,7 +369,18 @@ static void test_timing(void)
d[0] = do_some_work();
d[1] = do_some_work();
- rtems_cache_invalidate_multiple_instruction_lines(do_some_work, 4096);
+
+ do_longjmp = true;
+
+ if (setjmp(instruction_invalidate_return_context) == 0) {
+ rtems_cache_invalidate_multiple_instruction_lines(do_some_work, 4096);
+ exception = false;
+ } else {
+ exception = true;
+ }
+
+ do_longjmp = false;
+
d[2] = do_some_work();
rtems_interrupt_lock_release(&lock, &lock_context);
@@ -378,6 +395,12 @@ static void test_timing(void)
d[2]
);
+ if (exception) {
+ printf(
+ "rtems_cache_invalidate_multiple_data_lines() generated an exception\n"
+ );
+ }
+
rtems_interrupt_lock_destroy(&lock);
}
@@ -469,12 +492,26 @@ static void Init(rtems_task_argument arg)
rtems_test_exit(0);
}
+static void fatal_extension(
+ rtems_fatal_source source,
+ bool always_set_to_false,
+ rtems_fatal_code error
+)
+{
+ if (source == RTEMS_FATAL_SOURCE_EXCEPTION && do_longjmp) {
+ _ISR_Set_level(0);
+ longjmp(instruction_invalidate_return_context, 1);
+ }
+}
+
#define CONFIGURE_APPLICATION_NEEDS_CLOCK_DRIVER
#define CONFIGURE_APPLICATION_NEEDS_CONSOLE_DRIVER
#define CONFIGURE_MAXIMUM_TASKS 1
-#define CONFIGURE_INITIAL_EXTENSIONS RTEMS_TEST_INITIAL_EXTENSION
+#define CONFIGURE_INITIAL_EXTENSIONS \
+ { .fatal = fatal_extension }, \
+ RTEMS_TEST_INITIAL_EXTENSION
#define CONFIGURE_RTEMS_INIT_TASKS_TABLE
More information about the vc
mailing list