-
Notifications
You must be signed in to change notification settings - Fork 11
/
serial.rs
107 lines (97 loc) · 2.65 KB
/
serial.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
//! Serial communication (USART)
//!
//! This implementation consumes the following hardware resources:
//! - Periodic timer to mark clock cycles
//! - Output GPIO pin for transmission (TX)
//! - Input GPIO pin for reception (RX)
//!
//! The timer must be configured to twice the desired communication frequency.
//!
use embedded_hal::digital::v2::{InputPin, OutputPin};
use embedded_hal::serial;
use embedded_hal::timer::{CountDown, Periodic};
use nb::block;
/// Serial communication error type
#[derive(Debug)]
pub enum Error<E> {
/// Bus error
Bus(E),
}
/// Bit banging serial communication (USART) device
pub struct Serial<TX, RX, Timer>
where
TX: OutputPin,
RX: InputPin,
Timer: CountDown + Periodic,
{
tx: TX,
rx: RX,
timer: Timer,
}
impl<TX, RX, Timer, E> Serial<TX, RX, Timer>
where
TX: OutputPin<Error = E>,
RX: InputPin<Error = E>,
Timer: CountDown + Periodic,
{
/// Create instance
pub fn new(tx: TX, rx: RX, timer: Timer) -> Self {
Serial { tx, rx, timer }
}
#[inline]
fn wait_for_timer(&mut self) {
block!(self.timer.wait()).ok();
}
}
impl<TX, RX, Timer, E> serial::Write<u8> for Serial<TX, RX, Timer>
where
TX: OutputPin<Error = E>,
RX: InputPin<Error = E>,
Timer: CountDown + Periodic,
{
type Error = crate::serial::Error<E>;
fn write(&mut self, byte: u8) -> nb::Result<(), Self::Error> {
let mut data_out = byte;
self.tx.set_low().map_err(Error::Bus)?; // start bit
self.wait_for_timer();
for _bit in 0..8 {
if data_out & 1 == 1 {
self.tx.set_high().map_err(Error::Bus)?;
} else {
self.tx.set_low().map_err(Error::Bus)?;
}
data_out >>= 1;
self.wait_for_timer();
}
self.tx.set_high().map_err(Error::Bus)?; // stop bit
self.wait_for_timer();
Ok(())
}
fn flush(&mut self) -> nb::Result<(), Self::Error> {
Ok(())
}
}
impl<TX, RX, Timer, E> serial::Read<u8> for Serial<TX, RX, Timer>
where
TX: OutputPin<Error = E>,
RX: InputPin<Error = E>,
Timer: CountDown + Periodic,
{
type Error = crate::serial::Error<E>;
fn read(&mut self) -> nb::Result<u8, Self::Error> {
let mut data_in = 0;
// wait for start bit
while self.rx.is_high().map_err(Error::Bus)? {}
self.wait_for_timer();
for _bit in 0..8 {
data_in <<= 1;
if self.rx.is_high().map_err(Error::Bus)? {
data_in |= 1
}
self.wait_for_timer();
}
// wait for stop bit
self.wait_for_timer();
Ok(data_in)
}
}