A simple nonlinear control of two wheeled welding mobile robot

,QWHUQDWLRQDO-RXUQDORI&RQWURO$XWRPDWLRQDQG6\VWHPV9RO1R0DUFK





$6LPSOH1RQOLQHDU&RQWURORID7ZR:KHHOHG 
:HOGLQJ0RELOH5RERW



7URQJ+LHX%XL7DQ7LHQ1JX\HQ7DQ/DP&KXQJDQG6DQJ%RQJ.LP




$EVWUDFW7KLVSDSHUSURSRVHVDVLPSOHUREXVWQRQOLQHDUFRQWUROOHUEDVHGRQ/\DSXQRYVWDELO
LW\IRUWUDFNLQJWKHUHIHUHQFHZHOGLQJSDWKDQGYHORFLW\RIDWZRZKHHOHGZHOGLQJPRELOHURERW
:05
 7KH V\VWHP KDV WKUHH GHJUHHVRI IUHHGRP LQFOXGLQJ WZR ZKHHOVDQGRQH WRUFK VOLGHU
7RUFKVOLGHUPRWLRQLVXVHGIRUIDVWHUWUDFNLQJEHFDXVHWKHZHOGLQJVSHHGLVYHU\VORZ&RQWURO
ODZLVREWDLQHGIURP WKH/\DSXQRYFRQWUROIXQFWLRQWRHQVXUH WKHDV\PSWRWLFDOVWDELOLW\RIWKH
V\VWHP7KHFRQWUROOHUKDVWKUHHIUHHSDUDPHWHUVIRUDGMXVWLQJWKHSHUIRUPDQFHRIWKHFRQWUROOHG
V\VWHP$VLPSOHZD\RIPHDVXULQJWKHHUURUVXVLQJWZRSRWHQWLRPHWHUVLVLQWURGXFHG7KHHI
IHFWLYHQHVVRIWKHSURSRVHGFRQWUROOHULVVKRZQWKURXJKVLPXODWLRQUHVXOWV

.H\ZRUGV:HOGLQJPRELOHURERW:05
WUDFNLQJZHOGLQJSDWKUHIHUHQFH

,1752'8&7,21

