use crate::{AllChannelMeasurement, Error, Register, Veml6040, DEVICE_ADDRESS};
use embedded_hal::blocking::i2c;
impl<I2C, E> Veml6040<I2C>
where
I2C: i2c::WriteRead<Error = E>,
{
pub fn read_red_channel(&mut self) -> Result<u16, Error<E>> {
self.read_channel(Register::R_DATA)
}
pub fn read_green_channel(&mut self) -> Result<u16, Error<E>> {
self.read_channel(Register::G_DATA)
}
pub fn read_blue_channel(&mut self) -> Result<u16, Error<E>> {
self.read_channel(Register::B_DATA)
}
pub fn read_white_channel(&mut self) -> Result<u16, Error<E>> {
self.read_channel(Register::W_DATA)
}
pub fn read_all_channels(&mut self) -> Result<AllChannelMeasurement, Error<E>> {
let mut data = [0; 8];
self.i2c
.write_read(DEVICE_ADDRESS, &[Register::R_DATA], &mut data)
.map_err(Error::I2C)?;
Ok(AllChannelMeasurement {
red: u16::from(data[1]) << 8 | u16::from(data[0]),
green: u16::from(data[3]) << 8 | u16::from(data[2]),
blue: u16::from(data[5]) << 8 | u16::from(data[4]),
white: u16::from(data[7]) << 8 | u16::from(data[6]),
})
}
fn read_channel(&mut self, first_register: u8) -> Result<u16, Error<E>> {
let mut data = [0; 2];
self.i2c
.write_read(DEVICE_ADDRESS, &[first_register], &mut data)
.map_err(Error::I2C)
.and(Ok(u16::from(data[1]) << 8 | u16::from(data[0])))
}
}