/*-----------------------------------------------------------------------* 
| CSE MODELLIERUNGSTAGE 2015                                             |
| Zweipunkt-Regelung: Autmatische Abstandsregelung mit Ultraschallsensor  |
| 01.06.2015  Tim Wagner                                                 |
*-----------------------------------------------------------------------*/



#define Abstand_max 30		 //Definition des maximalen Abstandes zum Objekt 


task main()
{


 //Countdown

 PlayTone(400, 500);            
 Wait(800);
 
 PlayTone(400, 500);            
 Wait(800);
 
 PlayTone(800, 600);            
 Wait(600); 


//Initialisierung des Ultraschallsensors

SetSensorLowspeed(IN_1);


//Start der 2 Punkt Regelung in einer "unendlichen" Schleife

while(true)
 {
 if(SensorUS(IN_1)> Abstand_max)   //Wenn der Abstand größer als Abstand_max ist, fahre vorwärts,
                                   //wenn er kleiner als "Abstand_max" ist, fahre rückwärts.

  {
     OnFwd(OUT_AB, -60);           // negative Geschwindigkeit, da unser Modell sonst falschherum fahren würde
  }
 else
  {
     OnRev(OUT_AB, -60);
  }


 
 }

}