SE522383C2 - Mobil robot och kursjusteringsförfarande för densamma med en lägesingenkännande anordning som avkänner basmarkör i taket. - Google Patents

Description

l0 20 25 30 522 583 2 Den hinderdetekterande anordningen detekterar hinder, såsom en vägg, ett bord osv., med en ultraljudsensor eller lasersensor och sänder ut en motsvarande signal till styr- ningsdelen. Den hinderdetekterande anordningens sensor är företrädesvis monterad på framsidan av den mobila roboten parallellt med en köryta, för att mer korrekt de- tektera hindret som ligger i körbanan.

Styrdelen innefattar en mikroprocessor och ett rninne monterat på denna för styrning av allmänna operationer av den mobila roboten, såsom utsändning av ett startkom- mando till köranordningen, styrning av köranordningens rörelse för att undvika ett hinder i enlighet med signalema som mottages från den hinderdetekterande anord- ningen och ett internt, förinstallerat program samt för laddning av strömkällan med elektricitet när den bestärmner att strömnivån ligger under ett förutbestämt värde.

Strömkällan matar ström för drivning av olika delar i den mobila roboten, såsom mo- tom, som roterar köranordningens hjul, sensorn som detekterar närvaron av hinder samt styrdelen osv. Strömkällan är vanligen ett batteri som möjliggör att den mobila roboten kan arbeta under en förutbestämd tidsperiod utan anslutning till någon extern strömkälla.

Operationen av den mobila roboten, konstruerad på ovan angivet sätt, kommer att be- skrivas i detalj nedan.

Först, när den mobila roboten mottager ett startkommando, sänder styrdelen ut en körorder och motsvarande avkänningssignal till köranordningen respektive den hin- derdetekterande anordningen. Som svar på signalen från styrdelen kör köranordning- en i en viss riktning genom drivning av motorn. Vid denna tidpunkt sänder, genom sensorns funktion, den hinderdetekterande anordningen ut en avkänningssignal till styrdelen. Under den mobila robotens drift kommer, när sensorn avkänner närvaron av ett hinder inom ett förutbestämt avstånd från roboten, styrdelen att sända ut ett kommando till köranordningen att ändra den mobila robotens körriktning. Närhelst den mobila roboten påtråffar ett hinder ändras den mobila robotens körriktning 10 20 25 30 522 3823 3 genom de ovan beskrivna processerna. Det vill säga den mobila roboten kör i enlighet med dess initiala läge och hindrens lägen, och ritar upp ett slumpartat spår såsom vi- sasifig. 1.

En mobil robot med en sådan slumpvis förflyttriing befinnes vara ineffektiv när den rör sig inom ett begränsat område, eftersom den rör sig utmed en slumpvis bana. En arman nackdel med den mobila robotens slumpvisa rörelse är att den upprepat rör sig över samma område.

Ultraljudsensom i den konventionella hinderdetekterande anordningen innefattar en ultraljudsändande del för utsändning av ultraljudvågor, samt en ultraljudmottagande del för mottagning av reflekterade ultraljudvågor från hindret. Genom att mäta ett tids gap mellan ultraljudsändningen och mottagningen av reflekterat ultraljud beräknar den styrande delen ett avstånd från den mobila roboten till hindret och styr i enlighet därmed den mobila robotens motor till att undvika hindret. Även om den konventionella hinderdetekterande anordningen och dess förfarande kan mäta avståndet från den mobila roboten till hindret, så kan den inte på ett bra sätt hantera hindren med avseende på hindrets status eftersom det är omöjligt att erhålla exakt information om hindrets status, såsom hindrets form eller liknande. Följaktligen är det omöjligt för den mobila roboten att bestämma om den skall passera eller väj a för hindret.

Det fordras av den mobila roboten att den håller en förutbestämd orientering för att utföra en rengörings- eller vaktoperation mer effektivt. För detta är det nödvändigt att periodiskt kontrollera om den mobila roboten kör utmed rätt kurs och att korrigera den mobila robotens orientering om det bestämmes att den mobila roboten har avvikit från kursen.

För att säkerställa att den mobila roboten kör utmed rätt kurs använder den mobila ro- boten en styrtejp på en vägg i ett rum som referens. 10 20 25 30 När styrtejpen är fastsatt på golvet sker den mobila robotens kontroll av styrtejpen ge- nom användning av en fotosensor eller en magnetisk sensor. Den mobila roboten kör längs styrtejpen. Styrtejpens relativa läge med avseende på sensorn bestämmer om den mobila roboten är på rätt kurs eller ej.

