use crate::{AllChannelMeasurement, BitFlags, Error, Register, Tcs3400, DEVICE_ADDRESS};
use embedded_hal::blocking::i2c;
impl<I2C, E> Tcs3400<I2C>
where
I2C: i2c::WriteRead<Error = E>,
{
#[allow(clippy::wrong_self_convention)]
pub fn is_rgbc_status_valid(&mut self) -> Result<bool, Error<E>> {
let status = self.read_register(Register::STATUS)?;
Ok((status & BitFlags::RGBC_VALID) != 0)
}
pub fn read_clear_channel(&mut self) -> Result<u16, Error<E>> {
self.read_channel(Register::CDATAL)
}
pub fn read_red_channel(&mut self) -> Result<u16, Error<E>> {
self.read_channel(Register::RDATAL)
}
pub fn read_green_channel(&mut self) -> Result<u16, Error<E>> {
self.read_channel(Register::GDATAL)
}
pub fn read_blue_channel(&mut self) -> Result<u16, Error<E>> {
self.read_channel(Register::BDATAL)
}
fn read_channel(&mut self, first_register: u8) -> Result<u16, Error<E>> {
let mut cdata = [0; 2];
self.read_registers(first_register, &mut cdata)?;
Ok((u16::from(cdata[1])) << 8 | u16::from(cdata[0]))
}
pub fn read_all_channels(&mut self) -> Result<AllChannelMeasurement, Error<E>> {
let mut data = [0; 8];
self.read_registers(Register::CDATAL, &mut data)?;
Ok(AllChannelMeasurement {
clear: u16::from(data[1]) << 8 | u16::from(data[0]),
red: u16::from(data[3]) << 8 | u16::from(data[2]),
green: u16::from(data[5]) << 8 | u16::from(data[4]),
blue: u16::from(data[7]) << 8 | u16::from(data[6]),
})
}
pub fn read_device_id(&mut self) -> Result<u8, Error<E>> {
self.read_register(Register::ID)
}
fn read_register(&mut self, register: u8) -> Result<u8, Error<E>> {
let mut data = [0];
self.i2c
.write_read(DEVICE_ADDRESS, &[register], &mut data)
.map_err(Error::I2C)?;
Ok(data[0])
}
fn read_registers(&mut self, first_register: u8, mut data: &mut [u8]) -> Result<(), Error<E>> {
self.i2c
.write_read(DEVICE_ADDRESS, &[first_register], &mut data)
.map_err(Error::I2C)
}
}