1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859 |
- //! Testing the Quadrature Encoder Interface
- #![deny(unsafe_code)]
- #![deny(warnings)]
- #![no_main]
- #![no_std]
- extern crate panic_semihosting;
- use cortex_m_semihosting::hprintln;
- use stm32f1xx_hal::{
- prelude::*,
- pac,
- delay::Delay,
- qei::Qei,
- };
- use cortex_m_rt::entry;
- #[entry]
- fn main() -> ! {
- let dp = pac::Peripherals::take().unwrap();
- let cp = cortex_m::Peripherals::take().unwrap();
- let mut flash = dp.FLASH.constrain();
- let mut rcc = dp.RCC.constrain();
- let clocks = rcc.cfgr.freeze(&mut flash.acr);
- let mut afio = dp.AFIO.constrain(&mut rcc.apb2);
- // let gpioa = dp.GPIOA.split(&mut rcc.apb2);
- let gpiob = dp.GPIOB.split(&mut rcc.apb2);
- // TIM2
- // let c1 = gpioa.pa0;
- // let c2 = gpioa.pa1;
- // TIM3
- // let c1 = gpioa.pa6;
- // let c2 = gpioa.pa7;
- // TIM4
- let c1 = gpiob.pb6;
- let c2 = gpiob.pb7;
- let qei = Qei::tim4(dp.TIM4, (c1, c2), &mut afio.mapr, &mut rcc.apb1);
- let mut delay = Delay::new(cp.SYST, clocks);
- loop {
- let before = qei.count();
- delay.delay_ms(1_000_u16);
- let after = qei.count();
- let elapsed = after.wrapping_sub(before) as i16;
- hprintln!("{}", elapsed).unwrap();
- }
- }
|