i2c_hal_tools/
noincrement.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 NoIncrementI2c;
12
13
14impl<T, R> SerialWrite<NoIncrementI2c, R> for T
15where
16    T : Write,
17    R : Register,
18{
19
20    fn write_le_u16(&mut self, addr: u8, reg: R, data: u16) -> Result<(), Self::Error> {
21        self.write(addr, &[reg.addr(), (data & 0xFF) as u8])?;
22        self.write(addr, &[reg.addr() + 1, (data >> 8) as u8])
23    }
24
25    fn write_be_u16(&mut self, addr: u8, reg: R, data: u16) -> Result<(), Self::Error> {
26        self.write(addr, &[reg.addr(), (data >> 8) as u8])?;
27        self.write(addr, &[reg.addr() + 1, (data & 0xFF) as u8])
28    }
29
30    fn write_le_u32(&mut self, addr: u8, reg: R, data: u32) -> Result<(), Self::Error> {
31        self.write(addr, &[reg.addr(), ((data >> 24) & 0xFF) as u8])?;
32        self.write(addr, &[reg.addr() + 1, ((data >> 16) & 0xFF) as u8])?;
33        self.write(addr, &[reg.addr() + 2, ((data >> 8) & 0xFF) as u8])?;
34        self.write(addr, &[reg.addr() + 3, (data & 0xFF) as u8])
35    }
36
37    fn write_be_u32(&mut self, addr: u8, reg: R, data: u32) -> Result<(), Self::Error> {
38        self.write(addr, &[reg.addr(), (data & 0xFF) as u8])?;
39        self.write(addr, &[reg.addr() + 1, ((data >> 8) & 0xFF) as u8])?;
40        self.write(addr, &[reg.addr() + 2, ((data >> 16) & 0xFF) as u8])?;
41        self.write(addr, &[reg.addr() + 3, ((data >> 24) & 0xFF) as u8])
42    }
43}
44
45impl<T, R> SerialRead<NoIncrementI2c, R> for T
46where
47    T : WriteRead,
48    R : Register,
49{
50    fn read_le_u16(&mut self, addr: u8, reg: R) -> Result<u16, Self::Error> {
51        let mut buffer: [u8; 2] = unsafe { mem::uninitialized() };
52        self.write_read(addr, &[reg.addr()], &mut buffer[..1])?;
53        self.write_read(addr, &[reg.addr() + 1], &mut buffer[1..])?;
54        Ok((u16(buffer[1]) << 8) | u16(buffer[0]))
55    }
56
57    fn read_be_u16(&mut self, addr: u8, reg: R) -> Result<u16, Self::Error> {
58        let mut buffer: [u8; 2] = unsafe { mem::uninitialized() };
59        self.write_read(addr, &[reg.addr()], &mut buffer[..1])?;
60        self.write_read(addr, &[reg.addr() + 1], &mut buffer[1..])?;
61        Ok((u16(buffer[0]) << 8) | u16(buffer[1]))
62    }
63
64    fn read_le_u24(&mut self, addr: u8, reg: R) -> Result<u32, Self::Error> {
65        let mut buffer: [u8; 3] = unsafe { mem::uninitialized() };
66        self.write_read(addr, &[reg.addr()], &mut buffer[0..1])?;
67        self.write_read(addr, &[reg.addr() + 1], &mut buffer[1..2])?;
68        self.write_read(addr, &[reg.addr() + 2], &mut buffer[2..3])?;
69        Ok((u32(buffer[2]) << 16) | (u32(buffer[1]) << 8) | u32(buffer[0]))
70    }
71
72    fn read_be_u24(&mut self, addr: u8, reg: R) -> Result<u32, Self::Error> {
73        let mut buffer: [u8; 3] = unsafe { mem::uninitialized() };
74        self.write_read(addr, &[reg.addr()], &mut buffer[0..1])?;
75        self.write_read(addr, &[reg.addr() + 1], &mut buffer[1..2])?;
76        self.write_read(addr, &[reg.addr() + 2], &mut buffer[2..3])?;
77        Ok((u32(buffer[0]) << 16) | (u32(buffer[1]) << 8) | u32(buffer[2]))
78    }
79
80    fn read_le_u32(&mut self, addr: u8, reg: R) -> Result<u32, Self::Error> {
81        let mut buffer: [u8; 4] = unsafe { mem::uninitialized() };
82        self.write_read(addr, &[reg.addr()], &mut buffer[0..1])?;
83        self.write_read(addr, &[reg.addr() + 1], &mut buffer[1..2])?;
84        self.write_read(addr, &[reg.addr() + 2], &mut buffer[2..3])?;
85        self.write_read(addr, &[reg.addr() + 3], &mut buffer[3..])?;
86        Ok((u32(buffer[3]) << 24) | (u32(buffer[2]) << 16) | (u32(buffer[1]) << 8) | u32(buffer[0]))
87    }
88
89    fn read_be_u32(&mut self, addr: u8, reg: R) -> Result<u32, Self::Error> {
90        let mut buffer: [u8; 4] = unsafe { mem::uninitialized() };
91        self.write_read(addr, &[reg.addr()], &mut buffer[0..1])?;
92        self.write_read(addr, &[reg.addr() + 1], &mut buffer[1..2])?;
93        self.write_read(addr, &[reg.addr() + 2], &mut buffer[2..3])?;
94        self.write_read(addr, &[reg.addr() + 3], &mut buffer[3..])?;
95        Ok((u32(buffer[0]) << 24) | (u32(buffer[1]) << 16) | (u32(buffer[2]) << 8) | u32(buffer[3]))
96    }
97}
i2c_hal_tools/noincrement.rs

i2c_hal_tools/
noincrement.rs
