6. Ultrasonic sensor

Ultrasonic sensor pracuje jak sonar, czyli wysyła ultradźwięki i mierzy czas w jakim powrócą one po odbiciu od obiektu.
Wykorzystując ten sensor można zbudować robota, który unika przeszkód.

Zbuduj robota Explorer instrukcja.

Sensor Ultrasonic podłączony jest do portu_4. Robot działa w pętli, jedzie do przodu dopóki odległość od przeszkód jest większa niż 30 cm, następnie cofa się, skręca i znowu jedzie do przodu.

instrukcja SetSenorUltrasonic(IN_4) deklaruje sensor ultradźwiękowy.

Kolejny program sprawi, że robot będzie rozglądał się w prawo i w lewo, mierząc odległość od przeszkód i obróci się w kierunku, w którym jest dalej od przeszkody. Ultrasonic sensor umieszczony jest na głowie, która podłączona jest do silnika C. Komenda RotateMotor(OUT_C, 75, 90) powoduje obrót z prędkością 75 o kąt 90 stopni.
 Przed task main należy zadeklarować zmienne integer: i, p.

int p, l;

Zadania:

1. Ustaw robota w odległości 1.5 metra od przeszkody. Robot nie może zbliżyć się do przeszkody na odległość mniejszą niż 40 cm i oddalić na odległość większą niż 2 m.

2. Ustaw robota między dwoma równoległymi ścianami (przeszkodami). Robot ma się ustawić pośrodku ścian.