mirror of https://github.com/eldruin/ds323x-rs
104 lines
2.5 KiB
Rust
104 lines
2.5 KiB
Rust
|
//! I2C/SPI interfaces
|
||
|
|
||
|
#![deny(missing_docs)]
|
||
|
|
||
|
extern crate embedded_hal as hal;
|
||
|
use hal::blocking;
|
||
|
use super::{ DEVICE_ADDRESS, Error };
|
||
|
|
||
|
/// I2C interface
|
||
|
#[derive(Debug, Default)]
|
||
|
pub struct I2cInterface<I2C> {
|
||
|
pub(crate) i2c: I2C,
|
||
|
}
|
||
|
|
||
|
/// SPI interface
|
||
|
#[derive(Debug, Default)]
|
||
|
pub struct SpiInterface<SPI, CS> {
|
||
|
pub(crate) spi: SPI,
|
||
|
pub(crate) cs: CS
|
||
|
}
|
||
|
|
||
|
/// Write to a register
|
||
|
pub trait WriteRegister {
|
||
|
/// Error type
|
||
|
type Error;
|
||
|
/// Write to an u8 register
|
||
|
fn write_register(&mut self, register: u8, data: u8) -> Result<(), Error<Self::Error>>;
|
||
|
}
|
||
|
|
||
|
impl<I2C, E> WriteRegister for I2cInterface<I2C>
|
||
|
where
|
||
|
I2C: blocking::i2c::Write<Error = E>
|
||
|
{
|
||
|
type Error = E;
|
||
|
fn write_register(&mut self, register: u8, data: u8) -> Result<(), Error<E>> {
|
||
|
let payload: [u8; 2] = [register, data];
|
||
|
self.i2c
|
||
|
.write(DEVICE_ADDRESS, &payload)
|
||
|
.map_err(Error::Comm)
|
||
|
}
|
||
|
}
|
||
|
|
||
|
impl<SPI, CS, E> WriteRegister for SpiInterface<SPI, CS>
|
||
|
where
|
||
|
SPI: blocking::spi::Write<u8, Error = E>,
|
||
|
CS: hal::digital::OutputPin
|
||
|
{
|
||
|
type Error = E;
|
||
|
fn write_register(&mut self, register: u8, data: u8) -> Result<(), Error<E>> {
|
||
|
self.cs.set_low();
|
||
|
|
||
|
let payload: [u8; 2] = [register + 0x80, data];
|
||
|
let result = self.spi
|
||
|
.write(&payload)
|
||
|
.map_err(Error::Comm);
|
||
|
|
||
|
self.cs.set_high();
|
||
|
result
|
||
|
}
|
||
|
}
|
||
|
|
||
|
|
||
|
/// Read a register
|
||
|
pub trait ReadRegister {
|
||
|
/// Error type
|
||
|
type Error;
|
||
|
/// Read an u8 register
|
||
|
fn read_register(&mut self, register: u8) -> Result<u8, Error<Self::Error>>;
|
||
|
}
|
||
|
|
||
|
impl<I2C, E> ReadRegister for I2cInterface<I2C>
|
||
|
where
|
||
|
I2C: blocking::i2c::WriteRead<Error = E>
|
||
|
{
|
||
|
type Error = E;
|
||
|
fn read_register(&mut self, register: u8) -> Result<u8, Error<E>> {
|
||
|
let mut data = [0];
|
||
|
self.i2c
|
||
|
.write_read(DEVICE_ADDRESS, &[register], &mut data)
|
||
|
.map_err(Error::Comm)
|
||
|
.and(Ok(data[0]))
|
||
|
}
|
||
|
}
|
||
|
|
||
|
impl<SPI, CS, E> ReadRegister for SpiInterface<SPI, CS>
|
||
|
where
|
||
|
SPI: blocking::spi::Transfer<u8, Error = E>,
|
||
|
CS: hal::digital::OutputPin
|
||
|
{
|
||
|
type Error = E;
|
||
|
fn read_register(&mut self, register: u8) -> Result<u8, Error<E>> {
|
||
|
self.cs.set_low();
|
||
|
let mut data = [register, 0];
|
||
|
{
|
||
|
let result = self.spi
|
||
|
.transfer(&mut data)
|
||
|
.map_err(Error::Comm);
|
||
|
self.cs.set_high();
|
||
|
result?;
|
||
|
}
|
||
|
Ok(data[1])
|
||
|
}
|
||
|
}
|