143 lines
4.7 KiB
Rust
143 lines
4.7 KiB
Rust
#![no_std]
|
|
#![no_main]
|
|
teleprobe_meta::target!(b"rpi-pico");
|
|
|
|
use defmt::{assert, assert_eq, assert_ne, *};
|
|
use embassy_executor::Spawner;
|
|
use embassy_rp::gpio::{Input, Level, Output, Pull};
|
|
use embassy_rp::pwm::{Config, InputMode, Pwm};
|
|
use embassy_time::Timer;
|
|
use {defmt_rtt as _, panic_probe as _};
|
|
|
|
#[embassy_executor::main]
|
|
async fn main(_spawner: Spawner) {
|
|
let mut p = embassy_rp::init(Default::default());
|
|
info!("Hello World!");
|
|
|
|
// Connections on CI device: 6 -> 9, 7 -> 11
|
|
let (mut p6, mut p7, mut p9, mut p11) = (p.PIN_6, p.PIN_7, p.PIN_9, p.PIN_11);
|
|
|
|
let cfg = {
|
|
let mut c = Config::default();
|
|
c.divider = 125.into();
|
|
c.top = 10000;
|
|
c.compare_a = 5000;
|
|
c.compare_b = 5000;
|
|
c
|
|
};
|
|
|
|
// Test free-running clock
|
|
{
|
|
let pwm = Pwm::new_free(&mut p.PWM_CH3, cfg.clone());
|
|
cortex_m::asm::delay(125);
|
|
let ctr = pwm.counter();
|
|
assert!(ctr > 0);
|
|
assert!(ctr < 100);
|
|
cortex_m::asm::delay(125);
|
|
assert!(ctr < pwm.counter());
|
|
}
|
|
|
|
for invert_a in [false, true] {
|
|
info!("free-running, invert A: {}", invert_a);
|
|
let mut cfg = cfg.clone();
|
|
cfg.invert_a = invert_a;
|
|
cfg.invert_b = !invert_a;
|
|
|
|
// Test output from A
|
|
{
|
|
let pin1 = Input::new(&mut p9, Pull::None);
|
|
let _pwm = Pwm::new_output_a(&mut p.PWM_CH3, &mut p6, cfg.clone());
|
|
Timer::after_millis(1).await;
|
|
assert_eq!(pin1.is_low(), invert_a);
|
|
Timer::after_millis(5).await;
|
|
assert_eq!(pin1.is_high(), invert_a);
|
|
Timer::after_millis(5).await;
|
|
assert_eq!(pin1.is_low(), invert_a);
|
|
Timer::after_millis(5).await;
|
|
assert_eq!(pin1.is_high(), invert_a);
|
|
}
|
|
|
|
// Test output from B
|
|
{
|
|
let pin2 = Input::new(&mut p11, Pull::None);
|
|
let _pwm = Pwm::new_output_b(&mut p.PWM_CH3, &mut p7, cfg.clone());
|
|
Timer::after_millis(1).await;
|
|
assert_ne!(pin2.is_low(), invert_a);
|
|
Timer::after_millis(5).await;
|
|
assert_ne!(pin2.is_high(), invert_a);
|
|
Timer::after_millis(5).await;
|
|
assert_ne!(pin2.is_low(), invert_a);
|
|
Timer::after_millis(5).await;
|
|
assert_ne!(pin2.is_high(), invert_a);
|
|
}
|
|
|
|
// Test output from A+B
|
|
{
|
|
let pin1 = Input::new(&mut p9, Pull::None);
|
|
let pin2 = Input::new(&mut p11, Pull::None);
|
|
let _pwm = Pwm::new_output_ab(&mut p.PWM_CH3, &mut p6, &mut p7, cfg.clone());
|
|
Timer::after_millis(1).await;
|
|
assert_eq!(pin1.is_low(), invert_a);
|
|
assert_ne!(pin2.is_low(), invert_a);
|
|
Timer::after_millis(5).await;
|
|
assert_eq!(pin1.is_high(), invert_a);
|
|
assert_ne!(pin2.is_high(), invert_a);
|
|
Timer::after_millis(5).await;
|
|
assert_eq!(pin1.is_low(), invert_a);
|
|
assert_ne!(pin2.is_low(), invert_a);
|
|
Timer::after_millis(5).await;
|
|
assert_eq!(pin1.is_high(), invert_a);
|
|
assert_ne!(pin2.is_high(), invert_a);
|
|
}
|
|
}
|
|
|
|
// Test level-gated
|
|
{
|
|
let mut pin2 = Output::new(&mut p11, Level::Low);
|
|
let pwm = Pwm::new_input(&mut p.PWM_CH3, &mut p7, InputMode::Level, cfg.clone());
|
|
assert_eq!(pwm.counter(), 0);
|
|
Timer::after_millis(5).await;
|
|
assert_eq!(pwm.counter(), 0);
|
|
pin2.set_high();
|
|
Timer::after_millis(1).await;
|
|
pin2.set_low();
|
|
let ctr = pwm.counter();
|
|
assert!(ctr >= 1000);
|
|
Timer::after_millis(1).await;
|
|
assert_eq!(pwm.counter(), ctr);
|
|
}
|
|
|
|
// Test rising-gated
|
|
{
|
|
let mut pin2 = Output::new(&mut p11, Level::Low);
|
|
let pwm = Pwm::new_input(&mut p.PWM_CH3, &mut p7, InputMode::RisingEdge, cfg.clone());
|
|
assert_eq!(pwm.counter(), 0);
|
|
Timer::after_millis(5).await;
|
|
assert_eq!(pwm.counter(), 0);
|
|
pin2.set_high();
|
|
Timer::after_millis(1).await;
|
|
pin2.set_low();
|
|
assert_eq!(pwm.counter(), 1);
|
|
Timer::after_millis(1).await;
|
|
assert_eq!(pwm.counter(), 1);
|
|
}
|
|
|
|
// Test falling-gated
|
|
{
|
|
let mut pin2 = Output::new(&mut p11, Level::High);
|
|
let pwm = Pwm::new_input(&mut p.PWM_CH3, &mut p7, InputMode::FallingEdge, cfg.clone());
|
|
assert_eq!(pwm.counter(), 0);
|
|
Timer::after_millis(5).await;
|
|
assert_eq!(pwm.counter(), 0);
|
|
pin2.set_low();
|
|
Timer::after_millis(1).await;
|
|
pin2.set_high();
|
|
assert_eq!(pwm.counter(), 1);
|
|
Timer::after_millis(1).await;
|
|
assert_eq!(pwm.counter(), 1);
|
|
}
|
|
|
|
info!("Test OK");
|
|
cortex_m::asm::bkpt();
|
|
}
|