Robosled

Robosled sledi črni progi na beli podlagi. Sestavljen je lahko na več različnih načinov. Mi bomo obravnavali sestavljanje in delovanje robosleda, zgrajenega z enostavnimi analognimi komponentami, ki jih lahko dobimo v vsaki prodajalni z elektronskim materialom. Hhrati bomo spoznali veliko koristnih informacij glede uporabe operacijskega ojačevalnika.

Slika 1: Robosled

Za zaznavanje proge črne barve, robosled uporablja fotoupor (LDR - Light Dependet Resistor) kot senzor svetlobe, zgrajen iz kadmijevega sulfida (CdS) in visokosvetlečo modro LED (Light Emitting Diode) diodo. LED dioda osvetljuje površino pod fotouporom. Fotoupor pa prejema odbito svetlobo. Od bele podlage se odbije več svetlobe kot od črne podlage. Fotoupor zato zazna črno progo, po kateri se s pomočjo ustreznega krmiljenja enosmernih (DC - Direct Current) motorčkov premika robosled, kot kaže slika 2:

 

Slika 2: Premikanje robosleda po črni progi

 Fotouporu se spreminja upornost v odvisnosti od svetlobe. Bolj je osvetljen, manjša je njegova upornost. Če se nanj odbija svetloba visokosvetleče LED diode od bele podlage, je njegova upornost okoli 1 kΩ, od črne podlage pa okoli 40 kΩ. Naš robosled vsebuje dva fotoupora in dve LED diodi. Vsak na način, ki ga bomo spoznali krmili enosmerni motorček, levi fotoupor krmili levi motorček, desni fotoupor pa desnega.

Najenostavnejši način pomikanja robosleda po progi je ta, da vklapljamo in izklapljamo levi oziroma desni motorček. Če hočemo da robosled zavije v desno, kot prikazuje slika 2, moramo večkrat za kratek čas izklopiti desni motorček, vsakokrat, ko fotoupor zazna črno progo. Ta metoda bi delovala, vendar bi se robosled pomikal cik - cak.

Boljša je metoda kontrole hitrosti vrtenja obeh motorčkov, levega in desnega. V desnem ovinku se desni motorček ne ustavi, temveč se vrti počasneje. V tem primeru moramo motorčka krmiliti z ustreznimi impulzi določene frekvence oziroma s pulzno širinsko moduliranim (PWM - Pulse Width Modulation) signalom.

 Slika 3: PWM signal in povprečna vrednost napetosti na motorčku

PWM signal je v bistvu sestavljen iz pravokotnih impulzov konstantne frekvence. Razmerje širine impulza proti periodi imenujemo duty cikel in je izraženo v odstotkih. PWM duty cikel, izražen v odstotkih, ustreza povprečni moči tega pulznega signala.

Če PWM signal priključimo na enosmerni motorček, lahko reguliramo njegovo hitrost vrtenja. Pri različnem duty ciklu bo tudi hitrost vrtenja enosmernega motorčka različna. Kadar bo fotoupor pri robosledu nad belo podlago in bo zato prejemal več odbite svetlobe, bo duty cikel višji. Motorček se bo vrtel hitreje. Kadar pa se bo fotoupor nahajal nad črno podlago in bo prejemal manj odbite svetlobe, bo duty cikel nižji. Motorček se bo vrtel počasneje.

Slika 4: Prikaz delovanja robosleda, blok shema

 Električni načrt robosleda prikazuje slika 5. Sestavljen je iz več sklopov, katerih vlogo bomo podrobno spoznali v nadaljevanju. Glavni element vezja je integrirano vezje LM324, ki vsebuje štiri operacijske ojačevalnike. R13 in R14 sta fotoupora, ki od podlage prejemata odbito svetlobo, ki jo emitirata LED1 za levi fotoupor in LED2 za desni fotoupor. V kolektorskem tokokrogu tranzistorjev BC639 sta priključena levi in desni motorček robosleda. 

Slika 5: Robosled, električni načrt

Za sestavo robosleda potrebujemo naslednje elemente:

PWM signal v robosledu:

