i2c_master: Initial commit Signed-off-by: Alistair Francis <alistair.francis@wdc.com>
diff --git a/src/drivers.rs b/src/drivers.rs index 2c2929d..8604691 100644 --- a/src/drivers.rs +++ b/src/drivers.rs
@@ -4,6 +4,7 @@ use crate::ctap::CtapDriverFactory; use crate::gpio::GpioDriverFactory; use crate::hmac::HmacDriverFactory; +use crate::i2c_master::I2cDriverFactory; use crate::i2c_master_slave::I2cMSDriverFactory; use crate::leds::LedsDriverFactory; use crate::result::OtherError; @@ -32,6 +33,7 @@ pub buttons: ButtonsDriverFactory, pub adc: AdcDriverFactory, pub i2c_ms: I2cMSDriverFactory, + pub i2c: I2cDriverFactory, pub rng: RngDriver, pub ble_advertising: BleAdvertisingDriverFactory, pub ble_scanning: BleScanningDriverFactory, @@ -80,6 +82,7 @@ gpio: GpioDriverFactory, hmac: HmacDriverFactory, i2c_ms: I2cMSDriverFactory, + i2c: I2cDriverFactory, temperature: TemperatureDriverFactory, rng: RngDriver, ambient_light_sensor: AmbientLightSensor,
diff --git a/src/i2c_master.rs b/src/i2c_master.rs new file mode 100644 index 0000000..55f2ee1 --- /dev/null +++ b/src/i2c_master.rs
@@ -0,0 +1,112 @@ +use crate::callback::CallbackSubscription; +use crate::callback::Consumer; +use crate::result::TockResult; +use crate::syscalls; +use core::marker::PhantomData; +use core::ops::Deref; +use core::ops::DerefMut; +use libtock_core::shared_memory::SharedMemory; + +const DRIVER_NUMBER: usize = 0x20003; + +pub const BUFFER_SIZE: usize = 64; + +mod command_nr { + pub const CHECK_PRESENT: usize = 0; + pub const WRITE: usize = 1; + pub const READ: usize = 2; + pub const WRITE_READ: usize = 3; +} + +mod subscribe_nr { + pub const SUBSCRIBE_CALLBACK: usize = 1; +} + +mod allow_nr { + pub const BUFFER: usize = 1; +} + +#[non_exhaustive] +pub struct I2cDriverFactory; + +impl I2cDriverFactory { + pub fn init_driver(&mut self) -> TockResult<I2cDriver> { + let i2c = I2cDriver { + lifetime: PhantomData, + }; + Ok(i2c) + } +} + +struct I2cEventConsumer; + +impl<CB: FnMut(usize, usize)> Consumer<CB> for I2cEventConsumer { + fn consume(callback: &mut CB, _: usize, _: usize, _: usize) { + callback(0, 0); + } +} + +pub struct I2cBuffer { + buffer: [u8; BUFFER_SIZE], +} + +impl Default for I2cBuffer { + fn default() -> Self { + I2cBuffer { + buffer: [0; BUFFER_SIZE], + } + } +} + +impl Deref for I2cBuffer { + type Target = [u8; BUFFER_SIZE]; + + fn deref(&self) -> &Self::Target { + &self.buffer + } +} + +impl DerefMut for I2cBuffer { + fn deref_mut(&mut self) -> &mut Self::Target { + &mut self.buffer + } +} + +pub struct I2cDriver<'a> { + lifetime: PhantomData<&'a ()>, +} + +impl<'a> I2cDriver<'a> { + pub fn init_buffer(&self, buffer: &'a mut I2cBuffer) -> TockResult<SharedMemory> { + syscalls::allow(DRIVER_NUMBER, allow_nr::BUFFER, &mut buffer.buffer).map_err(Into::into) + } + + pub fn subscribe<CB: FnMut(usize, usize)>( + &self, + callback: &'a mut CB, + ) -> TockResult<CallbackSubscription> { + syscalls::subscribe::<I2cEventConsumer, _>( + DRIVER_NUMBER, + subscribe_nr::SUBSCRIBE_CALLBACK, + callback, + ) + .map_err(Into::into) + } + + pub fn check_present(&self) -> TockResult<usize> { + syscalls::command(DRIVER_NUMBER, command_nr::CHECK_PRESENT, 0, 0).map_err(Into::into) + } + + pub fn write(&self, address: usize, length: usize) -> TockResult<usize> { + syscalls::command(DRIVER_NUMBER, command_nr::WRITE, address, length).map_err(Into::into) + } + + pub fn read(&self, address: usize, length: usize) -> TockResult<usize> { + syscalls::command(DRIVER_NUMBER, command_nr::READ, address, length).map_err(Into::into) + } + + pub fn write_read(&self, address: usize, length: usize) -> TockResult<usize> { + syscalls::command(DRIVER_NUMBER, command_nr::WRITE_READ, address, length) + .map_err(Into::into) + } +}
diff --git a/src/lib.rs b/src/lib.rs index 31dd0f8..6f5be5a 100644 --- a/src/lib.rs +++ b/src/lib.rs
@@ -13,6 +13,7 @@ pub mod futures; pub mod gpio; pub mod hmac; +pub mod i2c_master; pub mod i2c_master_slave; pub mod leds; pub mod result;