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


extern crate cast;
extern crate embedded_hal as hal;

use core::mem;

use {SerialWrite, SerialRead, Register};
use hal::blocking::i2c::{Write, WriteRead};
use self::cast::{u16, u32};

pub struct AutoIncrementI2c;

impl<T, R> SerialWrite<AutoIncrementI2c, R> for T
where
    T : Write,
    R : Register,
{

    fn write_u8(&mut self, addr: u8, reg: R, data: u8) -> Result<(), Self::Error> {
        self.write(addr, &[reg.addr(), data])
    }

    fn write_le_u16(&mut self, addr: u8, reg: R, data: u16) -> Result<(), Self::Error> {
        self.write(addr, &[reg.addr(), (data & 0xFF) as u8, (data >> 8) as u8])
    }

    fn write_be_u16(&mut self, addr: u8, reg: R, data: u16) -> Result<(), Self::Error> {
        self.write(addr, &[reg.addr(), (data >> 8) as u8, (data & 0xFF) as u8])
    }

    fn write_le_u32(&mut self, addr: u8, reg: R, data: u32) -> Result<(), Self::Error> {
        self.write(addr, &[reg.addr(), ((data >> 24) & 0xFF) as u8, ((data >> 16) & 0xFF) as u8, ((data >> 8) & 0xFF) as u8, (data & 0xFF) as u8])
    }

    fn write_be_u32(&mut self, addr: u8, reg: R, data: u32) -> Result<(), Self::Error> {
        self.write(addr, &[reg.addr(), (data & 0xFF) as u8, ((data >> 8) & 0xFF) as u8, ((data >> 16) & 0xFF) as u8, ((data >> 24) & 0xFF) as u8])
    }
}

impl<T, R> SerialRead<AutoIncrementI2c, R> for T
where
    T : WriteRead,
    R : Register,
{
    fn read_le_u16(&mut self, addr: u8, reg: R) -> Result<u16, Self::Error> {
        let mut buffer: [u8; 2] = unsafe { mem::uninitialized() };
        self.write_read(addr, &[reg.addr()], &mut buffer)?;
        Ok((u16(buffer[1]) << 8) | u16(buffer[0]))
    }

    fn read_be_u16(&mut self, addr: u8, reg: R) -> Result<u16, Self::Error> {
        let mut buffer: [u8; 2] = unsafe { mem::uninitialized() };
        self.write_read(addr, &[reg.addr()], &mut buffer)?;
        Ok((u16(buffer[0]) << 8) | u16(buffer[1]))
    }

    fn read_le_u24(&mut self, addr: u8, reg: R) -> Result<u32, Self::Error> {
        let mut buffer: [u8; 3] = unsafe { mem::uninitialized() };
        self.write_read(addr, &[reg.addr()], &mut buffer)?;
        Ok((u32(buffer[2]) << 16) | (u32(buffer[1]) << 8) | u32(buffer[0]))
    }

    fn read_be_u24(&mut self, addr: u8, reg: R) -> Result<u32, Self::Error> {
        let mut buffer: [u8; 3] = unsafe { mem::uninitialized() };
        self.write_read(addr, &[reg.addr()], &mut buffer)?;
        Ok((u32(buffer[0]) << 16) | (u32(buffer[1]) << 8) | u32(buffer[2]))
    }

    fn read_le_u32(&mut self, addr: u8, reg: R) -> Result<u32, Self::Error> {
        let mut buffer: [u8; 4] = unsafe { mem::uninitialized() };
        self.write_read(addr, &[reg.addr()], &mut buffer)?;
        Ok((u32(buffer[3]) << 24) | (u32(buffer[2]) << 16) | (u32(buffer[1]) << 8) | u32(buffer[0]))
    }

    fn read_be_u32(&mut self, addr: u8, reg: R) -> Result<u32, Self::Error> {
        let mut buffer: [u8; 4] = unsafe { mem::uninitialized() };
        self.write_read(addr, &[reg.addr()], &mut buffer)?;
        Ok((u32(buffer[0]) << 24) | (u32(buffer[1]) << 16) | (u32(buffer[2]) << 8) | u32(buffer[3]))
    }
}