Glavni element vezja robosleda oziroma njegovi možgani predstavlja integrirano vezje LM324. Vezje za generiranje in regulacijo PWM signala potrebuje trikotni signal, ki ga proizvaja generator trikotnih impulzov, napetost na posameznem fotouporu, ki se spreminja v odvisnosti od odbite svetlobe ter komparator, ki ta dva signala primerja. 

Slika 6: PWM izhod komparatorja

  Ko vrednost trikotnega signala doseže vrednost napetosti na fotouporu, bo na izhodu komparatorja napetost, ker je napetost na neinvertirujočem vhodu (U+) večja od napetosti na invertirujočem vhodu (U-). Ko pa vrednost trikotnega signala pade pod vrednost napetosti na fotouporu, na izhodu komparatorja ne bo napetosti, ker je napetost na invertirujočem vhodu (U-) večja od napetosti na neinvertirujočem vhodu (U+) komparatorja.

Komparator:

Komparator ali primerjalnik primerja napetosti, ki jih dobi na neinvertirujoči vhod (U+) in invertirujoči vhod (U-). V našem primeru predstavlja prvo vrednost napetosti trikotnega signala, drugo pa vrednost napetosti na fotouporu.

 Slika 7: Komparator primerja dve napetosti

Vrednost trikotnega signala je stalno enaka in je odvisna od generatorja trikotnih impulzov. Vrednost napetosti na fotouporu pa je odvisna od prejete odbite svetlobe, ki jo oddaja LED dioda. V odvisnosti od podlage je lahko odbite svetlobe manj ali več. Zato se ta napetost spreminja. Nivo napetosti na fotouporu in s tem umerjanje robosleda lahko nastavljamo s spreminjanjem upornosti trimer potenciometra Rpot, saj mora biti v območju napetosti trikotnega signala.

Slika 8: Izhod komparatorja v odvisnosti od vhodnih napetosti

Slika 9: Generator trikotnih impulzov

Slika 8 prikazuje izhod komparatorja v odvisnosti od vhodnih napetosti. Kadar je napetost na neinvertirujočem vhodu (U+) večja od napetosti na invertirujočem vhodu (U-), je na izhodu komparatorja napetost (logično stanje 1). Čas trajanja te izhodne napetosti komparatorja je odvisna od tega, kako dolgo je napetost na U+ večja od napetosti U-. Od izhodnih pravokotnih impulzov komparatorja je odvisna povprečna napetost teh impulzov in posledično hitrost vrtenja enosmernega motorčka.

 Generator trikotnih impulzov:

Zdaj ko poznamo princip delovanja robosleda, si podrobneje poglejmo vezje generatorja trikotnih impulzov.

 Generator trikotnih impulzov potrebuje vezje Schmittovega prožilnika (Schmitt trigger), ki v bistvu predstavlja ON - OFF stikalo kot vhod za integrator. Integrator za generiranje trikotnih impulzov uporablja kondenzator C1 in upor R5.

Ko je izhod Schmittovega prožilnika (Uizh -U1A) na potencialu logične 1, se začne kondenzator C1 polniti preko upora R5. Ker sta C1 in R5 priključena na invertirujoči vhod operacijskega ojačevalnika U1B, bo začela vrednost trikotnega impulza padati. Neinvertirujoči vhod operacijskega ojačevalnika U1A je povezan z R3 in R4 in ko izhodna napetost operacijskega ojačevalnika U1B doseže spodnji prag napetosti (Upr), izhod operacijskega ojačevalnika U1A preklopi v stanje logične 0. Vrednost spodnjega praga napetosti (Upr) lahko izračunamo:

 

