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
|
//! Common functions
use crate::{devices::OperatingMode, Ads1x1x, BitFlags, Config, Error, Register};
impl<I2C, IC, CONV, MODE, E> Ads1x1x<I2C, IC, CONV, MODE>
where
I2C: embedded_hal::i2c::I2c<Error = E>,
{
pub(super) fn write_register(&mut self, register: u8, data: u16) -> Result<(), Error<E>> {
let data = data.to_be_bytes();
let payload: [u8; 3] = [register, data[0], data[1]];
self.i2c.write(self.address, &payload).map_err(Error::I2C)
}
pub(super) fn read_register(&mut self, register: u8) -> Result<u16, Error<E>> {
let mut data = [0, 0];
self.i2c
.write_read(self.address, &[register], &mut data)
.map_err(Error::I2C)
.and(Ok(u16::from_be_bytes(data)))
}
pub(super) fn set_operating_mode(&mut self, mode: OperatingMode) -> Result<(), Error<E>> {
let config = match mode {
OperatingMode::OneShot => self.config.with_high(BitFlags::OP_MODE),
OperatingMode::Continuous => self.config.with_low(BitFlags::OP_MODE),
};
self.write_register(Register::CONFIG, config.bits)?;
self.config = config;
Ok(())
}
/// Read whether a measurement is currently in progress.
pub fn is_measurement_in_progress(&mut self) -> Result<bool, Error<E>> {
let config = Config {
bits: self.read_register(Register::CONFIG)?,
};
Ok(!config.is_high(BitFlags::OS))
}
/// Reset the internal state of this driver to the default values.
///
/// *Note:* This does not alter the state or configuration of the device.
///
/// This resets the cached configuration register value in this driver to
/// the power-up (reset) configuration of the device.
///
/// This needs to be called after performing a reset on the device, for
/// example through an I2C general-call Reset command, which was not done
/// through this driver to ensure that the configurations in the device
/// and in the driver match.
pub fn reset_internal_driver_state(&mut self) {
self.config = Config::default();
}
}
|
