#![no_std]
#![no_main]
use hal::clocks::Clock;
use hal::multicore::{Multicore, Stack};
use hal::sio::Sio;
use panic_halt as _;
use rp2040_hal as hal;
use hal::pac;
use embedded_hal::digital::v2::ToggleableOutputPin;
#[link_section = ".boot2"]
#[used]
pub static BOOT2: [u8; 256] = rp2040_boot2::BOOT_LOADER_GENERIC_03H;
const XTAL_FREQ_HZ: u32 = 12_000_000u32;
const CORE1_TASK_COMPLETE: u32 = 0xEE;
static mut CORE1_STACK: Stack<4096> = Stack::new();
fn core1_task(sys_freq: u32) -> ! {
let mut pac = unsafe { pac::Peripherals::steal() };
let core = unsafe { pac::CorePeripherals::steal() };
let mut sio = Sio::new(pac.SIO);
let pins = hal::gpio::Pins::new(
pac.IO_BANK0,
pac.PADS_BANK0,
sio.gpio_bank0,
&mut pac.RESETS,
);
let mut led_pin = pins.gpio25.into_push_pull_output();
let mut delay = cortex_m::delay::Delay::new(core.SYST, sys_freq);
loop {
let input = sio.fifo.read();
if let Some(word) = input {
delay.delay_ms(word);
led_pin.toggle().unwrap();
sio.fifo.write_blocking(CORE1_TASK_COMPLETE);
};
}
}
#[rp2040_hal::entry]
fn main() -> ! {
let mut pac = pac::Peripherals::take().unwrap();
let _core = pac::CorePeripherals::take().unwrap();
let mut watchdog = hal::watchdog::Watchdog::new(pac.WATCHDOG);
let clocks = hal::clocks::init_clocks_and_plls(
XTAL_FREQ_HZ,
pac.XOSC,
pac.CLOCKS,
pac.PLL_SYS,
pac.PLL_USB,
&mut pac.RESETS,
&mut watchdog,
)
.ok()
.unwrap();
let sys_freq = clocks.system_clock.freq().to_Hz();
let mut sio = hal::sio::Sio::new(pac.SIO);
let mut mc = Multicore::new(&mut pac.PSM, &mut pac.PPB, &mut sio.fifo);
let cores = mc.cores();
let core1 = &mut cores[1];
let _test = core1.spawn(unsafe { &mut CORE1_STACK.mem }, move || {
core1_task(sys_freq)
});
const LED_PERIOD_INCREMENT: i32 = 2;
const LED_PERIOD_MIN: i32 = 0;
const LED_PERIOD_MAX: i32 = 100;
let mut led_period: i32 = LED_PERIOD_MIN;
let mut count_up = true;
loop {
if count_up {
led_period += LED_PERIOD_INCREMENT;
if led_period > LED_PERIOD_MAX {
led_period = LED_PERIOD_MAX;
count_up = false;
}
} else {
led_period -= LED_PERIOD_INCREMENT;
if led_period < LED_PERIOD_MIN {
led_period = LED_PERIOD_MIN;
count_up = true;
}
}
if led_period < 0 {
led_period = 0;
}
sio.fifo.write(led_period as u32);
let ack = sio.fifo.read_blocking();
if ack != CORE1_TASK_COMPLETE {
}
}
}