use crate::{AllChannelMeasurement, BitFlags, Error, Register, Tcs3472, DEVICE_ADDRESS};
#[cfg(not(feature = "async"))]
use embedded_hal::i2c::I2c;
#[cfg(feature = "async")]
use embedded_hal_async::i2c::I2c as AsyncI2c;
#[maybe_async_cfg::maybe(
sync(
cfg(not(feature = "async")),
self = "Tcs3472",
idents(AsyncI2c(sync = "I2c"))
),
async(feature = "async", keep_self)
)]
impl<I2C, E> Tcs3472<I2C>
where
I2C: AsyncI2c<Error = E>,
{
#[allow(clippy::wrong_self_convention)]
pub async fn is_rgbc_status_valid(&mut self) -> Result<bool, Error<E>> {
let status = self.read_register(Register::STATUS).await?;
Ok((status & BitFlags::RGBC_VALID) != 0)
}
pub async fn read_clear_channel(&mut self) -> Result<u16, Error<E>> {
self.read_channel(Register::CDATA).await
}
pub async fn read_red_channel(&mut self) -> Result<u16, Error<E>> {
self.read_channel(Register::RDATA).await
}
pub async fn read_green_channel(&mut self) -> Result<u16, Error<E>> {
self.read_channel(Register::GDATA).await
}
pub async fn read_blue_channel(&mut self) -> Result<u16, Error<E>> {
self.read_channel(Register::BDATA).await
}
async fn read_channel(&mut self, first_register: u8) -> Result<u16, Error<E>> {
let mut cdata = [0; 2];
self.read_registers(first_register, &mut cdata).await?;
Ok((u16::from(cdata[1])) << 8 | u16::from(cdata[0]))
}
pub async fn read_all_channels(&mut self) -> Result<AllChannelMeasurement, Error<E>> {
let mut data = [0; 8];
self.read_registers(Register::CDATA, &mut data).await?;
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 async fn read_device_id(&mut self) -> Result<u8, Error<E>> {
self.read_register(Register::ID).await
}
async fn read_register(&mut self, register: u8) -> Result<u8, Error<E>> {
let command = BitFlags::CMD | register;
let mut data = [0];
self.i2c
.write_read(DEVICE_ADDRESS, &[command], &mut data)
.await
.map_err(Error::I2C)?;
Ok(data[0])
}
async fn read_registers(
&mut self,
first_register: u8,
data: &mut [u8],
) -> Result<(), Error<E>> {
let command = BitFlags::CMD | BitFlags::CMD_AUTO_INC | first_register;
self.i2c
.write_read(DEVICE_ADDRESS, &[command], data)
.await
.map_err(Error::I2C)
}
}