This is an old revision of the document!


Balanseerija

Meeskond

  • Priit Suurküla
  • Siim Sülla
  • Holger Kruusla
  • Martin Parker

Nädalaaruanded

  1. Nädal - Nädal 1
  2. Nädal - Nädal 2
  3. Nädal - Nädal 3

Ülesanne

  • Robot toetub maapinnale ainult kahe rattaga
  • Robot on autonoomne
  • Robot suudab püsti seista ja sõita mööda joont

Ideelahendus

Meie Roboti ideelahenduse leidmine koosnes kahest osast. Esiteks visuaalse lahenduse leidmine, et robot näeks atraktiivne ja ilus välja ning ühtlasi oleks lihtsalt koostatav. Teiseks ja ühtlasi ka olulisemaks oli leida meile sobiv roboti tööpõhimõte. Selleks oli kolm võimalust: Güroskoobi, Infrapuna-, või Ultraheli kaugusandurite kasutamine.

  • Disain ja mehaanika

See oli üks esimestest asjadest, mille me reaalselt (3D mudelina) valmis saime. Kokku valmis 2 mudelit, seega polnud sobiva lahenduse valik ülemäära keeruline. Alljärgnevatel piltidel meie Disainilahendused.

i_lahendus.jpg ii_lahendus.jpg

Oma projekti realiseerimiseks valisime teise disaini variandi (parempoolne lahendus). Valik osutus selliseks mitmetel kaalutlustel. Suurimaks kasuteguriks oli sellise variandi lihtsus. Kogu roboti kere koosneb kaheksast detailist, mis kõik valmistatakse CNC pingil. Sellega seoses jäävad ära eisimese lahenduse puhul vajalikuks osutunud treimis, keermelõikus, mõõtmis, ning saagimis tööd, mida teise variandi puhul teeb meie eest CNC pink. Esimese variandi suureks puuduseks oli ka Ultraheli andurite paigutamine, kuna andurite „vaateväli“ on üsna lai siis peavad andurid asetsema roboti kerest teatud kaugusel ning kindla nurga all, et kere ei hakkaks andurite tööd segama.

  • Balanseerimise tööpõhimõte.
Plussid Miinused
Güroskoop Hästi realiseeritav, annab võrreldes teistega palju tagasisidet. Programmeerimine on mõnevõrra keerulisen ning peab kasutama rohkem matemaatikat.
Ultraheli andurid Annavad usaldatavat tagasisidet erinevatelt pindadelt (eri värvid ja materjalid)Reageerimisaeg on võrreldes IR anduritega aeglasem
Infrapuna andurid Mõõtmise sagedus suurem kui ultraheli anduritel. Keskkonnast tingitud suured mõõtevead (eri värvustelt peegeldab tagasi erinevalt)

Kuna kõik variandid on omamoodi huvitavad ning kõigil neist on oma valupunktid ,mida lahendada, siis oli otsustamine päris keeruline. Kuna güroskoobid on suhteliselt kallid ja roboti programmeerimine güroskoopi kasutades on võrreldes teistega mõnevõrra keerulisem otsustasime sellest lahendusest loobuda. Järgi jäid kaugusandurid. Lähema uurimise käigus selgus, et infrapuna andurid ei peegelda kõigilt pindadelt ühetaoliselt tagasi ja annavad seetõttu häiringuid ning tuli meil ka neist loobuda, sest joon mida mööda robot peab sõitma on musta värvi ning võib hakata IR andurite tööd häirima. Ultraheli andureid uurides selgus, et sellise lahendusega on valmistatud balanseerivaid roboteid. Kuna kodulabori komplekti kuulub samuti ultraheliandur, siis otsustasime, et neid kasutades saame roboti prototüübi kiiresti valmis ning sellega seoses jääb meil rohkem aega katsetusteks ja koodi kirjutamiseks.

Kõike eelnevat arvesse võttes otsustasime, et põhjalikumalt hakkame arendama teist disainilahendust koos ultraheli anduritega, mis tagavad roboti balansseerimise.

