29.08.2013 Views

Intelligent Robot Rullstol

Intelligent Robot Rullstol

Intelligent Robot Rullstol

SHOW MORE
SHOW LESS

You also want an ePaper? Increase the reach of your titles

YUMPU automatically turns print PDFs into web optimized ePapers that Google loves.

~ <strong>Intelligent</strong>a <strong>Robot</strong> <strong>Rullstol</strong>ar ~<br />

70 ms att beräkna. Om man dessutom lägger till tiden för observationerna från sensorerna,<br />

ökar tiden till ca 0,3 s. MAid är alltså kapabel att beräkna en ny manöver var 0,3:e sekund.<br />

3.4.1 Upptäcka och följa rörelser<br />

Då eventuella förändringar i omgivningen ska upptäckas jämförs sekvenser av indata från<br />

samma område med varandra, för att se om det finns någon skillnad. Om det visar sig att en<br />

skillnad finnas ger det en stark indikation på att det skett en förändring, antingen genom att<br />

rullstolen själv har förflyttat sig eller att ett objekt flyttat sig. Den avståndsmätande lasern<br />

används för att upptäcka och följa rörelser. Den har en räckvidd på max d = 50 meter, med en<br />

noggrannhet på σd ≈ 50 mm och ett gradomfång på ± 90° med en upplösning på 0,5°. Den<br />

arbetar med en frekvens på 3 Hz och ger tre "omfångsbilder" per sekund. Avståndsinformationen<br />

som lasern ger är relaterad utifrån den lokala referensramen.<br />

Då man ska jämföra två lokala omfångsbilder är det nödvändigt att veta exakt vilken rörelse<br />

lasern (rullstolen) har gjort mellan de två observationerna, det vill säga hur långt den har rört<br />

sig från den ena bilden till den andra och hur mycket den har vridit sig. Denna information<br />

tillhandahålls av död-räkning systemet, vilket möjliggör för rullstolen att hålla ordning på sin<br />

position och riktning, över en viss begränsad förflyttning, med relativt hög noggrannhet. Med<br />

hjälp av den gällande positionen och riktningen beräknas och skickas värdena av de lokala<br />

omfångsbilderna till den aktuella referensramen.<br />

För att representera variationer i omgivningen över tid används en så kallad "time stamp map"<br />

(T S M). "Tidkartan" är ett tvådimensionellt rutsystem som endast innehåller de områden som<br />

är ockuperade vid en viss tidpunkt, t, den omfattar således inte någon information om de områden<br />

som inte är ockuperade vid samma tidpunkt. Anledningen till att man valt att göra på<br />

det här sättet var att man vid försök upptäckte att den mesta tiden gick åt till att kartlägga de<br />

områden som inte var upptagna.<br />

Variationen över tid beräknas utifrån sekvensen T S Mt, T S Mt-1,.....T S Mt-n.<br />

9(12)<br />

Figur 4. Exempel på "time stamp map"<br />

Bilderna a-c, figur 4, till vänster visar hur tidkartor<br />

kan se ut. De visar ett rörligt objekt och ett stationärt.<br />

I ruta d är de tre kartorna sammanslagna.<br />

Tiden för observationen representeras av färgen, ju<br />

mer nyligen observation skedde desto mörkare nyans.<br />

Tiden det tar att uppta och omvandla omfångsbilden<br />

till en 200 × 200 celler stor tidkarta är ungefär 1,5 ms<br />

på en Pentium 166 MHz.<br />

Genom att använda en enkel heuristik kan man upptäcka en rörelse i en tidsfrekvens. De celler<br />

i T S Mt som är markerade som upptagna, jämförs med motsvarande celler i T S Mt-1, om<br />

samma celler är upptagna vid båda tillfällena indikerar det på att det är ett stationärt föremål.<br />

Om det skulle finnas en skillnad i jämförelsen mellan de olika tidkartorna kan man dra den

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!