From a04cf2dbb8d2e890405fbf0a1022aaad3015b1e8 Mon Sep 17 00:00:00 2001
From: Christian Cunningham <cc@localhost>
Date: Fri, 26 Aug 2022 17:25:34 -0700
Subject: Modularize

---
 src/bsp/drivers/gpio/mod.rs | 28 ++++++++++++++++++++++++++++
 1 file changed, 28 insertions(+)
 create mode 100644 src/bsp/drivers/gpio/mod.rs

(limited to 'src/bsp/drivers/gpio')

diff --git a/src/bsp/drivers/gpio/mod.rs b/src/bsp/drivers/gpio/mod.rs
new file mode 100644
index 0000000..a94c6e5
--- /dev/null
+++ b/src/bsp/drivers/gpio/mod.rs
@@ -0,0 +1,28 @@
+/// # GPIO Register
+pub mod GPPUD {
+    const ADDR: u32 = 0x3F200094;
+    pub fn set(v: u32) {
+        use crate::cpu::store32;
+        store32(ADDR, v)
+    }
+    pub fn clear() {
+        set(0)
+    }
+}
+/// # GPIO Clock 0 Register
+pub mod GPPUDCLK0 {
+    const ADDR: u32 = 0x3F200098;
+    const MASK: u32 = (1 << 14) | (1 << 15);
+    pub fn set(v: u32) {
+        use crate::cpu::store32;
+        store32(ADDR, v)
+    }
+    pub fn init() {
+        use crate::cpu::spin_for_n_cycles;
+        super::GPPUD::clear();
+        spin_for_n_cycles(150);
+        set(MASK);
+        spin_for_n_cycles(150);
+        set(0);
+    }
+}
-- 
cgit v1.2.1