- utveckling av en haptisk enhet



Relevanta dokument
Robotarm och algebra

Institutionen för matematik och datavetenskap Karlstads universitet. GeoGebra. ett digitalt verktyg för framtidens matematikundervisning

FEM-modellering och analys av en elastisk komponent

Bemästra verktyget TriBall

Bemästra verktyget TriBall

F3C HELIKOPTER SPORT PROGRAM (Ny manöver 2 ersätter tidigare, fr.o.m. 2001)

Biomekanik, 5 poäng Jämviktslära

TANA17 Matematiska beräkningar med Matlab

Kapitel 7 Skorsten, trappa och inredning... 3

Naturlagar i cyberrymden VT 2006 Lektion 6. Martin Servin Institutionen för fysik Umeå universitet. Modellering

Beräkningsuppgift I. Rörelseekvationer och kinematiska ekvationer

GeoGebra i matematikundervisningen - Inspirationsdagar för gymnasielärare. Karlstads universitet april. Liten introduktionsguide för nybörjare

cos( x ) I 1 = x 2 ln xdx I 2 = x + 1 (x 1)(x 2 2x + 2) dx

Tillämpad biomekanik, 5 poäng Övningsuppgifter

K-uppgifter Strukturmekanik/Materialmekanik

Rapport LUTFD2/TFHF-3089/1-16/(2013) Föreläsningsexempel i Teknisk mekanik

Semantic and Physical Modeling and Simulation of Multi-Domain Energy Systems: Gas Turbines and Electrical Power Networks

TAIU07 Matematiska beräkningar med Matlab

Collaborative Product Development:

Analys av två timmerredens påverkan på lastbilsram

Undersökning av hjulupphängning och styrning till ett fyrhjuligt skotarkoncept. Emil Larsson

Här följer fyra övningar som värmer upp axlarna, skuldrorna och ryggen.

Mekanik FK2002m. Kraft och rörelse I

Livens inverkan på styvheten

G 21 C 7/14

Progress report. In Project course in Engineering mechanics. SGT 700 compressor 1 st stage blade in composite material. A report made by Group C

Innehållsförteckning

Transformationer i R 2 och R 3

NATIONELLT PROV I MATEMATIK KURS D VÅREN Tidsbunden del

Skapande av en modifikation till Crysis

Analys av lyftarm för Sublift. Stefan Erlandsson Stefan Clementz

LABORATIONSHÄFTE NUMERISKA METODER GRUNDKURS 1, 2D1210 LÄSÅRET 03/04. Laboration 3 3. Torsionssvängningar i en drivaxel

5 Relationer mellan individens utvecklingsnivå, olika verktyg och användning av olika produkter

Programmeringspalett. Pr o gr a mvar a

Exempel. Vi skall bestämma koordinaterna för de punkter som finns i bild 3. OBS! Varje ruta motsvarar 1mm

Tentamen Mekanik F del 2 (FFM521 och 520)

n-abler är lämplig för alla åldersgrupper med motoriska svårigheter och för dem som arbetar långa perioder vid datorn.

Department of Information Technology Digitala projekt. SuperKull. Daniel Öhman Alexander Persson

EXPERIMENTELLT PROBLEM 2 DUBBELBRYTNING HOS GLIMMER

Försvar. 1. Förberedande försvarsträinng (5 eller 6 spelare). 2. Försvar mot 1:a-tempo följt av 3:e-tempo (minst 6 spelare).

Andra EP-laborationen

n-abler STYRKULA Handbok Underhåll Avfallshantering Förbrukad produkt ska hanteras som elektronikavfall

# /03/2005. Hydrauliska Spännare. Introduktion

Omtentamen TNM077, 3D datorgrafik och animering (samt även TNM008, 3D datorgrafik och VR)

TEKNISK NOTIS TN AT006

REGLERTEKNIK Inledande laboration (obligatorisk)

Lösningar och kommentarer till uppgifter i 3.1

Laboration 2: Konstruktion av asynkronmotor

Inledning. Kapitel Bakgrund. 1.2 Syfte

Jigg för raka eggar SE-76

Fönster och dörr. Kapitel 3 - Fönster och dörr... 3

RÖRELSE. - Mätningar och mätinstrument och hur de kan kombineras för att mäta storheter, till exempel fart, tryck och effekt.

DN1240, numo08 Stefan Knutas, Fredrik Båberg, B.10: Nalle-Maja gungar

Luddborttagning. Institutionen för produkt- och produktionsutveckling. Chalmers tekniska högskola Göteborg. Grupp E3.

