Krzysztof Kozłowski Ed.Robot Motion and Control Recent Developments With 200 Figures... Krzysztof Kozłowski Poznan University of Technology Institute of Control and Systems, Engineering
Trang 1Lecture Notes
Editors: M Thoma · M Morari
Trang 2Krzysztof Kozłowski (Ed.)
Robot Motion and Control Recent Developments
With 200 Figures
Trang 3Series Advisory Board
F Allg¨ower · P Fleming · P Kokotovic · A.B Kurzhanski ·
H Kwakernaak · A Rantzer · J.N Tsitsiklis
Editor
Professor Dr.-Ing habil Krzysztof Kozłowski
Poznan University of Technology
Institute of Control and Systems, Engineering
ul Piotrowo 3a
60-965 Pozna´n
Poland
Krzysztof.Kozlowski@put.poznan.pl
British Library Cataloguing in Publication Data
International workshop on Robot Motion and Control (4th : Puszczykowo, Poland : 2004)
Robot motion and control : recent developments
-(Lecture notes in control and information sciences ; 335)
1.Robots - Control systems - Congresses 2.Robots - Motion - Congresses
I.Title II.Kozłowski, Krzysztof
629.8’92
ISBN-13 9781846284045
ISBN-10 184628404X
Library of Congress Control Number: 2006923560
Lecture Notes in Control and Information Sciences ISSN 0170-8643
ISBN-13: 978-1-84628-404-5
© Springer-Verlag London Limited 2006
MATLAB is the registered trademark of The MathWorks, Inc., 3 Apple Hill Drive, Natick, MA 01760-2098, USA http://www.mathworks.com
Apart from any fair dealing for the purposes of research or private study, or criticism or review, as permitted under the Copyright, Designs and Patents Act 1988, this publication may only be reproduced, stored or transmitted, in any form or by any means, with the prior permission in writing of the publishers, or in the case of reprographic reproduction in accordance with the terms of licences issued by the Copyright Licensing Agency Enquiries concerning reproduction outside those terms should be sent to the publishers.
The use of registered names, trademarks, etc in this publication does not imply, even in the absence of a specific statement, that such names are exempt from the relevant laws and regulations and therefore free for general use The publisher makes no representation, express or implied, with regard to the accuracy of the information contained
in this book and cannot accept any legal responsibility or liability for any errors or omissions that may be made Typesetting: Data conversion by editor.
Final processing by PTP-Berlin Protago-TEX-Production GmbH, Germany (www.ptp-berlin.com)
Cover-Design: design & production GmbH, Heidelberg
Printed in Germany
9 8 7 6 5 4 3 2 1
Springer Science+Business Media
springer.com
Trang 4Ueb j^fk jlqfs^qflk fk mr_ifpefkd qefp `liib`qflk lc m^mbop fp ql mobpbkq
Trang 5d^m2Uebob^obpq^ka^oaqbuq_ lhp`lk`bokfkdqefppr_gb`qtef`e^ob^ ^fi^_ib
Dljjrkfqv2
Trang 6CL]_ < 6ZY_]ZW LYO G]LUPN_Z]d CWLYYTYR ZQAZYSZWZYZXTNFd^_PX^
Trang 892825 NQBtfqeEofcqObrqo^ifw^qflkcloOlkfkslirqfsbTLTp2 2 <=
Trang 9<27 Q^qeDlkqolilcqebN^kfmri^qlo 2 2 2 2 2 2 2 2 2 2 2 2 2 2 2576
#
Trang 10CL]_ < < 6WTXMTYRLYO JLWVTYR EZMZ_^
Trang 115828 Fumbofjbkqp^kaSbpriqp2 2 2 2 2 2 2 2 2 2 2 2 2 2 2 2 2 2 674
Trang 135=28 Dlk`irpflkp2 2 2 2 2 2 2 2 2 2 2 2 2 2 2 2 2 2 2 2 2 2 2 2 755
Trang 14+, GPWP]ZMZ_TNFTX`WL_Z] TY @TYTXLWWd<YaL^TaP F`]RP]d
Trang 15@VENIGXSV] @VEGOMRK JSV ;SRLSPSRSQMG BILMGPIW
K Kozłowski (Ed.): Robot Motion and Control, LNCIS 335, pp 3–23, 2006.
© Springer-Verlag London Limited 2006
Trang 16pvpqbjp0 ifkb^o pq^qb cbba_^`hp molsfab pfjmib0 bÆ`fbkq0 ^ka ol_rpq `lkqoli
ebob2
B
B
Trang 17DF
A/&
eANA
AZNB
C
E4
7259\.2
@4
ϕ
B
@4
Trang 18@4
'3.7Q2
'
&
A/&
eAN
A/&
eANJ
A-c.4
>@
3
@)
i'
%
?
A
%
%
Trang 19=
@DF
A/&
eAN
?
A-X
=
'I-X
=
5XI]XI5
]
DF
A/&
eANJ
A-c
I -X
=
5XI
>@
3
@
I -!)I)
=
@DF
A/&
eANA-a
54.2
I
$
=
Trang 20qe^q fqfp^ipl bkaltba tfqe^[k^qro^i)-^_bif^k.dolrmpqor`qrob2B pfjmib
=
I
=
@DF
A/&
eAN
?
A-X
I -X
=
5XI]XI5
]c
=
@DF
A/&
eANJ
A-c
=
I
!c]I4
-5255
A/&
eI
A-d.NA-aI-d 4
A/&
eI
A'
N
?
A-X
=.N
?
A
I(
=
I/DF
A/&
eI
A-NJ
A-c
=
>@
3
@B)
]X
=
=3
-5257
Trang 21*(+(- ?TYPL]TePO Fd^_PX^
=
@DF
A/&
eI
A-d.:
A-cI-d a
=
I-d e
@3
B
@
!'I
%
5d
&
I
'5
]hC
A
&
5f'
-h
&
5h'
Trang 22Cbpfab fqp -^mm^obkq pfjmif`fqv0 ^k fjmloq^kq molmboqv lc Tvpqbj -5259 fp
'
hC
C/D
C !&
B/'N
%
=
I-d.0
I
I
I
Trang 23GSPZ]PX*( Q02S<baf\WXeKlfgX`-525.j\g[^@6,TaWTffh`XIebcXeg\Xf
I
I
%
9Y
9a
DF
A/&
eANA
Trang 24clo tef`e ^sbef`ibfp `lkqoliiba pl^pql cliilt^klqebosbef`ibtef`e jlsbp
I
I-d
i7
K-d
)
9Y
9aN-a
I
I
Trang 25*(,(+ F_LMTWTeL_TZY ZQF[PNT!N G]LUPN_Z]TP^
pq^_fifwbop2
%
%
'
+
Trang 26%
&
E\
'h'
&
\(h(
&
E\
)h)
-5265
!&1"
-G/<
(Ul
-G/H
-''
>@
'
Eh'EG1I'"<#
(EG1I("<#
)EG1I)"<#
-''
G/<
''
!f
&
\(h(
'
-G/<
-''
!Ef
&
E\
)h)
(
-G/<
-''
-5266
Trang 27Uebmolmboqvlc8 1bumlkbkqf^ipq^_fifqvbslhbafkqeb^_l bmolmlpfqflkjb^kp
%E.V
'
'lc
7-G/<
-''
Trang 28&1(
)Eh)E
&1)-R(
5R)
&2
I
I
I
Trang 29pq^_fifwba_ rpfkdcbba_^`hp`^i`ri^qbaclo qebifkb^ofwba boolopvpqbj2 Ueb
&
E'
%
C'724
057(-
;
'.(
057(-
;
'
)EeI
'
?M
`lp''
`lp)'
!
h
=(
)pfk')
=pfk'
;
'
('
'
I
=
=7-6\
' 5
=
'
\)EeIEi
=
I-6\
'
(76.)
=
)EeIE'
=-526;
I
&
E2
Trang 30\+ Ueblobj5_^pf`^iiv qbiiprp qe^q kl`lkqfkrlrp cbba_^`h`^k^pvjmqlqf1
ce\-be\2
I
5ZI
5)I
I
I
Trang 31?PXXL*(<baf\WXe g[X geTV^\aZ Xeebe `bWX_ -5254 TffbV\TgXW j\g[ g[X VTe
I
5cI
W
&
W'
I -j('
'
6-#
(q^k-j(
)h)
%-\
=
I
Trang 32?PXXL+(?beTal 284, TaW (
&
5('
5((
'((
8<(
(
&(',
!
'W
&
-#.5'W)
^o`q^k-'W(-# 5'W'
(W(-#
Trang 33qefp pqofkdbkq0 ^ka pljbqfjbp rktloh^_ib0 dl^i fkql ^ jlob mo^dj^qf` lkb
@JKJWJSHJX
)F@>O*5;99<5vv7:=?A":=@<7
PF>JO^ob^p5|ur7<<5 :BB:5vv7;<A";?=7
vv7;>>";@@7
Trang 34:>7 X7Z7 S1Iruyqk5 X7S7 S{xxg7 Tutnurutusoi yyzksy gtj k~vutktzogr
:BB<5vv7B=<"B=A7
;99<5vv7:=B?":>9A7
vv7=?@"=@<7
|ur7<;5 :BB=5vv7:>B@":?9=7
:BB>5vv7?="@@7
Trang 35<<7 G7X7Zkkr5X7S7S{xxg5M7]gryn7TutnurutusoiiutzxuryyzksyClxusyzkkxotm
Trang 36=SWXYVI ?XEFMPM^EXMSR SJ E ARMG]GPI :SFMPI
K Kozłowski (Ed.): Robot Motion and Control, LNCIS 335, pp 25–54, 2006.
© Springer-Verlag London Limited 2006
Trang 37'$' :NSJRFYNHX
5
7]3
]h
]i
6
8
@5
75
4
4
6
8e
&
/5
74
6
8e'
Trang 38'$( ?TXYZWJ AYFGNQN_FYNTS ` B\T 2TSYWTQ 0UUWTFHMJX
7V
&
-/
V'-/
V(-/
hK
iK
Trang 39bu^jmibZ5805;066\.j^qebj^qf`^ijlabiprpbaql abp`of_baf!bobkqmevpf`^i
$9
@
#
;
#9h(
$9
$9
!
@5
!&
Trang 406ZY_]ZW ?Lb 7PaPWZ[XPY_
<
2
(j^v
<
!
@+
<
#
j(,
\9
0 <
'
3)2%
)$&
h(
M
!
@5
<@<
#9]
<
#
(]j(
Trang 41&
<
#/]
)2%
&
9
+
@&
9
$9.]
@
9
$9.]
-626=
Trang 42'
3)2%//6/'/%
+q^hfkd
%
%&
9
$9.]
&
0'
&
]0'
#
tfqe
'
&
('/6
-(/6/$
-(/6"%#/186"!#)#$
Trang 43Dlkpfabofkd-626= lkb`^kpbb qe^q cobnrbk`vlclp`fii^qflke
&
0'
<
A
-6284
2'
\92
A
0
&
0'
-6286
Trang 440'
&
]0'
-&
+
&
0'
A
&
'
A
]0A
+
AUeb
)$&
]
'"'2
Trang 45τ [s]
,x 2 ,x 3
@
\'j(
-628:
!<
#9]
$&/j(
&
9
$9.]
#9]
$& ^ka &
9
$9.]
$&*)F<
-#
tebob
)
-!
H%
%]0
&
%
%5
%
%]0'
%
%I
'j'
(
-)F<
#
-&
Ej(
-#
&
'-'/
&
'F<
#F'
-&
Ej(
&
'-'/
&
'j'
Trang 46!
!
'
H
6
6-
*-4
]
fkqbos^i.2
0'
324%
Trang 47&%
'%
&%
'%
#fk
Je+
tfqe
e+
\'j(
0
&
-/
J0'-/
%
<
<
]
<
vfbiap
Trang 489-/
J
$9
- /JU
'j'
(
- /.!<
#9-/.U
/j(-/
J
&
9-/
J
$9
- /J.U
Trang 49!
9
]7
#
!
@+
]h
]i,
#
'-7
!
@+
,
'
#
'-7.>
&
#
&
"bia
!
@5
7Y
&
Y'
Y(
Trang 50tef`e tfii _b `^iiba qeb VbaiXeZXaVX iXVgbe "X_W2 Mbq rp ^pprjb qe^q qefp
7
K
#
!
'Y(
\9lkql
#
#
]h-/
&
Y'
Y(
7Y
&
Y'
Y(
6
8:
>
<4
-62;9
Trang 51fpklqkbbabaql _bhkltkbumif`fqiv
'
'%
.Y'
<
"'.,,#
@]Y(Y'
(]Y'
Y'
^ka]Y(
e
&
!
@Y
'
(
Y(
#/7]
V'
V(,
+
Trang 52tebob \
G
]7
#
K
]7
"'.,&#
@+
K
K,
"'.+.#
@+
5
4,
#9
'6
@5
#9
'6
#
#
'F
Trang 53IebbY2 Gfopq0 ibq rp `lkpfabo qeb be\Xag\aZiTe\TU_X 3 _be^sflo2 Tr_pqfqrqfkd
]V
#
G3
G3
#
#
K
"'.-(#
#9-!\
G3
#9
#95
#
FZFG3
#/7]
#
Trang 54GV'
ifj
:-
-$-]
'5
]
(5
"' %#
:-
-$-]V'
'5
]V(
(4
-62=;
ifj
:-
-$-]V'
GV'
GV(
Trang 55Ibk`b0mlfkq3@)fpklq^kbnrfif_ofrj lc qeb`ilpbaillmpvpqbj0^kaqeb
#
3K
53]K
-625.2
&
'
5
1
5
D:M
1,
4
Trang 56\9
;
(9J
>
9J
\9
J
8J15J
\9
5;
E
1D:M
J
@-
D:M
K
92
/
@
)
Trang 59&fp
]
Trang 60ol_lq2 B``loafkd ql Gfdp2 <-^ ^ka <-_ lkb `^kpbb qe^q qeb pe^mbplc qeb
Trang 626L^P 4
5
D:M
mrqp
*
&J
'J
D:M
ek+gtjek,
XWxgznkx
Trang 63p`^ifkd mol`barob e^p _bbk molmlpba2 Ueb l_q^fkba mbocloj^k`b e^p _bbk
$E
$
X
34;eX
c4;eN.;
$E
$
$N.;
\'
"
\(
\'
:C
" '
!+\
4
\'
:C
"
'
!+\
E
$S+X
\'
>IL5(\
(LCH5
:C
"
++Y
E
&+61/'
$S+
!
++
"
$S+
!
++
\'(\
\'(\
Trang 64e
|0
E/
+
k+
k+
XE
k,
XE
k+
D
X3C
/
e{
e
|0
E7
+
\'LCH5:
\(
k+
\(
>IL5:
\'
X
,yot+CX8
E/
k+
k,0
D
+
E!{Ee he,
e
e
e
ll(m; m;U
l'(m'
l'(m'
JZ`Zsbg^5;C;@"<>5:BB>7
Trang 65@7 I7 Igt{jgy jk]oz5 N7 Qnkttu{l5I7 Ygsyut5 gtj U7P7 Y,xjgrkt7 Tutrotkgx
Vuroyn37
;99;7
;99>7
Trang 66@VENIGXSV] @VEGOMRK 1SRXVSP JSV ;SRLSPSRSQMG
NEPMGNE_EVIRXO/MGX&T[V&[VSG &TP
K Kozłowski (Ed.): Robot Motion and Control, LNCIS 335, pp 55–71, 2006.
© Springer-Verlag London Limited 2006
Trang 67sgtov{rgzux oytu|kr5utrg lk} vgvkxy jkgrotm }ozniutzxur vxuhrkslux y{in gt
gxs7
iutyzx{izout7
6WL^^
Trang 68su|k }oznu{z yrovvotm ul ozy }nkkry7 Znoy gyy{svzout osvroky znk k~oyzktik ul o
J
*2ta
3tea
a
e
e
|
e2
;
JE:
y
z
)b)
+
Trang 69e2+
e2,
;
JE
1*
1+
tf
*
E2+
E2,N
}nkxkC
-9
JN
Trang 70**
&
eP*2ta3xE
N
*
JN
*Z
*+
-ex
&
tf
47
PN
*+
*,
PN
*L
*+
L+*
P
*
L++
8-
x
etf
4
4-
9
M+
E/
PN
;f
Z
$-
ex
&
tf
$-
x
etf
$
$-
;a
;f
+*
2t
f
J+*
E-
JN
+2tf
9
etf
E/
)
NME)
NKD
Trang 71($) 2TSYWTQ ?WTGQJR AYFYJRJSY
N
a
E;f
f
e
|X
;
JE:
IyX
Trang 72]kgyy{skzngz7 2w3oyzosk6|gxogtz
e
hV
:
Ih
Ih
a
V7
ehaE:
Ie{Y
e
|Y
e2Y
;
JE:
Iz|
Goz6GhjkxxgnosC
xfE-
yf
zf
E:
I
!n
*{Y
*
Ye{Y
Ye
|Y
Ye2Y
*{+
+2+
X
X
Y
Trang 73iutzot{u{y gtj lxus Hgxhgrgz1yrkssg }k igtiutir{jk zngz {Ye 2 9 gy w 2 67
Y
e{Y
*{Y
y{hyyzks7
e2
*
*E
e
e2,
e
f
]
+E
}-;
L
JE
2,
+2*
4<d+
yot+
2+
-
Trang 74*D
{]Y
d+d,
iuy,2+X
d,
*YE
h+
,Y
+{
*YE
h,
+Y
h-
*YD
]osvroky
*
*XE
*
Ey
+cN
*X
+Xl{r"r znk
y*f
y+f
E:
Iy
*X4
i
y+X
*Xh+
;
J
Trang 75i E!n-h-4h+y+X!n,h+2h*4h, !;y*Xh
+
grmuxozns7
_+
:
;h+4:
;h+4:
;2h
*
,+44
;h+
exf
&
tfYZ
$-
xf
etfYZ
$
!-
T+v
-hi
v.2
!tefYZ
E-
ehf
f
&
tfYZ
E-
etfX
&
tfX
!$hef
D
*
+
Trang 76Z
$-
ehi
ev
$
E3-
hi
v
!/
T
*9
-hi
v
K
zX
X
|Y
2Y
+2Y
_
,2ha
Ehi
*2ha
"
Z
$2t3-
hi
v
2<7<<3
Yhi*
Yhi+
**
h+
i*
*+
h+
{+
!-
:
;
.+
!-
:
;
.+
!-
:
=
2+
n
*
En+H:
E2Y
EvEhi*
Ehi+5
X
X
Trang 77,(/(+ 7dYLXTN 6ZY_]ZWWP]QZ] L 7Z`MWdAZYSZWZYZXTN@ZMTWP
@LYT[`WL_Z]
f
Z*2}Y
-ex
ey
-x
y
E
Z
*2}
YE)Z2t3Re3- 7\
!&
&n'
)L2t3Re3- 7\
!&
&n'
)M2t3Re3- 7\
!&
&n'
K
*2}
YE)K2t3Re3- 7\
!&
&n'
exf
eyf
*-
xf
yf
E-
hi
h
+f
y+
9
+*
++
;
L
JE:
;
L
JE
TEn"R
hi
h
Z*
-ehi
eh
-hi
h
-hi
h
eh
4:
-hi
h
e_-
Trang 78+X
,2h
+
Ng|otmy{hyzoz{zkjznksujo"kjiutzxury2<7=:3"2<7=;3otzu2<7:=352<7=<3"2<7==3
otzu2<7;>35gtj2<7<B3otzu2<7=93}kuhzgot
h
2
4:
;
!
hih
"
eZ
*-
hi
h
E
:
=3{
+
:
=32+
Trang 79iutzxurrkxy gxk kw{gr zu 4 E ;95 n, E : gtj n- E :9 lux znk Pogtm 0 Topskopkx
time [s]
*X
Trang 80znk xurrotm6}oznu{z6yrovvotm gyy{svzout5 yosorgx zu znk xurrotm6}oznu{z6yrovvotm
time [s]
x [m]
Trang 81xuhuz }ozn xk|ur{zk puotzy37Nu}k|kx5 znktutnurutusoisgtov{rgzux tkkjyutr;
grmuxozns7
@JKJWJSHJX
vv7:;B@":<9?7
;99:5vv7=A">B7
Trang 82:;7 Q7Zinu&t5P7Pgq{hogq7Giikrkxgzout6jxo|ktqotksgzoiyulsuhorksgtov{rgzuxyC
Uxrkgty;99=5vv7=>B9"=>B>7
Trang 830EWIW JSV 9SGEP ;SRLSPSRSQMG :SXMSR
=PERRMRK
]3*
]
otzkx|gra9E]c5xx2"37 U
+
a
xuhuzy7
K Kozłowski (Ed.): Robot Motion and Control, LNCIS 335, pp 73–84, 2006.
© Springer-Verlag London Limited 2006
Trang 84Znk u{zrotk ul znk vgvkx oy gy lurru}y7 Ykizout ; xkigrry yusk tkikyygx
vgvkx7
I bb
I tt
I aa
I tt
]
]C
^ERH
`Kf
`C
Trang 85}2xx2"33E
(R
^3*
+]^
<
(
&N'2x
Pg
gv
f
Trang 86zngz5 jkyvozk ul g hgyoy ot znk yvgik ul iutzxury5 kgin iukÆioktz +T ot Kw7 2=7@3
+T
?@BK@@&T'8+
O)
^
:
]E
+3E
U,
!<9w+
+
,3E
-+c
3
Trang 87LUV_Y 3.0 IukÆioktzy ul Vn7 Ngrr ykxoky lux ykrkizkj vgoxy ul hgyoy krksktzy
*Ej+
*
*Ej+
ccaj+
*
Ej+cc
2J)
,
Trang 88gsvroz{jk9D:?gtj h2U*EU+ }oznznkgsvroz{jk9D:< 2}norkznk Nggxhgyoyigt
|kizux"krjy7
Trang 89b a
]3*
++
]
+R
]3*
,+
]
+R
]3*
+
-]
2=7:>3
?
o+yot+2
o+7
yot+
?
yot+24-
.+8
N&2uE?3E
u+
o+yot+2
#
;o+yot+
Æ
EB9Æ
Æ
kw{gzout
Trang 9010 20 30
1.2 1.4 1.6
1 1.5 2
90 180 270 360
*
Ej+
Ej,
cEaj
*
Ej,
cEaj+
Ej,
Trang 920 45 90 135 180
@JKJWJSHJX
&
Trang 9345 90 135 180
90 135 180
45 90 135 180
Trang 94:97 L7 Ro!gxxgrjk5 P7Z7 ]kt7 Lkkjhgiq yzghoro!gzout ul tutnurutusoi yyzksy
vv7=A>"=B97
Trang 95<R 2VMJX ;IYXVEPM^EXMSR SJ ?XVEXM!IH ?]WXIQW
K Kozłowski (Ed.): Robot Motion and Control, LNCIS 335, pp 85–96, 2006.
© Springer-Verlag London Limited 2006
Trang 96gvvxugin a?c7 Znk ojkg ul jxolz tk{zxgro!gzout kskxmky gryu ot #gz SVG7 Znk
*
E=+
*
+jk"tk znk
\+
*
+
*
+7
!
"
x+
Trang 97)
"Rl
"tgriut"m{xgzout{
Z
Trang 98%
NS
)y*2v3gv
%
NS
)y+2v3gv
%k,
NS
)2!y
*2v3
%k+
,
%k-
NS
)y-2v3gv
%k
NS
)y.2v3gv
%k,
Z
O
^3*
)
)
%k
^)
O
^3*
)
)
%k
^)
Trang 99*$) 3WNKY =JZYWFQN_FYNTS NS AYWFYN!JI 5WFRJ\TWP
vxkyktz7
\)
4" "4j
)7a
%x)7a
2>7A3
)
"
YC
e{Ej)7*x)7*4" "4j)7a
%x)7a
%
4a"E"cM
%
%x*7*4" "4j*7a
&
RM
%x*7a
&
4a"E"cM&
7
7
%xD7*4" "4jD7a
/RM
%xD7a/
4a"E"cM/
2>7B3
%
1i{zu!1lxusznk|kizux"krjy7Tuzgzouta"E"c
M
>
Trang 100>Y'a]g]ba2.I^m%2"3En, n7N!:E9E:ED D ROb_ma^o^\mhk"^e]lmaZm`^g^kZm^
)
`
\A
`!*,
Trang 101Pm^i>7 @hfinm^ \hgmkhe bginml mh ]^\hfihl^] k^_^k^g\^ mkZc^\mhkr K|kx yzxgz{s
#
j_
\
n3*w]
@7n5
!*
e{_
_
&
#
!
@'
_
&
#
!
@'
_
*x_
*
4" "4j
_
@x_
_x_
5o7k7x_
_4x_
Z5
G
*
j_
g
*
_
_
"
`
Trang 102)
"
_
_
_
_
_
Z7gy{hyzoz{zotm
!
\R
g3*
j_
gM
j_
gG
*
*j_
!'
j_
*G
*
j_
EĐDÉ
j_
@G
*
j_
\R
g3*
tgj_
g
_
_
Z7gkrosotgzky
Trang 1032!9D<E 9D=E 9E 9E93
N
f
N
yki
yki3
?QFSJ
Trang 104l
*
+
A
A
e
e
Trang 1050 0.2 0.4 0.6 0.8 1 1.2 1.4 inputs dashed - u ; solid - u : 1 2
time (sec)
yomtgry
0HPST\QJILRJSYX
@JKJWJSHJX
Trang 106=7 N7P7 Y{yysgtt5 ]7 Ro{7 Rosozy ul nomnr uyiorrgzux iutzxury gtj znk
vv7:<;@":<?:7
Trang 107;SZIP /HETXMZI 1SRXVSP SJ =EVXMEPP] :SHIPIH
+
8V^]W^XSJ&8S^PS[WOM/TYX&TS^RE R&TP
K Kozłowski (Ed.): Robot Motion and Control, LNCIS 335, pp 99–111, 2006.
© Springer-Verlag London Limited 2006
Trang 108YI yzorr ngy yk|kxgr jxg}hgiqy7 Znkt{shkxulznk tkikyygx l{!!x{rky yzxutmr
2k7m7a:>5:?c37
iutzxurrkj7
Trang 109iutyojkxkj7 Ot znk vxkyktz vgvkx znk ygsk yyzks oy inuykt gy g vgxgjoms lxus
f
X
?02]
b!*
)
2?7:3
b
0
?0!'
'2
Trang 110?h
M+
)
&*'
&*'
Trang 111+
]X
,
z2w]
O(
^3),
^
S od(,62w]!^
3S
O(
g3),g
2?7A3
S
o
X
Yg
h\
*
+asc5
*U
!p
*U
*
*et+
+U+
+et+
Trang 112znkxkluxk ol 2?7B3 oy yu xkgxxgtmkj zngz t+& oy su|kjzu znk xomnz ngtj yojk ul znk
+
rotky3
N
!.7
Trang 113U
Trang 114Joint Coordinate Errors vs Time [0.001 s]
Phase Space of the Unmodeled DOF
+axgj8yc
Trang 116+
X
S-" "-T
bSZ2]
X
X
XZlS
!*
2]
X
!*
2]
X
S
X
!
7+
!
7+
IZ
I]
5S]
I]
5S]
!
7+
S+
S,
XIZ
S
!+
"
Trang 117I]
6S
I]
6S
S
X
X
S
X
X
X
]
f
<?2C2]
X
@JKJWJSHJX
Trang 118;7 P7\gy'i&gq5R7Sgjgx&gy!7Znkjkyomtulznkk|gr{gzkj rotm{oyzoigvvxu~osgzout7
|ur7=5tu7>5:BB<5vv7@=9"@=@7
vv7=@">;7
|ur7:>5 :BB@5vv7:?<":?B7
;99=7
Bg`bg^^kbg`5|ur7<5tu7<5;99<5vv7<:B6<;B7
Trang 119:B7 P7Q7 Zgx5 G7 Hktiyoq5 P7L7 Hoz&u5 Q7 Pk!kxtoq7 Gvvroigzout ul g tk} lgsor
Trang 1203\EQTPI /TTPMGEXMSRW SJ 4Y^^] >IEWSRMRK
gvvroigzouty7
K Kozłowski (Ed.): Robot Motion and Control, LNCIS 335, pp 113–127, 2006.
© Springer-Verlag London Limited 2006
Trang 121yyzksy oy g joÆi{rz vxuhrks7 Ot zgyqy y{in gy zxgpkizux zxgiqotm ux lurru}otm
je
We
X
#*
c
&H(*'#HD
$
7
p (N ×1) ✲
H IDDEN LAYER
σ(·) (N ×1)
linear (N o ×1)
y (N o ×1) ✲
Trang 122)
}nkxk
U
c2;
4c2;
*
5;d+
d
UON
=
*
E;d+
ed
=+EUON
c(c
2;d
*
E;d+
Trang 1232@7:93
e
%
UON
c(c2;*Ed ;+d 3E
2@7:;3
#H
2;d
*
E;d+
%
;N
*
!>
c
@cS;
*SUOc
!>
c
@cUOc
WOc7
X