Swing-up and Stabilization of the Rotational Inverted Pendulum Using

Available online at www.sciencedirect.com

ScienceDirect Procedia Technology 12 (2014) 57 – 64

7KHWK,QWHUQDWLRQDO&RQIHUHQFH,QWHUGLVFLSOLQDULW\LQ(QJLQHHULQJ,17(5(1* 

6ZLQJXSDQGVWDELOL]DWLRQRIWKHURWDWLRQDOLQYHUWHGSHQGXOXP XVLQJ3'DQGIX]]\3'FRQWUROOHUV 6WHOLDQ(PLOLDQ2OWHDQ  3HWUX0DLRU8QLYHUVLW\RI7vUJX0XUHЮ1,RUJDVWU7vUJX0XUHЮ5RPDQLD

$EVWUDFW 7KH SDSHU SURSRVHV D VLPSOLILHG VROXWLRQ RI WKH FRQWURO SUREOHP RI WKH URWDWLRQDO LQYHUWHG SHQGXOXP 7KH URWDWLRQDO LQYHUWHG SHQGXOXP5,3 LVDFRPSOH[V\VWHPZLGHO\VWXGLHGLQPDQ\DUHDVGXHWRLWVFRPSOH[LW\DQGQRQOLQHDULWLHV7KHFRQWUROVWUDWHJ\ LVGLYLGHGLQWRWZRVXESUREOHPVWKHVZLQJXSFRQWURORIWKHSHQGXOXPXVLQJD3'FDVFDGHVFKHPHDQGWKHEDODQFHVWDELOL]LQJ FRQWURORIWKHZKROHV\VWHPXVLQJDIX]]\3'UHJXODWRU7KHVZLWFKLQJPRGHEHWZHHQWKHVHVXESUREOHPVLVDOVRFRQVLGHUHG7KH SODQWWKHVZLQJXSFRQWURODQGWKHVWDELOL]LQJV\VWHPDUHPRGHOHGDQGVWXGLHGLQWKH0DWODE6LPXOLQNHQYLURQPHQW

 ‹7KH$XWKRUV3XEOLVKHGE\(OVHYLHU%9 © 2013 The Authors. Published by Elsevier Ltd. 6HOHFWLRQDQGSHHUUHYLHZXQGHUUHVSRQVLELOLW\RI'HSDUWPHQWRI(OHFWULFDODQG&RPSXWHU(QJLQHHULQJ)DFXOW\RI(QJLQHHULQJ Selection and peer-review under responsibility of the Petru Maior University of Tirgu Mures. ³3HWUX0DLRU´8QLYHUVLW\RI7vUJX0XUH‫܈‬ .H\ZRUGVURWDWLRQDOLQYHUWHGSHQGXOXPVZLQJXSFRQWUROEDODQFHFRQWUROFRQYHQWLRQDO3'FRQWUROIX]]\3'FRQWURO

,QWURGXFWLRQ 7KH LQYHUWHG SHQGXOXP URWDWLRQDO RU QRW  KDV EHHQ ZLGHO\ VWXGLHG LQ PDQ\ DUHDV LQ ERWK OLQHDU DQG QRQOLQHDU FRQWURO7KHURWDWLRQDOLQYHUWHGSHQGXOXPFRQVLGHUHGLQWKHSDSHULVDFRPSOH[XQGHUDFWXDWHGPHFKDQLFDOV\VWHP 7KLV UHSUHVHQWDWLYH SUREOHP LQ WKH DSSOLFDWLRQ RI WKH FRQWURO WKHRU\ FDQ EH DQDO\]HG IURP PDQ\ SRLQWV RI YLHZ PXOWLYDULDEOH V\VWHPV QRQPLQLPXP SKDVH SURFHVV RU XQVWDEOH V\VWHPV VHYHUH QRQOLQHDU G\QDPLFV PRGHOLQJ 



&RUUHVSRQGLQJDXWKRU7HOID[ (PDLODGGUHVVVWHOLDQROWHDQ#LQJXSPUR

2212-0173 © 2013 The Authors. Published by Elsevier Ltd. Selection and peer-review under responsibility of the Petru Maior University of Tirgu Mures. doi:10.1016/j.protcy.2013.12.456

58

Stelian-Emilian Oltean / Procedia Technology 12 (2014) 57 – 64

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ƒ IURP WKH ILQDO YHUWLFDOO\ XSULJKW SRVLWLRQ WKH EDODQFHVWDELOL]LQJ FRQWURO V\VWHP LV LQWURGXFHG $OWKRXJK WKHUH DUH D YDULHW\ RI VROXWLRQVWKHVHWDVNVPXVWEHGRQHLQDVLPSOLILHGPDQQHUWRSURYLGHDEDVLVIRUIXUWKHUSK\VLFDOLPSOHPHQWDWLRQ 7KHUHPDLQLQJSDUWRIWKHSDSHULVRUJDQL]HGDVIROORZV,QVHFWLRQ,,WKHPDWKHPDWLFDOPRGHORIWKH5,3V\VWHP DQGLWVRSHQORRSUHVSRQVHVDUHSUHVHQWHG7KHVZLQJXSFRQWURORIWKHURWDWLRQDOLQYHUWHGSHQGXOXPFRQVLVWLQJLQD FDVFDGH FRQWURO VFKHPH ZLWKFRQYHQWLRQDO 3'UHJXODWRUV LV GHVFULEHG LQ VHFWLRQ,,,7KLV VHFWLRQ FRQWDLQV DOVR WKH EDODQFHVWDELOL]LQJFRQWUROVFKHPHXVLQJIX]]\3'VWUDWHJ\7KHVLPXODWLRQUHVXOWVDUHKLJKOLJKWHGLQWKHVHFWLRQ9 DQGVRPHFRQFOXVLRQVDUHPDGHLQWKHILQDOSDUWRIWKHSDSHU 7KHPRGHORIWKHURWDWLRQDOLQYHUWHGSHQGXOXP 'HVFULSWLRQRIWKHURWDWLRQDOLQYHUWHGSHQGXOXP 7KH URWDWLRQDO LQYHUWHG SHQGXOXP DOVR NQRZQ DV WKH )XUXWD SHQGXOXP  FRQVLVWV RI D URWDWLRQDO VHUYR PRWRU V\VWHPZKLFKGULYHVDQLQGHSHQGHQWRXWSXWJHDU$URWDWLRQDOSHQGXOXPDUPVHH)LJD RIUDGLXVUDQGPDVVPU LVPRXQWHGWRWKHRXWSXWJHDUDQGDSHQGXOXPRIOHQJWKODQGPDVVPLVDWWDFKHGWRWKHKLQJHSRLQW3 7KHSLYRW DUP URWDWHV LQ D KRUL]RQWDO SODQH ;@ 7KH LQSXWV WR WKH IX]]\ V\VWHP DUH DQJOH HUURU İĮ LI WKH UHIHUHQFH LV WKH XSULJKW SRVLWLRQ WKHQ WKH DQJOH HUURU EHFRPHV WKH GLVSODFHG IURP WKH XSULJKW SRVLWLRQ  DQG WKH FKDQJH LQ DQJOH HUURU FİĮ 7KH RXWSXW IURP WKH IX]]\ V\VWHPLVWKHYROWDJHXP7KHXQLYHUVHRIGLVFRXUVHRIWKHYDULDEOHVZDVQRUPDOL]HGWRFRYHUDUDQJHRI>@DQG VFDOLQJJDLQVJHJFJX ZHUHXVHGWRQRUPDOL]H7RVLPSOLI\WKHIXWXUHLPSOHPHQWDWLRQRIWKHFRQWUROOHUDVWDQGDUG FKRLFH IRU WKH PHPEHUVKLS IXQFWLRQV ZDV XVHG ZLWK ILYH PHPEHUVKLS IXQFWLRQV IRU WKH WKUHH IX]]\ YDULDEOHV PHDQLQJ UXOHVLQWKHUXOHEDVH DQGV\PPHWULFRYHUODSSLQJWULDQJXODUVKDSHGPHPEHUVKLSIXQFWLRQV )LJE PHDQLQJWKDWRQO\ UXOHVDWPRVWFDQEHDFWLYHDWDQ\JLYHQWLPH 7KH IX]]\ FRQWUROOHU LPSOHPHQWV D UXOH EDVH PDGH RI D VHW RI ,)7+(1 W\SH RI UXOHV 7KHVH UXOHV ZHUH GHWHUPLQHGKHXULVWLFDOO\EDVHGRQWKHNQRZOHGJHRIWKHSODQW7KHUHVXOWLQJUXOHWDEOHLVVKRZQLQ)LJD  7KH PLQPD[ LQIHUHQFH HQJLQH ZDV FKRVHQ ZKLFK IRU WKH SUHPLVHV XVHV PD[LPXP IRU WKH 25 RSHUDWRU DQG PLQLPXPIRUWKH$1'RSHUDWRU7KHFRQFOXVLRQRIHDFKUXOHLQWURGXFHGE\7+(1LVDOVRGRQHE\PLQLPXP7KH ILQDOFRQFOXVLRQIRUWKHDFWLYHUXOHVLVREWDLQHGE\WKHPD[LPXPRIWKHFRQVLGHUHGIX]]\VHWV 7RREWDLQ WKHFULVSRXWSXW WKH FHQWUH RI JUDYLW\ &2* GHIX]]LILFDWLRQPHWKRG LVXVHG 7KLV FULVS YDOXH LV WKH UHVXOWLQJFRQWUROOHURXWSXW 

63

Stelian-Emilian Oltean / Procedia Technology 12 (2014) 57 – 64

    

HN7 FN7  1% 16 = 36 D  3%

1% 3% 3% 3% 36 =

16 3% 3% 36 = 16

= 3% 36 = 16 1%

36 36 = 16 1% 1%

3% = 16 1% 1% 1%



1%16=363%

   

E 

)LJD )X]]\FRQWUROOHUUXOHWDEOHE )X]]\VHWVIRUWKHYDULDEOHV

