The higher order sliding modes control of bipedal walking robot with

The control of biped walking machines remains a challenge due to the high degree of complexity, ... ‚q the accelerations vector, M represents the inertia matrix, C the centrifugal and coriolis effects, G the gravity effect, V the joint friction effect.
77KB taille 10 téléchargements 198 vues
Wkh kljkhu rughu volglqj prghv frqwuro ri elshgdo zdonlqj urerw zlwk revhuylqj hruw frqwdfwv K1 Fkhuulg/ I1 HuudklplW / Q1 Qdgmdu0Jdxwklhu dqg Q1 N1 P*Vlugl Oderudwrluh gh Urerwltxh gh Sdulv 43045 Dy1 gh o*Hxursh/ :;473 Yìol}|/ IUDQFH Hpdlo=~fkhuulg/qdgmdu/pvlugl€Curerw1xyvt1iu W

Idfxowì ghv vflhqfhv hw whfkqltxhv Iëv0Vdlv/ PDURF 1

Nh|zrugv0 Zdonlqj elshg/ urexvw frqwuro/ khljkhu rughu volglqj prghv/ fkdwwhulqj dyrlgdqfh1 Iru wkh kxpdq elshg/ zdonlqj lv vxfk d qdwxudo h{huflvh/ shuiruphg vr h!flhqwo| wkdw lw lv gl!fxow wr shufhlyh lqwxlwlyho| lwv lqwulqvlf frpsoh{lw|1 Zh fdq hdvlo| lpdjlqh krz plplfnlqj vxfk dq h{huflvh zlwk d elshg zdonlqj pdfklqh fdq ohdg wr fkdoohqjlqj sureohpv lq wkh hogv ri frqwuro/ vhqvlqj dqg prwlrq sodqqlqj1 Wkh frqwuro ri elshg zdonlqj pdfklqhv uhpdlqv d fkdoohqjh gxh wr wkh kljk ghjuhh ri frpsoh{lw|/ rujdqlvdwlrq/ dqg h!flhqf| qhhghg wr pdlqwdlq edodqfh1 Wkhruhwlfdo dqg dssolhg vwxglhv ri elshg or0 frprwlrq kdyh surylghg uhvxowv rq nlqhpdwlf dqg g|qdplf prgholqj/ frqwuro dojrulwkpv/ dqg vwdelolw|1 Yxnreudwrylf hw do1 ^43` kdyh surylghg rqh ri wkh prvw h{whqvlyh vwxglhv ri elshg orfrprwlrq1 Udlehuw ^:` exlow dqg lpsohphqwhg ydulrxv frqwuro dojrulwkpv lq uxqqlqj pdfklqhv kdylqj rqh wr irxu ohjv1 Lq Mdsdq/ elshg orfrprwlrq kdv ehhq vwxglhg xvlqj urerwlfv/ frqwuro wkhru|/ dqg vhqvru0edvhg frqwuro ^9`1 Elshg uhvhdufk kdv ehhq dfwlyho| zrunlqj wr pdnh d urerw fdsdeoh ri g|qdplf zdonlqj1 G|qdplf elshgdo zdonlqj zdv uhdol}hg e| Plxud dqg Vklpr|dpd ^9`/ Wdndqlvkl hw do1 ^;`/ Ixuxvkr dqg Vdqr ^6`/ Ndmlwd hw do1 ^8`/ ]khqj dqg Vldv ^44`/ dqg Julvklq hw do1 ^7`1 Wkh frqwh{w ri rxu uhvhdufk lv wkh vwxg| ri elshg orfrprwlrq frqwuro zlwk revhuylqj hruw frqwdfwv> zh dsso| d kljkhu rughu volglqj prghv whfkqlfv wr iroorz wkh jdlw ri wkh sodqdu/ yh0olqn elshg urerw vkrzq lq +jxuh 4,1 Wkh g|qdplf prgho ri wkh v|vwhp fdq eh zulwwhq lq wkh iroorzlqj irup= P+t,‚ t . F+t> t, b tb . J+t, . Y +t, b @ d . h

+4,

zlwk t 5 ?: wkh jhqhudol}hg frruglqdwh yhfwru +t @ ^t64 > t65 > t74 > t75 > |> }> t4 `,/ tb wkh yhorflwlhv yhfwru/ t‚ wkh dffhohudwlrqv yhfwru/ P uhsuhvhqwv wkh lqhuwld pdwul{/ F wkh fhqwulixjdo dqg frulrolv hhfwv/ J wkh judylw| hhfw/ Y wkh mrlqw iulfwlrq hhfw1 d lv wkh wrutxh surgxfhg e| wkh dfwxdwruv/ dqg h wkh h{whuqdo irufhv dssolhg wr wkh mrlqwv1 Wkh h{whuqdo irufhv fruuhvsrqg wr wkh jurxqg lqwhudfwlrq1 Zkhq

4

y

l2 q

1

q31 q32 l3

q41 q42

l4

z

Iljxuh 4= Ilyh0olqn elshg urerw wkh elshg urerw lv qrw lq frqwdfw zlwk wkh jurxqg h @ 31 d @ ^64 > 65 > 74 > 75 > 3> 3> 3`W / wkh qxoo ydoxhv fruuhvsrqg wr yluwxdo mrlqwv +|> }> t4 ,1 Wkh wkhru| ri yduldeoh vwuxfwxuh frqwuro kdv ehhq ghyhorshg iru wkh ghvljq ri kljk shuirupdqfh frqwuro v|vwhpv1 Frqwuro vwudwhjlhv edvhg rq yduldeoh vwuxfwxuh frqwuro +YVF, vfkhphv duh urexvw djdlqvw glvwxuedqfhv dqg sdudphwhu xqfhuwdlqwlhv1 Prvw ri wkh hduo| zrun lq wkh duhd kdv ehhq uhsruwhg lq wkh Uxvvldq olwhudwxuh ^ t5g > wlph0ydu|lqj wudmhfwrulhv1 Wkh kljkhu volglqj prgh frqwuro dojrulwkp lv ghqhg e| wkh iroorzlqj frqwuro odz= d +w, @ d4 +w, . d5 +w, ; ? d b d4 +w, @ = zvljq +v,

vl

md m A 4

vl

md m  4

; ?  mv3 m vljq +v, b d5 +w, @ =  mvm vljq +v,

vl

mvm A v3

vl

mvm  v3

dqg wkhuh duh vrph vx!flhqw frqglwlrqv iru wkh qlwh wlph frqyhujhqfh zklfk zloo eh ghwdlohg lq wkh ixoo sdshu1 rd

-2.5 -3 -3.5

0

0.5

1

1.5

2

2.5

3

3.5

4

4.5

5

0 0

0.5

1

1.5

2

2.5

3

3.5

4

4.5

5

0.5

1

1.5

2

2.5

3

3.5

4

4.5

5

0.5

1

1.5

2

2.5 temps(s)

3

3.5

4

4.5

5

rd

-2.5 -3

rd

-3.5

-0.5 -1

rd

0 0

-0.5 -1

0

Iljxuh 5= Wudfnlqj huuru Zh kdyh dssolhg wklv frqwuro odz iru wkh wudmhfwru| wudfnlqj ri d sodqdu elshg urerw ghvfulehg douhdg| wkh vlpxodwlrqv zhuh grqh rq d frqwuro elshg vlpxodwru ghyhorshg e| d zrun jurxs ri iuhqfk uhvhdufkhuv fdoohg SUF0Urerw ã sdwwhv vxsruwhg e| wkh FQUV1 Wkh uhvxowv +jxuh 5, ghprqvwudwh wkh vxffhvvixo dssolfdwlrq ri wkh sursrvhg frqwuro elshgdo orfrprwlrq1 Wkh frqwdfw uhvxowv lq wkh vzlwfklqj ri wkh slyrw iurp wkh wls ri rqh olpe wr wkh rwkhu/ ohdglqj wr wkh surjuhvvlrq ri wkh elshg lq wkh iruzdug gluhfwlrq1 \hw/ 6

wkh frqwdfw hyhqw fdxvhv vxgghq fkdqjhv lq wkh vwdwh yduldeohv gxh wr lpsdfw dqg vzlwfklqj1 W|slfdoo|/ wkh frqwuroohu wdnhv ryhu lpphgldwho| diwhu wkh frqwdfw hyhqw dqg dwwhpswv wr holplqdwh wkh shuwxuedwlrqv wkdw duh fdxvhg e| wkh vxgghq fkdqjhv lq wkh vwdwh yduldeohv1 Zkhq wkh qh{w frqwdfw rffxuv/ krzhyhu/ wkh vwdwh lv shuwxuehg djdlq dqg wkh f|foh ri hyhqwv uhshdw lq d vlplodu pdqqhu1 Rxu remhfwlyhv duh qrz wr pruh uhdolvwlf dqg rswlpdo wudmhfwrulhv lq vlpxodwlrq dqg rq d surwrw|sh ri d sodqdu elshg urerw zklfk kdv ehhq exlow lq rxu oderudwru|1

Uhihuhqfhv ^4` J1 Eduwrolql/ D1 Ihuudud/ dqg H1 Xvdl1 Fkdwwhulqj dyrlgdqfh e| vhfrqg0rughu volglqj prgh frqwuro1 76+5,=574 579/ 4