capture4.rs

//! Input capture using TIM4

#![deny(unsafe_code)]
#![deny(warnings)]
#![feature(proc_macro)]
#![no_std]

extern crate blue_pill;
#[macro_use]
extern crate cortex_m;
extern crate cortex_m_rtfm as rtfm;
extern crate nb;

use blue_pill::time::Milliseconds;
use blue_pill::{Capture, Channel};
use blue_pill::prelude::*;
use rtfm::app;

// CONFIGURATION
const RESOLUTION: Milliseconds = Milliseconds(1);

app! {
    device: blue_pill::stm32f103xx,

    idle: {
        resources: [ITM, TIM4],
    },
}

fn init(p: init::Peripherals) {
    let capture = Capture(p.TIM4);

    capture.init(RESOLUTION, p.AFIO, p.GPIOB, p.RCC);
}

fn idle(r: idle::Resources) -> ! {
    const CHANNELS: [Channel; 4] =
        [Channel::_1, Channel::_2, Channel::_3, Channel::_4];

    let capture = Capture(&*r.TIM4);

    for c in &CHANNELS {
        capture.enable(*c);
    }

    loop {
        for c in &CHANNELS {
            match capture.capture(*c) {
                Ok(snapshot) => {
                    iprintln!(&r.ITM.stim[0], "{:?}: {:?} ms", c, snapshot);
                }
                Err(nb::Error::WouldBlock) => {}
                Err(nb::Error::Other(e)) => panic!("{:?}", e),
            }
        }
    }
}