#[derive(Debug)]
#[non_exhaustive]
pub enum Error {
BusBusy,
Arbitration,
DataAck,
AdrAck,
Timeout,
}
#[macro_export]
macro_rules! i2c_pins {
($I2Cn:ident,
scl: [$(($($sclgpio: ident)::*, $sclaf: ident)),*],
sda: [$(($($sdagpio: ident)::*, $sdaaf: ident)),*],
) => {
$(
impl<T> SclPin<$I2Cn> for $($sclgpio)::*<AlternateFunction<$sclaf, T>>
where
T: OutputMode,
{}
)*
$(
impl<T> SdaPin<$I2Cn> for $($sdagpio)::*<AlternateFunction<$sdaaf, T>>
where
T: OutputMode,
{}
)*
}
}
#[macro_export]
macro_rules! i2c_busy_wait {
($i2c:expr $(, $field:ident, $op:ident)? ) => {{
delay(8);
$i2c.mclkocnt
.write(|w| unsafe { w.cntl().bits((1_000 >> 4) as u8) });
let mcs = loop {
let mcs = $i2c.mcs.read();
if mcs.busy().bit_is_clear() {
break mcs;
}
};
if mcs.clkto().bit_is_set() {
return Err(Error::Timeout)
} else if mcs.arblst().bit_is_set() {
return Err(Error::Arbitration)
} else if mcs.error().bit_is_set() {
if mcs.adrack().bit_is_set() {
return Err(Error::AdrAck);
} else { return Err(Error::DataAck);
}
}
$( loop {
if mcs.clkto().bit_is_set() {
return Err(Error::Timeout)
} else if mcs.arblst().bit_is_set() {
return Err(Error::Arbitration)
} else if mcs.error().bit_is_set() {
if mcs.adrack().bit_is_set() {
return Err(Error::AdrAck);
} else { return Err(Error::DataAck);
}
} else if mcs.$field().$op() {
break;
} else {
}
};)?
Ok(())
}};
}
#[macro_export]
macro_rules! i2c_hal {
($($I2CX:ident: ($powerDomain:ident, $i2cX:ident),)+) => {
$(
impl<SCL, SDA> I2c<$I2CX, (SCL, SDA)> {
pub fn $i2cX<F>(
i2c: $I2CX,
pins: (SCL, SDA),
freq: F,
clocks: &Clocks,
pc: &sysctl::PowerControl,
) -> Self where
F: Into<Hertz>,
SCL: SclPin<$I2CX>,
SDA: SdaPin<$I2CX>,
{
sysctl::control_power(
pc, sysctl::Domain::$powerDomain,
sysctl::RunMode::Run, sysctl::PowerState::On);
sysctl::reset(pc, sysctl::Domain::$powerDomain);
i2c.mcr.write(|w| w.mfe().set_bit());
let freq = freq.into().0;
let tpr = ((clocks.sysclk.0/(2*10*freq))-1) as u8;
i2c.mtpr.write(|w| unsafe {w.tpr().bits(tpr)});
I2c { i2c, pins }
}
pub fn free(self) -> ($I2CX, (SCL, SDA)) {
(self.i2c, self.pins)
}
}
impl<PINS> Write for I2c<$I2CX, PINS> {
type Error = Error;
fn write(&mut self, addr: u8, bytes: &[u8]) -> Result<(), Error> {
self.i2c.msa.write(|w| unsafe {
w.sa().bits(addr)
});
self.i2c.mdr.write(|w| unsafe {
w.data().bits(bytes[0])
});
let sz = bytes.len();
i2c_busy_wait!(self.i2c, busbsy, bit_is_clear)?;
self.i2c.mcs.write(|w| {
if sz == 1 {
w.stop().set_bit();
}
w.start().set_bit()
.run().set_bit()
});
for (i,byte) in (&bytes[1..]).iter().enumerate() {
i2c_busy_wait!(self.i2c)?;
self.i2c.mdr.write(|w| unsafe {
w.data().bits(*byte)
});
self.i2c.mcs.write(|w| {
if (i+1) == (sz-1) {
w.stop().set_bit();
}
w.run().set_bit()
});
}
i2c_busy_wait!(self.i2c)?;
Ok(())
}
}
impl<PINS> Read for I2c<$I2CX, PINS> {
type Error = Error;
fn read(
&mut self,
addr: u8,
buffer: &mut [u8],
) -> Result<(), Error> {
self.i2c.msa.write(|w| unsafe {
w.sa().bits(addr)
.rs().set_bit()
});
i2c_busy_wait!(self.i2c, busbsy, bit_is_clear)?;
let recv_sz = buffer.len();
if recv_sz == 1 {
self.i2c.mcs.write(|w| {
w.run().set_bit()
.start().set_bit()
.stop().set_bit()
});
i2c_busy_wait!(self.i2c)?;
buffer[0] = self.i2c.mdr.read().data().bits();
} else {
self.i2c.mcs.write(|w| {
w.start().set_bit()
.run().set_bit()
.ack().set_bit()
});
i2c_busy_wait!(self.i2c)?;
buffer[0] = self.i2c.mdr.read().data().bits();
for byte in &mut buffer[1..recv_sz-1] {
self.i2c.mcs.write(|w| {
w.run().set_bit()
.ack().set_bit()
});
i2c_busy_wait!(self.i2c)?;
*byte = self.i2c.mdr.read().data().bits();
}
self.i2c.mcs.write(|w| {
w.run().set_bit()
.stop().set_bit()
});
i2c_busy_wait!(self.i2c)?;
buffer[recv_sz-1] = self.i2c.mdr.read().data().bits();
}
Ok(())
}
}
impl<PINS> WriteRead for I2c<$I2CX, PINS> {
type Error = Error;
fn write_read(
&mut self,
addr: u8,
bytes: &[u8],
buffer: &mut [u8],
) -> Result<(), Error> {
let write_len = bytes.len();
if buffer.len() == 0 {
return self.write(addr, bytes);
}
if bytes.len() == 0 {
return self.read(addr, buffer);
}
self.i2c.msa.write(|w| unsafe {
w.sa().bits(addr)
});
self.i2c.mdr.write(|w| unsafe {
w.data().bits(bytes[0])
});
i2c_busy_wait!(self.i2c, busbsy, bit_is_clear)?;
self.i2c.mcs.write(|w| {
w.start().set_bit()
.run().set_bit()
});
i2c_busy_wait!(self.i2c)?;
for byte in (&bytes[1..write_len]).iter() {
self.i2c.mdr.write(|w| unsafe {
w.data().bits(*byte)
});
self.i2c.mcs.write(|w| {
w.run().set_bit()
});
i2c_busy_wait!(self.i2c)?;
}
self.i2c.msa.write(|w| unsafe {
w.sa().bits(addr)
.rs().set_bit()
});
let recv_sz = buffer.len();
if recv_sz == 1 {
self.i2c.mcs.write(|w| {
w.run().set_bit()
.start().set_bit()
.stop().set_bit()
});
i2c_busy_wait!(self.i2c)?;
buffer[0] = self.i2c.mdr.read().data().bits();
} else {
self.i2c.mcs.write(|w| {
w.run().set_bit()
.start().set_bit()
.ack().set_bit()
});
i2c_busy_wait!(self.i2c)?;
buffer[0] = self.i2c.mdr.read().data().bits();
for byte in &mut buffer[1..recv_sz-1] {
self.i2c.mcs.write(|w| {
w.run().set_bit()
.ack().set_bit()
});
i2c_busy_wait!(self.i2c)?;
*byte = self.i2c.mdr.read().data().bits();
}
self.i2c.mcs.write(|w| {
w.run().set_bit()
.stop().set_bit()
});
i2c_busy_wait!(self.i2c)?;
buffer[recv_sz-1] = self.i2c.mdr.read().data().bits();
}
Ok(())
}
}
)+
}
}