#![no_main]
#![no_std]
use log::info;
use libdaisy::logger;
use stm32h7xx_hal::adc;
use stm32h7xx_hal::stm32;
use stm32h7xx_hal::timer::Timer;
use libdaisy::gpio::*;
use libdaisy::hid;
use libdaisy::prelude::*;
use libdaisy::system;
#[rtic::app(
device = stm32h7xx_hal::stm32,
peripherals = true,
monotonic = rtic::cyccnt::CYCCNT,
)]
const APP: () = {
struct Resources {
led1: hid::Led<SeedLed>,
adc1: adc::Adc<stm32::ADC1, adc::Enabled>,
control1: hid::AnalogControl<Daisy15<Analog>>,
timer2: Timer<stm32::TIM2>,
}
#[init]
fn init(ctx: init::Context) -> init::LateResources {
logger::init();
let mut system = system::System::init(ctx.core, ctx.device);
system.timer2.set_freq(1.ms());
let mut led1 = hid::Led::new(system.gpio.led, false, 1000);
led1.set_brightness(0.5);
let mut adc1 = system.adc1.enable();
adc1.set_resolution(adc::Resolution::SIXTEENBIT);
let adc1_max = adc1.max_sample() as f32;
let daisy15 = system
.gpio
.daisy15
.take()
.expect("Failed to get pin daisy15!")
.into_analog();
let control1 = hid::AnalogControl::new(daisy15, adc1_max);
init::LateResources {
led1,
adc1,
control1,
timer2: system.timer2,
}
}
#[idle]
fn idle(_cx: idle::Context) -> ! {
loop {
cortex_m::asm::nop();
}
}
#[task( binds = TIM2, resources = [timer2, adc1, control1, led1] )]
fn interface_handler(ctx: interface_handler::Context) {
ctx.resources.timer2.clear_irq();
let adc1 = ctx.resources.adc1;
let led1 = ctx.resources.led1;
let control1 = ctx.resources.control1;
if let Ok(data) = adc1.read(control1.get_pin()) {
control1.update(data);
}
let value = control1.get_value();
led1.set_blink(value, 1.0 - value);
info!("{} {}", value, 1.0 - value);
led1.update();
}
};