Koordinatsystem och Navigation

Syns du, finns du? Examensarbete 15 hp kandidatnivå Medie- och kommunikationsvetenskap

Tentamen Mekanik F del 2 (FFM520)

Kapitel 4 Tak Tak Kapitel 4

FlyBot. Copyright Sagitta Pedagog AB

Lösning till fråga 5 kappa-06

Bröstrygg och Skuldra

6-DOF-verktyg och dess användningsområden inom edutainment

LEKTION PÅ GRÖNA LUND GRUPP A (GY)

Tentamen Mekanik F del 2 (FFM520)

Angående skjuvbuckling

Övningsbeskrivningar Åtgärdsprogram 1

Uppvärmning och rörlighetsövningar SKF Anna Åberg, Anette Johansson och Anna Bjerkefors

Optisk bänk En Virtuell Applet Laboration

Tentamensskrivning i Mekanik - Dynamik, för M.

Introduktion till Biomekanik - Statik VT 2006

Kartesisk PTP-körning

Laboration Fuzzy Logic

Träningsprogram (T) - :: Secrets to Soccer ::

" = 1 M. ( ) = 1 M dmr. KOMIHÅG 6: Masscentrum: --3 partiklar: r G. = ( x G. ,y G M --Kontinuum: ,z G. r G.

Vrida detalj samt flytta nollpunkt 1

Belastningsanalys, 5 poäng Balkteori Deformationer och spänningar

NATIONELLT KURSPROV I MATEMATIK KURS D VÅREN Del I, 13 uppgifter med miniräknare 3. Del II, breddningsdel 8

Träning motionär (första veckoprogrammet av 4)

Biomekanik Belastningsanalys

9-1 Koordinatsystem och funktioner. Namn:

INFORMATION OM TRACKBALLS & ANDRA STYRDON

Snabbguide. ITP Whiteboard har 3 nivåer bas, medel och avancerad. Detta gör att det är enkelt att börja jobba med ITP Whiteboard.

TENTAMEN I HÅLLFASTHETSLÄRA FÖR I2 MHA april (5 timmar) Lärare: Anders Ekberg, tel

Tentamen i Robotteknik MPR160 och MPR210, 20 oktober 1997

UPPGIFT 1 V75 FIGUR 1.

Chalmers Tekniska Högskola och Mars 2003 Göteborgs Universitet Fysik och teknisk fysik Kristian Gustafsson Maj Hanson. Svängningar

Skola i Mariehäll Public School - Mariehäll. Gustaf Boström. Supervisor. Examiner

Övningsuppgift 8. ArchiCAD 16. Eget Bibliotek ! Med kopieringsrätt för Peder Skrivares skola, Varberg

Drakbåtsteknik. Steg av Katarina Forsberg. sammanställt av Birgitta Lagerholm

4. Deformerbara kroppar och fluider [Pix-SE, IR-11]

UPPGIFT 1 WILL ROGERS FENOMEN

f(x) = x 2 g(x) = x3 100

Du Kan Fixa. Rubiks kub i 8 steg KUB. ALEGA Skolmateriel AB

Ljusets böjning & interferens

MS-250M. Elektriskt ställdon för styrning/reglering av spjäll, ledskenor och ventiler

Tentamen i SG1140 Mekanik II. Problemtentamen

Laboration i Maskinelement

ROCKJET GRUPP A (GY) FRITT FALL

Målsättningar Proffesionell kunskap. Kunna hänvisa till lagar och definitioner. Tydlighet och enhetliga beteckningar.

Geometrisk optik. Syfte och mål. Innehåll. Utrustning. Institutionen för Fysik

Transkript:

1 Haptik/Robotik - utveckling av en haptisk enhet Fredrik Malgerud Jimmy Selling Adam Claesson Kandidatarbete Stockholm 2008

Haptik/Robotik - utveckling av en haptisk enhet av Fredrik Malgerud Jimmy Selling Adam Claesson Kandidatarbete MMKB 2008:10 MKNB 023 KTH Maskinkonstruktion SE-100 44 STOCKHOLM

