Research on smooth trot-to-walk gait transition algorithm for ...

5HVHDUFKRQ6PRRWK7URWWR:DON*DLW7UDQVLWLRQ $OJRULWKPIRU4XDGUXSHG5RERW  

@ DQG >@ 7KH XQUHDVRQDEOH DVSHFW LQ >@ LV WKDW WKH JDLW WUDQVLWLRQVHTXHQFHLVGLYLGHGLQWRWKUHHHTXDOWLPHSDUWVWKH\ KDYH QRW FRQVLGHUHGWKDW GLIIHUHQW JDLW SDWWHUQV KDYH GLIIHUHQW VSHHG ,Q >@ WKHUH DUH RQO\ WZR FDVHV WKDW TXDGUXSHG FDQ FKDQJH ZDON WR WURW ZKLFK JLYH QHJDWLYH HIIHFW WR JDLW WUDQVODWLRQHIILFLHQF\ 7R FRSH ZLWK WKH DIRUHPHQWLRQHG SUREOHP LQ WKLV ZRUN WKH JDLW WUDQVLWLRQ DOJRULWKP RI WURW WR ZDON LV VWXGLHG DQG VWDELOLW\ VPRRWKQHVV WLPH XWLOL]DWLRQ UDWLR DUH XVHG IRU UHGXFLQJ HQHUJ\ FRQVXPSWLRQ DQG LPSURYLQJ DGDSWDELOLW\ WR WKHHQYLURQPHQW7KHLQQRYDWLRQSRLQWVDUHVKRZQEHORZ  ,QRUGHUWRHQVXUHURERWFDQVZLWFKJDLWGXULQJRSWLPDO WLPH WKH VWDWH PDFKLQH LV XVHG WR GHWHFW WKH PRPHQW WKDW VZLQJLQJOHJOHJVWRXFKGRZQ  &XELF VSOLQH LQWHUSRODWLRQ LV SHUIRUPHG WR JHQHUDWH D FRQWLQXRXV DQG VPRRWK YHORFLW\ FXUYH GXULQJ JDLW WUDQVLWLRQ VHTXHQFH 7KLV SDSHU LV RUJDQL]HG DV IROORZV ,Q 6HFWLRQ Ċ  JDLW SDWWHUQV RI WURW DQG ZDON DUH DQDO\]HG JHWWLQJ WZR VZLWFK SRLQWV DQG VL[ DFFHVV SRLQWV UHVSHFWLYHO\ ,Q 6HFWLRQ ċ ZH SURSRVHDJDLWWUDQVLWLRQPHWKRGIRUIDVWJDLWWUDQVLWLRQFRQWURO

RIDTXDGUXSHGURERW7KHORFRPRWLRQVSHHGRIJDLWWUDQVLWLRQ VHTXHQFHVDUHFDOFXODWHGXVLQJFXELFVSOLQHLQWHUSRODWLRQ7KHQ VLPXODWLRQH[SHULPHQWLVSHUIRUPHGE\XVLQJURERW:HERWVLQ 6HFWLRQČ)LQDOO\FRQFOXVLRQVDUHJLYHQLQ6HFWLRQč ,, 29(59,(:62)*$,73$77(516 A. Trotting gait )LJ  VKRZV WKH WURWWLQJ JDLW ZH XVHG 7KH VROLG OLQHV UHSUHVHQWTXDGUXSHG¶VFXUUHQWERG\VWDWXVDQGWKHGRWWHGOLQHV UHSUHVHQW WKH QH[W¶V 7KH DUF DUURZ UHSUHVHQWV WKH WUHQG RI PRWLRQRIWKHURERW L LVWKHVWHSOHQJWKRIWURWWLQJJDLW7KH OHIWIURQWDQGULJKWKLQGOHJDUHQDPHG'LDJRQDO/HJV'/  ULJKWIURQW OHJ DQG OHIWKLQG OHJ DUH QDPHG 'LDJRQDO /HJV '/ UHVSHFWLYHO\$WWURWWLQJJDLWVZLQJLQJOHJVDQGERG\ DUHPRYLQJDWWKHVDPHWLPHVRZHFDQQRWFDOFXODWHWKHDFWXDO GLVWDQFHRIWLSWRHVEDVHG RQWKHORFDWLRQFRRUGLQDWHRIWLSWRHV UHODWLYH WR URERW¶V RZQ FRRUGLQDWH V\VWHP hip B x LV GHILQHG DVWKHWLSWRH¶VSRVLWLRQDORQJ x D[LVUHODWLYHWRLWVHOIKLSMRLQW )RUH[DPSOH5+¶VWLSWRHLVDKHDGRIULJKWKLQGOHJ¶VKLSMRLQW WKH RH hip B x LV UHFRUGHG DV SRVLWLYH QXPEHU 5)¶V WLSWRH LV EHKLQG LWV KLS MRLQW WKH RFhip B x LV UHFRUGHG DV PLQXV )LJ  VKRZVHDFKOHJ¶V hip B x  7ZR FRQGLWLRQ SRLQWV WKDW VZLQJLQJ GLDJRQDO OHJV DQG VWDQGLQJGLDJRQDOOHJVUHSODFHHDFKRWKHULQRQHWURWSHULRGDUH REWDLQHG WKURXJK WKH DQDO\VLV RI YDOXH 7ZR FRQGLWLRQ SRLQWV DUHQDPHG&RQGLWLRQ& DQG&RQGLWLRQ& DVVKRZQLQ )LJ7KHSRLQWWKDW'/DKHDGRIWKHLURZQKLSMRLQWLV& 2Q WKH FRQWUDU\ & LV WKH SRLQW ZKRVH '/ LQ IURQW RI WKHLU RZQKLSMRLQW$WWZRFRQGLWLRQVDERYHPHQWLRQHGWURWWLQJJDLW FDQ EHJDQ WR FKDQJH QRW WKH RWKHUV ,Q WKH & RFhip B x LH hip B x  L    LFhip B x RH hip B x L    ,Q WKH

LFhip B x

&

RH hip B x

RFhip B x

LH hip B x

L  



 L   

B. Discontinuous Static Walking Gait $V WKH JDLW DIWHU VZLWFKLQJ GLVFRQWLQXRXV VWDWLF ZDON JDLW ZDON VKRXOGEHDQDO\]HGDQGILQGWKHVXLWDEOHDFFHVVSRLQWV :DONSDWWHUQXVHGLQWKLVSDSHULVVKRZQLQ)LJ xy LVWKH ERG\ FRRUGLQDWH V\VWHP DQG  IRUZDUG GLUHFWLRQ RI WKH TXDGUXSHGURERWLVWKHSRVLWLYHGLUHFWLRQRI x D[LV2QHSHULRG LV GLYLGHG LQWR VL[ VWDJHV DQG L LV WKH VWHS OHQJWK RI ZDONLQJ JDLW 6WDJH  5+ VZLQJV IRUZDUG L DORQJ x D[LV WR UHDFK WKH SRLQWLQIURQWRI L   RILWVKLSMRLQW$WWKHHQGRIWKLVVWDJH RH hip B x L    6WDJH  5) VZLQJV IRUZDUG L DORQJ x D[LV WR UHDFK WKH SRLQWLQIURQWRI L   RILWVKLSMRLQW$WWKHHQGRIWKLVVWDJH RFhip B x L    6WDJH  $W WKLV VWDJH WKH FHQWHU RI JUDYLW\ &2*  LV PRYLQJWRWKHULJKWVWDELOL]HGERXQGDU\ DQGPRYLQJIRUZDUG $IWHU WKLV VWDJH WKH hip B x YDOXH RI IRXU IHHW DUH DOO FKDQJHG RFhip B x RH hip B x   RFhip B x   RH hip B x  L    6WDJH  /+ VZLQJV IRUZDUG L DORQJ x D[LV WR UHDFK WKH SRLQWLQIURQWRI L   RILWVKLSMRLQW$WWKHHQGRIWKLVVWDJH LH hip B x L    6WDJH  /) VZLQJV IRUZDUG L DORQJ x D[LV WR UHDFK WKH SRLQWLQIURQWRI L   RILWVKLSMRLQW$WWKHHQGRIWKLVVWDJH LFhip B x L    6WDJH&2*LVPRYLQJWRWKHOHIWVWDELOL]HGERXQGDU\DQG PRYLQJ IRUZDUG $IWHU WKLV VWDJH LFhip B x LH hip B x  

RFhip B x

RH hip B x

 L   

$IWHUDQDO\]HGDERYHVL[FRQGLWLRQSRLQWVWKDWWKHMXQFWLRQ SRLQW RI HYHU\ WZR VWDJHV LQ RQH SHULRG FDQ EH XVHG DV WKH DFFHVVSRLQWVRIWURWWRZDONWUDQVLWLRQVHTXHQFHV 

 )LJ,OOXVWUDWLRQRIWKHWURWWLQJJDLW 

 )LJVWDJHVRIWKHVWDWLFZDON



