Enchipsdator = allt på ett chip, KMM • • • • • • CPU, RAM, ROM, I/O (parallell, seriell, A/D, timer/counter, PWM, I2C, SPI, ...) Enchipsdatorn AVR Kommunikation Sensorer Reglerteknik Avbrott Beagleboard 8 8 8 8 I/O A I/O B I/O C I/O D Flash Prog CPU RAM Data EE Data www.atmel.com clk rst irq www.avrfreaks.net AVR-familjen. 8-bits RISC-dator + AVR = Alf Vegard Risc 1 I/O 3 ATmega1284 <-> ATmega16<-> ATmega168 Egenskap 1284 16 Instruktioner Principschema 2-stegs pipeline 168 131 kraftfulla! Register 32 generella 8-bits Flash (program,konstanter) 128 kB 16 kB 16 kB EEPROM (konstanter) 4 kB 512 B 512 B SRAM (variabler) 16 kB 1 kB I/O (pinnar) 32 (40) 32 (40) Avbrott (antal) 36 20 26 I2C 1 1 1 SPI 3 1 1 UART 2 1 1 8-bit timers 2 2 2 16-bit timers 2 1 1 PWM (kanaler) 6 4 6 A/D (kanaler) 8 8 6 klocka 0-20 MHz 0-16 MHz 0-20 MHz 1 kB 168 23 (28) 1284, 16 clk rst Motor, Servo, Sensor, Bluetooth, ... 4 5 Programmerarmodell Hur fort går det? Program space Data space Med 20 MHz klocka gör AVR 20 MIPS (miljoner instruktioner per sekund) 32 Hämta 1 Hämta 2 add Verkställ 1 Verkställ 2 brpl xxx yyy add brpl nop yyy 8k 64 20000 instruktioner per millisekund! OBS, en FPGA på samma frekvens är klart snabbare! 1024 processor sekvensnät 8 16 6 20 MHz 20 MHz 1 Ett litet exempel AVR ddrB r0 r1 portB pinB r31 • Stora AVR-en har 4 portar (A,B,C,D) à 8 bitar. • Varje port kan vara en parallellport eller något annat. • Till porten hör ett antal I/O-register. bar LED PB4 PB5 PB6 PB7 DIP switch 8 10 11 Vanlig digital in/ut-matning - asm En pinne/bit i port B DDRBn .include "m16def.inc" .org 0 Här är pinnen! PORTBn PINBn Alltså * 3 register * skriv till PORT * läs från PIN ; Skriv 00001111 i datariktningsregistret ldi r17,(1<<DDB3)|(1<<DDB2)|(1<<DDB1)|(1<<DDB0) out DDRB,r17 TILLBAKA: ; Läs av pinnarna in r16,PINB ; kolla tryckknappar 7,6,5,4 ; Skifta ner r16 fyra gånger swap r16 ; Skriv ut på LEDarna out PORTB,r16 jmp TILLBAKA 12 13 asm Vanlig digital in/ut-matning - C #include <avr/io.h> <-> C Manualen har exempel för båda CPU registren r0-r31 försvinner int main(void) { uint8_t i; ... /* Define directions for port pins */ DDRB = (1<<DDB3)|(1<<DDB2)|(1<<DDB1)|(1<<DDB0); I/O-programmeringen likadan. 64 I/O-register while (1) { /* Läs av DIP-switchen */ i = PINB; /* kolla tryckknappar */ /* Skifta 4 steg höger, skriv ut på LEDarna */ PORTB = i>>4; } Struktur, if-satser, forloopar ..., datatyper ... Tidskritisk kod? Mer ”känsla” för maskinen ? } Kommentar: 1) I/O-programmering likadan som i asm! 2) Nytt är variabeln i. Var bor den? Hur stor är den? PB0 PB1 PB2 PB3 14 Det går att blanda, fast gör inte det Kompilatorn fixar kod för avbrottsvektorer 15 2 Utvecklingsmiljö för Atmel •Windows – Atmel Studio (asm, avr-gcc) JTAG-kabel USB-kabel I labbet: Med ICE, exekvering i AVR 1) 2) 3) 4) 1) 2) 3) 4) Upload + Programmering Läsa/skriva register (vrida på huvudet ...) Singlesteppa Köra med brytpunkt adress/data Hemma: Utan ICE, simulering i PCn Läsa/skriva register Singlesteppa Köra med brytpunkt program/data Stimuli (mata in 0/1 på pinnarna) 16 18 Kommunikation - UART Parallell I2C SPI 19 20 1) UART (Universal Asynchronous Receiver/Transmitter) Hur kommunicerar processorerna med varandra och med omvärlden? Protokoll: startbit databitar 1 stoppbit ...... servon sensorer Modul 1 Atmel AVR1 UART1 Firefly Dongle Bluetooth modul Bluetooth pinne USB term UART2 Modul 2 Atmel AVR2 Modul 3 Atmel UART1 • Max 115200 BAUD (databitar per sekund) • Full duplex • Flaggor signallerar sänt/mottaget data klart UART2 21 3 3) I2C – Inter Integrated Circuit TWI -Two Wire Interface 2) Parallellport AVR1 • Enkel 2-trådsbuss (+ jord) • AVR kan vara Master/Slave • AVR kan vara Sändare/Mottagare • 7-bits adress => 128 slavar • Multimaster arbitration supported • Upp till 400 kHz (200 kHz i praktiken) AVR2 + Enkelt (?) - Många pinnar - Eget protokoll - Dubbelriktad (?) - Egen handskakning Data IRQ0 Handskakning AVR1 master AVR2 master IRQ1 AVR1 master AVR3 master AVR2 slave AVR3 slave SDA SCL SDA SCL Multimaster Coolt men svårt! 23 3) I2C – Two wire interface Inter-integrated-circuit master AVR1 bit rate control status data slave address TWBR TWCR TWSR TWDR TWAR slave slave AVR2 AVR2 TWBR TWCR TWSR TWDR TWAR Master / Slaves Vanligare, lättare! 24 4) SPI fmax = 8/4 MHz TWBR TWCR TWSR TWDR TWAR + 10 kohm SDA 25 SCL AVR1 (master) AVR2 (slave) 26 Sensor 1: IR-avståndsmätare Sensorer - A/D-omvandling - Reglering - Telemetri -Tidsmätning spänning 27 Features • Less influence on the color of reflected objects, reflectivity • Analog voltage corresponding to distance • Detecting distance: 4 to 30 cm, 10 to 80 cm, 20 to 150 cm • External control circuit unnecessary • Low cost 28 avstånd 4 Sensordata Sensor 2: Tejpsensorn Ett exempel ur verkligheten: IR-avståndsmätare ger 25 mätvärden/s i form av analog spänning 0->3V. Vi kopplar den direkt till en AVR, som har A/D-omvandlare. mäter tejpens läge Vid närmare studium av sensordatas kvalitet på oscilloskop upptäcks störningar på mätvärdena! +5 R1 Bäst är att bli av med dessa, med ett lågpassfilter, innan signalen går in i A/Domvandlaren. R2 analog spänning [0 - 5] V IR-lysdiod 29 30 Att mäta analog spänning: A/D-omvandling Sensor 3: Linjesensor Vårt sensorpaket, 11 sensorer (LED + fototransistor), • Läses av med A/D • Varje sensor kontrollerad ljust = 0, mörkt 1023 En bit tejp, Ojämn, varierande belysning +5 R1 R2 analog mux omvandlare Värde 10 bitar Kontroll/Status 8 kanaler 0->5 V => 0->1023 Start .... (gör nåt annat) Färdig 31 32 Lite reglerteknik Sensordata 1 2 3 4 5 6 Hur gör man egentligen för att 1) gå mitt i en korridor? 2) följa en linje? trots att 1) 4-beningen haltar lite grann 2) linjen böjer av 3) golvet lutar k Enkel tyngdpunktsberäkning: kT mk k k m k k Felet lägessensor e 3,5 kT styrdon 34 33 5 Lite reglerteknik Lite reglerteknik Vi måste konstruera en enkel linjär tidsdiskret regulator. 1) Vi bestämmer oss för ett lämpligt T, dvs tiden mellan två sensoravläsningar. 2) För roboten i korridoren bildar vi felet e[n] = xh[n] – xv[n] För linjeföljaren får vi felet direkt ur sensorn. 3) En regulator bildar en lämpligt styrsignal u[n] mha av felet e[n]. u[n] = KP*e[n] styrsignal felsignal e[n] Enklaste regulatorn: P-reglering Regulator u[n] Rattutslaget proportionellt mot felet Vi antar att u[n] = 0 rakt fram u[n] > 0 sväng höger u[n] < 0 sväng vänster och att e[n] = 0 mitt på linjen e[n] > 0 vänster om linjen 35 e[n] < 0 höger om linjen 36 Lite reglerteknik Lite reglerteknik P OBS: 1) Det är viktigt att känna till T. PD-formeln ska ju egentligen se ut så här: Näst enklaste regulatorn: PD-reglering u[n] = KP*e[n] + KD*(e[n] –e[n-1]) u[ n] K P e[ n] K D Alla bilarna har samma e[n] => samma positiva P-del K P e[ n] 1) Neg D-del => minskat rattutslag 2) Pos D-del => ökat rattutslag 3) Mycket neg D-del => styr åt andra hållet e[n] e[ n 1] T KD (e[ n] e[ n 1]) T Det är ju felderivatan vi ska reagera på!!! Styregenskaperna ska inte ändras om T ändras! Variant: om vinkeln kan mätas I-del behövs ej, kvarstående reglerfel finns ej här! e=0 => u=0 trigger Inbyggt system tx Firefly out fel int16_t u,e, …; Styrstopp? if u>MAX u=max; … u[ n] K P e[ n] K 2 37 Telemetri Det är bra! Men varför då? • Lätt att se inre tillståndet i systemet, när det är i drift och rörelse! T ex varför gjorde den så? • Lätt att ställa in reglerparametrar, i realtid! Var försiktig med talområdet! Använd C, 38 Sensor 4: Ultraljud 1 1 styr Voltage 5v Frequency 40KHz Max Range 3m Min Range 3 cm Sensitivity Detect a 3cm diameter stick at > 2m Input Trigger 10uS Min. TTL level pulse Echo Pulse Positive TTL level signal, width proportional to range. USB rx 39 40 6 Att mäta tid Timer/Counter AVR har 3 timer/counters (ATMega 16) Detta är timer/counter1. ”Simplified block diagram”! Polling 16-bits räknare 1) 2) 3) 4) 5) jämförelseregister Vänta på att pinnen går hög Läs av räknaren TCNT1 Vänta på att pinnen går låg Läs av räknaren TCNT1 Subtrahera Avbrott 1) Sätt upp ICR1 för att ta en timestamp på positiv flank på pinnen I avbrottsrutinen Läs av TCNT1, lägg i en variabel och ställ om polariteten på flanken tidregister kontrollregister 41 Pulsbreddsmodulering (PWM) Variabeln innehåller ”avståndet”! 42 Avbrottskällor i ATmega16 - ”D/A-omvandling” avbrott Vanlig avbrottsingång period komp S räknare R T ex motor komp Duty cycle Kontrollera om motorn/servot reagerar på pulskvot eller pulsbredd! Vanlig avbrottsingång 43 45 Sensor 6: 3-axlig accelerometer Sensor 5: RFID RFID Tags .. .. .. x, y , z RFID Card Reader RS232 (UART) 2400 BAUD 50 52 7 Sensor 7: Angular rate sensor (”Gyro”) Sensor 8 : IMU Inertia Measuring Unit - Tröghetsnavigering • • • • Accel & Gyro 6 axlar Rörelseprocessor Datablad 57 sidor!! 54 Sensor 9 : LIDAR LIght Detection And Ranging ”Avståndet till ett objekt mäts via tidsfördröjningen mellan utsänd laserpuls och den registrerade reflexen.” • • • • Range: 0-40m Accurucy: +/-2.5cm Rep rate: 1-500Hz Interface: I2C eller PWM ”Reserverad” för kartrobotar Beagleboard 55 56 Beagleboard Beagleboard Mer kraft – Mer makt men ... ”Ett tyngre svärd att svinga” •Super-scalar ARM Cortex TM-A8 •512-MB LPDDR RAM •High-speed USB 2.0 OTG port optionally powers the board •On-board four-port high-speed USB 2.0 hub with 10/100 Ethernet •DVI-D (digital computer monitors and HDTVs) •S-video (TV out) •Stereo audio out/in •High-capacity microSD slot and 4-GB microSD card •JTAG •Camera port 8 Processorn Beagleboard PDF-datablad finns, 3500 sidor! ”The good ... and the bad” PLUS MINUS • Ett operativsystem -Linux (Ångström, Ubuntu) -Windows CE -RTOS • Stort arbetsminne, 512MB • Kraftfull processor • Många olika portar -USB, DVI, ETH -Serieport, PS/2 -Audio in/ut • I/O-portar och I2C: (1.8V) • Ej 5V-kompatibel (ansl. till AVR bara via UART) • Skrymmande storlek (relativt AVR) • ”Ett tungt svärd att svinga” (krävande att använda) Kopplingsförslag 1 WiFi USB USB Kopplingsförslag 2 BT USB USB USB USB USB-Serie USB-Serie RS232 (UART) styr mät AVR1 AVR2 AVR3 RS232 styr mät styr mät I2C AVR1 USB-Serie RS232 AVR2 BT USB USB-Serie RS232 AVR3 styr mät styr mät The End Vad göra nu? -Fundera och planera -Kolla datablad vanheden.isy.liu.se -Prata med handledaren 6/10 : Designföreläsning -Tänkvärt vid design av inbyggda system -Designspecar 65 9
© Copyright 2024