   MS.begin();
   motor1->setSpeed(RPM);
   motor2->setSpeed(RPM);
-
-  Serial.print("Waiting for commands...");
 }
 
 

  sCmd.addCommand("S", ProcessStop);    // S\r
  sCmd.addCommand("P", ProcessGetPos);  // P\r
  sCmd.addCommand("L", ProcessLaser);   // L enable\r
  sCmd.addDefaultHandler(Unrecognized);	// Unknown commands

  // Configure interrupt speed (microseconds)

}


// Get ID
void ProcessID() {
  Serial.print("SkyPointer 1.0\r");
}


// Handles unknown commands
void Unrecognized() {
  Serial.print("NK\r");
