Mikael Ögren Version 1.0 Granskad Status Godkänd 1
PROJEKTIDENTITET 09/HT, CaPS Linköpings tekniska högskola, ISY Namn Ansvar Telefon E-post Mohsen Alami designansvarig(des) 073-7704709 mohal385@student.liu.se Tobias Andersson dokumentansvarig (DOK) 076 3093880 Fredik Bodesund designansvarig(des) 076-8913299 frebo449@student.liu.se Isac Duhan 073-5811085 isadu859@student.liu.se Emil Granberg 070-2864574 graem978@student.liu.se Erik Jakobsson testansvarig (TST) 070-6225872 mrejster@gmail.com Axel Landgren hemsideansvarig(hem) 073-8747296 axela706@student.liu.se Olof Larsson 070-8109389 olola417@gmail.com Mikael Ögren projektledare (PL) 073-7623772 ogren.mikael@gmail.com E-postlista för hela gruppen: tsrt10-kph@googlegroups.com Hemsida: http//www.isy.liu.se/edu/projekt/tsrt10/2009/hamnkran_2009 Kund: ABB, 721 83 Västerås, tele: 021-32 50 00, fax: 021-13 41 12, info@se.abb.com Kontaktperson hos kund: Johan Sjöberg, 021 34 20 47, johan.sjoberg@se.abb.com Beställare: Martin Skoglund, 013 28 28 03, ms@isy.liu.se Kursansvarig: David Törnqvist, 013 28 18 82, tornqvist@isy.liu.se Handledare: Fredrik Lindsten, 013 28 40 43, lindsten@isy.liu.se 2
Innehåll DOKUMENTHISTORIK...4 1 INLEDNING...5 1.1 DEFINITIONER...6 2 ÖVERSIKT AV SYSTEMET...7 2.1 GROV BESKRIVNING AV PRODUKTEN...7 2.2 INGÅENDE DELSYSTEM...7 2.2.1 Bildbehandling...7 2.2.2 Sensorfusion...7 2.2.3 Reglering...8 2.2.4 Simuleringsmiljö... 8 3 BILDBEHANDLING...9 3.1 INLEDANDE BESKRIVNING AV BILDBEHANDLINGSDELEN...9 3.1.1 Ambienta/Externa featurepunkter...9 3.1.2 Featurepunkter på container i spreader...10 3.1.3 Featurepunkter på underliggande container...10 3.2 GRÄNSSNITT...10 4 SENSORFUSION...11 4.1 INLEDANDE BESKRIVNING AV SENSORFUSIONSDELEN...11 4.1.1 Rörelsemodell...11 4.1.2 Mätekvationer...12 4.1.3 Filter...12 4.2 GRÄNSSNITT...12 5 REGLERING...13 5.1 INLEDANDE BESKRIVNING AV REGULATORDELEN...13 5.1.1 Styrenhet...13 5.1.2 Regulator för förflyttning...13 5.1.3 Regulator för containerpositionering...14 5.2 GRÄNSSNITT...14 6 SIMULERINGSMILJÖ...15 6.1 INLEDANDE BESKRIVNING AV SIMULERINGSMILJÖ...15 6.2 GRÄNSSNITT...15 3
Dokumenthistorik version datum utförda förändringar utförda av granskad 1.0 2009-09-18 Första versionen TA MÖ, MS 0.2 2009-09-17 Andra utkastet CaPS MÖ, MS 0.1 2009-09-15 Första utkastet CaPS MÖ, MS 4
1 Inledning Projektets syfte är att utvärdera hur långt man kan nå med att använda standardvideokameror för att skatta positionen för en hamnkran med dess last. Kranens uppgift är att förflytta containrar i ett containermagasin. Således skall det även utredas vilka reglermöjligheter det finns för att styra containerpositionering utifrån skattad position. Figur1. Systemetidessomgivning. 5
1.1 Definitioner Bom/Girder Trolley/Tralla Gauntry Spreader Hoist Container Räls Figur2. Kransystemet Hoist Längden från trolley till spreadern. Trolley/Tralla Vagn som löper över bommen. Spreader Anordning som fäster vid containern. Gauntry Ställning som bommen sitter på. Container Den last som kranen lyfter. Landmärken En punkt som kan beskrivas i ett fixt, globalt koordinatsystem. Featurepunkt En punk som relaterar till ett fysiskt landmärke, typiskt containerhörn. 6
2 Översikt av systemet Kamerafilm Bildbehandling Simuleringsmiljö Sensorfusion Regulator Simulerad bildbehandling Figur3. Dennabildvisarenöversiktavsystemet. 2.1 Grov beskrivning av produkten Systemets uppgift är att skatta position hos kranbom och last utifrån videosekvenser. Videobilder från ett antal kameror signalbehandlas i bildbehandlingsdelen. Den behandlade informationen från varje kamera samlas i sensorfusionsdelen som utnyttjar samma data för att med hjälp av en mekanikmodell bestämma aktuella tillstånd (position, hastighet) för last och kran. Regulatordelen använder dessa tillstånd för att reglera kranen. Kranen simuleras i en simuleringsmiljö. 2.2 Ingående delsystem Nedan följer en beskrivning av de olika delsystemen. 2.2.1 Bildbehandling Systemet tar emot data från en, eventuellt flera kameror. Bildbehandlingsdelen utför digital bildbehandling av varje kameradataström. Efter behandling av brus och dylikt så utvärderas konturer och andra element i bilden. Detta resulterar i ett antal featurepunkter från varje bild. 2.2.2 Sensorfusion I detta delsystem fusioneras all data och används tillsammans med den valda mekanikmodellen för att estimera position, hastighet och andra tillstånd hos kran och last. 7
2.2.3 Reglering I detta delsystem ska en regulator tas fram som kan hantera upptagning, nedsättning samt förflyttning av container. 2.2.4 Simuleringsmiljö I detta delsystem simuleras kranen utifrån styrsignaler ifrån regulatorn samt yttre förhållanden. 8
3 Bildbehandling Kamerafilm Extern miljö Koord. för featurepkt fr. mark Längd på hoist Egen container Koord. för featurepkt fr. egen container Status för spreader Extern container Koord. för featurepkt fr. extern container Figur4. BildavBildbehandlingsdelen 3.1 Inledande beskrivning av bildbehandlingsdelen I bildbehandlingsdelen kommer en videoström att analyseras och utifrån denna identifiera featurepunkter som sedan kan användas i sensorfusionsdelen. Bildbehandlingsdelen kommer att hanteras separat ifrån de andra delsystemen då vi ej kommer kunna åstadkomma en komplett återkoppling där videoströmmen påverkas av våra styrsignaler till kranen. Målet för bildbehandlingsdelen är en analys av med hur stor noggrannhet vi kan identifiera featurepunkter. Bildbehandlingsdelen kommer bestå av tre olika delsystem för att identifiera tre olika typer av featurepunkter. 3.1.1 Ambienta/Externa featurepunkter Denna delkomponent kommer att identifiera featurepunkter i omgivningen kring kranen. Gemensamt för dessa featurepunkter är att de ska vara stationära när kameran förflyttar sig. Det kan till exempel vara markeringar på marken eller hörn på containrar i magasinet. Dessa kommer att utnyttjas till att bestämma kamerans globala position och rörelse. 9
3.1.2 Featurepunkter på container i spreader Denna delkomponent kommer identifiera givna featurepunkter på container i spreader, eventuellt bara på spreader. Dessa kommer vara strikt givna och det är av vikt att rätt featurepunkter kommer identifieras, det kan till exempel röra sig om specifika hörn på containern i spreadern eller specifik punkt på spreader. 3.1.3 Featurepunkter på underliggande container Denna delkomponent kommer att identifiera givna featurepunkter på den underliggande containern som containern i spreadern ska staplas på. Dessa kommer vara strikt givna och det är av vikt att rätt featurepunkter identifieras, det kan till exempel röra sig om specifika hörn på containern eller containerbeteckning. 3.2 Gränssnitt Som insignal kommer bildbehandlingsdelen att få kamerafilmen samt hoistlängd och om spreadern håller i container eller inte. Bildbehandlingsdelen kommer att ge koordinater för featurepunkterna som utsignal till sensorfusionsdelen. 10
4 Sensorfusion Koord. för featurepkt fr. mark Koord. för featurepkt fr. egen container Koord. för featurepkt fr. extern container Rörelsemodell Mätekvation Trallas position och hastighet Containers position och hastighet Längd på hoist ev. styrsignal till motor Filter Extern containers position Figur5. Bildavsensorfusionsdelen 4.1 Inledande beskrivning av sensorfusionsdelen Sensorfusionsdelen ska utifrån featurepunkter givna av bildbehandlingsdelen, eller simulerad bildbehandling, kunna skatta positionen på kameran, samt positionen på containern/spreadern. Den ska även estimera med hur stor säkerhet positionerna är givna utifrån osäkerheten i featurepunkter och dynamikmodell. Sensorfusionsdelen kommer att innehålla tre delkomponenter. 4.1.1 Rörelsemodell Sensorfusionsdelen kommer att innehålla två olika rörelsemodeller, en för trolleyn och en för container/spreader. Dessa används för att estimera framtida hastigheter och positioner. 11
4.1.2 Mätekvationer Mätekvationerna beskriver förhållandet mellan mätdata och de interna tillstånd som används för att skatta koordinater och hastigheter i det globala systemet. 4.1.3 Filter Filtret har till uppgift att på bästa möjliga sätt kombinera rörelsemodellernas och mätekvationernas resultat så att vi får en god skattning av tillstånden. 4.2 Gränssnitt Insignal till sensorfusionsdelen kommer att vara koordinater för featurepunkter, hoist och eventuellt styrsignaler från regulatorn. Utsignaler kommer att vara skattade positioner och hastigheter. 12
5 Reglering Trallas position och hastighet Mekanikmodell Containers position och hastighet Styrenhet Styrsignaler till kran Extern containers position Regulator för förflyttning Börvärden Regulator för containterpositionering Figur6. Dennabildvisarregulatordelen 5.1 Inledande beskrivning av regulatordelen Regulatordelen ska utnyttja positioner givna av sensorfusionsdelen för att styra trolley, gauntry och hoist för att därigenom styra containerposition. Regulatordelen kommer bestå av tre delkomponenter. 5.1.1 Styrenhet Styrenheten vet vilken reglersituation systemet befinner sig i och bestämmer utifrån detta vilken typ av regulator som skall utnyttjas. 5.1.2 Regulator för förflyttning Denna regulator är anpassad för att förflyttning av trolleyn från en position till en annan. Detta skall ske utan att containern förskjuts ifrån sin relativa nollposition mer än 50 cm. 13
5.1.3 Regulator för containerpositionering Denna regulator är anpassad för att kunna positionera en container ovanpå en underliggande container. Detta skall ske så att positioneringen inte avviker mer än 5 cm från tänkt position. 5.2 Gränssnitt Som insignal kommer regulatordelen att få positionen och hastigheten för trolley samt spreaderns relativa hastighet och position. Från användare kommer regulatorn antingen få ett börväde på trallans position eller en position där en container skall hämtas eller placeras. Utsignal från regulatorn skall vara styrsignal till kranens positionsstyranordning. 14
6 Simuleringsmiljö Styrsignaler från regulator Simulerade featurepunkter Mätbrus Kran- och containermodell Simulerade featurepunkter Modellfel Simulerad bildbehandling Figur7. Dennabildvisarsimuleringsmiljön 6.1 Inledande beskrivning av simuleringsmiljö I simuleringsmiljön skall man kunna verifiera om regulatorn och sensorfusionsdelen uppfyller ställda krav på prestanda. Vi skall här kunna beskriva en värld för kranen utifrån vilken systemet skall kunna bestämma sin position och hastighet. Världen ska bestå av featurepunkter som vi identifierar med en simulerad bildbehandling. 6.2 Gränssnitt Som insignal får simuleringsdelen styrsignaler från regulatordelen. Det ska även finnas möjlighet att skicka in mätbrus och modellfel. Som utsignal ger simuleringsdelen koordinater för featurepunkter, dvs. detsamma som bildbehandlingsdelen ska göra. 15