Bachelor Thesis MMKB 2008:10 MKNB 023 Haptic/Robotic - development of a haptic device Adam Claesson Fredrik Malgerud Jimmy Selling Date 2008-05-21 Examiner Kjell Andersson Ulf Sellgren Supervisor Kjell Andersson Suleman Khan Commissioner Kjell Andersson, KTH Maskinkonstruktion Contact person Kjell Andersson Abstract The objective of this project was to find and analyse the working-area, mobility, and required torque for the actuator of two different haptic robot models. The models were built in the computer program Adams. Adams was used to do all the tests and analysis. To describe the working-area a varying force were imposed that dragged the robots TCP (Tool Centre Point). This showed that Tau model 2 had a somewhat longer reach than model 1 but that model 1 had a larger working-area in the vertical level. To investigate the mobility of the robots, a cube formed space in the working-area was defined where the robots should have maximum mobility. The TCP were positioned in each of the eight corners of the cube and forced to rotate in all three axis until stopped by a lockup. The conclusion was that the TCP were able to rotate more when positioned further away from the middle. The third analysis performed studied the torques needed in the actuator to keep the TCP from moving when exposed to different kinds of forces and torques. The results states that the motors needs more power when working close to the base.

Kandidatarbete MMKB 2008:10 MKNB 023 Haptik/Robotik - utveckling av en haptisk enhet Adam Claesson Fredrik Malgerud Jimmy Selling Datum 2008-05-21 Examinator Kjell Andersson Ulf Sellgren Handledare Kjell Andersson Suleman Khan Uppdragsgivare Kjell Andersson, KTH Maskinkonstruktion Kontaktperson Kjell Andersson Sammanfattning Projektet går ut på att ta fram och analysera arbetsområde, rörlighet och moment i styrande leder för två olika haptiska robotmodeller. Modellerna byggdes upp i datorprogrammet Adams för att kunna göra nödvändiga analyser. För att beskriva arbetsområdet ansattes en varierande kraft som drog i robotens TCP (Tool Centre Point). Det visade sig att Tau modell 2 hade något längre räckvidd, men att Tau modell 1 hade större arbetsområde i vertikalled. För att undersöka rörligheten hos robotarna togs det först fram en kubformad avgränsning i arbetsområdet där roboten bör ha bäst rörlighet. Sedan placerades robotens armar i vart och ett av kubens hörn och tvingades rotera kring samtliga tre axlar tills en låsning uppkom. Här visade det sig att båda robotarna hade större möjlighet att rotera TCP när armarna var långt ut ifrån roboten än när den höll armarna nära. Den tredje analysen som gjordes var av de moment som uppkom i de styrande lederna när TCP påverkades av en kraft respektive ett vridande moment. Från denna analys drogs slutsatsen att båda robotarna belastas mycket mer när de jobbar nära inpå mittornet.

Innehållsförteckning 1 Inledning... 1 1.1 Bakgrund...1 1.2 Syfte... 2 1.3 Modeller... 2 1.3.1 Tau 1... 2 1.3.2 Tau 2... 2 2 Metod... 3 3 Utförand... 3 3.1 Modellbyggande... 3 3.1.1 Leder i Tau 1... 5 3.1.2 Leder i Tau 2... 6 3.1.3 Förbättrade modeller... 6 3.2 Arbetsområde... 7 3.3 Rörlighet/styrbarhet... 8 3.4 Kraftanalys...8 4 Resultat... 9 4.1 Arbetsområde... 9 4.2 Rörlighet... 11 4.3 Kraftanalys... 13 5 Diskussion... 15 6 Slutsatser... 16 7 Rekomendation... 16 8 Referenser... 16 Bilaga 1 Rotationstest 1 för Tau 1 och 2 Bilaga 2 Rotationstest 2 för Tau 1 och 2 med förbättringar Bilaga 3 Kraftanalys Tau 1 och 2

