     setRightSpeed( -100 );
     delay(5000);
     stopMotors();
+    return;
   }
 
   if(TOUPIE_2) {

    setRightSpeed(100);
    delay(1000);
    stopMotors();
  }

  if (!hasCalibrate) {

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

IntervalTimer ultraTimer;
IntervalTimer motorTimer;
