i2c_hal_tools/
autoincrement.rs

1
2extern crate cast;
3extern crate embedded_hal as hal;
4
5use core::mem;
6
7use {SerialWrite, SerialRead, Register};
8use hal::blocking::i2c::{Write, WriteRead};
9use self::cast::{u16, u32};
10
11pub struct AutoIncrementI2c;
12
13impl<T, R> SerialWrite<AutoIncrementI2c, R> for T
14where
15    T : Write,
16    R : Register,
17{
18
19    fn write_u8(&mut self, addr: u8, reg: R, data: u8) -> Result<(), Self::Error> {
20        self.write(addr, &[reg.addr(), data])
21    }
22
23    fn write_le_u16(&mut self, addr: u8, reg: R, data: u16) -> Result<(), Self::Error> {
24        self.write(addr, &[reg.addr(), (data & 0xFF) as u8, (data >> 8) as u8])
25    }
26
27    fn write_be_u16(&mut self, addr: u8, reg: R, data: u16) -> Result<(), Self::Error> {
28        self.write(addr, &[reg.addr(), (data >> 8) as u8, (data & 0xFF) as u8])
29    }
30
31    fn write_le_u32(&mut self, addr: u8, reg: R, data: u32) -> Result<(), Self::Error> {
32        self.write(addr, &[reg.addr(), ((data >> 24) & 0xFF) as u8, ((data >> 16) & 0xFF) as u8, ((data >> 8) & 0xFF) as u8, (data & 0xFF) as u8])
33    }
34
35    fn write_be_u32(&mut self, addr: u8, reg: R, data: u32) -> Result<(), Self::Error> {
36        self.write(addr, &[reg.addr(), (data & 0xFF) as u8, ((data >> 8) & 0xFF) as u8, ((data >> 16) & 0xFF) as u8, ((data >> 24) & 0xFF) as u8])
37    }
38}
39
40impl<T, R> SerialRead<AutoIncrementI2c, R> for T
41where
42    T : WriteRead,
43    R : Register,
44{
45    fn read_le_u16(&mut self, addr: u8, reg: R) -> Result<u16, Self::Error> {
46        let mut buffer: [u8; 2] = unsafe { mem::uninitialized() };
47        self.write_read(addr, &[reg.addr()], &mut buffer)?;
48        Ok((u16(buffer[1]) << 8) | u16(buffer[0]))
49    }
50
51    fn read_be_u16(&mut self, addr: u8, reg: R) -> Result<u16, Self::Error> {
52        let mut buffer: [u8; 2] = unsafe { mem::uninitialized() };
53        self.write_read(addr, &[reg.addr()], &mut buffer)?;
54        Ok((u16(buffer[0]) << 8) | u16(buffer[1]))
55    }
56
57    fn read_le_u24(&mut self, addr: u8, reg: R) -> Result<u32, Self::Error> {
58        let mut buffer: [u8; 3] = unsafe { mem::uninitialized() };
59        self.write_read(addr, &[reg.addr()], &mut buffer)?;
60        Ok((u32(buffer[2]) << 16) | (u32(buffer[1]) << 8) | u32(buffer[0]))
61    }
62
63    fn read_be_u24(&mut self, addr: u8, reg: R) -> Result<u32, Self::Error> {
64        let mut buffer: [u8; 3] = unsafe { mem::uninitialized() };
65        self.write_read(addr, &[reg.addr()], &mut buffer)?;
66        Ok((u32(buffer[0]) << 16) | (u32(buffer[1]) << 8) | u32(buffer[2]))
67    }
68
69    fn read_le_u32(&mut self, addr: u8, reg: R) -> Result<u32, Self::Error> {
70        let mut buffer: [u8; 4] = unsafe { mem::uninitialized() };
71        self.write_read(addr, &[reg.addr()], &mut buffer)?;
72        Ok((u32(buffer[3]) << 24) | (u32(buffer[2]) << 16) | (u32(buffer[1]) << 8) | u32(buffer[0]))
73    }
74
75    fn read_be_u32(&mut self, addr: u8, reg: R) -> Result<u32, Self::Error> {
76        let mut buffer: [u8; 4] = unsafe { mem::uninitialized() };
77        self.write_read(addr, &[reg.addr()], &mut buffer)?;
78        Ok((u32(buffer[0]) << 24) | (u32(buffer[1]) << 16) | (u32(buffer[2]) << 8) | u32(buffer[3]))
79    }
80}
i2c_hal_tools/autoincrement.rs

i2c_hal_tools/
autoincrement.rs