1 Inledning Då allt mer arbete utförs med hjälp av datorer och i simulerade miljöer är det viktigt att simuleringarna blir så verklighetstrogna som möjligt. Idag är synen den absolut viktigaste kommunikationsvägen mellan människa och dator. Hörseln är också ett sinne som flitigt används. Känseln däremot är ett sinne som hamnat i skymundan än så länge. I och med att simuleringarna blir alltmer avancerade ställs det krav på att även detta sinne kan användas. Då räcker inte dagens primitiva datormöss, utan mer avancerad styrutrustning behövs. Detta projekt är en del i att förbättra människans kommunikation med datorn, genom att utveckla en enhet som kan känna på virtuella objekt i datorn. 1.1 Bakgrund Haptik är ett mycket gammalt ord som används för att förklara en relativt ny teknik som går ut på att med hjälp av återkoppling returnera verkliga eller simulerade krafter till användaren. Principen är ganska enkel och består normalt av fem komponenter; 3D-modell, dator, display, robotstruktur och användare, figur 1. 3D-modell Dator Display Robotstruktur (givare,motorer) Känsel Användare Visuellt Figur 1. Grundläggande haptisk logik. Robotstrukturen fungerar ungefär som en bakvänd industrirobot, istället för att styra roboten med programvara, styrs den med användarens hand. På så vis kan datorn registrera rörelser hos roboten och även ge tillbaka signaler till användaren i form av motstånd. Vill man exempelvis simulera en tandborrning görs en 3D modell av en tand i datorn. Tandläkaren kan hålla i den haptiska modellen på samma sätt som han skulle ha hållit i en riktig borr. Genom att titta på displayen kan tandläkaren se hur verktyget rör sig. Går borren emot tanden skickar datorn signaler till robotstrukturen, vilken med hjälp av motorerna simulerar kontakten med tanden. Tandläkaren kan alltså både se tanden och verktyget optiskt på displayen samtidigt som den känner objektet med borrmodellen via robotstrukturen. Med denna metod kan man alltså simulera en tandborrning utan att behöva borra i en fysisk tand. [2] Användningsområdena domineras idag av medicinsk simulering, påläggning av yttre krafter vid servostyrning och av spelindustrin för att ge en förhöjd spelkänsla. Men användningsområdena ökar och det blir allt vanligare att man använder sig av haptiska enheter i samband med produktutveckling. Detta för att tidigare kunna ge en känsla av produkten utan att behöva bygga fysiska modeller. [3] För att användaren ska få en bra och verklighetstrogen simulering av krafter ställs höga krav på robotstrukturen. Detta eftersom den måste kunna simulera relativt stora krafter. Ännu viktigare är att strukturen ska kunna röra sig friktionslöst, vilket innebär att det endast ger upphov till små dynamiska krafter vid rörelse. 1

Eftersom simuleringsbehoven blir allt mer avancerade, krävs mer av de haptiska strukturerna. Dagens strukturer kan endast simulera krafter i tre frihetsgrader, även om det finns strukturer som kan röra sig i sex frihetsgrader. [1] 1.2 Syfte Projektet går ut på att analysera två stycken haptiska robotmodeller som använder sig av parallelkinematik. Projektet ska utreda hur stort arbetsområde modellerna har och om de har sex aktiva frihetsgrader. Samt om de har möjligheten att kunna ge kraftåterkoppling i dessa sex frihetsgrader det vill säga gå att styra. 1.3 Modeller De modeller som skulle analyseras blev tilldelade gruppen i form av två bilder, figur 2. Det var sedan upp till gruppen att göra en bedömning av hur robotarna skulle röra sig och hur armarna skulle förhålla sig till varandra storleksmässigt. Båda modellerna är uppbyggda av parallellkinematiska strukturer, vilka är speciellt lämpade då låg vikt och hög mekanisk styvhet eftertraktas. Under utvecklingen av modellerna har följande krav beaktats: Sex aktiva frihetsgrader Låg friktion och låg tröghet Hög styvhet 1.3.1 Tau 1 Den här roboten har tre leder som roterar kring tornet och en led högst upp som kan kontrollera rörelser i vertikalled. På baksidan sitter det en länkarm som har som syfte att skapa en viss symmetri mellan armarna. Armarna är uppdelade i ett bakre och främre parti. Det främre består på ena sidan av två parallella armar och på andra sidan av tre parallella armar. 1.3.2 Tau 2 I viss mån påminner Tau 2 väldigt mycket om Tau 1. Den har tre leder som roterar kring tornet. De undre armarna har liknande konfiguration som hos Tau 1. Vad som däremot skiljer robotarna åt är att överarmen inte kan röra sig vertikalt, men däremot antas kunna rotera kring sin egen axel. Tau 2 saknar dessutom en baklänk som hindrar de undre armarna att röra sig osymmetriskt. 2