6HTXHQFH6DPHDV6HTXHQFH

,,, '(6,*12)752772:$/.*$,775$16,7,21 A. Rhythm Control 7R FRQGXFW JDLW WUDQVLWLRQ RI TXDGUXSHG URERW EHWZHHQ GLIIHUHQW JDLWV ZH FRXOG DGMXVW GXW\ IDFWRU SHULRG SKDVH GLIIHUHQFH DQG SKDVH VHTXHQFH V\QFKURQRXVO\ DFFRUGLQJ WR FKDQJHRIFLUFXPVWDQFHV7KHVHIDFWRUVDUHGHWHUPLQHGE\JDLW UK\WKP %RWK&DQG&FDQEHXVHGDVVZLWFKLQJSRLQWWRFKDQJH WKH WURWWLQJ JDLW RI TXDGUXSHG URERW WKH WUDQVLWLRQ VHTXHQFHV DUH QDPHG FDVH  DQG FDVH  UHVSHFWLYHO\ $OWKRXJK WKH WZR WUDQVLWLRQVHTXHQFHVDUHQRWLGHQWLFDOWKH\FDQEHVXPPDUL]HG DVIROORZV 6HTXHQFH  &RPSDUH WKH hip B x YDOXH RI /+ DQG 5+ ,I

LH hip B x ELJJHUWKDQ RH hip B x PRYLQJ&2*WROHIWVWDELOL]HG ERXQGDU\ ,QVWHDG PRYH WR WKH ULJKW DW WKLV VHTXHQFH &2* GRVHQRWPRYHDORQJWKH x D[LV  6HTXHQFH  6HOHFW WKH KLQG OHJ ZLWK VPDOOHU hip B x DV VZLQJLQJ OHJ $W WKH HQG RI WKLV VHTXHQFH VZLQJLQJ OHJ ODQGLQJDQG hip B x YDOXHLVUHDFKHGWR L    6HTXHQFH,SVLODWHUDOIURQWOHJZLWKSUHYLRXVVHTXHQFHRI VZLQJLQJ OHJ DV VZLQJLQJ OHJ $W WKH HQG RI WKLV VHTXHQFH VZLQJLQJOHJODQGLQJDQGLWV hip B x YDOXHLVUHDFKHGWR L    6HTXHQFH0RYLQJ&2*DORQJ x D[LVIRUZDUG L   DQG DORQJ y D[LVWRWKHRWKHUVLGHVWDELOL]HGERXQGDU\

6HTXHQFH6DPHDV6HTXHQFH $V VKRZQ LQ )LJ  DQG )LJ  WKH WUDQVLWLRQ VHTXHQFHV IURPWURWWLQJJDLWWRZDONLQJJDLW$IWHUWURWWRZDONWUDQVLWLRQ VHTXHQFHVWKHFRQGLWLRQRITXDGUXSHGURERWLVWKHVDPHDVRQH RIDFFHVVSRLQWRIZDONLQJJDLW&DQG&WUDQVLWLRQWRDFFHVV SRLQWDQGUHVSHFWLYHO\ B. Speed Control 7KHVSHHGWKDWWURWWLQJJDLWDSSO\WRLVKLJKHUWKDQZDONLQJ JDLW¶V,QRUGHUWRHQVXUHWKHFRQWLQXLW\DQGVPRRWKQHVVRIWKH VSHHGLQ DOOWUDQVLWLRQVHTXHQFHVFXELFVSOLQHLQWHUSRODWLRQLV XVHGWRFRQQHFWVZLWFKSRLQWVDQGDFFHVVWKHPRWLRQVSHHGRI DFFHVV 7KH VSHHG LQ WKH IROORZLQJ VHFWLRQV UHIHUV WR WKH PRYLQJ VSHHG RI &2* 7KH VSHHG  vtrot  RI WURWWLQJ JDLW LV FRQVWDQW WKH YDOXH LV v  WKH VSHHG RI ZDONLQJ JDLW LV  GXULQJ VWDJH &RPSRQHQWVSHHGLQ x D[LVGLUHFWLRQ vwalk RI6WDJH DQGVWDJH VWDUW IURPLQFUHDVH ILUVWO\ DQGGHFUHDVH WR 7KHVSHHGLQWUDQVLWLRQVHTXHQFHVUHFRUGHGDV vtrans LVDWWKH EHJLQQLQJDQGHQGRIWKHVHTXHQFH7KHVSHHGLQWKHHQGRIWKH VHTXHQFHVLVHTXDOWR vwalk DWDFFHVVSRLQWRIZDONLQJJDLW%XW WKH vtrot RIVZLWFKSRLQWLV v WKDWLVQRWHTXDOWR vtrans RIWKH VWDUWRIWUDQVLWLRQVHTXHQFHV  



 )LJ,OOXVWUDWLRQRIWKHVWDWXVGXULQJWKHFDVHRIWURWWRZDONJDLWWUDQVLWLRQ



 )LJ,OOXVWUDWLRQRIWKHVWDWXVGXULQJWKHFDVHRIWURWWRZDONJDLWWUDQVLWLRQ