Upr = (R4 (Uizh -U1A - Uizh -U1B) / (R3 + R4) + Uizh -U1B            Uizh -U1A = Vcc            Upr <= Uref                (<= manjše ali enako)

                                                                                             Vcc = 5 V                    Uref = 0,41 V

 

Uref = R2 / (R1 + R2) Vcc = 33 / 80 Vcc = 0,41 V

 

(R4 (Vcc - Uizh -U1B) / (R3 + R4) + Uizh -U1B <= 0,41 Vcc

 

Ko vstavimo vrednosti vseh uporov dobimo rezultat:

(47 (Vcc - Uizh -U1B) / 147) + Uizh -U1B <= 0,41 Vcc

0,32 (5 - Uizh -U1B) + Uizh -U1B <= 2,05

1,6 - 0,32 Uizh -U1B + Uizh -U1B <= 2,05

Uizh -U1B <= 0,66 V

 Vrednost spodnje napetosti trikotnega signala (Uizh -U1B) je okoli 0,66 V. Ko napetost pade na to vrednost, izhod Schmittovega prožilnika (Uizh -U1A) preklopi na potencial logične 0. Sedaj se začne kondenzator C1 prazniti preko upora R5. Napetost na izhodu operacijskega ojačevalnika U1B bo začela naraščati. Ko izhodna napetost operacijskega ojačevalnika U1B doseže zgornji prag napetosti (Upr), izhod operacijskega ojačevalnika U1A preklopi v stanje logične 1 in postopek se začne ponavljati. Vrednost zgornjega praga napetosti (Upr) lahko izračunamo: 

 

Upr = (R4 (Uizh -U1A - Uizh -U1B) / (R3 + R4) + Uizh -U1B            Uizh -U1A = 0 V            Upr >= Uref                (>= večje ali enako)

                                                                                             Vcc = 5 V                    Uref = 0,41 V 

Uref = R2 / (R1 + R2) Vcc = 33 / 80 Vcc = 0,41 V 

(R4 (Vcc - Uizh -U1B) / (R3 + R4) + Uizh -U1B >= 0,41 Vcc

0,32 (- Uizh -U1B) + Uizh -U1B >= 2,05

Uizh -U1B >= 3,01 V

Slika 10: Pravokotni impulzi na izhodu Schmittovega prožilnika in trikotni impulzi na izhodu generatorja trikotnih impulzov

 Trikotni impulz na izhodu vezja torej narašča od vrednosti 0,66 V do 3,01 V in pada od vrednosti 3,01 V do napetosti 0,66 V. Ta postopek se ponavlja. Frekvenco trikotnih imulzov lahko izračunamo: 

f = (1 / (4 x R5 x C1)) x (R3 / R4) = (1 / (4 x 36000 x 0,0000001)) x (100000 / 47000) = 147,75 Hz

Če želimo frekvenco spreminjati, lahko zaporetno z uporom R5 vežemo ustrezni trimer potenciometer, npr. vrednosti 100 kohm.

 

Senzorja za robosled:

Kot je omenjeno na začetku, robosled za zaznavanje črne proge uporablja dva fotoupora, na katera se od podlage odbija svetloba visokosvetlečih LED diod. Na sliki 11 je prikazana pozicija obeh fotouporov in LED diod.

Slika 11: Senzorja za robosled, dve visokosvetleči LED diodi in dva LDR upora

   Izdelava robosleda:

1. Na osnovno ploščico tiskanega vezja po načrtu zaspajkamo elemente vezja:

Slika 12: Osnovna plošča tiskanega vezja

Pozorni moramo biti pri vstavljanju LED diode (LED zelena), obeh diod 1N4148  ter kondenzatorjev 1 µF in 47 µF, da jih pravilno obrnemo, saj imajo pozitivno in negativno sponko. Integriranega vezja LM 324 ne spajkamo v ploščico temveč ga vstavimo z podnožje. To je predhodno zaspajkamo v ploščico. Polzareza podnožja mora biti obrnjena, kot prikazuje slika. S tem preprečimo napačno vstavljanje integriranega vezja LM 324 v podnožje.Tranzistorja BC 639 zaspajkamo v ploščico, kot je prikazano na sliki.

Ploščica s senzorjema vsebuje dva fotoupora LDR in dve visokosvetleči LED diodi (modri). Paziti moramo, da sta LED diodi pravilno povezani (anoda je pozitivna, katoda pa negativna elektroda).

Oddaljenost ploščice s senzorjema od osnovne ploščice je odvisna od konstrukcije izdelanega robosleda. Oddaljenost ploščice s senzorjema od osovine koles vpliva na uspešnost sledenja črni liniji, predvsem v ovinkih.

Servo motorčka RS-2 moramo predelati, kar je vidno tudi na kratkem posnetku izdelave oziroma sestavljanja robosleda:

Konstrukcija robosleda je lahko poljubna. Na video posnetku je le ena od možnih variant. Pri delu vam želim obilo uspeha in zadovoljsta. Poglejmo še video posnetek robosleda: