 #define echoPin 5
 #define servoPin 4
 
+#define treshold 1800
 #define REVERSE_SPEED     200 // 0 is stopped, 400 is full speed
 #define TURN_SPEED        400
 #define FORWARD_SPEED     100

    delay(REVERSE_DURATION);
    motors.setSpeeds(-TURN_SPEED, TURN_SPEED);
    delay(TURN_DURATION);
    motors.setSpeeds(FORWARD_SPEED, FORWARD_SPEED);
  }
}


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