 }
 
 void rotateServoNext() {
+  Serial.println("SERVO POSITION:");
   Serial.println(servoPosition);
   if (servoPosition > 160 || servoPosition < 20) {
     flipServo = !flipServo;
   }
   if (flipServo) {
-     rotateServo((servoPosition + 20) % 181);
+     rotateServo(servoPosition + 10);
   } else {
-      rotateServo((servoPosition - 20) % 0);
+      rotateServo(servoPosition - 10);
   }
 }
 
 void rotateServo(int sPosition) {
   servo.write(sPosition);
   servoPosition = sPosition;
-  delay(100);
+  delay(50);
 }
 
 void killOpponent(int positionServo, double distance) {

#define echoPin 5
#define servoPin 4

#define REVERSE_SPEED     200 // 0 is stopped, 400 is full speed
#define TURN_SPEED        400
#define FORWARD_SPEED     100

      motors.setSpeeds(0, 0);
    }
    rotateServo(90);
    flipServo = !flipServo;
    delay(200);
  }
}
