Prodictive control Applied TO 5DPO - Robocup middle-size omnidirectional robots

Page 1

$QGU¹ 6FRODUL &RQFHL¸¶R $ 3DXOR 0RUHLUD 3DXOR - &RVWD 'HSDUWPHQW RI (OHFWULFDO DQG &RPSXWHU (QJLQHHULQJ 8QLYHUVLW\ RI 3RUWR 3RUWR 3RUWXJDO >VFRODUL DPRUHLUD SDFR@#IH XS SW

$57,*2 7®&1,&2

35(',&7,9( &21752/ $33/,(' 72 '32 52%2&83 0,''/( 6,=( 201,',5(&7,21$/ 52%276 $%675$&7 7KLV SDSHU SUHVHQWV D QRQOLQHDU PRGHO EDVHG SUHGLFWLYH FRQWUROOHU 103& IRU WUDMHFWRU\ WUDFNLQJ RI WKH 0LGGOH VL]H 2PQLGLUHFWLRQDO 5RERWV IURP WKH '32 5RERWLF 6RFFHU WHDP 7KH VWUDWHJ\ SURSRVHG XVHV PHWKRGV RI QXPHULFDO RSWLPL]DWLRQ WR SHUIRUP UHDO WLPH QRQOLQHDU PLQLPL]DWLRQ RI WKH FRVW IXQFWLRQ 7KH FRVW IXQFWLRQ SHQDOL]HV WKH URERW SRVLWLRQ HUURU WKH URERW RULHQWDWLRQ DQJOH HUURU DQG WKH FRQWURO HIIRUW ([SHULPHQWDO UHVXOWV RI WKH WUDMHFWRULHV IROORZLQJ DQG WKH SHUIRUPDQFH RI WKH PHWKRGV RI RSWLPL]DWLRQ DUH SUHVHQWHG

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

> @

UREËWLFD

REWDLQHG JRRG WLPHV RI PLQLPL]DWLRQ RI WKH FRQWUROOHU V FRVW IXQFWLRQ PLOOLVHFRQGV 1RZDGD\V ZLWK SRWHQW SURFHVVRUV LQ SHUVRQDO FRPSXWHUV WKH XVH RI RSWLPL]DWLRQ DOJRULWKPV EHFDPH YLDEOH 7KH SDSHU LV RUJDQL]HG DV IROORZV 6HFWLRQ ,, SUHVHQWV EULHI GHVFULSWLRQ RI WKH RPQLGLUHFWLRQDO PRELOH URERW 6HFWLRQ ,,, SUHVHQWV WKH 103& HOHPHQWV 103& VFKHPH SUHGLFWLRQ PRGHO FRVW IXQFWLRQ DQG FRQWURO ODZ ,Q WKLV VHFWLRQ WKH RSWLPL]DWLRQ PHWKRGV DUH SUHVHQWHG 7KH H[SHULPHQWDO UHVXOWV RI WKH 103& DUH SUHVHQWHG LQ VHFWLRQ ,9 )LQDOO\ WKH FRQFOXVLRQV DUH GUDZQ LQ VHFWLRQ 9

,, 52%27 '(6&5,37,21 7KH URERW )LJ D LV HTXLSSHG ZLWK IRXU RPQLGLUHFWLRQDO ZKHHOV FRQQHFWHG WR JHDUHG PRWRUV &RQQHFWHG WR HDFK ZKHHO WKHUH LV LQGXVWULDO HQFRGHU WR PHDVXUH LWV VSHHG (DFK SDLU ZKHHOHQFRGHU LV FRQQHFWHG WR FRQWUROOHU ERDUG 7KLV ERDUG KDV PLFURFRQWUROOHU WKDW PHDVXUHV WKH ZKHHO VSHHG DQG LPSOHPHQWV ORFDO FRQWUROOHU 7KLV FRQWUROOHU PDLQWDLQV WKH UHTXHVWHG VSHHG DQG LV EDVHG RQ 3,' 7KLV ORZ OHYHO ORRS KDV VDPSOLQJ IUHTXHQF\ RI +] 7KH IRXU FRQWUROOHUV DUH FRQQHFWHG WR WKH 3& E\ 56 OLQN UXQQLQJ DW EDXG 7KH URERW KDV VWDQGDUG 3& PRWKHUERDUG ZLWK *+] &HOHURQ SURFHVVRU 1HYHUWKHOHVV WKHUH LV QR KDUG GLVN DQG WKH /LQX[ 26 DQG WKH SURJUDPV DUH VWRUHG LQ 0%\WHV &RPSDFW )ODVK &DUG FRQQHFWHG WR WKH ,'( $QRWKHU YHU\ LPSRUWDQW PRGXOH LV WKH RQH WKDW GHDOV ZLWK WKH LPDJH FDSWXUHG E\ WKH RQPLGLUHFWLRQDO YLVLRQ V\VWHP DQG H[WUDFWV WKH PRVW LPSRUWDQW IHDWXUHV 7KLV LQIRUPDWLRQ LV XVHG WR FRQVWUXFW DQ HVWLPDWLRQ RI WKH URERW SRVLWLRQ 7KH YLVLRQ FDPHUD DOVR SURYLGHV WKH VDPSOH WLPH FRQWURO RI WKH URERW WV PLOOLVHFRQGV 7KH PRELOH URERW ZDV EXLOW IRU WKH '32 5RERWLF 6RFFHU WHDP IURP WKH 'HSDUWPHQW RI (OHFWULFDO DQG &RPSXWHU (QJLQHHULQJ DW WKH 8QLYHUVLW\ RI 3RUWR DW 3RUWR 3RUWXJDO

,,, 02'(/ 35(',&7,9( &21752//(5 7KH VWUDWHJ\ RI WKH 03& FRQWUROOHU LV FKDUDFWHUL]HG E\ VFKHPH UHSUHVHQWHG LQ )LJ $ SURFHVV PRGHO LV XVHG WR SUHGLFW WKH IXWXUH RXWSXWV EDVHG RQ SDVW DQG FXUUHQW YDOXHV DQG RQ WKH SURSRVHG IXWXUH FRQWURO DFWLRQV 7KHVH DFWLRQV DUH FDOFXODWHG E\ RSWLPL]DWLRQ RI D FRVW IXQFWLRQ 7DNH LQWR DFFRXQW WKH WUDMHFWRU\ WUDFNLQJ SUREOHP WKH FRVW IXQFWLRQ - RI WKH SUHGLFWLYH FRQWUROOHU LV GHILQHG DV IROORZ


Turn static files into dynamic content formats.

Create a flipbook
Prodictive control Applied TO 5DPO - Robocup middle-size omnidirectional robots by cie - Issuu