         break;
         
         case '1':
-          Serial.print(F("Case 1\n"));
-          
+          Serial.print(F("Case 1: set a val\n"));
+          setMCReg();
+          Serial.print(F(menuCAN));
         break;
         
         case '2':
-          Serial.print(F("Case 2\n"));
-          
+          Serial.print(F("Case 2: read a val\n"));
+          readMCReg();
+          Serial.print(F(menuCAN));
+        break;
+
+        case '3':
+          Serial.print(F("Case 3: config polling from MC\n"));
+          //configMCPolling();
+          Serial.print(F(menuCAN));
         break;
         
         default:


#include <FlexCAN.h>
#include <TimerOne.h>

const char *menuMain =
  "\nWelcome to EVOS!\n"

    rx_byte = Serial.read();

    //discard anything more than one char long
    clearSerialBuf();
    
    Serial.print("You typed: ");
    Serial.println(rx_byte);
