tof_control/rb_control/
rb_ph.rs

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
use crate::constant::*;
use crate::helper::rb_type::{RBPh, RBError};
use crate::device::{bme280, pca9548a};

impl RBPh {
    pub fn new() -> Self {
        match Self::read_ph() {
            Ok(rb_ph) => {
                rb_ph
            }
            Err(_) => {
                Self {
                    pressure: f32::MAX,
                    humidity: f32::MAX,
                }
            }
        }
    }
    pub fn read_ph() -> Result<RBPh, RBError> {
        let i2c_mux = pca9548a::PCA9548A::new(I2C_BUS, RB_PCA9548A_ADDRESS_1);

        i2c_mux.select(RB_BME280_CHANNEL)?;
        let bme280 = bme280::BME280::new(I2C_BUS, RB_BME280_ADDRESS);
        bme280.configure()?;
        let ph = bme280.read()?;
        let pressure = ph[0];
        let humidity = ph[1];

        i2c_mux.reset()?;

        Ok(
            RBPh {
                pressure,
                humidity,
            }
        )
    }
}

pub fn config_ph() -> Result<(), RBError> {
    let i2c_mux = pca9548a::PCA9548A::new(I2C_BUS, RB_PCA9548A_ADDRESS_1);
    i2c_mux.select(RB_BME280_CHANNEL)?;
    let bme280 = bme280::BME280::new(I2C_BUS, RB_BME280_ADDRESS);
    bme280.configure()?;

    i2c_mux.reset()?;

    Ok(())
}