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.
Brak komentarzy:
Prześlij komentarz