tof_control/tcpc_control/
tcpc_vcp.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
use crate::constant::*;
use crate::helper::tcpc_type::{TCPCVcp, TCPCVcpError};
use crate::device::ina219;

impl TCPCVcp {
    pub fn new() -> Self {
        match Self::read_vcp() {
            Ok(tcpc_vcp) => {
                tcpc_vcp
            }
            Err(_) => {
                Self {
                    tcpc_vcp: [f32::MAX; 3],
                }
            }
        }
    }
    pub fn read_vcp() -> Result<TCPCVcp, TCPCVcpError> {
        let tcpc_ina219 = ina219::INA219::new(1, TCPC_INA219_ADDRESS, TCPC_INA219_RSHUNT, TCPC_INA219_MEC);
        tcpc_ina219.configure()?;
        let tcpc_vcp = tcpc_ina219.read()?;

        Ok(
            TCPCVcp {
                tcpc_vcp,
            }
        )
    }
}