Performance Evaluation of the Grid-based FastSLAM ...



3HUIRUPDQFH(YDOXDWLRQRIWKH*ULGEDVHG)DVW6/$0 LQ95(38VLQJ0$7/$% 6DOLP$]DN

(UD\(UGRJDQ

'HSDUWPHQWRI&LYLO(QJLQHHULQJ 0LGGOH(DVW7HFKQLFDO8QLYHUVLW\ $QNDUD7XUNH\ 'HSDUWPHQWRI(OHFWULFDO(OHFWURQLF(QJLQHHULQJ 6HOFXN8QLYHUVLW\ .RQ\D7XUNH\ VDOLPD]DN#LHHHRUJ

'HSDUWPHQWRI(OHFWULFDO(OHFWURQLF(QJLQHHULQJ 0LGGOH(DVW7HFKQLFDO8QLYHUVLW\ $QNDUD7XUNH\ HUD\HUGRJDQHHH#JPDLOFRP

Abstract² 7KLV SDSHU SUHVHQWV D 6LPXOWDQHRXV /RFDOL]DWLRQ DQG 0DSSLQJ 6/$0  DSSOLFDWLRQ WKDW LV GHYHORSHG LQ 95(3 URERW VLPXODWLRQ SURJUDP E\ XVLQJ *ULG%DVHG )DVW6/$0 PHWKRG ,QWKLVZRUN WKH6/$0SUREOHPLQDQXQNQRZQLQGRRU HQYLURQPHQW LV VROYHG ZLWK WKH 3LRQHHU  '; PRELOH URERW HTXLSSHGZLWKDODVHUUDQJHILQGHU&RQWUROVFULSWVDUHGHYHORSHG LQWKH/XDDQG)DVW6/$0VFULSWVXVLQJ0$7/$%WKDWLVOLQNHGWR WKHVLPXODWLRQSODWIRUPE\PHDQVRI WKH5HPRWH$3,IHDWXUHRIWKH 95(3,QRUGHUWRHYDOXDWHRIWKHSHUIRUPDQFHRIWKH)DVW6/$0 DQXPEHURI WHVWVKDYHEHHQFRQGXFWHG(IIHFWVRIWKHFKDQJLQJRI SDUWLFOH QXPEHUV FKDQJLQJ LQ WKH HUURU GXH WR VWHHS WXUQ FKDQJLQJRIWKHQXPEHURIVHQVRUEHDPFSXWLPHIRUWKHLWHUDWLRQV DQGWKHPDSHUURUGXHWRZRUNLQJWLPHDUHDQDO\]HGLQGHWDLO Keywords— FastSLAM; SLAM; v-rep; grid-based; localization; mapping

, ,1752'8&7,21 6LPXOWDQHRXV/RFDOL]DWLRQDQG0DSSLQJ6/$0 LVRQHRI WKHHVVHQWLDO SUREOHPV RIDXWRQRPRXVQDYLJDWLRQ 0RELOHURERWV PRYLQJLQXQNQRZQHQYLURQPHQWVZLWKRXWDQ\SULRUNQRZOHGJH WU\ WR EXLOG WKH PDS RI WKHLU HQYLURQPHQW DFFXUDWHO\ ZKLOH HVWLPDWLQJWKHLUORFDWLRQ RQWKHPDS LQRUGHUWRQDYLJDWHVDIHO\ ,QWKH6/$0SUREOHPDOOWKDW LVJLYHQDUHSDUWLDOPHDVXUHPHQWV DQG PRWLRQ LQIRUPDWLRQ +RZHYHU WKH URERW GRHV QRW KDYH D PDSQRUGRHVLWNQRZLWVRZQSRVH 6/$0LVPRUHGLIILFXOWDQG FRPSOLFDWHGWKDQRWKHUSUREOHPVLQWKHURERWLFVILHOG >@ :KLOH WKHURERWPRYHVLQDQXQNQRZQHQYLURQPHQW LWPXVWEXLOG WKH PDSRIWKHHQYLURQPHQWLWLVLQDQGSRVLWLRQLWVHOIRQWKLVPDS VLPXOWDQHRXVO\E\FRPSLOLQJ WKHOLPLWHG LQIRUPDWLRQLWUHFHLYHV IURPWKHVHQVRUV ,QWKHVROXWLRQRIWKH6/$0SUREOHPUDWKHU WKDQ GHWHUPLQLVWLF VROXWLRQV PRUH SUREDELOLVWLF VROXWLRQ PHWKRGVKDYHEHHQDGRSWHGEHFDXVHRIWKHH[WHURFHSWLYHVHQVRU PHDVXUHPHQW QRLVH DQG WKH XQFHUWDLQW\ RI HVWLPDWLRQ GXH WR SURSULRFHSWLYH VHQVRUV 7KH VWDWLVWLFDO DSSURDFK WR WKH 6/$0 SUREOHPILUVWGHVFULEHGE\6PLWKHWDOZRUNV E\HVWDEOLVKLQJD UHODWLRQVKLSEHWZHHQODQGPDUNVDQGSUREDELOLVWLFXQFHUWDLQWLHV >@>@ 3UREDELOLVWLFDSSURDFKHVKDYHVXFFHVVIXOO\WDFNOHG PDQ\ SUREOHPV LQ 6/$0 VXFK DVPDSSLQJ ORFDOL]DWLRQ VHQVRUDQG PRWLRQ PRGHOLQJ IRU PDQ\ \HDUV $ VLJQLILFDQW QXPEHU RI

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

‹,(((

)HEUXDU\

7&6(7

/YLY6ODYVNH8NUDLQH



 )LJ 6DPSOLQJIURPWKHPRWLRQPRGHOXVLQJGLIIHUHQWQRLVHSDUDPHWHUV

LPSOHPHQWDWLRQXVLQJWKH95(3SODWIRUPLQWKHOLWHUDWXUH>@ >@>@7KHDLPRIWKLVSDSHULVWRDQDO\]HWKHSURSHUWLHVRI )DVW6/$0DOJRULWKPDQGLWVSHUIRUPDQFHWKDWLVLPSOHPHQWHG RQD3LRQHHU';XVLQJWKH95(3SODWIRUP 7KH UHVW RI WKLV SDSHU LV RXWOLQHG DV IROORZV 6HFWLRQ ,, GHVFULEHV WKH )DVW6/$0 PHWKRG DQG DSSOLHG SUREDELOLVWLF PRGHOV1H[WWKH95(3SODWIRUPLVDGGUHVVHGLQ6HFWLRQ,,, 7KHQWKHH[SHULPHQWDOUHVXOWVDUHSUHVHQWHGLQ6HFWLRQ,97KH SDSHUHQGVZLWKFRQFOXVLRQDQGVXJJHVWLRQVIRUIXWXUHZRUN ,, 352%$%,/,67,&02'(/6$1'*5,'%$6(')$676/$0 0(7+2' 7KLV VHFWLRQ GHVFULEHV WKH PDWKHPDWLFDO IUDPHZRUN RI WKH )DVW6/$0 PHWKRG DQG HPSOR\HG SUREDELOLVWLF PRGHOV LQ WKH DOJRULWKP ,Q WKLV VWXG\ ZH PDNH XVH RI WKH )DVW6/$0 DOJRULWKP WR UHSUHVHQW WKH URERW SRVH LQ DQ XQNQRZQ HQYLURQPHQWWKDWLVDOVRGHILQHGDVDJULGPDS7REHDEOHWRUXQ WKH )DVW6/$0 DOJRULWKP RQ WKH RFFXSDQF\ JULG PDSV ZH HPSOR\HGDQRFFXSDQF\JULGPDSSLQJ IXQFWLRQWKDWFDOFXODWHV WKHSRVWHULRURYHUPDSVJLYHQWKHGDWD pm_z1:t , x1:t 

 

+HUHmLVWKHPDSzLVWKHPHDVXUHPHQWVDQGxLVWKHURERW SRVH /RFDOL]DWLRQ SDUW RI RXU 6/$0 DOJRULWKP LV EDVHG RQ 0RQWH&DUOR/RFDOL]DWLRQ0&/ >@0&/LVDQHDV\WRXVH DQGUREXVWPHWKRG7KLVPHWKRGLVDSSOLFDEOHWRERWKORFDODQG JOREDOORFDOL]DWLRQSUREOHPVDVJULGEDVHG0DUNRYORFDOL]DWLRQ >@:HZLOOQRZSUHVHQWHDFKRIWKHSUREDELOLVWLFPRGHOVDQG WKHVXEIXQFWLRQVLQPRUHGHWDLO A. Motion Model 7KH SRVH RI D PRELOH URERW RSHUDWLQJ RQ D ' SODQH LV FRPSRVHGRIERG\¶V[\FRRUGLQDWHDQGLWVDQJXODURULHQWDWLRQ DVQRWHGLQWKHIROORZLQJYHFWRU ‫ݔ‬ ቆ‫ݕ‬ቇ   ߠ ZKHUHx DQGyGHQRWHWKHSODQDUFRRUGLQDWHVRIWKHURERWDQGș GHQRWHVWKHDQJXODURULHQWDWLRQ $VZHSUHIHUWRXVHDSDUWLFOHILOWHUEDVHGDSSURDFKXVH LV PDGHRIDVDPSOLQJEDVHGPRWLRQPRGHO7KHFHQWUDOWKHPHRI

)HEUXDU\

)LJ $SSUR[LPDWLRQ RI WKH VHQVRU PRGHO REWDLQHG ZLWK  PHDVXUHPHQW IRU WKH WUXH GLVWDQFH YDOXH WKDW LV HTXDO WR  7KH H[SRQHQWLDO GLVWULEXWLRQ EHIRUHWKHDFWXDOPHDVXUHPHQWLVFOHDUO\YLVLEOH

WKHSDUWLFOHILOWHULVWRLGHQWLI\WKHSRVWHULRUE\DVHWRIUDQGRP VWDWH VDPSOHV JHQHUDWHG IURP WKLV SRVWHULRU 7KXV ZH VDPSOH IURPWKHPRWLRQPRGHOpxt_ utxt-1 LQVWHDGRIFRPSXWLQJIXOO SRVWHULRU xt LV WKH VWDWH YDULDEOH LH URERW SRVH DQG ut LV WKH PRWLRQFRPPDQG2XUPRWLRQPRGHOVFULSWVDFFHSWVxt-1DQGut DV LQSXW DQG JHQHUDWHV UDQGRP SRVHV xt DFFRUGLQJ WR WKH GLVWULEXWLRQRIWKHSRVWHULRUE\DGGLQJQRLVH)LJLOOXVWUDWHVWKH SDUWLFOHV FDOFXODWHG IURP WKH PRWLRQ PRGHO ZLWK UHVSHFW WR GLIIHUHQWQRLVHSDUDPHWHUVHWWLQJV B. Measurement Model 7KLV PRGHO DFFHSWV WKH PHDVXUHPHQWV URERW SRVH DQG WKH ODVWPRGLILHGLQGLYLGXDOJULGPDSDQGJHQHUDWHVWKHZHLJKWRI HDFKSDUWLFOH ሾ௞ሿ ሾ௞ሿ ሾ௞ሿ ‫ݓ‬௧ ̱‫݌‬ሺ‫ݖ‬௧ ȁ‫ݔ‬௧ ǡ ݉௧ିଵ ሻ   ,Q WKLV LPSOHPHQWDWLRQ D ODVHU UDQJH ILQGHU ZDV XVHG DV D PHDVXUHPHQW GHYLFH :H KDYH WR DFFRXQW IRU WKH LQKHUHQW XQFHUWDLQW\LQWKHPHDVXUHPHQWVHQVRUVLQRUGHUWRUHIOHFWUHDO OLIH FRQGLWLRQV 7KXV IRXU W\SH RI PHDVXUHPHQW HUURUV DUH LQFRUSRUDWHG LQ WKH PRGHO D *DXVVLDQ QRLVH DURXQG WKH WUXH PHDVXUHPHQWUDQGRPQRLVHHUURUGXHWRIDLOXUHWRGHWHFWREMHFWV DQG HUURUV GXH WR XQH[SHFWHG REMHFWV ,Q WKH UHDO ZRUOG ODVHU UDQJHILQGHUVPHDVXUHDGLVWDQFHZLWKLQWKH UDQJHZLWKDYHU\ VPDOOHUURU:HPRGHOWKLVVPDOOHUURUFDXVHGE\HQYLURQPHQWDO UHDVRQV ZLWK D QDUURZ *DXVVLDQ GLVWULEXWLRQ LQ RXU VHQVRU PRGHO )LJ  LOOXVWUDWHV WKH GHQVLW\ RI WKH PRGHO JUDSKLFDOO\ +HUH ZH KDYH LQFUHDVHG WKH VLJPD YDOXH RI WKH QRUPDO GLVWULEXWLRQDQGWKHZHLJKWRIWKHHUURUGXHWR WKHXQH[SHFWHG REMHFWV LQ RUGHU WR PDNH WKH ILJXUH HDV\ WR XQGHUVWDQG 7KH FRUUHFWPHDVXUHPHQWSUREDELOLW\LVJLYHQE\ ሾ௞ሿ

ሾ௞ሿ‫כ‬

ሾ௞ሿ ‫݌‬௛௜௧ ቀ‫ݖ‬௧ ቚ‫ݔ‬௧ ǡ ݉ቁ ൌ ൜ߟࣨሺ‫ݖ‬௧ Ǣ ‫ݖ‬௧ Ͳ  ሾ௞ሿ

ଶ ǡ ߪ௛௜௧ ሻ

Ͳ ൑ ‫ݖ‬௧௞ ൑ ‫ݖ‬௠௔௫    ‫݁ݏ݅ݓݎ݄݁ݐ݋‬ ሾ௞ሿ

ሾ௞ሿ‫כ‬

ଶ ሻ LV WKH ZKHUH ‫ݖ‬௧  GHQRWHV WKH WUXH UDQJH ࣨሺ‫ݖ‬௧ Ǣ ‫ݖ‬௧ ǡ ߪ௛௜௧ ሾ௞ሿ‫כ‬ QRUPDOGLVWULEXWLRQZLWKPHDQ‫ݖ‬௧ VWDQGDUGGHYLDWLRQߪ௛௜௧ DQG ȘLVWKHQRUPDOL]HU$OWKRXJKXQH[SODLQDEOHPHDVXUHPHQWVDUH YHU\UDUHIRUWKHODVHUUDQJHILQGHUZHGHILQHDUDQGRPQRLVH XQLIRUPO\ GLVWULEXWHG RYHU WKH VHQVRU¶V UDQJH LQ RUGHU WR

7&6(7

/YLY6ODYVNH8NUDLQH



UHSUHVHQWWKHJKRVWUHDGLQJV7KLUGO\ZHKDYHPRGHOHGWKHHUURU GXHWRXQH[SHFWHGIDLOXUHV/DVHUUDQJHILQGHUVPD\IDLOZKHQ WKHODVHULVDEVRUEHGE\WKHREMHFWVRULWGRHVQRWUHWXUQWRWKH GHYLFH2XUPRGHOJHQHUDWHVWKHPD[UDQJHPHDVXUHPHQWLIDQ\ IDLOXUH RFFXUV )LQDOO\ HUURUV GXH WR XQH[SHFWHG REMHFWV DUH GHILQHGLQWKHPRGHO0RELOHURERWVXVXDOO\PRYHLQG\QDPLF HQYLURQPHQWV7KH VHQVRUVPD\VHQVHSHRSOHRURWKHUPRYLQJ REMHFWVIRUDVKRUWWLPH7KLVW\SHRIPHDVXUHPHQWZLOOEHVKRUWHU LQKHUHQWO\WKDQWKHH[SHFWHGYDOXH7KHOLNHOLKRRGRIVHQVLQJDQ REMHFWLVKLJKHUDURXQGWKHURERWDQGLWGHFUHDVHVZLWKWKHUDQJH 7KHGHQVLW\RIPHDVXUHPHQWVRIXQH[SHFWHGREMHFWVXVXDOO\LV GHVFULEHGZLWKDQH[SRQHQWLDOGLVWULEXWLRQ([SRQHQWLDOGHFOLQH EHIRUHWKHH[SHFWHGPHDVXUHPHQWLVFOHDUO\YLVLEOHLQ)LJ 7KHVHGLIIHUHQWHUURUGLVWULEXWLRQVDUHPHUJHGE\ZHLJKWLQJDOO GHQVLWLHVLQGLYLGXDOO\ZLWKWKHFRUUHVSRQGLQJSDUDPHWHUVܹ௛௜௧  ܹ௥௔௡ௗ ܹ௠௔௫ ܹ௦௛௢௥௧  ܹ௛௜௧ ் ܲ௛௜௧ ܹ ܲ ሾ௞ሿ ‫݌‬௛௜௧ ቀ‫ݖ‬௧ ቚ‫ݔ‬௧ ǡ ݉ቁ ൌ ൮ ௥௔௡ௗ ൲ Ǥ൮ ௥௔௡ௗ ൲ ܹ௠௔௫ ܲ௠௔௫ ܹ௦௛௢௥௧ ܲ௦௛௢௥௧

 

C. Updating Occupancy Grids 2FFXSDQF\ JULG PDSSLQJ DOJRULWKP XSGDWHV JULGFHOOV WKDW IDOOLQWRWKHVHQVRUILHOGRIYLHZ7KLVDOJRULWKPDOVRHPSOR\VDQ LQYHUVHVHQVRUPRGHO7KHPDLQREMHFWLYHRIWKHLQYHUVHVHQVRU PRGHOLVWRFDOFXODWHLQYHUVHPHDVXUHPHQWPRGHOLQLWVORJRGGV IRUP,WUHWXUQVRFFXSLHGRUIUHHIRUWKHH[DPLQHGJULGFHOO7R SUHYHQW LQVWDELOLWLHV IRU WKH SUREDELOLWLHV QHDU ]HUR RU RQH RFFXSDQF\ JULG SUREDELOLWLHV DUH UHSUHVHQWHG LQ WKH ORJ RGGV IRUP ݈‫݃݋‬

௣ሺ௠೔ ȁ௭೟ ǡ௫೟ ሻ



ଵି௣ሺ௠೔ ȁ௭೟ ǡ௫೟ ሻ

 

$WWKHHQGRIWKHDOJRULWKPSUREDELOLWLHVDUHUHFRYHUHGIURP WKHORJRGGVUDWLR D. Low Variance Sampling &RPSXWDWLRQWLPHLVFUXFLDOZKHQZRUNLQJZLWKWKHSDUWLFOH ILOWHUV(DFKSDUWLFOHSURFHVVEULQJVDQDGGLWLRQDOZDVWHRIWLPH 7KXV VKRUWFXWV DUH YHU\ LPSRUWDQW DV WKH WLPH LV JROG SDUWLFXODUO\LQPRELOHURERWLFVDSSOLFDWLRQV:HHVWDEOLVKDORZ YDULDQFHVDPSOHUWRUHGXFHWKHVDPSOLQJHUURUDWWKHHQGRIWKH PDLQ VFULSW /RZ YDULDQFH VDPSOHU VHOHFWV VDPSOHV ZLWK D SUREDELOLW\ SURSRUWLRQDO WR WKH ZHLJKW RI WKH VDPSOH ,W RYHUFRPHV FKRRVLQJ DOO VDPSOHV LQGHSHQGHQWO\ DW UDQGRP 7KHUH DUH VHYHUDO HIILFLHQW VDPSOLQJ PHWKRGV LQ WKH OLWHUDWXUH >@ ,,, 95(33/$7)250 :HSUHIHUWRXVH95(3DVWKHYLUWXDOURERWSODWIRUPVLQFH LWKDVD IUHHDFDGHPLFOLFHQVHIRUWKHXQLYHUVLWLHV 95(3LVD YHUVDWLOHURERWVLPXODWLRQSURJUDPWKDWLVEDVHGRQDGLVWULEXWHG FRQWURO DUFKLWHFWXUH (DFK REMHFW FDQ EH FRQWUROOHG YLD DQ HPEHGGHG VFULSW WKDW LV ZULWWHQ LQ && 3\WKRQ -DYD /XD 0$7/$%RU2FWDYH,WLQFOXGHVPDQ\W\SHVRIURERWVVXFKDV ZKHHOHGURERWVTXDGFRSWHUVKH[DSRGVPDQLSXODWRUVDQGHWF,W LVDOVRHDV\WRFUHDWHDYLUWXDOHQYLURQPHQWWKDWLVVXLWDEOHIRUWKH URERW7KH95(3LQWHUIDFHLVHDV\WRXVH,QDGGLWLRQWREHLQJ

)HEUXDU\

 )LJ 95(3VHWXSRIWKH3LRQHHU';

DEOHWRVHOHFWYLVXDOURERWVWKHXVHUFDQPRGLI\WKHURERWZLWKD YDULHW\ RI VHQVRUV DQG FUHDWH DQ RIILFH HQYLURQPHQW ZLWK WKH IXUQLWXUHRUDQRXWGRRUHQYLURQPHQWLQGLIIHUHQWWHUUDLQ ,QWKLVVWXG\ZHKDYHXVHGWKH3LRQHHU';ZLWKD'ODVHU VFDQQHUDQGHLJKWXOWUDVRQLFVHQVRUVLQDQLQGRRUHQYLURQPHQW ZHFUHDWHG:HPDNHXVHRIWKH%UDLWHQEHUJDSSURDFK>@WKDW FRPSULVHV /XD VFULSW WR QDYLJDWH VPRRWKO\ LQ XQNQRZQ HQYLURQPHQW:LWKWKLVVWUDWHJ\WKHPRELOHURERWVXFFHVVIXOO\ SHUIRUPVWKHFROOLVLRQDYRLGDQFHZLWKRXWXVLQJDQ\H[SORUDWLRQ DOJRULWKP([SORUDWLRQLVWKHSUREOHPRIURERWFRQWUROWKDWWULHV WRGLUHFWDPRELOHURERWPRYLQJLQDQXQNQRZQHQYLURQPHQWWR XQH[SORUHGDUHDVLQDGLUHFWLRQWKDWZLOOLQFUHDVHLWVNQRZOHGJH UDWKHUWKDQUHSHDWLQJWKHNQRZOHGJHLWKDV)RURXUSUREOHPLH IRU RFFXSDQF\ JULG PDSSLQJ H[SORUDWLRQ LV WKDW WKH URERW LV FRQWUROOHGWRLQFUHDVHWKHLQIRUPDWLRQDERXWJULGFHOOVWKDWKDV QRWEHHQYLVLWHG\HW6LQFHWKHH[SORUDWLRQLVQRWRQHRIWKHPDLQ REMHFWLYHV RI WKH VWXG\ ZH KDYH IRFXVHG RQ WKH )DVW6/$0 DOJRULWKPKHUHDQGZHDUHVDWLVILHGZLWK%UDLWHQEHUJDOJRULWKP WRFRQWUROWKHURERW 95(3RIIHUVD5HPRWH$3,DOORZLQJWRFRQWUROWKHPRELOH URERW IURP DQ H[WHUQDO DSSOLFDWLRQ $OO )DVW6/$0 VFULSWV DUH GHYHORSHG LQ 0$7/$% DQG WKH PRELOH URERW OLQNHG ZLWK 0$7/$%WKDQNVWRWKH5HPRWH$3,IHDWXUHRIWKH95(3 ,9 (;3(5,0(17$/5(68/76 ,QRUGHUWRDQDO\]HWKHHIIHFWVRIWKHGLIIHUHQWSDUDPHWHUVRQ WKH )DVW6/$0 DOJRULWKP D QXPEHU RI H[SHULPHQWV ZHUH SHUIRUPHG 6LPXODWLRQV ZHUH UXQ RQ D GHVNWRS 3& ZLWK  *+] &38 DQG  *% 5$0 $Q LQGRRU HQYLURQPHQW ZDV FUHDWHGLQWKH95(3SODWIRUP7KH3LRQHHUURERWZDVHTXLSSHG ZLWKDODVHUUDQJHILQGHUDQGWKHURERWZDVWHVWHGLQWKDWYLUWXDO HQYLURQPHQW )LUVW ZH FRPSDUHG WKH UHDO SRVLWLRQ DQG WKH HVWLPDWHG SRVLWLRQRIWKHURERWRQWKH'VXUIDFHIRUDVLPSOHPRYHPHQW VFHQDULR $IWHU WKH H[SHULPHQWV LW ZDV QRWLFHG WKDW WKH HUURU GUDPDWLFDOO\LQFUHDVHVDIWHUWKHPRELOHURERWKDGDVWHHSWXUQ 7RYLVXDOL]HWKHGLIIHUHQFHEHWZHHQWKHWUXHWUDMHFWRU\DQGWKH SDUWLFOHV¶ WUDMHFWRU\ D VWHHS WXUQ FRPPDQG ZDV JLYHQ WR WKH URERW,Q)LJLWLVVKRZQWKDWWKHFRPSDULVRQRIWKHPRYHPHQWV RIWKHURERWDQGSDUWLFOHVGXULQJDVWHHSWXUQ$VVKRZQLQWKH )LJWUDMHFWRULHVRIWKHSDUWLFOHVGLYHUJHLPPHGLDWHO\DIWHUWKH VWHHSWXUQ

7&6(7

/YLY6ODYVNH8NUDLQH



)LJ 5HDOYVHVWLPDWHGWUDMHFWRU\DIWHUDVWHHSWXUQ

7KHHIIHFWVRIWKHPHDVXUHPHQWVZHUHDOVRDQDO\]HGLQGHWDLO ,Q 95(3 LW LV HDV\ WR LGHQWLI\ WKH ILHOG RI YLHZ QXPEHU RI EHDP  DQG WKH EHDP GHQVLW\ SHU GHJUHH RI WKH ODVHU GLVWDQFH PHDVXUHPHQWVHQVRU7KHHIIHFWRIWKHQXPEHURIEHDPVRQWKH SRVLWLRQ HUURU ZHUH H[DPLQHG IRU ILYH GLIIHUHQW QXPEHU RI EHDPV)RUHDFKQXPEHURIEHDPYDOXHWZRWHVWVHWVZHUH

)LJ 7UDMHFWRULHVRIWKHURERWDQGSDUWLFOHVZLWKKLJKVLJPDYDOXH

 3DUWLFOHV 3DUWLFOHV

 

3RVLWLRQ(UURU

:HDOVRFRPSDUHGWKH WUDMHFWRU\HUURUVZLWKUHVSHFWWR WKH PRWLRQPRGHO¶VVLJPDYDOXH$VPHQWLRQHGDERYHD*DXVVLDQ GLVWULEXWLRQZDVDSSOLHGWRWKHPRWLRQPRGHO,Q)LJDQG)LJ LWLVFOHDUO\VHHQWKDWWUDMHFWRULHVRISDUWLFOHVZLWKKLJKVLJPD YDOXHVGLYHUJHPRUHIURPWKHH[SHFWHGWUDMHFWRU\FRPSDUHGWR WKHSDUWLFOHVZLWKORZVLJPDYDOXH,Q)LJ)LJDQG)LJ EOXHGDVKHG OLQHVGHSLFWWKHSDUWLFOHWUDMHFWRU\DQGUHGVROLG  OLQHVKRZVWKHUHDOWUDMHFWRU\RIWKHPRELOHURERW,Q)LJDQG )LJWKHWUDMHFWRU\GLIIHUHQFHEHWZHHQWKHPRELOHURERWDQGWKH SDUWLFOHVIRUDORQJSHULRGLVVKRZQ$VVHHQLQWKHILJXUHVWKH GLIIHUHQFHHUURU EHWZHHQWKHPRELOHURERW¶VWUDMHFWRU\DQGWKH SDUWLFOHV¶WUDMHFWRU\LQFUHDVHVDWWKHFRUQHUVZKHUHWKH3LRQHHU UHDOL]HGDVWHHSWXUQ7KHUHLVDOVRDVLJQLILFDQWHUURUDWWKHHQG RI WKH ORQJ OLQHDU WUDQVODWLRQ 'XH WR WKH FRQWURO QRLVH RU XQLGHQWLILHG HIIHFWV LQ WKH PRWLRQ FRQWURO DOZD\V KDV XQFHUWDLQWLHVLQUHDOOLIH,WLVDOVRHYLGHQWIURPWKHILJXUHVWKDW GHILQLQJWKHXQFHUWDLQWLHVZLWKWKH*DXVVLDQGLVWULEXWLRQJLYHVD JUHDWGHDORIWKHUHDOLVWLFURERWPRWLRQEHKDYLRU

      















1XPEHURI5DQJH6HQVRU%HDPV

)LJ &KDQJLQJRIWKHSRVLWLRQHUURUDFFRUGLQJWRWKHQXPEHURIVHQVRUEHDP DQGWKHQXPEHURISDUWLFOH

IRUPHG ZLWK GLIIHUHQW QXPEHU RI SDUWLFOHV $OO WKH WHVWV ZHUH FRQGXFWHGZLWKSDUWLFOHVDQGSDUWLFOHVDVZHOO,WLVFOHDUO\ VHHQWKDWWKHSRVLWLRQHUURUGHFUHDVHVZKLOHWKHQXPEHURIEHDP LQFUHDVHV7KLVWUHQGLVDOVRYDOLGIRUERWKFDVHV,WLVDOVRVHHQ WKDW WKH PRWLRQ HUURU GHFUHDVHV ZKLOH WKH QXPEHU RI SDUWLFOHV LQFUHDVH:HKDYHGLVFXVVHGWKLVSKHQRPHQRQDERYH7KHNH\ LGHDRIWKHSDUWLFOHILOWHULVWRUHSUHVHQWWKHEHOLHIE\PHDQVRID OLPLWHGQXPEHURISDUWLFOHV7KHPRUHWKHQXPEHURISDUWLFOHV WKHFORVHUUHSUHVHQWDWLRQRIWKHEHOLHI:RUNLQJZLWKDOLPLWHG QXPEHURISDUWLFOHVZLOOQRWUHSUHVHQWWKHEHOLHIYHU\ZHOODQG ZRUNLQJ ZLWK D KLJK QXPEHU RI SDUWLFOHV ZLOO UHGXFH WKH SHUIRUPDQFH RI WKH SURFHVVRU ZKLOH WKH EHOLHI¶V TXDOLW\ LQFUHDVHV 7KH &38 WLPH VSHQW RQ D VLQJOH LWHUDWLRQ H[HFXWLRQ ZDV HYDOXDWHGLQWKHWHVWV7HVWVIRUWKH&38WLPHHYDOXDWLRQZHUH FRQGXFWHGZLWKSDUWLFOHVDQGVHQVRUEHDPV7KHV\VWHP ZDV WHVWHG IRU  GHJUHH DQG  GHJUHH VHQVRU GHQVLW\ $V VKRZQLQWKH)LJPHDQWLPHIRUWKHVLQJOHH[HFXWLRQLQFUHDVHV LQSURSRUWLRQWRWKHVHQVRUGHQVLW\

 )LJ 7UDMHFWRULHVRIWKHURERWDQGSDUWLFOHVZLWKORZVLJPDYDOXH

)HEUXDU\

7&6(7

/YLY6ODYVNH8NUDLQH



 

D 

E 

)LJ &38WLPHFRQVXPHGIRUVLQJOHH[HFXWLRQWKURXJKLWHUDWLRQD IRUGHJUHHDQGE IRUGHJUHHPHDVXUHPHQWGHQVLW\





D 

E 

)LJ &RPSDULVRQRIWKHPDSVWKDWLVJHQHUDWHGD DWWKHHQGRIDVKRUWUXQWLPHDQGE DWWKHHQGRIORQJUXQWLPH

)LQDOO\ZHZDQWHGWRVHHWKHORQJWLPHSHUIRUPDQFHRIRXU V\VWHP,QWKH ILUVWWHVWVKRZQLQ)LJD WKHURERWKDVEHHQ RSHUDWHGIRUDSHULRGRIWLPHVXIILFLHQWWRQDYLJDWHDOPRVWDOORI WKHHQFORVHGVSDFHLQWKHGLUHFWLRQRIWKH%UDLWHQEHUJDOJRULWKP ,QWKHVHFRQGWHVWWKHURERWKDVEHHQRSHUDWHGIRUPXFKORQJHU )LJE  (YHQWXDOO\ VRPH GLVUXSWLRQV RQ WKH PDS DUH REVHUYHG GXH WR WKH FXPXODWLYH HUURUV 2FFXSDQF\ JULG PDSV GHSLFWHGLQ)LJZDVJHQHUDWHGE\WKHSDUWLFOHZLWKWKHKLJKHVW LPSRUWDQFHZHLJKWWKDWLVDOVRXSGDWHGLQHDFKLWHUDWLRQ 9 &21&/86,21$1'68**(67,216)25)8785(:25. ,QWKLVVWXG\WKH)DVW6/$0SUREOHPLQDQXQNQRZQLQGRRU HQYLURQPHQW ZDV VROYHG ZLWK WKH 3LRQHHU  '; PRELOH URERW HTXLSSHGZLWKDODVHUUDQJHILQGHULQWKH95(3HQYLURQPHQW $OO)DVW6/$0VFULSWVZHUHGHYHORSHGLQ0$7/$%DQGOLQNHG WRWKHPRELOHURERWWKURXJKWKH5HPRWH$3,RIWKH95(37KH PDLQ REMHFWLYH RI WKLV VWXG\ LV WKDW WKH )DVW6/$0 DOJRULWKP ZRUNVZLWKDYLUWXDOURERWEXLOWRQWKH95(3DQGWRH[DPLQH

)HEUXDU\

WKHHIIHFWVRIWKHFKDQJLQJRISDUDPHWHUVLQWKHPRGHOVRQWKH V\VWHP ,Q WKH )DVW6/$0 DOJRULWKP D PRWLRQ PRGHO ZDV XVHG WR UHSUHVHQWWKHSRVWHULRUE\DILQLWHQXPEHURIWKHVDPSOHVWKDWLV FDOOHGDOVRWKHSDUWLFOHV7KHSDUWLFOHILOWHUVDVDQRQSDUDPHWULF LPSOHPHQWDWLRQRIWKH%D\HVILOWHUVDUHHDV\WRXVH7KHEHOLHI FDQEHUHSUHVHQWHGE\DQ\QXPEHURISDUWLFOHV7KHH[SHULPHQWDO UHVXOWV VKRZHG WKDW DV WKH QXPEHU RI SDUWLFOHV LQFUHDVHV WKH UHVXOW JHW FORVHU WR WKH WDUJHW GLVWULEXWLRQ 7KLV SURYLGHV IOH[LELOLW\ZKHQGHVLJQLQJWKHV\VWHP+RZHYHUWKHJUHDWHUWKH QXPEHURISDUWLFOHVWKHORQJHUWKHIRUPDWLRQRISDUWLFOHVSDFH ZLOOWDNH$PHDVXUHPHQWPRGHOZDVDOVRGHVLJQHGWRDFFRXQW IRUWKHLQKHUHQWXQFHUWDLQW\WKDWPD\EHHQFRXQWHULQUHDOOLIH 6RPH PHDVXUHPHQW QRLVH VXFK DV UDQGRP QRLVH HUURU GXH WR IDLOXUHWRGHWHFWREMHFWVDQGHUURUGXHWRXQH[SHFWHGREMHFWVZHUH DOVR FRQVLGHUHG $W WKH HQG RI WKH DOJRULWKP D ORZ YDULDQFH VDPSOHU ZDV HVWDEOLVKHG WR VHOHFW VDPSOHV ZLWK D SUREDELOLW\ SURSRUWLRQDOWRWKHZHLJKWRIVDPSOH

7&6(7

/YLY6ODYVNH8NUDLQH



([SHULPHQWDOUHVXOWVVKRZHGWKDWWKH)DVW6/$0DOJRULWKP FDQEHVXFFHVVIXOO\LPSOHPHQWHGRQDYLUWXDOURERWFUHDWHGLQ9 5(3 7KH XQFHUWDLQWLHV LQ WKH PRWLRQ DQG PHDVXUHPHQW ZHUH PRGHOHGVXFFHVVIXOO\DVZHOO2XUSXUSRVHZDVWRHYDOXDWHWKH HIIHFWV RI FKDQJLQJ WKH SDUDPHWHUV RI WKH PRWLRQ PRGHO PHDVXUHPHQWPRGHODQGWKHQXPEHURISDUWLFOHV$WWKHHQGRI WKHH[SHULPHQWVLWLVFOHDUO\VHHQWKDWLQFUHDVLQJWKHQRLVHLQWKH PRWLRQ RU PHDVXUHPHQW PRGHO DIIHFWV WKH RSHUDWLRQ RI WKH V\VWHP QHJDWLYHO\ ZKHUHDV LQFUHDVLQJ WKH QXPEHU RI EHDP GHFUHDVHV WKH SRVLWLRQ HUURU )XUWKHUPRUH LW LV VHHQ WKDW LQFUHDVLQJWKHQXPEHURISDUWLFOHVDOVRLQFUHDVHVDFFXUDF\RIWKH SRVLWLRQLQJ+RZHYHULWZDVREVHUYHGWKDWWKHH[HFXWLRQWLPH LQFUHDVHVJUDGXDOO\%HVLGHVLWZDVVHHQWKDWZRUNLQJLQDFORVHG DUHDIRUORQJWLPHFDXVHVWRORVVRIWKHPDSDFFXUDF\ ,Q RUGHU WR LPSURYH WKH SUHVHQWHG V\VWHP 5HPRWH $3, FRQQHFWLRQ DQG PRGHOV VKRXOG EH FRQVLGHUHG )DFWRUV WKDW QHJDWLYHO\ DIIHFW WKH SHUIRUPDQFHRI WKH 0$7/$% VKRXOGEH UHGXFHG,Q IXWXUH ZH ZLOO FRQWLQXH WR VSHHG XS WKH DYDLODEOH V\VWHP 5()(5(1&(6 >@ >@ >@

>@

>@

>@

>@

>@

>@

>@

6 7KUXQ ' )R[ DQG : %XUJDUG Probabilistic Robotics0,73UHVV 5&6PLWKDQG3&KHHVHPDQ³2QWKH5HSUHVHQWDWLRQ DQG (VWLPDWLRQ RI 6SDWLDO 8QFHUWDLQW\´ Int. J. Rob. Res.YROQRSS± 5 6PLWK 0 6HOI DQG 3 &KHHVHPDQ ³(VWLPDWLQJ 8QFHUWDLQ 6SDWLDO 5HODWLRQVKLSV LQ 5RERWLFV´ Mach. Intell. Pattern Recognit. YRO  QR & SS ±  6 7KUXQ : %XUJDUG DQG ' )R[ ³$ 3UREDELOLVWLF $SSURDFKWR&RQFXUUHQW0DSSLQJDQG/RFDOL]DWLRQIRU 0RELOH5RERWV´Mach. Learn.YROQR±SS±  0:0*DPLQL'LVVDQD\DNH31HZPDQ6&ODUN +)'XUUDQW:K\WHDQG0&VRUED³$VROXWLRQWRWKH VLPXOWDQHRXV ORFDOL]DWLRQ DQG PDS EXLOGLQJ 6/$0  SUREOHP´ IEEE Trans. Robot. Autom.YRO QR SS± + $EGHOQDVVHU et al. ³6HPDQWLF6/$0 8VLQJ (QYLURQPHQW /DQGPDUNV IRU 8QVXSHUYLVHG ,QGRRU /RFDOL]DWLRQ´IEEE Trans. Mob. Comput.YROQR SS± $*LOÏ5HLQRVR0%DOOHVWDDQG0-XOLi³0XOWL URERWYLVXDO6/$0XVLQJD5DR%ODFNZHOOL]HGSDUWLFOH ILOWHU´ Rob. Auton. Syst. YRO  QR  SS ±  5 0XU$UWDO - 0 0 0RQWLHO DQG - ' 7DUGRV ³25%6/$0 $ 9HUVDWLOH DQG $FFXUDWH 0RQRFXODU 6/$06\VWHP´IEEE Trans. Robot.YROQRSS ± 00RQWHPHUOR67KUXQ'.ROOHUDQG%:HJEUHLW ³)DVW6/$0 $ IDFWRUHG VROXWLRQ WR WKH VLPXOWDQHRXV ORFDOL]DWLRQ DQG PDSSLQJ SUREOHP´ Proc. 8th Natl. Conf. Artif. Intell. Conf. Innov. Appl. Artif. Intell.YRO QRSS± 6--XOLHUDQG-.8KOPDQQ³1HZH[WHQVLRQRIWKH

)HEUXDU\

>@

>@

>@ >@ >@ >@

>@

>@

>@

>@

>@

7&6(7

.DOPDQ ILOWHU WR QRQOLQHDU V\VWHPV´ Int Symp AerospaceDefense Sens. Simul Control.YROS  - (QJHO 7 6FK|SV DQG ' &UHPHUV ³/6'6/$0 /DUJH6FDOH 'LUHFW PRQRFXODU 6/$0´ LQ Lecture Notes in Computer Science (including subseries Lecture Notes in Artificial Intelligence and Lecture Notes in Bioinformatics)  YRO  /1&6 QR 3$57SS± & &DGHQD et al. ³3DVW 3UHVHQW DQG )XWXUH RI 6LPXOWDQHRXV /RFDOL]DWLRQ DQG 0DSSLQJ 7RZDUG WKH 5REXVW3HUFHSWLRQ$JH´IEEE Trans. Robot.YRO QRSS± ³95(3 9LUWXDO 5RERW ([SHULPDQWDWLRQ 3ODWIRUP´ >2QOLQH@ $YDLODEOH KWWSZZZFRSSHOLDURERWLFVFRP ³0$7/$%´ >2QOLQH@ $YDLODEOH KWWSVZZZPDWKZRUNVFRP ³/XD´>2QOLQH@$YDLODEOHKWWSZZZOXDRUJ 0 $ 2OLYDUHV0HQGH] 6 .DQQDQ DQG + 9RRV ³9LVLRQEDVHGIX]]\FRQWURODXWRQRPRXVODQGLQJZLWK 8$9V)URP95(3WRUHDOH[SHULPHQWV´LQ2015 23rd Mediterranean Conference on Control and Automation, MED 2015 - Conference Proceedings SS± 0 )UHHVH 6 6LQJK ) 2]DNL DQG 1 0DWVXKLUD ³9LUWXDO URERW H[SHULPHQWDWLRQ SODWIRUP 95(3 $ YHUVDWLOH ' URERW VLPXODWRU´ LQ Lecture Notes in Computer Science (including subseries Lecture Notes in Artificial Intelligence and Lecture Notes in Bioinformatics)YRO/1$,SS± ( )DEUHJDV * )DULDV ( 3HUDOWD + 9DUJDV DQG 6 'RUPLGR³7HDFKLQJFRQWUROLQPRELOHURERWLFVZLWK9 5(3 DQG D .KHSHUD ,9 OLEUDU\´ LQ 2016 IEEE Conference on Control Applications, CCA 2016 SS± 5 6LPPRQV DQG 6 .RHQLJ ³3UREDELOLVWLF 5RERW 1DYLJDWLRQ LQ 3DUWLDOO\ 2EVHUYDEOH (QYLURQPHQWV´ LQ Proceedings of the 14th International Joint Conference on Artificial Intelligence - Volume 2SS±  .%ULQJPDQQDQG.3DQDJLRWRX³(IILFLHQW6DPSOLQJ 0HWKRGV IRU 'LVFUHWH 'LVWULEXWLRQV´ ALGORITHMICA YRO  QR  SS ± 2FW  9 %UDLWHQEHUJ Vehicles: Experiments in Synthetic Psychology0,73UHVV 

/YLY6ODYVNH8NUDLQH