Figur 2. Tilldelade modeller. Tau 1 till vänster, Tau 2 till höger. 2 Metod 1. De båda robotstrukturerna modelleras i programmet ADAMS- view. [4] 2. För att kunna variera arbetsarmarnas längder behövs modellerna parameteriseras. 3. Kopplingarna mellan delarna definieras med hjälp av olika leder, så att modellerna får sex frihetsgrader. 4. De leder som styr strukturen identifieras. I en fysisk modell används motorer i dessa leder för att styra robotstrukturerna. 5. Genom att lägga på en varierande kraft på TCP samt att låsa dess rotation, kan ett arbetsområde tas fram. TCPs olika positioner lagras och exporteras till Matlab [5] så att arbetsområdet kan visas i en graf. 6. I arbetsområdet ritas en 1dm 3 stor kub ut. Vid kubens hörn analyseras modellens rotationsförmåga samt momentpåverkan i styrande leder. 3 Utförand 3.1 Modellbyggande Som utgångspunkt modellerades först tornet och ringarna på roboten. Därefter placerades en del punkter (points) ut i rymden runt roboten. Punkternas koordinater räknades ut med hjälp av trigonometri och var beroende av robotens armlängder, detta för att kunna användas som fästpunkter för armarna. På så vis kan armlängderna varieras (inom vissa gränser) utan att tappa kontakt med övriga delar. Därefter gjordes en preliminär analys av de leder som roboten skulle behöva för att uppnå sex frihetsgrader, men ändå upprätthålla styrbarhet i strukturen. Storleken på modellerna ses i figur 3a och 3b. 3

Figur 3a. Mått på Tau 1. Figur 3b. Mått på Tau 2. Båda robotmodellerna har liknande konfiguration gällande sina arbetsarmar, figur 4. På ena sidan sitter det två armar som är parallella i vertikalplanet och bildar en fyrledsmekanism mellan TCP och basarmen. På andra sidan är det istället tre armar, två av dem är parallella i vertikalplanet på samma sätt som på andra sidan. Den tredje armen ligger i sin tur parallellt med en av de andra armarna fast i horisontalplanet. Dessa tre armar bildar på så sätt två fyrledsmekanismer. 4

Figur 4. Modellernas armar. 3.1.1 Leder i Tau 1 I tornet valdes rotationsleder (revolute) i ringarna, tornets överdel samt i den cylinder som styr överarmen. Då man för styrbarhetens skull gärna vill ha de leder man vill styra så nära robotens mitt som möjligt delades båda robotens basarmar upp i två delar och fästes ihop med varsin rotationsled. På robotens baksida sitter det en länk för att koppla basarmarnas rörelser till varandra. Länken är i ena sidan fäst i tornet med en rotationsled och i andra sidan fäst i bakarmarna med kulleder. Bakarmarna är i sin tur fästa i basarmarna med universalleder. Detta för att hindra armarna från att rotera runt sin egen axel men i övrigt bibehålla full rörlighet. Längst ut på basarmarna sitter det en mellanpinne som pekar upp respektive ner. Denna är helt fastlåst i basarmen och kan inte röra sig i förhållande till varandra. Dessa pinnar är i sin tur ihopkopplade med robotens arbetsarmar med universalleder. Arbetsarmarna är sedan ihopkopplade med robotens TCP med kulleder. Robotens överarm är helt fastlåst i tornets roterande cylinder. På andra sidan sitter det en till arbetsarm som även den är kopplad med en universalled i ena änden och en kulled i andra, figur 5. Figur 5. Leder på Tau 1. 5

3.1.2 Leder i Tau 2 Tau-modell 2 har tre stycken basarmar som alla är kopplade med rotationsleder till tornet, figur 6. På basarmarna sitter arbetsarmarna som är fastsatta med universalleder. Plattan med TCP är sedan fastsatt med sfäriska kulleder. Figur 6. Leder på Tau 2. 3.1.3 Förbättrade modeller Under rotationsanalysen framkom att varken Tau-modell 1 eller 2 var möjlig att styra fritt i varje frihetsgrad var för sig. Detta fick gruppen att besluta sig för att förändra de båda modellerna. Den inre arbetsarmen plockades bort, figur 7. Detta ledde till att modellerna gick att rotera mer fritt och ett önskvärt resultat kunde uppnås. Tau-modell 1 som innan denna förändring bara hade fem frihetsgrader enligt Gruebler-kriteriumet fick efter förändringen istället sex frihetsgrader. Modell 2 som innan hade sex frihetsgrader enligt Gruebler fick då istället fem, vilket ledde till att en av lederna behövde förändras. Denna förändring gjordes mellan den övre basarmen och den övre arbetsarmen där universalleden byttes ut mot en rotationsled, figur 8. 6

