   // during testing. [In future we will add the option for controlling the stage through
   // the USB port]
   Serial.begin(115200);
-  if (doSerialInterface){
-    if (!controlViaUSB){
-       Serial1.begin(115200);
-        SerialComms = &Serial1;
-         SerialComms->println("test");
-
-     } else {
-         SerialComms = &Serial;
-         SerialComms->println("test");
-
-     }
-  } //if doSerialInterface
 
 
 


  //Move based on serial commands 
  if (doSerialInterface){
    if (SerialComms->available()){
        char ch=Serial1.read(); //read first character
        if (ch=='g') //Absolute and relative motion
          serialMove(); 

//------------------------------------------------------------------------------------------------
// * Enable/disable major OpenStage functions 
//
bool doSerialInterface=1; //Set to 1 to communicate with the stage via a PC serial port. See setup() for serial port IDs.
bool doGamePad=1; //Set to 1 to enable PS3 DualShock as an input device
bool doLCD=1; //Set to 1 to enable LCD character display

