Professional Documents
Culture Documents
Robottechnika 1
Robottechnika 1
BEVEZETÉS ...................................................................................................... 7
1. A ROBOTOK KIALAKULÁSÁNAK ÁTTEKINTÉSE ............................... 9
2. A ROBOTOK KIALAKULÁSÁNAK TUDOMÁNYOS, MŰSZAKI ÉS
TÁRSADALMI HÁTTERE (Háttéranyag) ................................................ 19
3. ROBOTOK FOGALMI MEGHATÁROZÁSA ........................................... 23
3.1. Robotok funkcionális elemzése ............................................................. 25
3.1.1. Manipulátor .......................................................................... 26
3.1.2. Teleoperátor.......................................................................... 28
3.1.3. Helyező berendezés .............................................................. 30
3.1.4. Ipari robotok ......................................................................... 31
3.2. Robotok csoportosítása .......................................................................... 34
3.3. Ellenőrző kérdések ................................................................................ 35
4. ROBOTOK FELÉPÍTÉSE ............................................................................ 38
4.1. Robotok mechanikai rendszerének koordinátarendszerek szerinti
felépítése, robotmechanikák .................................................................. 38
4.1.1. Derékszögű koordinátarendszerű robot ................................ 38
4.1.2. Henger koordinátarendszerű robot (RTT) ............................ 41
4.1.3. Gömbi koordinátarendszerű robot (RRT) ............................ 43
4.1.4. Csuklóskaros robotok ........................................................... 45
4.1.5. Robotplatformok lineáris (transzlációs) mozgásokból ......... 57
4.1.6. A robottechnika mechanizmuselméleti kérdései .................. 62
4.2. Robotok munkatere ............................................................................... 73
4.3. Robotkarok tömegkiegyenlítő rendszerei ............................................ 103
4.3.1. Ellensúllyal való tömegkiegyenlítés ................................... 104
4.3.2. Rugós tömegkiegyenlítő mechanizmus .............................. 110
4.4. Robotok hajtási rendszerei................................................................... 120
4.4.1. Pneumatikus hajtási rendszerek.......................................... 121
4.4.2. Hidraulikus hajtási rendszerek ........................................... 125
4.4.3. Villamos hajtási rendszerek................................................ 131
4.5. Robotok megfogó szerkezetei ............................................................. 149
4.5.1. Erőzáró megfogás ............................................................... 151
4.5.2. Alakzáró megfogás ............................................................. 155
1.1. ábra
1.2. ábra
1.3. ábra
1.4. ábra
1.4. ábra
1.5. ábra
1.6. ábra
1.7. ábra
- robot mechanika,
- hajtó egység,
- robot megfogó szerkezet,
- szenzorikai elemek,
- irányító rendszer a szoftverekkel.
In fo rm a tika i ka p c s o la t
H a jtá s s ze n zo ra i
(ú tm é rõ k, s zö g a d ó k,
n yo m a té k a d ó k s tb .)
R o b o t irá n yító
re n d s ze r
R o b o t m e c h a n ika H a jtó re n d s ze r
K ö rn ye ze ti é s
te c h n o ló g ia i
s ze n zo ro k
M e c h a n ika i ka p c s o la t
M e g fo g ó s ze rke ze t
M e g fo g ó s ze n zo ra i
(e rõ s ze n zo ro k, fe lü -
le ti n yo m á s é r s tb .)
1.8 ábra
Kar 2
Kar forgástengelye
Kar 1
Kar mozgatás
Kar mozgatás
Kar forgástengelye
Forgató egység
Állvány
1.9. ábra
70 m2alapterület,
18.000 elektroncső,
1.500 jelfogó,
150 [kW] teljesítmény.
3.1. ábra
3.2. ábra
- tároló berendezés,
- leválasztó berendezés,
- mozgató berendezés,
- tartó berendezés,
- vizsgáló berendezés
ANYAGKEZELÕ
BERENDEZÉSEK
Alapkritérium:
fõfunkció
3.3. ábra
MOZGATÓ
BERENDEZÉSEK
Alapkritérium:
funkció sokféleség
Mozgatóberendezések Mozgatóberendezések
rögzített funkcióval változó funkcióval
Alapkritérium: Manipulátor
program változás Teleoperátor
Helyezõ berendezés
Alapkritérium:
program befolyásolás
IPARI ROBOT
( VDI 2860, ISO )
3.4. ábra
3.1.1. Manipulátor
3.5. ábra
3.6. ábra
3.1.2. Teleoperátor
gatott irányító karok a master rész, a végrehajtó szerkezet pedig a slave be-
rendezés. Egy master-slave rendszert mutat a 3.7- és 3.8. ábra.
3.7. ábra
3.8. ábra
Mozgatóegység Helyzetérzékelõ
Pneumatikus henger B
b0
Helyzetérzékelõ a0 a1
h
Mozgató egység b1
Pneumatikus henger A
A D
TCP
Állvány szerkezet
Munkatér
B C
3.9. ábra
Szervó vezérlõ
Memória
3.10. ábra
01
Robot mechanika
Anyagmozgató rendszer
(Konvejor)
33
45
50 Szervó vezérlõ
Memória
Program
módosítás
03 0050
Programszám
0 0 0 4 2
Programszám beírás
nyugtázása Programsor
Vészstop
Programszám bevitel
25
3.11. ábra
01
Robot mechanika
Anyagmozgató rendszer
(Konvejor)
33
45
50 Szervó vezérlõ
CCD Kamera
Memória
Program
módosítás
Sorszám 01 0033
02 0045 Programozó és irányító berendezés
03 0050
Programszám
0 0 0 4 2
Programsor
25
Képfeldolgozó elektronika
3.12. ábra
A rendszer működése annyiban tér el a programszelekcióval rendelke-
ző robotoktól, hogy itt a tárolt programoknak a sorba rendezését egy automa-
- R R R,
- R T R,
- T R R,
- R R T,
- T R T,
- R T T,
- T T R,
- T T T.
A fenti kombinációkból a
- T T T,
- R T T,
- R R T,
- R R R,
-TRR
- derékszögű koordinátarendszerű T T T,
- henger koordinátarendszerű R T T,
- gömbi koordinátarendszerű R R T,
- csuklós rendszerű
• függőleges síkú csuklókaros R R R
• vízszintes síkú csuklókaros robot,
3.13. ábra
3.14. ábra
z ,
y
4
3
l 2
2max 1
s
l 32
2min
s s
43 21
l
1
l
y , 4min
x
TCP
l
4max
l
3min
l
3max
4.1. ábra
s
43
z
s
32
y
3 TCP
l
2max 2 1
l
3max
l
2min
s l
21 3min
l
4min l
1
l x
4max
4.2. ábra
A 3.9. ábra jelképi jelöléseivel is lehet képezni robot modelleket. A 4.2. ábra
robot modelljét jelképi jelölésekkel a 4.3. ábra mutatja.
Minden robot egy ún. világkoordináta-rendszerrel jellemezhető. A vi-
lágkoordináta-rendszer a robot bázis koordinátarendszere általában a robot
állványához rögzített. Ebben a koordinátarendszerben definiálható a robot
munkavégző pontjának, vagy szerszám-középpontjának (Tool Center Point,
a továbbiakban TCP pont) pályája, a kinematikai kényszerekben működtetett
kinematikai előírások (ún. ízületi koordináták) (t) vagy s (t) segítségével.
A robottechnikában használatos még egy koordinátarendszer, amely a
robotkarokhoz rögzített. A koordinátarendszer kezdőpontja általában a karo-
kat összekapcsoló kinematikai kényszerrel egybeesik. Alkalmazásukkal
könnyen leírható a karok relatív helyzete és egyszerűen értelmezhetők az
őket meghatározó kinematikai előírások. A robottechnika - főleg angol nyel-
vű - szakirodalma ezeket a koordinátarendszereket frame-eknek vagy frame
koordinátarendszereknek, a relatív helyzetet leíró kinematikai előírásokat
pedig izületi koordinátáknak nevezi.
x 4 min s 43 ,
y 2 min s 21 , (4.1)
z 1 3 min s 32
l
4 max
l
4 min
l s
3 max s 43
32
TCP
3
l 4
3 min
l
1
y
2
z
y s P
21
1
l
2 max
l
2 min
x
x
4.3. ábra
x ( t ) 4 min s 43 ( t )
y ( t ) 2 min s 21 ( t ) (4.2)
z ( t ) 1 3 min s 32 ( t )
egyenletekkel.
l
z 4max
l
4min
s 4
32
l
s 43 3max
3
l
21 3min
y
2
21 l
2
1
4.4. ábra
z
l
4 max
l
4 min
l s
3 max s 43
32
TCP
l
3 min
l
2
21 y y
z
21max
21
P
21min
4.5. ábra
x 4 min s 43 cos 21 ,
z 2 3 min s 32
l
4max
l
4min
TCP
4
3
s
32 43
y
32
21
2
l
3
1
21
x
l
2
4.6. ábra
z l
4 max
l
4 min
s
43
l
3 32 G = TCP
l
2 32
21 y y
G
z
21max
21 ,
G
21min
x
G
x
4.7. ábra
z 2 3 4 min s 43 sin 32 .
z t 2 3 4 min s 43 t sin 32 t .
- függőleges síkú és a
- vízszintes síkú
csuklókaros robotokat.
z
l
4
l 4
3 43
43
3
G = TCP
32
y
32
2
l *
2
z
G
21
l l
1 2
21
1
x
G
x
4.8. ábra
z
43
l
32 3
43 l
4
32
l*
l 2
2
y
l y
1 21 G
G = TCP
z
, G
G
21
x
G
4.9. ábra
z
C
K 43
l
32 4
H
l G = TCP
3
D
U B
43
32 ,
O G
z
V
* y
l y
2
l 21
2
l ,,
1 A
G
21
x
x
4.10. ábra
3 HK cos 32 KG sin 32 ,
(4.6)
z 2 3 HK sin 32 KG cos 32
illetve
K G 4 sin 43 (4.8)
(4.10)
egyenletek írják le, ahol már három független kinematikai előírás szükséges:
2 1 , 3 2 , és 4 3 .
Az eddigiekben nem volt szó a kinematikai előírások realizálásáról. Az
eddigi robot osztályoknál a gyakorlatban is az terjedt el, hogy a kinematikai
előírásokat a kinematikai kényszerekben működtetett közvetlen hajtásokkal
valósították meg. A csuklókaros robotok között több olyan típus is található,
ahol egy kar (általában a 4 jelű) kinematikai előírását nem a kényszer csukló
pontban közvetlen hajtással, hanem közvetett módon - hidraulikus henger
l
a 4
43 4
l
3
, 43
s
2 3 ,
s
3
G = TCP
32
y
2
32 l*
2
z
G
l
l 2
1
21
21
1
x
G
x
4.11. ábra
l
4 4
l
3
l
3
, 43
3
3
G = TCP
32
y
32
43
2
l *
2
l z
2 G
l
1
21
1 21
x
G
x
4.12. ábra
l
4 B
43
S
R
,
l
3
Pályagörbe
l f ( )
3 32
43
O 32min
32max 1
O
4.13. ábra
a sin 32 a sin 32
sin (4.11)
x 3 2 a 3 cos 32
2 2
a
l TCP
4
a S
,
43
l
3
x
l
3
32 O1
O
4.14. ábra
,2
3 2a 2 a 3 cos 32
2 2
3
cos (4.12)
2 a a 3 2 a 3 cos 32
2 2
a sin 32
43 arcsin
3 2 a 3 cos 32
2 2
a
(4.13)
,2
3 2a 2 a 3 cos 32
2 2
3
arccos
3 2 a 3 cos 32
2 2
2a a
összefüggést nyerjük.
(4.13) összefüggésből látható, hogy a tényleges hajtást megvalósító
hidraulikus henger hosszának állandósága ( , 3 const ) esetén 43 g ( 32 )
illetve 43 ( t ) g 32 ( t ) . Abban az esetben, ha 3 const
,
akkor
43 f ( 32 , 3 ) illetve 43 ( t ) f 32 ( t ) , 3 ( t ) , ahol 32 ( t ) és l
már
, , ,
3(t)
43
z
32
l 4
3
l
3 4
s
21
43 G = TCP
l
5
y 32
2 y
G
z
G
l
2min
1 32
x
G x
4.15. ábra
E két kényszerrel csak egy síkmozgás képezhető le. Mivel a robotoknál kö-
vetelmény a térbeli mozgás realizálása, ezért felépítésében kiegészül egy
szintén függőleges irányú mozgást lehetővé tevő transzlációs kényszerrel.
Ezzel a kényszerrel TRR vagy RRT robotstruktúra is képezhető. Az anyag-
mozgatási egységrakományozási feladatokhoz a TRR struktúrák terjedtek el,
a szerelési anyagkezelési feladatokhoz inkább az RRT struktúrákat alkal-
mazzák. Mindkét struktúra esetében a robot mozgását, illetve mozgástarto-
mányát meghatározó kényszerek az RR kényszerek, ezért tárgyaljuk a csuk-
lókaros robotok osztályában.
A vízszintes síkú csuklókaros robot egy TRR jelképi modelljét a 4.16.
ábra mutatja. A TCP pont leírásához itt is
32 43
s
21 2 l H
3 3
O l
32 4 4
43
l l
2min 5
y y
1 G
G = TCP
z
G
,
G
x
G
x
4.16. ábra
z
43
32
s 43 K
21 2 l H
3 3
U
O
32 4 l
4
V 43
l l
2min y 5
y
1 G
G = TCP
z
G
,
G
x
G
x
4.17. ábra
x ( 3 HK ) cos 32 KG sin 32 ,
z 2 min s 21 5
HK 4 cos 43 (4.15)
és
KG " 4 sin 43 (4.16)
összefüggések határozhatók meg, amelyeket (4.14)-be helyettesítve:
z 2 min s 21 5
z
32
21
32 K
l H 4
2 2
U s
O 43
l 21 l
3 3
1
32
V l
1 y 4min
y
G
G = TCP
z
G
,
G
x
G
4.18. ábra
z 1 4 min s 43
4.19. ábra
A
3 1 Állvány sík
3
l
y l
A
4
l
l
4
3
s s
31 A 41
2
2 s
4
x l
l s 4
2 21
s
S
3
S
4
TCP
S
2
4.20. ábra
x S 2 2 cos 2 ,
y S 2 0, (4.19)
z S 2 2 sin 2 ,
1
x S 3 ( 3 cos 3 ) sin 30 ( 3 cos 3 ),
3
y S 3 ( 3 cos 3 ) cos 30 ( 3 cos 3 ),
(4.20)
2
z S 3 3 sin 3
illetve
1
x S 4 ( 4 cos 4 ) sin 30 ( 4 cos 4 ),
3
y S 4 ( 4 cos 4 ) cos 30 ( 4 cos 4 ),
(4.21)
2
z S 4 4 sin 4
2 cos 2
s 2 0 (4.22)
sin
2 2
1
( 3 cos 3 )
2
3
s3 ( 3 cos 3 ) (4.23)
2
3 sin 3
illetve
1
( 4 cos 4 )
2
3
s4 ( 4 cos 4 ) . (4.24)
2
4 sin 4
s2 s3 s4
s (4.25)
3
1
2 cos 2 2 3 cos 3 4 cos 4
2
1 3
s 2 3 cos 3 4 cos 4 (4.26)
3 2
2 sin 2 3 sin 3 4 sin 4
1 1
x 2 cos 2 3 cos 3 4 cos 4 ,
3 2
1 1
y 2 3 cos 3 4 cos 4 , (4.27)
3
1
z ( 2 sin 2 3 sin 3 4 sin 4 )
3
2 2 min s 21 ,
3 3 min s 31 , (4.28)
4 4 min s 41
s3 s2 s4 s3 s2 s4 (4.29)
1-2 kényszer
(n-1) tag (kar)
3 tag (kar)
2 tag (kar) n-1 kényszer
1 tag (állvány)
n tag (kar)
4.21. ábra
1 tag (állvány)
(k+j) tag
(k+1) tag
k-(k+1) kényszer
k tag 2. lánc
Elágazási pont
(4-k kényszer)
2-3 kényszer
1-2 kényszer
(n-1) tag (kar)
4 tag (kar)
2 tag (kar) 3 tag (kar) 1. lánc n-1 kényszer
1 tag (állvány)
n tag (kar)
4.22. ábra
.
r 2 ( m 1) (4.30)
vagy
r
m 1 , (4.31)
2
2-3 kényszer
3 tag (kar)
2 tag (kar)
n tag (kar)
1 tag (állvány)
4.23. ábra
f ( q 1 , q 2 , ... , q n ) 0 (4.32)
vagy
f ( q 1 , q 2 ,..., q n , t ) 0 (4.33)
B
l
AB
(t)
z
A
4.24. ábra
q 1 x A 0,
q 2 y A 0,
q 3 z A 0,
q 4 x 0, (4.34)
q 5 y 0,
q 6 z ( t ).
2 tag
21
1 állvány
4.25 ábra
s s n(n-1)
n(n-1)
n. tag
n -1. tag
Sikló vezeték
4.26. ábra
s s
n(n-1) n(n-1)
n. tag
n -1. tag
Gördülõ vezeték
4.27. ábra
21
s s
32 32
21
3 tag
2 tag
1 állvány
4.28. ábra
C
D
3
G 5
7
E
H
8 6
I B F
4.29. ábra
D E
C B
G
I
H
4.30. ábra
A BCDEF GHI ,
(4.35)
A IHGB CDEF
M g 6 ( N 1 j) f i
. (4.36)
i 1
Mg f i
6,
i 1
Mg f . i
i 1
M g 3 ( N 1 j) f , i (4.37)
i 1
Mg f i
3,
i 1
Mg f i
i 1
M M g
g 1
A IHGB CDEF
M 1 1 4 1 3 4 1 3 1 1 1 3.
A BCD E F G H I ,
(4.38)
A I H GB CD E F .
alakú lesz.
Jelöljük az egy láncban lévő kinematikai előírások számát k g -vel.
(4.36)-ból
KH g M g k g (4.39)
összefüggéssel a kinematikai határozottság fogalmát értelmezhetjük. A ki-
nematikai határozottság fogalma a
m
KH KH g (4.40)
g 1
A BCD E F G H I
M 1 1 5 1 3 3 1 3 1 2 0 3,
KH (1 1) 1 ( 5 1 3 ) 1 ( 3 1 3 ) 1 0 1 1 0 ,
A I H GB CD E F
M 1 1 4 1 3 4 1 3 2 1 3,
KH (1 1) 1 ( 4 1 3 ) 1 ( 4 1 3 ) 1 0 0 0 0 .
KH M k g
. (4.41)
g 1
z
C
43 43 max
32 32 max
l D
3
32 max 43 min B
32 max
43 43 min
l
4
* 32 min
l
2
y
l 21
2 32 32 min
l
1
A
21
x
4.31. ábra
BC
( 3 4 cos 43 max ) cos 32 4 sin 43 max sin 32 ,
(4.43)
z BC 2 ( 3 4 cos 43 max ) sin 32 4 sin 43 max cos 32 .
Adatok:
1 300 mm ,
2 250 mm ,
3 800 mm ,
4 1100 mm ,
21 50 ,
32 min 50 ,
32 max 115 ,
43 min 55 ,
43 max 120 .
z A 300 250 800 1100 cos 55
o
sin 50 o o o
1100 sin 55 cos 50
z B 300 250 800 1100 cos 120
sin 50
1100 sin 120 cos 50
b) A B-C ív mentén 4 3 4 3 m ax ; 3 2 3 2 m in ; 3 2 m ax . A C
csúcspontot meghatározó 4 3 m ax és 3 2 m ax szögkoordináta értékeket behe-
lyettesítve (4.9)-be
z C 300 250 800 1100 cos 120
o
sin 115 o o
1100 sin 120 cos 115
o
c) A C-D ív mentén 32 32 m ax ; 32 43 m ax ; 43 m in , a D
csúcspontot pedig a 4 3 m in és 3 2 m ax szögkoordináták jellemzik, a-
melyeket (4.9)-be helyettesítve
1100
l = 800 o
3 = 55
43 min
1084,03 D
800 971,82 B
o
= 120
= 115
ö 43 max
32 max
1000
= 50 o
550 32 min
100,31
A
Anyagmozgató rendszer
mozgás síkja
21
1856,92
x
1300
4.32. ábra
x A B A B cos 21 ,
y A B A B sin 21 ,
x const b ,
b
,
cos 21
y sin 21 ,
2
2
7 0 2 , 6 1 sin 43 5 1 3 , 6 2 5 1 3 , 6 8 4 2 , 6 sin 43
2
2 2
8 4 2 , 6 sin 43 ,
706 ,2 2
842 ,6
2
sin 2
43 1685 ,2 513 ,6 sin 43
706 ,2 513 ,6
2 2
0
másodfokú egyenlet adódik.
A sin 43 -ra másodfokú egyenletet , illetve y paraméterek mellett
megoldva kapjuk a z = z(y) munkafelületet határoló függvényt az AB ív által
meghatározott felületen, amelyet a 4.33. ábra és kinagyítva a 4.34. ábra mu-
tat. Hasonló elv alapján írhatjuk fel a határol görbét a BC ív mentén is.
A B típusú csuklókaros robotosztályok esetében a 4 3 m ax és 4 3 m in
értékei a 3 2 változása esetén nem maradnak állandó értékek, ha-nem a ge-
ometriai elrendezésből adódóan - 4.1.4.a) fejezet - 43 m ax f ( 32 ) , illetve
4 3 m in g ( 3 2 ) függvények; 4.35. ábra. A 4.36. ábra általános elrendezését
alapul véve az ORO1 és az O1RS három-szögekből korábban értelmezett
(4.11) (4.12) és (4.13) összefüggések a határhelyzetre is érvényesek. A ha-
tárhelyzeteket B típusú robotok esetén az © 3 max , © 3 min , 32 max és 3 2 m in
elmozdulás, illetve szögkoordináták jelölik ki. Az l ' 3 m ax érték (4.13)-ba
helyettesítésével 4 3 m ax -ra
z z
C C
2176,11
z = z (y)
BC
1100
l = 800 = 55
o
3
43 min
1084,03 D
B
971,82 B
800
o
= 115
o = 120
32 max 43 max
= 50
o
550 32 min
100,31
A A
z = z (y)
AB
Anyagmozgató rendszer
mozgás síkja
1856,92
21
1300
4.33. ábra
z
,
C 2176,11 C
z = z (y)
BC
,
B
B
z = z (y)
AB
100,31
,
A A
a)
1569,8
2 2
z = z (y) = 1569,8 -y
971,85
2 2
z (y) = 1162,83 - 769,75 -y
393,05
y
-928,46 928,46
b)
4.34. ábra
a sin 32
43 max arcsin
3 2 a 3 cos 32
2 2
a
(4.45)
©2
3 2a 2 al 3 cos 32
2 2
3 max
arccos
3 2 a 3 cos 32
2 2
2a a
(4.46)
,2
3 2a 2 a 3 cos 32
2 2
3 min
arccos
2 a a 3 2 a 3 cos 32
2 2
f( )
C 43max 32
1
C
B
C
2
43max
S
R
32max 32min
D
1
43max
O 32min D
32max 1 D 2 A
O
g( )
43min 32
4.35. ábra
B
=f( )
C 43 max 32
l
4
32 min
a S 32 max
R
43max
,
l
3
x D1
l D
2
3
D
32max O1
O =g( ) A
43 min 32
4.36. ábra
B
=f( )
C 43 max 32
a
l 32 min
4 32 max
43min
R
S
,
l
3
x
D1
l D
2
3
D
32max O1
O =g( ) A
43 min 32
4.37. ábra
Felütközési pont
Felütközés miatt
korlátozott minimális szög
R S G = TCP
Felütközés miatt
korlátozott maximális szög
Felütközési pont
32max
32min
Szélsõ helyzet
D1
O O1
D D2
A
Lemaradó terület
4.38. ábra
l4 G
a
S o
160-165
R
,
l3
l
3 32max
O O
1
4.39. ábra
l4
a
R S
,
l3 G
o
30-35 l
3 32max
O O1
4.40. ábra
1 600 mm ,
2 225 mm ,
*
2 825 mm ,
3 1250 mm ,
4 1600 mm ,
a 200 mm ,
3 min 1100 mm ,
,
21 65 ,
32 min 55 ,
32 max 135 .
B 1250 1600 cos 165
o
cos 55 o o
1600 sin 165 sin 55
o
z B 825 1250 1600 cos 165
o
sin 55 o o o
1600 sin 165 cos 55
l C1
4
C2
a
S
32 min
32 max
l
3 o
165
32min
, D1
l
3
O O1 D2 A
a =g( )
l 43 min
2 32
4.41. ábra
3
,
2
3
2a
2
2 a 3 cos 32
(4.47)
2a a 3 2 a 3 cos 32
2 2
a sin 32
.cos 43 arcsin
a
2
3 2 a 3 cos 32
2
3
,
1250 2
2 200
2
2 200 1250 cos 55
2 200 200
2
1250
2
2 200 1250 cos 55
200 sin 55
cos 165 arcsin
1250 2 200 1250 cos 55
2 2
200
1333 ,19 mm .
adódik, igazolva az előbbi állítást, hogy a hidraulikus henger kinyúlása nem
éri el az ,3 max 1400 mm értéket.
A 3 2 értékét fokozatosan növelve (4.47)-ből meghatározhatjuk azt a
32 értéket, ahol ,3 ,3 max lesz. A számításokat a 4.42. ábrán foglaltuk
össze. Az ábra alapján ,3 max 1400 mm hengerkinyúláshoz 3 2 7 5 ,5o
tartozik.
1450
1425
1400
,
3 1375
1350
1325
1300
55 57.5 60 62.5 65 67.5 70 72.5 75 77.5 80
32
4.42. ábra
C 1 1250 1600 cos 165
o
cos 75,5 o o
1600 sin 165 sin 75 ,5
o
z C 1 825 1250 1600 cos 165
o
sin 75,5 o o
1600 sin 165 cos 75 ,5
o
= f ( )
43 max 32
l C1
z 4
z G B
B
C 2
a
S
32 min
R 32 max
o
l 165
3
r = r OB
OC
1
,
32 l
3
O O1
a l
2
B
4.43. ábra
4.1 táblázat
m m z m m 3 mm
,
o o
32 4 3 m ax
o
200 sin 135
43 m ax arcsin
2 2 o
200 1250 2 200 1250 cos 135
2 2 2 o
1250 2 200 1400 2 200 1250 cos 135
arccos
2 2 o
2 200 200 1250 2 200 1250 cos 135
200 0 , 70710
arcsin
4 10 1 ,5625 10 5 10 0 , 70710
4 6 5
1,5625 10 8 10 1, 96 10 5 10 0 , 70710
6 4 6 5
arccos
400400 4 10 1,5625 10 5 10 0 , 70710
4 6 5
6
141, 42136 0 , 03605 10
arcsin arccos
6 6
1, 95605 10 400 1, 95605 10
o
5 ,8035 86 , 3053 92 ,108 .
C 2 1250 1600 cos 92 ,108
o
cos 135 o o
1600 sin 92 ,108 sin 135
o
z C 2 825 1250 1600 cos 92 ,108
o
sin 135 o o
1600 sin 92 ,108 cos 135
o
4.2. táblázat
m m z m m 3 mm
,
o o
32 43 m ax
C1
z
C2
a l4 32 max
S
32 min
o
35 R ,
l3
l
3
32max
D1
O1
O
A
a D2
l
2
=g( )
43 min 32
4.44. ábra
D 1 1250 1600 cos 135
o
cos 135 o o
1600 sin 35 sin 135
o
z D 1 825 1250 1600 cos 35
sin 135
1600 sin 35 cos 135
4.3. táblázat
m m z m m 3 mm
,
o o
43 32
3
,
1250 2
2 200
2
2 200 1250 cos 135
2 200 200
2
1250
2
2 200 1250 cos 135
200 sin 135
cos 35 arcsin
1250 2 200 1250 cos 135
2 2
200
1,5625 10
6
8 10
4
5 10
5
0 ,7071
200 0 ,7071
cos 35 arcsin
4 10 1 ,5625 10 5 10 0 ,7071
4 6 5
1227 ,88 mm .
a
l
4
o
35 32 max
R
S
,
l
3
l G
3 D1
z
D1 =g( )
43 min 32
32max O O1 r D
OD D
1 2
a
A
D1
4.45. ábra
1200
1175
1150
,
3 1125
1100
1075
1050
90.0 92.5 95.0 97.5 100.0 102.5 105.0 107.5 110.0 112.5 115.0 117.5 120.0
32
4.46. ábra
D 2 1250 1600 cos 35
o
cos 93 o o
1600 sin 35 sin 93
o
919 , 61 m m ,
z D 2 825 1250 1600 cos 35
o
sin 93 o o
1600 sin 35 cos 93
o
812 , 47 m m .
4.4. táblázat
m m z m m 3 mm
,
o o
32 43
o
200 sin 55
4 3 m in arcsin
2 2 o
200 1250 2 200 1250 cos 55
2 2 2 o
1250 2 200 1100 2 200 1250 cos 55
arccos
2 2 o
2 200 200 1250 2 200 1250 cos 55
2 0 0 0 ,8 1 9 1 5
arcsin
4 6 5
4 1 0 1,5 6 2 5 1 0 5 1 0 0 ,5 7 3 5 7
6 4 6 5
1,5 6 2 5 1 0 8 1 0 1, 2 1 1 0 5 1 0 0 ,5 7 3 5 7
arccos
4 6 5
4 0 0 4 1 0 1,5 6 2 5 1 0 5 1 0 0 ,5 7 3 5 7
3
1 6 3 ,8 3 1 4 5,7 2 1 0
arcsin arccos
6 6
1, 3 1 5 7 2 1 0 4 0 0 1, 3 1 5 7 2 1 0
3
1 6 3 ,8 3 1 4 5 ,7 2 1 0
arcsin arccos
3
1 1 4 7 ,0 4 4 0 0 1,1 4 7 0 4 1 0
o o o
8 , 2 1 1 5 7 1, 4 8 2 1 7 9 , 6 9 .
A 1250 1600 cos 79 , 69
o
cos 55 o
1600 sin 79 , 69 sin 55
o
z A 8 2 5 1 2 5 0 1 6 0 0 cos 7 9 , 6 9
o
sin 5 5 o o
1 6 0 0 sin 7 9 , 6 9 cos 5 5
o
8 2 5 1 2 5 0 1 6 0 0 0 ,1 7 8 9 7 0 ,8 1 9 1 5 1 6 0 0 0 , 9 8 3 8 5 0 ,5 7 3 5 7
8 2 5 7 8 9 , 4 5 2 2 9 0 2 ,8 9 0 9 7 1 1 ,5 6 m m
4.5. táblázat
m m z mm 3 mm
,
o o
32 43
4.6. táblázat
m m zmm 3 mm
,
o o
43 3 2 m in
3500
C1
3000
B
C2
2500
2000
1500
D1
1000
D2
A
500
4.47. ábra
1 a
M k (m t m k 4 ( )) 4 g cos( 43 32 ) . (4.48)
2 4
1 a
4 m t m k 4 ( )
2 4
me . (4.49)
a b
a
l
4 b
l 2
4
m
m m 43 e
t 4
k4
43 32 MODELL: KUKA
3
3
32
1
4.46. ábra
l
4 b
l 2
4
a
4 m
m m e
t k4
43
43 32 3 MODELL: KUKA
3
32
1
4.47. ábra
z
l
4
l 2
4
4
m m 43
t k4
43 32 3 MODELL: KUKA
l
3
l
3
32
me
2
l
1 2
a b
4.48. ábra
m k4
M k (m t ) 4 g cos( 43 32 ) (4.50)
2
z
l
4 a
l 2
4
m 4
m
t k4
MODELL: ASEA BROWN BOVERI
43 IRB 6000
43 32 3
32 l l
3 3
me
2
l
1 2
a b
4.49. ábra
m a
M k
m t k 4 (1 ) 4 g cos ( 43 32 ) (4.51)
2 4
k co s ( 4 3 3 2 ) (4.52)
0 .8
0 k
0 .6
10
i 0 .4
20
20
30 10
0
j
o
o
43 = o
( 65 + 2 ,5 i )
32
=
o
( 55 + 2 ,5 j )
180 180
a)
1 ,0
= 75 o
32
0 ,8
= 8 5o
32
k
= 65 o
32
= 9 5o
32
0 ,6
= 5 5o
32
0 ,4
1 ,0 1 ,5 2 ,0 2 ,5
[ra d ]
43
b)
4.50. ábra
m k4 ab
(m t ) 4 m ki
me 2 2 (4.53)
b
mk4 a ab
m t (1 ) 4 m ki
2 4 2
me (4.54)
ab
m k 4 7 , 0 kg ,
m ki 1, 0 kg ,
m t 1,5 kg ,
a 200 mm ,
b 500 mm ,
4 1100 mm .
5500 150
10 , 7 kg .
500
l a
4
43 32
l 2
4
A B
4
43
m
m k4
t
l
3
l
3
3
32
O G
1
k k
4.51. ábra
S
M = M
k 4 ,
K K
G
O
,
S
k k
4.52 ábra
S
Fr x
M = M
k 4
G
, x
O
K K
,
S Fr M
r 32 43
k k
4.53. ábra
m a
M k
m t k 4 (1 ) 4 g cos ( 43 32 ) (4.55)
2 4
M
43 32 arccos k
, (4.56)
mk4 a
m t (1 ) 4 g
2 4
illetve,
M
43 32 arccos k
(4.57)
mk4 a
m t (1 ) 4 g
2 4
egyenletekkel.
(4.56) és (4.57) összefüggésekből meghatározott szögkoordinátákkal
számított trajektóriákon való robot mozgás során a 4 kar kiegyenlített marad.
A 4.53. ábra alapján a rugók által kifejtett kiegyensúlyozó nyomaték
M r 2 k Fr sin , (4.58)
cos( 43 32 )
tg (4.59)
k
sin ( 43 32 )
x
illetve
cos( 43 32 )
arctg (4.60)
k
sin( 43 32 )
x
Mr Mk
Fr . (4.61)
2 k sin 2 k sin
2 2
S K y 0 y ( 43 , 32 ) x k 2 kx cos , (4.62)
43 32 . (4.63)
2
o
43 m in 60 ,
o
43 m ax 135 ,
o
32 m in 55 ,
o
32 m ax 115 ,
illetve
4 1600 mm 1, 6 m ,
3 750 mm 0 , 75 m ,
a 100 mm 0 ,1 m ,
m t
12 , 5 kg ,
m k 4 22 , 5 kg ,
g 9 ,81 m / s . 2
A 4.51. ábra A pontjára számított kiegyenlítetlen karnyomaték (4.55)
alapján
m a
M k
m t k 4 (1 ) 4 g cos( 43 32 )
2 4
22 , 5 0 ,1
12 , 5 (1 ) 1, 6 9 ,81 cos( 80 75 180 )
2 1, 6
827 , 768 Nm
k 300 m m 0 , 3 m ,
x 150 m m 0 ,15 m
o o o o
cos(180 75 80 ) cos 25 o
arctg arctg 29 ,88 ,
o
0 , 30 o
sin(180 75 80 )
o o 2 sin 25
0 ,15
-ra adódik.
A kiegyenlítési helyzetre vonatkozóan (4.61)-ből a
o o
S K y o y ( 43 80 , 32 75 )
2 2 o o o
0 ,15 0 ,3 2 0 ,3 0 ,15 cos(80 75 90 )
2 2 o
0 ,15 0 ,3 2 0 , 3 0 ,15 cos 65
a) 3 2 m in 5 5 o , 4 3 m in 6 0 o
S K ( 4 3 m in , 3 2 m in ) y ( 4 3 m in , 3 2 m in ) y 1
2 2 o
0 ,1 5 0 , 3 2 0 , 3 0 ,1 5 co s( 9 0 4 3 m in 3 2 m in )
o
0 , 0 2 2 5 0 , 0 9 2 0 , 3 0 ,1 5 co s 2 5
0 , 0 2 2 5 0 , 0 9 2 0 , 3 0 ,1 5 0 , 9 0 6
0 ,1 1 2 5 0 , 0 8 1 0 ,1 7 6 m 1 7 6 m m
b) 3 2 m in 5 5 o , 4 3 m ax 1 3 5 o
S K ( 43 m in , 32 m ax ) y ( 43 m in , 32 m ax ) y 2
o
0 ,0225 0 , 09 2 0 ,3 0 ,15 cos 100
0 ,358 m 358 m m .
c) 3 2 m ax 1 1 5 o , 4 3 m in 6 0 o
S K ( 43 m in , 32 m ax ) y ( 43 m in , 32 m ax ) y 3
o
0 ,0225 0 ,09 2 0 ,3 0 ,15 cos 85
d) 3 2 m ax 1 1 5 o , 4 3 m ax 1 3 5 o
S K ( 43 m ax , 32 m ax ) y ( 43 m ax , 32 m ax ) y 4
o
0 , 0225 0 ,09 2 0 , 3 0 ,15 cos 160
32 m in 55
o
és 4 3 m in 6 0
o
-ra
o o o o
60 55 90 25 ,
3 2 m in 5 5
o
és 43 m ax 1 3 5 o - ra
o o o o
135 55 90 100 ,
3 2 m ax 1 1 5
o
és 4 3 m in 6 0 o -ra
o o o o
60 115 90 85 ,
o
3 2 m ax 1 1 5 és 43 m ax 1 3 5 o -ra
o o o o
135 115 90 160
SK tartomány pedig 176 mm és 444 mm között változik. A kapott adatok
alapján megszerkeszthető a 4.54. ábra rugókarakterisztikája.
F
r F
r
M
1128,13
2
1
2
3
4.54. ábra
3,0
2,5
337,21 [Nm]
2,0
[rad]
43
1,5
1,0
0,5
0,5 1,0 1,5 2,0 2,5
[rad]
32
4.55. ábra
200
150
100
= 55
o
32
50
M [Nm ] 0
h4 = 75
o
o
32 = 65
32
- 50
= 95
o
32
- 100
- 150
- 200
1,0 1,2 1,4 1,6 1,8 2,0 2,2 2,4
[rad]
43
4.56. ábra
Programozható ütközõk
Végrehajtó szerv
(Henger)
Beavatkozó szerv
(Útváltó)
4.57. ábra
4.58. ábra
4.59. ábra
Útmérõ
Szervó szabályozó
Kommunikációs busz
4.60. ábra
Beavatkozó szerv
(Útváltó)
Tápegység
4.61. ábra
Ux
Végrehajtó szerv
Útmérõ
(Henger)
p p
1 2
Fk
Q s
md
l
Q1
Tápegység
4.62. ábra
i
1
i
1 + i2
i
2
M V
F F
p A B p
1t 2t
c c
1 1
P T
4.63. ábra
Kommunikációs busz
Szervo szabályozó
= 24 V
Szervo szelep
Útmérõ Henger
4.64. ábra
A p d m d s B s F k ,
V
Q A s C t p d p d ,
4
(4.64)
Q Q1 k C p d ,
k 1 I C 1 Q 1 C 2 Q 1 Q1 ,
x s s pd Q1 Q 1 T
(4.65)
x A x f F k b I (4.66)
i
x A x f F k b I
i i i i i i
(4.67)
x s s p d Q 1
Q 1
T
(4.68)
s s ,
B A Fk
s s pd ,
md md md
4 A 4 (k C C t ) 4
p d s pd Q1 , (4.69)
V V V
Q 1 Q 1 ,
Q1 C 1 Q 1 C 2 Q 1 k 1 I .
0 1 0 0 0
0 B A
0 0
md md
i
A 4 A 4 k C C t 4 (4.70)
0 0
V V V
0 0 0 0 1
0 0 0 C1 C 2
0
1
md
f
i
0 , (4.71)
0
0
0
0
b 0 .
i
(4.72)
0
k
1
a) Egyenáramú szervomotorok
Állórész tekercs
Hajtó tengely
M
Forgórész
4.65. ábra
R L
a a
Ia
U U I g = áll.
a i
M t
4.66. ábra
dI a
U a U i Ra I a La R a I a L a I a (4.73)
dt
U i k g I g k g I g q (4.74)
M km I g Ia (4.76)
M M t J q C v q (4.77)
M t J q C v q k m I g I a (4.78)
x q q Ia
T
(4.79)
x A x f M t bU a (4.80)
x q q I a T
(4.81)
q q ,
Cv km I g M
q q Ia t
, (4.82)
J J J
kg Ig Ra Ua
I a q Ia .
La La La
x A x f M b U a
i i i i i i i
t
, (4.83)
0 1 0
Cv km I g
0
A J ,
i
J (4.84)
kg Ig Ra
0
La La
0
1
f ,
i
(4.85)
J
0
0
0
b
i
, (4.86)
1
L a
d 2
L M d q dq
a t = = q
dt 2 dt
dt
U 1 1
a
K I
Ra m g J
K I
c g
4.67. ábra
d
M =
t dt
1
U R
a a 1 1
L K I
a m g Js s
1+s
R
a
K I
c g
4.68. ábra
M
o U
an
M U
2 ar
U
M a2
1 U a1
4.69. ábra
.
b) Léptetőmotorok
A
+
É
4 2
D
B
- +
3
4.70. ábra
U
A 1 2 3 4 1 2
U
B
4.71. ábra
U
A 1 2 3 4 5 6 7 8 1 2 3
U
B
4.72. ábra
o
o 360
z
M (J = 0)
A R
M
B
J 0
R
M
Bm
M
Am
f
f z
f Am
Am f
Bom
f
Bm
4.73. ábra
fz
4.74. ábra
f
df
tg =
dt
fz
t t
H
4.75. ábra
f
df
tg =
dt
fz
t t
H
4.76. ábra
M M L
M gy
, (4.87)
ahol ML a terhelőnyomaték,
2 df
M gy
(J R J L ) . (4.88)
z dt
J
Lm
J Lm JL
fz f f
Aom
4.77. ábra
J Lm J L
M L
M Bm (4.89)
J Lm J R
összefüggéssel számítható.
Egyenletes frekvencia felfutás és lefutás esetén a gyorsító nyomaték nem
hanyagolható el, ekkor a terhelő nyomaték
JL JR
M L
M Bm
(4.90)
J Lm J R
6
10 t H
fz M Bm
Gyűrűkerék (z ) Hullámgenerátor
k
r
h
r
h
Hullámgenerátor
4.78. ábra
r z k
h
, (4.91)
k h
zr
r zr zk
(4.92)
h zr
a hajtómű áttételét jelenti ( i (hk)r > 1). (4.92)-ből zk = 202, zr = 200 esetén
200
i hr 100
(k )
200 202
Hullámgenerátor Gyűrűkerék
M
Hajtó tengely
4.79. ábra
v
Hajtó tengely
4.80. ábra
Valós pozició
M
Előírt pozició
Helyzet szabályozó
4.81. ábra
o
360 1
h (4.95)
z (k)
ih r
1 1
sh (k )
h. (4.96)
z ih r
M
4.82. ábra
4.83. ábra
c
A
D
p B C
Megfogandó tárgy
a b
4.84. ábra
4.85. ábra
,
F
F
sz
TCP
Szorítópofa
F ,
sz F
G
Munkadarab
4.86. ábra
,
G mg 4 F , (4.97)
F
sz
, ,
F
F 45 o
D Megfogandó munkadarab
Megfogó pofa
4.87. ábra
o
G m g 4 Fsz cos 45 , (4.99)
illetve az
mg
Fsz (4.100)
o
4 cos 45
.
, ,
B C
A Fsz
A
D
Fsz
p B C
a b
4.88. ábra
F Fsz
Br
B C
a b
4.89 ábra
b
FB r Fsz , (4.101)
a cos
,
pA F
Br
F
rúd
F
Br
a.)
,
F F
Br Br
F
rúd
b.)
4.90. ábra
F rú d 2 FB r sin (4.102)
F
p rú d
(4.103)
A
b tg
p mg (4.104)
o
2 A a cos 45
alakban.
.
,
F
sz
Munkadarab
Szorítópofa
TCP
,,
F
sz
4.91. ábra
, ,
B C
,
A Fsz
A
D
,,
Fsz
p
B C
G
a b
4.92. ábra
" '
Fsz G Fsz (4.105)
,, ,,
F Fsz
Br
B C
a b
4.93. ábra
" b "
FB r Fsz , (4.106)
a cos
illetve (4.105) felhasználásával
" b '
FB r ( G Fsz ) (4.107)
a cos
' b '
FB r Fsz (4.108)
a cos
a b
, ,
B C
,
, Fsz
F
Br
4.94. ábra
,
p.A F
Br
F
rúd
F ,,
d F k
F
k
Br
4.95. ábra
,
F
Br
,,
F
Br
F
A
F
k
F
Av
4.96. ábra
ható erők
" '
F k (F B r F B r ) cos (4.109)
és
" '
FA v ( F B r F B r ) sin . (4.110)
b
Fk G, (4.111)
a
b '
FA v ( G 2 F sz ) tg (4.112)
a
tg d ' a
pA G 2 F sz tg (4.114)
tg b
a
pA ( tg d ) G
'
F sz b , (4.115)
2 tg
a
pA ( tg d ) G
"
F sz b . (4.116)
2 tg
( tg d ) b G
p . (4.118)
aA
, ,
B C
,
A Fsz
A
p D
,,
Fsz
B C ma
TCP
a b
4.97. ábra
" '
F sz m a TCP F sz , (4.119)
' " o
G m g 2 ( F sz F sz ) cos 45 . (4.120)
a
pA ( tg d ) m a T C P
'
F sz b , (4.121)
2 tg
a
pA ( tg d ) m a T C P
"
F sz b . (4.122)
2 tg
mg d m a TCP
p b tg b (4.123)
o
2 A a cos 45 Aa
-m a
TCP
,,
F
sz
, ,,
F F
TCP
Szorítópofa
,
F
sz
Robotmozgás iránya G
Munkadarab
4.98. ábra
' "
m a TCP 2 ( F F ) (4.124)
' " o
m a TCP 2 ( F sz F sz ) cos 45 (4.125)
d G m a TCP
p b b tg . (4.126)
o
Aa 2 A a cos 45
,
F
sz
Munkadarab
Szorítópofa
,
F
TCP
Robotmozgás iránya
,, -ma
F TCP
G
,,
F
sz
4.99. ábra
G cos d m a T C P cos
pe b tg b, (4.127)
o
2 A a cos 45 Aa
d G sin m a T C P sin
pa b b tg (4.128)
o
Aa 2 A a cos 45
,
F
sz
Munkadarab
, Megfogó síkja
F
TCP Szorítópofa
-ma
TCP
- (m a )cos
Robotmozgás iránya
TCP
G
,,
F
G cos
,,
F
sz
4.100. ábra
(4.129)
Adatok:
a 50 m m ,
b 200 m m ,
o
30 ,
m 7 kg ,
g 9 ,8 1 m / s
2
,
a T C P 1,5 m / s
2
,
0 ,2 5 ,
d 0 ,2 ,
D h 50 m m .
o
b tg 0 ,2 tg 30
p mg 7 9 ,81
o 2 o
2 A a cos 45 2 0 ,025 0 ,25 0 ,05 cos 45
0 ,2 0 ,577 3 N
7 9 ,81 228 , 34 10 .
4 2 2
2 6 ,25 10 0 ,25 5 10 0 , 707 m
o
( tg d ) b G ( tg 30 0 ,2 ) 0 , 2 7 9 ,81
p
2
Aa 0 , 025 0 ,05
( 0 ,577 0 , 2 ) 0 , 2 7 9 ,81 3 N
108 ,697 10 .
4 2 2
6 ,25 10 5 10 m
7 9 ,81 o 0 , 2 7 1,5
0 , 2 tg 30 0 ,2
2 o 2
2 0 , 25 0 , 025 0 , 05 cos 45 0 , 025 0 , 05
3 3 3 N
228 , 34 10 4 , 278 10 232 , 618 10 .
2
m
d G m a PT P
p b b tg
o
Aa 2 A a cos 45
0 , 2 7 9 ,8 1 0 , 2 7 1, 5 o
0 , 2 tg 3 0
2 2 o
0 ,0 2 5 0 ,0 5 2 0 , 2 5 0 , 0 2 5 0 , 0 5 cos 4 5
0 , 2 7 9 ,8 1 0 , 2 7 1, 5
0 , 2 0 ,5 7 7
4 2 4 2
6 ,2 5 1 0 5 1 0 2 0 ,2 5 6 ,2 5 1 0 5 1 0 0,7 0 7
3 3
3 N
2 7 , 9 7 8 1 0 3 4 , 9 1 4 1 0 6 2 , 9 9 2 1 0 .
2
m
4.7. táblázat
o
a TCP m / s
2 D h mm
p N/m
2
0 1,5 50 2 , 327 10
5
10 1,5 50 2 ,4 0 1 1 0
5
20 1,5 50 2 , 402 10
5
30 1,5 50 2 ,3 3 0 1 0
5
40 1,5 50 2 ,1 8 7 1 0
5
50 1,5 50 1,9 7 8 1 0
5
60 1,5 50 1,7 0 8 1 0
5
70 1,5 50 1,3 8 7 1 0
5
80 1,5 50 1,0 2 4 1 0
5
90 1,5 50 0 ,6 2 9 1 0
5
4 10 5
2
a = 10,5 [m/s ]
TCP
3.5 10 5
3 10 5
p [N/m 2] 2.5 10 5
2
a = 9,0 [m/s ]
TCP
a = 7,5 [m/s ] 2
5 TCP
2 10
2
a = 6,0 [m/s ]
TCP
2
a = 4,5 [m/s ]
TCP
5
1.5 10
a = 3 [m/s ] 2
TCP
2
a = 1,5 [m/s ]
TCP
1 10 5
4
5 10
0 20 40 60 80 100
o
[ ]
4.101. ábra
, ,
B C
A
c
A D
1 D
p B C
a b
4.102. ábra
2 2 2 R1 2
(b ) c b ( k) . (4.130)
sin
D
k
C E
F
c
R R
S O1 1
O
b
4.103. ábra
2 R1 2 2
b b ( k) c (4.131)
sin
, ,
B C
c
A D
1 D
b
1
c
p B C
a b
4.104. ábra
b 1 (1 co s ). (4.132)
,,
D G
, e E k
, ,
B C D
F k
c
R R
1
O1 O
b
1
4.105. ábra
R1 e
b 1 sin k c (4.133)
sin 2
R1 e
k c
sin 2
sin (1.134)
b1
2 R1 e 2
b1 b1 ( k c) (4.135)
sin 2
egyenletet kapjuk.
A megfogó ujjat megvalósító szorítópofa szorítófelületét a áll. nyí-
lásszög jellemzi, a szorítófelület ebből adódóan síkfelület. Amennyiben a
szorítófelületet úgy alakítjuk ki, hogy áll., - ebben az esetben a szorítófe-
lület görbe felület - akkor ( R 1 ; ) .
A (4.135) összefüggés alapján 0 érték csak (4.134) nulla értéke
mellett adódik, ami azt jelenti, hogy a megfogó szerkezetet nem lehetne
nyitni vagy zárni.
A 4.106. ábrán jelölje Po pont a 0 megfogási szöghöz tartozó
megfogó pofa szorítási pontot, P pedig legyen egy általános megfogási szög-
höz tartozó szorítási pont. A BPS derékszögű háromszög alapján a szorítási
felület érintőjére a
b
1
K
Bo
+
2 o
So P
o
B
, P
a
P ,S
S
y
R1
R
O x x
4.106. ábra
R 1 b a sin ' b 1 cos ' b 1 cos ( ' b 1 cos ' b 1 cos ( ' ) (4.139)
(4.140)-ből R 1 j -t kifejezve
b B
1
S P
K , ,
P Bo
S
+
2 o
So Po
R
1
a y
R
O
x x
4.107. ábra
' (4.144)
2 2
' 2 . (4.145)
A 4.107. ábra alapján
b 1 (1 co s )
ar ctg , (4.146)
a b 1 sin
b (1 cos )
' 2 arctg 1 (4.147)
a b 1 sin
- ' o állandó,
- ' o n ( ),
b 1 (1 cos )
o 2 ar ctg (4.149)
a b 1 sin
dx j
w j ( ) w j ( 0) v j ( ) ( ) d , (4.151)
0 d
x j ( ) R 1 j cos (4.152)
és az
u j ( ) x j ( ) b 1 (1 cos ) (4.153)
w j ( 0 ) w j ( 0 ) R 1 j sin o . (4.154)
45
40
w (
j 35
[mm]
30
25
0 5 10 15 20 25 30 35 40
u ( ) [mm]
j
4.108. ábra
b) Megoldás , o n ( ) esetén
,
o n ( ) (4.155)
b 1 (1 cos )
o ( 2 n ) arctg (4.156)
a b 1 sin
k
Bal oldali szorítófelület Jobb oldali szorítófelület
,
P P
a R
1
4.109. ábra
dx j
w j ( ) w j ( 0) v j ( ) ( ) d , (4.159)
o d
x j ( ) R 1 j cos (4.160)
és
u j ( ) x j ( ) b 1 (1 cos ) , (4.161)
dx b
w b ( ) w b ( 0) v b ( ) ( ) d , (4.162)
o d
,
x b ( ) R 1 b co s (4.163)
és az
u b ( ) x b ( ) b 1 (1 cos ) (4.164)
45
40
w ( ) 35
j
[mm]
30
25
0 5 10 15 20 25 30 35 40
u ( ) [mm]
j
4.110. ábra
45
40
w ( ) 35
b
[mm]
30
25
40 35 30 25 20 15 10 5 0
u ( ) [mm]
b
4.111. ábra
,
P P
a R
1
4.112. ábra
a.)
b.)
c.)
4.113. ábra
Vákuum
p
v
G p
o
4.114. ábra
2
D
(po pv ) G , (4.165)
4
a) Útmérők
Analóg
4.115. ábra
L R
u
o
x Ro u
4.116. ábra
x R x x 1
u uo 1 1 . (4.166)
L R b L L
x R x x
u uo 1 1 (4.167)
L R b L L
Útinformáció
Adókivezérlés
4.117. ábra
U
S1
U
R
U S2
4.118. ábra
Legyen
u s 1 U o sin t
(4.168)
u sz U o cos t
d
o (4.169)
dt
ahol k a feszültségáttétel.
A forgórész szöghelyzet (4.170) alapján megegyezik az UR és Us1
közötti villamos fáziseltolódás szögével. A fáziseltolási szög pontos megha-
tározását kiértékelő áramkörök végzik (4.119. ábra).
f
1
f 2
2
Számláló
4.119. ábra
4.120. ábra
Kódtárcsa Tengely
4.121. ábra
D1
D2
A fotódiódák jelei
D3
D4
A kimenõ impulzusok
Egyszerezõ
kiértékelés
Kettõzõ
kiértékelés Kimenõ jelek értékelése
Négyszerezõ
kiértékelés
4.122. ábra
4.123. ábra
b) Fordulatszám-érzékelők
Permanens mágnes
Kommutátor
Forgórész
Forgórész tekercs
4.124. ábra
d (t)
u (t) K (t) K . (4.171)
dt
c) Erő- és nyomatékszenzorok
4.125. ábra
P1
d1 = a tájékozódási ponttól
mért távolság
d2 P2
Vezetõnélküli mobil robot
y lézer távolságmérõje
y2
2
y3 z2 P3
z1 d3
y1
1
y z3
Q
z0
3
x3
x
x2
x3
x
4.126. ábra
Cél
y
B
Akadály
D d
v
4.126. ábra
kell a B pontként jelzett célba eljutni, miközben a lehetséges útvonalak né-
melyikén akadály van. A probléma egy Fuzzy típusú szabályozásának meg-
oldása látható a 4.127. ábrán. Az ábrán lévő Jacobi hálózat (részletes kifejté-
se az 5. fejezetben történik) egy koordináta transzformációt valósít meg
u*
A célt közelítõ hálózat
u
Irány keresõ hálózat
u* u
v v v
Sebességváltó hálózat u
j
Jakobi
hálózat
u * u
Irányszög váltó hálózat u
b
4.127. ábra
r r
u j u v
2 2
(4.172)
r
r
u u
b 2 2
r
2 2r
J . (4.173)
r
2r
2
y
Bal oldal
Fb
mv
Jv
Fj
Jobb oldal
4.128. ábra
J v ( F j F b )
m v F j F b (4.174)
J ke
j c
j k u j rF j
(4.175)
J ke
b c
b k u b rF b
r j v ,
. (4.176)
r b v
Képezzük az
állapotváltozó, az
u (t ) u j (t ) u b (t ) T
(4.178)
beavatkozó változó, és az
y ( t ) v ( t ), ( t ) (4.179)
2c
mr 22J 0 0
ke
A 0 0 1 , (4.181)
2c
2
0 0 2
J v r 2 J ke
2
kr kr
m r 2 J ke m r 2 J ke
2 2
B 0 0 , (4.182)
k r k r
2
J v r 2 J ke J v r 2 J ke
2 2 2
1 0 0
C . (4.183)
0 1 0