Figur 7. Den röda armen plockades bort för att få bättre rörlighet. Figur 8. Tau 2s leder efter förbättringen. 3.2 Arbetsområde Robotarnas arbetsområde togs fram genom att lägga på en varierande kraft i både storlek och riktning på TPC. Samtidigt som kraften verkade sparades TPCs rörelse, vilka sedan kunde plottas i en graf. För att undvika onaturliga rörelser låstes rotationen runt Z- och X-axeln. Då Adams inte känner av kollisioner flyttades först TCP med en konstant kraft in till sitt närmsta läge mot tornet. Därefter aktiverades den varierande kraften, vilken rör TCP ut från tornet samtidigt som den rör sig upp och ner (+Y och Y). Med denna metod fås ett arbetsområde i ett vertikalplan. Eftersom roboten sedan kan röra sig 360 runt tornet fås ett donutformat arbetsområde. Detta motsvarar det teoretiskt maximala arbetsområdet. För vidare analys ritades en kub på 1dm 3 ut i Adams med hjälp av rörelsevillkor. Denna kub placerades så centralt som möjligt i arbetsområdet. 7

3.3 Rörlighet/styrbarhet För att testa rörligheten hos de tre rotations-frihetsgraderna analyserades varje hörn i den framtagna kuben inne i arbetsområdet. Detta test utfördes genom att i tur och ordning flytta TCP till de åtta olika hörnen. I hörnen vreds plattan med TCP utan att förflytta sig i någon riktning. Rotationstesten utfördes i alla tre rotations-riktningar och åt båda hållen i varje riktning. På så vis kunde rörligheten i varje punkt analyseras. Resultatet fördes in i grafer, en för varje hörn, se bilaga 1. Resultatet från testet var inte tillfredsställande vilket ledde till att gruppen beslutade att modellerna skulle förbättras så att önskvärda resultat var möjliga att uppnå. Efter förbättringen gjordes testet om för alla hörn och resultatet plottades i grafer som finns att se i bilaga 2. Under testet analyserades även vart de styrande lederna sitter och vart man på så vis ska sätta motorer för att kunna styra modellen. Genom att först röra modellen genom att lägga på ett rörelsevillkor i TCP och spela in hur varje styrande led rör sig. Sedan spelades denna inspelning upp genom att lägga på de inspelade rörelserna i de styrande lederna. På så sätt kunde gruppen konstatera om de rätta lederna hade lokaliserats och att modellen går att styra med motorer i dessa leder. 3.4 Kraftanalys För att få en bild av det moment som behövs i motorerna utfördes ett test. Testet inleddes genom att förflytta plattan med TCP till ett av hörnen i den kub som tidigare tagits fram. Med TCP i ett hörn skapades en ny modell där de styrande lederna låstes fast. I låsningen skapades en avläsningspunkt som mätte det moment som låsningen tog up. På TCP applicerades en kraft eller ett moment som gradvis fick öka från 0 till 50 N respektive Nmm. Efter testet plottades momentet som avläsningspunkten mätt upp i en graf mot den kraft eller moment som lagts på TCP. Krafter och moment ansattes i tre riktningar. Resultatet från testet finns att se i bilaga 3. Endast fyra hörn analyserades i denna första studie av modellerna. 8

4 Resultat 4.1 Arbetsområde Arbetsområdena för robotarna plottades i Matlab, figur 9a och 9b. Robotarnas torn är placerade i X=0. Den maximala förflyttningen hos Tau 1 är X=325mm och Y=500mm. För Tau 2 blev det istället X=250mm och Y=200mm. Figur 9a. Simulerat arbetsområde för Tau. Figur 9a. Simulerat arbetsområde för Tau 2. Sett uppifrån fås ett cirkelformat arbetsområde där robotarnas torn är placerat i X=0 och Y=0, se figur 10a och 10b. 9

Figur 10a. Arbetsområde för Tau 1 sett uppifrån. Figur 10b. Arbetsområde för Tau 2 sett uppifrån. Inom arbetsområdet placerades en kub i vilken rörlighet undersöktes, figur 11. Kuben för Tau 2 gjordes till1 dm 3. Armarna på Tau 1 har en total längd som är ca 1,9 gånger större än armarna på Tau 2 och för att en jämförelse mellan dessa skulle vara rättvis gjordes kuben för Tau 1 till 1,9dm 3. 10

Figur 11. kuben i Tau 1 hörnen är numrerade 1 till 8. 4.2 Rörlighet Resultatet från det första testet med ursprungsmodellen visade på att varken tau modell 1 eller 2 var möjlig att styra fritt i de tre rotationsriktningarna utan det var endast möjlig att rotera runt Z och X då Y rotationen var helt fri. Resultatet från det första rotationstestet för Tau 1 i hörn 1, hörnet bak uppe höger, ses i figur 12. Här ses hur TCP har roterat runt X och Z axeln två gånger dels negativ rotation samt positiv. Resultatet från testet säger att TCP kan rotera 20º i Z, 75 º i +Z, 51º i X och 49 º i +X dvs. nästan 100º både runt Z och X. Alla grafer finns att beskåda i bilaga 1. Figur 12. Resultatet från rotationstest 1 för Tau 1 i hörn 1 Bak Uppe Höger. 11