,Q RUGHU WR OHW vtrot RI VZLWFK SRLQW HTXDO WR  D GHFHOHUDWLRQLVVWDUWHGIURPRQHF\FOHEHIRUHWKHVWDUWRIVZLWFK 6WUXFWXUHVSHHGIRUPXODDQGDFFHOHUDWLRQIRUPXOD DVHTXDWLRQ  DQG EDVHGRQFXELFVSOLQHLQWHUSRODWLRQ˖ 

a  at  at at

vt vtc

a  at  at









   

ZKHUH t LV WKH YDULDEOH RI vt DQG vtc  t  > T @ T LV WKH 

mLQWKHRYHUDOOWUDQVLWLRQ SHULRG )LJVKRZVWKH &2* VSHHG RI WUDQVLWLRQ VHTXHQFHV $W WKH ODVW WURW SHULRG vtrot GHFHOHUDWLRQ WR 0 VPRRWKO\ 7KHUH LV QR LQVWDQWDQHRXV FKDQJHRIVSHHG)LJVKRZVWKHSRVLWLRQFRRUGLQDWHRIIRXU WLSWRHVRIWKHTXDGUXSHGURERW7KH hip x RIWKHHQGRIHDFK  VHTXHQFH DOVR FDQ EH GHGXFHG DQG DUH VKRZQ LQ 7DEOH  FRUUHVSRQGLQJO\)URPWKHDERYHDQDO\VLVRIVLPXODWLRQGDWD ZH FDQVHHWKDWWKHTXDGUXSHG URERW FDQ VZLWFKIURPWURWWLQJ JDLW WR ZDONLQJ JDLW VPRRWKO\ DQG VWHDGLO\ EDVHG RQ WKH SURSRVHGJDLWWUDQVLWLRQDOJRULWKP

