Implemented 31kHz PWM output

AdditiveControlCode/AdditiveControlCode.ino

@@ -2,6 +2,7 @@
 #include "IndSensorMap.hpp"
 #include "Controller.hpp"
 #include "ADC.hpp"
+#include "FastPWM.hpp"
 
 // K, Ki, Kd Constants
 Constants repelling = {1000, 0, 10000};
@@ -50,6 +51,7 @@ int ON = 0;
 void setup() {
   Serial.begin(115200);
   setupADC();
+  setupFastPWM();
 
   indL.alpha = alphaVal;
   indR.alpha = alphaVal;

AdditiveControlCode/FastPWM.cpp

@@ -0,0 +1 @@
+../lib/FastPWM.cpp

AdditiveControlCode/FastPWM.hpp

@@ -0,0 +1 @@
+../lib/FastPWM.hpp