use alloc::vec;
use rustsbi::{Console, Physical, Reset, SbiRet, Timer};
use crate::mm;
pub enum ConsolePutError {
AddrInvalid,
SBIFailed(SbiRet),
}
pub fn sbi_console_putchar(ch: usize) -> Result<(), ConsolePutError> {
let sbi_ret = rustsbi::Forward {}.write_byte(ch as u8);
if sbi_ret.is_ok() {
Ok(())
} else {
Err(ConsolePutError::SBIFailed(sbi_ret))
}
}
pub fn sbi_console_put(s: &str) -> Result<(), ConsolePutError> {
if s.is_empty() {
return Ok(());
}
let num_bytes = s.len();
if unsafe { mm::init::HEAP_INITED } {
let buf = alloc::vec::Vec::from(s);
let buf_ptr = buf.as_ptr();
let physical = Physical::new(num_bytes, buf_ptr as usize, buf_ptr as usize + num_bytes);
let sbi_ret = rustsbi::Forward {}.write(physical);
return if sbi_ret.is_ok() {
Ok(())
} else {
Err(ConsolePutError::SBIFailed(sbi_ret))
};
}
let phys_addr_lo = s.as_ptr() as usize;
if let Some(phys_addr_hi) = phys_addr_lo.checked_add(num_bytes - 1) {
let physical = Physical::new(num_bytes, phys_addr_lo, phys_addr_hi);
let sbi_ret = rustsbi::Forward {}.write(physical);
return if sbi_ret.is_ok() {
Ok(())
} else {
Err(ConsolePutError::SBIFailed(sbi_ret))
};
}
Err(ConsolePutError::AddrInvalid)
}
pub fn sbi_console_getchar() -> Result<u8, SbiRet> {
if unsafe { mm::init::HEAP_INITED } {
let mut buf = vec![0u8; 1];
let physical = Physical::new(1, buf.as_mut_ptr() as usize, buf.as_mut_ptr() as usize);
let sbi_ret = rustsbi::Forward {}.read(physical);
if sbi_ret.is_ok() {
return Ok(buf[0]);
}
return Err(sbi_ret);
} else {
let mut buf = [0u8; 1];
let physical = Physical::new(1, buf.as_mut_ptr() as usize, buf.as_mut_ptr() as usize);
let sbi_ret = rustsbi::Forward {}.read(physical);
if sbi_ret.is_ok() {
return Ok(buf[0]);
}
return Err(sbi_ret);
}
}
enum ResetType {
Shutdown = 0x00000000,
ColdReboot = 0x00000001,
WarmReboot = 0x00000002,
}
enum ResetReason {
NoReason = 0x00000000,
SystemFailure = 0x00000001,
}
impl From<ResetType> for u32 {
fn from(rt: ResetType) -> u32 {
rt as u32
}
}
impl From<ResetReason> for u32 {
fn from(rr: ResetReason) -> u32 {
rr as u32
}
}
pub fn sbi_shutdown(failure: bool) -> ! {
if failure {
rustsbi::Forward {}.system_reset(
ResetType::Shutdown.into(),
ResetReason::SystemFailure.into(),
);
} else {
rustsbi::Forward {}.system_reset(ResetType::Shutdown.into(), ResetReason::NoReason.into());
}
unreachable!("sbi_shutdown");
}
pub fn sbi_set_timer(stime_value: u64) {
rustsbi::Forward {}.set_timer(stime_value);
}