WORKING: IOManagement input pins are correct

* Change IOManagement timer to TIM2 to not conflict with motor_control
* Remove remnants of MC_ON being an output pin
* Add testing code in main.cpp for IOManagement inputs

Author: bquan0

src/IOManagement.cpp

@@ -32,8 +32,8 @@ void initIO() {
     }
 }
 
-void readIO() 
-{
+void readIO() {
+    digital_data.mc_on = digitalRead(MC_ON);
     digital_data.park_brake = digitalRead(PRK_BRK_TELEM);
 
     acc_in = readADC(ADC_CHANNEL_11); // PA_6
@@ -54,11 +54,6 @@ void set_eco_mode(bool eco){
     digital_data.eco_mode = eco;
 }
 
-void set_mc_on(bool mc_on){
-    digital_data.mc_on = mc_on;
-    digitalWrite(MC_ON, mc_on);
-}
-
 void writeAccOut(float newAccOut) {
     acc_out = newAccOut;
     analogWrite(PA5, acc_out);

src/main.cpp

@@ -6,6 +6,8 @@
 
 CANPDC canBus(CAN1, DEF);
 
+uint8_t counter = 0;
+
 void setup() {
   Serial.begin(115200);
   initIO();
@@ -15,4 +17,23 @@ void setup() {
 void loop() {
   canBus.sendPDCData();
   canBus.runQueue(DATA_SEND_PERIOD);
+  counter++;
+  if (counter >= 10) {
+    counter = 0;
+
+    // clear the screen
+    printf("\e[1;1H\e[2J");
+
+    // digital inputs 
+    printf("mc_on: %d\n", digital_data.mc_on);
+    printf("park_brake: %d\n", digital_data.park_brake);
+    
+    // analog inputs
+    printf("acc_in: %f\n", acc_in);
+    printf("12V: %f\n", lv_12V_telem);
+    printf("5V: %f\n", lv_5V_telem);
+    printf("5V current: %f\n", lv_5V_current);
+    printf("current in: %f\n", current_in_telem);
+    printf("brake pressure: %f\n", brake_pressure_telem);
+  }
 }