 }
 
 
-
+void stopRobot(){
+
+  motorAllStop();
+
+  // send reply message
+  Serial.println("Robot stopped");
+  
+}
 
 void moveRobotForward(int power){
 
   //motorStop(0); // this might be useful, in the case the robot is already in a turning move
   
-  motorForward(1,power);
-  motorForward(2,power);
+  motorForward(FRONT_LEFT_MOTOR,power);
+  motorForward(FRONT_RIGHT_MOTOR,power);
 
   // need to create a reply message to let the PC acknowledge the accepted request and execution
   Serial.println("Robot forward");

    String c = Serial.readString();
    
    // inital test to see if message is recieved (delete afterwards)
    // 
    Serial.println(c);


      // need to check if signuture is our teams first!

  motorAllStop(); // use this for now, can change later on

  // set motors for left rotation
  motorForward(FRONT_RIGHT_MOTOR,power);
  motorForward(TURNING_MOTOR,power);

  // send reply message 
  Serial.println("Robot left");