I test nummer två analyserades rotationsmöjligheterna för de modifierade modellerna. Här kunde rotation ske runt alla tre axlar var för sig. Alla vinklar som var under 50º åt något hållet, sett från oförändrat tillstånd, ansågs som en möjlig begränsning i en framtida användning av modellen. Dessa vinklar räknades ihop för varje hörn, figur 13. Resultatet ger att rotationen för båda modellerna var bättre längre ifrån tornet än då TCP befinner sig nära. Ifall rotationsmöjligheterna var bättre till höger eller vänster och uppe eller nere gav analysen inget entydigt svar. Hela resultatet finns att betrakta i bilaga 2. Figur 13. Antalet vinklar som är mindre än 50º i varje hörn för de båda modellerna. Under testet kunde även de styrande lederna lokaliseras och dessa finns representerade i figur 14. För Tau 1 lyckades inte gruppen styra kryssleden som finns mellan basarm 1 och den nedre arbetsarmen på vänster sida på ett tillfredsställande sätt men gruppen anser det vara möjlig att göra detta om man kan definiera rörelsen längs rätt axel. 12

Figur 14. De styrda lederna i Tau 1 och 2. 4.3 Kraftanalys Kraftanalysen som gjordes gav upphov till ett antal grafer över de moment som upptogs i de olika styrande lederna (se bilaga 3). Ur dessa grafer har de moment som är störst för varje led tagits fram i en tabell (tabell 1). I tabellen skiljs moment vid pålagd kraft från moment vid pålagt vridmoment. Värt att notera är att uteslutande i Tau 1 och till största delen i Tau 2 uppkommer de största krafterna i hörn 3, BNV ( Bak Ner Vänster), dvs. nära roboten, långt ner i arbetsområdet (se figur 15). Moment vid pålagd kraft [Nmm] Hörn Moment vid pålagt vridmoment [Nmm] Hörn TAU 1 Arbetsarm 17500 3 BNV 780 3 BNV Basarm1 15000 3 BNV 620 3 BNV Basarm2 7000 3 BNV 260 3 BNV Överarm 36250 3 BNV 1125 3 BNV Ring1 17000 3 BNV 750 3 BNV Ring2 17500 3 BNV 750 3 BNV TAU 2 Basarm1 4500 1 BUH 350 1 BUH Basarm2 5250 1 BUH 382 1 BUH Basarm3 14700 3 BNV 545 3 BNV Ring1 22500 3 BNV 420 3 BNV Ring2 8000 7 FNV 450 7 FUH Ring3 5000 3 BNV 250 3 BNV Tabell 1. Tabell över moment i de styrande lederna. Alla enheter är i Nmm. Bokstavskombinationen efter symboliserar i vilket hörn momentet uppstod. 13

Figur 15. Graf över hur momentet i de olika styrande lederna ändras vid en pålagd kraft i Z- riktningen på TCP. Y-axeln representerar momentet i leden och x-axeln visar hur den pålagda kraften ökar. 14