PRGHUDWLYH SHULRG RI WURWWLQJ JDLW a  a  a  a LV FRHIILFLHQWV WKDW QRW EH GHWHUPLQHG 7KH VWDUWLQJ SRLQW RI GHFHOHUDWLRQ t  vt v  vtc   7KH HQG SRLQW RI GHFHOHUDWLRQ t

T  vt

 vtc

 %ULQJWKHDERYHFRQGLWLRQV

LQWR HTXDWLRQ   DQG   a  a  a  a DUH GHWHUPLQHG DV IROORZV a

v  a





v  T  a

  a



v  T  6R

)LJ7KHVLPXODWLRQPRGHORIURERW

vt DQG vtc EHFRPH 







vt

v  v  T t  v  T t

vtc

v  T t  v  T t









  

  

,QWHJUDWH v RQ > T @ HTXDO WR Lc  T LV GHWHUPLQHG DV t  IROORZV

 )LJ7KHVWDELOLW\PDUJLQRIFDVHRIWURWWRZDON

  T L  v   7KH FXUYH RI WLPH DQG YHORFLW\ GXULQJ GHFHOHUDWLRQ LV VKRZQDV)LJ



)LJ7KHIRUZDUGVSHHGRI&2*RIFDVHRIWURWWRZDON

7$%/(7+( hip B x 9$/8(2))285)((7,17+(&$6(2):$/.727527

 )LJ,OOXVWUDWLRQRIWKHYDULDWLRQRIWKHYHORFLW\RIWURWRYHUWLPH

,9 (;3(5,0(1762)7+(*$,775$16,7,21 )LJ  VKRZV WKH TXDGUXSHG URERW ORFRPRWLRQ PRGHO LQ URERWVLPXODWRU:HERWV3DUDPHWHUVRIWKHTXDGUXSHGURERWDUH DV IROORZLQJ ZDONLQJ SHULRG Twalk s  L m  WURWWLQJ SHULRG Ttrot s  Lc m  vtrot m  s  5LJKW ERXQGDU\DQGOHIWERXQGDU\DUHSDUDOOHOWRFHQWHUOLQHDQGWKH ODWHUDOGLVWDQFHLVm*DWKHUWKHVWDELOLW\PDUJLQGDWDHYHU\  VHFRQG WR PDNH VXUH PRWLRQ VWDELOLW\ RI WKH TXDGUXSHG URERW:KHQWKHVWDELOLW\PDUJLQLVOHVVWKDQmTXDGUXSHG ORVHVLWVVWDELOLW\ )RUVLPSOLFLW\WDNHWKH FDVH DVWKHVLPXODWLRQH[DPSOH )LJVKRZVWKHVWDELOLW\PDUJLQRIDOOWKHWUDQVLWLRQVHTXHQFHV 7KHVLPXODWLRQUHVXOWVVKRZWKDWWKHVWDELOLW\PDUJLQLVDERYH





5)

5+

/)

/+

6ZLWFKSRLQW (QGRIVWDJH (QGRIVWDJH (QGRIVWDJH (QGRIVWDJH (QGRIVWDJH (QGRIVWDJH $FFHVVSRLQW

       

       

       

       

 č&21&/86,216 ,QWKLVSDSHUZHLQYHVWLJDWHGWZRW\SLFDOJDLWSDWWHUQVWURW DQG ZDON  DQG WKH VZLWFK PHWKRG EHWZHHQ WKHP )LUVWO\ RQH SHULRGRIWURWWLQJJDLWDQGZDONLQJJDLWDUHDQDO\]HGIRUILQGLQJ RXW WZR VZLWFK SRLQWV DQG VL[ DFFHVV SRLQWV UHVSHFWLYHO\ 6HFRQGO\ D JDLW WUDQVLWLRQ PHWKRG LV SURSRVHG YLD FKDQJHG GXW\IDFWRUSHULRGSKDVHGLIIHUHQFHDQGVWHSOHQJWKRIWKHJDLW SDWWHUQV%DVHGRQWKHFXELFVSOLQHLQWHUSRODWLRQWKHVSHHGRI VZLWFK SRLQW RI WURWWLQJ JDLW LV HTXDO WR WKH VWDUW RI WUDQVLWLRQ VHTXHQFHV7KHUHIRUHWKHJDLW

WUDQVLWLRQ IURP WURW WR ZDON LV LPSOHPHQWHG VPRRWKO\ DQG VWHDGLO\ 6LPXODWLRQ UHVXOWV YHULI\ WKH IHDVLELOLW\ DQG HIIHFWLYHQHVV RI WKH PHWKRG ZKLFK FDQ SURYLGH D EHWWHU

WKHRUHWLFDO DQG PHWKRGRORJLFDO EDVLV IRU WKH JDLW WUDQVLWLRQ RI UHDOTXDGUXSHGURERWSK\VLFDOSODWIRUP 

 )LJ7KHSRVLWLRQGDWHJUDSKRIIRXUIHHWRIFDVHRIWURWWRZDON

5()(5(1&(6  >@ 0LQHWWL $ ( $UGLJR / 3 5HLQDFK ( HW DO 7KH UHODWLRQVKLS EHWZHHQ PHFKDQLFDO ZRUN DQG HQHUJ\ H[SHQGLWXUH RI ORFRPRWLRQ LQ KRUVHV>-@ -RXUQDORI([SHULPHQWDO%LRORJ\  >@ *ULIILQ70.UDP5:LFNOHU6-HWDO%LRPHFKDQLFDODQGHQHUJHWLF GHWHUPLQDQWV RI WKH ZDONWURW WUDQVLWLRQ LQ KRUVHV>-@ -RXUQDO RI ([SHULPHQWDO%LRORJ\  >@ ,MVSHHU $ - %LRURERWLFV XVLQJ URERWV WR HPXODWH DQG LQYHVWLJDWH DJLOH ORFRPRWLRQ>-@6FLHQFH  >@ :DQJ &KHQJ *DR -XQ\DR 'XDQ ;LQJJXDQJ HW DO 7KH &3* *DLW *HQHUDWH0HWKRGRIWKH4XDGUXSHG5RERW%DVHGRQ,WHUDWLYH/HDUQLQJ &RQWURO$OJRULWKP>-@$GYDQFHG0DWHULDOV5HVHDUFK >@ =KDQJ ;LXOL =KHQJ +DRMXQ &KHQ /LDQMXQ *DLW WUDQVLWLRQ IRU D TXDGUXSHGDO URERW E\ UHSODFLQJ WKH JDLW PDWUL[ RI D FHQWUDO SDWWHUQ JHQHUDWRUPRGHO$GYDQFHG5RERWLFV>-@  >@ &DR4X9DQ5$73RXODNDNLV,2QWKHFRQWURORIJDLWWUDQVLWLRQVLQ TXDGUXSHGDO UXQQLQJ>&@ ,(((56- ,QWHUQDWLRQDO &RQIHUHQFH RQ ,QWHOOLJHQW5RERWVDQG6\VWHPV >@ :RQ0.DQJ7+:DQ.&*DLWSODQQLQJIRUTXDGUXSHGURERWEDVHG RQ G\QDPLF VWDELOLW\ ODQGLQJ DFFRUGDQFH UDWLR>-@ ,QWHOOLJHQW 6HUYLFH 5RERWLFV  >@ .LPXUD + )XNXRND -@,IDF3URFHHGLQJV9ROXPHV   >@ $RL 6 &@ ,(((56- ,QWHUQDWLRQDO &RQIHUHQFHRQ,QWHOOLJHQW5RERWV 6\VWHPV >@ 0DVDNDGR 6 ,VKLL 7 ,VKLL . $ *DLW7UDQVLWLRQ 0HWKRG IRU D 4XDGUXSHG :DONLQJ 5RERW>&@ ,((($60( ,QWHUQDWLRQDO &RQIHUHQFH RQ $GYDQFHG ,QWHOOLJHQW 0HFKDWURQLFV 3URFHHGLQJV  >@ /HH