   Serial.println("Max Following Error set as 5000rpm/s");
   delay(10);
   CAN.sendMsgBuf(0x601, 0, 8, set_max_profile_velocity);
-  Serial.println("Max Profile Velocity set as 2000rpm");
-  delay(10);
-  
+  Serial.println("Max Profile Velocity set as 2000rpm");  
   delay(10);
   State = Operational;
 }

    Serial.println(" Init CAN BUS Shield again");
    delay(100);
  }
  Serial.println("CAN BUS Shield init ok!");
}



void loop()
{
  switch (State) 
  {
    case Startup:
      doStartup();
      break;
    case Operational:
      dataRead();
