Projekt BROB B13. Jízda po čáře pro reklamní robot. Vedoucí projektu: Ing. Tomáš Florián

Transkript

1 FAKULTA ELEKTROTECHNIKY A KOMUNIKAČNÍCHTECHNOLOGIÍ ÚSTAV AUTOMATIZACE A MĚŘICÍ TECHNIKY Projekt BROB 2013 B13. Jízda po čáře pro reklamní robot Vedoucí projektu: Ing. Tomáš Florián Autoři práce: Martin Maršál, Marek Návara, Ondřej Pijáček

2 1. Zadání Implementujte modul do podvozku robotu, který umožňuje jízdu robotu po předem definované trase. Trasa robotu by měla být pro člověka na první pohled neodhalitelná, proto zvažte přednostně použití magnetické pásky přilepené k podlaze pod kobercem. Řízení robotu bude realizováno po některé ze standardních sériových sběrnic (RS-485, Ethernet apod.).

3 2. Teoretický popis 2.1. Úvod do problematiky Při návrhu modulu jsme vycházeli z návrhu kolegů z minulých let. Jako vodící čára je použita magnetická páska, která může být schována například pod kobercem. Na snímání čáry jsou použity 3 snímače KMZ-51. Dva krajní snímače na rozlišení směru a prostřední senzor na určení velikosti výchylky. Signál ze snímačů je potřeba zesílit na hodnotu, kterou je možné převést AD převodníkem s co nejmenším zkreslením. Jako řídící jednotka je použit mikročip ATmega8. Tento čip má dostatek kanálů AD převodníku, modul USART na sériovou komunikaci a je dostatečně rychlý. Také byl vybrán kvůli podpoře ze školy. Na komunikaci s řízením motorů je použita sériová linka RS-485. Převod mezi mikročipem a RS-485 je řešen pomocí SN75176AD. Napájení je řešeno z baterií Fektbota a je stabilizováno na 5V DC-DC měničem LM2594. Celý modul jsme se rozhodli rozdělit na řídící desku, která bude obstarávat, řízení, komunikaci a napájení celého systému a dále na 3 desky se snímači. Každý snímač má vlastní desku, aby bylo možné doladit přesnou vzdálenost snímačů od sebe. Ta by se měla pohybovat kolem 2 až 3 centimetrů. Pro program řízení je využito jazyka C. Program musí být schopný zmagnetizovat snímač, zpracovat jeho výstupní hodnotu, algoritmem spočítat požadované rychlosti motorů a ty poté odeslat přes sériovou linku. Toto bude probíhat v opakovaném cyklu Řídící jednotka - ATMEGA8-16PU Vybrané vlastnosti: Taktovací frekvence 16 MHz 8 Kbajt programové paměti 130 instrukcí 32 pracovních registrů 2 osmibitové čítače a 1 šestnáctibitový

4 6tikanálový AD převodník Programovatelný modul USART 23 programovatelných I/O pinů Obrázek 1:Rozložení portů ATMEGA8

5 2.3. LM2594 DC-DC měnič Mezní hodnoty: Obrázek 2: Základní zapojení LM2594 Obrázek 3: Rozložení pinů LM2594

6 2.4. SN75176AD sériová linka RS485 Doporučené provozní hodnoty: Obrázek 4: Vnitřní zapojení SN75176AD

7 2.5. Snímač magnetického pole KMZ 51 KMZ-51 snímá intenzitu magnetického pole. Je založen na principu magnetorezistivních účinků permalloye. Pro jeho správnou funkci je potřeba snímač pravidelně odmagnetizovat velmi krátkým pulzem (jednotky µs) proudu o velikosti přibližně 1A. Doporučené provozní hodnoty: Obrázek 5: Vnitřní zapojení KMZ 51

8 2.6. INA126P přístrojový zesilovač Mezní hodnoty: Obrázek 6: Vnitřní zapojení INA128

