main.rs 5.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190
  1. #![cfg_attr(test, allow(unused_imports))]
  2. #![cfg_attr(not(test), no_std)]
  3. #![cfg_attr(not(test), no_main)]
  4. // custom panic handler
  5. #[cfg(not(test))]
  6. use core::panic::PanicInfo;
  7. use core::{cell::RefCell, ops::DerefMut};
  8. // use cortex_m::asm;
  9. use cortex_m::{interrupt::free, interrupt::Mutex, peripheral::NVIC};
  10. use cortex_m_rt::entry;
  11. // use cortex_m_semihosting::hprintln;
  12. use stm32l4xx_hal::{
  13. delay::Delay,
  14. gpio::State,
  15. gpio::{Edge, Input, Output, PullUp, PushPull, PA3, PC15},
  16. i2c::I2c,
  17. interrupt, pac,
  18. prelude::*,
  19. rcc,
  20. stm32::Interrupt,
  21. };
  22. mod tusb322;
  23. static FAULT_INT: Mutex<RefCell<Option<PA3<Input<PullUp>>>>> = Mutex::new(RefCell::new(None));
  24. static FAULT_LED: Mutex<RefCell<Option<PC15<Output<PushPull>>>>> = Mutex::new(RefCell::new(None));
  25. #[cfg(not(test))]
  26. #[entry]
  27. fn main() -> ! {
  28. // Semihosting only works if debugger is connected.
  29. // See https://github.com/rust-embedded/cortex-m/issues/289
  30. // hprintln!("Hello, world!").unwrap();
  31. // Acquire a singleton instance for the chip's peripherals
  32. let mut dp = pac::Peripherals::take().unwrap();
  33. let cp = pac::CorePeripherals::take().unwrap();
  34. // let cp = cortex_m::Peripherals::take().unwrap();
  35. // Consume the raw peripheral and return a new object that implements a higher level API
  36. let mut flash = dp.FLASH.constrain();
  37. let mut rcc = dp.RCC.constrain();
  38. let mut pwr = dp.PWR.constrain(&mut rcc.apb1r1);
  39. // Configure clocks to run at maximum frequency off internal oscillator
  40. let clocks = rcc
  41. .cfgr
  42. .pll_source(rcc::PllSource::HSI16)
  43. .sysclk(80.mhz())
  44. .hclk(80.mhz())
  45. .pclk1(40.mhz())
  46. .pclk2(40.mhz())
  47. .freeze(&mut flash.acr, &mut pwr);
  48. // Split GPIO peripheral into independent pins and registers
  49. // let mut gpiob = dp.GPIOB.split(&mut rcc.ahb2);
  50. let mut gpioa = dp.GPIOA.split(&mut rcc.ahb2);
  51. let mut gpioc = dp.GPIOC.split(&mut rcc.ahb2);
  52. // Configure fault LED output on PC15
  53. let fault_led = gpioc.pc15.into_push_pull_output_with_state(
  54. &mut gpioc.moder,
  55. &mut gpioc.otyper,
  56. State::Low,
  57. );
  58. // Store fault LED in global static variable as it is accessed in interrupts
  59. free(|cs| {
  60. FAULT_LED.borrow(cs).replace(Some(fault_led));
  61. });
  62. // Configure fault input interrupt on PA3
  63. let mut fault_int = gpioa
  64. .pa3
  65. .into_pull_up_input(&mut gpioa.moder, &mut gpioa.pupdr);
  66. fault_int.make_interrupt_source(&mut dp.SYSCFG, &mut rcc.apb2);
  67. fault_int.enable_interrupt(&mut dp.EXTI);
  68. fault_int.trigger_on_edge(&mut dp.EXTI, Edge::FALLING);
  69. // Sanity check that fault pin isn't already set (active low) before enabling interrupt
  70. if fault_int.is_high().unwrap() {
  71. // Configure NVIC mask to enable interrupt source
  72. unsafe {
  73. NVIC::unmask(Interrupt::EXTI3);
  74. }
  75. // Store fault input in global static variable as it is accessed in interrupt
  76. free(|cs| {
  77. FAULT_INT.borrow(cs).replace(Some(fault_int));
  78. });
  79. } else {
  80. panic!();
  81. }
  82. // Start with HV PSU disabled (enable pin on PA2)
  83. let mut _hv_en =
  84. gpioa
  85. .pa2
  86. .into_push_pull_output_with_state(&mut gpioa.moder, &mut gpioa.otyper, State::Low);
  87. // Configure I2C SCL
  88. let scl = gpioa
  89. .pa9
  90. .into_open_drain_output(&mut gpioa.moder, &mut gpioa.otyper);
  91. let scl = scl.into_af4(&mut gpioa.moder, &mut gpioa.afrh);
  92. // Configure I2C SDA
  93. let sda = gpioa
  94. .pa10
  95. .into_open_drain_output(&mut gpioa.moder, &mut gpioa.otyper);
  96. let sda = sda.into_af4(&mut gpioa.moder, &mut gpioa.afrh);
  97. // Initialize I2C
  98. let mut i2c = I2c::i2c1(dp.I2C1, (scl, sda), 100.khz(), clocks, &mut rcc.apb1r1);
  99. tusb322::init(&mut i2c);
  100. // Configure abstract timer that operates off systick timer
  101. let mut timer = Delay::new(cp.SYST, clocks);
  102. loop {
  103. timer.delay_ms(1000_u32);
  104. set_fault_led(State::High);
  105. timer.delay_ms(1000_u32);
  106. set_fault_led(State::Low);
  107. }
  108. }
  109. fn set_fault_led(state: State) {
  110. free(|cs| {
  111. let mut led_ref = FAULT_LED.borrow(cs).borrow_mut();
  112. if let Some(ref mut led) = led_ref.deref_mut() {
  113. match state {
  114. State::High => led.set_high().unwrap(),
  115. State::Low => led.set_low().unwrap(),
  116. };
  117. }
  118. });
  119. }
  120. #[interrupt]
  121. fn EXTI3() {
  122. free(|cs| {
  123. let mut nfault_ref = FAULT_INT.borrow(cs).borrow_mut();
  124. if let Some(ref mut nfault) = nfault_ref.deref_mut() {
  125. if nfault.check_interrupt() {
  126. // hprintln!("Fault pin interrupt triggered!").unwrap();
  127. // nfault.clear_interrupt_pending_bit();
  128. panic!();
  129. }
  130. }
  131. });
  132. }
  133. #[panic_handler]
  134. #[cfg(not(test))]
  135. /// Custom panic handler
  136. fn panic(_info: &PanicInfo) -> ! {
  137. // if let Some(location) = info.location() {
  138. // hprintln!(
  139. // "Panic in file '{}' at line {}",
  140. // location.file(),
  141. // location.line()
  142. // )
  143. // .unwrap();
  144. // } else {
  145. // hprintln!("Panic'd!").unwrap();
  146. // }
  147. set_fault_led(State::High);
  148. loop {
  149. continue;
  150. }
  151. }
  152. #[cfg(test)]
  153. mod test {
  154. use super::*;
  155. fn add(a: i32, b: i32) -> i32 {
  156. a + b
  157. }
  158. #[test]
  159. fn foo() {
  160. println!("tests work!");
  161. assert!(2 == add(1, 1));
  162. }
  163. }