1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
|
//! Generic register access.
use core::marker::PhantomData;
use vcell::VolatileCell;
pub trait Readable {}
pub trait Writable {}
pub struct Register<T, Reg> {
value: VolatileCell<T>,
_marker: PhantomData<Reg>,
}
impl<T, Reg> From<T> for Register<T, Reg> {
fn from(v: T) -> Self {
Self {
value: VolatileCell::new(v),
_marker: PhantomData,
}
}
}
impl<T, Reg> Register<T, Reg>
where
Self: Readable,
T: Copy,
{
pub fn read(&self) -> R<T, Self> {
R {
bits: self.value.get(),
_marker: PhantomData,
}
}
}
impl<T, Reg> Register<T, Reg>
where
Self: Readable + Writable,
T: Copy,
{
pub fn write<F>(&self, f: F)
where
F: FnOnce(&mut W<T, Self>) -> &mut W<T, Self>,
{
let mut w = W {
bits: self.value.get(),
_marker: PhantomData,
};
self.value.set(f(&mut w).bits);
}
pub fn modify<F>(&self, f: F)
where
F: FnOnce(T, &mut W<T, Self>) -> &mut W<T, Self>,
{
let mut w = W {
bits: self.value.get(),
_marker: PhantomData,
};
self.value.set(f(w.bits, &mut w).bits);
}
}
pub struct R<T, Reg> {
pub bits: T,
_marker: PhantomData<Reg>,
}
impl<T, Reg> R<T, Reg>
where
T: Copy,
{
pub fn new(bits: T) -> Self {
Self {
bits,
_marker: PhantomData,
}
}
pub fn bits(&self) -> T {
self.bits
}
}
pub struct W<T, Reg> {
pub bits: T,
_marker: PhantomData<Reg>,
}
impl<T, Reg> W<T, Reg> {
pub unsafe fn bits(&mut self, bits: T) -> &mut Self {
self.bits = bits;
self
}
}
|