HAL Id: tel-00982026
https://tel.archives-ouvertes.fr/tel-00982026
Submitted on 23 Apr 2014HAL is a multi-disciplinary open access archive for the deposit and dissemination of sci-entific research documents, whether they are pub-lished or not. The documents may come from teaching and research institutions in France or abroad, or from public or private research centers.
L’archive ouverte pluridisciplinaire HAL, est destinée au dépôt et à la diffusion de documents scientifiques de niveau recherche, publiés ou non, émanant des établissements d’enseignement et de recherche français ou étrangers, des laboratoires publics ou privés.
Simulation dynamique de perte d’équilibre : Application
aux passagers debout de transport en commun
Zohaib Aftab
To cite this version:
Zohaib Aftab. Simulation dynamique de perte d’équilibre : Application aux passagers debout de transport en commun. Médecine humaine et pathologie. Université Claude Bernard - Lyon I, 2012. Français. �NNT : 2012LYO10243�. �tel-00982026�
1G¶RUGUH $QQpH 7KqVH
6LPXODWLRQG\QDPLTXHGHSHUWH
GpTXLOLEUH
$SSOLFDWLRQDX[SDVVDJHUV
GHERXWGHWUDQVSRUWHQFRPPXQ
3UpVHQWpHGHYDQW /¶81,9(56,7(&/$8'(%(51$5'/<21, 3RXUOREWHQWLRQ GX',3/Ð0('('2&725$7 )RUPDWLRQGRFWRUDOH%LRPpFDQLTXH eFROHGRFWRUDOHeFROHGRFWRUDOH0(*$ 3DU0=RKDLE$)7$%
6RXWHQXHOH1RYHPEUHGHYDQWOD&RPPLVVLRQG¶H[DPHQ -XU\5DSSRUWHXU 03DWULFN/$&28785( 3URIHVVHXU8QLYHUVLWpGH3RLWLHUV 5DSSRUWHXU 03KLOLSSH)5$,66( 3URIHVVHXU8QLYHUVLWp0RQWSHOOLHU ([DPLQDWHXU 0PH/DXUHQFH&+Ê=( 3URIHVVHXU8QLYHUVLWp/\RQ
'LUHFWHXUGHWKqVH 0%HUQDUG%52*/,$72 'LUHFWHXUGHUHFKHUFKH,15,$*UHQREOH &RGLUHFWHXU 07KRPDV52%(57 &KDUJpGHUHFKHUFKH,)677$5%URQ &RGLUHFWHXU 03LHUUH%ULFH:,(%(5 &KDUJpGHUHFKHUFKH,15,$*UHQREOH
/DERUDWRLUHGH%LRPpFDQLTXHHW0pFDQLTXHGHV&KRFV
Thèse
Dynamic Simulation of Balance
Recovery: Application to the
standing passengers of
public transport
Présentée devant
L’UNIVERSITE CLAUDE BERNARD LYON I
Pour l'obtention
du DIPLÔME DE DOCTORAT
Formation doctorale : Biomécanique École doctorale : École doctorale MEGA
Par
M. Zohaib AFTAB
Soutenue le 21 Novembre 2012 devant la Commission d’examen
Jury
Rapporteur M. Patrick LACOUTURE Professeur (Université de Poitiers) Rapporteur M. Philippe FRAISSE Professeur (Université Montpellier 2) Examinateur Mme. Laurence CHÈZE Professeur (Université Lyon 1)
Directeur de thèse M. Bernard BROGLIATO Directeur de recherche (INRIA Grenoble) Co-directeur M. Thomas ROBERT Chargé de recherche (IFSTTAR, Bron) Co-directeur M. Pierre-Brice WIEBER Chargé de recherche (INRIA Grenoble)
Laboratoire de Biomécanique et Mécanique des Chocs,
Ifsttar, 25 av. Francois Mitterrand, case 24, 69 675 BRON Cedex
R k
R6`2M+? AMbiBimi2 Q7 a+B2M+2 M/ h2+?MQHQ;v 7Q` h`MbTQ`i- .2p2HQTK2Mi M/ L2irQ`Fb kLiBQMH AMbiBimi2 7Q` _2b2`+? BM *QKTmi2` a+B2M+2 M/ *QMi`QH
]#Qmi 8 v2`b ;Q vQmM; H/v ;2ib QM i?2 oQHpQ #mb i MQQMX AiǶb HB;?i HQ/ rBi? QMHv Ry Q` bQ Tbb2M;2`bX a?2 KQp2b iQ i?2 b2+QM/ iB+F2i K+?BM2 r?B+? Bb #Qmi k K2i`2b BMiQ i?2 #mb- bQ A +HQb2 i?2 /QQ` M/ `2H2b2 i?2 S`F "`F2 rBi?Qmi iQm+?BM; i?2 ++2H2`iQ`X h?2 #mb Dmbi `QHHb ;2MiHv QM Bib QrM bi2K i #Qmi 8 FKf?` U#Qmi jKT?V b A +?2+F i?2 QmibB/2 KB``Q` 7Q` i`{+ M/ ;2MiHv brBM; iQr`/b i?2 HM2X Ai b22Kb +H2` M/ i?2 H/v ?b }MBb?2/ /BTTBM; ?2` iB+F2i M/ AǶK #Qmi iQ iQm+? i?2 ++2H2`iQ` r?2M A b22 i?Bb B/BQi /b? #2ir22M irQ +`b `B;?i BM 7`QMi Q7 K2X A bHKK2/ i?2 #`F2b M/ BMbiBM+iBp2Hv M/ BMbiMiHv bim+F Kv ?M/ Qmi BMiQ i?2 BbH2 `2X 1p2M +?M;BM; i?2
bT22/ Q7 i?2 #mb 7`QK 8 FKf?` iQ w1_P rb 2MQm;? iQ T`QT2H i?2 vQmM; H/v HBF2 `Q+F2i iQr`/b i?2 7`QMi Q7 i?2 #mbX 6Q`imMi2Hv rBi? 98 v2`b Q7 F`i2 BMbiBM+ib Kv `K rb Qmi i?2`2
iQ biQT ?2` 7`QK +`b?BM; BMiQ i?2 7`QMi rBM/b?B2H/X]
U++QmMi Q7 7Q`K2` #mb /`Bp2`- BM/B+iBM; i?2 H2p2H Q7 `BbF BM #mb2b ?iiT,ffrrrX2KTQr2`M2irQ`FX+QKf`QM`B+?KQM/fi?2@#mb@M/@vQm`@b72ivf V
Ǧ
− − −
− −
ͳ k ͳǤͳ ͳǤͳǤͳ ͳǤͳǤʹ ǣ ͳǤͳǤ͵ ͳǤͳǤͶ ͳǤʹ ϐ ͳǤʹǤͳ ͳǤʹǤʹ Ǧ ͳǤʹǤ͵ ͳǤ͵ ͳǤͶ ʹ Rk ʹǤͳ ʹǤͳǤͳ ʹǤͳǤʹ ʹǤͳǤ͵ ʹǤͳǤͶ ʹǤʹ ʹǤʹǤͳ ϐ ʹǤʹǤʹ ʹǤʹǤ͵ ʹǤʹǤͶ ʹǤ͵ ʹǤ͵Ǥͳ ʹǤ͵Ǥʹ ϐ ʹǤ͵Ǥ͵ ǡ ʹǤ͵ǤͶ ʹǤ͵Ǥͷ ʹǤͶ ʹǤͶǤͳ ʹǤͷ ͵ jd ͵Ǥͳ ͵ǤͳǤͳ ͵ǤͳǤʹ ȋʹͲͲȌ ͵ǤͳǤ͵ Ǥ ȋʹͲͲȌ ͵ǤͳǤͶ ȋͳͻͻͻȌ ͵Ǥʹ ͵Ǥ͵ ͵Ǥ͵Ǥͳ ͵Ǥ͵Ǥʹ ͵Ǥ͵Ǥ͵ ͵ǤͶ ͵ǤͶǤͳ ͵ǤͶǤʹ ͵Ǥͷ ͵ǤͷǤͳ ͵ǤͷǤʹ ͵ǤͷǤ͵ ͵ǤͷǤͶ
͵ǤͷǤͷ ͵ǤͷǤ ͵ǤͷǤ ͵Ǥ Ͷ Ǧ e3 ͶǤͳ Ǧ ͶǤʹ ͶǤʹǤͳ ͶǤʹǤʹ ͶǤʹǤ͵ ͶǤ͵ ͶǤ͵Ǥͳ Ǧ ͶǤ͵Ǥʹ ͶǤ͵Ǥ͵ ͶǤ͵ǤͶ ͶǤͶ ͶǤͶǤͳ ͶǤͶǤʹ ͵ ͶǤͷ ͶǤͷǤͳ ͶǤͷǤʹ ͶǤͷǤ͵ Ǧ ͶǤͷǤͶ ͶǤ ͷ Ryk ͷǤͳ ͷǤͳǤͳ ͷǤͳǤʹ ͷǤͳǤ͵ ͷǤʹ
ͷǤʹǤͳ ͷǤʹǤʹ ͷǤʹǤ͵ ͷǤʹǤͶ ͷǤ͵ ͷǤ͵Ǥͳ ͷǤ͵Ǥʹ ͷǤ͵Ǥ͵ ͷǤͶ Rjy Ǥͳ Ǥʹ ±± Rj3
*?Ti2` R
*QMi2Mib
ͳǤͳ X X X X X X X X X X X X X X X X X X X X X X X X X X X X X 9 ͳǤͳǤͳ X X X X X X X X X X X X X 9 ͳǤͳǤʹ ǣ X X X 9 ͳǤͳǤ͵ X X X X X X X X X X X X X X X X X X X X X X X 8 ͳǤͳǤͶ X X X X X X X X X X X X X X X X X X X X X X X X X X e ͳǤʹ ϐ X X X X X X X X X X X X X X X X X X X d ͳǤʹǤͳ X X X X X X X X X X X X X X X X X X d ͳǤʹǤʹ Ǧ X X X X X X X X X X 3 ͳǤʹǤ͵ X X X X X X X X X X X X X X X X X X X X X X X X X X X N ͳǤ͵ X X X X X X X X X X X X X X X X X X X X X X X Ry ͳǤͶ X X X X X X X X X X X X X X X X X X X X X X X X X X Ry
ͳǤͳ
ͳǤͳǤͳ
ͳǤͳǤʹ ǣ
h?2 b72iv Q7 biM/BM; Tbb2M;2`b BM Tm#HB+ i`MbTQ`i Bb i?2 7Q+H TQBMi Q7 i?Bb rQ`F
Ǧ
6B;m`2 RXR, ;2 Tii2`M Q7 i?2 6`2M+? TQTmHiBQM 7`QK RN8y T`QD2+i2/ mMiBH ky8y #v i?2
6`2M+? LiBQMH AMbiBimi2 Q7 aiiBbiB+b M/ 1+QMQKB+ aim/B2b UAMb22- kyyeVX R BM j T2QTH2 rBHH #2 ey v2`b Q7 ;2 Q` KQ`2 BM ky8y- +QKT`2/ iQ R BM 9 BM kyR8X
ϐ
ͳǤͳǤͶ
ͳǤʹ ϐ
ϐ
ͳǤʹǤʹ Ǧ
R
ϐ
6B;m`2 RXk, ivTB+H /Bbim`#M+2 M/ `2+Q`/BM; K2+?MBbK 7Q` bBKmHiBM; i`MbTQ`i b+2M`@
BQb UJFB 2i HX- kyyjV
ͳǤ͵
h?2 KQ/2HBM; Q7 i?Bb `2bTQMb2 Bb i?2 F2v 72im`2 Q7 i?Bb iQQH M/ i?2 T`BK`v Q#D2+iBp2 Q7 i?Bb i?2bBbX
b2+QM/`v Q#D2+iBp2 Q7 i?2 i?2bBb Bb iQ `2T`2b2Mi i?2 `2+iBQM Q7 i?2 2H/2`Hv T2QTH2
*?Ti2` k
*QMi2Mib
ʹǤͳ X X X X X X X X X X X R9 ʹǤͳǤͳ X X X X X X X X X X X X X X X X X X R9 ʹǤͳǤʹ X X X X X X X X X X X X X R8 ʹǤͳǤ͵ X X X X X X X X X X X RN ʹǤͳǤͶ X X X X X X X X X X X X X X X X X X X X X X X X X X X ky ʹǤʹ X X X X X X X X X X X X X X X X X X X X ky ʹǤʹǤͳ ϐ X X X X X X X X X kR ʹǤʹǤʹ X X X X X X X X X X X X X X X X X X X X X X X X kk ʹǤʹǤ͵ X X X X X X X X X X X X X X X X X X X X X X X k9 ʹǤʹǤͶ X X X X X X X X X X X X X X X X X X X X X X X X X X X k8 ʹǤ͵ X X X X X X X X X X X X X X X X ke ʹǤ͵Ǥͳ X X X X X X X X X X X X X X X X kd ʹǤ͵Ǥʹ ϐ X X X X X X X X X X X k3 ʹǤ͵Ǥ͵ ǡ X X jy ʹǤ͵ǤͶ X X X X X X X X X X X X X X X X X X X X X X X X jR ʹǤ͵Ǥͷ X X X X X X X X X X X X X X X X X X X X X jj ʹǤͶ X X X X X X X X X X X X X X X X X X X X X X X jj ʹǤͶǤͳ X X X X X X X j9 ʹǤͷ X X X X X X X X X X X X X X X X X X X X X X X X X X X X X X j9
ʹǤͳ
h#H2 kXR, b2H2+iBQM Q7 BKTQ`iMi THi7Q`K /Bbim`#M+2 bim/B2b M/ i?2B` +?`+i2`BbiB+bX
hQ #2 +Q?2`2Mi #2ir22M bim/B2b- i?2 /Bbim`#M+2 Bb `2TQ`i2/ BM i2`Kb Q7 T2F THi7Q`K ++2H2`iBQM BM HH +b2b
aim/v .Bbim`#M+2 .B@
`2+iBQM .Bbim`#M+2 S`Q}H2 _M;2 Q7 T2F THi@7Q`K ++2H2`iBQM ai2TTBM;HHQr2/ \ P#b2`p2/LmK#2` Q7 ai2Tb
6Q+mb Q7 aim/v /2 :`7 M/ pM
q2T2`2M URNNdV
6Q`r`/- "+F@
r`/- aB/2rvb ZmbB@a[m`2 ++2H2`@iBQM T`Q}H2 yXj@RXe KXb
−27Q` k b LQ y GBKBi Q7 #HM+2 rBi?@
Qmi bi2TTBM; _mM;2 2i HX URNNNV "+Fr`/ h`T2xQB/H p2HQ+BivT`Q}H2 eX8 @ jk KXbyXje @ 9 b −2 7Q` LQ y MFH2 M/ >BT bi`i2@;B2b axim`K M/ 6HHM;
URNN3V
6Q`r`/- "+F@
r`/- aB/2rvb ZmbB@b2KBb[m`2 p2@HQ+Biv T`Q}H2 k @ 9 KXb
−27Q` yX9 @
yX3 b LQ y JQp2K2Mi Sii2`Mb-JQiQ` +QMi`QH J+AH`Qv M/ JFB
URNNeV
6Q`r`/- "+F@
r`/ a[m`2 rp2 ++2H2`@iBQM T`Q}H2 RX8@k KXb
−27Q` yXe b u2b >R ;2@`2Hi2/ bi2TTBM; +?`+i2`BbiB+b o2``B2bi 2i HX UkyRyV 6Q`r`/- "+F@r`/- aB/2rvb ZmbB@i`T2xQB/H +@+2H2`iBQM T`Q}H2 9 KXb−27Q` 8 b u2b >k EBM2KiB+b Q7 #H@M+2 `2+Qp2`v BM
2K2`;2M+v #`FBM; +QM/BiBQMb _Q#2`i UkyyeV "+Fr`/ a2KB@bBMQbQB/H++2H2`iBQM T`Q}H2 k@Ry KXb−27Q` yX9 b u2b R@9 EBM2KiB+b M/ EB@M2iB+b Q7 KmHiBTH2 bi2T
#HM+2 `2+Qp2`v
6B;m`2 kXR, .Bbim`#M+2 bim/B2b mM/2` +QMbB/2`iBQM BM i?Bb i?2bBb, h2i?2`@`2H2b2 K2+?@
MBbK UG27iV M/ h`MbHiBM; THi7Q`K T`/B;K U_B;?iV
6B;m`2 kXk, "bB+ KQp2K2Mi bi`i2;B2b 2KTHQv2/ #v ?mKMb iQ `2iBM i?2B` #HM+2, MFH2
UH27iV- >BT UKB//H2V M/ ai2TTBM; U`B;?iV UEMKBv 2i HX- kyRyV
6B;m`2 kXj, h?2 i2KTQ`H T?b2b Q7 #HM+2 `2+Qp2`v BMpQHpBM; bi2TTBM;
ʹǤͳǤ͵
Ǧϔ
ʹǤʹ
6B;m`2 kX9, aQK2 +QKKQM bBKTHB}2/ KQ/2Hb mb2/ iQ TT`QtBKi2 KmHiB@`iB+mHi2/ ?mKM
6B;m`2 kX8, h?2 bi#BHBiv Q7 MFH2 bi`i2;v +H+mHi2/ BM SB M/ SiiQM URNNdV Ub?/2/
`2;BQMV M/ TT`QtBKi2/ #v >Q7 2i HX Ukyy8V U/Qii2/ HBM2V mbBM; bBKTH2 BMp2`i2/ T2M/mHmK KQ/2HX U6B;m`2 iF2M 7`QK >Q7 2i HX Ukyy8VV
ʹǤʹǤ͵
+iBp2
6B;m`2 kXe, HBM2` 722/#+F +QMi`QH KQ/2H- r?2`2 K Bb Ki`Bt Q7 722/#+F ;BMb T`Q/m+@
BM; DQBMi iQ`[m2 +QKKM/b u b 7mM+iBQM Q7 #Q/v KQp2K2Mi x US`F 2i HX-kyy9VX
6B;m`2 kXd, 6HQr /B;`K Q7 i?2 ?mKM biM+2 +QMi`QH KQ/2H T`QTQb2/ #v pM /2` EQQBD
2i HX URNNNVX h?2 mMFMQrM /Bbim`#M+2b wst `2 bm++2bb7mHHv Qzb2i #v i?2 Kmb+H2 +iBQMb ustX AM //BiBQM iQ b2MbQ`v BMTmi- i?2 b2MbQ`v +QMi`QH +2Mi2` HbQ BMTmib Kmb+H2 +iBQMb 7Q` #2bi 2biBKi2 Q7 i?2 #Q/v brv
BMi2`KBii2Mi bHB/BM;@KQ/2
biiB+ 2[mBHB#`BmK /vMKB+ 2[mBHB#`BmK bi#BHBiv
ʹǤ͵Ǥͳ
Wi = Wg+ Wc Wi Wg Wc :Bp2M i?i i?2 ;`p@ BiiBQMH 7Q`+2 Uq;V Bb +QMbiMi M/ +QMi+i 7Q`+2b Uq+V #2ir22M 722i M/
ʹǤ͵Ǥʹ ϐ
≃ /vMKB+ 2[mBHB#`BmK bi#H2
:Bp2M i?i i?2 ;`pBiiBQMH 7Q`+2 Bb +QMbiMi- i?2 QMHv rv iQ +?B2p2 /2bB`2/ KQiBQM Bb iQ bQK2?Qr #2 #H2 iQ +?M;2 i?2 +QMi+i 7Q`+2b
ʹǤ͵Ǥ͵ ǡ
m l j α ¨ cx px cx mg(px− cx) = jα ≈ −ml2 ¨ cx l ¨ cx = ω20(cx− px) ω0 =g/l cx(t) = px+ (cx(0) − px)cosh(ω0t) + ˙cx(0) ω0 sinh(ω0t) cx(t) ≤ px cx+ ˙cx ω0 ≤ px cx + ω˙cx0
6B;m`2 kX3, G27i, h?2 bBKTH2 AMp2`i2/ S2M/mHmK UASV Y 6QQi KQ/2H bbmK2b TQBMi Kbb
+QM+2Mi`i2/ i *QJX h?2 ;`QmM/ `2+iBQM 7Q`+2 U:_6V +ib i i?2 *QS r?B+? Bb +QMbi`BM2/ iQ `2KBM rBi?BM i?2 7QQiX _B;?i, h?2 HBKBib Q7 i?2 /vMKB+ bi#BHBiv `2;BQM U;`2v `2V 7Q` biM/BM; #HM+2X Mv bii2 i?i HB2b rBi?BM i?Bb `2;BQM rQmH/ bm++2bb7mHHv i2`KBMi2 Bib KQiBQM Qp2` i?2 "Qa U7QQiVX
≃
6B;m`2 kXN, h?2 pB#BHBiv F2`M2H ;i?2`b HH i?2 bii2b 7`QK r?B+? Bi Bb TQbbB#H2 iQ pQB/ iQ
7HHX G2pBM; Bi BKK2/Bi2Hv BKTHB2b M mMpQB/#H2 7HH UqB2#2`- kyykV
≃ tk+T tk c (n) x 2dt
ʹǤ͵Ǥͷ
*?Ti2` j
*QMi2Mib
͵Ǥͳ X X X X X X X X X X X X jN ͵ǤͳǤͳ X X X X X X X X X X X X X X X X X X X jN ͵ǤͳǤʹ ȋʹͲͲȌ X X X X X X 9R ͵ǤͳǤ͵ Ǥ ȋʹͲͲȌ X X X X X X X 9j ͵ǤͳǤͶ ȋͳͻͻͻȌ X X X 98 ͵Ǥʹ X X X X X X X X X X X X X 9d ͵Ǥ͵ X X X X 9N ͵Ǥ͵Ǥͳ X X X X X X X X X X X X X 8y ͵Ǥ͵Ǥʹ X X X X X X X X X X X X X X X X X X X X X X X X X X X X 8y ͵Ǥ͵Ǥ͵ X X X X X X X X X X X X X X X X X X X X X X X X X X 8R ͵ǤͶ X X X X X X X X X X X X X X X X X X X X X 8j ͵ǤͶǤͳ X X X X X X X X X X X X X X X X X X X X X 89 ͵ǤͶǤʹ X X X X X X X X X X X 88 ͵Ǥͷ X X X X X X X X X X 8d ͵ǤͷǤͳ X X X X X X X X X X X X X X X 83 ͵ǤͷǤʹ X X X X X X X X X X X X X X X X X X X X X X X X X 8N ͵ǤͷǤ͵ X X X X X X X X X X X X X X X X X X X X X X X X X ey ͵ǤͷǤͶ X X X X X X X X X X X X X X ey ͵ǤͷǤͷ X X X X X X X X X X X X ek ͵ǤͷǤ X X X X X X X X X X X X X X X X X X X X X X X X X X X X ek ͵ǤͷǤ X X X X X X X X X X X X X X X X X X X X X X X X X X ej ͵Ǥ X X X X X X X X X X X X X X X X X X X X X X X X X X X X X X e8
͵Ǥͳ
cx+ ˙cx ω0 ≤ px px cx + ω˙cx0͵ǤͳǤͳ
6B;m`2 jXR, h?2 GBM2` AMp2`i2/ S2M/mHmK UGASV Y 6Hvr?22H KQ/2H rBi? +QMbiMi ?2B;?i
*QJ M/ i2H2b+QTB+ H2;b ¨ cx = ω2(cx− px) ω =g/h ELIP = 1 2˙c 2 x− g 2h(cx− px) 2 px = xcapt = cx+ ˙cx ω
xcapt xcapt xcapt xcapt = cx+ ˙cx ω ± τmax mg [ eωTR2− 2eω(TR2−TR1)+ 1 eωTR2 ] τmax TR1 TR2
6B;m`2 jXk, h?2 bi2TTBM; KQ/2H T`QTQb2/ #v >Q7KMM UkyyeV M/ 2ti2M/2/ #v ai2T?2Mb
UkyydVX h?2 bvbi2K #2?p2b HBF2 bBKTH2 BMp2`i2/ T2M/mHmK mMiBH BKT+i rBi? +QMbiMi H2; H2M;i? lX 7i2` BKT+i- i?2 H2; H2M;i?b `2 /Dmbi2/ iQ KQp2 *QJ i +QMbiMi ?2B;?i 7`QK ;`QmM/X
͵ǤͳǤʹ ȋʹͲͲȌ
l
"27Q`2 BKT+i
i BKT+i ˙c+ x − ˙c−x ˙c+ z − ˙c−z = tanθ ˙c− x ˙c+x ˙c− z ˙c+z 7i2` BKT+i ˙c+ z = 0 ˙c+x = ˙c−x − ˙c−z tanθ cx+ ˙c+ x ω0 = 0 ˙θ = ωsinθcos1/2θ cos2θ θ 2θ
6B;m`2 jXj, h?2 i`D2+iQ`B2b mM/2` BMp2`i2/ T2M/mHmK KQ/2H bbmKTiBQM 7`QK /Bz2`2Mi H2p@
2Hb Q7 BMBiBH /Bbim`#M+2 U#Hm2 +m`p2bV BMi2`b2+i i?2 QTiBKH bi2T +m`p2 U#H+FV i QTiBKH bi2T /BbiM+2 b?QrM BM 6B;m`2 jX9
6B;m`2 jX9, h?2 QTiBKmK bi2T H2M;i?b U#H+FV M/ +Q``2bTQM/BM; +QMi+i iBK2b U#Hm2V 7Q`
mMB[m2 bi2T H2M;i?@bi2T /m`iBQM +QK#BMiBQM
͵ǤͳǤ͵ Ǥ ȋʹͲͲȌ
͵ǤͳǤͶ ȋͳͻͻͻȌ
θc θ0 tcont θc = θ0cosh( 3g 2l − 3ka ml2tcont) θc Fmax α = 2θc tcont
6B;m`2 jX8, JBMBKH bi2T H2M;i? UMQ`KHBx2/ rBi? i?2 H2M;i? Q7 7QQiV M22/2/ 7Q` #HM+2
`2+Qp2`v Q7 p`BQmb BMBiBH /BbTH+2K2Mib UMQ`KHBx2/ #v i?2 H2M;i? Q7 7QQiV M/ p2HQ+BiB2b UMQ`KHBx2/ #v i?2 √gH - r?2`2 > Bb ?2B;?i Q7 #Q/v M/ ; Bb i?2 ++2H2`iBQM /m2 iQ ;`pBivV Q7 *PJ #v Uqm 2i HX- kyydV
6B;m`2 jXe, h?2 bi2TTBM; KQ/2H Q7 >bBQ M/ _Q#BMQpBi+? URNNNV rBi? iQ`bBQMH M/ HBM2`
͵Ǥʹ
bi2T /m`iBQM bvbi2K bii2 i i?2 iBK2 Q7 BKT+i
͵Ǥ͵ Ǧ
st nd st 6B;m`2 jXd, h?2 THi7Q`K /Bbim`#M+2 T`Q}H2
͵Ǥ͵Ǥͳ
τmax = 190N.m ◦
͵Ǥ͵Ǥʹ
6B;m`2 jX3, h?2 /BbiM+2 . #2ir22M i?2 bi2TTBM; 7QQi M/ i?2 +Tim`2 TQBMi i BKT+iX
1st b2`B2b bm#D2+ib r?Q bi2TT2/ 7`i?2` 7`QK i?2 +Tim`2 TQBMi Ur?Bi2 #`V iQQF b2p2`H bi2Tb iQ `2+Qp2` #HM+2X
st
nd 13±4.6 cm
͵Ǥ͵Ǥ͵
6B;m`2 jXN, h?2 2pQHmiBQM Q7 i?2 *QJ U#H+FV M/ *Tim`2 SQBMi U#Hm2V BM iBK2 7Q` QM2
bm#D2+i r?Q bi2TT2/ p2`v +HQb2 iQ i?2 +Tim`2 TQBMi- M/ QM i?2 +Tim`2 `2;BQM-M/ `2+Qp2`2/ #HM+2 BM 2t+iHv QM2 bi2TX h?2 ;`2v `2 `2T`2b2Mib i?2 +Tim`2 `2;BQM +H+mHi2/ mbBM; ~vr?22H `QiiBQM rBi? Mi?`QTQKQ`T?B+ T`K2i2`b BM #Qi? /B`2+iBQMbX
6B;m`2 jXRy, 1tKTH2 Q7 bm#D2+i r?Q /B/ MQi bi2T QM i?2 +Tim`2 TQBMi f `2;BQM BM i?2
͵ǤͶ
tk L T tk+T tk L(q(t), ˙q(t), ¨q(t), u(t), λ(t))dt u(t) tk+1͵ǤͶǤͳ
͵ǤͶǤʹ
N T c ˆ ck = ⎡ ⎢ ⎢ ⎣ ck ˙ck ¨ ck ⎤ ⎥ ⎥ ⎦ , tk Ck+1 = ⎡ ⎢ ⎢ ⎣ ck+1 ck+N ⎤ ⎥ ⎥ ⎦ , ˙Ck+1= ⎡ ⎢ ⎢ ⎣ ˙ck+1 ˙ck+N ⎤ ⎥ ⎥ ⎦ , ¨Ck+1 = ⎡ ⎢ ⎢ ⎣ ¨ ck+1 ¨ ck+N ⎤ ⎥ ⎥ ⎦ Ck+1 = ⎡ ⎢ ⎢ ⎣ ck+1 ck+N ⎤ ⎥ ⎥ ⎦ Ck+1 = Spcˆk+ UpCk, ˙ Ck+1 = Svˆck+ UvCk, ¨ Ck+1 = Saˆck+ UaCk. zx = cx− h g c¨x px zx Zk+1 = ⎡ ⎢ ⎢ ⎣ zk+1 zk+N ⎤ ⎥ ⎥ ⎦ Ck Zk+1 = Szˆck + UzCk,
Sz = Sp− h gSa, Uz = Up− h gUa. f′ i ˙f′ i ≤ ˙fKt′ . zx D(zi− fi) ≤ b, D b fi ˙ Ck+1 ˙ Ck+1ref Ck Zk+1 Fk+1
1 c2 1 ˙ Ck+1 − C˙k+1ref2 + 1 c2 2C k2 + 1 c2 3Z k+1 − Fk+12, c1 c2 c3 u = Ck ¯ Fk+1 Ck ¯ Fk+1
͵Ǥͷ
͵ǤͷǤͳ
͵ǤͷǤʹ
˙ Ck+1`27 = 0 T?Q`BxQM= 1 TbKTHBM;= 25
6B;m`2 jXRR, h?2 `2T`2b2MiiBQM Q7 i?2 ?mKM #Q/v mb2/ 7Q` i?2 bQ@+HH2/ K2+?MB+H
KQ/2HX Ai +QMbBbib Q7 bBKTH2 BMp2`i2/ T2M/mHmK Y 7QQi KQ/2H- r?2`2 i?2 *QJ 7QHHQrb +B`+mH` `+ `QmM/ i?2 MFH2 DQBMiX
m
͵ǤͷǤ͵
TT`2T Tbi2T
͵ǤͷǤͶ
THM/ = T`2++ TT`2T+ Tbi2T T`2+ TT`2T Tbi2T THM/ T`2++ TT`2Th#H2 jXR, Mi?`QTQKQ`T?B+ T`QTQ`iBQMb mb2/ BM i?2 bBKmHiBQM Ub22 HbQ 6B;m`2 jXRRVX
l ×
lf ×
a × lf
h#H2 jXk, aBKmHiBQM T`K2i2`b mb2/ b BMTmi 7Q` i?2 }p2 bBKmHi2/ b+2M`BQb, H2M M;H2b
UθV- #Q/v ?2B;?i UHV `2+iBQM iBK2b UTreacV- bi2T T`2T`iBQM iBK2b UTprepV M/ H2; brBM; iBK2b UTstepVX
H θ Treac Tprep Tstep
m.s−1
c1 c3
c1 = 1 m.s−1
c2 c3 100
h#H2 jXj, h?2 +QMi`QHH2` T`K2i2`b `2Hi2/ iQ +Qbi 7mM+iBQM M/ +QMbi`BMib
× c1 −1 c2 −3 c2 lf vmax −1
͵ǤͷǤͷ
TbKTHBM;
6B;m`2 jXRk, h?2 722/#+F HQQT BKTH2K2Mi2/ iQ bBKmHi2 i?2 i2i?2`@`2H2b2 +QM/BiBQM mbBM;
i?2 JS* +QMi`QHH2`
͵ǤͷǤ
6B;m`2 jXRj, ai2T H2M;i?b 7Q` bBM;H2 bi2T `2+Qp2`v b+2M`BQb 7`QK >bBQ@q2+FbH2` M/ _Q#B@
MQpBi+? UkyydV, 2tT2`BK2MiH Ur?Bi2 #`b- p2`;2/ +`Qbb bm#D2+ib ± QM2 biM/`/ /2pBiBQMV p2`bmb bBKmHi2/ U#H+F #`bV `2bmHibX
6B;m`2 jXR9, ai`B/2 H2M;i? 7Q` KmHiBTH2 bi2T `2+Qp2`v b+2M`BQ 7`QK *v` M/ aK22bi2`b
UkyyNVX 1tT2`BK2MiH Ur?Bi2 #`b- p2`;2/ +`Qbb bm#D2+ib ± QM2 biM/`/ /2pBiBQMV p2`bmb bBKmHi2/ U#H+F #`bV `2bmHibX
6B;m`2 jXR8, 1pQHmiBQM Q7 i?2 K2+?MB+H KQ/2H /m`BM; i?2 T`2/B+i2/ `2+Qp2`v 7Q` i?2 b+2@
M`BQ Q7 *v` M/ aK22bi2`b UkyyNV UbMTb?Qib 2p2`v kyy KbVX
]Pm` 2tT2`B2M+2 ?Bi?2`iQ DmbiB}2b mb BM i`mbiBM; i?i Mim`2 Bb i?2 `2HBxiBQM Q7 i?2 bBKTH2bi i?i Bb Ki?2KiB+HHv +QM+2Bp#H2X] H#2`i 1BMbi2BM- RNjj
*?Ti2` 9
Ǧ
*QMi2Mib
ͶǤͳ Ǧ X X X X X X X X X X X X X X dy ͶǤʹ X X X X X X X X X X X X X X X X X X dR ͶǤʹǤͳ X X X X X X X X X X X X X X X X X X X X X X X dR ͶǤʹǤʹ X X X X X X X X X X X X X dj ͶǤʹǤ͵ X X X X X X X X X X X X X X X X X X X X X X X d8 ͶǤ͵ X X X X X X X X X X X X X X X X X X X X X X X d8 ͶǤ͵Ǥͳ Ǧ X X X X X X X X X X X de ͶǤ͵Ǥʹ X X X X X X X X X X X X X X dN ͶǤ͵Ǥ͵ X X X X X X X X X X X dN ͶǤ͵ǤͶ X X X X X X X X X X X X 3k ͶǤͶ X X X X X X X X X X X X X X X X X X X X X X 39 ͶǤͶǤͳ X X X X X X X X X X X X X X X X X X X 39 ͶǤͶǤʹ ͵ X X X X X X X X X X X X X X X X X X 3N ͶǤͷ X X X X X X X X X X X X X X X Ny ͶǤͷǤͳ X X X X X X X X X X X X X X X X X X X X X X NR ͶǤͷǤʹ X X X X X X X X X X X X X X X X X X X X X X X X X X X X NR ͶǤͷǤ͵ Ǧ X X X X X X X Nj ͶǤͷǤͶ X X X X X Ne ͶǤ X X X X X X X X X X X X X X X X X X X X X X X X X X X X X X NN Ǧ
ͶǤʹ
ͶǤʹǤͳ
mhc¨x+ j ¨θ= mg(cx− zx) cx zx θ j g N T c θ ˆ θk= ⎡ ⎢ ⎢ ⎣ θk ˙θk ¨ θk ⎤ ⎥ ⎥ ⎦ tk Θk+1 = ⎡ ⎢ ⎢ ⎣ θk+1 θk+N ⎤ ⎥ ⎥ ⎦ , ˙Θk+1 = ⎡ ⎢ ⎢ ⎣ ˙θk+1 ˙θk+N ⎤ ⎥ ⎥ ⎦ , ¨Θk+1 = ⎡ ⎢ ⎢ ⎣ ¨ θk+1 ¨ θk+N ⎤ ⎥ ⎥ ⎦ Θk+1 = ⎡ ⎢ ⎢ ⎣ θk+1 θk+N ⎤ ⎥ ⎥ ⎦ Θk+1 = Spθˆk+ UpΘk, ˙ Θk+1 = Svθˆk+ UvΘk, ¨ Θk+1 = Saθˆk+ UaΘk. Sp, Up z = cx− h g ¨cx− j mgθ.¨ Zk+1 = ⎡ ⎢ ⎢ ⎣ zk+1 zk+N ⎤ ⎥ ⎥ ⎦ Ck Θk Zk+1 = Sz ˆ ck ˆ θk + Uz Ck Θk , Sz = Sp− hgSa −mgj Sa , Uz = Up− hgUa −mgj Ua .
ͶǤʹǤʹ
i∈ [k + 1, . . . k + N] θKBM≤ θi ≤ θKt. j|¨θi| ≤ τKt fi ti ci x− fi ≤ lKt. f′ i ¨f′ i ≤ ¨fKt′ zx D(zi− fi) ≤ b, D b fi Fk+1 = ⎡ ⎢ ⎢ ⎣ fk+1 fk+N ⎤ ⎥ ⎥ ⎦ fk ¯ Fk+1 Vk+1 ¯ Vk+1 ti Fk+1 = Vk+1fk+ ¯Vk+1F¯k+1. Vk+1 = ⎡ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎣ 1 1 0 0 0 0 ⎤ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎦ , ¯Vk+1 = ⎡ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎢ ⎣ 0 0 0 0 1 0 1 0 0 1 0 1 ⎤ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎥ ⎦
ͶǤʹǤ͵
˙ Ck+1 ˙ Θk+1 ¨ F′ k+1 1 c21 ˙Ck+1 2+ 1 c22 ˙Θk+1 2+ 1 c23 ¨F ′ k+12. Ck Θk Zk+1 Fk+1 1 c21 ˙Ck+1 2+ 1 c22 ˙Θk+1 2+ 1 c23 ¨F ′ k+12 + 1 c2 4C k2+ 1 c2 5Θ k2+ 1 c2 6Z k+1− Fk+12, u=Ck Θk F¯k+1 T c1 c6
h#H2 9XR, Mi?`QTQKQ`T?B+ T`QTQ`iBQMb mb2/ BM i?2 bBKmHiBQM
H m h= 0.575 × H lf = 0.152 × H 0.81 × lf 0.19 × lf θKt π/2 θKBM −π/2 j 2 τmax
ͶǤ͵
ͶǤ͵Ǥͳ Ǧ
1 c2 1 ˙ Ck+12+ 1 c2 2 ˙Θ k+12. u = Ck Θk T
6B;m`2 9XR, 1z2+i Q7 BM2`iB r?22H iQ`[m2 HBKBi QM i?2 KtBKmK /Bbim`#M+2 i?i +M #2
bmbiBM2/ rBi?Qmi bi2TTBM;X h?2 KtBKmK `QiiBQM M;H2 Bb }t2/ iQ π 2
6B;m`2 9Xk, 1z2+i Q7 BM2`iB r?22H M;H2 HBKBi QM i?2 KtBKmK /Bbim`#M+2 i?i +M #2
τmax θmax −1 −1 τmax = 190N.m θmax = π2 −1 −1
6B;m`2 9Xj, h?2 }t2/@bmTTQ`i bi#BHBiv `2;BQM BM *QJ bii2 bT+2 rBi? Qm` JS* +QMi`QHH2`
U9XkjV mbBM; Mi?`QTQK2i`B+ T`K2i2`bX w2`Q BM/B+i2b i?2 TQbBiBQM Q7 MFH2 BM b;BiiH THM2X Ai Bb 2pB/2Mi i?i i?2 /BbTQbBiBQM Q7 mTT2`@#Q/v HHQrb `2+Qp2`BM; 7`QK Km+? H`;2` /Bbim`#M+2b i?M rBi? MFH2 bi`i2;v HQM2 rBi?Qmi bi2TTBM;
ͶǤ͵Ǥʹ
−1 Ck2 −1 c4 c5 c4 c5 −3 −3
6B;m`2 9X9, hBK2 T`Q}H2b Q7 *QJ M/ BM2`iB r?22H ++2H2`iBQMb 7QHHQrBM; ;Bp2M /Bbim`@
#M+2 Q#iBM2/ #v KBMBKBxBM; +Qbi 7mM+iBQM U9XkjVX LQi2 i?2 `2bmHiBM; ~m+im@ iBQMb /m2 iQ i?2 #b2M+2 Q7 i?2B` i?B`/ /2`BpiBp2 T2MHBxiBQM
6B;m`2 9X8, hBK2 T`Q}H2b Q7 *QJ M/ BM2`iB r?22H ++2H2`iBQMb r?2M QMHv *QJ D2`F UH27iV
M/ #Qi? *QJ M/ BM2`iB r?22H D2`Fb U`B;?iV `2 T2MHBx2/X
6B;m`2 9Xe, aBM;H2 `2+Qp2`v bi2T H2M;i?b 7Q` ;Bp2M T2`im`#iBQM b 7mM+iBQM Q7 bi2T /m`@
iBQMb −1 ˙Ck+12 ¨ F′ k+1 ¨F′ k+12
6B;m`2 9Xd, h?2 *QJ p2HQ+Biv +Qbi UH27iV M/ brBM; 7QQi ++2H2`iBQM +Qbi U`B;?iV ;BMbi
p`vBM; bi2T /m`iBQMb M/ 7Q` bi2T H2M;i?b THQii2/ BM 6B;m`2 9XeX LQi2 i?i #Qi? i?2 +Qbib b?Qr +QKTH2i2Hv QTTQbBi2 i`2M/ ;BMbi bi2T /m`iBQM
1 c2 1 ˙ Ck+12 + 1 c2 3 ¨ F′ k+12 c3 c1 −2
ͶǤ͵ǤͶ
6B;m`2 9X3, JBMBKH pHm2b Q7 i?2 +Qbi 7mM+iBQM 7Q` /Bz2`2Mi T2MHBxiBQM +Q2{+B2Mib c3
c4 c5 c1 −1 c 4 −3 c5 −3 c2 c3 c2 c2 −1 c3 ¨F′ k+12 103 104 ˙Ck+12
h#H2 9Xk, ;2M2`H ;mB/2HBM2 7Q` b2H2+iBM; +QMi`QH r2B;?i pHm2b
c1 −1 c2 −1 c3 −2 c4 −3 c5 −3 c6 c1 c3 ≈ −2
ͶǤͶ
ͶǤͶǤͳ
1 c2 1 ˙ Ck+12+ 1 c2 2 ˙Θ k+12+ 1 c2 3 ¨ F′ k+12 + 1 c24Ck 2 + 1 c25Θk 2+ 1 c26Zk+1− Fk+1 2
6B;m`2 9XN, hBK2 THQib Q7 `2bmHiBM; ?BT iQ`[m2 7i2` i?2 bvbi2K Bb 2tTQb2/ iQ /Bbim`#M+2b
Q7 BM+`2bBM; K;MBim/2b iBHH i?2 HBKBi Q7 i?2 +QK#BM2/ MFH2Y?BT bi`i2;B2b
6B;m`2 9XRy, hBK2 THQib Q7 `2bmHiBM; MFH2 iQ`[m2 7i2` i?2 bvbi2K Bb 2tTQb2/ iQ /Bbim`#M+2b
Q7 BM+`2bBM; K;MBim/2b iBHH i?2 HBKBi Q7 i?2 +QK#BM2/ MFH2Y?BT bi`i2;B2b
c2 −1 c
−1 c2 c5 c2 −1 c5 −3 c2 c5 c2 −1 −1 ◦
6B;m`2 9XRR, h?2 `2HiBp2 H2p2H Q7 mb2 Q7 MFH2 M/ ?BT bi`i2;B2bX S2F MFH2 U#H+FV M/ ?BT
U#Hm2V iQ`[m2b `2 THQii2/ ;BMbi p`vBM; T2`im`#iBQMbX q?Bi2 /Qi BM/B+i2b i?2 TQBMi r?2`2 mTT2`@#Q/v M;H2 HBKBi Q7 Ny◦ Bb `2+?2/
c2 c5 c2
6B;m`2 9XRk, 1z2+i Q7 p`vBM; *QJ D2`F T2MHBxiBQM c4 QM `2HiBp2 +QMi`B#miBQM Q7 MFH2 M/ ?BT iQ`[m2bX
c6 c4
c4 = 1000 m.s−2
6B;m`2 9XRj, 1z2+i Q7 p`vBM; *QS /Bp2`;2M+2 +Q2{+B2Mi c6QM `2HiBp2 +QMi`B#miBQM Q7 MFH2 M/ ?BT iQ`[m2bX c2 c6
ͶǤͶǤʹ ͵
¨ F′′ k+1
c3 = −2
c3 = −2
6B;m`2 9XR9, ai2T H2M;i? r?2M `2+iBM; iQ p`vBM; TQbi@BKT+i *QJ p2HQ+BiB2b 7Q` /Bz2`2Mi
T2MHBxiBQM +Q2{+B2Mib c3- Q` 7Q` MQ T2MHBxiBQM i HH Q7 i?2 brBM; 7QQi ++2H2`iBQM ¨F′
ͶǤͷ
TsamplingͶǤͷǤͳ
Treac Tprep TstepͶǤͷǤʹ
◦
h#H2 9Xj, h?2 +QMi`QHH2` T`K2i2`b `2Hi2/ iQ bBKmHiBQM M/ +QMbi`BMib
× lf ¨ f′Kt −2 θKt π/2 τmax c1 −1 c2 −1 c3 −2 c4 −3 c5 −3 c6 Tland
6B;m`2 9XR8, .Bz2`2M+2 #2ir22M bi2T M/ bi`B/2 H2M;i?X 6Q` i?2 722i BMBiBHHv HB;M2/ i?2
b;BiiH THM2- #Qi? bi2T M/ bi`B/2 H2M;i?b `2 i?2 bK2 7Q` i?2 }`bi bi2T
Tstep
ͶǤͷǤ͵ Ǧ
6B;m`2 9XRe, ai2T H2M;i?b 7Q` bBM;H2 bi2T `2+Qp2`v b+2M`BQb 7`QK >bBQ@q2+FbH2` M/ _Q#B@
MQpBi+? UkyydV, 2tT2`BK2MiH Ur?Bi2 #`b- p2`;2/ +`Qbb bm#D2+ib ± QM2 biM/`/ /2pBiBQMV p2`bmb bBKmHi2/ UrBi? M/ rBi?Qmi l"AV `2bmHibX h?2 bi2T iBKBM;b `2 }t2/ BM /pM+2 ++Q`/BM; iQ i?2 `2TQ`i2/ pHm2b BM i?2 bim/vX
6B;m`2 9XRd, h?2 T2F ?BT iQ`[m2 pHm2b +?B2p2/ /m`BM; i?2 9 `2+Qp2`v b+2M`BQb 7`QK
>bBQ@q2+FbH2` M/ _Q#BMQpBi+? UkyydV M/ +Q``2bTQM/BM; }MH `2+Qp2`v TQb@ im`2b Q7 i?2 K2+?MB+H KQ/2HX LQi2 i?i i?2 T2F ?BT iQ`[m2 M/ mTT2`@#Q/v `QiiBQM M;H2 `2 TQbBiBp2Hv b+H2/ rBi? i?2 T2`im`#iBQM H2p2HX
6B;m`2 9XR3, ai`B/2 H2M;i? 7Q` KmHiBTH2 bi2T `2+Qp2`v b+2M`BQ 7`QK *v` M/ aK22bi2`b
UkyyNVX 1tT2`BK2MiH Ur?Bi2 #`b- p2`;2/ +`Qbb bm#D2+ib ± QM2 biM@ /`/ /2pBiBQMV p2`bmb bBKmHi2/ UrBi? M/ rBi?Qmi l"AV `2bmHibX ai`B/2 iBK2b `2 }t2/ BM /pM+2X
6B;m`2 9XRN, 1pQHmiBQM Q7 i?2 K2+?MB+H KQ/2H /m`BM; i?2 T`2/B+i2/ `2+Qp2`v 7Q` i?2 b+2@
M`BQ Q7 *v` M/ aK22bi2`b UkyyNVX LQi2 i?i i?2 FM22 DQBMi ?b #22M //2/ 7Q` #2ii2` pBbmH +QKT`BbQM M/ Bb MQi i?2 T`i Q7 i?2 KQ/2HX
ͶǤͷǤͶ
Tstep
c3 −2
6B;m`2 9Xky, ai2T H2M;i?b 7Q` bBM;H2 bi2T `2+Qp2`v b+2M`BQb 7`QK >bBQ@q2+FbH2` M/ _Q#B@
MQpBi+? UkyydV rBi? QTiBKBxiBQM Q7 bi2T HM/BM; iBK2b, 2tT2`BK2MiH Ur?Bi2 #`b- p2`;2/ +`Qbb bm#D2+ib ± QM2 biM/`/ /2pBiBQMV p2`bmb bBKmHi2/ UrBi? M/ rBi?Qmi l"AV `2bmHibX
6B;m`2 9XkR, h?2 T`2/B+i2/ bi2T HM/BM; iBK2b Tland 7Q` i?2 9 T2`im`#iBQM b+2M`BQb Q7 >bBQ@q2+FbH2` M/ _Q#BMQpBi+? UkyydV- rBi? M/ rBi?Qmi l"A +QMbB/2`iBQMb +QKT`2/ ;BMbi 2tT2`BK2MiH pHm2b Ur?Bi2 #`bV
6B;m`2 9Xkk, h?2 T2F ?BT iQ`[m2 pHm2b +?B2p2/ /m`BM; i?2 9 `2+Qp2`v b+2M`BQb 7`QK
>bBQ@q2+FbH2` M/ _Q#BMQpBi+? UkyydV r?2M Tstep Bb HbQ QTiBKBx2/X
6B;m`2 9Xkj, ai`B/2 H2M;i? `2bmHib 7Q` KmHiBTH2 bi2T `2+Qp2`v b+2M`BQ 7`QK *v` M/ aK22bi2`b
UkyyNV r?2`2 bi`B/2 iBK2b `2 HbQ QTiBKBx2/X 1tT2`BK2MiH Ur?Bi2 #`b-p2`;2/ +`Qbb bm#D2+ib ± QM2 biM/`/ /2pBiBQMV p2`bmb bBKmHi2/ UrBi? M/ rBi?Qmi l"AV `2bmHibX
6B;m`2 9Xk9, h?2 QTiBKBx2/ bi`B/2 iBKBM;b- rBi? M/ rBi?Qmi l"A- +QKT`2/ ;BMbi 2t@
T2`BK2MiH pHm2b 7Q` KmHiBTH2 bi2T `2+Qp2`v b+2M`BQ 7`QK *v` M/ aK22bi2`b UkyyNVX
6B;m`2 9Xk8, h?2 bBM;H2 bi2T `2+Qp2`v T`2/B+iBQMb 7Q` k `2+Qp2`v b+2M`BQb 7`QK JQ;HQ M/
aK22bi2`b Ukyy8V- rBi? M/ rBi?Qmi l"A +QKT`2/ ;BMbi 2tT2`BK2MiH `2@ bmHib Ur?Bi2 #`bVX
6B;m`2 9Xke, PTiBKBx2/ bi2T /m`iBQMb 7Q` k `2+Qp2`v b+2M`BQb 7`QK JQ;HQ M/ aK22bi2`b
]A i?BMF i?i QMHv /`BM; bT2+mHiBQM +M H2/ mb 7m`i?2` M/ MQi ++mKmHiBQM Q7 7+ibX] H#2`i 1BMbi2BM- RN8k
*?Ti2` 8
*QMi2Mib
ͷǤͳ X X X X X X X X X X X X X X X X Ry8 ͷǤͳǤͳ X X X X X X X X X X X X X X X X X X X X X X Ry8 ͷǤͳǤʹ X X X X X X X X X X X X X X X X X X X X X X X X X X RyN ͷǤͳǤ͵ X X X X X X X X X X X X X X X X X X X X X X X X X X RRj ͷǤʹ X X X X X X X X RR8 ͷǤʹǤͳ X X X X X X X X X X X X X X X X X X X RR8 ͷǤʹǤʹ X X X X X X X X X X X X X X X X X X X X X X X RRd ͷǤʹǤ͵ X X X X X X X X X X X X X X X X X X X X X X X X X X X X RR3 ͷǤʹǤͶ X X X X X X X X X X X X X X X X X X X X X X X X X X X RkR ͷǤ͵ X X X X X X X X X X Rkk ͷǤ͵Ǥͳ X X X X X X X X X X X X Rkk ͷǤ͵Ǥʹ X X X X X X X X X X X X X X X X X X X Rkj ͷǤ͵Ǥ͵ X X X X X X X X X X X X X X X X X X X X Rk9 ͷǤͶ X X X X X X X X X X X X X X X X X X X X X X X X X X X X X X Rk3
ͷǤͳ
ͷǤͳǤͳ
st nd st nd
6B;m`2 8XR, h?2 THi7Q`K /Bbim`#M+2 T`Q}H2 mb2/ iQ /2bi#BHBx2 i?2 bm#D2+ib #v
U_Q#2`i-kyyeVX
6B;m`2 8Xk, h?2 irQ `2+Qp2`v ibFb ;Bp2M iQ i?2 bm#D2+ib ;BMbi i?2 bK2 H2p2H Q7 /Bbim`@
h#H2 8XR, *QKTH2i2 bi2T FBM2KiB+b- T`2pBQmbHv mMTm#HBb?2/- 7Q` i?2 irQ #HM+2 `2+Qp2`v
b+2M`BQb +QMbB/2`2/ BM _Q#2`i UkyyeV Treac Tprep Tstep ± ± ± ± ± ± ± ± ± ± ± ± ± ±
6B;m`2 8Xj, hBK2 T`Q}H2b Q7 *QJ p2HQ+Biv Q7 M 2tKTH2 bm#D2+i BM #Qi? `2+Qp2`v ibFbc
ͷǤͳǤʹ
1 c21 ˙Ck+1 2+ 1 c22 ˙Θk+1 2+ 1 c23 ¨F ′ k+12+ 1 c24Ck 2+ 1 c25Θk 2+ 1 c26Zk+1−Fk+1 2 c1 c6
6B;m`2 8X9, h?2 BKTH2K2Mi2/ 722/#+F HQQT rBi? JS* +QMi`QHH2` BM i?2 HQQTX h#H2 8Xk, *QMi`QHH2` T`K2i2`b Treac Tprep st nd Tstep × ¨ f′Kt −2 θKt π/2 τmax c1 −1 c2 −1 c3 −2 c4 −3 c5 −3 c6
6B;m`2 8X8, h?2 bBKmHiBQM Q7 irQ #HM+2 `2+Qp2`v ibFb UH`;2 bT+2 pbX HBKBi2/ bT+2V
mbBM; i?2 bK2 +QMi`QHH2` T`K2i2`b U+X7X h#H2 8XkXV h?2 T`2/B+i2/ bi2TTBM; #2?pBQ` Bb +HQb2` iQ i?2 HBKBi2/ bT+2 2tT2`BK2MiH b+2M`BQ U`B;?iV i?M rBi? i?2 H`;2 bT+2X Ǧ ¨F′ k+12 Ck2 c3 c4 c3 c4 c3 −2 c 4 −3
6B;m`2 8Xe, h?2 H2M;i?b Q7 T`2/B+i2/ }`bi bi2T ;BMbi p`vBM; pHm2b Q7 +QMi`QH r2B;?ib
c3 M/ c4- r?B+? T2MHBx2 i?2 *QJ D2`F M/ brBM; 7QQi ++2H2`iBQM i2`Kb `2bT2+iBp2HvX h?2 MmK#2` i i?2 #QiiQK Q7 2+? THQi `2T`2b2Mi i?2 iQiH MmK#2` Q7 T`2/B+i2/ 7Q`r`/ bi2TbX Ai +M #2 b22M i?i i?2 bKHH2` +QMi`QH r2B;?i pHm2b UBKTHvBM; bi`QM;2` T2MHBxiBQM Q7 +Q``2bTQM/BM; +Qbi 7mM+iBQM i2`KbV `2bmHi BM b?Q`i2` bi2T H2M;i?b M/ KQ`2 bi2TbX
ͷǤͳǤ͵
6B;m`2 8Xd, *QKT`BbQM Q7 p2`;2 2tT2`BK2MiH bi2T H2M;i?b rBi? T`2/B+i2/ H2M;i?b rBi?
c3 4 kyy KXb−2 M/ c4 4 jy KXb−3X
6B;m`2 8X3, *QKT`BbQM #2ir22M i?2 *QJ p2HQ+Biv 7Q` `2H bm#D2+i U/Qii2/ THQi- H`;2
bT+2 b+2M`BQV M/ i?2 bBKmHiBQM U+QMiBMmQmb THQiV rBi? c3 4 kyy KXb−2- c4 4 jy KXb−3X
ͷǤʹ
−3 −2
6B;m`2 8XN, h?2 ivTB+H ++2H2`iBQM T`Q}H2 Q7 i?2 2K2`;2M+v #`FBM; +QM/BiBQM BM m`#M
6B;m`2 8XRy, h?2 7Q`2+bi2/ THi7Q`K /Bbim`#M+2 T`Q}H2b U/Qii2/ #Hm2V `2 b?QrM rBi?
`2bT2+i iQ i?2 +imH T`Q}H2 U#H+F THQiV i 7Qm` bKTH2 BMbiMib Ui 4 yX8- RXy-RX8- k bV 7i2` i?2 /Bbim`#M+2 QMb2iX i 2+? BMbiMi- i?2 +QMi`QHH2` 7Q`2+bib i?2 /Bbim`#M+2 iQ +QMiBMm2 7Q` i?2 M2ti Rb, G27i, qBi? M ++2H2`iBQM 2[mH iQ i?2 p2`;2 Q7 Tbi Rb Ub+2M`BQ #V- Q` _B;?i, qBi? i?2 bK2 BMbiMiM2Qmb ++2H2`iBQM Ub+2M`BQ +VX q?2M i?2 +imH /Bbim`#M+2 /BbTT2`b i i4 kb-i?2 7Q`2+bi Bb HbQ K/2 iQ x2`QX
ͷǤʹǤʹ
¨ cx = g h(cx− zx) − j mhθ¨ ¨ cx= g h(cx− zx) − j mhθ¨ ± ¨x pf F cast ¨ xpfF cast
ͷǤʹǤ͵
−2
6B;m`2 8XRR, h?2 T`2/B+i2/ `2+Qp2`v #2?pBQ` mM/2` i?2 2K2`;2M+v #`FBM; b+2M`BQ U+X7X
6B;m`2 8XNV rBi? MQ Q` p`vBM; H2p2Hb Q7 /Bbim`#M+2 7Q`2+biBM;X hBK2 T`Q}H2b Q7 *QJ TQbBiBQM UH27i- #H+F THQiV M/ p2HQ+Biv U`B;?iV `2 THQii2/X h?2 bi2T TQbBiBQMb `2 BM/B+i2/ rBi? #Hm2 /QibX
nd
6B;m`2 8XRk, h?2 iQiH *QJ i`p2H b 7mM+iBQM Q7 +QMi`QHH2` bKTHBM; iBK2 pHm2b 7Q` /Bz2`2Mi
H2p2Hb Q7 /Bbim`#M+2 7Q`2+biBM;- mM/2` i?2 THi7Q`K /Bbim`#M+2 T`Q}H2 ;Bp2M BM 6B;m`2 8XNX
ͷǤ͵
ͷǤ͵Ǥʹ
− −2 −2 π/2 π/3
h#H2 8Xj, *QMi`QHH2` T`K2i2`b 7Q` i?2 2H/2`Hv `2+iBQM
lf × Tprep Treac Tstep ¨ f′Kt −2 θKt π/3 τmax − − c1 c6 Tstep
ͷǤ͵Ǥ͵
◦
6B;m`2 8XRj, PTiBKBx2/ bi2T H2M;i?b M/ iBKBM;b ;BMbi 7Q`r`/ BM+HBMiBQMb b+2M`BQ 7Q`
2H/2`Hv 7`QK >bBQ@q2+FbH2` M/ _Q#BMQpBi+? UkyydV ;BMbi KtBKmK 7QQi ++2H2`iBQM pHm2b Up`B2/ HQM; t@tBbV 7Q` j /Bz2`2Mi `2+iBQM iBK2 pHm2b Ud8- Ryy M/ R8y KbV M/ k /Bz2`2Mi 2z2+iBp2 "Qa H2M;i?b, UH27i `2/ THQib 7Q` `2/m+2/ "Qa pbX `B;?i #Hm2 THQib 7Q` 7mHH "QaVX
6B;m`2 8XR9, PTiBKBx2/ bi2T H2M;i?b M/ iBKBM;b ;BMbi 7Q`r`/ BM+HBMiBQMb b+2M`BQ 7Q`
2H/2`Hv 7`QK >bBQ@q2+FbH2` M/ _Q#BMQpBi+? UkyydV ;BMbi KtBKmK 7QQi ++2H2`iBQM pHm2b Up`B2/ HQM; t@tBbV 7Q` j /Bz2`2Mi `2+iBQM iBK2 pHm2b Ud8- Ryy M/ R8y KbV M/ k /Bz2`2Mi 2z2+iBp2 "Qa H2M;i?b, UH27i `2/ THQib 7Q` `2/m+2/ "Qa pbX `B;?i #Hm2 THQib 7Q` 7mHH "QaVX ai``2/ pHm2 U⋆V `2T`2b2Mib 7HHX
]_2K2K#2` i?i HH KQ/2Hb `2 r`QM;c i?2 T`+iB+H [m2biBQM Bb ?Qr r`QM; /Q i?2v ?p2 iQ #2 iQ MQi #2 mb27mHX] 1KTB`B+H KQ/2H@#mBH/BM; M/ `2bTQMb2 bm`7+2b #v :2Q`;2 1X SX "Qt- qBH2v- RN3d
*?Ti2` e
+Q@2tBbi2M+2 M/ `2;mHiBQM
Ǧ
l"A M/ M 2z2+iBp2 bi2T iBK2 QTiBKBxiBQM BM M JS* b+?2K2
b@ b2bbK2Mi Q7 `BbFb
Ǥʹ
6B;m`2 eXR, h?2 +m``2Mi ?mKM@#Q/v `2T`2b2MiiBQM UiQTV +M #2 `2TH+2/ #v KQ`2 `2HBbiB+
KQ/2Hb bm+? b /Qm#H2@BMp2`i2/ T2M/mHmK U.ASV KQ/2H /m`BM; i?2 bBM;H2@ bmTTQ`i T?b2 M/ bT`BM; KQ/2H /m`BM; i?2 /Qm#H2@bmTTQ`i T?b2X
6B;m`2 eXk, TQbbB#H2 BMi2;`iBQM Q7 ?mKM b2MbQ`v bvbi2Kb BM i?2 "_ iQQH rQmH/ BMpQHp2
b2T`i2 b2MbQ` /vMKB+ KQ/2H Q7 2+? b2MbQ`v KQ/HBiv UU2X;X "Q`? 2i HX-RN33VV M/ b2MbQ`v BMi2;`iBQM +2Mi2`X
_ûbmKû 2M 6`MÏBb
ǣ ° ±
6B;m`2 eXj, G T`QTQ`iBQM /2b T2`bQMM2b ;û2b /Mb H TQTmHiBQM 7`MÏBb2 /2TmBb RN8y
2i T`QD2iû Dmb[m^¨ ky8y T` H^AMbiBimi LiBQMH /2 H aiiBbiB[m2 2i /2b 1im/2b 1+QMQKB[m2b UAMb22- kyyeVX
± ± ǣ ±
6B;m`2 eX9, G2 KQv2M /^2bbB +Qm`KK2Mi miBHBbû TQm` ;ûMû`2` /2b T2`im`#iBQMb /2 ivT2
6B;m`2 eX8, G2b bi`iû;B2b 7QM/K2MiH2b miBHBbû2b T` H2b ?mKBMb TQm` `ii`T2` H2m` û[mBHB@
#`2, G bi`iû;B2 /Bi2 /2 +?2pBHH2 U;m+?2V- /2 ?M+?2 U+2Mi`2V 2i /2 Tb /2 `ii`T;2 U/`QBi2V UEMKBv 2i HX- kyRyV
Wi = Wg+ Wc
6B;m`2 eXe, G2 MQvm /2 pB#BHBiû `bb2K#H2 iQmb H2b ûiib ¨ T`iB` /2b[m2Hb BH 2bi TQbbB#H2
±
1 c21 ˙Ck+1 − C˙ ref k+12 + 1 c22Ck 2 + 1 c23Zk+1 − Fk+1 2, c1 c2 c3 u = Ck ¯ Fk+1 Ck F¯k+1 ± ±
6B;m`2 eXd, GQM;m2m`b /2b Tb /2 `ii`T;2 TQm` H2 b+ûM`BQb /2 >bBQ@q2+FbH2` M/ _Q#B@
MQpBi+? UkyydV, 2tTû`BK2MiH2b U2M #HM+- KQv2MM2 2i û+`i@ivT2V pb bBKmHû2b T` H T`2KBĕ`2 p2`bBQM /m KQ/ĕH2UMQB`V
6B;m`2 eX3, G2b TQbBiBQMb /2b i`QBb Tb /2 `ii`T;2 TQm` H2 b+ûM`BQ /2 *v` M/ aK22bi2`b
UkyyNV, 1tTû`BK2MiH2b U2M #HM+- KQv2MM2 2i û+`i@ivT2V pb bBKmHû2b T` H T`2KBĕ`2 p2`bBQM /m KQ/ĕH2UMQB`V mhc¨x+ j ¨θ= mg(cx− zx) z = cx− h g ¨cx− j mgθ.¨ j θ ˙ Ck+1 ˙ Θk+1 Q#i2MB` mM2 pû`Bi#H2 QTiBKBbiBQM /2 H /m`û2 /2 Tb ¨ F′ k+1 1 c2 1 ˙ Ck+12+ 1 c2 2 ˙Θ k+12+ 1 c2 3 ¨ F′ k+12.
6B;m`2 eXN, G2 KQ/ĕH2 /2 T2M/mH2 BMp2`bû HBMûB`2 p2+ mM pQHMi /^BM2`iB2 TQm` T`2M/`2 2M
+QKTi2 H2b 2z2ib BM2`iB2Hb /m ?mi /m +Q`Tb
Ck Θk Zk+1 1 c21 ˙Ck+1 2+ 1 c22 ˙Θk+1 2+ 1 c23 ¨F ′ k+12 + 1 c24Ck 2+ 1 c25Θk 2+ 1 c26Zk+1− Fk+1 2, u =Ck Θk F¯k+1 T c1 c6
6B;m`2 eXRy, G2b HQM;m2m`b /2 Tb /2 `ii`T;2 TQm` H2 b+ûM`BQ /2 >bBQ@q2+FbH2` M/
_Q#BMQpBi+? UkyydV p2+ H^QTiBKBbiBQM /2 H /m`û2 /2 Tb, 1tTû`BK2MiH2 U2M #HM+- KQv2MM2 2i û+`i@ivT2V +QMi`2 bBKmHû2 p2+ UMQB`V 2i bMb U;`BbV +QMbB/û`iBQM /2 H^BM2`iB2 /m ?mi /m +Q`TbX