När rummets vägg användes som referens bestämmes om den mobila roboten kör längs rätt kurs eller ej i enlighet med den mobila robotens avstånd från väggen, såsom det detekteras av en sensor, såsom en ultraljudsensor osv. Beroende av avståndet mel- lan den mobila roboten och väggen kommer den mobila roboten att justera sin orien- tering. Även om dessa sätt att justera den mobila robotens kurs, dvs. användningen av en styrtejp eller vägg som referens, kan vara användbara för styrning av den mobila ro- botens körning, så är de knappast applicerbara på en mobil robot som avkänner sitt läge med användning av en bildkamera. Det vill säga, att separat anordna styrtejpen eller ultraljudsensorn på den mobila roboten, som avkärmer sitt läge medelst en bild- kamera just för att bestämma om den mobila robotens orientering skall justeras eller ej, orsakar nackdelar såsom att komplicera tillverkningsprocessema och att höja till- verkningskostnaderria.

Uppfinningen i korthet Den föreliggande uppfinningen har åstadkommits för att undanröja ovan nämnda pro- blem hos känd teknik. Följaktligen är ändamålet med den föreliggande uppfmningen att åstadkomma en mobil robot som kan effektivt köra utmed en viss kurs under av- kännande av sitt läge och med undvikande av upprepade passager över samma områ- de.

Ett armat ändamål med den föreliggande uppfinningen är att åstadkomma en mobil robot som kan bestämma om den skall passera eller väja för ett hinder i dess körrikt- ning, baserat på information om hindrets form. Infonnation om hindrets form 20 25 30 522 5823 5 åstadkommes medelst en hinderdetekterande anordning som har en linjelaser och en bildkamera. Ännu ett ändamål med den föreliggande uppfinningen är att åstadkomma ett förfaran- de för reglering av den mobila robotens orientering, vilken avkänner sitt läge genom att använda en bildkamera, i enlighet med att bestämma om den skall bibehålla eller ta en annan bana.

Ovan angivna ändamål uppnås helt eller delvis av en mobil robot samt ett förfarande för att reglera en kurs eller en körbana för en mobil robot, enligt de bifogade självständiga kraven.

Således omfattar uppfinningen en mobil robot innefattande en köranordning för att förflytta den mobila roboten runt i ett rum, en hinderdetekterande anordning för att detektera närvaron av ett hinder, en styrdel kopplad till och styrande köranordningen och den hinderdetekterande anordningen. Den mobila roboten särskiljs av en lägesigenkännande anordning kopplad till styrdelen för att bestämma ett aktuellt läge för den mobila roboten, vilken lägesigenkännande anordning innefattar en första bildkamera och ett första bildkort, van/id den första bildkameran avbildar taket i ett rum och avkänner en basmarkör i taket och det första bildkortet bearbetar en bild från den första bildkameran och sänder data till styrdelen samt en strömkälla kopplad till styrdelen, vilken strömkälla är anordnad att lagra och mata elektricitet till köranordningen, den hinderdetekterande anordningen, den lägesigenkärmande anordningen samt styrdelen, varvid basmarkören är ett igenkänningsmärke som uppvisar en basskiva och ett antal punkter utformade på basskivan på ett förutbestämt avstånd från varandra.

Vidare omfattar uppfinningen ett förfarande för att reglera en kurs eller körbana för en mobil robot, vilken mobila robot innefattar en köranordning för att förflytta den mobila roboten runt i ett rum, en hinderdetekterande anordning för att detektera närvaron av ett hinder, en lägesigenkännande anordning för att bestämma ett aktuellt läge för den mobila roboten, en styrdel för att styra köranordningen, den hinderdetekterande anordningen och den lägesigenkännande anordningen samt en 20 25 30 522 385 6 strömkälla för att lagra och mata elektricitet till var och en av anordningama och styrdelen. Förfarandet omfattar (I) fotografering av en basmarkör med användning av en forsta bildkamera i den lägesígenkärmande anordningen, som genererar bilddata av basmarkören genom utnyttjande av ett forsta bildkort, varvid basmarkören är ett igenkärmingsmärke 'som uppvisar en basskiva och ett antal punkter utformade på basskívan pâ ett förutbestämt avstånd från varandra, (II) bestämning av om koordinaterna för basmarkören, som erhållits genom styrdelens databearbetning, överensstämmer med koordinaterna för den förutbestämda körbanan, samt (III) styrning av kördelen till att förflytta den mobila roboten i en riktning med ett motsvarande avstånd för att kompensera varje avvikelse från den förutbestämda körbanan när koordinatema för basmarkören inte stämmer överens med koordinatema för den förutbestämda körbanan.

Den mobila roboten enligt en föredragen utföringsform av den föreliggande upp- finningen innefattar en dammsugare, vilken har en sugöppning för insugning av föroreningar, en dammuppsamlingsdel för att samla upp föroreningarna samt en mo- tordrivdel för att generera sugkraft.

Kort redogörelse för ritningarna Ovan angivna och andra ändamål och fördelar med den föreliggande uppfinningen kommer att vara helt uppenbara vid läsning av den följande detaljerade beskrivning- en, som ges i samband med de bifogade ritningarna, där fig. 1 visar en vy som åskådliggör rörelsebanan för en konventionell mobil robot, fig. 2 visar en schematisk vy i perspektiv som åskådliggör strukturen hos en mobil robot i enlighet med en föredragen utföringsform av den föreliggande uppfinningen, fig. 3 visar ett blockschema som åskådliggör funktionema för respektive delar i den mobila roboten enligt den föreliggande uppfinningen, 20 25 30 522 383 7 fig. 4 visar ett flödesschema som förklarar ett förfarande för igenkännande av ett läge för den mobila roboten enligt den föreliggande uppfinningen, fig. 5 visar en vy av ett exempel på en basmarkering för den mobila roboten enligt den föreliggande uppfinningen, fig. 6 visar en vy som åskådliggör rörelsebanan för den mobila roboten, vilken rör sig i enlighet med en maskbild inställd vid en inlärningsprocess, fig. 7 visar ett flödesschema som förklarar ett förfarande för att detektera ett hinder med utnyttjande av en hinderdetekterande anordning i den mobila roboten enligt den föreliggande uppfinningen, fig. 8 visar en vy som förklarar en process för beräkning av ett avstånd från den mo- bila roboten till ett hinder, fig. 9 visar en vy som i korthet åskådliggör en process för bildande av en tredimensio- nell bild med ett flertal linjära bilder, fig. 10 visar ett flödesschema som förklarar ett förfarande för justering av den mobila robotens orientering enligt den föreliggande uppfinningen, fig. 11A, 11B och 1 IC visar vyer som åskådliggör linjer bildade av basmarkeringar, vilka visas i ett bíldfönster i en första bildkamera i överensstämmelse med den mobila robotens förflyttning och fig. 12 visar en vy som åskådliggör den mobila robotens förflyttning längs en viss ba- na medan den avkärmer sitt läge.

Detaljerad beskrivning av den föredragna utföringsformen Den föredragna utföringsfonnen av den föreliggande uppfinningen kommer att be- skrivas nedan under hänvisning till de bifogade ritningama. 10 20 25 30 522 385 8 Med hänvisning till fig. 2 och 3 framgår att en mobil robot 1 innefattar en köranord- ning 30 för att förflytta den mobila roboten 1 utmed en plan yta, en lägesigenkärinande anordning 20 för att avkänna ett läge för den mobila roboten 1 genom användning av en första bildkamera (CCD-kamera) 21, en hinderdetekterande anordning 40 för att detektera förekomsten av ett hinder i den mobila robotens 1 bana, en fjärrstyrd sändare/mottagare 50 för sändning eller mottagning av ett start/stoppkommando till/ fiån den mobila roboten l samt en strömkälla 60 för att lagra och mata ström till den mobila robotens 1 respektive komponenter.

Köranordníngen 30 innefattar ett par hjul 33, som kan röra sig framåt och bakåt, åt höger och åt vänster, en motor 32 för drivning av hjulen 33 samt en motordrivenhet 31 för att styra motorn 32 som svar på signaler som motordrivenheten 31 mottar från styrdelen 10.

Den lägesigenkännande anordningen 20 innefattar en första bildkamera 21 som är vertikalt anordnad för att avbilda ett tak på vilket en basmarkör 70 (fig. 5) är anbring- ad. Den lägesigenkännande anordningen 20 innefattar vidare ett första bildkort 23 för inställning av relevanta trösklar med bilder fotograferade med den första bildkameran 21.

Den hinderdetekterande anordningen 40 innefattar en linjär laser 41 för att sända en linjär ljusstråle i banan för den mobila robotens 1 körriktning, en andra bildkamera 43 för att avkänna en linjär ljusstråle som reflekteras från ett hinder beläget i den mobila robotens 1 bana samt ett andra bildkort 45 för bearbetning av bilder som fotograferats med den andra bildkameran 43.

Den linjära lasem 41 benämnes ofta ”linj ärsändare” eftersom den sänder en stråle i form av en rak linje mot ett bildplan. Bildplanet är vinkelrätt mot den linjära lasems 41 optiska axel. Den linjära lasem 41 är monterad på en frontyta på den mobila robo- ten 1 och detekterar närvaron av hinder som kan föreligga i robotens väg. 20 25 30 3823 9 Den andra bildkameran 43 är monterad ovanför den linjära lasem 41 för att uppfånga varje linjär stråle från den linjära lasem 41 som reflekteras från ett hinder. Den andra bildkameran 43 innefattar ett på densamma anbringat filter för att exklusivt avkänna en reflekterad stråle från den linjära lasem 41. Filtret tillåter även en exklusiv passage för en våglängd som motsvarar den linjära strålen från den linjära lasem 41, så att den andra bildkameran 43 exklusivt avkänner den linjära strålen från den linjära lasem 41.

Det andra bildkortet 45 är monterat på ena sidan av den andra bildkameran 43 och är kopplat via anslutningstrådar till styrdelen 10 och den andra bildkameran 43.

Den fjärrstyrda sändaren/mottagaren 50 gör det möjligt för en användare att på av- stånd styra start och stopp av den mobila roboten. Det vill säga den fjärrstyrda sända- ren/mottagaren 50 mottager ett start- eller stoppkommando fiân användaren och sän- der en statussignal för den mobila roboten 1 till användaren.

Strömkällan 60 är ett elektriskt batteri som lagrar och matar en förutbestämd elektrisk spänning till respektive komponenter i den mobila roboten l.

För en total styrning av den mobila roboten 1 är styrdelen 10 kopplad till köranord- ningens 30 motordrivenhet 31, den lägesavkännande anordningen 20, den hinder- detekterande anordningen 40, den fjärrstyrda sändaren/mottagaren 50 samt strömkäl- lan 60. Styrdelen 10 innefattar en bilddataprocessor 1 1, som har en mikroprocessor för beräkning av positionsdata medelst bilddata som sändes från de första och andra bildkorten 23 och 45. Det vill säga styrdelen 10 använder sin egen lokalinformation och läges- och forminforrnation för ett hinder för att ställa in en målpunkt och en kör- kurs för den mobila roboten 1. Styrdelen 10 leder vidare den mobila roboten l utmed den raka kursen mot målpunkten. Den mobila robotens lägesinformation erhålles ge- nom användning av bilddata för basmarkören 70, som erhålles genom att med den första bildkameran 21 fotografera taket på vilket basmarkören 70 är anbringad samt genom bearbetning av den fotograferade bilden med det första bildkortet 23. Läget 20 25 30 522 383 10 för och formen på hindret erhålles med användning av linjära bilddata som erhålles genom att med den hínderdetekterande anordningens 40 andra bildkamera 43 fotogra- fera hindret och bearbeta den fotograferade bilden med det andra bildkortet 45.

Funktionen för den enligt ovan konstruerade mobila roboten 1 kommer att beskrivas mer i detalj nedan.

Körprocessen och lägesigenkärmingsprocessen för den mobila roboten 1 via den för- sta bildkameran 21 kommer att beskrivas under hänvisning till fig. 4.

Först mottager den mobila roboten 1 ett startkommando, styrdelen 10 initialiserar och kontrollerar en förutbestämd riktning och ett törutbestämt avstånd (steg S10 och S11). När det inte finns några data beträffande den förutbestämda riktningen och det förutbestämda avståndet begär styrdelen 10 bilddata från den lägesigenkännande an- ordningen 20 (steg S12). Efter mottagande av begäran av bilddata från styrdelen 10 använder den lägesigenkärmande anordningen 20 den första bildkameran 21 till att fotografera taket från den mobila robotens 1 aktuella läge. Baserad på den av den for- sta bildkameran 21 fotograferade bilden inställes den relevanta tröskeln och sändes till styrdelens 10 bilddataprocessor 11 (steg S13). Efter att ha mottagit bilddata från det första bildkortet 23, detekterar bilddataprocessom ll läget och riktningen fór bas- markörens 70 igenkärmingspunkter 71 och 73 (fig. 5) medelst en ornrâdeskorrelation och utmatar ett avstånd och en riktning som köranordningen 30 har att fórflytta sig (steg S14). Basmarkören 70, som är anbringad i taket, kan utfomias av ett lämpligt material så länge det kan igenkännas av den första bildkameran 21. Det är fördelak- tigt att använda i genkänningsmarkörer för tydligare igenkärming. Ett exempel på bas- markör 70 visas i fig. 5. Basmarkören 70 är ett igenkänningsmärke som innefattar en skiva 75, en större referenspunkt 71 och en mindre referenspunkt 73. Den större refe- renspunkten 71 är till for bestämning av basläget, medan den mindre referenspunkten 73 är till för kontroll av en riktning för den mobila roboten 1 baserat pâ dess relation till den större referenspunkten 71. 20 25 522 385 ll Styrdelen 10 sänder data om förflyttningsavståndet och riktningen från bilddatapro- cessom 11 till köranordningen 30 och köranordningen 30 arbetar i den riktning och med det avstånd som bestämmes av signalen från styrdelen 10 (steg S15).