6LPXODWLRQUHVXOWV

8P9 

TGHJ 

ņT ņTG

DGHJ 

7R VWXG\ WKH VLPXODWLRQ RI WKH URWDWLRQDO LQYHUWHG SHQGXOXP FRQWURO WKH V\VWHPV ZHUH PRGHOHG LQ 0DWODE 6LPXOLQNDQGWKHUHVXOWVDUHVKRZQLQ)LJ )LUVWGLDJUDPWHVWHGZDVWKHLQQHUORRSIURPWKHVZLQJXSFRQWUROSLYRWSRVLWLRQFRQWUROOHU DQGWKHUHVSRQVHVRI WKHFORVHGORRSV\VWHPWRWKHƒVWHSUHIHUHQFHDUHSUHVHQWHGLQ)LJD ,WFDQEHVHHQWKDWWKHUHVSRQVHKDVD RYHUVKRRWDQGWKHILUVWSHDNLVDWVHFRQG6RWKHSRVLWLRQFRQWUROOHUPHHWVWKHUHTXLUHGVSHFLILFDWLRQV )LJ  E  VKRZV DOVR WKDW WKH VZLQJXS FRQWURO V\VWHP DFKLHYHV LWV JRDO DQG WKH SHQGXOXP LV EURXJKW XS WKH FXUYH RI WKH DQJOH SDVVHV ƒ OLQH  LQ DERXW  VHFRQGV $V VWDWHG EHIRUH WKH VZLQJXS WLPH FDQ EH UHGXFHG E\ DGGLQJDQLPSXOVLYHFRQWUROZKLFKZLOOLQFUHDVHWKHHQHUJ\LQWKHV\VWHP

