Elektroda.pl
Elektroda.pl
X
Elektroda.pl
Advanced Search

Search our partners

Find the latest content on electronic components. Datasheets.com
Datasheets
Elektroda.pl
Popular Topics
Please add exception to AdBlock for elektroda.pl.
If you watch the ads, you support portal and users.

[Line Follower] Nimbus2000

petter0 23 Jun 2012 00:28 11431 29
IGE-XAO
Reply Cool? Ranking DIY | New topic
  • [Line Follower] Nimbus2000

    Witam!
    Chciałbym przedstawić mojego pierwszego robota klasy linefollower. Co prawda daleko mu do konstrukcji Botland Teamu, ale myślę, że wyszedł całkiem nieźle.
    Jego konstrukcja i użyte elementy są dość standardowe jak dla tego typu robotów, dlatego tylko pokrótce opisze najważniejsze z nich.

    Elektronika
    Sercem robota jest mikrokontroler ATmega 8 taktowany wewnętrznym oscylatorem 8MHz. Za wykrywanie linii odpowiedzialne są czujniki CNY70, które podłączone są do komparatorów LM339. Sterowanie silnikami odbywa się sygnałem PWM poprzez dwukanałowy mostek L298. Dodatkowo na płytce znajduje się 7 diod LED wskazujących stan czujników, oraz bramki NOT i NAND o których powiem później. Do zasilania użyty został akumulatorek LiPol 11.1V 800mAh, co wystarcza średnio na 10 minut ciągłej jazdy przy średnim wypełnieniu PWM. Napięcie jest stabilizowane przez układ LM7805 i filtrowane przez kilka kondensatorów.

    Mechanika
    Podstawą konstrukcji robota jest dwustronna płytka wykonana metodą termotransferu. Z tyłu znajdują się dwa koła napędzane mikrosilnikami Pololu o przełożeniu 30:1. Z przodu - tradycyjnie ball caster 3/8 cala. Do odprowadzania ciepła z mostka i stabilizatora służy radiator wycięty z kawałka aluminium.

    Program
    Cały napisany został w C. Do programowania służy gniazdo znajdujące się obok mikrokontrolera. Program miał już miliard wersji i nadal pozostawia wiele do życzenia. Chodzi mi głównie o to, by móc wykorzystać w pełni moc silników, a nie jak dotąd maksymalnie 50%. Przy wyższych współczynnikach robot po prostu nie nadąża 'ogarniać' trasy.

    Sterowanie
    Początkowo robot miał działać w ten sposób, że gdy środkowy czujnik wykrywa linię to układ znajduje się w stanie równowagi. Natomiast kiedy inny czujnik wykryje linie układ wychodzi z tego stanu dając poprzez bramkę NAND przerwanie zewnętrzne do mikrokontrolera. Ten sprawdza który z czujników wykrywa linię i podejmuje odpowiednią akcję regulując wartość PWM silniczków. Dzieje się to do chwili kiedy układ znów znajdzie się w położeniu równowagi. Pomysł takiego sterowania powstał z chęci uchronienia mikrokontrolera przed ciągłym 'multipleksowaniem' czujników. Został on jednak porzucony ze względu na to, że robot przez 80% czasu i tak znajduje się w położeniu gdzie musi korygować obroty silników (poza prostymi :) ). Przerwanie zewnętrzne przychodziło więc praktycznie cały czas, a to nie miało najmniejszego sensu. Aktualny program jest standardowy. Ciągle odpytuje czujniki i ustala odpowiadające im wartości PWM.

    Podsumowanie
    Robot działa, a to najważniejsze. Osiąga nawet przyzwoite czasy. Była to moja pierwsza konstrukcja tego typu i można ją uznać za doświadczalną. Następna będzie lepsza o doświadczenia zdobyte przy budowie Nimbusa. Zmieniłbym liczbę czujników, algorytm sterowania na PID, elementy SMD, a w przyszłości kto wie - może turbinka :) .

    Poniżej kilka zdjęć i filmik

    [Line Follower] Nimbus2000 [Line Follower] Nimbus2000 [Line Follower] Nimbus2000 [Line Follower] Nimbus2000 [Line Follower] Nimbus2000 [Line Follower] Nimbus2000

    Filmik:



    Schemat układu
    Attachments:

    Cool? Ranking DIY
    Can you write similar article? Send message to me and you will get SD card 64GB.
    About Author
    petter0
    Level 10  
    Offline 
    Has specialization in: automatyka i robotyka
    petter0 wrote 24 posts with rating 107, helped 0 times. Live in city Małachowo. Been with us since 2011 year.
  • IGE-XAO
  • #2
    AzaZeL_B
    Level 12  
    bardzo fajna konstrukcja.
    Jedyne co mi się nie podoba to marnotrawstwo energii :(.
    Zasilanie bateryjne i stabilizator liniowy z 11V na 5V.
    Aż się prosi zastosować chociażby ST1S10 i przejść najlepiej na 3.3V jeżeli się da.
    podejrzewam że wydłużyło by to zabawę co najmniej dwukrotnie.
  • IGE-XAO
  • #3
    Komar91
    Level 18  
    A jakie wymiary ma ta konstrukcja? co to są za uchwyty przy kołach jakieś specjalne?
  • #4
    Razonek
    Level 11  
    Muszę przyznać że fajna płytka Ci wyszła, ale ten mostek nie wygląda zbyt dobrze, a dodatkowy kaloryfer trochę jednak waży. Nie napisałeś jak zasilasz silniki, no chyba że nie widzę. Jeśli bezpośrednio z akku, to przy wypełnieniu 50% i spadku napięcia na mostku masz max 5V, uwierz mi, przy tych silnikach i takim zasilaniu można wycisnąć więcej ( nie pokazałeś na razie przejazdów)
    Kolego AzaZeL_B niby po co? Jedynym sensem takiego rozwiązanie jest zastosowanie STM32, ale jaki jest sens przy takiej konstrukcji...

    PS. Filtracja zasilania jest kiepska. Masz miejsce, mogłeś dać większe kondki.
  • #5
    AzaZeL_B
    Level 12  
    kolego Razonek co niby poco?
    chyba napisałem że czas zabawy wydłużyłby się co najmniej 2 razy.
  • #6
    Razonek
    Level 11  
    Na jakiej podstawie tak twierdzisz? Poza tym przejazd trwa maksymalnie 15sekund na zawodach, a nie 3 godziny
  • #7
    eXcLiFe
    Level 14  
    Witam bardzo fajna konstrukcja :) Co do na "ogarnięcia" trasy mam nadzieje że nie używasz nigdzie żadnych opóźnień które nic więcej nie robią? Widzę że używasz L298 I mam do Ciebie takie pytanie czy też spotkałeś się z czymś takim że gdy każesz jechać robotowi prosto to on nie pracuje na pełnej mocy, a gdy dasz mu w prawo i prosto to oba silniki pracują tak jak powinny?

    @Razonek Odpowiedź jest bardzo prosta, zastąpienie stabilizatora liniowego impulsowym zwiększy jego sprawność z max 30% do 80%... a więc faktycznie 2x więcej zabawy. A czas ten jest potrzebny np przy testach na większych trasach.
  • #8
    AzaZeL_B
    Level 12  
    Razonek wrote:
    Na jakiej podstawie tak twierdzisz?


    czas wydłużyłby się co najmniej dwukrotnie?

    ustaw zasilanie 3,3V
    weź kalkulator w rączkę i policz.

    Razonek wrote:
    Poza tym przejazd trwa maksymalnie 15sekund na zawodach, a nie 3 godziny


    idąc twoim tokiem myślenia to w takim razie akumulator jest przewymiarowany 10 razy, a idąc moim 20 razy.

    Ja zaproponowałem ulepszenie a kolega chyba to źle odebrał. :D
  • #9
    Razonek
    Level 11  
    Kalkulator? Kolego, uC bierze tutaj wraz z czujnikami maksymalnie 100-150mA, gdzie silniki na biegu jałowym pobierają po 160mA sztuka, weź pod uwagę że tutaj robot nie jeździ na biegu jałowym. Więc twoje 2x dłużej nijak ma się do tego co jest na prawdę.
  • #10
    treker
    Level 25  
    Ile waży cała konstrukcja? Wygląda trochę ciężko. Przy kolejnej pamiętaj, aby ograniczyć jak najbardziej masę na ramieniu, to wprowadza tylko niepotrzebną bezwładność.
  • #11
    AzaZeL_B
    Level 12  
    Razonek wrote:
    Kalkulator? Kolego, uC bierze tutaj wraz z czujnikami maksymalnie 100-150mA, gdzie silniki na biegu jałowym pobierają po 160mA sztuka, weź pod uwagę że tutaj robot nie jeździ na biegu jałowym. Więc twoje 2x dłużej nijak ma się do tego co jest na prawdę.


    Kolega chyba nie rozumie że ponad połowa energii wytracana jest na ciepło, prąd i owszem około 300mA ale napięcie 6V na stabilizatorze 5V na elektronice? zastosowanie chociażby st1s10 która ma typowo 90% sprawności daje właśnie to ponad dwa razy dłuższe działanie, a uwzględniając fakt że akumulatory wykazują większą pojemność przy mniejszym poborze prądu oczywiście dłuższy czas pracy.
  • #12
    treker
    Level 25  
    AzaZeL_B wrote:
    zastosowanie chociażby st1s10 która ma typowo 90% sprawności daje właśnie to ponad dwa razy dłuższe działanie, a uwzględniając fakt że akumulatory wykazują większą pojemność przy mniejszym poborze prądu oczywiście dłuższy czas pracy.


    Właśnie akumulator jest tutaj również zbędną masą. W innych konstrukcjach tego typu używa się zdecydowanie mniejszych akumulatorów oraz tak jak kolega właśnie napisał przetwornice ST1S10.
  • #13
    Razonek
    Level 11  
    To prawda że dużo mocy wytrąca się na stabilizatorze, ale kto powiedział że akku ma być 3 celowy.
  • #14
    treker
    Level 25  
    Komar91 wrote:
    co to są za uchwyty przy kołach jakieś specjalne?


    Są to specjalnie uchwyty do tych silników dostępne bez problemu do kupienia (np.: tu).
  • #15
    Propaganja12
    Level 9  
    Czym wycinałeś laminat?
    Bardzo ładnie Ci to wyszło.
  • #16
    Modecom601
    Level 13  
    Rewelacja projekt, czekam na filmik. Jak dobrze, że w moim sklepie są CNY70 :), sam dwie diody nadawczą i fototranzystor pod odpowiednik kątem naginałem, by działało, ale na dłuższą metę to nie sprawdzało się :)

    Nie rozumiem zasady działania komparatora tutaj, czy zamiast niego mógłym po prostu użyć ULN2803?

    Czekamy na filmik :):)
  • #17
    treker
    Level 25  
    Modecom601 wrote:
    Nie rozumiem zasady działania komparatora tutaj


    Odczyt czujników jest analogowy, a do mikrokontorolera dostarczany jest sygnał w formie cyfrowej. Autor użył komparatorów zapewne właśnie w tym celu ;)
  • #18
    petter0
    Level 10  
    Przyznam, że kusiło mnie żeby użyć przetwornicy zamiast stabilizatora ale brak doświadczenia w ich stosowaniu spowodował że wybrałem 7805. Przy okazji jeżeli można zapytać to polecacie do konstrukcji amatorskich właśnie przetwornicę DC/DC ST1S10?

    Komar91 wrote:
    A jakie wymiary ma ta konstrukcja? co to są za uchwyty przy kołach jakieś specjalne?

    Robot ma wymiary 180 x 130 mm. Uchwyty są specjalne dla tych silników. Oczywiście równie dobrze mógłby to być kawałek wygiętej blaszki, ale skoro można było kupić tak drogie silniczki to można tez dać parę zł na porządne uchwyty.

    Razonek wrote:
    [...] Nie napisałeś jak zasilasz silniki, no chyba że nie widzę. Jeśli bezpośrednio z akku, to przy wypełnieniu 50% i spadku napięcia na mostku masz max 5V, uwierz mi, przy tych silnikach i takim zasilaniu można wycisnąć więcej ( nie pokazałeś na razie przejazdów)
    [...]
    PS. Filtracja zasilania jest kiepska. Masz miejsce, mogłeś dać większe kondki.

    Kondensatorki myślę że są ok. Gdyby były większe to zwiększy się masa. Trzeba znaleźć złoty środek.
    Silniki zasilane są z mostka L298. Masz rację, da się z nich wycisnąć o wiele więcej. Są naprawdę dobre. Kwestia dopracowania programu.

    eXcLiFe wrote:
    [...] Co do na "ogarnięcia" trasy mam nadzieje że nie używasz nigdzie żadnych opóźnień które nic więcej nie robią? Widzę że używasz L298 I mam do Ciebie takie pytanie czy też spotkałeś się z czymś takim że gdy karzesz jechać robotowi prosto to on nie pracuje na pełnej mocy a gdy dasz mu w prawo i prosto to oba silniki pracują tak jak powinny? [...]

    Nie, nie używam zbędnych opóźnień. Nie spotkałem się też z takim problemem. Może wynika on z za małej wydajności prądowej akumulatorka?

    AzaZeL_B wrote:
    [...] idąc twoim tokiem myślenia to w takim razie akumulator jest przewymiarowany 10 razy, a idąc moim 20 razy. [...]

    treker wrote:
    Ile waży cała konstrukcja? Wygląda trochę ciężko. Przy kolejnej pamiętaj, aby ograniczyć jak najbardziej masę na ramieniu, to wprowadza tylko niepotrzebną bezwładność.

    Fakt, akumulatorek mógłby być trochę mniejszy - robot lekki nie jest. Dobrze, że umieszczony jest na linii osi - przynajmniej zwiększa przyczepność xD. Zapewne komparatorki znajdujące się na ramieniu wprowadzają niechcianą bezwładność, ale po prostu nie było dla nich miejsca z tyłu. W wersji smd nie będzie tego problemu.

    Propaganja12 wrote:
    Czym wycinałeś laminat?[...]

    Zwykła szlifierka kątowa + pilnik + duuużo wolnego czasu :)

    treker wrote:
    Modecom601 wrote:
    Nie rozumiem zasady działania komparatora tutaj


    Odczyt czujników jest analogowy, a do mikrokontorolera dostarczany jest sygnał w formie cyfrowej. Autor użył komparatorów zapewne właśnie w tym celu ;)

    Dokładnie. Podłączony jest do nich sygnał z dzielnika napięcia. Komparator porównuje to napięcie z napięciem na czujniku. Jeżeli napięcie na czujniku jest mniejsze wtedy na wyjściu ustawia '0', kiedy większe '1'. Dzięki temu, że w skład dzielnika napięcia wchodzi potencjometr mogę regulować moment w którym sygnał wyjściowy przełącza się. Czyli mogę jakby regulować czułość czujników. Przydaję to się np. podczas, gdy robot jeździ w bardziej rozświetlonym / przyciemnionym pomieszczeniu.

    Filmik powinien być późnym wieczorem (cierpliwości). Niestety nie mam go na komputerze.
  • #19
    Razonek
    Level 11  
    Piszesz że większych kondensatorów nie chcesz dać bo zwiększają masę. W takim razie wytłumacz mi czy ten kawał alu który robi jako kaloryfer jest lekki? To samo ma się przy akku. Lepiej mieć 2 lub więcej LiPoli 2 celowych o pojemności np. 450 mAh.
    Sam ball caster na przodzie waży więcej niż reszta tego kawałka.
    Przetwornica jest ogólnie dobra. Ma wyższą sprawność, niż tradycyjny liniowiec, ale potrzebuje więcej części do swojego działania. Ja jakoś nie używam przetwornicy do stabilizowania napięcia dla logiki ale dla silników, czego u Ciebie brakuje. Przy takim rozwiązaniu jak u Ciebie, PID rozjeżdża się w trakcie rozładowania akku, co jest negatywne.
  • #20
    petter0
    Level 10  
    Większych kondensatorów nie chcę dać, bo te są dobre. Ten kawałek aluminium jest naprawdę leciutki. Niestety musi być bo stabilizator grzeje dość mocno. Następnym razem zastosuję przetwornice.
    Przy zakupie trudno było mi ocenić nie mając w rękach silniczków ani akumulatorka jak długo to będzie działać. Musiałem kupić trochę 'na zapas'. Jak się okazało jest dużo 'na zapas'. Trzeba nabrać wyczucia. Niestety nie mogłem sobie pozwolić na zakup kolejnego akumulatorka, dlatego został ten.

    Razonek - to nie jest tak zaawansowana konstrukcja jak Wolverine lub Turbinowiec. Chodziło o zapoznanie się z tematem line follower'ów.
  • #21
    dan1112
    Level 12  
    Ile wyniósł Cię koszt (w przybliżeniu) tej konstrukcji i jaką planujesz następną ?

    W następnej konstrukcji możesz:
    Razonek wrote:
    mieć 2 lub więcej LiPoli 2 celowych o pojemności np. 450 mAh.

    AzaZeL_B wrote:
    zastosowanie chociażby st1s10

    lub
    Razonek wrote:
    zastosowanie STM32

    Razonek wrote:
    dać większe kondki


    Pozdrawiam

    P.S. Nie miej mojej wypowiedzi jako jakiś rozkaz ;)
  • #24
    Razonek
    Level 11  
    ahmed10 wrote:
    Moim skromnym zdaniem użycie takiego potężnego mostka L298 jest przerostem formy nad treścią, spokojnie wystarczył by L293.


    Moim zdaniem najlepszym mostkiem jest obojętnie jaki byle nie na tranzystorach bipolarnych a na mosfetach. Ja preferuję TB6612FNG. Nigdy mnie nie zawiódł.
    Każdy mostek na mosfetach będzie o niebo lepszy od tego na tranzystorach bipolarnych.
  • #25
    ahmed10
    Level 11  
    Quote:
    Moim zdaniem najlepszym mostkiem jest obojętnie jaki byle nie na tranzystorach bipolarnych a na mosfetach. Ja preferuję TB6612FNG. Nigdy mnie nie zawiódł.

    Tak masz rację! Zgodzę się z tobą, jednakże w tym konkretnym przypadku chodziło mi o to że L298 jest większy i cięższy od L293 co ma niestety wpływ na zwrotność LF-a (bezwładność) dodatkowo mostek ten jest w trochę niefortunnym miejscu bo nie w jakimkolwiek środku symetrii LF-a:)
  • #26
    Razonek
    Level 11  
    Tak również masz racje, ale nadal nie ma filmiku więc tego nie wiemy. Jeśli on szybko nie jeździ to z powodzeniem można to skorygować w kodzie.
  • #27
    petter0
    Level 10  
    dan1112 wrote:
    Ile wyniósł Cię koszt (w przybliżeniu) tej konstrukcji i jaką planujesz następną ? [...]

    Koszt to +- 300 zł (wliczając w to koszty przesyłek). Następna konstrukcja będzie o wiele poważniejsza. Otrzymałem wiele cennych uwag, które na pewno wykorzystam.

    ahmed10 wrote:
    Moim skromnym zdaniem użycie takiego potężnego mostka L298 jest przerostem formy nad treścią, spokojnie wystarczył by L293. Reszta konstrukcji wyszła Ci bardzo fajnie:)!

    Początkowo korzystałem z mostka L293D. Jest on mniejszy i ma wbudowane diody zabezpieczające. Wyczytałem jednak, że maksymalny prąd chwilowy na jeden kanał dla L293 to 1.2A, a dla L298 to 3.0A. Natomiast maksymalny prąd chwilowy dla silnika to 1.6A, dlatego wybrałem L298. Jak się później okazało - rzeczywiście niepotrzebnie, bo i tak nie wykorzystuję ich pełnej mocy. Chodzi tutaj głównie o zbędną masę, która pewnie swoją bezwładnością wpływa na niestabilną jazdę (jak widać na filmiku). Cały czas pracuję nad kodem, bo tak jak powiedział kolega Razonek - da się to skorgować.
  • #28
    Juffre
    Level 13  
    Gratuluję udanego robota. W jakim programie zaprojektowałeś płytkę?
  • #30
    petter0
    Level 10  
    Płytkę i schemat wykonałem w programie Eagle. Podobieństwo do Battlecruisera jest absolutnie przypadkowe ;D
Reply Cool? Ranking DIY | New topic