|
2 | 2 |
|
3 | 3 | use crate::result::{Error, Result};
|
4 | 4 |
|
5 |
| -/// satp register |
6 |
| -#[derive(Clone, Copy, Debug)] |
7 |
| -pub struct Satp { |
8 |
| - bits: usize, |
| 5 | +read_write_csr! { |
| 6 | + /// `satp` register |
| 7 | + Satp: 0x180, |
| 8 | + mask: usize::MAX, |
9 | 9 | }
|
10 | 10 |
|
11 |
| -impl Satp { |
12 |
| - /// Returns the contents of the register as raw bits |
13 |
| - #[inline] |
14 |
| - pub fn bits(&self) -> usize { |
15 |
| - self.bits |
16 |
| - } |
17 |
| - |
18 |
| - /// Current address-translation scheme |
19 |
| - /// |
20 |
| - /// **WARNING**: panics if the field has an invalid variant. |
21 |
| - #[inline] |
22 |
| - #[cfg(target_pointer_width = "32")] |
23 |
| - pub fn mode(&self) -> Mode { |
24 |
| - self.try_mode().unwrap() |
25 |
| - } |
26 |
| - |
27 |
| - /// Attempts to get the current address-translation scheme. |
28 |
| - #[inline] |
29 |
| - #[cfg(target_pointer_width = "32")] |
30 |
| - pub fn try_mode(&self) -> Result<Mode> { |
31 |
| - ((self.bits >> 31) as u8).try_into() |
32 |
| - } |
33 |
| - |
34 |
| - /// Current address-translation scheme |
35 |
| - /// |
36 |
| - /// **WARNING**: panics if the field has an invalid variant. |
37 |
| - #[inline] |
38 |
| - #[cfg(target_pointer_width = "64")] |
39 |
| - pub fn mode(&self) -> Mode { |
40 |
| - self.try_mode().unwrap() |
41 |
| - } |
42 |
| - |
43 |
| - /// Attempts to get the current address-translation scheme. |
44 |
| - #[inline] |
45 |
| - #[cfg(target_pointer_width = "64")] |
46 |
| - pub fn try_mode(&self) -> Result<Mode> { |
47 |
| - ((self.bits >> 60) as u8).try_into() |
48 |
| - } |
49 |
| - |
50 |
| - /// Address space identifier |
51 |
| - #[inline] |
52 |
| - #[cfg(target_pointer_width = "32")] |
53 |
| - pub fn asid(&self) -> usize { |
54 |
| - (self.bits >> 22) & 0x1FF // bits 22-30 |
| 11 | +#[cfg(target_pointer_width = "32")] |
| 12 | +csr_field_enum! { |
| 13 | + /// 32-bit satp mode |
| 14 | + Mode { |
| 15 | + default: Bare, |
| 16 | + /// No translation or protection |
| 17 | + Bare = 0, |
| 18 | + /// Page-based 32-bit virtual addressing |
| 19 | + Sv32 = 1, |
55 | 20 | }
|
| 21 | +} |
56 | 22 |
|
57 |
| - /// Address space identifier |
58 |
| - #[inline] |
59 |
| - #[cfg(target_pointer_width = "64")] |
60 |
| - pub fn asid(&self) -> usize { |
61 |
| - (self.bits >> 44) & 0xFFFF // bits 44-59 |
| 23 | +#[cfg(target_pointer_width = "64")] |
| 24 | +csr_field_enum! { |
| 25 | + /// 64-bit satp mode |
| 26 | + Mode { |
| 27 | + default: Bare, |
| 28 | + /// No translation or protection |
| 29 | + Bare = 0, |
| 30 | + /// Page-based 39-bit virtual addressing |
| 31 | + Sv39 = 8, |
| 32 | + /// Page-based 48-bit virtual addressing |
| 33 | + Sv48 = 9, |
| 34 | + /// Page-based 57-bit virtual addressing |
| 35 | + Sv57 = 10, |
| 36 | + /// Page-based 64-bit virtual addressing |
| 37 | + Sv64 = 11, |
62 | 38 | }
|
| 39 | +} |
63 | 40 |
|
| 41 | +#[cfg(target_pointer_width = "32")] |
| 42 | +read_write_csr_field! { |
| 43 | + Satp, |
64 | 44 | /// Physical page number
|
65 |
| - #[inline] |
66 |
| - #[cfg(target_pointer_width = "32")] |
67 |
| - pub fn ppn(&self) -> usize { |
68 |
| - self.bits & 0x3F_FFFF // bits 0-21 |
69 |
| - } |
| 45 | + ppn: [0:21], |
| 46 | +} |
70 | 47 |
|
| 48 | +#[cfg(target_pointer_width = "64")] |
| 49 | +read_write_csr_field! { |
| 50 | + Satp, |
71 | 51 | /// Physical page number
|
72 |
| - #[inline] |
73 |
| - #[cfg(target_pointer_width = "64")] |
74 |
| - pub fn ppn(&self) -> usize { |
75 |
| - self.bits & 0xFFF_FFFF_FFFF // bits 0-43 |
76 |
| - } |
| 52 | + ppn: [0:43], |
77 | 53 | }
|
78 | 54 |
|
79 |
| -/// 32-bit satp mode |
80 | 55 | #[cfg(target_pointer_width = "32")]
|
81 |
| -#[derive(Clone, Copy, Debug, Eq, PartialEq)] |
82 |
| -pub enum Mode { |
83 |
| - /// No translation or protection |
84 |
| - Bare = 0, |
85 |
| - /// Page-based 32-bit virtual addressing |
86 |
| - Sv32 = 1, |
| 56 | +read_write_csr_field! { |
| 57 | + Satp, |
| 58 | + /// Address space identifier |
| 59 | + asid: [22:30], |
87 | 60 | }
|
88 | 61 |
|
89 |
| -/// 64-bit satp mode |
90 | 62 | #[cfg(target_pointer_width = "64")]
|
91 |
| -#[derive(Clone, Copy, Debug, Eq, PartialEq)] |
92 |
| -pub enum Mode { |
93 |
| - /// No translation or protection |
94 |
| - Bare = 0, |
95 |
| - /// Page-based 39-bit virtual addressing |
96 |
| - Sv39 = 8, |
97 |
| - /// Page-based 48-bit virtual addressing |
98 |
| - Sv48 = 9, |
99 |
| - /// Page-based 57-bit virtual addressing |
100 |
| - Sv57 = 10, |
101 |
| - /// Page-based 64-bit virtual addressing |
102 |
| - Sv64 = 11, |
| 63 | +read_write_csr_field! { |
| 64 | + Satp, |
| 65 | + /// Address space identifier |
| 66 | + asid: [44:59], |
103 | 67 | }
|
104 | 68 |
|
105 | 69 | #[cfg(target_pointer_width = "32")]
|
106 |
| -impl TryFrom<u8> for Mode { |
107 |
| - type Error = Error; |
108 |
| - |
109 |
| - fn try_from(val: u8) -> Result<Self> { |
110 |
| - match val { |
111 |
| - 0 => Ok(Mode::Bare), |
112 |
| - 1 => Ok(Mode::Sv32), |
113 |
| - _ => Err(Error::InvalidFieldVariant { |
114 |
| - field: "mode", |
115 |
| - value: val as usize, |
116 |
| - }), |
117 |
| - } |
118 |
| - } |
| 70 | +read_write_csr_field! { |
| 71 | + Satp, |
| 72 | + /// Current address-translation scheme. |
| 73 | + mode, |
| 74 | + Mode: [31:31], |
119 | 75 | }
|
120 | 76 |
|
121 | 77 | #[cfg(target_pointer_width = "64")]
|
122 |
| -impl TryFrom<u8> for Mode { |
123 |
| - type Error = Error; |
124 |
| - |
125 |
| - fn try_from(val: u8) -> Result<Self> { |
126 |
| - match val { |
127 |
| - 0 => Ok(Mode::Bare), |
128 |
| - 8 => Ok(Mode::Sv39), |
129 |
| - 9 => Ok(Mode::Sv48), |
130 |
| - 10 => Ok(Mode::Sv57), |
131 |
| - 11 => Ok(Mode::Sv64), |
132 |
| - _ => Err(Error::InvalidFieldVariant { |
133 |
| - field: "mode", |
134 |
| - value: val as usize, |
135 |
| - }), |
136 |
| - } |
137 |
| - } |
| 78 | +read_write_csr_field! { |
| 79 | + Satp, |
| 80 | + /// Current address-translation scheme. |
| 81 | + mode, |
| 82 | + Mode: [60:63], |
138 | 83 | }
|
139 | 84 |
|
140 |
| -read_csr_as!(Satp, 0x180); |
141 |
| -write_csr_as_usize!(0x180); |
142 |
| - |
143 | 85 | /// Sets the register to corresponding page table mode, physical page number and address space id.
|
144 | 86 | ///
|
145 | 87 | /// **WARNING**: panics on:
|
@@ -207,3 +149,77 @@ pub unsafe fn try_set(mode: Mode, asid: usize, ppn: usize) -> Result<()> {
|
207 | 149 | _try_write(bits)
|
208 | 150 | }
|
209 | 151 | }
|
| 152 | + |
| 153 | +#[cfg(test)] |
| 154 | +mod tests { |
| 155 | + use super::*; |
| 156 | + |
| 157 | + #[cfg(target_pointer_width = "32")] |
| 158 | + const ASID_START: usize = 22; |
| 159 | + #[cfg(target_pointer_width = "64")] |
| 160 | + const ASID_START: usize = 44; |
| 161 | + #[cfg(target_pointer_width = "32")] |
| 162 | + const MODE_START: usize = 31; |
| 163 | + #[cfg(target_pointer_width = "64")] |
| 164 | + const MODE_START: usize = 60; |
| 165 | + |
| 166 | + #[cfg(target_pointer_width = "32")] |
| 167 | + const MODES: [Mode; 2] = [Mode::Bare, Mode::Sv32]; |
| 168 | + #[cfg(target_pointer_width = "64")] |
| 169 | + const MODES: [Mode; 5] = [Mode::Bare, Mode::Sv39, Mode::Sv48, Mode::Sv57, Mode::Sv64]; |
| 170 | + |
| 171 | + #[test] |
| 172 | + fn test_satp() { |
| 173 | + let new_mode = Mode::new(); |
| 174 | + |
| 175 | + (1..=usize::BITS) |
| 176 | + .map(|r| ((1u128 << r) - 1) as usize) |
| 177 | + .for_each(|raw| { |
| 178 | + let mut satp = Satp::from_bits(raw); |
| 179 | + |
| 180 | + let exp_ppn = raw & ((1usize << ASID_START) - 1); |
| 181 | + let exp_asid = (raw & ((1usize << MODE_START) - 1)) >> ASID_START; |
| 182 | + |
| 183 | + assert_eq!(satp.ppn(), exp_ppn); |
| 184 | + |
| 185 | + satp.set_ppn(0); |
| 186 | + assert_eq!(satp.ppn(), 0); |
| 187 | + |
| 188 | + satp.set_ppn(exp_ppn); |
| 189 | + assert_eq!(satp.ppn(), exp_ppn); |
| 190 | + |
| 191 | + assert_eq!(satp.asid(), exp_asid); |
| 192 | + |
| 193 | + satp.set_asid(0); |
| 194 | + assert_eq!(satp.asid(), 0); |
| 195 | + |
| 196 | + satp.set_asid(exp_asid); |
| 197 | + assert_eq!(satp.asid(), exp_asid); |
| 198 | + |
| 199 | + match Mode::from_usize(raw >> 60) { |
| 200 | + Ok(exp_mode) => { |
| 201 | + assert_eq!(satp.try_mode(), Ok(exp_mode)); |
| 202 | + assert_eq!(satp.mode(), exp_mode); |
| 203 | + |
| 204 | + satp.set_mode(new_mode); |
| 205 | + |
| 206 | + assert_eq!(satp.try_mode(), Ok(new_mode)); |
| 207 | + assert_eq!(satp.mode(), new_mode); |
| 208 | + |
| 209 | + satp.set_mode(exp_mode); |
| 210 | + |
| 211 | + assert_eq!(satp.try_mode(), Ok(exp_mode)); |
| 212 | + assert_eq!(satp.mode(), exp_mode); |
| 213 | + } |
| 214 | + Err(exp_err) => { |
| 215 | + assert_eq!(satp.try_mode(), Err(exp_err)); |
| 216 | + } |
| 217 | + } |
| 218 | + }); |
| 219 | + |
| 220 | + let mut satp = Satp::from_bits(0); |
| 221 | + MODES |
| 222 | + .into_iter() |
| 223 | + .for_each(|mode| test_csr_field!(satp, mode: mode)); |
| 224 | + } |
| 225 | +} |
0 commit comments