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

@@ -12,7 +12,7 @@ volatile float current_in_telem = 0;
 volatile float brake_pressure_telem = 0;
 
 // Ticker to poll input readings at fixed rate
-STM32TimerInterrupt IOTimer(TIM7);
+STM32TimerInterrupt IOTimer(TIM2);
 
 void initIO() {
     pinMode(MCU_DIR, OUTPUT);
@@ -35,6 +35,7 @@ void initIO() {
 
 void readIO() 
 {
+    digital_data.mc_on = digitalRead(MC_ON);
     digital_data.mc_speed_sig = digitalRead(MCU_SPEED_SIG);
     digital_data.park_brake = digitalRead(PRK_BRK_TELEM);
 
@@ -56,11 +57,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

@@ -5,6 +5,8 @@
 
 CANPDC canBus(CAN1, DEF);
 
+uint8_t counter = 0;
+
 void setup() {
   Serial.begin(115200);
   initIO();
@@ -13,4 +15,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);
+  }
 }