9 3. Návrh výroby 3.1. Program řídící jednotky Řídící program nebyl zkompletován z časových důvodů prakticky zkompletován. Z teoretického hlediska je v programu potřeba nejprve odmagnetizovat snímače a poté postupně převést hodnoty snímačů pomocí ADC (a přerušení po dokončení převodu). Tyto hodnoty zpracovat, což znamená porovnat hodnoty z krajních snímačů a určit, na jakou stranu má zatočit a poté z prostředního snímače určit velikost výchylky: hodnotu porovnat s intervaly a dle toho načíst velikost výchylky. Spočítané hodnoty rychlosti obou motorů poté odeslat přes sériovou linku. Jako Master zařízení nemá žádné problémy rychlost odesílat s protokolem 8-N Schéma zapojení řídící desky Kompletní návrh byl vypracován v programu EAGLE. Na vstupu (levé svorky) je připojeno napájení napětí baterky robotu. Pomocí DC-DC měniče LM2594M napětí sníženo na 5V. Pro řízení jsme využili programovatelný procesor ATmega8. Pro komunikaci s motory robotu je využita sériová linka 75176AD (RS485). Výstup sériové liny je realizován za pomoci konektoru D-SUB F09. Déle jsou osazeny tři konektory pro spojení se třemi snímacími jednotkami. Obrázek 7: Zapojení řídící desky

10

11 3.3. Seznam součástekřídící desky 4x Odpor 10kΩ 1x Odpor 120Ω 1x Tlumivka 100μH 2x Kondenzátor 1μF/50V 2x Kondenzátor 22pF/500V 2x Kondenzátor 100μF/25V 1x Dioda 1N5817 1x Krystal 16MHz 1x AMTEGA8 1x LM2594M 1x SN75176AD 1x Mikro spínač 1x D-SUB F09 1x Konektor 2_piny 3x Konektor 4_piny

12 3.4. Schéma zapojení snímací jednotky Nejdůležitější část snímací jednotky je součástka KMZ-51. Ta snímá intenzitu magnetického pole. Výstup je následně zesílen přístrojovým zesilovačem INA126P,který signál zesílí 100x. Další část je odmagnetizování snímače KMZ 51. Obrázek 8: Zapojení snímací jednotky

13 Seznam součástek jedné snímací jednotky 3x Odpor 1kΩ 2x Odpor 10kΩ 2x Odpor 0,5Ω 1x Odpor 2Ω 2x Kondenzátor 10nF/50V 1x Kondenzátor 10μF/25V 2x Kondenzátor 470nF/63V 2x Dioda 1N4148 2x Tranzistor BC337 2x Tranzistor BC327 1x Tranzistor BC557 1x Tranzistor BC547 1x KMZ 51 1x INA128P 1x Konektor 4_piny

14 4. Realizace 4.1. Program mikrokontroléru ATMEGA Úchyt snímacích jednotek První díl Druhý díl

15 4.3. Desky plošných spojů, osazovací plány Snímací jednotka left

16 Snímací jednotka center

17 Snímací jednotka right

18 Základová deska

19 Reference [1] TEXAS INSTRUMENTS. Precision, LowPower INSTRUMENTATION AMPLIFIERS: INA128,INA129 [online]. Texas, 1995, FEBRUARY 2005 [cit ]. Dostupné z: [2] TEXAS INSTRUMENTS. DIFFERENTIAL BUS TRANSCEIVER: SN75176A [online]. Texas, 1984, MAY 1995 [cit ]. Dostupné z: [3] TEXAS INSTRUMENTS. LM2594/LM2594HV SIMPLE SWITCHER PowerConverter 150 khz. 5A Step-Down VoltageRegulator: LM2594, LM2594HV [online]. Texas, 1999, APRIL 2013 [cit ]. Dostupné z: [4] PHILIPS. Magneticfield sensor: KMZ51 [online]. 1998, JUN 2000 [cit ]. Dostupné z: [5] ATMEL. Atmel AVR 8-bitMicrocontroller: ATmega8, ATmega8L [online] [cit ]. Dostupné z: ATmega8_L_datasheet.pdf