Tateisi/rcore-tutorial
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

Add ns16550a

Browse source
This commit is contained in:
Yifan Wu 2022-02-18 13:09:03 -08:00
parent fef12c79f1
commit 704eae3bb0
16 changed files with 311 additions and 129 deletions
Download patch file Download diff file Expand all files Collapse all files

52
os/src/drivers/plic.rs
View file

@ -1,5 +1,5 @@
pub struct PLIC {
base_addr: usize,
base_addr: usize,
}
#[derive(Copy, Clone)]
@ -10,7 +10,7 @@ pub enum IntrTargetPriority {
impl IntrTargetPriority {
pub fn supported_number() -> usize {
2
2
}
}
@ -19,9 +19,7 @@ impl PLIC {
assert!(intr_source_id > 0 && intr_source_id <= 132);
(self.base_addr + intr_source_id * 4) as *mut u32
}
fn hart_id_with_priority(
hart_id: usize,
target_priority: IntrTargetPriority) -> usize {
fn hart_id_with_priority(hart_id: usize, target_priority: IntrTargetPriority) -> usize {
let priority_num = IntrTargetPriority::supported_number();
hart_id * priority_num + target_priority as usize
}
@ -31,13 +29,16 @@ impl PLIC {
target_priority: IntrTargetPriority,
intr_source_id: usize,
) -> (*mut u32, usize) {
let id = Self::hart_id_with_priority(hart_id, target_priority);
let id = Self::hart_id_with_priority(hart_id, target_priority);
let (reg_id, reg_shift) = (intr_source_id / 32, intr_source_id % 32);
((self.base_addr + 0x2000 + 0x80 * id + 0x4 * reg_id) as *mut u32, reg_shift)
(
(self.base_addr + 0x2000 + 0x80 * id + 0x4 * reg_id) as *mut u32,
reg_shift,
)
}
fn threshold_ptr_of_hart_with_priority(
&self,
hart_id: usize,
hart_id: usize,
target_priority: IntrTargetPriority,
) -> *mut u32 {
let id = Self::hart_id_with_priority(hart_id, target_priority);
@ -45,27 +46,23 @@ impl PLIC {
}
fn claim_comp_ptr_of_hart_with_priority(
&self,
hart_id: usize,
hart_id: usize,
target_priority: IntrTargetPriority,
) -> *mut u32 {
let id = Self::hart_id_with_priority(hart_id, target_priority);
(self.base_addr + 0x20_0004 + 0x1000 * id) as *mut u32
}
pub unsafe fn new(base_addr: usize) -> Self {
Self {
base_addr,
}
Self { base_addr }
}
pub fn set_priority(&mut self, intr_source_id: usize, priority: u32) {
assert!(priority < 8);
assert!(priority < 8);
unsafe {
self.priority_ptr(intr_source_id).write_volatile(priority);
}
}
pub fn get_priority(&mut self, intr_source_id: usize) -> u32 {
unsafe {
self.priority_ptr(intr_source_id).read_volatile() & 7
}
unsafe { self.priority_ptr(intr_source_id).read_volatile() & 7 }
}
pub fn enable(
&mut self,
@ -78,6 +75,7 @@ impl PLIC {
reg_ptr.write_volatile(reg_ptr.read_volatile() | 1 << shift);
}
}
#[allow(unused)]
pub fn disable(
&mut self,
hart_id: usize,
@ -86,7 +84,7 @@ impl PLIC {
) {
let (reg_ptr, shift) = self.enable_ptr(hart_id, target_priority, intr_source_id);
unsafe {
reg_ptr.write_volatile(reg_ptr.read_volatile() & (!(1u32 << shift)));
reg_ptr.write_volatile(reg_ptr.read_volatile() & (!(1u32 << shift)));
}
}
pub fn set_threshold(
@ -97,21 +95,15 @@ impl PLIC {
) {
assert!(threshold < 8);
let threshold_ptr = self.threshold_ptr_of_hart_with_priority(hart_id, target_priority);
unsafe { threshold_ptr.write_volatile(threshold); }
unsafe {
threshold_ptr.write_volatile(threshold);
}
}
pub fn get_threshold(
&mut self,
hart_id: usize,
target_priority: IntrTargetPriority,
) -> u32 {
pub fn get_threshold(&mut self, hart_id: usize, target_priority: IntrTargetPriority) -> u32 {
let threshold_ptr = self.threshold_ptr_of_hart_with_priority(hart_id, target_priority);
unsafe { threshold_ptr.read_volatile() & 7 }
}
pub fn claim(
&mut self,
hart_id: usize,
target_priority: IntrTargetPriority,
) -> u32 {
pub fn claim(&mut self, hart_id: usize, target_priority: IntrTargetPriority) -> u32 {
let claim_comp_ptr = self.claim_comp_ptr_of_hart_with_priority(hart_id, target_priority);
unsafe { claim_comp_ptr.read_volatile() }
}
@ -122,6 +114,8 @@ impl PLIC {
completion: u32,
) {
let claim_comp_ptr = self.claim_comp_ptr_of_hart_with_priority(hart_id, target_priority);
unsafe { claim_comp_ptr.write_volatile(completion); }
unsafe {
claim_comp_ptr.write_volatile(completion);
}
}
}