7$&+,1* $1' *5$63,1* 675$7(*< ,163,5(' %< +80$1

'(7$&+,1* $1' *5$63,1* 675$7(*< ,163,5(' %< +80$1 %(+$9,25 0DNRWR .DQHNR 7DWVX\D 6KLUDL DQG 7RVKLR 7VXML 'HSDUWPHQW RI ,QGXVWULDO DQG 6\VWHPV (QJLQHHULQJ +LURVKLPD 8QLYHUVLW\ +LJDVKL^+LURVKLPD  -DSDQ

$EVWUDFW 7KURXJK JUDVS H[SHULPHQWV E\ KXPDQ DFKLHYLQJ DQ HQYHORSLQJ JUDVS IRU D VPDOO F\OLQGULFDO REMHFW SODFHG RQ D WDEOH ZH IRXQG DQ LQWHUHVWLQJ JUDVSLQJ PRWLRQ ZKHUH D KXPDQ FKDQJHV WKH nQJHU SRVWXUH IURP XSULJKW WR FXUYHG RQHV DIWHU HDFK nQJHU PDNHV FRQWDFW ZLWK WKH REMHFW 'XULQJ WKLV PRWLRQ WKH REMHFW LV DXWRPDWLFDOO\ OLIWHG XS WKURXJK HLWKHU UROOLQJ RU VOLGLQJ PRWLRQ EHWZHHQ WKH nQJHUWLS DQG WKH REMHFW $ VHULHV RI WKLV PRWLRQ LV FDOOHG DV 'HWDFKLQJ $VVLVW 0RWLRQ '$0  $Q DGYDQWDJH RI '$0 LV WKDW PRVW RI JUDVSLQJ PRWLRQV FDQ EH GRQH RQ WKH WDEOH LQVWHDG RI LQ WKH DLU 7KHUHIRUH ZH FDQ DYRLG WKH ZRUVW VFHQDULR ZKHUH WKH REMHFW IDOOV GRZQ WR WKH WDEOH :H nUVW GLVFXVV WKH EDVLF PHFKDQLVP RI '$0 E\ KXPDQ H[SHULPHQWV :H WKHQ DSSO\ WKH '$0 WR D JUDVSLQJ PRWLRQ E\ D PXOWL^nQJHUHG URERW KDQG :H VKRZ WKDW WKH '$0 FDQ EH H[SODLQHG E\ XVLQJ 6HOI^3RVWXUH &KDQJLQJ 0RWLRQ :H DOVR VKRZ VRPH VLPXODWLRQ DQG H[SHULPHQWDO UHVXOWV WR FRQnUP WKDW D VPDOO REMHFW FDQ EH JUDVSHG HDVLO\ E\ DSSO\LQJ WKH '$0

, ,QWURGXFWLRQ 0XOWL^nQJHUHG URERW KDQGV KDYH D SRWHQWLDO DGYDQWDJH WR SHUIRUP YDULRXV VNLOOIXO WDVNV OLNH KXPDQ KDQGV )RU FRQVLGHULQJ WKH JUDVS VWUDWHJ\ RI URERW KDQG KXPDQ PRWLRQ RIWHQ SURYLGHV XV ZLWK D JRRG KLQW>@^>@ &XWNRVN\>@ KDV DQDO\]HG PDQXIDFWXULQJ JULSV DQG FRUUHODWLRQ ZLWK WKH GHVLJQ RI URERW KDQGV E\ H[DPLQLQJ JUDVSV XVHG E\ KXPDQV ZRUNLQJ ZLWK WRROV DQG PHWDO SDUWV %HNH\ HW DO>@ KDYH SUHVHQWHG WKH DXWRPDWLF JUDVS SODQQHU ZKLFK JHQHUDWHV DQ RUGHU VHW RI JUDVS DFFRUGLQJ WR WDVN GHVFULSWLRQ KHXULVWLFV DQG JHRPHWU\ RI DQ REMHFW .DQJ DQG ,NHXFKL>@ KDYH SURSRVHG WKH FRQWDFW ZHE DQG WKH JUDVS FRKHVLYH LQGH[ IRU DXWRPDWLF FODVVLnFDWLRQ RI KXPDQ JUDVSLQJ 6KLPL]X HW DO>@ KDYH GHYHORSHG WKH VHQVRU JORYH 0. ,,, WKDW FDQ PHDVXUH WKH JUDVSLQJ IRUFH DQG

Initial state

Picking up

Regrasping

Final state

Initial state

Rolling up

Slipping up

Detaching Assist Motion (DAM)

(a) Enveloping motion in the air

(b) Enveloping motion on the table

)LJ  7ZR JUDVS VWUDWHJLHV HQYHORSLQJ IRU DQ REMHFW SODFHG RQ D WDEOH

Final state

LWV GLVWULEXWLRQ :KLOH WKHVH ZRUNV>@^>@ GLVFXVVHG WKH FODVVLnFDWLRQ RI HLWKHU nQDO JUDVS SDWWHUQV RU JUDVS SRVWXUHV ZH DUH SDUWLFXODUO\ LQWHUHVWHG LQ FRQVLGHULQJ WKH ZKROH JUDVSLQJ SURFHGXUH ZKHUH WKH KDQG DSSURDFKHV DQ REMHFW SODFHG RQ D WDEOH DQG nQDOO\ DFKLHYHV DQ HQYHORSLQJ JUDVS 7KURXJK WKH REVHUYDWLRQ RI KXPDQ JUDVSLQJ ZH IRXQG WKDW KXPDQ FKDQJHV KLV KHU JUDVSLQJ VWUDWHJ\ DFFRUGLQJ WR WKH VL]H RI REMHFWV HYHQ WKRXJK WKH\ KDYH VLPLODU JHRPHWU\ :H FDOOHG WKH JUDVS SODQQLQJ 6FDOH'HSHQGHQW *UDVS>@^>@ ,Q WKLV ZRUN ZH IRFXV RQ F\OLQGULFDO REMHFWV ZKRVH GLDPHWHU LV VPDOO DV VKRZQ LQ )LJ )RU VXFK REMHFWV WZR FKDUDFWHULVWLF SDWWHUQV DUH REVHUYHG 2QH LV WKDW KXPDQ nUVW SLFNV XS WKH REMHFW IURP WKH WDEOH DQG WKHQ nQDOO\ DFKLHYHV WKH WDUJHW JUDVS WKURXJK D JUDVS WUDQVLWLRQ IURP WKH nQJHUWLS WR WKH HQYHORSLQJ JUDVSV DV VKRZQ LQ )LJD  7KH RWKHU RQH LV WKDW KXPDQ nUVW DSSURDFKHV WKH REMHFW DQG WKHQ WKH nQJHU SRVWXUH LV FKDQJHG IURP XSULJKW WR FXUYHG RQHV JUDGXDOO\ DV VKRZQ LQ )LJE  ,W LV JHQHUDOO\ GLpFXOW IRU WKH URERW KDQG WR DFKLHYH WKH PRWLRQ DV VKRZQ LQ )LJD  DQG LW PD\ RIWHQ IDLO LQ FKDQJLQJ WKH SKDVH IURP nQJHUWLS WR HQYHORSLQJ JUDVSV ,I WKH URERW KDQG IDLOV LQ PDQLSXODWLQJ WKH REMHFW LQ WKH DLU WKH REMHFW ZLOO IDOO GRZQ RQ WKH WDEOH ZKLFK LV D ZRUVW VFHQDULR 2Q WKH RWKHU KDQG LQ WKH ZD\ DV VKRZQ LQ )LJE  WKH URERW KDQG FDQ PDQLSXODWH WKH REMHFW RQ WKH WDEOH 7KHUHIRUH LW LV QRW QHFHVVDU\ WR ZRUU\ DERXW IDOOLQJ GRZQ WKH REMHFW HYHQ LI WKH URERW KDQG IDLOV LQ GHWDFKLQJ WKH REMHFW IURP WKH WDEOH ,Q WKLV SDSHU ZH FDOO WKH VHULHV RI PRWLRQ DV VKRZQ LQ )LJE 'HWDFKLQJ $VVLVW 0RWLRQ '$0  7KH PRVW DWWUDFWLYH IHDWXUH RI '$0 LV WKDW LW FDQ EH DFKLHYHG E\ H[WUHPHO\ VLPSOH nQJHU PRWLRQ 7KHUHIRUH WKH '$0 LV HDVLO\ DSSOLFDEOH IRU WKH URERW KDQGV 2XU JRDO LV WR DQDO\]H WKH '$0 DQG LPSOHPHQW LW LQWR WKH JUDVSLQJ VWUDWHJ\ RI D PXOWL^nQJHUHG URERW KDQG ,, $QDO\VLV RI WKH 'HWDFKLQJ $VVLVW 0RWLRQ E\ +XPDQ $ :KDW LV 'HWDFKLQJ $VVLVW 0RWLRQ" $Q HQYHORSLQJ JUDVS FDQ EH DFKLHYHG E\ WKH IROORZLQJ WKUHH IXQGDPHQWDO WDVNV GHWDFKLQJ DQ REMHFW IURP D WDEOH OLIWLQJ LW XS WRZDUG WKH SDOP DQG nUPO\ JUDVSLQJ )RU GHWDFKLQJ WKH REMHFW ZKRVH VL]H LV ODUJHU WKDQ nQJHUWLS D KXPDQ RIWHQ XWLOL]HV WKH ZHGJH^HmHFW ZKHUH D VLPSOH SXVKLQJ PRWLRQ RI WKH ERWWRP SDUW RI REMHFW PDNHV WKH REMHFW GHWDFK IURP WKH WDEOH DV VKRZQ LQ )LJD  'XH WR LWV VLPSOH PRWLRQ SODQQLQJ ZH FDQ HDVLO\ LPSOHPHQW LW LQWR WKH JUDVSLQJ SURFHGXUH RI D PXOWL^nQJHUHG URERW KDQG (LWKHU XQGHU VLJQLnFDQW IULFWLRQ RU IRU DQ REMHFW ZLWK VPDOO GLDPHWHU ZH FDQ QRW GHWDFK WKH REMHFW VLQFH WKH nQJHU IRUFHV EDODQFH ZLWKLQ WKH REMHFW DQG GR QRW SURGXFH D OLIWLQJ IRUFH DQ\ PRUH DV VKRZQ LQ )LJE  8QGHU VXFK D VLWXDWLRQ KXPDQ GHWDFKHV VXFK D VPDOO REMHFW ZLWKRXW WKH ZHGJH^HmHFW %\ FKDQJLQJ nQJHU SRVWXUH IURP XSULJKW WR FURRNHG RQHV DV VKRZQ LQ )LJF  WKH REMHFW LV DXWRPDWLFDOO\ OLIWHG XS IURP WKH WDEOH WKURXJK HLWKHU D UROOLQJ PRWLRQ RU D VOLGLQJ PRWLRQ EHWZHHQ WKH REMHFW DQG WKH nQJHUWLS :H FDOO WKLV JUDVSLQJ PRWLRQ '$0 % $QDO\VLV RI WKH &KDQJH RI )LQJHU 3RVWXUH :K\ GRHV WKH '$0 ZRUN HmHFWLYHO\ IRU GHWDFKLQJ WKH REMHFW IURP D WDEOH" :KDW NLQG RI SULQFLSOH H[LVWV EHKLQG LW" ,Q WKLV VXEVHFWLRQ WR FODULI\ WKH EDVLF ZRUNLQJ PHFKDQLVP RI '$0 ZH H[DPLQH ERWK nQJHU SRVWXUH DQG REMHFW SRVLWLRQ ZKLOH KXPDQ SXUSRVHO\ DSSOLHV WKH '$0 DV VKRZQ LQ )LJF  7KH VHYHQ PDUNHUV DUH DWWDFKHG DW WKH VLGH RI REMHFW DQG

(a) Wedge-effect

(b) Wedge-effect is not available for a small object.

(c-1)

(c-2)

(c-3)

(c-4) (c) DAM for a small object

)LJ  *UDVSLQJ PRWLRQ E\ KXPDQ

)LJ  9LVXDO REVHUYDWLRQ GXULQJ

'$0

HDFK MRLQW RI LQGH[ nQJHU DQG WKXPE DV VKRZQ LQ )LJD  :H PHDVXUH WKH FRRUGLQDWHV RI PDUNHUV IURP WKH YLGHR LPDJH VHTXHQFHV UHFRUGHG E\ YLGHR FDPHUD V\VWHP ZKHUH WKH VDPSOLQJ WLPH LV  >VHF@ 7KH DEVROXWH DQJOH RI LQGH[ nQJHU tL SRVLWLYH IRU &&: DQG WKXPE tL SRVLWLYH IRU &:  WKH FHQWHU RI REMHFW 3 %  >3%[  3%\ @W DQG WKH URWDWLRQ RI REMHFW t% SRVLWLYH IRU &&: FDQ EH REWDLQHG IURP WKH LPDJH VHTXHQFHV )LJVE WKURXJK G VKRZ H[SHULPHQWDO UHVXOWV IRU D F\OLQGULFDO REMHFW ZLWK WKH GLDPHWHU RI >PP@ ZKLOH KXPDQ XWLOL]HV WKH '$0 IURP WKH LQLWLDO SRVWXUH )LJF WR WKH nQDO SRVWXUH )LJF  ZKHUH )LJVE F DQG G VKRZ WKH FKDQJHV RI ctL DQG ctW  WKH WUDMHFWRU\ RI 3 % DQG WKH FKDQJH RI c3%\ DQG ct%  UHVSHFWLYHO\ ctL  ctW  c3%\ DQG tL b tL  ctW tW b tW  c3%\ 3%\ b 3%\  DQG ct% t% b t%   ct% DUH ctL UHVSHFWLYHO\ ZKHUH VXEVFULSW  GHQRWHV WKH YDOXH DW LQLWLDO SRVWXUH >VHF@  )URP )LJE  LW FDQ EH VHHQ WKDW ERWK nQJHUWLSV URWDWH XQLIRUPO\ ZLWK UHVSHFW WR WLPH DQG nQDOO\ NHHS FRQVWDQW LQ SRVWXUH $Q LQWHUHVWLQJ EHKDYLRU DSSHDUV IRU WKH REMHFW PRWLRQ ZKHQ W >VHF@ 7D  $W WKH PRPHQW RI 7D  WKH REMHFW VXGGHQO\ VWDUWV WR PRYH XS ZLWK URWDWLQJ PRWLRQ DV VKRZQ LQ )LJG  ZKLOH LW VORZO\ PRYHV EHIRUH 7D  & %DVLF :RUNLQJ 0HFKDQLVP RI '$0 /HW XV GLVFXVV ZKDW LV UHDOO\ KDSSHQLQJ GXULQJ WKH '$0 E\ XVLQJ WKH nQJHUWLS PRGHO DV VKRZQ LQ )LJ :H DVVXPH WKDW WKH REMHFW LV VPDOO HQRXJK WR HQVXUH WKDW D VLPSOH SXVKLQJ

PRWLRQ LQ WKH KRUL]RQWDO GLUHFWLRQ FDQ QRW OLIW XS WKH REMHFW DV VKRZQ LQ )LJD  1RZ IRU VLPSOLI\LQJ WKH GLVFXVVLRQ OHW XV VLPSOLI\ WKH nQJHUWLS PRGHO DV VKRZQ LQ )LJE  %HIRUH 7D  ZH FDQ REVHUYH IURP YLGHR LPDJH WKDW WKH REMHFW DQG WKH nQJHUWLS NHHS WKH UROOLQJ FRQWDFW ,I ZH FDQ DVVXPH WKDW HDFK nQJHUWLS GRHV QRW VOLS RQ WKH VXUIDFH RI REMHFW ERWK nQJHUWLSV ZLOO URWDWH IURP WKH LQLWLDO WR WKH nQDO SRVWXUHV DFFRUGLQJ WR WKH JHRPHWULFDO UHVWULFWLRQ EHWZHHQ nQJHU DQG REMHFW DV VKRZQ LQ )LJE DQG F  :H FDOO WKLV SKDVH 5ROOLQJ^XS SKDVH $V WKH REMHFW LV OLIWHG XS WKH QRUPDO GLUHFWLRQ RI IULFWLRQ FRQH JUDGXDOO\ FKDQJHV XSZDUGV ZKLOH WKH FRQWDFW SRLQW PRYHV WRZDUGV WKH ERWWRP RI REMHFW )LQDOO\ WKH PRPHQW WKH FRQWDFW IRUFH LV DZD\ IURP WKH IULFWLRQ FRQH WKH REMHFW VOLSV RQ WKH VXUIDFH RI nQJHUWLSV DQG WKH ZHGJH^HmHFW RFFXUV DV VKRZQ LQ )LJG  2QFH WKH FRQWDFW IRUFH LV DZD\ IURP WKH ERXQGDU\ WKH ZHGJH^HmHFW FDQ EH FRQWLQXRXVO\ H[SHFWHG :H FDQ DOVR REVHUYH WKDW WKH nQJHUWLSV RI LQGH[ nQJHU DQG WKXPE VOLS VLPXOWDQHRXVO\ WKH PRPHQW RI 7D  7KLV LV EDVLF PHFKDQLVP ZK\ WKH REMHFW VXGGHQO\ PRYHV XSZDUGV DIWHU 7D  :H FDOO WKH nQDO SKDVH :HGJH^HmHFW SKDVH 7KHVH DUH WKH RXWOLQH RI WKH ZRUNLQJ PHFKDQLVP RI '$0 7KH SKDVH IURP 5ROOLQJ^XS WR :HGJH^HmHFW LV DXWRPDWLFDOO\ VZLWFKHG GHSHQGLQJ XSRQ WKH nQJHU URWDWLQJ PRWLRQ Friction cone Object

Finger tip 1

(a)

Finger tip 2

(b) Initial posture

(c) Rolling-up phase

(d) Wedge-effect phase

)LJ  7KH EDVLF PHFKDQLVP RI '$0

,,, $SSOLFDWLRQ IRU 5RERW +DQGV :KLOH VHYHUDO VWUDWHJLHV ZKLFK DUH HTXLYDOHQW WR WKH KXPDQ '$0 FDQ EH FRQVLGHUHG ZH XWLOL]H FRPSOLDQW PRWLRQ RI OLQN V\VWHP KDYLQJ DW OHDVW RQH FRPSOLDQW MRLQW VL WK DQG RQH SRVLWLRQ^FRQWUROOHG MRLQW SL WK DV VKRZQ LQ )LJD  1RZ VXSSRVH WKDW ZH LPSDUW DQ DUELWUDU\ DQJXODU GLVSODFHPHQW ctSL DW WKH SRVLWLRQ^FRQWUROOHG MRLQW SL IRU VXFK D OLQN V\VWHP FRQWDFWLQJ ZLWK DQ HQYLURQPHQW 8QGHU VXFK D VLWXDWLRQ WKH OLQN V\VWHP ZLOO DXWRPDWLFDOO\ FKDQJH LWV SRVWXUH ZKLOH NHHSLQJ FRQWDFW EHWZHHQ WKH HQYLURQPHQW DQG WKH OLQN V\VWHP LI ctSL LV JLYHQ DSSURSULDWHO\ 7KLV VHULHV RI PRWLRQ LV WHUPHG DV 6HOI^ 3RVWXUH &KDQJLQJ 0RWLRQ 63&0 >@ >@ 63&0 LV FRQYHQLHQWO\ XWLOL]HG IRU GHWHFWLQJ DQ DSSUR[LPDWH FRQWDFW SRLQW EHWZHHQ D OLQN V\VWHP DQG DQ XQNQRZQ REMHFW XQGHU WKH DVVXPSWLRQ WKDW WKH REMHFW GRHV QRW PRYH GXULQJ VHQVLQJ ,Q WKLV ZRUN ZH UHPRYH WKLV DVVXPSWLRQ DQG DOORZ WKH REMHFW WR PRYH DFFRUGLQJ WR WKH FRQWDFW IRUFH LPSDUWHG E\ WKH OLQN DV VKRZQ LQ )LJE  :H H[SUHVV WKH VHULHV RI PRWLRQV DV 63 &0 I. t ctS J ZKHUH . t GLDJ>Nt      NtQ @W  5Qd Q DQG ctS >ctS      ctSQ @W  5Qd GHQRWH WKH VWLmQHVV PDWUL[ RI FRPSOLDQW FRQWUROOHG MRLQWV DQG WKH DQJXODU GLVSODFHPHQW PDWUL[ RI SRVLWLRQ FRQWUROOHG MRLQWV UHVSHFWLYHO\ ,Q 63&0 KL WK OLQN NHHSV PDNLQJ FRQWDFW ZLWK WKH REMHFW GXULQJ WKH FKDQJH RI nQJHU SRVWXUH )URP WKH EDVLF EHKDYLRU ZH FDQ VHH WKDW LW LV DOPRVW HTXLYDOHQW WR WKH '$0 E\ KXPDQ 1RZ ZH GLVFXVV WKH FRQGLWLRQ WKDW WKH URERW KDQG FDQ OLIW XS WKH REMHFW E\ XWLOL]LQJ WKH

