     stopMotors();
   }
 
+  if(TOUPIE_2) {
+    while (!digitalRead(JUMPER_PIN));
+    while (digitalRead(JUMPER_PIN));
+    setLeftSpeed(100);
+    setRightSpeed(100);
+    delay(500);
+    setLeftSpeed(-100);
+    setRightSpeed(-100);
+    delay(200);
+    setRightSpeed(100);
+    delay(1000);
+    stopMotors();
+  }
+
   if (!hasCalibrate) {
     // Turn for calibrate with potard rotation before the match
     Serial.println(getRotateDelay());

  //  stopMotors();

  // Tempo before start.
  //delay(START_TIMER);

  // Forward
  goForward(30, 950); // 900 before morning calibration ;)

#define ULTRASOUND true // Disable ultrason if false

// Goodies mode
#define TOUPIE false
#define TOUPIE_2 false

IntervalTimer ultraTimer;
IntervalTimer motorTimer;
