Implement force_reset

stm32-rs · May 11, 2021 · baac8a1 · baac8a1
1 parent ae65590
commit baac8a1
Show file tree

Hide file tree

Showing 2 changed files with 13 additions and 0 deletions.
diff --git a/Cargo.toml b/Cargo.toml
@@ -12,6 +12,7 @@ keywords = ["no-std", "embedded", "usb"]
 [dependencies]
 riscv = { version = "0.5.4", optional = true }
 cortex-m = { version = "0.6.0", optional = true }
+embedded-hal = "0.2"
 vcell = "0.1.0"
 usb-device = "0.2.2"
 

diff --git a/src/bus.rs b/src/bus.rs
@@ -1,4 +1,5 @@
 use core::marker::PhantomData;
+use embedded_hal::blocking::delay::DelayMs;
 use usb_device::{Result, UsbDirection, UsbError};
 use usb_device::bus::{UsbBusAllocator, PollResult};
 use usb_device::endpoint::{EndpointType, EndpointAddress};
@@ -126,6 +127,17 @@ impl<USB: UsbPeripheral> UsbBus<USB> {
         }
     }
 
+    pub fn force_reset(&self, delay: &mut impl DelayMs<u32>) -> Result<()> {
+        interrupt::free(|cs| {
+            let regs = self.regs.borrow(cs);
+            write_reg!(otg_device, regs.device(), DCTL, SDIS: 1); // Soft disconnect
+            delay.delay_ms(3);
+            write_reg!(otg_device, regs.device(), DCTL, SDIS: 0); // Soft connect
+            delay.delay_ms(3);
+        });
+        Ok(())
+    }
+
     #[cfg(feature = "hs")]
     /// Reads from a ULPI register in an external ULPI PHY.
     ///