Finger i

Dq si

Compliant Joiont si

Position controlled Joint pi

Joint Si

K qi

Dq si t si

Joint pi Unknown Object

Dq pi

Dq pi hi th link

(a)

(b) )LJ  6HOI3RVWXUH &KDQJLQJ 0RWLRQ

63&0 6XSSRVH WKDW WKH URERW KDQG XWLOL]HV 63 &0 I. t ctS J IRU WKH REMHFW ZKRVH PDVV LV P%  /HW I F >I WF      I WFQ @W  5Qd  DQG : H[W  5d  EH WKH FRQWDFW IRUFH YHFWRU DW HDFK FRQWDFW SRLQW DQG WKH ORDG ZUHQFK UHVSHFWLYHO\ 7KH HTXDWLRQ RI WKH IRUFH DQG WKH PRPHQW EDODQFLQJ RQ WKH REMHFW FDQ EH H[SUHVVHG DV : H[W

b*W I F 

ZKHUH *W  5d Q LV WKH JUDVS PDWUL[ DQG JLYHQ E\   , ccc , W *  5% % 3 &%  d ccc 5% % 3 &%Q d



6XSSRVH WKDW WKH ORDG ZUHQFK LV : H[W >  bP% J  IH]    @W  ZKHUH J DQG IH] DUH WKH DFFHOHUDWLRQ RI JUDYLW\ DQG WKH YLUWXDO IRUFH LQ WKH JUDYLWDWLRQDO GLUHFWLRQ DW WKH FHQWHU RI JUDYLW\ RI REMHFW UHVSHFWLYHO\ $Q\ FRPSRQHQW RI I F FDQ QRW H[LVW RXWVLGH RI WKH IULFWLRQ FRQH DW HDFK FRQWDFW SRLQW ,I DOO FRPSRQHQWV RI I F H[LVW LQVLGH RI WKH IULFWLRQ FRQH ZLWK IH]  WKH REMHFW GRHV QRW PRYH VLQFH WKH UHVXOWDQW IRUFH DFWLQJ RQ WKH REMHFW EDODQFHV ,I WKH UHVXOWDQW IRUFH GRHV QRW EDODQFH ZLWKRXW SXVKLQJ GRZQ WRZDUGV JUDYLWDWLRQDO GLUHFWLRQ IH] !   WKH REMHFW LV QHFHVVDULO\ OLIWHG XS IURP WKH WDEOH ZKHQ VXFK D YLUWXDO H[WHUQDO IRUFH IH] LV UHPRYHG %DVHG RQ WKLV FRQVLGHUDWLRQ ZH GLVFXVV IROORZLQJ LVVXH >3UREOHP IRUPXODWLRQ@ 6HDUFK 63 &0I. t ctS J ZKHUH WKH FRQWDFW IRUFH I F EDODQFHV ZLWK : H[W E\ XWLOL]LQJ D YLUWXDO H[WHUQDO IRUFH IH] w  /HW ~V >~V     ~VQ @W  5Qd EH WKH WRUTXH DW FRPSOLDQW MRLQWV $OO FRPSOLDQW MRLQWV URWDWH ctV DFFRUGLQJ WR WKH DQJXODU GLVSODFHPHQW ctS XQGHU WKH DVVXPSWLRQ WKDW WKH REMHFW GRHV QRW PRYH E\ 63 &0 I. t ctS J 8QGHU 63 &0 I. t ctS J WRUTXH LQ FRPSOLDQW MRLQWV LV JLYHQ ~V b. tctV  ~ELDV  ZKHUH ZH DVVXPH ~V  LQLWLDOO\ 7KH UHODWLRQVKLS EHWZHHQ I F DQG ~V LV H[SUHVVHG DV IROORZV ~V

- WI F



ZKHUH - W  5Qd Q GHQRWHV WKH -DFRELDQ PDWUL[ PDSSLQJ IURP I F WR ~V  7KHUHIRUH WKH UHODWLRQVKLS DPRQJ I F  : H[W DQG ~V FDQ EH H[SUHVVHG DV HT      : H[W b*W IF  ~V -W

Object

Finger i

d qsi S

fC i KPi pC B i

t

G dx

-L i KPi dPi

SB

pCFi

a - K Pi dPi

J dq q

nCFi

dx

SB

pCFi

Wext

f

e ci

SR fti

(a) Relationship between displacement and restoring force

)LJ 

(b) Contact force outside of friction cone

1RWDWLRQ RI SDUDPHWHUV

%LFFKL>@ >@ =KDQJ *DR DQG *UXYHU>@ 2PDWD DQG 1DJDWD>@ SRLQWHG RXW WKDW HT FRQWDLQV WKH LQGHWHUPLQDWH FRQWDFW IRUFH ZKLFK QHLWKHU DmHFWV ~V QRU DSSHDUV LQ : H[W  7R FRSH ZLWK WKLV SUREOHP ZH DVVXPH DQ H[WUHPHO\ VPDOO FRPSOLDQFH DW HDFK FRQWDFW SRLQW EHWZHHQ HDFK nQJHU DQG WKH REMHFW 7KLV DVVXPSWLRQ UHOHDVHV XV IURP VXFK DQ LQGHWHUPLQDWH FRQWDFW IRUFH VLQFH WKH FRQWDFW IRUFH I F LV XQLTXHO\ GHWHUPLQHG XQGHU WKH GLDJ>. 3       . 3 Q @  5Qd Q DW WKH FRQWDFW SRLQW DV VKRZQ FRQWDFW VWLmQHVV . 3 LQ )LJD  ZKHUH . 3L GLDJ>N3[L  N3 \L  N3]L @  5d   :H DVVXPH WKH GLVSODFHPHQW p[  5d  DQG ptV  5Qd  XQGHU ZH[W  ZKHUH p[ DQG ptV GHQRWH WKH YHFWRU H[SUHVVLQJ WKH GLVSODFHPHQW DQG WKH URWDWLRQ RI REMHFW DQG WKH DQJXODU GLVSODFHPHQW RI FRPSOLDQW MRLQWV 1RZ WKH UHODWLRQVKLS DPRQJ GLVSODFHPHQW YHFWRUV p3  p[ DQG ptV LV JLYHQ E\ p3

*p[ b -ptV 



ZKHUH p3 >p3 W      p3 WQ @W DQG p3 L  5d  LV WKH SRVLWLRQ YHFWRU IURP 3 &) L WR 3 &%L  7KH UHODWLRQVKLS DPRQJ I F  p3  ptV DQG ~V FDQ EH H[SUHVVHG DV IROORZV IF ~V

b. 3 p3 



~ELDV b . tptV 



)URP HTV       DQG   ZH GHULYH WKH FRQWDFW IRUFH YHFWRU I F LQ WKH IROORZLQJ I F b. 3 H**W . 3 H * b  : H[W  *W I ELDV  I ELDV   ZKHUH . 3H

 W . 3 , b -. b tH - . 3  . tH

. t  - W . 3 - DQG I ELDV

 . 3 -. b tH ~ELDV 

+RZHYHU LW GRHV QRW JXDUDQWHH ZKHWKHU HDFK FRQWDFW IRUFH I FL REWDLQHG IURP HT H[LVWV ZLWKLQ WKH IULFWLRQ FRQH RU QRW %HFDXVH HT GRHV QRW FRQWDLQ DQ\ FRQVWUDLQW ZLWK UHVSHFW WR WKH IULFWLRQ FRQH 1RZ VXSSRVH WKDW I FL LV FRPSXWHG RXWVLGH RI WKH IULFWLRQ FRQH DV VKRZQ LQ )LJE  6LQFH DFWXDO I FL QHYHU H[LVWV RXWVLGH RI WKH IULFWLRQ FRQH I FL DV VKRZQ LQ )LJE LPSOLHV D ORFDO VOLS DW WKH FRQWDFW SRLQW 7KLV PHDQV WKDW I FL H[LVWV RQ WKH IULFWLRQ ERXQGDU\ %DVHG RQ WKLV ZH FKDQJH WKH RULHQWDWLRQ RI I FL LQWR WKH QHDUHVW IULFWLRQ ERXQGDU\ ZKHUH WKH GLUHFWLRQ HFL LV JLYHQ E\ HFL FRV mQ&)L  VLQ m MMI WL MM I WL  ZKHUH I WL I FL b QW&)L I FL Q&)L  )RU UHVWULFWLQJ WKH GLUHFWLRQ RI UHVWRULQJ IRUFH b. 3L p3 L WRZDUGV WKH GLUHFWLRQ RI HFL  ZH LQWURGXFH WKH OLQHDU WUDQVIRUPDWLRQ PDWUL[ /L  5d 

z

120[deg] R = 0.1 [m]

120[deg]

y Joint s

120[deg]

x

0.1 [m] Locked joint

0.1 [m] Joint p

105 [deg] + 1 [deg]

0.1 [m]

radius = 0.02 [m] mass

= 0.01 [kg]

(a-1) Simulation model

(b-1) Initial posture

(c-1) Initial posture

(c-2) Changing posture

(b-2) Pushing an object

(c-3) Slipping up

(c-4) Enveloping

Stiffness Kθi [Nm/deg]

0.7 0.6 0.5 Lifting

0.4

up

0.3 0.2 0.1 0 0

5 10 Angular displacement ∆θ pi [deg]

15

(a-2) Relationship between K θ i and

∆ θpi

(a) Simulation result

(b) Appling a simple pushing motion

(c) Appling SPCM

)LJ  6LPXODWLRQ DQG H[SHULPHQWDO UHVXOWV

GHnQHG E\ /L HFL HWFL  2Q WKH RWKHU KDQG /M IULFWLRQ FRQH )URP HT  ZH FDQ REWDLQ IA F

GLDJ>  @ ZKHQ I FM H[LVWV ZLWKLQ WKH

b/. 3 p3 



ZKHUH / GLDJ>/      /Q @  5Qd Q  DQG Ae GHQRWHV WKH YDOXH ZKHQ FRQWDFW IRUFH LV SURMHFWHG RQ WKH IULFWLRQ ERXQGDU\ )URP HTV       DQG   WKH FRQWDFW IRUFH YHFWRU IA F FDQ EH REWDLQHG DV IROORZV IA F

A 3 H**W . A 3 H * b  : H[W  *W IA ELDV  IA ELDV  b. b

 b

W W A A A A ZKHUH . 3 H /. 3 , b - . tH . t  - /. 3 -  DQG IA ELDV /. 3 - . tH - /. 3  . tH ~ELDV  %\ XVLQJ WKHVH HTXDWLRQV ZH FDQ MXGJH ZKHWKHU WKH URERW KDQG FDQ OLIW XS WKH REMHFW E\ XWLOL]LQJ 63 &0I. t ctS J RU QRW

)LJD VKRZV D VLPXODWLRQ UHVXOW IRU D WKUHH^nQJHUHG URERW KDQG ZKHUH HDFK nQJHU KDV WKUHH MRLQWV (DFK nQJHU FRQVLVWV RI WKH FRPSOLDQW FRQWUROOHG ORFNHG DQG SRVLWLRQ^ FRQWUROOHG MRLQW 7KH REMHFW LV WKH VSKHUH ZKRVH PDVV LV P% >NJ@ UDGLXV LV >P@ DQG WKH IULFWLRQ DQJOH m >GHJ@ )LJD VKRZV WKH NtL ^ctSL PDS ZKHUH WKH URERW KDQG FDQ OLIW XS WKH REMHFW E\ 63 &0 I. t ctS J ,Q RXU VLPXODWLRQ ZH VHW Nt Nt Nt Nt ctS ctS ctS ctS  DQG . 3L GLDJ>N3  N3  N3 @ ZKHUH N3 >1 PP@ IRU VLPSOLFLW\ :KHQ WKH VKDSH WKH PDVV RI REMHFW DQG WKH IULFWLRQ FRHpFLHQW DUH JLYHQ ZH FDQ URXJKO\ GHVLJQ WKH MRLQW FRPSOLDQFH ZLWK UHVSHFW WR ctSL E\ XVLQJ WKLV JUDSK ,9 ([SHULPHQWDO 5HVXOWV :H LPSOHPHQW WKH 63&0 LQWR WKH JUDVSLQJ SURFHGXUH DQG H[HFXWH WKH JUDVSLQJ H[SHULPHQW IRU DQ REMHFW SODFHG RQ D WDEOH 7KH URERW KDQG FRQVLVWV RI WKUHH nQJHU XQLWV DQG HDFK

nQJHU KDV WKUHH OLQNV 7KH OHQJWK RI HDFK OLQN LV >PP@ >PP@ DQG >PP@ LQ RUGHU IURP WKH EDVH UHVSHFWLYHO\ DQG WKH UDGLXV RI HDFK nQJHUWLS LV DERXW >PP@ )LJVE DQG F VKRZ WKH H[SHULPHQWDO UHVXOWV ZKHUH WKH URERW KDQG XWLOL]HV WKH ZHGJH^ HmHFW LQ )LJE DQG WKH 63&0 IRU GHWDFKLQJ D F\OLQGULFDO REMHFW IURP WKH WDEOH LQ )LJF  7KH URERW KDQG JUDVSV WKH F\OLQGULFDO REMHFW €>PP@ FRYHUHG ZLWK UXEEHU VKHHW LQ RUGHU WR LQFUHDVH WKH VXUIDFH IULFWLRQ 7KH URERW KDQG FDQ QRW OLIW XS WKH REMHFW E\ XWLOL]LQJ WKH ZHGJH^HmHFW DV VKRZQ LQ )LJE VLQFH WKH FRQWDFW IRUFHV EDODQFH ZLWKLQ WKH REMHFW 2Q WKH RWKHU KDQG LW FDQ OLIW XS HDVLO\ WKH REMHFW E\ XWLOL]LQJ WKH 63&0 DV VKRZQ LQ )LJF  (DFK nQJHU FRQVLVWV RI FRPSOLDQW FRQWUROOHG ORFNHG DQG SRVLWLRQ^ FRQWUROOHG MRLQW $V HDFK SRVLWLRQ^FRQWUROOHG MRLQW URWDWHV IURP >GHJ@ WR >GHJ@ WKH URERW KDQG OLIWV XS WKH REMHFW IURP WKH WDEOH 5ROOLQJ^XS SKDVH DV VKRZQ LQ )LJF  )LQDOO\ WKH FRQWDFW FRQGLWLRQ EHWZHHQ WKH nQJHU OLQN DQG WKH REMHFW UHVXOWV LQ VOLGLQJ FRQWDFW :HGJH^HmHFW SKDVH DV VKRZQ LQ )LJF  $IWHU HYHU\ nQJHU^WLS OLQN URWDWHV >GHJ@ WKH FRQVWDQW WRUTXH FRQWURO LV DSSOLHG IRU DFKLHYLQJ DQ HQYHORSLQJ JUDVS DV VKRZQ LQ )LJF  9 &RQFOXVLRQ :H QHZO\ IRXQG WKH '$0 WKURXJK WKH REVHUYDWLRQ RI KXPDQ JUDVSLQJ PRWLRQ :H DQD O\]HG WKH nQJHU SRVWXUH GXULQJ WKH '$0 DQG H[SODLQHG WKH EDVLF ZRUNLQJ PHFKDQLVP RI WKH '$0 :H DOVR H[DPLQHG WKH FRQGLWLRQ OHDGLQJ WR WKH '$0 E\ XVLQJ 63&0 ZKLFK LV HDVLO\ LPSOHPHQWHG IRU URERW KDQG DQG HTXLYDOHQW WR WKH '$0 :H DOVR LPSOHPHQWHG WKH 63&0 LQWR WKH JUDVS SURFHGXUH RI D PXOWL^nQJHUHG URERW KDQG DQG YHULnHG LWV HmHFWLYH QHVV H[SHULPHQWDOO\ 7KLV ZRUN KDV EHHQ VXSSRUWHG E\ &5(67 RI -67 -DSDQ 6FLHQFH DQG 7HFKQRORJ\  5HIHUHQFHV >@ 0 &XWNRVN\ ?2Q *UDVS &KRLFH *UDVS 0RGHOV DQG WKH 'HVLJQ RI +DQGV IRU 0DQXIDFWXULQJ 7DVNV ,((( 7UDQV RQ 5RERWLFV DQG $XWRPDWLRQ 9RO  1R  -81( SS ^  >@ *$ %HNH\ + /LX 5 7RPRYLF DQG : .DUSOXV ?.QRZOHGJH%DVHG &RQWURO RI *UDVSLQJ LQ 5RERW +DQGV 8VLQJ KHXULVWLFV IURP KXPDQ PRWRU VNLOOV ,((( 7UDQV RQ 5RERWLFV DQG $XWRPDWLRQ 9RO  1R  '( &(0%(5 SS ^  >@ 6% .DQJ DQG . ,NHXFKL ?7RZDUG $XWRPDWLF 5RERW ,QVWUXFWLRQ IURP 3HUFHSWLRQ_5HFRJQL]LQJ D *UDVS IURP 2EVHUYDWLRQ ,((( 7UDQV RQ 5RERWLFV DQG $XWRPDWLRQ 9RO  1R  $8*867 SS ^  >@ 6 6KLPL]X 0 6KLPRMR 6 6DWR @ $ %LFFKL ?$QDO\VLV DQG &RQWURO RI 3RZHU *UDVSLQJ 3URF RI ,(((56- ,QW :RUNVKRS RQ ,QWHOOLJHQW 5RERWV DQG 6\VWHPV ,526  SS ^  >@ $ %LFFKL ?)RUFH 'LVWULEXWLRQ LQ 0XOWLSOH :KROH/LPE 0DQLSXODWLRQ 3URF RI WKH ,((( ,QW &RQI RQ 5RERWLFV DQG $XWRPDWLRQ SS ^  >@ @ 0 .DQHNR DQG . +RQNDZD ?&RQWDFW 3RLQW DQG )RUFH 6HQVLQJ IRU ,QQHU /LQN %DVHG *UDVSV 3URF RI WKH ,((( ,QW &RQI RQ 5RERWLFV DQG $XWRPDWLRQ SS ^