1 files changed, 39 insertions, 0 deletions
diff --git a/hal/hwconfig.cpp b/hal/hwconfig.cpp
new file mode 100644
index 0000000..a3b4b46
--- /dev/null
+++ b/hal/hwconfig.cpp
@@ -0,0 +1,39 @@
+#include "hwconfig.hpp"
+
+extern "C" {
+#include <xc.h>
+}
+
+void hw::reglock()
+{
+    SYSKEY = 0x00000000; 
+}
+
+void hw::regunlock()
+{
+    SYSKEY = 0x12345678;
+    SYSKEY = 0xAA996655;
+    SYSKEY = 0x556699AA;
+}
+
+void osc::initialize()
+{
+    hw::regunlock(); 
+    // CF no clock failure; COSC FRCDIV; PLLODIV DIV_256; UFRCEN disabled; PBDIVRDY disabled; SLOCK out of lock; FRCDIV FRC/1; SLPEN Idle on WAIT instruction; NOSC FRCDIV; PLLMULT MUL_24; SOSCEN disabled; PBDIV DIV_8; CLKLOCK unlocked; OSWEN Switch is Complete; SOSCRDY disabled; 
+    OSCCON = 0x381F7700;
+    hw::reglock();
+    // TUN Center Frequency; 
+    OSCTUN = 0x0;
+    // DIVSWEN disabled; RSLP disabled; ACTIVE Active; ROSEL SYSCLK; OE Not Driven out on REFCLKO pin; SIDL disabled; RODIV 0; ON disabled; 
+    REFOCON = 0x100;
+    // ROTRIM 0; 
+    REFOTRIM = 0x0;
+}
+
+void interrupts::initialize()
+{
+    //  Enable the multi vector
+    INTCONbits.MVEC = 1;
+    //  Enable Global Interrupts 
+    __builtin_mtc0(12,0,(__builtin_mfc0(12,0) | 0x0001));
+}
+\ No newline at end of file