[rtems commit] bsp/riscv: Add reset via for SiFive Test Finisher

[Sebastian Huber]

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

Author:    Sebastian Huber <sebastian.huber at embedded-brains.de>
Date:      Thu Jul 19 14:45:47 2018 +0200

bsp/riscv: Add reset via for SiFive Test Finisher

Update #3433.

---

 bsps/riscv/riscv/start/bsp_fatal_halt.c | 23 ++++++++++++++++++-----
 1 file changed, 18 insertions(+), 5 deletions(-)

diff --git a/bsps/riscv/riscv/start/bsp_fatal_halt.c b/bsps/riscv/riscv/start/bsp_fatal_halt.c
index 5c81cac..af9e2ac 100644
--- a/bsps/riscv/riscv/start/bsp_fatal_halt.c
+++ b/bsps/riscv/riscv/start/bsp_fatal_halt.c
@@ -1,8 +1,8 @@
-/* @ingroup riscv_generic
- * @brief riscv_generic BSP Fatal_halt handler.
+/*
+ * Copyright (c) 2018 embedded brains GmbH
  *
- *  Copyright (c) 2015 University of York.
- *  Hesham Almatary <hesham at alumni.york.ac.uk>
+ * Copyright (c) 2015 University of York.
+ * Hesham Almatary <hesham at alumni.york.ac.uk>
  *
  * Redistribution and use in source and binary forms, with or without
  * modification, are permitted provided that the following conditions
@@ -27,14 +27,27 @@
  */
 
 #include <bsp/riscv.h>
+#include <bsp/fdt.h>
+
+#include <libfdt.h>
 
 void _CPU_Fatal_halt(uint32_t source, uint32_t error)
 {
+  const char *fdt;
+  int node;
+  volatile uintptr_t *sifive_test;
+
 #if RISCV_ENABLE_HTIF_SUPPORT != 0
   htif_poweroff();
 #endif
 
+  fdt = bsp_fdt_get();
+  node = fdt_node_offset_by_compatible(fdt, -1, "sifive,test0");
+  sifive_test = riscv_fdt_get_address(fdt, node);
+
   while (true) {
-    /* Do nothing */
+    if (sifive_test != NULL) {
+      *sifive_test = 0x5555;
+    }
   }
 }