Processen för sökning av igenkänningspunktema 71 och 73 genom en områdeskorre- lation av tröskeln för bilddata kommer att beskrivas mer i detalj nedan.

Ornrådeskorrelation är en process där maskbilddata för basmarkören 70 jämförs med bilddata som erhålles från bilden av taket fotograferat från ett visst avstånd samt ut- finnandet av ett läge som indikerar en liknande maskbild på ett bildfönster som erhål- lits av den forsta bildkameran 21. Såsom visas i fig. 6 utförs en inlämingsoperation av maskbilden 70 i en nedåtriktad orientering.

Vidare är det läge som har en maskbild liknande den av den mobila roboten 1 såsom följer. Först erhålles områdeskorrelationskoefficienter för maskbilden, som är ett re- sultat av inlämingsoperationen, från hela området för bilddata för bilden såsom den fotograferats från ett visst avstånd. Sedan välj es det område som har den största kor- relationskoefficienten, eftersom det har den bild som mest liknar bilden av igenkän- ningsmärkena 73 och 75 på basmarkören 70 mot vilken den mobila roboten 1 är in- riktad. Läget för basmarkören 70 uttryckes genom den bild som fotograferas med den första bildkameran 21 och formas på bildtönstret (W) i pixelkoordinater. Genom att följaktligen använda de ursprungliga koordinatema för basmarkören 70 och koordi- natema för basmarkören 70 på det aktuella bildfönstret (W) erhålles det aktuella läget och riktningen för den mobila roboten 1. Eflersom basmarkörens 70 läge vidare er- hålles i pixelkoordinater i varje samplíngsperiod under vilken taket fotograferas av den första bildkameran 21, erhålles även den mobila robotens l rörelse och bana.

