-
Notifications
You must be signed in to change notification settings - Fork 26
/
Copy pathport.rs
196 lines (163 loc) · 5.82 KB
/
port.rs
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
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
use core::fmt;
use crate::LineStsFlags;
/// A x86 I/O port-mapped UART.
#[cfg_attr(docsrs, doc(cfg(any(target_arch = "x86", target_arch = "x86_64"))))]
#[derive(Debug)]
pub struct SerialPort(u16 /* base port */);
impl SerialPort {
/// Base port.
fn port_base(&self) -> u16 {
self.0
}
/// Data port.
///
/// Read and write.
fn port_data(&self) -> u16 {
self.port_base()
}
/// Interrupt enable port.
///
/// Write only.
fn port_int_en(&self) -> u16 {
self.port_base() + 1
}
/// Fifo control port.
///
/// Write only.
fn port_fifo_ctrl(&self) -> u16 {
self.port_base() + 2
}
/// Line control port.
///
/// Write only.
fn port_line_ctrl(&self) -> u16 {
self.port_base() + 3
}
/// Modem control port.
///
/// Write only.
fn port_modem_ctrl(&self) -> u16 {
self.port_base() + 4
}
/// Line status port.
///
/// Read only.
fn port_line_sts(&self) -> u16 {
self.port_base() + 5
}
/// Creates a new serial port interface on the given I/O base port.
///
/// This function is unsafe because the caller must ensure that the given base address
/// really points to a serial port device and that the caller has the necessary rights
/// to perform the I/O operation.
pub const unsafe fn new(base: u16) -> Self {
Self(base)
}
/// Creates a new serial port interface on the given I/O base port and initializes it.
///
/// This function returns `Err(())` if the serial port fails a simple loopback test.
///
/// This function is unsafe because the caller must ensure that the given base address
/// really points to a serial port device and that the caller has the necessary rights
/// to perform the I/O operation.
pub unsafe fn try_create(base: u16) -> Result<Self, ()> {
let mut port = unsafe { Self::new(base) };
port.init();
port.loopback_test()?;
Ok(port)
}
/// Tests that the serial port is working.
///
/// This function temporarily sets the serial port into loopback mode and
/// performse a simple write and read, checking that the same
/// value is read. If not this function returns `Err(())`.
pub fn loopback_test(&mut self) -> Result<(), ()> {
unsafe {
// Disable interrupts
x86::io::outb(self.port_int_en(), 0x00);
// Set the serial port into loopback mode
x86::io::outb(self.port_modem_ctrl(), 0x1e);
// write `0xae` to the data port
x86::io::outb(self.port_data(), 0xae);
// read back the value we just wrote
let loopback = x86::io::inb(self.port_data());
if loopback != 0xae {
return Err(());
}
// Mark data terminal ready, signal request to send
// and enable auxilliary output #2 (used as interrupt line for CPU)
x86::io::outb(self.port_modem_ctrl(), 0x0b);
// Enable interrupts
x86::io::outb(self.port_int_en(), 0x01);
}
Ok(())
}
/// Initializes the serial port.
///
/// The default configuration of [38400/8-N-1](https://en.wikipedia.org/wiki/8-N-1) is used.
pub fn init(&mut self) {
unsafe {
// Disable interrupts
x86::io::outb(self.port_int_en(), 0x00);
// Enable DLAB
x86::io::outb(self.port_line_ctrl(), 0x80);
// Set maximum speed to 38400 bps by configuring DLL and DLM
x86::io::outb(self.port_data(), 0x03);
x86::io::outb(self.port_int_en(), 0x00);
// Disable DLAB and set data word length to 8 bits
x86::io::outb(self.port_line_ctrl(), 0x03);
// Enable FIFO, clear TX/RX queues and
// set interrupt watermark at 14 bytes
x86::io::outb(self.port_fifo_ctrl(), 0xc7);
// Mark data terminal ready, signal request to send
// and enable auxilliary output #2 (used as interrupt line for CPU)
x86::io::outb(self.port_modem_ctrl(), 0x0b);
// Enable interrupts
x86::io::outb(self.port_int_en(), 0x01);
}
}
fn line_sts(&mut self) -> LineStsFlags {
unsafe { LineStsFlags::from_bits_truncate(x86::io::inb(self.port_line_sts())) }
}
/// Sends a byte on the serial port.
pub fn send(&mut self, data: u8) {
unsafe {
match data {
8 | 0x7F => {
wait_for!(self.line_sts().contains(LineStsFlags::OUTPUT_EMPTY));
x86::io::outb(self.port_data(), 8);
wait_for!(self.line_sts().contains(LineStsFlags::OUTPUT_EMPTY));
x86::io::outb(self.port_data(), b' ');
wait_for!(self.line_sts().contains(LineStsFlags::OUTPUT_EMPTY));
x86::io::outb(self.port_data(), 8);
}
_ => {
wait_for!(self.line_sts().contains(LineStsFlags::OUTPUT_EMPTY));
x86::io::outb(self.port_data(), data);
}
}
}
}
/// Sends a raw byte on the serial port, intended for binary data.
pub fn send_raw(&mut self, data: u8) {
unsafe {
wait_for!(self.line_sts().contains(LineStsFlags::OUTPUT_EMPTY));
x86::io::outb(self.port_data(), data);
}
}
/// Receives a byte on the serial port.
pub fn receive(&mut self) -> u8 {
unsafe {
wait_for!(self.line_sts().contains(LineStsFlags::INPUT_FULL));
x86::io::inb(self.port_data())
}
}
}
impl fmt::Write for SerialPort {
fn write_str(&mut self, s: &str) -> fmt::Result {
for byte in s.bytes() {
self.send(byte);
}
Ok(())
}
}