[rtems commit] bsp/gen83xx: Disable caches in bsp_restart()

[Sebastian Huber]

Module:    rtems
Branch:    master
Commit:    7f7b09ca2e79a4773e0189a44d5708dfb91772d2
Changeset: http://git.rtems.org/rtems/commit/?id=7f7b09ca2e79a4773e0189a44d5708dfb91772d2

Author:    Sebastian Huber <sebastian.huber at embedded-brains.de>
Date:      Fri Jan 18 09:48:38 2013 +0100

bsp/gen83xx: Disable caches in bsp_restart()

---

 .../libbsp/powerpc/gen83xx/startup/bsprestart.c    |   24 +++++++++++++++++++-
 1 files changed, 23 insertions(+), 1 deletions(-)

diff --git a/c/src/lib/libbsp/powerpc/gen83xx/startup/bsprestart.c b/c/src/lib/libbsp/powerpc/gen83xx/startup/bsprestart.c
index c095478..4e27c4e 100644
--- a/c/src/lib/libbsp/powerpc/gen83xx/startup/bsprestart.c
+++ b/c/src/lib/libbsp/powerpc/gen83xx/startup/bsprestart.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2008-2012 embedded brains GmbH.  All rights reserved.
+ * Copyright (c) 2008-2013 embedded brains GmbH.  All rights reserved.
  *
  *  embedded brains GmbH
  *  Obere Lagerstr. 30
@@ -13,12 +13,34 @@
  */
 
 #include <bsp.h>
+#include <bsp/u-boot.h>
+
+#include <libcpu/powerpc-utility.h>
 
 void bsp_restart(void *addr)
 {
   rtems_interrupt_level level;
   void (*start)(void) = addr;
+  #ifdef HAS_UBOOT
+    const void *mem_begin = (const void *) bsp_uboot_board_info.bi_memstart;
+    size_t mem_size = bsp_uboot_board_info.bi_memsize;
+  #else /* HAS_UBOOT */
+    const void *mem_begin = bsp_ram_start;
+    size_t mem_size = (size_t) bsp_ram_size;
+  #endif /* HAS_UBOOT */
+  uint32_t hid0;
 
   rtems_interrupt_disable(level);
+
+  hid0 = PPC_SPECIAL_PURPOSE_REGISTER(HID0);
+
+  if ((hid0 & HID0_DCE) != 0) {
+    rtems_cache_flush_multiple_data_lines(mem_begin, mem_size);
+  }
+
+  hid0 &= ~(HID0_DCE | HID0_ICE);
+
+  PPC_SET_SPECIAL_PURPOSE_REGISTER(HID0, hid0);
+
   (*start)();
 }