Onirådeskorrelationskoefficienten uttryckes av 10 20 25 522 383 12 Z<.,,).S[fl-?.|f2-?Ã d,d = _ a _ y r( x y) “iz(x,y)es[fi(x>y)“firz(gyfisl/“x+dr>y+dy)"f2]2}z där r(dx,dy) är en ornrådeskorrelationskoefficient, fl är en inlämingsmaskbild, fl är ett medelvärde för inlärningsmaskbilden, Z är ett medelvärde för f2, (dmdy) är erfor- derligt fórflyttningsavstånd för maskbilden i koordinater, (x,y) är en koordinat och S är den ursprungliga bilden.

Härefter kommer ett förfarande för detektering av förekomsten av ett hinder under körningen att beskrivas under hänvisning till fig. 7.

Det hinderdetekterande förfarandet innefattar stegen: Att inrikta den linjära lasem 41 för att avge en linjär stråle mot ett hinder beläget i den mobila robotens bana (steg 31); att bringa den andra bildkameran 43 att avkänna den reflekterade linjära strålen från hindret (steg S32); att bringa det andra bildkortet 45 att bearbeta bilden från den andra bildkameran 43 till bilddata som är beräkningsbara med användning av mjuk- vara (steg S33); samt att beräkna avståndet från den mobila roboten l till hindret ge- nom användning av bilddatan (steg S34).

I det ljusavgivande steget (S31) kommer, när den linjära lasem 41 riktar en linjär strå- le mot ett hinder, hindrets fonn att distordera strålen. I det avkärmande steget (S32) formar den andra bildkameran 43 en bild genom att avkänna den reflekterade distor- derade strålen från filtret. I det bilddatabearbetande steget (S33) utför det andra bild- kortet 45 den tröskelbildande processen för att förenkla bilden som avkänts i det av- kännande steget (S32) samt att använda en uttunningsprocess för att reducera bildens storlek till att vara så liten som möjligt. I det avståndsberäknande steget (S34) beräk- nas avståndet från den mobila roboten l till hindret baserat på den från det bilddata- bearbetande steget (S43) erhållna bilddatan. Den mobila roboten l upprepar de ovan angivna hinderdetekterande processerna tills den erhåller all information om hindrets i dess bana. 20 25 585 13 Följaktligen kan avståndet från den mobila roboten 1 till hindret lätt erhållas genom trigonometri med ett par värden. Såsom visas i fig. 8 är dessa värden: En vinkel (GLP) mellan den linjära lasem 41 och den mobila roboten 1, avståndet (yLp) mellan bildka- meran 43 och den linjära lasem 41, avståndet (fo) mellan en lins 43a på bildkameran 43 och ett bildplan 43b på vilket bilden av hindret formas, samt avståndet (yj) från bildplanet 43b till linsens 43a mitt. Med dessa värden erhålles avståndet (Z) från den mobila roboten 1 till hindret genom den trigonometrisk ekvationen (hänför sig till fig. 8): Z = tan 9,, Yu* _ y Omformulera = tan du, genom att substituera xo = yLP - tan Gu» och yLP "' y y = -(Z - y1)/f0 och erhåll Z=___f°í_ 1"(y1/fo'tan01.1>) Eftersom vinkeln (GLP) mellan den linjära lasem 41 och den mobila roboten l, avstån- det (fo) mellan bildkamerans 43 lins 43a och hinderbildplanet 43b samt värdet på X0 = Yu» - tan GL; samtliga uttrycks i konstanter, så kan avståndet (Z) från den mobila robo- ten l till hindret erhållas enbart genom att erhålla ett värde (yl) motsvarande ett hori- sontellt avstånd fiån linsens 43a mitt till änden av bilddatan for den bild som formas på bfldplanet.

Genom att lösa de ovan givna ekvationerna med bilddatan kan hindrets form bestäm- IIlaS.

Enligt en annan fóredragen utforingsforrn av den föreliggande uppfinningen kan även en tredimensionell bild erhållas genom att använda ett flertal linjära lasrar 4l. Ett fler- tal linjära lasrar 41 är anordnade att avge laserstrålar mot hindret med en infallsvinkel 20 25 30 522 385' 14 som är sådan att den linjära strålens infallsvinkel mot hindret kan avkärmas medelst bildkameran 43. Flertalet linjära lasrar 41 avger de linjära strålarna mot hindret och bildkameran 43 avkänner de reflekterade strålarna från de linjära lasrarna 41. Genom bildbearbetning av de reflekterade strålarna erhålles sedan den tredimensionella bil- den. F ig. 9 illustrerar processerna for att fonna den tredimensionella bilden från ett flertal linjära bilder. På detta sätt erhåller den mobila roboten mer korrekta data om hindret såsom om hindrets form.

Slutligen kommer processen for att nå målläget under bibehållande av den riktiga kursen att beskrivas mer i detalj nedan.

När den mobila roboten 1 mottager startkommandot initialiserar och begär styrdelen 10 att få bilddata från den lägesigenkännande anordningen 20 och den hinderdetekte- rande anordningen 40. Efler att ha mottagit begäran om bilddata från styrdelen 10 fo- tograferar den lägesigenkännande anordningen 20 taket, i vilket basmarkören 70 är anbringad och alstrar en bild. Sedan bearbetar det forsta bildkortet 23 bilden till en tröskelinfonnation och sänder densamma till styrdelen 10. Den hinderdetekterande anordningen 40 använder sin linjära laser 41 och sin andra bildkamera 43 till att gene- rera bilddata om hindret som ligger i den mobila robotens 1 bana och sänder desam- ma till styrdelen 10.

Mjukvara i styrdelen 10 bearbetar bilddatan som mottagits fiån den lägesigenkännan- de anordningen 20 och den hinderdetekterande anordningen 40 for erhållande av in- formation om hindret och det aktuella läget for den mobila roboten. Styrdelen 10 in- ställer sedan målläget och kursen mot målläget baserat på den ovan erhållna informa- tionen.

Styrdelen 10 sänder körkommando till kördelen 30 for en bestämd bana, kontrollerar periodiskt koordinaterna for basmarkören 70 med förutbestämda intervall samt be- stämmer om den mobila roboten 1 rör sig utmed den bestämda banan eller ej. Om ko- ordinaterna for basmarkören 70 avviker från den bestämda banan styr styrdelen 10 20 25 30 522 585 15 köranordningen 30 till att flytta den mobila roboten 1 i motsatt riktning och därmed upprätthålla den riktiga banan för den mobila roboten 1. Efter flera banjusteringar och när den mobila roboten l når målläget upphör den mobila roboten 1 att röra sig eller fortsätter att röra sig om det föreligger en efterföljande order.

Detta förfarande hos styrdelen 10 för erhållande av det aktuella läget för den mobila roboten 1 antages motsvara den mobila robotens 1 lägesigenkännande process, som har beskrivits ovan. Följaktligen utelämnas den detaljerade beskrivningen för detta.

Här kommer processen för att kontrollera kursen och justera riktningen för den mobi- la robeten 1 när den mobila roboten 1 avviker från sin kurs, att beskrivas mer i detalj med hänvisning till fig. 10, 11A, llB och llC.

Styrdelen 10 begär bilddata om basmarkören 70 från den lägesigenkännande anord- ningen 20. Efter mottagande av begäran från styrdelen 10 fotograferar den lägesigen- kännande anordningen 20 taket i vilket basmarkören 70 är anbringad och genererar en bild av basmarkören 70. Sedan bearbetar det första bildkortet 23 bilden till bilddata som kan bearbetas av mjukvara och sänder bilddatan till styrdelen 10 (steg S51).

Styrdelen 10 beräknar koordinaterna för basmarkören 70 medelst processen för områ- deskorrelering, som är identisk med processen för erhållande av den mobila robotens 1 läge genom användning av bilddata utsända från den lägesigenkärmande anordning- en 20 (steg S52).

Därefter jämför styrdelen 10 koordinaterna för basmarkören 70, som erhållits från det aktuella läget för den mobila roboten 1, med koordinatema för den kurs som bestämts i det kursbestämmande steget (S53).

När de aktuella koordinaterna för basmarkören 70 inte överensstämmer med koordi- natema för den bestämda kursen, beräknar styrdelen 10 avvikelsen i riktning och av- stånd från de bestämda koordinaterna för kursen. Styrdelen 10 styr sedan 20 25 30 522 385 16 köranordningens 30 motor 32 till att förflytta den mobila roboten 1 så att avvikelsema kompenseras, genom att röra sig i motsatt riktning mot ett avvikande avstånd (steg S54). Om exempelvis den mobila roboten 1 är ur kurs åt höger om basmarkören 70, så styr styrdelen 10 motom 32 till att driva köranordningen 30 åt vänster, dvs. tillbaka till banan. Sådana processer visas i fig. 11A, llB och llC. Fig. 11A visar läget för basmarkören 70 indikerad på den första bildkamerans 21 bildfönster (W) när den mobila roboten 1 rör sig utmed en rak bana. Pâ samma sätt visar fig. 11B läget för basmarkören 70 på bildkamerans 21 bildfönster (W) när den mobila roboten 1 kör bort från den raka banan, medan fig. 1 IC visar läget för basmarkören 70 när den mobila roboten 1 återgår till rörelsebanan. Hänvisningsbeteckningarna 71 och 73 i fig. l1A hänför sig till basmarkörens 70 båda igenkänningspunkter.

Därefter bestämmer styrdelen 10 om det aktuella läget är målläget (steg S55). Om så inte är fallet begär styrdelen 10 att den lägesigenkärmande anordningen 20 ger bild- data för basmarkören 70 för att bestämma om den mobila roboten 1 ligger på samma koordinater som koordinaterna för den bestämda kursen.

Styrdelen 10 upprepar periodiskt ovan angivna processer med förutbestämda intervall tills den mobila roboten 1 når målläget, så att den mobila roboten 1 förflyttar sig utef- ter den bestämda kursen.

Fig. 12 visar rörelsema för den mobila roboten 1 som kan känna av sitt läge och sin manövrering runt föremål i ett rum. En sådan mobil robot 1 kan användas som en hushållsapparat, dvs. en dammsugande mobil robot. Här innefattar den mobila robo- ten 1 vidare en dammsugare, som har ett sugmunstycke för uppsugning av förore- ningar, en dammuppsamlande del för uppsamling av föroreningarna från suglufien samt en motordrivdel för att alstra sugkrafl. Den dammsugande mobila robotens 1 kurs- eller förflyttningsbana kan vara förinmatad i olika programmönster i överens- stämmelse med rummets geografi. 20 Såsom beskrivits ovan kan den mobila roboten 1 enligt den föreliggande uppfinning- en avkänna sitt aktuella läge samt även effektivt förflytta sig med en given kurs utan repetitiv genomgång av samma område.

Enligt den föreliggande uppfinningen kan den mobila roboten 1 vidare, eftersom den mobila roboten 1 erhåller information om formen på hindret genom utnyttjande av den linjära lasern 41 och den andra bildkameran 43, bestämma om den skall passera eller undvika hindret i enlighet med statusen för hindret.

Genom att den mobila roboten l enligt den föreliggande uppfinningen vidare avkän- ner sitt läge genom användning av den första bildkameran 21, kan den bestämma om den aktuella förflyttningsbanan skall bibehållas eller ej samt justera sin orientering när den bestämmer någon avvikelse från den önskade kursen.

Såsom angivits ovan har en föredragen utföringsfonn av den föreliggande uppfin- ningen visats och beskrivits. Även om en föredragen utíöringsform av den föreliggan- de uppfinningen har beskrivits skall det förstås att den föreliggande uppfinningen inte är begränsad till denna föredragna utföringsfonn. Olika förändringar och modifikatio- ner kan utföras av fackmannen på området utan att man avviker från idén med den fö- religgande uppfinningen såsom den kommer till uttryck i de efterföljande patentkra- VCII.

Claims (1)

1. 0 15 20 25 30 522 383 18 Patentkrav Mobil robot innefattande: en köranordning (3 0) for att forflytta den mobila roboten (l) runt i ett rum, en hinderdetekterande anordning (40) för att detektera närvaron av ett hinder, en styrdel (10) kopplad till och styrande köranordningen (3 0) och den hinderdetekterande anordningen (40), kännetecknad av en lägesigenkärmande anordning (20) kopplad till styrdelen (10) for att bestämma ett aktuellt läge for den mobila roboten (1), vilken lägesigenkännande anordning (20) innefattar en forsta bildkamera (21) och ett forsta bildkort (23), varvid den första bildkameran (21) avbildar taket i ett rum och avkänner en basmarkör (70) i taket och det forsta bildkortet (23) bearbetar en bild från den första bildkameran (21) och sänder data till styrdelen (10) samt en strömkälla (60) kopplad till styrdelen (10), vilken strömkälla (60) är anordnad att lagra och mata elektricitet till köranordningen (30), den hinderdetekterande anordningen (40), den lägesigenkännande anordningen (20) samt styrdelen (10), varvid basmarkören (70) är ett igenkänningsmärke som uppvisar en basskiva (75) och ett antal punkter (71, 73) utformade på basskivan (75) på ett forutbestämt avstånd från varandra. Mobil robot enligt patentkrav 1, kännetecknad av att den innefattar en dammsugare uppvisande en sugöppning for insugning av föroreningar, en dammuppsamlingsdel for att samla upp fororeningama samt en motordrivdel for att generera sugkrafi. Förfarande for att reglera en kurs eller körbana for en mobil robot (1), vilken mobila robot (l) innefattar en köranordning (3 0) for att forflytta den mobila roboten (1) runt i ett rum, en hinderdetekterande anordning (40) for att detektera närvaron av ett hinder, en lägesigenkärmande anordning (20) for att bestämma ett aktuellt läge for den mobila roboten (l), en styrdel (10) for att styra köranordningen (30), den hinderdetekterande anordningen (40) och den lägesigenkännande anordningen (20) samt en strömkälla (60) for att lagra och mata elektricitet till var och en av anordningarna (20, 30, 40) och styrdelen (10), kännetecknat av att förfarandet omfattar: 10 20 25 19 (I) fotografering av en basmarkör (70) med användning av en första bildkamera (21) i den lägesigenkännande anordningen (20), som genererar bilddata av basmarkören (70) genom utnyttjande av ett första bildkort (23), varvid basmarkören (7 0) är ett igenkänningsmärke som uppvisar en basskiva (75) och ett antal punkter (71, 73) utformade på basskivan (75) på ett förutbestämt avstånd från varandra, (II) bestämning av om koordinaterna för basmarkören (70), som erhållits genom styrdelens (10) databearbetning, överensstämmer med koordinatema för den förutbestämda körbanan, samt (III) styrning av kördelen (30) till att förflytta den mobila roboten (1) i en riktning med ett motsvarande avstånd för att kompensera varje avvikelse från den förutbestämda körbanan när koordinaterna för basmarkören (70) inte stämmer överens med koordinaterna för den förutbestämda körbanan. Förfarande enligt patentkrav 3, kännetecknat av att steg (I) innefattar: fotografering av basmarkören (70) med användning av den första bildkameran (21) i den lägesigenkännande anordningen (20) samt generering av en bild av basmarkören (70) och inställning av tröskelinformation för bilden med användning av det första bildkortet (23) och generering av bilddata. Förfarande enligt patentkrav 3, kännetecknat av att steg (II) vidare innefattar genomförande av områdeskorrelation förutom beräkning av koordinaterna för basmarkören (70).