WVHF 

WVHF 

D  WVHF  

ƒ

DGHJ 

TGHJ 

8P9 



WVHF 

WVHF 

WVHF 

WVHF 

DGHJ 

TGHJ 

8P9 



E 

WVHF 



F  WVHF 

 )LJD 6LJQDOVIURPWKHDUPSRVLWLRQFRQWUROE 6LJQDOVIURPWKHVZLQJXSFRQWUROF 6LJQDOVIURPWKHEDODQFHVWDELOL]LQJFRQWURO



64

Stelian-Emilian Oltean / Procedia Technology 12 (2014) 57 – 64

$IWHU WKLV SURFHVV WKH 5,3 FRQWURO LV WDNHQ E\ WKH EDODQFHVWDELOL]DWLRQ IX]]\ V\VWHP 7R VWXG\ WKH EDODQFHVWDELOL]DWLRQIX]]\FRQWUROOHUDQLPSXOVHGLVWXUEDQFHZLWKDPSOLWXGHRIGHJUHHVDQGSHULRGRIVHFRQGV LVDGGHGWRWKHPHDVXUHGĮ)LJF KLJKOLJKWVWKDWWKHEDODQFHFRQWUROOHULVJRRGHQRXJKWRPDLQWDLQWKHSHQGXOXP LQWKHXSULJKWSRVLWLRQDQGNHHSLWWKHUHVWDEO\ &RQFOXVLRQV ,Q WKLV SDSHU WKH URWDWLRQDO LQYHUWHG SHQGXOXP 5,3 FRQWURO KDV EHHQ VWXGLHG 7KH 5,3 FRQWURO SUREOHP FDQ EH GLYLGHGLQVHYHUDOWDVNV)LUVWWKHSHQGXOXPPXVWEHEURXJKWXSIURPLWVVWDEOHSRVLWLRQQDPHGGRZQZDUGSRVLWLRQ  7KLV ZDV GRQH XVLQJ D FDVFDGH FRQWURO VFKHPH ZLWK WZR FRQYHQWLRQDO 3' FRQWUROOHUV 7KH LQQHU ORRS KDV D 3' SRVLWLRQFRQWUROOHURIWKHSLYRWDUPZKLOHRQWKHRXWHUORRSLVWKHVZLQJXSFRQWUROOHU6RWKHWDVNLVDFKLHYHGLQ DERXW  VHFRQGV )URP WKLV SRLQW WKH EDODQFHVWDELOL]LQJ FRQWURO LV PDGH E\ WKH IX]]\3' V\VWHP 7KH PRGHUQ V\VWHP ZDV LPSOHPHQWHG NQRZLQJ WKH SDUWLFXODU QDWXUH RI WKH 5,3 V\VWHP FRQVLVWV LQ QRQOLQHDULWLHV PRGHOLQJ XQFHUWDLQWLHV DQG LQVWDELOLW\ DQG LQYHVWLJDWHG HYHQ LQ WKH SUHVHQFH RI VPDOO LPSXOVH SHUWXUEDWLRQV 7R PDNH WKH ZKROHFRQWUROSURFHVVJOREDOO\VWDEOHDVLPSOHVZLWFKLQJFULWHULRQEDVHGRQDWKUHVKROGIRUWKHSHQGXOXPDQJOHZDV DOVRDWWHPSWHG7KHFRQWUROVWUDWHJLHVH[SHULHQFHGLQWKLVSDSHUFDQDOVREHDSSOLHGWRRWKHUFRPSOH[V\VWHPV 5HIHUHQFHV >@ 2UWHJD56SRQJ0:*RPH](VWHUQ)%ODQNHQVWHLQ*6WDELOL]DWLRQRIDFODVVRIXQGHUDFWXDWHGPHFKDQLFDOV\VWHPVYLDLQWHUFRQQHFWLRQ DQGGDPSLQJDVVLJQPHQW,(((7UDQVDFWLRQVRQ$XWRPDWLF&RQWURO >@ 6SRQJ0:%ORFN'-7KH3HQGXERWDPHFKDWURQLFV\VWHPIRUFRQWUROUHVHDUFKDQGHGXFDWLRQ3URFHHGLQJVRIWKHWK,(((&RQIHUHQFH RQ'HFLVLRQDQG&RQWURO1HZ2UOHDQV/$ >@ 0HL++H=6WXG\RQVWDELOLW\FRQWUROIRUVLQJOHOLQNURWDU\LQYHUWHGSHQGXOXP,QWHUQDWLRQDO&RQIHUHQFHRQ0HFKDQLF$XWRPDWLRQDQG &RQWURO(QJLQHHULQJ0$&(:XKDQ >@ *UDVVHU)'¶$UULJR$&RORPEL65XIHU$&-2($PRELOHLQYHUWHGSHQGXOXP,(((7UDQVDFWLRQVRQ,QGXVWULDO(OHFWURQLFV  >@ 3KXRQJ17/RF+'7KXDQ74&RQWURORIWZRZKHHOHGLQYHUWHGSHQGXOXPXVLQJVLOGLQJPRGHWHFKQLTXH,QWHUQDWLRQDO-RXUQDORI (QJLQHHULQJ5HVHDUFKDQG$SSOLFDWLRQV >@ 3DUN0.LP@ :DQJ=&KHQ@ 0HOED0DU\30DULPXWKX160LQLPXPWLPHVZLQJXSDQGVWDELOL]DWLRQRIURWDU\LQYHUWHGSHQGXOXPXVLQJSXOVHVWHSFRQWURO,UDQLDQ -RXUQDORI)X]]\6\VWHPV >@ @7RUUHV3RPDOHV:*RQ]DOH]251RQOLQHDUFRQWURORIVZLQJXSLQYHUWHGSHQGXOXP3URFHHGLQJVRIWKH,(((,QWHUQDWLRQDO&RQIHUHQFHRQ FRQWURODSSOLFDWLRQ'HDUERUQ0, >@@+DVVDQ]DGHK,0RED\HQ6&RQWUROOHUGHVLJQIRUURWDU\LQYHUWHGSHQGXOXPV\VWHPXVLQJHYROXWLRQDU\DOJRULWKPV0DWKHPDWLFDO3UREOHPVLQ (QJLQHHULQJSDJHV >@$WNHVRQ&*6DQWDPDULD-&$FRPSDULVRQRIGLUHFWDQGPRGHOEDVHGUHLQIRUFHPHQWOHDUQLQJ3URFHHGLQJVRIWKH,(((,QWHUQDWLRQDO &RQIHUHQFHRQ5RERWLFVDQG$XWRPDWLRQ± >@3DVVLQR.0@'XND$9$EUXGHDQ06LPXODWLRQRID)X]]\3'/HDUQLQJ&RQWURO6\VWHP,(((,QWHUQDWLRQDO&RQIHUHQFHRQ$XWRPDWLRQ4XDOLW\DQG 7HVWLQJ5RERWLFV