1 files changed, 42 insertions, 0 deletions
diff --git a/src-riscv/usb.rs b/src-riscv/usb.rs
new file mode 100755
index 0000000..1ec36af
--- /dev/null
+++ b/src-riscv/usb.rs
@@ -0,0 +1,42 @@
+use gd32vf103xx_hal::pac;
+use gd32vf103xx_hal::gpio::{Input, Floating, gpioa::{PA11, PA12}};
+use gd32vf103xx_hal::time::Hertz;
+pub use synopsys_usb_otg::UsbBus;
+use synopsys_usb_otg::UsbPeripheral;
+
+#[allow(dead_code)]
+pub struct USB {
+    pub usb_global: pac::USBFS_GLOBAL,
+    pub usb_device: pac::USBFS_DEVICE,
+    pub usb_pwrclk: pac::USBFS_PWRCLK,
+    pub pin_dm: PA11<Input<Floating>>,
+    pub pin_dp: PA12<Input<Floating>>,
+    pub hclk: Hertz,
+}
+
+unsafe impl Sync for USB {}
+
+unsafe impl UsbPeripheral for USB {
+    const REGISTERS: *const () = pac::USBFS_GLOBAL::ptr() as *const ();
+
+    const HIGH_SPEED: bool = false;
+    const FIFO_DEPTH_WORDS: usize = 320;
+    const ENDPOINT_COUNT: usize = 4;
+
+    fn enable() {
+        let rcu = unsafe { &*pac::RCU::ptr() };
+
+        riscv::interrupt::free(|_| {
+            // Enable USB peripheral
+            rcu.ahben.modify(|_, w| w.usbfsen().set_bit());
+
+            // Reset USB peripheral
+            rcu.ahbrst.modify(|_, w| w.usbfsrst().set_bit());
+            rcu.ahbrst.modify(|_, w| w.usbfsrst().clear_bit());
+        });
+    }
+
+    fn ahb_frequency_hz(&self) -> u32 {
+        self.hclk.0
+    }
+}