reset: add reset module, refactor failure module to call reset::fail

introduce SiFive Test device

Signed-off-by: Zhouqi Jiang <luojia@hust.edu.cn>

Cargo.lock

@@ -98,6 +98,7 @@ dependencies = [
  "panic-halt",
  "riscv",
  "rustsbi",
+ "sifive-test-device",
  "spin",
  "uart16550",
 ]
@@ -113,6 +114,12 @@ version = "1.2.0"
 source = "registry+https://github.com/rust-lang/crates.io-index"
 checksum = "94143f37725109f92c262ed2cf5e59bce7498c01bcc1502d7b9afe439a4e9f49"
 
+[[package]]
+name = "sifive-test-device"
+version = "0.0.0"
+source = "registry+https://github.com/rust-lang/crates.io-index"
+checksum = "ba50a6fd7cb5cdb2645fb93fb2bbae7d8d78390677a889bdcfaf13c3d29286d0"
+
 [[package]]
 name = "spin"
 version = "0.9.8"

Cargo.toml

@@ -13,6 +13,7 @@ log = "0.4.21"
 panic-halt = "0.2.0"
 riscv = "0.11.1"
 rustsbi = { git = "https://github.com/rustsbi/rustsbi", features = ["machine"] }
+sifive-test-device = "0.0.0"
 spin = "0.9.8"
 uart16550 = "0.0.1"
 

src/fail.rs

@@ -1,4 +1,4 @@
-use crate::dynamic;
+use crate::{dynamic, reset};
 use riscv::register::mstatus;
 
 #[cold]
@@ -20,9 +20,7 @@ pub fn invalid_dynamic_info(err: dynamic::DynamicError) -> (mstatus::MPP, usize)
         "help: dynamic information contains magic value 0x{:x}, version {}, next jump address 0x{:x}, next privilege mode {} ({}), options {:x}",
         err.bad_info.magic, err.bad_info.version, err.bad_info.next_addr, err.bad_info.next_mode, explain_next_mode, err.bad_info.options
     );
-    loop {
-        core::hint::spin_loop()
-    }
+    reset::fail()
 }
 
 #[cold]
@@ -31,7 +29,5 @@ pub fn no_dynamic_info_available(err: dynamic::DynamicReadError) -> dynamic::Dyn
         "no dynamic information available at address 0x{:x}",
         err.bad_paddr
     );
-    loop {
-        core::hint::spin_loop()
-    }
+    reset::fail()
 }

src/main.rs

@@ -11,6 +11,7 @@ mod board;
 mod console;
 mod dynamic;
 mod fail;
+mod reset;
 
 use panic_halt as _;
 use riscv::register::mstatus;

src/reset.rs

@@ -0,0 +1,29 @@
+use sifive_test_device::SifiveTestDevice;
+use spin::Mutex;
+
+static RESET: Mutex<MachineReset> = Mutex::new(MachineReset::DeadLoop);
+
+pub fn fail() -> ! {
+    let lock = RESET.lock();
+    match *lock {
+        MachineReset::DeadLoop => {
+            trace!("test fail, begin dead loop");
+            loop {
+                core::hint::spin_loop()
+            }
+        }
+        MachineReset::SifiveTest(test) => {
+            trace!("test fail, invoke process exit procedure on SiFive Test device");
+            unsafe { &*test }.fail(0)
+        }
+    }
+}
+
+enum MachineReset {
+    DeadLoop,
+    #[allow(unused)] // TODO use on FDT parsing
+    SifiveTest(*const SifiveTestDevice),
+}
+
+unsafe impl Send for MachineReset {}
+unsafe impl Sync for MachineReset {}