348 lines
8.3 KiB
Rust
348 lines
8.3 KiB
Rust
use core::marker::PhantomData;
|
|
|
|
use crate::pac;
|
|
use crate::pac::common::{Reg, RW};
|
|
use crate::pac::SIO;
|
|
use crate::peripherals;
|
|
|
|
use embassy::util::Unborrow;
|
|
use embassy_extras::{unborrow, unsafe_impl_unborrow};
|
|
use embedded_hal::digital::v2 as digital;
|
|
|
|
/// Represents a digital input or output level.
|
|
#[derive(Debug, Eq, PartialEq)]
|
|
pub enum Level {
|
|
Low,
|
|
High,
|
|
}
|
|
|
|
/// Represents a pull setting for an input.
|
|
#[derive(Debug, Eq, PartialEq)]
|
|
pub enum Pull {
|
|
None,
|
|
Up,
|
|
Down,
|
|
}
|
|
|
|
/// A GPIO bank with up to 32 pins.
|
|
#[derive(Debug, Eq, PartialEq)]
|
|
pub enum Bank {
|
|
Bank0 = 0,
|
|
Qspi = 1,
|
|
}
|
|
|
|
pub struct Input<'d, T: Pin> {
|
|
pin: T,
|
|
phantom: PhantomData<&'d mut T>,
|
|
}
|
|
|
|
impl<'d, T: Pin> Input<'d, T> {
|
|
pub fn new(pin: impl Unborrow<Target = T> + 'd, pull: Pull) -> Self {
|
|
unborrow!(pin);
|
|
|
|
unsafe {
|
|
pin.pad_ctrl().write(|w| {
|
|
w.set_ie(true);
|
|
match pull {
|
|
Pull::Up => w.set_pue(true),
|
|
Pull::Down => w.set_pde(true),
|
|
Pull::None => {}
|
|
}
|
|
});
|
|
|
|
// disable output in SIO, to use it as input
|
|
pin.sio_oe().value_clr().write_value(1 << pin.pin());
|
|
|
|
pin.io().ctrl().write(|w| {
|
|
w.set_funcsel(pac::io::vals::Gpio0CtrlFuncsel::SIO_0.0);
|
|
});
|
|
}
|
|
|
|
Self {
|
|
pin,
|
|
phantom: PhantomData,
|
|
}
|
|
}
|
|
|
|
pub fn is_high(&self) -> bool {
|
|
!self.is_low()
|
|
}
|
|
|
|
pub fn is_low(&self) -> bool {
|
|
let val = 1 << self.pin.pin();
|
|
unsafe { self.pin.sio_in().read() & val == 0 }
|
|
}
|
|
}
|
|
|
|
impl<'d, T: Pin> Drop for Input<'d, T> {
|
|
fn drop(&mut self) {
|
|
// todo
|
|
}
|
|
}
|
|
|
|
impl<'d, T: Pin> digital::InputPin for Input<'d, T> {
|
|
type Error = !;
|
|
|
|
fn is_high(&self) -> Result<bool, Self::Error> {
|
|
Ok(self.is_high())
|
|
}
|
|
|
|
fn is_low(&self) -> Result<bool, Self::Error> {
|
|
Ok(self.is_low())
|
|
}
|
|
}
|
|
|
|
pub struct Output<'d, T: Pin> {
|
|
pin: T,
|
|
phantom: PhantomData<&'d mut T>,
|
|
}
|
|
|
|
impl<'d, T: Pin> Output<'d, T> {
|
|
// TODO opendrain
|
|
pub fn new(pin: impl Unborrow<Target = T> + 'd, initial_output: Level) -> Self {
|
|
unborrow!(pin);
|
|
|
|
unsafe {
|
|
match initial_output {
|
|
Level::High => pin.sio_out().value_set().write_value(1 << pin.pin()),
|
|
Level::Low => pin.sio_out().value_clr().write_value(1 << pin.pin()),
|
|
}
|
|
pin.sio_oe().value_set().write_value(1 << pin.pin());
|
|
|
|
pin.io().ctrl().write(|w| {
|
|
w.set_funcsel(pac::io::vals::Gpio0CtrlFuncsel::SIO_0.0);
|
|
});
|
|
}
|
|
|
|
Self {
|
|
pin,
|
|
phantom: PhantomData,
|
|
}
|
|
}
|
|
|
|
/// Set the output as high.
|
|
pub fn set_high(&mut self) {
|
|
let val = 1 << self.pin.pin();
|
|
unsafe { self.pin.sio_out().value_set().write_value(val) };
|
|
}
|
|
|
|
/// Set the output as low.
|
|
pub fn set_low(&mut self) {
|
|
let val = 1 << self.pin.pin();
|
|
unsafe { self.pin.sio_out().value_clr().write_value(val) };
|
|
}
|
|
|
|
/// Is the output pin set as high?
|
|
pub fn is_set_high(&self) -> bool {
|
|
!self.is_set_low()
|
|
}
|
|
|
|
/// Is the output pin set as low?
|
|
pub fn is_set_low(&self) -> bool {
|
|
// todo
|
|
true
|
|
}
|
|
}
|
|
|
|
impl<'d, T: Pin> Drop for Output<'d, T> {
|
|
fn drop(&mut self) {
|
|
// todo
|
|
}
|
|
}
|
|
|
|
impl<'d, T: Pin> digital::OutputPin for Output<'d, T> {
|
|
type Error = !;
|
|
|
|
/// Set the output as high.
|
|
fn set_high(&mut self) -> Result<(), Self::Error> {
|
|
self.set_high();
|
|
Ok(())
|
|
}
|
|
|
|
/// Set the output as low.
|
|
fn set_low(&mut self) -> Result<(), Self::Error> {
|
|
self.set_low();
|
|
Ok(())
|
|
}
|
|
}
|
|
|
|
impl<'d, T: Pin> digital::StatefulOutputPin for Output<'d, T> {
|
|
/// Is the output pin set as high?
|
|
fn is_set_high(&self) -> Result<bool, Self::Error> {
|
|
Ok(self.is_set_high())
|
|
}
|
|
|
|
/// Is the output pin set as low?
|
|
fn is_set_low(&self) -> Result<bool, Self::Error> {
|
|
Ok(self.is_set_low())
|
|
}
|
|
}
|
|
|
|
pub(crate) mod sealed {
|
|
use super::*;
|
|
|
|
pub trait Pin: Sized {
|
|
fn pin_bank(&self) -> u8;
|
|
|
|
#[inline]
|
|
fn pin(&self) -> u8 {
|
|
self.pin_bank() & 0x1f
|
|
}
|
|
|
|
#[inline]
|
|
fn bank(&self) -> Bank {
|
|
if self.pin_bank() & 0x20 == 0 {
|
|
Bank::Bank0
|
|
} else {
|
|
Bank::Qspi
|
|
}
|
|
}
|
|
|
|
fn io(&self) -> pac::io::Gpio {
|
|
let block = match self.bank() {
|
|
Bank::Bank0 => crate::pac::IO_BANK0,
|
|
Bank::Qspi => crate::pac::IO_QSPI,
|
|
};
|
|
block.gpio(self.pin() as _)
|
|
}
|
|
|
|
fn pad_ctrl(&self) -> Reg<pac::pads::regs::GpioCtrl, RW> {
|
|
let block = match self.bank() {
|
|
Bank::Bank0 => crate::pac::PADS_BANK0,
|
|
Bank::Qspi => crate::pac::PADS_QSPI,
|
|
};
|
|
block.gpio(self.pin() as _)
|
|
}
|
|
fn sio_out(&self) -> pac::sio::Gpio {
|
|
SIO.gpio_out(self.bank() as _)
|
|
}
|
|
fn sio_oe(&self) -> pac::sio::Gpio {
|
|
SIO.gpio_oe(self.bank() as _)
|
|
}
|
|
fn sio_in(&self) -> Reg<u32, RW> {
|
|
SIO.gpio_in(self.bank() as _)
|
|
}
|
|
}
|
|
|
|
pub trait OptionalPin {}
|
|
}
|
|
|
|
pub trait Pin: Unborrow<Target = Self> + sealed::Pin {
|
|
/// Degrade to a generic pin struct
|
|
fn degrade(self) -> AnyPin {
|
|
AnyPin {
|
|
pin_bank: self.pin_bank(),
|
|
}
|
|
}
|
|
}
|
|
|
|
pub struct AnyPin {
|
|
pin_bank: u8,
|
|
}
|
|
unsafe_impl_unborrow!(AnyPin);
|
|
impl Pin for AnyPin {}
|
|
impl sealed::Pin for AnyPin {
|
|
fn pin_bank(&self) -> u8 {
|
|
self.pin_bank
|
|
}
|
|
}
|
|
|
|
// ==========================
|
|
|
|
pub trait OptionalPin: Unborrow<Target = Self> + sealed::OptionalPin + Sized {
|
|
type Pin: Pin;
|
|
fn pin(&self) -> Option<&Self::Pin>;
|
|
fn pin_mut(&mut self) -> Option<&mut Self::Pin>;
|
|
|
|
/// Convert from concrete pin type PIN_XX to type erased `Option<AnyPin>`.
|
|
#[inline]
|
|
fn degrade_optional(mut self) -> Option<AnyPin> {
|
|
self.pin_mut()
|
|
.map(|pin| unsafe { core::ptr::read(pin) }.degrade())
|
|
}
|
|
}
|
|
|
|
impl<T: Pin> sealed::OptionalPin for T {}
|
|
impl<T: Pin> OptionalPin for T {
|
|
type Pin = T;
|
|
|
|
#[inline]
|
|
fn pin(&self) -> Option<&T> {
|
|
Some(self)
|
|
}
|
|
|
|
#[inline]
|
|
fn pin_mut(&mut self) -> Option<&mut T> {
|
|
Some(self)
|
|
}
|
|
}
|
|
|
|
#[derive(Clone, Copy, Debug)]
|
|
pub struct NoPin;
|
|
unsafe_impl_unborrow!(NoPin);
|
|
impl sealed::OptionalPin for NoPin {}
|
|
impl OptionalPin for NoPin {
|
|
type Pin = AnyPin;
|
|
|
|
#[inline]
|
|
fn pin(&self) -> Option<&AnyPin> {
|
|
None
|
|
}
|
|
|
|
#[inline]
|
|
fn pin_mut(&mut self) -> Option<&mut AnyPin> {
|
|
None
|
|
}
|
|
}
|
|
|
|
// ==========================
|
|
|
|
macro_rules! impl_pin {
|
|
($name:ident, $bank:expr, $pin_num:expr) => {
|
|
impl Pin for peripherals::$name {}
|
|
impl sealed::Pin for peripherals::$name {
|
|
fn pin_bank(&self) -> u8 {
|
|
($bank as u8) * 32 + $pin_num
|
|
}
|
|
}
|
|
};
|
|
}
|
|
|
|
impl_pin!(PIN_0, Bank::Bank0, 0);
|
|
impl_pin!(PIN_1, Bank::Bank0, 1);
|
|
impl_pin!(PIN_2, Bank::Bank0, 2);
|
|
impl_pin!(PIN_3, Bank::Bank0, 3);
|
|
impl_pin!(PIN_4, Bank::Bank0, 4);
|
|
impl_pin!(PIN_5, Bank::Bank0, 5);
|
|
impl_pin!(PIN_6, Bank::Bank0, 6);
|
|
impl_pin!(PIN_7, Bank::Bank0, 7);
|
|
impl_pin!(PIN_8, Bank::Bank0, 8);
|
|
impl_pin!(PIN_9, Bank::Bank0, 9);
|
|
impl_pin!(PIN_10, Bank::Bank0, 10);
|
|
impl_pin!(PIN_11, Bank::Bank0, 11);
|
|
impl_pin!(PIN_12, Bank::Bank0, 12);
|
|
impl_pin!(PIN_13, Bank::Bank0, 13);
|
|
impl_pin!(PIN_14, Bank::Bank0, 14);
|
|
impl_pin!(PIN_15, Bank::Bank0, 15);
|
|
impl_pin!(PIN_16, Bank::Bank0, 16);
|
|
impl_pin!(PIN_17, Bank::Bank0, 17);
|
|
impl_pin!(PIN_18, Bank::Bank0, 18);
|
|
impl_pin!(PIN_19, Bank::Bank0, 19);
|
|
impl_pin!(PIN_20, Bank::Bank0, 20);
|
|
impl_pin!(PIN_21, Bank::Bank0, 21);
|
|
impl_pin!(PIN_22, Bank::Bank0, 22);
|
|
impl_pin!(PIN_23, Bank::Bank0, 23);
|
|
impl_pin!(PIN_24, Bank::Bank0, 24);
|
|
impl_pin!(PIN_25, Bank::Bank0, 25);
|
|
impl_pin!(PIN_26, Bank::Bank0, 26);
|
|
impl_pin!(PIN_27, Bank::Bank0, 27);
|
|
impl_pin!(PIN_28, Bank::Bank0, 28);
|
|
impl_pin!(PIN_29, Bank::Bank0, 29);
|
|
|
|
impl_pin!(PIN_QSPI_SCLK, Bank::Qspi, 0);
|
|
impl_pin!(PIN_QSPI_SS, Bank::Qspi, 1);
|
|
impl_pin!(PIN_QSPI_SD0, Bank::Qspi, 2);
|
|
impl_pin!(PIN_QSPI_SD1, Bank::Qspi, 3);
|
|
impl_pin!(PIN_QSPI_SD2, Bank::Qspi, 4);
|
|
impl_pin!(PIN_QSPI_SD3, Bank::Qspi, 5);
|