Add open-drain support for embassy-rp
This commit adds open-drain support for embassy-rp by adding a new type named embassy_rp::gpio::OutputOpenDrain.
This commit is contained in:
parent
e4072d7ff3
commit
c8461709e3
1 changed files with 83 additions and 1 deletions
|
@ -86,7 +86,6 @@ pub struct Output<'d, T: Pin> {
|
||||||
}
|
}
|
||||||
|
|
||||||
impl<'d, T: Pin> Output<'d, T> {
|
impl<'d, T: Pin> Output<'d, T> {
|
||||||
// TODO opendrain
|
|
||||||
pub fn new(pin: impl Unborrow<Target = T> + 'd, initial_output: Level) -> Self {
|
pub fn new(pin: impl Unborrow<Target = T> + 'd, initial_output: Level) -> Self {
|
||||||
unborrow!(pin);
|
unborrow!(pin);
|
||||||
|
|
||||||
|
@ -155,6 +154,89 @@ impl<'d, T: Pin> Drop for Output<'d, T> {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/// GPIO output open-drain.
|
||||||
|
pub struct OutputOpenDrain<'d, T: Pin> {
|
||||||
|
pin: T,
|
||||||
|
phantom: PhantomData<&'d mut T>,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl<'d, T: Pin> OutputOpenDrain<'d, T> {
|
||||||
|
#[inline]
|
||||||
|
pub fn new(pin: impl Unborrow<Target = T> + 'd, initial_output: Level) -> Self {
|
||||||
|
unborrow!(pin);
|
||||||
|
|
||||||
|
unsafe {
|
||||||
|
let val = 1 << pin.pin();
|
||||||
|
pin.io().ctrl().write(|w| {
|
||||||
|
w.set_funcsel(pac::io::vals::Gpio0CtrlFuncsel::SIO_0.0);
|
||||||
|
});
|
||||||
|
pin.sio_out().value_clr().write_value(val);
|
||||||
|
|
||||||
|
match initial_output {
|
||||||
|
Level::High => {
|
||||||
|
// For Open Drain High, disable the output pin.
|
||||||
|
pin.sio_oe().value_clr().write_value(val);
|
||||||
|
}
|
||||||
|
Level::Low => {
|
||||||
|
// For Open Drain Low, enable the output pin.
|
||||||
|
pin.sio_oe().value_set().write_value(val);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
Self {
|
||||||
|
pin,
|
||||||
|
phantom: PhantomData,
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/// Set the output as high.
|
||||||
|
#[inline]
|
||||||
|
pub fn set_high(&mut self) {
|
||||||
|
// For Open Drain High, disable the output pin.
|
||||||
|
unsafe {
|
||||||
|
self.pin
|
||||||
|
.sio_oe()
|
||||||
|
.value_clr()
|
||||||
|
.write_value(1 << self.pin.pin());
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/// Set the output as low.
|
||||||
|
#[inline]
|
||||||
|
pub fn set_low(&mut self) {
|
||||||
|
// For Open Drain Low, enable the output pin.
|
||||||
|
unsafe {
|
||||||
|
self.pin
|
||||||
|
.sio_oe()
|
||||||
|
.value_set()
|
||||||
|
.write_value(1 << self.pin.pin());
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/// Is the output level high?
|
||||||
|
#[inline]
|
||||||
|
pub fn is_set_high(&self) -> bool {
|
||||||
|
let val = 1 << self.pin.pin();
|
||||||
|
unsafe { (self.pin.sio_oe().value().read() & val) == 0 }
|
||||||
|
}
|
||||||
|
|
||||||
|
/// Is the output level low?
|
||||||
|
#[inline]
|
||||||
|
pub fn is_set_low(&self) -> bool {
|
||||||
|
!self.is_set_high()
|
||||||
|
}
|
||||||
|
|
||||||
|
/// Toggle pin output
|
||||||
|
#[inline]
|
||||||
|
pub fn toggle(&mut self) {
|
||||||
|
let val = 1 << self.pin.pin();
|
||||||
|
unsafe {
|
||||||
|
self.pin.sio_out().value_xor().write_value(val);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
pub(crate) mod sealed {
|
pub(crate) mod sealed {
|
||||||
use super::*;
|
use super::*;
|
||||||
|
|
||||||
|
|
Loading…
Reference in a new issue