 void setup(){
 
   pinMode(PUSH_BUTTON,INPUT);//debug push button
-  Serial.begin(115200);
+  //Serial.begin(115200);
+  Serial.end();
 
   //Configuration data for the node
   cbus.getNodeId()->setNodeName("MODSERV",7);  //node name

  cbus.setStdNN(999); //standard node number

  if (digitalRead(PUSH_BUTTON)==LOW){
    Serial.println("Setup new memory");
    cbus.setUpNewMemory();
    cbus.setSlimMode();
    cbus.saveNodeFlags();

  cbus.initCanBus(10);  //initiate the transport layer. pin=53, rate=125Kbps,10 tries,200 millis between each try
  //create the servos object
  setUpServos();  
  //Serial.println("Setup finished");
}

void loop (){
