/
rw.rs
58 lines (47 loc) · 1.59 KB
/
rw.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
use embedded_hal::blocking::spi::{Operation, Transactional, Transfer, Write};
use crate::registers::Registers;
pub trait ReadWrite {
type Error;
/// Direct write to RFM69 registers.
fn write_many(&mut self, reg: Registers, data: &[u8]) -> core::result::Result<(), Self::Error>;
/// Direct read from RFM69 registers.
fn read_many(
&mut self,
reg: Registers,
buffer: &mut [u8],
) -> core::result::Result<(), Self::Error>;
}
pub struct SpiTransactional<S>(pub(crate) S);
impl<S, E> ReadWrite for SpiTransactional<S>
where
S: Transactional<u8, Error = E>,
{
type Error = E;
fn write_many(&mut self, reg: Registers, data: &[u8]) -> core::result::Result<(), E> {
let write = [reg.write()];
let mut operations = [Operation::Write(&write), Operation::Write(data)];
self.0.exec(&mut operations)
}
fn read_many(&mut self, reg: Registers, buffer: &mut [u8]) -> core::result::Result<(), E> {
let read = [reg.read()];
let mut operations = [Operation::Write(&read), Operation::Transfer(buffer)];
self.0.exec(&mut operations)
}
}
impl<S, E> ReadWrite for S
where
S: Transfer<u8, Error = E>,
S: Write<u8, Error = E>,
{
type Error = E;
fn write_many(&mut self, reg: Registers, data: &[u8]) -> core::result::Result<(), E> {
self.write(&[reg.write()])?;
self.write(data)?;
Ok(())
}
fn read_many(&mut self, reg: Registers, buffer: &mut [u8]) -> core::result::Result<(), E> {
self.write(&[reg.read()])?;
self.transfer(buffer)?;
Ok(())
}
}