7RGD\WKHZHOGLQJSURFHVVLVVWURQJO\HQFRXUDJHG
IRU LPSURYHPHQWV LQ TXDOLW\ SURGXFWLYLW\ DQG ODERU
FRQGLWLRQV ,Q QDYDO FRQVWUXFWLRQ WKH DXWRPDWLRQ
ZHOGLQJ SURFHVV LV XOWLPDWHO\ QHFHVVDU\ VLQFH WKH
ZHOGLQJ VLWHV DUH VSDWLDOO\ HQFORVHG E\ IORRUV DQG
JLUGHUV DQG WKH ZHOGHUV DUH H[SRVHG WR VHYHUH ZRUN
LQJ FRQGLWLRQV 7R VROYH WKLV SUREOHP VRPH URERWLF
ZHOGLQJV\VWHPVKDYHUHFHQWO\EHHQGHYHORSHG6DQ
WRVHWDO>@GHYHORSHGWKH52:(5V\VWHPDFRP
SOH[IRXUOHJJHGPRELOHSODWIRUPZHOGLQJPDFKLQH
IRUDSSOLFDWLRQLQWKHQDYDOFRQVWUXFWLRQSURFHVV.LP
HW DO >@ SURSRVHG D V\VWHP RI YLVXDO VHQVLQJ DQG
ZHOGLQJ HQYLURQPHQW UHFRJQLWLRQ IRU LQWHOOLJHQW
VKLS\DUGZHOGLQJURERWV-HRQHWDO>@DQG.DPHWDO
>@SURSRVHGDVLPSOHZHOGLQJPRELOHURERW :05

IRU ODWWLFHW\SH RI ZHOGLQJ 7KH :05 FRPELQHV D
SODWIRUP RI D WZRZKHHOHG PRELOH URERW DQG D WRUFK
VOLGHUWKDWFDUULHVWKHZHOGLQJHOHFWURGHVRWKH:05
KDVSURSHUWLHVRIDWZRZKHHOHGPRELOHURERW
$ PRELOH URERW LV RQH RI WKH ZHOONQRZQ V\VWHPV
BBBBBBBBBB

0DQXVFULSWUHFHLYHG)HEHXDU\DFFHSWHG-XO\

7URQJ+LHX %XL LV ZLWK WKH 'HSDUWPHQW RI 0HFKDQLFDO
(QJLQHHULQJ&ROOHJHRI(QJ3XN\RQJ1DWLRQDO8QLYHUVLW\
.RUHDHPDLOKLHXSNQX#\DKRRFRP

7DQ7LHQ1JX\HQLVZLWKWKH'HSDUWPHQWRI0HFKDQLFDO

(QJLQHHULQJ +RFKLPLQK &LW\ 8QLYHUVLW\ RI 7HFKQRORJ\
9LHWQDPHPDLOWLHQQW#\DKRRFRP

7DQ/DP &KXQJ LV ZLWK WKH 'HSDUWPHQW RI 0HFKDQLFDO
(QJLQHHULQJ&ROOHJHRI(QJ3XN\RQJ1DWLRQDO8QLYHUVLW\
.RUHDHPDLOFKXQJWDQODP#\DKRRFRP

6DQJ%RQJ .LP LV ZLWK WKH 'HSDUWPHQW RI 0HFKDQLFDO
(QJLQHHULQJ&ROOHJHRI(QJ3XN\RQJ1DWLRQDO8QLYHUVLW\
.RUHDHPDLONLPVE#PDLOSNQXDFNU


ZLWK QRQKRORQRPLF FRQVWUDLQV DQG PDQ\ ZRUNV RQ
WUDFNLQJFRQWUROPHWKRGVIRUPRELOHURERWVDUHDYDLO
DEOHLQWKHOLWHUDWXUH.DQD\DPDHWDO>@SURSRVHGD
VWDEOH WUDFNLQJ FRQWURO PHWKRG IRU D QRQKRORQRPLF
YHKLFOHXVLQJWKH/\DSXQRYIXQFWLRQLQZKLFKWKHHU
URU FRQILJXUDWLRQ LV GHILQHG DQG WKH HUURU G\QDPLFV
DUHXVHGIRUGHULYLQJWKHFRQWUROOHU6DUNDUHWDO>@
SURSRVHGDQRQOLQHDUIHHGEDFNWKDWJXDUDQWHHVLQSXW
RXWSXWVWDELOLW\DQG/DJUDQJHVWDELOLW\IRUWKHRYHUDOO
V\VWHP )LHUURU >@ GHYHORSHG D FRPELQHG NL
QHWLFWRUTXH FRQWURO ODZ XVLQJ D EDFNVWHSSLQJ DS
SURDFK=HQJDQG0RRUH>@GHDOWZLWKWLPHRSWLPDO
FRQWUROVWUDWHJLHVIRUPRELOHURERWVWRWUDFNDPRYLQJ
WDUJHW ZLWK WKH 3RQWU\DJLQ PD[LPXP SULQFLSOH DQG6DUNDU>@IRFXVHGRQNLQHPDWLFVDQGFRQWURORI
DYHKLFOHZLWKWZRVWHHUDEOHZKHHOVXVLQJDG\QDPLF
IHHGEDFNOLQHDUL]DWLRQ0XNKHUMHHHWDO>@SURSRVHG
DQ DV\PSWRWLF IHHGEDFN VWDELOL]DWLRQ RI D QRQ

KRORQRPLF PRELOH URERW XVLQJ D QRQOLQHDU RVFLOODWRU
7D\EHL >@ SUHVHQWHG D EDFNVWHHSLQJ SURFHGXUH IRU
WKH GHVLJQ RI GLVFRQWLQXRXV WLPHLQYDULDQW VWDWH
IHHGEDFN FRQWUROOHUV IRU WKH VWDELOL]DWLRQ RI QRQ
KRORQRPLF V\VWHPV DQG DQ H[SRQHQWLDOO\ VWDELOL]LQJ
DGDSWLYHFRQWUROOHUIRUFRQGLWLRQVLQZKLFKLQSXWVGLV
WXUEDQFHVH[LVW7VXFKLDHWDO>@GHVLJQHGDFRQWURO
OHU EDVHG RQ WKH NLQHPDWLF PRGHO E\ H[WHQGLQJ WKH
/\DSXQRYFRQWURO)XNDRHWDO>@GHDOWZLWKWKHDGDS
WLYHWUDFNLQJ FRQWURORI D WZRZKHHOHG PRELOH URERW
$QDGDSWLYHODZZDVSURSRVHGIRUXSGDWLQJWKHHUURU
RI XQNQRZQ SDUDPHWHUV /HH HW DO>@ XVHG D VDWXUD
WLRQIHHGEDFNFRQWUROOHUIRUWUDFNLQJFRQWURORIDXQL
F\FOHPRGHOHGPRELOH
-HRQHWDO>@DSSOLHGWKHWZRZKHHOHGPRELOHURERW
IRU ZHOGLQJ DXWRPDWLRQ -HRQ SURSRVHG D VHDP
WUDFNLQJDQGPRWLRQFRQWURORI:05IRUODWWLFHW\SH
ZHOGLQJ7KUHHFRQWUROOHUVZHUHDYDLODEOHIRUFRQWURO




,QWHUQDWLRQDO-RXUQDORI&RQWURO$XWRPDWLRQDQG6\VWHPV9RO1R0DUFK

OLQJ VWUDLJKW DQG WXUQLQJ ORFRPRWLRQ DQG WKH WRUFK
VOLGHU.DPSURSRVHGDFRQWURODOJRULWKPIRUVWUDLJKW
ZHOGLQJ EDVHG RQ ¦WULDO DQG HUURU§ PHWKRG LQ HDFK
VWHS WLPH 7KH VHDPWUDFNLQJ VHQVRU PRYHV WRJHWKHU
ZLWKWKHWRUFKVOLGHU,IWKHUHLVDQ¦HUURU§WKHFRQWURO
OHU ZLOO DGMXVW WKH :05 PRWLRQ EDVHG RQ SUH

SURJUDPPHG VFKHGXOH 7KH FRQWUROOHUV DUH XVHG RQO\
IRUVWUDLJKWOLQHWUDFNLQJDQGFDQQRWEHH[WHQGHGIRUD
VPRRWK FXUYHGOLQH WUDFNLQJ %RWK FRQWUROOHUV SUR
SRVHG E\ -HRQ DQG .DP KDYH EHHQ VXFFHVVIXOO\ DS
SOLHG IRU UHDO V\VWHPV EXW ERWK FRQWUROOHUV DUH FRP
SOH[ DQG H[SHULHQFH ORVV RI JHQHUDOLW\ ZKHQ DOO\LQJ
IRUJHQHUDOVPRRWKSDWKWUDFNLQJ
7KLV SDSHU SURSRVHV D VLPSOH QRQOLQHDU FRQWUROOHU
EDVHGRQWKH/\DSXQRYFRQWUROIXQFWLRQWRHQKDQFHWKH
WUDFNLQJSURSHUWLHVRIWKH:057RGHVLJQDWUDFNLQJ
SHUIRUPDQFHDQHUURUFRQILJXUDWLRQLVGHILQHGDQGWKH
FRQWUROOHULVGHVLJQHGWRGULYHWKHHUURUWR]HURDVIDVW
DV GHVLUHG 7KH FRQWUROOHG V\VWHP DWWDLQV /\DSXQRY
VWDELOLW\ 7R GHVLJQ D FRQWUROOHU D VLPSOH PHWKRG IRU
PHDVXULQJWKHHUURUVXVLQJSRWHQWLRPHWHUVLVSURSRVHG
7ZR FDVHV DUH FRQVLGHUHG IL[HG WRUFK DQG FRQWUROOHG
WRUFK :05V 7KH :05 KDV D JHRPHWULFDO SURSHUW\
WKHZHOGLQJSRLQWLVRXWVLGHLWVZKHHOVDQGLVIDUIURP
LWVFHQWHU7KLVSURSHUW\OHDGVWRWKHVORZFRQYHUJHQFH
RI WUDFNLQJ HUURUV LQ WKH FDVH RI D IL[HG WRUFK :05
7KLV GLVDGYDQWDJH FDQ EH RYHUFRPH E\ XVLQJ D FRQ
WUROOHGWRUFKVOLGHU7KHVLPXODWLRQIRUD:05ZLWKD
VWUDLJKW ZHOGLQJ SDWK VKRZV WKH HIIHFWLYHQHVV RI WKH
SURSRVHGFRQWUROOHU

6<67(002'(/,1*
7KH:05XVHGLQWKLVSDSHULVWKH056/PRGHO
ZKLFKZDVGHYHORSHGE\&,0(&/DE3XN\RQJ1D
WLRQDO 8QLYHUVLW\ DQG ZDV XVHG IRU -HRQ DQG .DP©V
ZRUNVHWDO>@7KHPRGHOLVSUHVHQWHGLQ)LJ7KLV

:05 PRGHO ZDV RULJLQDOO\ GHYHORSHG WR DXWRPDWL
FDOO\ ZHOG WKH VWUDLJKWOLQH EXW ZLWK DQ DSSURSULDWH
FRQWUROOHU DV VKRZQ LQ WKLV SDSHU LW FDQ EH XVHG IRU
ZHOGLQJDVPRRWKFXUYHGOLQH%\LQFOXGLQJWKHZHOG
LQJWRUFKPRWLRQLQWRWKHV\VWHPG\QDPLFVWKHZHOG
LQJ URERW FDQ WUDFN WKH UHIHUHQFH SDWK DQG ZHOGLQJ
VSHHGZHOO
:HDVVXPHWKDWWKHZKHHOVUROODQGDYRLGVOLSSLQJ
7KHNLQHPDWLFHTXDWLRQRIWKH:05DQGWKHUHODWLRQ
RILWVFRRUGLQDWHVZLWKLWVUHIHUHQFHZHOGLQJSDWKDUH
VKRZQLQ)LJ7KHRUGLQDU\IRUPRIDPRELOHURERW
ZLWKWZRDFWXDWHGZKHHOVFDQEHGHULYHGDVIROORZV

ª [ º
« \ »
« »
«¬I »¼

ªFRV I  º
« VLQ I  » ª Y º              

«
» «Z »
¬ ¼
«¬ 
 »¼

ZKHUH &[ \
 LV WKH &DUWHVLDQ FRRUGLQDWH RI WKH
:05©V FHQWHU SRLQW I LV WKH KHDGLQJ DQJOH RI WKH 
















ZHOGLQJWRUFK



ZKHHOGULYLQJPRWRUV



VHQVRU



SUR[LPLW\VHQVRU



WRUFKVOLGHU



ORZHUOLPLWVZLWFK



WRUFKVOLGHUGULYLQJPRWRU 

GULYLQJZKHHOV

)LJ :05FRQILJXUDWLRQ




:05 DQG Q DQG Z DUH WKH VWUDLJKW DQG DQJXODU YH
ORFLWLHVRIWKH:05DWLWVFHQWHUSRLQW
7KHUHODWLRQVKLSEHWZHHQQZDQGWKHDQJXODUYHORFL
WLHVRIWKHWZRGULYLQJZKHHOVLV
ªZUZ º
«Z »
¬ OZ ¼

ª U E  U º ª Y º
« U E  U » «Z »             


¬
¼ ¬ ¼

ZKHUH ZUZ  ZOZ  UHSUHVHQW WKH DQJXODU YHORFLWLHV RI
WKHULJKWDQGOHIWZKHHOV E  LVWKHGLVWDQFHIURPWKH
:05©V FHQWHU SRLQW WR WKH GULYLQJ ZKHHO DQG U  LV
GULYLQJZKHHOUDGLXV7KHZHOGLQJSRLQWFRRUGLQDWHV
:  [Z  \Z
 DQG WKH KHDGLQJ DQJOH IZ  FDQ EH FDOFX
ODWHGIURPWKH:05©VFHQWHUSRLQW 
­ [Z [  O VLQ I 
°
® \Z \  O FRV I                 

°I I 
¯ Z
+HQFHZHKDYH
­ [Z
°°
® \ Z
°
°¯ IZ

Y FRV I  OZ FRV I  O VLQ I 
Y VLQ I  OZ VLQ I  O FRVI           

ZZ 


\

H
 [U  \ U  I U


5

\U
H
\Z

:
 [Z  \ Z  I Z


WRUFK
VOLGHU
\

UHIHUHQFH
ZHOGLQJSDWK

IU I
O

H

<

E

;

U  [U  \U


&  [ \I

U
[Z [U

[

I

[

)LJ 6FKHPHIRUGHULYLQJWKHNLQHPDWLFHTXDWLRQV
RI:05




,QWHUQDWLRQDO-RXUQDORI&RQWURO$XWRPDWLRQDQG6\VWHPV9RO1R0DUFK

$ UHIHUHQFH SRLQW 5 [U  \U
 PRYLQJ ZLWK WKH FRQ
VWDQWYHORFLW\RI YU RQWKHUHIHUHQFHSDWKKDVWKHFR
RUGLQDWHV  [U  \U
 DQG WKH KHDGLQJ DQJOH IU  VDWLV

ILHVWKHG\QDPLFHTXDWLRQ
­ [U
°
® \ U
°
¯IU

YU FRV IU 
YU VLQ I                 

ZU 
G

ZKHUH IU  LV GHILQHG DV WKH DQJOH EHWZHHQ YU  DQG
G
[  FRRUGLQDWHV DQG ZU  LV WKH UDWH RI FKDQJH RI YU 
GLUHFWLRQ

&21752//(5'(6,*1
2XU REMHFWLYH LV WR GHVLJQ D FRQWUROOHU VR WKDW WKH
ZHOGLQJSRLQW : WUDFNVWRWKHUHIHUHQFHSRLQW5:H
GHILQHWKHWUDFNLQJHUURUV H >H  H  H @7 DVVKRZQLQ
)LJDV
ª H º
«H »
« »
«¬ H »¼

ª FRV I
«  VLQ I

«
«¬ 

VLQ I

º
FRV I »»

 »¼

ª [U  [Z º
« \  \ »        

Z»
« U
«¬ IU  IZ »¼

:HZLOOGHVLJQDFRQWUROOHUWRDFKLHYH HL o   ZKHQ
W o f DQGKHQFHWKHZHOGLQJSRLQW :  WUDFNVWRLWV
UHIHUHQFHSRLQW 5 :HZLOOFRQVLGHUWZRFDVHVXVLQJ
DQGRPLWWLQJWKHWRUFKVOLGHU

)L[HGWRUFKOHQJWK
,QWKLVFDVHWKHWRUFKLVDGMXVWHGRQO\EHIRUHZHOG
LQJ$QJXODUYHORFLWLHVRIWKHOHIWZKHHODQGWKHULJKW
ZKHHO DUH WKH WZR LQSXWV WR WKH V\VWHP :KHQ WRUFK
OHQJWK O  LVFRQVWDQWIURP(TV
ZHFDQFRQ
ILUPWKDW HL  VDWLVILHV
ª H º

«H »
« »
«¬ H »¼

ªYU FRV H º ª  H  O º
ªYº
« Y VLQ H »  « 
H »» « »