sen6x-driver 0.0.3

embedded-hal driver for the sensirion sen6x sensors
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
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123

use crate::commands::CommandId;
use crate::connection::State;
use crate::io::{FromBytes, ToBytes};
use crate::types::Milliseconds;
use crate::{Sen6x, SensorConnectionSync, SensorState, errors};
use core::cell::RefCell;
use embedded_hal::delay::DelayNs;
use embedded_hal::i2c::{I2c, Operation};

impl<'a, I2C, D, E> SensorConnectionSync for Sen6x<'a, RefCell<&'a mut I2C>, D>
where
    I2C: I2c<Error = E>,
    D: DelayNs,
{
    type I2c = I2C;
    type Error = E;
    type Delay = D;

    fn transaction<R>(&self, f: impl FnOnce(&mut I2C) -> R) -> R {
        let mut i2c = self.i2c.borrow_mut();
        f(&mut i2c)
    }

    fn delay(&self, delay: Milliseconds) {
        self.delay.borrow_mut().delay_ms(delay as u32);
    }
}

impl<S, T> crate::connection::Sen6xConnection<S, T::Error> for T
where
    T: SensorConnectionSync + SensorState<T::Error>,
    S: crate::connection::SensorModel,
{
    fn send(
        &mut self,
        cmd: CommandId,
        execution_time: Milliseconds,
        valid_in: &[State],
    ) -> Result<(), crate::Error<T::Error>> {
        self.check_state(valid_in)?;
        let this = &*self;
        this.transaction(move |i2c| {
            i2c.write(S::I2C_ADDRESS, &(cmd as u16).to_be_bytes())
                .map_err(errors::Error::I2c)?;
            this.delay(execution_time);
            Ok(())
        })
    }

    fn write<const N: usize, Tx: ToBytes<N>>(
        &mut self,
        cmd: CommandId,
        execution_time: Milliseconds,
        data: Tx,
        valid_in: &[State],
    ) -> Result<(), crate::Error<T::Error>> {
        self.check_state(valid_in)?;
        let this = &*self;

        this.transaction(move |i2c| {
            i2c.transaction(
                S::I2C_ADDRESS,
                &mut [
                    Operation::Write(&(cmd as u16).to_be_bytes()),
                    Operation::Write(&data.to_bytes()),
                ],
            )
            .map_err(errors::Error::I2c)?;
            this.delay(execution_time);
            Ok(())
        })
    }

    fn read<const N: usize, Rx: FromBytes<N, Rx>>(
        &mut self,
        cmd: CommandId,
        execution_time: Milliseconds,
        valid_in: &[State],
    ) -> Result<Rx, crate::Error<T::Error>> {
        self.check_state(valid_in)?;
        let this = &*self;
        this.transaction(move |i2c| {
            i2c.write(S::I2C_ADDRESS, &(cmd as u16).to_be_bytes())
                .map_err(errors::Error::I2c)?;
            this.delay(execution_time);
            let mut buffer = [0u8; N];
            i2c.read(S::I2C_ADDRESS, &mut buffer)
                .map_err(errors::Error::I2c)?;
            Rx::from_bytes_with_crc(&buffer)
        })
    }

    fn fetch<const NT: usize, const NR: usize, Rx: FromBytes<NR, Rx>, Tx: ToBytes<NT>>(
        &mut self,
        cmd: CommandId,
        execution_time: Milliseconds,
        data: Tx,
        valid_in: &[State],
    ) -> Result<Rx, crate::Error<T::Error>> {
        self.check_state(valid_in)?;
        let this = &*self;

        this.transaction(move |i2c| {
            i2c.transaction(
                S::I2C_ADDRESS,
                &mut [
                    Operation::Write(&(cmd as u16).to_be_bytes()),
                    Operation::Write(&data.to_bytes()),
                ],
            )
            .map_err(errors::Error::I2c)?;
            this.delay(execution_time);
            let mut buffer = [0u8; NR];
            i2c.read(S::I2C_ADDRESS, &mut buffer)
                .map_err(errors::Error::I2c)?;
            Rx::from_bytes_with_crc(&buffer)
        })
    }

    fn update_state(&mut self, state: State) {
        *self.state() = state;
    }
}