use crate::{BOOT_DELAY_MS, CST820_CHIP_ID, DEFAULT_DEVICE_ADDRESS, RESET_PULSE_US, Touch};
use cst820_registers::prelude::*;
use cst820_registers::{
AutoSleepTime, ChipId, DisAutoSleep, FwVersion, IrqCtl, MotionMask, ProjId, SleepMode,
};
use embedded_hal::digital::OutputPin;
use embedded_hal_async::delay::DelayNs;
use embedded_hal_async::i2c::I2c;
pub async fn reset<P, D>(rst: &mut P, delay: &mut D) -> Result<(), P::Error>
where
P: OutputPin,
D: DelayNs,
{
rst.set_low()?;
delay.delay_us(RESET_PULSE_US).await;
rst.set_high()?;
delay.delay_ms(BOOT_DELAY_MS).await;
Ok(())
}
#[derive(Debug)]
pub struct Cst820<I2C> {
i2c: I2C,
address: u8,
}
impl<I2C> Cst820<I2C>
where
I2C: I2c,
{
pub fn new(i2c: I2C) -> Self {
Self::with_address(i2c, DEFAULT_DEVICE_ADDRESS)
}
pub fn with_address(i2c: I2C, address: u8) -> Self {
Self { i2c, address }
}
pub fn release(self) -> I2C {
self.i2c
}
pub async fn chip_id(&mut self) -> Result<u8, I2C::Error> {
Ok(self.read_register::<ChipId>().await?.value())
}
pub async fn identify(&mut self) -> Result<bool, I2C::Error> {
Ok(self.chip_id().await? == CST820_CHIP_ID)
}
pub async fn project_id(&mut self) -> Result<u8, I2C::Error> {
Ok(self.read_register::<ProjId>().await?.value())
}
pub async fn firmware_version(&mut self) -> Result<u8, I2C::Error> {
Ok(self.read_register::<FwVersion>().await?.value())
}
pub async fn configure_gestures(&mut self, mask: MotionMask) -> Result<(), I2C::Error> {
self.write_register(mask).await
}
pub async fn read_touch(&mut self) -> Result<Touch, I2C::Error> {
let mut buffer = [0; Touch::LEN];
self.i2c
.write_read(self.address, &[Touch::START.addr()], &mut buffer)
.await?;
Ok(Touch::from_bytes(&buffer))
}
pub async fn configure_interrupts(&mut self, irq: IrqCtl) -> Result<(), I2C::Error> {
self.write_register(irq).await
}
pub async fn set_auto_sleep(&mut self, seconds: Option<u8>) -> Result<(), I2C::Error> {
match seconds {
Some(seconds) => {
self.write_register(AutoSleepTime::new().with_value(seconds))
.await?;
self.write_register(DisAutoSleep::new()).await
}
None => self.write_register(DisAutoSleep::new().with_value(1)).await,
}
}
pub async fn sleep(&mut self) -> Result<(), I2C::Error> {
self.write_register(SleepMode::deep_sleep()).await
}
pub async fn read_register<R>(&mut self) -> Result<R, I2C::Error>
where
R: Register,
{
let mut buffer = [0];
self.i2c
.write_read(self.address, &[*R::REGISTER_ADDRESS], &mut buffer)
.await?;
Ok(R::from_bits(buffer[0]))
}
pub async fn write_register<R>(&mut self, register: R) -> Result<(), I2C::Error>
where
R: WritableRegister,
{
self.i2c
.write(self.address, &[*R::REGISTER_ADDRESS, register.to_bits()])
.await
}
pub async fn modify_register<R, F>(&mut self, f: F) -> Result<(), I2C::Error>
where
R: WritableRegister,
F: FnOnce(R) -> R,
{
let register = self.read_register::<R>().await?;
self.write_register(f(register)).await
}
}