5 Diskussion Då robotarnas armar skiljde sig i storlek i förhållande till varandra gjordes en sammanställd graf över det båda arbetsområdena, för att på så vis kunna jämföra de två, figur 16. Denna bild visar att Tau 1 har ett större arbetsområde i horisontell riktning, medan Tau 2 har ett större arbetsområde i vertikal riktning. Detta kan dels bero på att avståndet mellan tornets botten och ring 1 varierar mellan modellerna. Då alla leder kan röra sig obegränsat i Adams, oavsett länkarmarnas tjocklek, kan detta arbetsområde ses som det teoretiskt maximala. Det skulle i princip vara omöjligt att bygga en fysisk robot med samma arbetsområde. Tau 1 Tau 2 Figur 16. Sammanställd graf över Tau 1 och Tau 2s arbetsområde med kompensation för olika storlek på armar. Den ursprungliga modellen visade sig sakna den grundläggande egenskapen att kunna rotera fritt i alla riktningar utan att påtvinga en rotation runt en annan axel och att en translation kan ske utan att rotation ska vara nödvändig. Genom att modifiera armarna kunde denna egenskap infogas. Rotationsförmågan var ungefär lika bra hos de båda modellerna och båda modellerna har flest begränsningar då TCP befinner sig nära tornet. Tester visade också på att även fast en parallell arm avlägsnades gick tau modell 2 fortfarande att styra. Hade detta inte gått hade man blivit tvungen att lägga på en ny arm som hade kunnat likna överarmen på tau 2 och på så sätt fått en ny och helt självständigt styrd arm. Tau 1 lyckades gruppen däremot inte styra helt. Detta beror på att en av de leder som ska styras är en av rotationsaxlarna i en kardanaxel/universalled som sitter i robotens ena armbåge. Svårigheterna artade sig i att hitta rätt riktning på axeln. Skulle rätt riktning hittas är gruppen övertygad om att modellen skulle gå att styra. Men i denna modell kanske det vore bättre att bygga en separat fjärde arm som är kopplad till den nedre bakdelen på plattan med TCP, eftersom gruppen anser det vara lika svårt att implementera denna styrning i en prototyp som det var för gruppen att göra det i simuleringen. I kraftanalysen som gjordes undersökte gruppen endast krafterna i fyra extrempunkter i kuben. Om analysen skulle ha gjorts i andra extrempunkter skulle nog vissa resultat ha sett annorlunda ut. Ett exempel är ring 1 och ring 2 i Tau 1. De maxvärden vi fick fram här skiljer sig rätt kraftigt mellan varandra, trots att det uppenbart är en viss symmetri mellan deras respektive armar. Det borde alltså finnas punkter där förhållandet mellan dem är det motsatta. 15

6 Slutsatser Tau 1s arbetsområde når bättre horisontellt medan Tau 2 når bättre vertikalt. Originalmodellerna går inte att röra fritt i sex frihetsgrader. De modifierade modellerna kan röra sig i en frihetsgrad utan att påverka övriga. Tau modell 2 går att styra. Det är mer krävande för roboten att jobba nära tornet Hos Tau modell 1 har läget i höjdled stor betydelse för momentet som krävs i de styrda lederna. 7 Rekommendation I en fortsatt studie av modellerna skulle det vara intressant att titta på följande saker: Förändras arbetsområdet då innerarmen på robotarna avlägsnas? Går det att styra Tau 1 eller krävs utterliggare modifiering? Hur ser momenten ut i de hörn som inte analyseras i studien? Går det att flytta kuben för att få bättre egenskaper? Är det möjligt att parametrisera kraften som simulerar arbetsområdet? Hur påverkar längden på armarna resultatet? 8 Referenser 1. Uppgiftslydelse av Ulf Sellgren och Kjell Andersson, januari 2008 2. A Haptic and Virtual Reality Temporal Bone Surgery Simulator http://www.md.kth.se/research/projects/mda/p13.shtml?eng (2008-05-05) 3. Haptik http://www.nada.kth.se/kurser/kth/2d1413/agi03-haptik-oh.pdf (2008-05-05) 4. MSC Software http://www.mscsoftware.com/ 5. The Mathworks http://www.mathworks.com/ 16

Bilaga 1 Rotationstest 1 för Tau 1 och 2 Maximala rotationsvinkeln vid TPC läses från slutvärdet på Y-axeln i följande grafer. Rotationstest 1 för Tau 1 17

18

Rotationstest 1 för Tau 2 19

20

Bilaga 2 Rotationstest 2 för Tau 1 och 2 med förbättringar Maximala rotationsvinkeln vid TPC läses från slutvärdet på Y-axeln i följande grafer. Rotationstest 2 med förbättrade modeller Tau 1 21

22

Rotationstest 2 med förbättrade modeller Tau 2 23

24

Bilaga 3 kraftanalys Tau 1 ochj 2 Upptaget moment i samtliga styrleder vid pålagd kraft eller moment. Det upptagna momentet ses på Y-axeln och pålagd kraft eller moment läses på X-axeln. Kraftanalys på Tau 1 i hörn 3 bak nere till vänster 25

Kraftanalys på Tau 1 i hörn 5 fram uppe till höger 26

Kraftanalys på Tau 1 i hörn 1 bak uppe till höger 27

Kraftanalys på Tau 1 i hörn 7 fram nere till vänster 28

Kraftanalys på Tau 2 i hörn 1 bak uppe till höger 29

Kraftanalys på Tau 2 i hörn 3 bak nere till vänser 30

Kraftanalys på Tau 2 i hörn 5 fram uppe till höger 31

Kraftanalys på Tau 2 i hörn 7 fram nere till vänster 32