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
use crate::spi::{vdm_header, AccessMode};
use embedded_hal::digital::v2::OutputPin;
pub struct W5500<SPI, CS> {
spi: SPI,
cs: CS,
}
#[derive(Debug)]
pub enum Error<SpiError, PinError> {
Spi(SpiError),
Pin(PinError),
}
impl<SPI, CS, SpiError, PinError> W5500<SPI, CS>
where
SPI: embedded_hal::blocking::spi::Transfer<u8, Error = SpiError>
+ embedded_hal::blocking::spi::Write<u8, Error = SpiError>,
CS: OutputPin<Error = PinError>,
{
pub fn new(spi: SPI, cs: CS) -> Self {
W5500 { spi, cs }
}
pub fn free(self) -> (SPI, CS) {
(self.spi, self.cs)
}
#[inline(always)]
fn with_chip_enable<T, E, F>(&mut self, mut f: F) -> Result<T, E>
where
F: FnMut(&mut SPI) -> Result<T, E>,
E: core::convert::From<Error<SpiError, PinError>>,
{
self.cs.set_low().map_err(Error::Pin)?;
let result = f(&mut self.spi);
self.cs.set_high().map_err(Error::Pin)?;
result
}
}
impl<SPI, CS, SpiError, PinError> crate::Registers for W5500<SPI, CS>
where
SPI: embedded_hal::blocking::spi::Transfer<u8, Error = SpiError>
+ embedded_hal::blocking::spi::Write<u8, Error = SpiError>,
CS: OutputPin<Error = PinError>,
{
type Error = Error<SpiError, PinError>;
#[inline(always)]
fn read(&mut self, address: u16, block: u8, data: &mut [u8]) -> Result<(), Self::Error> {
let header = vdm_header(address, block, AccessMode::Read);
self.with_chip_enable(|spi| {
spi.write(&header).map_err(Error::Spi)?;
spi.transfer(data).map_err(Error::Spi)?;
Ok(())
})
}
#[inline(always)]
fn write(&mut self, address: u16, block: u8, data: &[u8]) -> Result<(), Self::Error> {
let header = vdm_header(address, block, AccessMode::Write);
self.with_chip_enable(|spi| {
spi.write(&header).map_err(Error::Spi)?;
spi.write(&data).map_err(Error::Spi)?;
Ok(())
})
}
}