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
use core::marker::PhantomData;
pub use crate::structures::port::PortReadWrite;
impl PortReadWrite for u8 {
#[inline]
unsafe fn read_from_port(port: u16) -> u8 {
let value: u8;
asm!("inb %dx, %al" : "={al}"(value) : "{dx}"(port) :: "volatile");
value
}
#[inline]
unsafe fn write_to_port(port: u16, value: u8) {
asm!("outb %al, %dx" :: "{dx}"(port), "{al}"(value) :: "volatile");
}
}
impl PortReadWrite for u16 {
#[inline]
unsafe fn read_from_port(port: u16) -> u16 {
let value: u16;
asm!("inw %dx, %ax" : "={ax}"(value) : "{dx}"(port) :: "volatile");
value
}
#[inline]
unsafe fn write_to_port(port: u16, value: u16) {
asm!("outw %ax, %dx" :: "{dx}"(port), "{ax}"(value) :: "volatile");
}
}
impl PortReadWrite for u32 {
#[inline]
unsafe fn read_from_port(port: u16) -> u32 {
let value: u32;
asm!("inl %dx, %eax" : "={eax}"(value) : "{dx}"(port) :: "volatile");
value
}
#[inline]
unsafe fn write_to_port(port: u16, value: u32) {
asm!("outl %eax, %dx" :: "{dx}"(port), "{eax}"(value) :: "volatile");
}
}
#[derive(Debug, Clone, PartialEq, Eq)]
pub struct Port<T: PortReadWrite> {
port: u16,
phantom: PhantomData<T>,
}
impl<T: PortReadWrite> Port<T> {
pub const fn new(port: u16) -> Port<T> {
Port {
port: port,
phantom: PhantomData,
}
}
#[inline]
pub unsafe fn read(&self) -> T {
T::read_from_port(self.port)
}
#[inline]
pub unsafe fn write(&mut self, value: T) {
T::write_to_port(self.port, value)
}
}