Fully Autonomous Calibration of Parallel Manipulators by imposing ...

Proceedings of the 2001 IEEE International Conference on Robotics & Automation Seoul, Korea • May 21-26, 2001

)XOO\$XWRQRPRXV&DOLEUDWLRQRI3DUDOOHO0DQLSXODWRUVE\,PSRVLQJ3RVLWLRQ &RQVWUDLQW $%'8/5$8)DQG-(+$5@ HPSOR\HG /9'7 VHQVRUV /DVHU GLVSODFHPHQWVHQVRUVZHUHXVHGWRFDOLEUDWHDGHOWDW\SH SDUDOOHO URERW E\ 0DXULQH DQG 'RPEUH>@ :LWK SDUWLDO SRVH LQIRUPDWLRQ WKH FRQFHSW SUHVHQWHG E\ *RVZDPL HW DO>@LQFRQWH[WRIVHULDO PDQLSXODWRUVFDQEHDSSOLHGIRU SDUDOOHO PDQLSXODWRUV DV ZHOO %HVQDUG DQG NKDOLO >@ VWXGLHG FDOLEUDWLRQ RI SDUDOOHO PDQLSXODWRUV XVLQJ WZR LQFOLQRPHWHUV $FTXLULQJ GDWD ZLWK H[WHUQDO VHQVLQJ KRZHYHU LV GLIILFXOW DQG H[SHQVLYH 6SHFLDO SXUSRVH FDOLEUDWLRQ HTXLSPHQW DQG FRPSOH[ VHW XS LV UHTXLUHG HYHU\WLPHIRUFDOLEUDWLRQ

0-7803-6475-9/01/$10.00© 2001 IEEE

