broken commit
Signed-off-by: Sean Cross <sean@xobs.io>
This commit is contained in:
commit
eb5881a358
1
.gitignore
vendored
Normal file
1
.gitignore
vendored
Normal file
@ -0,0 +1 @@
|
||||
/target
|
7
Cargo.lock
generated
Normal file
7
Cargo.lock
generated
Normal file
@ -0,0 +1,7 @@
|
||||
# This file is automatically @generated by Cargo.
|
||||
# It is not intended for manual editing.
|
||||
version = 3
|
||||
|
||||
[[package]]
|
||||
name = "rouns"
|
||||
version = "0.1.0"
|
8
Cargo.toml
Normal file
8
Cargo.toml
Normal file
@ -0,0 +1,8 @@
|
||||
[package]
|
||||
name = "rouns"
|
||||
version = "0.1.0"
|
||||
edition = "2021"
|
||||
|
||||
# See more keys and their definitions at https://doc.rust-lang.org/cargo/reference/manifest.html
|
||||
|
||||
[dependencies]
|
5
src/main.rs
Normal file
5
src/main.rs
Normal file
@ -0,0 +1,5 @@
|
||||
mod riscv;
|
||||
|
||||
fn main() {
|
||||
println!("Hello, world!");
|
||||
}
|
11
src/riscv/bus.rs
Normal file
11
src/riscv/bus.rs
Normal file
@ -0,0 +1,11 @@
|
||||
use crate::riscv::exception::Exception;
|
||||
|
||||
pub enum XLen {
|
||||
X32,
|
||||
X64,
|
||||
}
|
||||
|
||||
pub trait Bus<XLen> {
|
||||
fn read(&mut self, addr: XLen, size: u8) -> Result<XLen, Exception>;
|
||||
fn write(&mut self, addr: XLen, value: XLen, size: u8) -> Result<(), Exception>;
|
||||
}
|
3575
src/riscv/cpu.rs
Normal file
3575
src/riscv/cpu.rs
Normal file
File diff suppressed because it is too large
Load Diff
397
src/riscv/csr.rs
Normal file
397
src/riscv/csr.rs
Normal file
@ -0,0 +1,397 @@
|
||||
//! The csr module contains all the control and status registers.
|
||||
|
||||
use std::fmt;
|
||||
use std::ops::{Bound, Range, RangeBounds, RangeInclusive};
|
||||
|
||||
pub type CsrAddress = u16;
|
||||
pub type CsrFieldRange = RangeInclusive<usize>;
|
||||
|
||||
pub const MXLEN: usize = 64;
|
||||
/// The number of CSRs. The field is 12 bits so the maximum kind of CSRs is 4096 (2**12).
|
||||
pub const CSR_SIZE: usize = 4096;
|
||||
|
||||
//////////////////////////////
|
||||
// User-level CSR addresses //
|
||||
//////////////////////////////
|
||||
// User trap setup.
|
||||
/// User status register.
|
||||
const USTATUS: CsrAddress = 0x000;
|
||||
/// User trap handler base address.
|
||||
const UTVEC: CsrAddress = 0x005;
|
||||
|
||||
// User trap handling.
|
||||
/// User exception program counter.
|
||||
const UEPC: CsrAddress = 0x041;
|
||||
/// User trap cause.
|
||||
const UCAUSE: CsrAddress = 0x042;
|
||||
/// User bad address or instruction.
|
||||
const _UTVAL: CsrAddress = 0x043;
|
||||
|
||||
// User floating-point CSRs.
|
||||
/// Flating-point accrued exceptions.
|
||||
const _FFLAGS: CsrAddress = 0x001;
|
||||
/// Floating-point dynamic rounding mode.
|
||||
const _FRB: CsrAddress = 0x002;
|
||||
/// Floating-point control and status register (frm + fflags).
|
||||
pub const FCSR: CsrAddress = 0x003;
|
||||
|
||||
// User Counter/Timers.
|
||||
/// Timer for RDTIME instruction.
|
||||
const TIME: CsrAddress = 0xc01;
|
||||
|
||||
/////////////////////////////////////
|
||||
// Supervisor-level CSR addresses //
|
||||
////////////////////////////////////
|
||||
// Supervisor trap setup.
|
||||
/// Supervisor status register.
|
||||
pub const SSTATUS: CsrAddress = 0x100;
|
||||
/// Supervisor exception delegation register.
|
||||
const SEDELEG: CsrAddress = 0x102;
|
||||
/// Supervisor interrupt delegation register.
|
||||
const SIDELEG: CsrAddress = 0x103;
|
||||
/// Supervisor interrupt-enable register.
|
||||
pub const SIE: CsrAddress = 0x104;
|
||||
/// Supervisor trap handler base address.
|
||||
pub const STVEC: CsrAddress = 0x105;
|
||||
|
||||
// Supervisor trap handling.
|
||||
/// Scratch register for supervisor trap handlers.
|
||||
const _SSCRATCH: CsrAddress = 0x140;
|
||||
/// Supervisor exception program counter.
|
||||
pub const SEPC: CsrAddress = 0x141;
|
||||
/// Supervisor trap cause.
|
||||
pub const SCAUSE: CsrAddress = 0x142;
|
||||
/// Supervisor bad address or instruction.
|
||||
pub const STVAL: CsrAddress = 0x143;
|
||||
/// Supervisor interrupt pending.
|
||||
pub const SIP: CsrAddress = 0x144;
|
||||
|
||||
// Supervisor protection and translation.
|
||||
/// Supervisor address translation and protection.
|
||||
pub const SATP: CsrAddress = 0x180;
|
||||
|
||||
// SSTATUS fields.
|
||||
const SSTATUS_SIE_MASK: u64 = 0x2; // sstatus[1]
|
||||
const SSTATUS_SPIE_MASK: u64 = 0x20; // sstatus[5]
|
||||
const SSTATUS_UBE_MASK: u64 = 0x40; // sstatus[6]
|
||||
const SSTATUS_SPP_MASK: u64 = 0x100; // sstatus[8]
|
||||
const SSTATUS_FS_MASK: u64 = 0x6000; // sstatus[14:13]
|
||||
const SSTATUS_XS_MASK: u64 = 0x18000; // sstatus[16:15]
|
||||
const SSTATUS_SUM_MASK: u64 = 0x40000; // sstatus[18]
|
||||
const SSTATUS_MXR_MASK: u64 = 0x80000; // sstatus[19]
|
||||
const SSTATUS_UXL_MASK: u64 = 0x3_00000000; // sstatus[33:32]
|
||||
const SSTATUS_SD_MASK: u64 = 0x80000000_00000000; // sstatus[63]
|
||||
const SSTATUS_MASK: u64 = SSTATUS_SIE_MASK
|
||||
| SSTATUS_SPIE_MASK
|
||||
| SSTATUS_UBE_MASK
|
||||
| SSTATUS_SPP_MASK
|
||||
| SSTATUS_FS_MASK
|
||||
| SSTATUS_XS_MASK
|
||||
| SSTATUS_SUM_MASK
|
||||
| SSTATUS_MXR_MASK
|
||||
| SSTATUS_UXL_MASK
|
||||
| SSTATUS_SD_MASK;
|
||||
/// Global interrupt-enable bit for supervisor mode.
|
||||
pub const XSTATUS_SIE: CsrFieldRange = 1..=1;
|
||||
/// Previous interrupt-enable bit for supervisor mode.
|
||||
pub const XSTATUS_SPIE: CsrFieldRange = 5..=5;
|
||||
/// Previous privilege mode for supervisor mode.
|
||||
pub const XSTATUS_SPP: CsrFieldRange = 8..=8;
|
||||
|
||||
/////////////////////////////////
|
||||
// Machine-level CSR addresses //
|
||||
/////////////////////////////////
|
||||
// Machine information registers.
|
||||
/// Vendor ID.
|
||||
const MVENDORID: CsrAddress = 0xf11;
|
||||
/// Architecture ID.
|
||||
const MARCHID: CsrAddress = 0xf12;
|
||||
/// Implementation ID.
|
||||
const MIMPID: CsrAddress = 0xf13;
|
||||
/// Hardware thread ID.
|
||||
const MHARTID: CsrAddress = 0xf14;
|
||||
|
||||
// Machine trap setup.
|
||||
/// Machine status register.
|
||||
pub const MSTATUS: CsrAddress = 0x300;
|
||||
/// ISA and extensions.
|
||||
const MISA: CsrAddress = 0x301;
|
||||
/// Machine exception delefation register.
|
||||
pub const MEDELEG: CsrAddress = 0x302;
|
||||
/// Machine interrupt delefation register.
|
||||
pub const MIDELEG: CsrAddress = 0x303;
|
||||
/// Machine interrupt-enable register.
|
||||
pub const MIE: CsrAddress = 0x304;
|
||||
/// Machine trap-handler base address.
|
||||
pub const MTVEC: CsrAddress = 0x305;
|
||||
/// Machine counter enable.
|
||||
const _MCOUNTEREN: CsrAddress = 0x306;
|
||||
|
||||
// Machine trap handling.
|
||||
/// Scratch register for machine trap handlers.
|
||||
const _MSCRATCH: CsrAddress = 0x340;
|
||||
/// Machine exception program counter.
|
||||
pub const MEPC: CsrAddress = 0x341;
|
||||
/// Machine trap cause.
|
||||
pub const MCAUSE: CsrAddress = 0x342;
|
||||
/// Machine bad address or instruction.
|
||||
pub const MTVAL: CsrAddress = 0x343;
|
||||
/// Machine interrupt pending.
|
||||
pub const MIP: CsrAddress = 0x344;
|
||||
|
||||
// Machine memory protection.
|
||||
/// Physical memory protection configuration.
|
||||
const _PMPCFG0: CsrAddress = 0x3a0;
|
||||
/// Physical memory protection address register.
|
||||
const _PMPADDR0: CsrAddress = 0x3b0;
|
||||
|
||||
// MSTATUS fields.
|
||||
/// Global interrupt-enable bit for machine mode.
|
||||
pub const MSTATUS_MIE: CsrFieldRange = 3..=3;
|
||||
/// Previous interrupt-enable bit for machine mode.
|
||||
pub const MSTATUS_MPIE: CsrFieldRange = 7..=7;
|
||||
/// Previous privilege mode for machine mode.
|
||||
pub const MSTATUS_MPP: CsrFieldRange = 11..=12;
|
||||
/// Modify privilege bit.
|
||||
pub const MSTATUS_MPRV: CsrFieldRange = 17..=17;
|
||||
|
||||
// MIP fields.
|
||||
/// Supervisor software interrupt.
|
||||
pub const SSIP_BIT: u64 = 1 << 1;
|
||||
/// Machine software interrupt.
|
||||
pub const MSIP_BIT: u64 = 1 << 3;
|
||||
/// Supervisor timer interrupt.
|
||||
pub const STIP_BIT: u64 = 1 << 5;
|
||||
/// Machine timer interrupt.
|
||||
pub const MTIP_BIT: u64 = 1 << 7;
|
||||
/// Supervisor external interrupt.
|
||||
pub const SEIP_BIT: u64 = 1 << 9;
|
||||
/// Machine external interrupt.
|
||||
pub const MEIP_BIT: u64 = 1 << 11;
|
||||
|
||||
/// The state to contains all the CSRs.
|
||||
pub struct State {
|
||||
csrs: [u64; CSR_SIZE],
|
||||
}
|
||||
|
||||
impl fmt::Display for State {
|
||||
fn fmt(&self, f: &mut fmt::Formatter<'_>) -> fmt::Result {
|
||||
write!(
|
||||
f,
|
||||
"{}",
|
||||
format!(
|
||||
"{}\n{}\n{}",
|
||||
format!(
|
||||
"mstatus={:>#18x} mtvec={:>#18x} mepc={:>#18x}\n mcause={:>#18x} medeleg={:>#18x} mideleg={:>#18x}",
|
||||
self.read(MSTATUS),
|
||||
self.read(MTVEC),
|
||||
self.read(MEPC),
|
||||
self.read(MCAUSE),
|
||||
self.read(MEDELEG),
|
||||
self.read(MIDELEG),
|
||||
),
|
||||
format!(
|
||||
"sstatus={:>#18x} stvec={:>#18x} sepc={:>#18x}\n scause={:>#18x} sedeleg={:>#18x} sideleg={:>#18x}",
|
||||
self.read(SSTATUS),
|
||||
self.read(STVEC),
|
||||
self.read(SEPC),
|
||||
self.read(SCAUSE),
|
||||
self.read(SEDELEG),
|
||||
self.read(SIDELEG),
|
||||
),
|
||||
format!(
|
||||
"ustatus={:>#18x} utvec={:>#18x} uepc={:>#18x}\n ucause={:>#18x}",
|
||||
self.read(USTATUS),
|
||||
self.read(UTVEC),
|
||||
self.read(UEPC),
|
||||
self.read(UCAUSE),
|
||||
),
|
||||
)
|
||||
)
|
||||
}
|
||||
}
|
||||
|
||||
impl State {
|
||||
/// Create a new `state` object.
|
||||
pub fn new() -> Self {
|
||||
let mut csrs = [0; CSR_SIZE];
|
||||
let misa: u64 = (2 << 62) | // MXL[1:0]=2 (XLEN is 64)
|
||||
(1 << 20) | // Extensions[20] (User mode implemented)
|
||||
(1 << 18) | // Extensions[18] (Supervisor mode implemented)
|
||||
(1 << 12) | // Extensions[12] (Integer Multiply/Divide extension)
|
||||
(1 << 8) | // Extensions[8] (RV32I/64I/128I base ISA)
|
||||
(1 << 5) | // Extensions[5] (Single-precision floating-point extension)
|
||||
(1 << 3) | // Extensions[3] (Double-precision floating-point extension)
|
||||
(1 << 2) | // Extensions[2] (Compressed extension)
|
||||
1; // Extensions[0] (Atomic extension)
|
||||
csrs[MISA as usize] = misa;
|
||||
|
||||
Self { csrs }
|
||||
}
|
||||
|
||||
/// Increment the value in the TIME register.
|
||||
pub fn increment_time(&mut self) {
|
||||
self.csrs[TIME as usize] = self.csrs[TIME as usize].wrapping_add(1);
|
||||
}
|
||||
|
||||
/// Read the val from the CSR.
|
||||
pub fn read(&self, addr: CsrAddress) -> u64 {
|
||||
// 4.1 Supervisor CSRs
|
||||
// "The supervisor should only view CSR state that should be visible to a supervisor-level
|
||||
// operating system. In particular, there is no information about the existence (or
|
||||
// non-existence) of higher privilege levels (machine level or other) visible in the CSRs
|
||||
// accessible by the supervisor. Many supervisor CSRs are a subset of the equivalent
|
||||
// machine-mode CSR, and the machinemode chapter should be read first to help understand
|
||||
// the supervisor-level CSR descriptions."
|
||||
match addr {
|
||||
SSTATUS => self.csrs[MSTATUS as usize] & SSTATUS_MASK,
|
||||
SIE => self.csrs[MIE as usize] & self.csrs[MIDELEG as usize],
|
||||
SIP => self.csrs[MIP as usize] & self.csrs[MIDELEG as usize],
|
||||
_ => self.csrs[addr as usize],
|
||||
}
|
||||
}
|
||||
|
||||
/// Write the val to the CSR.
|
||||
pub fn write(&mut self, addr: CsrAddress, val: u64) {
|
||||
// 4.1 Supervisor CSRs
|
||||
// "The supervisor should only view CSR state that should be visible to a supervisor-level
|
||||
// operating system. In particular, there is no information about the existence (or
|
||||
// non-existence) of higher privilege levels (machine level or other) visible in the CSRs
|
||||
// accessible by the supervisor. Many supervisor CSRs are a subset of the equivalent
|
||||
// machine-mode CSR, and the machinemode chapter should be read first to help understand
|
||||
// the supervisor-level CSR descriptions."
|
||||
match addr {
|
||||
MVENDORID => {}
|
||||
MARCHID => {}
|
||||
MIMPID => {}
|
||||
MHARTID => {}
|
||||
SSTATUS => {
|
||||
self.csrs[MSTATUS as usize] =
|
||||
(self.csrs[MSTATUS as usize] & !SSTATUS_MASK) | (val & SSTATUS_MASK);
|
||||
}
|
||||
SIE => {
|
||||
self.csrs[MIE as usize] = (self.csrs[MIE as usize] & !self.csrs[MIDELEG as usize])
|
||||
| (val & self.csrs[MIDELEG as usize]);
|
||||
}
|
||||
SIP => {
|
||||
let mask = SSIP_BIT & self.csrs[MIDELEG as usize];
|
||||
self.csrs[MIP as usize] = (self.csrs[MIP as usize] & !mask) | (val & mask);
|
||||
}
|
||||
_ => self.csrs[addr as usize] = val,
|
||||
}
|
||||
}
|
||||
|
||||
/// Read a bit from the CSR.
|
||||
pub fn read_bit(&self, addr: CsrAddress, bit: usize) -> u64 {
|
||||
if bit >= MXLEN {
|
||||
// TODO: raise exception?
|
||||
}
|
||||
|
||||
if (self.read(addr) & (1 << bit)) != 0 {
|
||||
1
|
||||
} else {
|
||||
0
|
||||
}
|
||||
}
|
||||
|
||||
/// Read a arbitrary length of bits from the CSR.
|
||||
pub fn read_bits<T: RangeBounds<usize>>(&self, addr: CsrAddress, range: T) -> u64 {
|
||||
let range = to_range(&range, MXLEN);
|
||||
|
||||
if (range.start >= MXLEN) | (range.end > MXLEN) | (range.start >= range.end) {
|
||||
// TODO: ranse exception?
|
||||
}
|
||||
|
||||
// Bitmask for high bits.
|
||||
let mut bitmask = 0;
|
||||
if range.end != 64 {
|
||||
bitmask = !0 << range.end;
|
||||
}
|
||||
|
||||
// Shift away low bits.
|
||||
(self.read(addr) as u64 & !bitmask) >> range.start
|
||||
}
|
||||
|
||||
/// Write a bit to the CSR.
|
||||
pub fn write_bit(&mut self, addr: CsrAddress, bit: usize, val: u64) {
|
||||
if bit >= MXLEN {
|
||||
// TODO: raise exception?
|
||||
}
|
||||
if val > 1 {
|
||||
// TODO: raise exception
|
||||
}
|
||||
|
||||
if val == 1 {
|
||||
self.write(addr, self.read(addr) | 1 << bit);
|
||||
} else if val == 0 {
|
||||
self.write(addr, self.read(addr) & !(1 << bit));
|
||||
}
|
||||
}
|
||||
|
||||
/// Write an arbitrary length of bits to the CSR.
|
||||
pub fn write_bits<T: RangeBounds<usize>>(&mut self, addr: CsrAddress, range: T, val: u64) {
|
||||
let range = to_range(&range, MXLEN);
|
||||
|
||||
if (range.start >= MXLEN) | (range.end > MXLEN) | (range.start >= range.end) {
|
||||
// TODO: ranse exception?
|
||||
}
|
||||
if (val >> (range.end - range.start)) != 0 {
|
||||
// TODO: raise exception
|
||||
}
|
||||
|
||||
let bitmask = (!0 << range.end) | !(!0 << range.start);
|
||||
// Set bits.
|
||||
self.write(addr, (self.read(addr) & bitmask) | (val << range.start))
|
||||
}
|
||||
|
||||
/// Read bit(s) from a given field in the SSTATUS register.
|
||||
pub fn read_sstatus(&self, range: CsrFieldRange) -> u64 {
|
||||
self.read_bits(SSTATUS, range)
|
||||
}
|
||||
|
||||
/// Read bit(s) from a given field in the MSTATUS register.
|
||||
pub fn read_mstatus(&self, range: CsrFieldRange) -> u64 {
|
||||
self.read_bits(MSTATUS, range)
|
||||
}
|
||||
|
||||
/// Write bit(s) to a given field in the SSTATUS register.
|
||||
pub fn write_sstatus(&mut self, range: CsrFieldRange, val: u64) {
|
||||
self.write_bits(SSTATUS, range, val);
|
||||
}
|
||||
|
||||
/// Write bit(s) to a given field in the MSTATUS register.
|
||||
pub fn write_mstatus(&mut self, range: CsrFieldRange, val: u64) {
|
||||
self.write_bits(MSTATUS, range, val);
|
||||
}
|
||||
|
||||
/// Reset all the CSRs.
|
||||
pub fn reset(&mut self) {
|
||||
self.csrs = [0; CSR_SIZE];
|
||||
|
||||
let misa: u64 = (2 << 62) | // MXL[1:0]=2 (XLEN is 64)
|
||||
(1 << 18) | // Extensions[18] (Supervisor mode implemented)
|
||||
(1 << 12) | // Extensions[12] (Integer Multiply/Divide extension)
|
||||
(1 << 8) | // Extensions[8] (RV32I/64I/128I base ISA)
|
||||
(1 << 5) | // Extensions[5] (Single-precision floating-point extension)
|
||||
(1 << 3) | // Extensions[3] (Double-precision floating-point extension)
|
||||
(1 << 2) | // Extensions[2] (Compressed extension)
|
||||
1; // Extensions[0] (Atomic extension)
|
||||
self.csrs[MISA as usize] = misa;
|
||||
}
|
||||
}
|
||||
|
||||
/// Convert the val implement `RangeBounds` to the `Range` struct.
|
||||
fn to_range<T: RangeBounds<usize>>(generic_range: &T, bit_length: usize) -> Range<usize> {
|
||||
let start = match generic_range.start_bound() {
|
||||
Bound::Excluded(&val) => val + 1,
|
||||
Bound::Included(&val) => val,
|
||||
Bound::Unbounded => 0,
|
||||
};
|
||||
let end = match generic_range.end_bound() {
|
||||
Bound::Excluded(&val) => val,
|
||||
Bound::Included(&val) => val + 1,
|
||||
Bound::Unbounded => bit_length,
|
||||
};
|
||||
|
||||
start..end
|
||||
}
|
240
src/riscv/exception.rs
Normal file
240
src/riscv/exception.rs
Normal file
@ -0,0 +1,240 @@
|
||||
//! The exception module contains all the exception kinds and the function to handle exceptions.
|
||||
|
||||
use crate::riscv::{
|
||||
bus::Bus,
|
||||
cpu::{Cpu, Mode},
|
||||
csr::*,
|
||||
};
|
||||
|
||||
use super::bus::XLen;
|
||||
|
||||
/// All the exception kinds.
|
||||
#[derive(Debug, PartialEq)]
|
||||
pub enum Exception {
|
||||
/// With the addition of the C extension, no instructions can raise
|
||||
/// instruction-address-misaligned exceptions.
|
||||
InstructionAddressMisaligned,
|
||||
InstructionAccessFault,
|
||||
IllegalInstruction(u64),
|
||||
Breakpoint,
|
||||
LoadAddressMisaligned,
|
||||
LoadAccessFault,
|
||||
StoreAMOAddressMisaligned,
|
||||
StoreAMOAccessFault,
|
||||
EnvironmentCallFromUMode,
|
||||
EnvironmentCallFromSMode,
|
||||
EnvironmentCallFromMMode,
|
||||
// Stores a trap value (the faulting address) for page fault exceptions.
|
||||
InstructionPageFault(u64),
|
||||
LoadPageFault(u64),
|
||||
StoreAMOPageFault(u64),
|
||||
}
|
||||
|
||||
/// All the trap kinds.
|
||||
#[derive(Debug)]
|
||||
pub enum Trap {
|
||||
/// The trap is visible to, and handled by, software running inside the execution
|
||||
/// environment.
|
||||
Contained,
|
||||
/// The trap is a synchronous exception that is an explicit call to the execution
|
||||
/// environment requesting an action on behalf of software inside the execution environment.
|
||||
Requested,
|
||||
/// The trap is handled transparently by the execution environment and execution
|
||||
/// resumes normally after the trap is handled.
|
||||
Invisible,
|
||||
/// The trap represents a fatal failure and causes the execution environment to terminate
|
||||
/// execution.
|
||||
Fatal,
|
||||
}
|
||||
|
||||
impl Exception {
|
||||
fn exception_code(&self) -> u64 {
|
||||
match self {
|
||||
Exception::InstructionAddressMisaligned => 0,
|
||||
Exception::InstructionAccessFault => 1,
|
||||
Exception::IllegalInstruction(_) => 2,
|
||||
Exception::Breakpoint => 3,
|
||||
Exception::LoadAddressMisaligned => 4,
|
||||
Exception::LoadAccessFault => 5,
|
||||
Exception::StoreAMOAddressMisaligned => 6,
|
||||
Exception::StoreAMOAccessFault => 7,
|
||||
Exception::EnvironmentCallFromUMode => 8,
|
||||
Exception::EnvironmentCallFromSMode => 9,
|
||||
Exception::EnvironmentCallFromMMode => 11,
|
||||
Exception::InstructionPageFault(_) => 12,
|
||||
Exception::LoadPageFault(_) => 13,
|
||||
Exception::StoreAMOPageFault(_) => 15,
|
||||
}
|
||||
}
|
||||
|
||||
fn epc(&self, pc: u64) -> u64 {
|
||||
// 3.2.1 Environment Call and Breakpoint
|
||||
// "ECALL and EBREAK cause the receiving privilege mode’s epc register to be set to the
|
||||
// address of the ECALL or EBREAK instruction itself, not the address of the following
|
||||
// instruction."
|
||||
match self {
|
||||
Exception::Breakpoint
|
||||
| Exception::EnvironmentCallFromUMode
|
||||
| Exception::EnvironmentCallFromSMode
|
||||
| Exception::EnvironmentCallFromMMode
|
||||
// TODO: why page fault needs this?
|
||||
| Exception::InstructionPageFault(_)
|
||||
| Exception::LoadPageFault(_)
|
||||
| Exception::StoreAMOPageFault(_) => pc,
|
||||
_ => pc.wrapping_add(4),
|
||||
}
|
||||
}
|
||||
|
||||
fn trap_value(&self, pc: u64) -> u64 {
|
||||
// 3.1.17 Machine Trap Value Register (mtval)
|
||||
// 4.1.9 Supervisor Trap Value Register (stval)
|
||||
// "When a hardware breakpoint is triggered, or an address-misaligned, access-fault, or
|
||||
// page-fault exception occurs on an instruction fetch, load, or store, mtval (stval) is
|
||||
// written with the faulting virtual address. On an illegal instruction trap, mtval (stval)
|
||||
// may be written with the first XLEN or ILEN bits of the faulting instruction as described
|
||||
// below. For other traps, mtval (stval) is set to zero, but a future standard may redefine
|
||||
// mtval's (stval's) setting for other traps."
|
||||
match self {
|
||||
Exception::InstructionAddressMisaligned
|
||||
| Exception::InstructionAccessFault
|
||||
| Exception::Breakpoint
|
||||
| Exception::LoadAddressMisaligned
|
||||
| Exception::LoadAccessFault
|
||||
| Exception::StoreAMOAddressMisaligned
|
||||
| Exception::StoreAMOAccessFault => pc,
|
||||
Exception::InstructionPageFault(val)
|
||||
| Exception::LoadPageFault(val)
|
||||
| Exception::StoreAMOPageFault(val) => *val,
|
||||
Exception::IllegalInstruction(val) => *val,
|
||||
_ => 0,
|
||||
}
|
||||
}
|
||||
|
||||
/// Update CSRs and the program counter depending on an exception.
|
||||
pub fn take_trap<Bus>(&self, cpu: &mut Cpu<Bus>) -> Trap
|
||||
where
|
||||
Bus: crate::riscv::bus::Bus<XLen>,
|
||||
{
|
||||
// 1.2 Privilege Levels
|
||||
// "Traps that increase privilege level are termed vertical traps, while traps that remain
|
||||
// at the same privilege level are termed horizontal traps."
|
||||
|
||||
let exception_pc = self.epc(cpu.pc);
|
||||
let previous_mode = cpu.mode;
|
||||
let cause = self.exception_code();
|
||||
|
||||
// 3.1.8 Machine Trap Delegation Registers (medeleg and mideleg)
|
||||
// "By default, all traps at any privilege level are handled in machine mode"
|
||||
// "To increase performance, implementations can provide individual read/write bits within
|
||||
// medeleg and mideleg to indicate that certain exceptions and interrupts should be
|
||||
// processed directly by a lower privilege level."
|
||||
//
|
||||
// "medeleg has a bit position allocated for every synchronous exception shown in Table 3.6
|
||||
// on page 37, with the index of the bit position equal to the value returned in the mcause
|
||||
// register (i.e., setting bit 8 allows user-mode environment calls to be delegated to a
|
||||
// lower-privilege trap handler)."
|
||||
if previous_mode <= Mode::Supervisor && ((cpu.state.read(MEDELEG) >> cause) & 1) == 1 {
|
||||
// Handle the trap in S-mode.
|
||||
cpu.mode = Mode::Supervisor;
|
||||
|
||||
// Set the program counter to the supervisor trap-handler base address (stvec).
|
||||
cpu.pc = (cpu.state.read(STVEC) & !1) as u64;
|
||||
|
||||
// 4.1.9 Supervisor Exception Program Counter (sepc)
|
||||
// "The low bit of sepc (sepc[0]) is always zero."
|
||||
// "When a trap is taken into S-mode, sepc is written with the virtual address of
|
||||
// the instruction that was interrupted or that encountered the exception.
|
||||
// Otherwise, sepc is never written by the implementation, though it may be
|
||||
// explicitly written by software."
|
||||
cpu.state.write(SEPC, exception_pc & !1);
|
||||
|
||||
// 4.1.10 Supervisor Cause Register (scause)
|
||||
// "When a trap is taken into S-mode, scause is written with a code indicating
|
||||
// the event that caused the trap. Otherwise, scause is never written by the
|
||||
// implementation, though it may be explicitly written by software."
|
||||
cpu.state.write(SCAUSE, cause);
|
||||
|
||||
// 4.1.11 Supervisor Trap Value (stval) Register
|
||||
// "When a trap is taken into S-mode, stval is written with exception-specific
|
||||
// information to assist software in handling the trap. Otherwise, stval is never
|
||||
// written by the implementation, though it may be explicitly written by software."
|
||||
cpu.state.write(STVAL, self.trap_value(exception_pc));
|
||||
|
||||
// Set a previous interrupt-enable bit for supervisor mode (SPIE, 5) to the value
|
||||
// of a global interrupt-enable bit for supervisor mode (SIE, 1).
|
||||
cpu.state
|
||||
.write_sstatus(XSTATUS_SPIE, cpu.state.read_sstatus(XSTATUS_SIE));
|
||||
// Set a global interrupt-enable bit for supervisor mode (SIE, 1) to 0.
|
||||
cpu.state.write_sstatus(XSTATUS_SIE, 0);
|
||||
// 4.1.1 Supervisor Status Register (sstatus)
|
||||
// "When a trap is taken, SPP is set to 0 if the trap originated from user mode, or
|
||||
// 1 otherwise."
|
||||
match previous_mode {
|
||||
Mode::User => cpu.state.write_sstatus(XSTATUS_SPP, 0),
|
||||
_ => cpu.state.write_sstatus(XSTATUS_SPP, 1),
|
||||
}
|
||||
} else {
|
||||
// Handle the trap in M-mode.
|
||||
cpu.mode = Mode::Machine;
|
||||
|
||||
// Set the program counter to the machine trap-handler base address (mtvec).
|
||||
cpu.pc = (cpu.state.read(MTVEC) & !1) as u64;
|
||||
|
||||
// 3.1.15 Machine Exception Program Counter (mepc)
|
||||
// "The low bit of mepc (mepc[0]) is always zero."
|
||||
// "When a trap is taken into M-mode, mepc is written with the virtual address of
|
||||
// the instruction that was interrupted or that encountered the exception.
|
||||
// Otherwise, mepc is never written by the implementation, though it may be
|
||||
// explicitly written by software."
|
||||
cpu.state.write(MEPC, exception_pc & !1);
|
||||
|
||||
// 3.1.16 Machine Cause Register (mcause)
|
||||
// "When a trap is taken into M-mode, mcause is written with a code indicating
|
||||
// the event that caused the trap. Otherwise, mcause is never written by the
|
||||
// implementation, though it may be explicitly written by software."
|
||||
cpu.state.write(MCAUSE, cause);
|
||||
|
||||
// 3.1.17 Machine Trap Value (mtval) Register
|
||||
// "When a trap is taken into M-mode, mtval is either set to zero or written with
|
||||
// exception-specific information to assist software in handling the trap.
|
||||
// Otherwise, mtval is never written by the implementation, though it may be
|
||||
// explicitly written by software."
|
||||
cpu.state.write(MTVAL, self.trap_value(exception_pc));
|
||||
|
||||
// Set a previous interrupt-enable bit for machine mode (MPIE, 7) to the value
|
||||
// of a global interrupt-enable bit for machine mode (MIE, 3).
|
||||
cpu.state
|
||||
.write_mstatus(MSTATUS_MPIE, cpu.state.read_mstatus(MSTATUS_MIE));
|
||||
// Set a global interrupt-enable bit for machine mode (MIE, 3) to 0.
|
||||
cpu.state.write_mstatus(MSTATUS_MIE, 0);
|
||||
// When a trap is taken from privilege mode y into privilege mode x, xPIE is set
|
||||
// to the value of x IE; x IE is set to 0; and xPP is set to y.
|
||||
match previous_mode {
|
||||
Mode::User => cpu.state.write_mstatus(MSTATUS_MPP, Mode::User as u64),
|
||||
Mode::Supervisor => cpu
|
||||
.state
|
||||
.write_mstatus(MSTATUS_MPP, Mode::Supervisor as u64),
|
||||
Mode::Machine => cpu.state.write_mstatus(MSTATUS_MPP, Mode::Machine as u64),
|
||||
_ => panic!("previous privilege mode is invalid"),
|
||||
}
|
||||
}
|
||||
|
||||
match self {
|
||||
Exception::InstructionAddressMisaligned | Exception::InstructionAccessFault => {
|
||||
Trap::Fatal
|
||||
}
|
||||
Exception::IllegalInstruction(_) => Trap::Invisible,
|
||||
Exception::Breakpoint => Trap::Requested,
|
||||
Exception::LoadAddressMisaligned
|
||||
| Exception::LoadAccessFault
|
||||
| Exception::StoreAMOAddressMisaligned
|
||||
| Exception::StoreAMOAccessFault => Trap::Fatal,
|
||||
Exception::EnvironmentCallFromUMode
|
||||
| Exception::EnvironmentCallFromSMode
|
||||
| Exception::EnvironmentCallFromMMode => Trap::Requested,
|
||||
Exception::InstructionPageFault(_)
|
||||
| Exception::LoadPageFault(_)
|
||||
| Exception::StoreAMOPageFault(_) => Trap::Invisible,
|
||||
}
|
||||
}
|
||||
}
|
4
src/riscv/mod.rs
Normal file
4
src/riscv/mod.rs
Normal file
@ -0,0 +1,4 @@
|
||||
mod bus;
|
||||
mod cpu;
|
||||
mod csr;
|
||||
mod exception;
|
Loading…
Reference in New Issue
Block a user