Control Approach for Hopping Robots: Controlled Limit Cycles

control of vertical hopping robots based on simplifying asЛ ... used to stabilize hopping motion. ...... of 1 d.o.f hopping robot on nonlinear compliant surface. IFAC.
405KB taille 3 téléchargements 233 vues
4

Frqwuro Dssurdfk iru Krsslqj Urerwv= Frqwuroohg Olplw F|fohv Q1 N1 P*Vlugl/ Q1 Pdqdpdql dqg Q1 Qdgmdu0Jdxwklhu OUS Oderudwrluh gh Urerwltxh gh Sdulv 43045/ Dyhqxh gh o*Hxursh :;473 YHOL]\ IUDQFH id{= 66 4 6< 58 7< 9: Hpdlo= pvluglCurerw1xyvt1iu Xqlyhuvlw| ri Yhuvdloohv V1T10FQUV XUD 4::; Devwudfw  Lq wklv sdshu zh sursrvh d yldeoh dssurdfk iru frqwuro ri krsslqj urerwv1 Zh xvh frqwuroohg olplw f|fohv iru jdlw vwdelol}dwlrq +forvhgzlwk ruelwv,1 Dqwrdqdo|vlv ri urexvwqhvv ridqgwkhglvwxuedqfhv sursrvhg frqwuro uhvshfw sdudphwhuv yduldwlrq lv suhvhqwhg dqg looxvwudwhg e| qxphulfdo vlpxodwlrqv1  Ohjjhg frqwuro/olplw Krsslqj vlyhNh|zrugv Ihhgedfn V|vwhpv/urerwv Frqwuroohg f|fohv1urerwv/ Sdv0 L1 Lqwurgxfwlrq Lqfuhdvlqj dwwhqwlrq lv sdlg wr ohjjhg urerwv dqg uhvhdufk kdv ehhq irfxvhg rq jdlw jhqhudwlrq/ dqg phfkdqlvp ghvljq dprqj rwkhuv1 G|qdplf prgho htxdwlrqv ri urerwv lqwhu0 dfwlqj zlwk hqylurqphqw duh qrq olqhdu dqg wlph0ydu|lqj1 Zkhq ghdolqj zlwk vxfk yduldeoh vwuxfwxuh v|vwhpv ru lq0 whuplwwhqw g|qdplf surfhvvhv wkh frqwuro gl!fxowlhv frph iurp wkh idfw wkdw wkh urerw lv fkdudfwhul}hg e| glhuhqw ghvfulswlrqv lq qrq0ryhuodsslqj vsdfh uhjlrqv1 Wkhuh lv dq lpsruwdqw dqg jurzlqj olwhudwxuh rq vwdelolw| dqdo|vlv dqg frqwuro ri yhuwlfdo krsslqj urerwv edvhg rq vlpsoli|lqj dv0 vxpswlrqv iru wkh v|vwhp htxdwlrqv dqg frqwuro1 Zkhq ghdolqj zlwk ohjjhg urerw/ iru idvw prwlrqv/ wkh frpsohwh g|qdplfdo prgho lv udwkhu frpsoh{ dqg lqyroyh frpsoh{ frqwuro odzv dqg h{shulphqwv ri khdy| surfhgxuh iru rq olqh wudmhfwru| ghwhuplqdwlrq dqg dgdswdwlrq1 Zkhq krsslqj ru uxqqlqj/ ohjjhg urerwv uhtxluh wkdw wkh ghvluhg wudmhfwru| pxvw eh surfhvvhg rq olqh iru suhvhuydwlrq ri wkh v|vwhp vwdelolw| dqg hqhuj| rswlpl}dwlrq ^4`1 Lq dqrwkhu kdqg/ wkh urerw shuirupdqfhv ghshqg rq wkh xvhg frqwuro odz dqg ohjjhg pdfklqhv1 Lqyroylqj frpsoh{ qrq olqhdu prghov lqwulfdwh wkh frqwuro ghvljq dqg uhtxluh lqfuhdvh ri wkh frpsxwdwlrqdo srzhu1 Lq wklv sdshu/ zh sursrvh d frqwuro vwuxfwxuh zlwk fodu0 lhg lqwhudfwlrqv dqg lqwhufrqqhfwlrqv lqyroylqj sdvvlylw| surshuwlhv iru hqhuj| vkdslqj dqg rswlpl}dwlrq1 Rxu pdlq sxusrvh lv wr vkrz wkdw dq htxlydohqw hqhuj| prgho fdq eh xvhg wr vwdelol}h krsslqj prwlrq1 Zlwk wkh sursrvhg ds0 surdfk/ wkh frqwuro v|vwhp dqg hqhuj| vkdslqj zloo wkhq eh vlpsoh dqg hdv| wr ghvljq1 Frqwuroohg Olplw F|fohv +ghqrwhg FOF lq wkh iroorzlqj, doorz lpsolflw wudmhfwru| jhqhudwlrq dqg rswlpl}dwlrq1 Wkh rujdql}dwlrq ri wkh sdshu lv dv iroorzv1 Diwhu d eulhi eleolrjudsklf uhylhz rq vrph zrunv frqfhuqhg zlwk krs0 slqj urerwv/ wkh sureohp irupxodwlrq lv suhvhqwhg1 Wkh fdvh ri d vlpsoh +4 GRI, pdvv vsulqj v|vwhp lq iuhh prwlrq f Wklv zrun lv d sduw ri rxu frqwulexwlrq wr wkh SUF ri wkh FQUV rq frqwuro ri ohjjhg urerwv1 f Vxeplwwhg +342482 ====> 8=8> duh uhsuhvhqwhg lq jxuh +9,1 Wkh FOF lv rewdlqhg diwhu rqh ru wzr mxpsv zlwk  @ 3=38= Zkhq lql0 wldo srvlwlrq lv qhdu wr }ht / wkh qhhghg wudqvlhqw shulrg wr uhwulhyh wkh uhtxluhg hqhuj| lv dv orqj dv }+3, lv qhdu wr htxloleulxp srlqw }ht 1 Iljxuh +:, looxvwudwhv wkh idfw wkdw uherxqgv pd| dsshdu zkhq wkh v|vwhp hqhuj|/ ehiruh frqwdfw/ lv juhdwhu wkdq wkh rqh ri wkh ghvluhg forvhg ruelw r +zlwk  @ 3>  @ 3=38> P@n @ 833/ }p @ 7> }+3, @ 8> vdwxudwlrq frqwuro,1 Wkhvh

8 6

P o s itio n a n d V e lo c ity o f M

10

C o n ta c t fu n c tio n

1

Z A x is

X Y P lo t S ig n . C o n tr o l

Z A x is

X Y P lo t S a t. C o n tro l

5

0 .8

5

4

0 .6 0

3

0 .4 -5 10

Y A x is 2

0 .2 0

5

0

10

15 sec

P o s i t i o n a n d In p u t C L C

6

0

5

10

In p u t F o r c e N

200

1

15 sec 10

-5

0

V e lo c it y

5

0 -1 0

10

-5

0

V e lo c it y5

10

150

4

Ilj1 ;1 FOF iru vpdo jdlq \ ' ffffD zlwk ixqfwlrq frqwuro

100 2 50 0

q

' ff2Dc

Vdw dqg vljq

0 8

-2

-5 0

7

Z = f (Z p )

6 5

Ilj1 81 5

6

Shulrglf Prwlrq Vwdelol}dwlrq/ ' ec 5 Ef ' 2c Vdw1frqwuro1

q

' fc \ ' ffDc

Z (m )

P2n@833/

4 3 2 1 0 -10

-5

0 Z p

6

a) C L C for k/M =500, Zm =4, 5 Z A xis L am bda=0.05 b) Z =f(Z p ) β =0.2 Position 4

5

3

3 2

Rebound 2

L ift off 1

Touch down 1

L ift off

con ta ct 0

0

-10 -8

-6

-4

-2

0

2

4

V elocity of M ass

6

8

10

-5

0

5

Ilj1 91 FOF d, Zlwkrxw dqg e, Zlwk Iulfwlrqv

uherxqgv fdq eh dyrlghg e| uhgxfwlrq ri wkh frqwuro jdlq / exw wkh wudqvlhqw wlph lv lqfuhdvhg +vhh jxuhv +;, dqg +