#![no_std]
#![no_main]
use panic_halt as _;
use rp2040_hal as hal;
use embedded_hal::digital::OutputPin;
use hal::pac::interrupt;
use hal::pac;
use hal::gpio;
use hal::pwm;
use core::cell::RefCell;
use critical_section::Mutex;
#[link_section = ".boot2"]
#[used]
pub static BOOT2: [u8; 256] = rp2040_boot2::BOOT_LOADER_GENERIC_03H;
const LOW_US: u16 = 1475;
const HIGH_US: u16 = 1525;
const XTAL_FREQ_HZ: u32 = 12_000_000u32;
type LedPin = gpio::Pin<gpio::bank0::Gpio25, gpio::FunctionSio<gpio::SioOutput>, gpio::PullNone>;
type InputPwmPin = gpio::Pin<gpio::bank0::Gpio1, gpio::FunctionPwm, gpio::PullNone>;
type PwmSlice = pwm::Slice<pwm::Pwm0, pwm::InputHighRunning>;
type LedInputAndPwm = (LedPin, InputPwmPin, PwmSlice);
static GLOBAL_PINS: Mutex<RefCell<Option<LedInputAndPwm>>> = Mutex::new(RefCell::new(None));
#[rp2040_hal::entry]
fn main() -> ! {
let mut pac = pac::Peripherals::take().unwrap();
let mut watchdog = hal::Watchdog::new(pac.WATCHDOG);
hal::clocks::init_clocks_and_plls(
XTAL_FREQ_HZ,
pac.XOSC,
pac.CLOCKS,
pac.PLL_SYS,
pac.PLL_USB,
&mut pac.RESETS,
&mut watchdog,
)
.unwrap();
let sio = hal::Sio::new(pac.SIO);
let pins = gpio::Pins::new(
pac.IO_BANK0,
pac.PADS_BANK0,
sio.gpio_bank0,
&mut pac.RESETS,
);
let pwm_slices = pwm::Slices::new(pac.PWM, &mut pac.RESETS);
let mut pwm: pwm::Slice<_, pwm::InputHighRunning> = pwm_slices.pwm0.into_mode();
pwm.set_div_int(125);
pwm.enable();
let input_pin = pins.gpio1.reconfigure();
let channel = &mut pwm.channel_b;
channel.set_enabled(true);
input_pin.set_interrupt_enabled(gpio::Interrupt::EdgeLow, true);
let led = pins.gpio25.reconfigure();
critical_section::with(|cs| {
GLOBAL_PINS.borrow(cs).replace(Some((led, input_pin, pwm)));
});
unsafe {
pac::NVIC::unmask(pac::Interrupt::IO_IRQ_BANK0);
}
loop {
cortex_m::asm::wfi();
}
}
#[interrupt]
fn IO_IRQ_BANK0() {
static mut LED_INPUT_AND_PWM: Option<LedInputAndPwm> = None;
if LED_INPUT_AND_PWM.is_none() {
critical_section::with(|cs| {
*LED_INPUT_AND_PWM = GLOBAL_PINS.borrow(cs).take();
});
}
if let Some((led, input, pwm)) = LED_INPUT_AND_PWM {
if input.interrupt_status(gpio::Interrupt::EdgeLow) {
let pulse_width_us = pwm.get_counter();
if pulse_width_us < LOW_US {
let _ = led.set_low();
}
else if pulse_width_us > HIGH_US {
let _ = led.set_high();
}
pwm.set_counter(0);
input.clear_interrupt(gpio::Interrupt::EdgeLow);
}
}
}