Śledzenie linii – czujnik światła

Transkrypt

Śledzenie linii – czujnik światła
ledzenie linii – czujnik wiatøa
1
2
3
4
5
6
7
8
9
Zrób program wedøug nast puj cego wzoru :
Rozwi zanie pierwsze :
Ustawienia górnej pary silników
Ustawienia dolnej pary silników
Rozwi zanie drugie :
Wewn trz p tli mo liwe jest bardzo szybkie sprawdzanie czujnika wiatøa, który okre la ilo wiatøa w liczbach od 0 do 100.
Je li jest biaøy, to odczyt jest 100 jednostek, je li czarny, to odczyt wynosi 0 jednostek.
50 jednostek oznacza, e jeste my dokøadnie na rodku granicy czerni i bieli.
Naszym celem jest, aby go utrzyma , jak døugo to jest tylko mo liwe. Program sprawdza w którym momencie odczyt jest
najbardziej poprawny i w razie pogorszenia parametrów stara si go skorygowa .
Aby to zrobi , za pomoc zmiennej zliczaj cej odczyt z czujnika wiatøa zostaø podzielony przez 20. Otrzymujemy przez to pi
zakresów pracy.
Nast pnie za pomoc przeø cznika zostaøo okre lonych pi
rodzajów ruchu silnika.
W zale no ci od odczytu robot wykona nast puj cy ruch :
0 = mocny skr t w prawo, znacznie zmniejszaj c moc silnika C
1 = søaby skr t w prawo, nieznacznie zmniejszaj c moc silnika C
2 = odczyt redni, równa praca obu silników
3 = søaby obrót w lewo , lekko zmniejszaj c moc silnika B
4 = mocny obrót w lewo , znacznei zmniejszaj c moc silnika B
Poszczególne bloki silnikowe s wykorzystywane do sterowania ka dego koøa zamiast bloku wspóønego.
Nale y pami ta , e ruch jest " do tyøu ", bo silniki s montowane w robocie " do tyøu ".
Czas ruchu jest "unlimited" - nieograniczony, dlatego, e p tla ma sprawdza odczyt z czujnika w kóøko, caøy czas, aby reagowa
na zmiany odczytu czujnika i w razie potrzeby szybko zmieni kierunek ruchu. ("nieograniczony" oznacza tutaj "jed w ten
sposób, a ci powiem inaczej")

Podobne dokumenty