(PDLOU\X#NMLVWDFNU

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

2389

D QXPEHU RI RULHQWDWLRQV XQGHU WKH SRLQW FRQVWUDLQW ZKLOH DFWXDWRU YDOXHV EHLQJ VWRUHG IRU HDFK RULHQWDWLRQWKHGDWD FDQ EH XVHG WR ILQG RXW DFWXDO YDOXHV RI JHRPHWULF SDUDPHWHUV(YHQWKRXJKWKHLGHDRIVLQJOHSRLQWFRQVWUDLQW IRU FDOLEUDWLRQ KDG EHHQ SUHVHQWHG IRU VHULDO PDQLSXODWRUV >@DSSOLFDWLRQ WR SDUDOOHO PDQLSXODWRUV UHTXLUH GLIIHUHQW IRUPXODWLRQ DQG FDOLEUDWLRQ SURFHGXUH 7KLV SDSHU LQYHVWLJDWHV WZR FDOLEUDWLRQ SURFHGXUHV LQYHUVH DQG IRUZDUG NLQHPDWLF FDOLEUDWLRQ SURFHGXUHV 7KHVH VFKHPHV KDYH EHHQ DSSOLHG WR D  '2) IXOO\ SDUDOOHO +H[D 6OLGH PDQLSXODWRU ZLWK IL[HG OLQNV RQ PRYLQJ VOLGHUV 7KH WHFKQLTXH KRZHYHU LV JHQHUDO DQG FDQ EH XVHG IRU RWKHU SDUDOOHODUFKLWHFWXUHV6LPXODWLRQVKDYHEHHQSHUIRUPHGWR VKRZYDOLGLW\DQGHIIHFWLYHQHVVRIWKHSURSRVHGVFKHPH 7KLVSDSHULVRUJDQL]HGDVIROORZV6HFWLRQGHVFULEHV WKH +H[D 6OLGH PHFKDQLVP XQGHU FRQVLGHUDWLRQ .LQHPDWLFV LV SUHVHQWHG LQ VHFWLRQ  DQG WKH FDOLEUDWLRQ VFKHPH LV GLVFXVVHG LQ VHFWLRQ  6LPXODWLRQ UHVXOWV DUH VKRZQDQGGLVFXVVHG LQ6HFWLRQ /DVWO\VHFWLRQ  PDGH FRQFOXVLRQVDQGGLVFXVVHGIXWXUHVWXGLHV

'HVFULSWLRQRI0HFKDQLVP

7KH VFKHPDWLF RI WKH +H[DVOLGH PHFKDQLVP LV VKRZQ LQ ILJXUHDQGGHWDLOVRIHDFKNLQHPDWLFFKDLQLQILJXUH,W LVD'2)GHJUHHRIIUHHGRP IXOO\SDUDOOHOPDQLSXODWRURI 3556W\SH

=

$ 

2

;$



$ $

$


S[ S\ S]@7 LV WKH SRVLWLRQ YHFWRU RI WKH ORFNLQJ SRLQW WKH SRVLWLRQ GLIIHUHQFHYHFWRU FDQEHIRUPXODWHGDV

&)

>S



 S   ˜ ˜˜ S   S U  S   S   ˜ ˜˜ S U   S U

@

ZKHUH WKH VXSHUVFULSW U LV WKHLQGH[ IRU RULHQWDWLRQV 1RWH WKDWWKHSRVLWLRQRIWKHORFNHGSRLQWQHHGV QRWWREHNQRZQ H[DFWO\ %HQHILW RI WKLV FRVW IXQFWLRQ LV WKDW WKH SRVLWLRQ YHFWRU RI WKH ORFNLQJ SRLQW QHHGV QRW WR EH DGGHG DV LGHQWLILFDWLRQ SDUDPHWHUV 7KLV W\SH RI FRVW IXQFWLRQ KDV EHHQXVHGE\.KDOLO DQG%HVQDUG >@DQG0DXULQH HWDO>@ LQ ORFNLQJ SDVVLYH MRLQWV )RU PHDVXUHPHQW GDWD WKH PDQLSXODWRU FDQ EH PRYHG WR DW GLIIHUHQW RULHQWDWLRQV PDQXDOO\ RU DXWRPDWLFDOO\ WKURXJK VRPH H[WHUQDO GHYLFH DQG DFWXDWRU OHQJWKV DUH UHFRUGHG $OWHUQDWLYHO\ DQ\ RI WKUHH DFWXDWRUV FDQ EH PDGH SDVVLYH ZKLOH WKHRWKHU WKUHH DUH FRPPDQGHG FHUWDLQ YDOXHV DQG WKHQ WKH PHDVXUHPHQW GDWDRIDOOVL[DFWXDWRUVLVVWRUHGDIWHUWKHFRQWUROWROHUDQFH LV VDWLVILHG 2SWLPL]DWLRQ LV WKHQ SHUIRUPHG XVLQJ DQ RSWLPL]DWLRQ DOJRULWKP VXFK DV /HYHQEHUJ0DUTXDUGW PHWKRG )RUZDUGNLQHPDWLFVLVFDOFXODWHGVHYHUDOWLPHV IRU HDFKHYDOXDWLRQRIFRVWIXQFWLRQDQGWKXVLWPD\WDNHORQJ WLPH

 6LPXODWLRQV DQG5HVXOWV

,QRUGHUWRVKRZYDOLGLW\DQGHIIHFWLYHQHVVRIWKHSURSRVHG FDOLEUDWLRQ VFKHPH FRPSXWHU VLPXODWLRQV KDYH EHHQ SHUIRUPHG )RU VLPXODWLRQV WZR VHWV RI JHRPHWULFDO SDUDPHWHUV DUH XVHG )LUVW VHW LV WKH H[DFW JHRPHWULF SDUDPHWHUV DQG LV XVHG IRU JHQHUDWLQJ H[DFW PHDVXUHPHQW GDWD DQG WKH VHFRQG VHW LV XVHG DV QRPLQDO JHRPHWULF SDUDPHWHUV WKDW VKRXOG EH FDOLEUDWHG E\ WKH SURSRVHG VFKHPH :LWK LWHUDWLRQV RI DOJRULWKP WKH VHFRQG VHW VKRXOGFRQYHUJHWRWKHILUVWRQHWKHUHE\UHGXFLQJWKHYDOXH RI FRVW IXQFWLRQ (YDOXDWLRQ FULWHULRQ LV WKH DFFXUDF\ RI SRVLWLRQ DQG RULHQWDWLRQ RI HQGHIIHFWRU $V WKLV DFFXUDF\ YDULHV RYHU WKH ZRUNVSDFHDYHUDJH YDOXHV RI QRUPV IRU D V\PPHWULFDO ZRUN YROXPH RI [[P DURXQG D FHQWHU SRVLWLRQ RI HQGHIIHFWRU DUH SUHVHQWHG ,Q DGGLWLRQ VLPXODWLRQV KDYH EHHQ SHUIRUPHG ZLWK DQG ZLWKRXW FRQVLGHUDWLRQ RI WKH HIIHFWV RI GLIIHUHQW OHYHOV RI PHDVXUHPHQW QRLVHV /RFNLQJ SRLQW IRU VLPXODWLRQV LV FKRVHQ LQ WKH DSSUR[LPDWH FHQWHU RI ZRUNVSDFH DQG LV GHILQHG E\ WKH YHFWRU >  ±@7 2ULHQWDWLRQ UDQJHV IRUDOOWKUHH(XOHUDQJOHVKDYHEHHQ r R 7DEOH  VKRZV WKH LQLWLDO HUURUV LQ SRVLWLRQ DQG RULHQWDWLRQDVZHOODVLQWKHLGHQWLILFDWLRQSDUDPHWHUV1RWH WKDW OLQHDU GLPHQVLRQV DUH H[SUHVVHG LQ PHWHUV DQG WKH DQJXODU GLPHQVLRQV LQ UDGLDQV $V VKRZQ LQ 7DEOH 

ZLWKRXWDQ\QRLVHVWKH,.FDOLEUDWLRQSURFHGXUHFRQYHUJHV HUURU WR SUDFWLFDOO\ ]HUR 7DEOHV  DQG  VKRZ WKH UHVXOWV ZLWK ,. FDOLEUDWLRQ DOJRULWKP FRQVLGHULQJ UDQGRP QRLVHV RI  PP DQG  PP UHVSHFWLYHO\ LQ DUWLFXODU YDULDEOH PHDVXUHPHQWGDWD 3RVLWLRQ &KDLQ

" E[ E\ E] D[ D\ D] D E



&KDLQ







(





(

(

(

(

(

(

(

(

(

(

(

(

( (

( ( ( ( (

3RVLWLRQ " E[ E\ E] D[ D\ D] D E

7DEOH ,QLWLDO(UURUV ( 2ULHQWDWLRQ



( ( ( (

( (

(

( (

( (

( ( (

( ( ( ( (

( (

( ( ( ( ( (

(

( ( (

( ( ( (

7DEOH(UURUVZLWKRXWQRLVHV ( 2ULHQWDWLRQ ( 









(

(

(

(

(

(

(

(

(



(

(

( 

( (

( (

(

( ( (

( ( (

(

( ( ( ( (

( (

( 

( ( ( (

(

( (

( ( (

( (

(

( ( ( ( ( (

7DEOH(UURUVZLWK0HDVXUHPHQW1RLVH ( PP

3RVLWLRQ &KDLQ

" E[ E\ E] D[ D\ D] D E

 (

(

(

 (

(

(

(

(

(

(

(

(

(

(

(

(

(

(

(

(

 (

(

( (

2ULHQWDWLRQ

 (

(

(

(

(

( (

(

(

(

(

(

(

(

(

 (

(

(

(

(

 (

(

(

( ( ( (

(

(

(

(

(

7DEOH(UURUVZLWK0HDVXUHPHQW1RLVH ( PP

3RVLWLRQ &KDLQ

" E[ E\ E] $[ D\ D] D E

2393

 (

(

(

 (

 (

(

(

(

(

(

(

(

(

(

(

(

(

 (

(

( (

 (

(

(

(

(

 (

(

( (

2ULHQWDWLRQ (

(

(

(

(

(

(

(

(

( (

(

(

(

(

(

(

(

(

(

( (

( ( (

(

5HVXOWVVKRZ WKDWHUURULQSRVLWLRQDQGRULHQWDWLRQ KDV WKH VDPH RUGHU DV WKDW RI WKH QRLVH UHIOHFWLQJ WKDW WKH DFFXUDF\RIFDOLEUDWLRQGHSHQGVRQWKHDFFXUDF\RIVHQVRUV ,WKDVEHHQREVHUYHGWKDWWKH,GHQWLILFDWLRQ-DFRELDQLV YHU\VHQVLWLYHWRWKHUDQJHRIRULHQWDWLRQZRUNVSDFHDWWKH ORFNHG SRLQW )RU VPDOO UDQJH RI RULHQWDWLRQ ZRUNVSDFH FRQGLWLRQ QXPEHU RI WKH ,GHQWLILFDWLRQ -DFRELDQ KDV KLJK YDOXHV UHVXOWLQJ LQ ODUJHU HUURUV 3K\VLFDOO\ WKLV PHDQV PHDVXUHPHQWGDWDVKRXOGEHFROOHFWHGRYHUODUJHUDQJHRI RULHQWDWLRQ ZRUNVSDFH RU LQ WKH RWKHU ZRUGV HQGHIIHFWRU VKRXOG EH ORFNHG LQ WKH UHJLRQ RI PD[LPXP RULHQWDWLRQ ZRUNVSDFH

 &RQFOXVLRQVDQG)XWXUH6WXGLHV

%DVHGRQVLQJOHSRLQWFRQVWUDLQWRIWKHPRELOHSODWIRUPD IXOO\ DXWRQRPRXV FDOLEUDWLRQ WHFKQLTXH LV SUHVHQWHG IRU D '2) IXOO\ SDUDOOHO +H[D VOLGH PDQLSXODWRU 7ZR FDOLEUDWLRQSURFHGXUHVKDYHEHHQVWXGLHGEDVHGRQLQYHUVH NLQHPDWLFV DQG IRUZDUG NLQHPDWLFV %HQHILWV RI WKH SURSRVHG FDOLEUDWLRQ WHFKQLTXH LQFOXGH YHU\ HDV\ LQVWDOODWLRQ RI ORFNLQJ GHYLFH DQG V\PPHWULFDO ORDGLQJ XQOLNH WKDW RI MRLQW ORFNLQJ WKDW PD\ UHVXOW LQ ODUJH GHIOHFWLRQVRIVWUXFWXUDOPHPEHUV $OVRWKHORFNLQJGHYLFH QHHGV QRWWREHGHVLJQHGIRUDVSHFLILFPDQLSXODWRU5DWKHU WKHVDPHGHYLFHFDQEHXVHGIRUGLIIHUHQWFRQILJXUDWLRQVRI SDUDOOHOPHFKDQLVPV )XWXUH LQYHVWLJDWLRQV ZLOO LQFOXGH VHOHFWLRQ RI PHDVXUHPHQWFRQILJXUDWLRQVWKDWFDQJLYHEHVWFRQGLWLRQRI WKH ,GHQWLILFDWLRQ -DFRELDQ ). FDOLEUDWLRQ UHVXOWV DQG H[SHULPHQWDOYDOLGDWLRQ

5HIHUHQFHV      

=KXDQJ +