cortex_a9::regs: use crate::regs interface

This commit is contained in:
Astro 2019-06-12 00:20:23 +02:00
parent 81a892b618
commit 1e16beb707
2 changed files with 32 additions and 22 deletions

View File

@ -1,12 +1,12 @@
pub trait ReadableRegister<T> { use crate::regs::{RegisterR, RegisterW};
fn get(&self) -> T;
}
macro_rules! def_reg_get { macro_rules! def_reg_get {
($name:ty, $type:ty, $asm_instr:tt) => { ($name:tt, $type: ty, $asm_instr:tt) => {
impl ReadableRegister<$type> for $name { impl RegisterR for $name {
type R = $type;
#[inline(always)] #[inline(always)]
fn get(&self) -> $type { fn read(&self) -> Self::R {
let mut value; let mut value;
unsafe { asm!($asm_instr : "=r" (value) ::: "volatile") } unsafe { asm!($asm_instr : "=r" (value) ::: "volatile") }
value value
@ -15,17 +15,19 @@ macro_rules! def_reg_get {
} }
} }
pub trait WritableRegister<T> {
fn set(&self, value: T);
}
macro_rules! def_reg_set { macro_rules! def_reg_set {
($name:ty, $type:ty, $asm_instr:tt) => { ($name:ty, $type:ty, $asm_instr:tt) => {
impl WritableRegister<$type> for $name { impl RegisterW for $name {
type W = $type;
#[inline(always)] #[inline(always)]
fn set(&self, value: $type) { fn write(&mut self, value: Self::W) {
unsafe { asm!($asm_instr :: "r" (value) :: "volatile") } unsafe { asm!($asm_instr :: "r" (value) :: "volatile") }
} }
fn zeroed() -> Self::W {
0
}
} }
} }
} }
@ -43,7 +45,18 @@ def_reg_set!(LR, u32, "mov lr, $0");
pub struct MPIDR; pub struct MPIDR;
def_reg_get!(MPIDR, u32, "mrc p15, 0, $0, c0, c0, 5"); def_reg_get!(MPIDR, u32, "mrc p15, 0, $0, c0, c0, 5");
pub struct DFAR;
def_reg_get!(DFAR, u32, "mrc p15, 0, $0, c6, c0, 0");
pub struct DFSR;
def_reg_get!(DFSR, u32, "mrc p15, 0, $0, c5, c0, 0");
pub struct SCTLR;
def_reg_get!(SCTLR, u32, "mrc p15, 0, $0, c1, c0, 0");
def_reg_set!(SCTLR, u32, "mcr p15, 0, $0, c1, c0, 0");
/// Invalidate TLBs /// Invalidate TLBs
#[inline(always)]
pub fn tlbiall() { pub fn tlbiall() {
unsafe { unsafe {
asm!("mcr p15, 0, $0, c8, c7, 0" :: "r" (0) :: "volatile"); asm!("mcr p15, 0, $0, c8, c7, 0" :: "r" (0) :: "volatile");
@ -51,6 +64,7 @@ pub fn tlbiall() {
} }
/// Invalidate I-Cache /// Invalidate I-Cache
#[inline(always)]
pub fn iciallu() { pub fn iciallu() {
unsafe { unsafe {
asm!("mcr p15, 0, $0, c7, c5, 0" :: "r" (0) :: "volatile"); asm!("mcr p15, 0, $0, c7, c5, 0" :: "r" (0) :: "volatile");
@ -58,6 +72,7 @@ pub fn iciallu() {
} }
/// Invalidate Branch Predictor Array /// Invalidate Branch Predictor Array
#[inline(always)]
pub fn bpiall() { pub fn bpiall() {
unsafe { unsafe {
asm!("mcr p15, 0, $0, c7, c5, 6" :: "r" (0) :: "volatile"); asm!("mcr p15, 0, $0, c7, c5, 6" :: "r" (0) :: "volatile");
@ -65,16 +80,10 @@ pub fn bpiall() {
} }
/// Invalidate D-Cache /// Invalidate D-Cache
#[inline(always)]
pub fn dccisw() { pub fn dccisw() {
// TODO: $0 is r11 at what value? // TODO: $0 is r11 at what value?
unsafe { unsafe {
asm!("mcr p15, 0, $0, c7, c5, 6" :: "r" (0) :: "volatile"); asm!("mcr p15, 0, $0, c7, c5, 6" :: "r" (0) :: "volatile");
} }
} }
/// Enable I-Cache and D-Cache
pub fn sctlr() {
unsafe {
asm!("mcr p15, 0, $0, c1, c0, 0" :: "r" (0x00401004) :: "volatile");
}
}

View File

@ -18,6 +18,7 @@ mod uart;
use uart::Uart; use uart::Uart;
mod eth; mod eth;
use crate::regs::{RegisterR, RegisterW};
use crate::cortex_a9::{asm, regs::*}; use crate::cortex_a9::{asm, regs::*};
extern "C" { extern "C" {
@ -32,9 +33,9 @@ extern "C" {
pub unsafe extern "C" fn _boot_cores() -> ! { pub unsafe extern "C" fn _boot_cores() -> ! {
const CORE_MASK: u32 = 0x3; const CORE_MASK: u32 = 0x3;
match MPIDR.get() & CORE_MASK { match MPIDR.read() & CORE_MASK {
0 => { 0 => {
SP.set(&mut __stack_start as *mut _ as u32); SP.write(&mut __stack_start as *mut _ as u32);
boot_core0(); boot_core0();
} }
_ => loop { _ => loop {
@ -67,7 +68,7 @@ fn l1_cache_init() {
// (Initialize MMU) // (Initialize MMU)
// Enable I-Cache and D-Cache // Enable I-Cache and D-Cache
sctlr(); SCTLR.write(0x00401004);
// Synchronization barriers // Synchronization barriers
// Allows MMU to start // Allows MMU to start