Lahendus

  • Kasutame kahte ultraheliandurit roboti asendi määramiseks maapinna suhtes
  • Roboti ajuks on ATMega128 mikrokontroller
  • Kahte ratast veavad kaks DC mootorit

Mehaanika

Roboti projekteerimisel lähtusime sellest, et see oleks huvitava välimusega ning, et seda oleks võimalikult lihtne kokku panna (lahti võtta). Roboti kere koosneb kahest identsest küljest, mille sisse on lõigatud tapiavad ja freesitud mootorite kinnitus avad. Kahe külje vahele paigutuvad horisontaalplaadid moodulite ning patareide jaoks. Nende asetus on paigutatud nii, et oleks lihtne moodulplaatidele ligi pääseda (paigaldada progammaatori juhet, andurite ja mootorite juhtmeid jne). Kuna tapid lähevad avadesse ainult ühte moodi ning horisontaalplaate on kõigest kolm erinevat siis on kere kokku panemine hämmastavalt lihtne. (juhul kui moodulid ning andurid on eelnevalt plaatidele monteeritud). Roboti ratasteks kasutame tavalisi lego rattaid (http://www.peeron.com/inv/parts/2903), mis on meie roboti tarvis vastavalt modifitseeritud. Rataste tsentrisse on puuritud suuremad augud,mis on ka keermestatud. Alloleval pildil ratas koos kinnitusega (ratas kinnitub mootori võllile kahe kruvi abil).

ratas.jpg

Ratta kinnnitamiseks mootori võllile on treitud nn Rattakinnitus võll, mille ühte otsa on puuritud auk, mis ühtib mootori võlli läbimõõduga ning samasse otsa ka kaks võlli teljega risti asetsevat auku, mis hiljem keermestatakse M3 keermega ning, mille eesmärgiks on pingu tekitamine mootori võllile, et ratas kindlalt kinni püsiks. Võlli teises otsas on M8 keere ratta ning mutri kinnituseks. Lihtsustatud Rattakinnituse detailijoonis ja Kinnituse prototüübi valmis lahendus.

kinni_detailijoonis.jpg kinnitus.jpg

Roboti kere selgrooks on küljed, nende külge kinnituvad praktiliselt kõik teised kere detailid: mootorid ning horisontaalplaadid moodulite, akude ja ultraheliandurite kinnituseks. Motorite kinnituseks on külje siseküljele freesitud mootori diameetriga võrdne süvend ning puuritud augud vastavalt mootori tüübi kinnitusele (antud juhul lahendatud süvend alumiinium plaadiga kuhu puuritud mootori kinnitamiseks 2 auku ning 1 auk mootori võlli tarvis). Järgnevat on kujutatud lihtsustatud külje detailijoonis, kuhu on märgitud tapiavade paigutus ning nende suurused. Kontuurjoonte raadiused on märkimata kuna antud juhul on kontuuri põhiline eesmärk huvitava disaini loomine ( tähtis on tapiavade paigutus, suurus ning omavahelised kaugused).

kuljejoonis.jpg

Roboti prototüübi valmis küljelahendus.

kulg.jpg

Järgmised võtmedetailid roboti kere juures on rohelised horisontaalplaadid, mis annavad robotile soovitud jäikuse ning tugevuse. Horisontaalplaate on meie roboti juures kolme erinevat tüüpi. Üks alusplaat, mille eesmärgiks on suurema jäikuse tekitamine. Kolm identset plaati, millest kahele kinnituvad kontrolleri- ning mootorite moodul ning ühele patareid. Kaks identset plaati ultraheli andurite kinnitamiseks. Kõik horisontaalplaadid kinnituvad külgedele tappide ning kruvidega (soovi korral võib jätta kruviaugud tegemata ning kinnitada plaadid liimiga kuna praktika näitas ,et tapid hoiavad ise juba robotit üsna hästi koos).

Alusplaadi detailijoonis.

alusplaat.jpg

Moodulite plaadi detailijoonis.

moodulite.jpg

Andurite kinnitusplaadi detailijoonis.

andurplaat.jpg

Moodulite kinnitamiseks Horisontaalplaatidele puuritakse plaatidesse augud (vastavalt moodulplaatide kinnitus aukudele) ning keermestatakse need augud. Moodulid kinnitatakse kruvidega, mooduli ning horisontaali vahele asetatakse ka puksid, mille kõrguseks on 3-5 mm ning avad puksides vastavalt kinnituskruvide läbimõõdule. Robot kasutab 8x 1.5v patareid mille hoidmiseks on kaks patarei pesa , kumbki mahutab neli patareid. Kuna patareipesadel puuduvad kinnitamiseks mõeldud avad siis nende kinnnitamiseks oleme esialgu mõelnud kasutada kahepoolset teipi.

Ultraheliandurid kinnituvad horisontaalplaatidele analoogselt mooduplaatidega. Andurite ning plaadi vahele asetatakse puksid ning kruvitakse andurid plaadi külge. Kuna tegemist on kahel rattal sõitva robotiga siis on vältimatu ,et robot aegajalt „ninuli“ kukub. Kukkumisest tekkivate vigastuste vältimiseks kinnitasime ultraheliandurite juurde vedrud „bumperid“ ,mis roboti kukkumisel summutavad suurema põrutuse. Vedru on kinnitatud horisontaalplaadile pleki tüki abil (vedru nurka on võimailik korrigeerida pleki tükki paenutades). Kuna vedru kinnitamine pleki tüki külge oli komplitseeritud, siis tuli selleks üsna palju vaeva näha. Esmalt tuli „vedru „ peene juhtme abil pleki külge punuda ning kinnituse tugevamaks muutmiseks jootsime sinna ka tina. Vedrude ning ultraheliandurite kinnitus on järgneval pildil.

vedru.jpg

Elektroonika

Üldine elektroonika blokkskeem

Jooneandurite elektriskeem

Info kuvamiseks ja välimuse atraktiivsemaks muutmiseks on roboti peale (Patareide pesade peal) kinnitatud visuaalne väljundplaat mis koosneb viiest rohelisest ledist, mida on võimalik programmerida meile vajaliku infot kuvama. Plaat on kinnitatud kahepoolse teibiga.

Visuaalse väljundplaadi pilt

valjundplaat.jpg

Visuaalse väljundplaadi elektriskeem

Juhtalgoritm

Valmislahendus

Pärast 9 nädalat tööd on valmis robot balanseeriv joonejälgija. Järgnevalt on näha meie roboti prototüüp ja kõik tähtsamad detailid ning nende kinnitused komplektselt. Ühtlasi on antud pildi järgi ka teostada roboti kokku monteerimine ilma koostejooniseta.

valmis.jpg

Majanduskalkulatsioonid

Eesmärk oli kasutada ära võimalult palju olemasolevaid komponente ja materjale.

Komponentide tabel
Komponent Nimetus Kogus Hind Maksumus
Põhikontroller ATmega128 1
Mootorikontroller H-sild L293D 1
Mootorid 12V 0.2Nm, 14000rpm 2
Reduktorid Faulhaber 16/7, 43:1 2
Ultraheli andurid SRF04 2
Jooneandurid QRD1114 5
Akud, patareid AA Patarei 8
Rattad Lego, D = 80mm 2
Kere materjalid Plastik 5mm, POM 1x1m
Sisend-väljundplaat LED ja Mikrolüliti 5 + 1
Kokku 0

Lisaks tuleks CNC freespingi ja muude töövahendite kasutamise hind.

Projektijuhtimine

Kokkuvõte

Viited ja kasutatud materjal

Lisad

Video roboti toimimisest - PID

et/projects/tudengid11/balanseerija.1301478807.txt.gz · Last modified: 2020/07/20 09:00 (external edit)
CC Attribution-Share Alike 4.0 International
www.chimeric.de Valid CSS Driven by DokuWiki do yourself a favour and use a real browser - get firefox!! Recent changes RSS feed Valid XHTML 1.0