Proceedings of The 2024 IEEE International

Conference on Real-time Computing and Robotics

June 24 - 28, 2024

.LQHPDWLFV DQG '\QDPLFV 0RGHOLQJ RI %LRQLF 9DULDEOH 6WUXFWXUH 8$9V

2024 IEEE International Conference on Real-time Computing and Robotics (RCAR) | 979-8-3503-7260-1/24/$31.00 ©2024 IEEE | DOI: 10.1109/RCAR61438.2024.10670985

+XDQKXDQ /RX 4LQJ[LDQJ :X 0HPEHU ,((( +DL :DQJ 7RQJ <DQJ 0HPEHU ,(((
+XDZDQJ /LX DQG 1LQJ 6XQ 6HQLRU 0HPEHU ,(((

$EVWUDFW² ,Q UHFHQW \HDUV TXDGURWRUV KDYH EHHQ ZLGHO\ PDQHXYHU WKURXJK QDUURZ SDVVDJHV RU QDYLJDWH REVWDFOHV HI
XVHG LQ PDQ\ ILHOGV DQG WKH UHTXLUHPHQWV IRU UHVFXH DQG IHFWLYHO\ 7R VROYH WKLV SUREOHP UHVHDUFKHUV KDYH WXUQHG WKHLU
H[SORUDWLRQ LQ QDUURZ DQG OLPLWHG HQYLURQPHQWV KDYH JUDGXDOO\ DWWHQWLRQ WR WKH GHYHORSPHQW RI YDULDEOH VWUXFWXUH TXDGURWRUV
LQFUHDVHG ,Q RUGHU WR LPSURYH WKH DGDSWDELOLW\ RI TXDGURWRUV
IRU OLPLWHG HQYLURQPHQWV WKLV SDSHU HVWDEOLVKHV WKH NLQHPDWLFV %\ LQWHJUDWLQJ IOH[LEOH RU PRUSKLQJ VWUXFWXUHV LQWR TXDGUR
DQG G\QDPLFV RI ELRQLF YDULDEOH VWUXFWXUH XQPDQQHG DHULDO WRU GHVLJQV UHVHDUFKHUV DLP WR HQKDQFH WKHLU DGDSWDELOLW\ DQG
YHKLFOH %968$9V  6SHFLILFDOO\ WKH IRXU DUPV RI %968$9V PDQHXYHUDELOLW\ 7KHVH GHIRUPDEOH VWUXFWXUHV DOORZ TXDGUR
FDQ URWDWH LQGHSHQGHQWO\ DURXQG WKH FHQWUDO ERG\ IUDPH WR WRUV WR DOWHU WKHLU VKDSH RU FRQILJXUDWLRQ LQ UHVSRQVH WR
UHDOL]H WKH FRQILJXUDWLRQ FKDQJH GXULQJ IOLJKW ZKLFK HQKDQFHV HQYLURQPHQWDO FRQVWUDLQWV HQDEOLQJ WKHP WR QDYLJDWH WKURXJK
WKH DGDSWDWLRQ IRU OLPLWHG HQYLURQPHQWV DQG FRPSOH[ WDVNV
VXFK DV QDUURZ VSDFH DQG FORVH VFDQQLQJ YHUWLFDO VXUIDFHV OLPLWHG VSDFHV ZLWK JUHDWHU HDVH DQG SUHFLVLRQ 3DUWLFXODUO\
+RZHYHU FRPSDUHG ZLWK IL[HGZLQJ 8$9V WKH FRQWURO RI TXDGFRSWHUV ZLWK IL[HG VWUXFWXUHV PD\ VWUXJJOH WR HIIHFWLYHO\
YDULDEOH VWUXFWXUH DQG DV\PPHWULF IRU %968$9 LV IXOO RI FRPSOHWH WDVNV LQ VFHQDULRV VXFK DV FROODSVHG EXLOGLQJV
FKDOOHQJHV DQG WKH PRGHOLQJ RI NLQHPDWLFV DQG G\QDPLFV LV UXJJHG WHUUDLQ RU FRQILQHG VSDFHV
LQWXLWLYHO\ LPSRUWDQW 7KHUHIRUH NLQHPDWLFV DQG G\QDPLFV IRU 5HFHQWO\ WKH ILHOG RI YDULDEOH VWUXFWXUH TXDGURWRUV KDV
%968$9V FRQVLGHULQJ WKH FKDQJH RI FHQWHU RI JUDYLW\ &R*
DQG WKH PRPHQW RI LQHUWLD 0R, DUH HVWDEOLVKHG :H DOVR VHHQ QRWDEOH DGYDQFHPHQWV ZLWK VFKRODUV LQYHVWLJDWLQJ GL
FDOFXODWHG WKH FRQWURO DOORFDWLRQ PDWUL[ %HVLGHV WKH SURWRW\SH YHUVH GHVLJQ PRGHOV DQG FRQWURO WDFWLFV WR HQKDQFH WKHLU HIIL
RI %968$9V LV EXLOW DQG WKH KRYHU SHUIRUPDQFH LV IXOO\ FLHQF\ LQ FKDOOHQJLQJ HQYLURQPHQWV 7KURXJK D FRPELQDWLRQ
YHULILHG RI WKHRUHWLFDO DQDO\VHV H[SHULPHQWDO YDOLGDWLRQ DQG VLPX
ODWLRQ VWXGLHV UHVHDUFKHUV DLP WR XQORFN WKH IXOO SRWHQWLDO
, ,1752'8&7,21 RI YDULDEOH VWUXFWXUH TXDGURWRUV DQG SDYH WKH ZD\ IRU WKHLU
4XDGURWRUV DV D NLQG RI 8$9V FKDUDFWHUL]HG E\ WKHLU SUDFWLFDO GHSOR\PHQW LQ UHDOZRUOG VFHQDULRV +RZHYHU LQ
VLPSOLFLW\ RI RSHUDWLRQ ORZ FRVW FRPSDFW VL]H DQG KLJK VWD FRPSOH[ HQYLURQPHQWV VXFK DV HDUWKTXDNHV ILUH VLWHV DQG
ELOLW\ KDYH IRXQG H[WHQVLYH DSSOLFDWLRQV LQ ERWK PLOLWDU\ DQG RXWGRRU FDYHV TXDGURWRUV QHHG WR SDVV WKURXJK QDUURZ JDSV
FLYLOLDQ GRPDLQV>@ >@ ,Q UHFHQW \HDUV WKH VZLIW DGYDQFH 7KHUHIRUH PDQ\ UHVHDUFK WHDPV KDYH PDGH HIIRUWV WR VWXG\
PHQW RI TXDGFRSWHUV DQG RWKHU XQPDQQHG DHULDO YHKLFOHV GHIRUPDEOH TXDGURWRUV ,Q GHWDLO .DUDQMRW 6LQJK HW DO >@
KDV LJQLWHG VLJQLILFDQW LQWHUHVW DFURVV ERWK WKH UHVHDUFK DQG GHVLJQ D GXDOD[LV WLOWDEOH TXDGURWRU QDPHG 4XDG3OXV WKH
FRPPHUFLDO VHFWRUV>@ >@ >@ >@ >@ >@ >@ 6SHFLILFDOO\ PDQHXYHUDELOLW\ RI WKH TXDGURWRU LV HIIHFWLYHO\ LPSURYHG LQ
LQ PLOLWDU\ FRQWH[WV TXDGURWRUV VHUYH YLWDO UROHV LQ UHFRQQDLV QDUURZ WHUUDLQ DQG WKH HIIHFWLYHQHVV RI WKH V\VWHP LV YHULILHG
VDQFH VXUYHLOODQFH WDUJHW SRVLWLRQLQJ DQG VWULNH PLVVLRQV E\ VLPXODWLRQ 6 + HW DO >@ GHVLJQ D GHIRUPDEOH TXDGURWRU
:LWKLQ FLYLOLDQ VSKHUHV TXDGFRSWHUV DUH ZLGHO\ XVHG LQ DQG SURSRVHG D JHQHUDO PRGHO FRQVLGHULQJ WKH FHQWHU RI PDVV
YDULRXV ILHOGV LQFOXGLQJ SDFNDJH GHOLYHU\>@ LQIUDVWUXFWXUH &R0 DQG URWDWLRQ YDULDEOHV $GGLWLRQDOO\ +X HW DO>@
PRQLWRULQJ WUDQVSRUWDWLRQ SUHFLVLRQ DJULFXOWXUH>@ DHULDO SURSRVH D WUDQVIRUPDEOH TXDGURWRU IHDWXULQJ D URWDWLQJ DUP
PDSSLQJ DQG LPDJLQJ >@ >@ +RZHYHU GHVSLWH WKHLU IRU FRQILJXUDWLRQ DOWHUDWLRQ 7KH\ DGGUHVV PRGHOLQJ DQG FRQ
QXPHURXV DGYDQWDJHV TXDGURWRUV IDFH VLJQLILFDQW FKDOOHQJHV WURO FKDOOHQJHV SRVHG E\ WKH G\QDPLF VWUXFWXUH 0HDQZKLOH
ZKHQ RSHUDWLQJ LQ FRPSOH[ DQG FRQILQHG HQYLURQPHQWV VXFK TXDGURWRUV ZLWK YDULDEOH VWUXFWXUH KDV DWWUDFWHG WKH LQWHUHVW RI
DV HDUWKTXDNH VLWHV ILUH VFHQHV RU RXWGRRU H[SORUDWLRQ ,Q PDQ\ UHVHDUFK WHDPV >@ >@ >@ $OWKRXJK WKHVH YDULDEOH
VXFK VFHQDULRV WUDGLWLRQDO TXDGURWRU GHVLJQV PD\ VWUXJJOH WR VWUXFWXUH TXDGURWRUV KDYH WKHLU RZQ LQQRYDWLRQV LQ VWUXFWXUH
WKH\ DUH VWLOO GLIILFXOW WR DGDSW WR FRPSOH[ HQYLURQPHQWV GXH
7KLV ZRUN ZDV VXSSRUWHG E\ WKH 1DWLRQDO 1DWXUDO 6FLHQFH )RXQGD WR WKHLU KLJK PHFKDQLFDO UHGXQGDQF\ DQG ODUJH RYHUDOO VL]H
WLRQ RI &KLQD XQGHU *UDQW  DQG  WKH 7LDQMLQ 6FLHQFH ,Q WKLV SDSHU D QRYHO ELRQLF YDULDEOH VWUXFWXUH XQPDQQHG
)XQG IRU 'LVWLQJXLVKHG <RXQJ 6FKRODUV XQGHU *UDQW -&-4-& WKH DHULDO YHKLFOH %968$9 LV SUHVHQWHG DV VKRZ LQ )LJ 
*XDQJGRQJ %DVLF DQG $SSOLHG %DVLF 5HVHDUFK )RXQGDWLRQ XQGHU *UDQW
$ WKH &KLQD 3RVWGRFWRUDO 6FLHQFH )RXQGDWLRQ XQGHU *UDQW ZKLFK FDQ VLJQLILFDQWO\ LPSURYH WKH DELOLW\ RI TXDGURWRUV
0 DQG WKH 6WDWH .H\ /DERUDWRU\ RI 5RERWLFV DQG 6\VWHPV +,7 WR SDVV WKURXJK QDUURZ VSDFH FORVH VFDQQLQJ REVWDFOH
XQGHU *UDQW 6./56.) &RUUHVSRQGLQJ DXWKRU 4LQJ[LDQJ :X DYRLGDQFH DQG RWKHU WDVNV $W WKH VDPH WLPH FRQVLGHULQJ
7KH DXWKRUV DUH ZLWK WKH ,QVWLWXWH RI 5RERWLFV DQG $XWRPDWLF ,Q
IRUPDWLRQ 6\VWHPV ,5$,6  &ROOHJH RI $UWLILFLDO ,QWHOOLJHQFH 1DQNDL WKH GLIILFXOW\ RI FRQWUROOLQJ %968$9V 7KH NLQHPDWLFV DQG
8QLYHUVLW\ 7LDQMLQ  &KLQD DQG ZLWK WKH ,QVWLWXWH RI ,QWHOOLJHQFH G\QDPLFV RI %968$9V DUH IRUPXODWHG OHDGLQJ WR WKH FUH
7HFKQRORJ\ DQG 5RERWLF 6\VWHPV 6KHQ]KHQ 5HVHDUFK ,QVWLWXWH RI 1DQNDL DWLRQ RI D %968$9 SURWRW\SH 7KHVH PRGHOV DUH YDOLGDWHG
8QLYHUVLW\ 6KHQ]KHQ  &KLQD HPDLO ORXKK#PDLOQDQNDLHGXFQ
ZXT[#QDQNDLHGXFQ ZDQJKDL#PDLOQDQNDLHGXFQ \DQJW#QDQNDLHGXFQ WKURXJK KRYHU FRQWURO WHVWV XQGHU YDU\LQJ FRQILJXUDWLRQV
KXDZDQJO#QDQNDLHGXFQ VXQQ#QDQNDLHGXFQ  FRQILUPLQJ WKHLU DFFXUDF\ DQG VWDELOLW\

979-8-3503-7260-1/24/$31.00 ©2024 IEEE 592

Authorized licensed use limited to: Polytechnic University of Bucharest. Downloaded on March 22,2025 at 09:50:46 UTC from IEEE Xplore. Restrictions apply.
 )LJ  0RGHO RI %968$9V

)LJ  3ULQFLSOH RI %968$9V

7KH SDSHU VWUXFWXUH LV DV IROORZV 6HFWLRQ ,, RXWOLQHV WKH
GHIRUPDWLRQ PHWKRG IRU %968$9V 6HFWLRQ ,,, GHYHORSV
WKHLU NLQHPDWLFV G\QDPLFV DQG FRQWURO DOORFDWLRQ 6HFWLRQ
,9 GHWDLOV WKH SURWRW\SH DQG KRYHU WHVWV WR YDOLGDWH SHUIRU
PDQFH 6HFWLRQ 9 VXPPDUL]HV WKH ILQGLQJV

,, '()250$7,21 675$7(*<

$V VKRZQ LQ )LJ  %968$9V FDQ IROG WKH IRXU DUPV
IRU GLIIHUHQW FRQILJXUDWLRQV (DFK DUP LV FRQQHFWHG WR WKH
ERG\ RI %968$9V DQG GULYHQ E\ PRWRUV IRU URWDWLQJ LQ
)LJ  5RWDWLRQ GLUHFWLRQ RI TXDGFRSWHU SURSHOOHUV
GHSHQGHQWO\ 'LIIHUHQW FRQILJXUDWLRQV VLJQLILFDQWO\ LPSURYH
WKH %968$9 DGDSWDELOLW\ DQG PDQHXYHUDELOLW\ 6SHFLIL
FDOO\ %968$9V FDQ EH WUDQVIRUPHG IURP WKH VWDQGDUG
RWKHU FRQILJXUDWLRQ ZKHUH θ2 = θ3 = π2 , θ1 = θ4 = 0 :KHQ
;FRQILJXUDWLRQ IRU D VSHFLILF PLVVLRQ FRQILJXUDWLRQ %96
LW LV QHFHVVDU\ WR SDVV WKURXJK D YHUWLFDO QDUURZ SLSH %96
8$9V ZLWK +FRQILJXUDWLRQ FDQ HDVLO\ SDVV WKURXJK QDUURZ
8$9V DUH WUDQVIRUPHG LQWR LQ DQ ॽFRQILJXUDWLRQ ZKHUH
VSDFH %968$9V ZLWK ॽFRQILJXUDWLRQ KDYH REYLRXV DG
θ1 = θ2 = θ3 = θ4 = 34π 
YDQWDJHV ZKHQ SDVVLQJ WKURXJK UHVWULFWHG SLSHOLQHV DQG WKH
IODW DUPV RI 7FRQILJXUDWLRQ FDQ DYRLG FROOLVLRQV DQG LPSURYH ,,, 02'(/,1*
WKH VDIHW\ RI %968$9V
7KH IROGLQJ VWUDWHJ\ RI %968$9V LV VKRZQ LQ )LJ  $Q $ 0RGHOLQJ LQ 6WDQGDUG &RQILJXUDWLRQ
LQHUWLDO FRRUGLQDWH V\VWHP ( DQG D ERG\ FRRUGLQDWH V\VWHP )RU VWDQGDUG ;FRQILJXUDWLRQ θ1 = θ2 = θ3 = θ4 = π4 
% DUH GHILQHG ZKHUH Oe xe ye ze LV WKH LQHUWLDO FRRUGLQDWH WKH &R0 RI %968$9V LV ORFDWHG LQ WKH JHRPHWULF FHQWHU
V\VWHP DQG Ob xb yb zb LV WKH ERG\ FRRUGLQDWH V\VWHP xe  )LUVW WKH NLQHPDWLFV DQG G\QDPLFV RI %968$9V ZLWK ;
D[LV LV IRUZDUG ye D[LV LV WR WKH ULJKW ze D[LV LV YHUWLFDO FRQILJXUDWLRQ DUH HVWDEOLVKHG
WR WKH JURXQG ,Q DGGLWLRQ xb D[LV yb D[LV DQG zb SRLQW 7KH SRVLWLRQ NLQHPDWLFV HTXDWLRQ RI %968$9V LV DV
WR WKH IURQW ULJKW DQG ERWWRP RI %968$9V UHVSHFWLYHO\ IROORZV
θi (i = 1, 2, .., 4) GHQRWHV WKH DUP DQJOHVDV VKRZQ LQ )LJ  ṗe = ve , 
b LV WKH OHQJWK RI %968$9 DUP 2l h GHQRWHV WKH OHQJWK   
DQG WKLFNQHVV RI %968$9 ERG\ UHVSHFWLYHO\ 7KH URWDWLRQ ZKHUH pe = x y z UHSUHVHQWV WKH FRRUGLQDWH SRVLWLRQ
GLUHFWLRQ RI IRXU URWRUV LV VKRZQ LQ )LJ  ZKHUH 12 RI %968$9V LQ WKH LQHUWLDO FRRUGLQDWH V\VWHP
12 SURSHOOHUV URWDWH FRXQWHUFORFNZLVH DQG 12 12 )XUWKHU WKH GLIIHUHQWLDWLRQ RI  FDQ EH FDOFXODWHG DV
SURSHOOHUV URWDWH FORFNZLVH  
)XUWKHU %968$9V FDQ EH VLPSOLILHG LQWR WKH IROORZLQJ ẋ ẏ ż = [ vx vy vz ] . 
WZR SDUWV WKH FHQWUDO ERG\ WKDW KROGV HOHFWURQLF HTXLSPHQW
$GGLWLRQDOO\ WKH FKDQJH UDWH RI DWWLWXGH DQJOHV KDV WKH
LQFOXGLQJ IOLJKW FRQWURO SDQHOV DQG EDWWHULHV IXU EUXVKOHVV
IROORZLQJ UHODWLRQVKLS ZLWK WKH URWDWLRQ DQJXODU VSHHG RI
PRWRUV ZLWK URWRUV WKDW URWDWH LQGHSHQGHQWO\ UHODWLYH WR WKH
%968$9 ERGLHV7KH UHODWLRQDO H[SUHVVLRQ DV IROORZV
FHQWUDO ERG\ 'XULQJ QRUPDO WDVNV %968$9V DGRSW DQ ;
FRQILJXUDWLRQ ZKLFK LV VLPLODU WR D WUDGLWLRQDO IL[HGZLQJ Θ̇ = W ω b , 
TXDGFRSWHUV DV VKRZQ LQ )LJ  ZKHUH θ1 = θ2 = θ3 = θ4 =  
π Θ = φ̇ θ̇ ψ̇
4  :KHQ LW LV QHFHVVDU\ WR SDVV WKURXJK QDUURZ VSDFH %96 ZKHUH Θ̇  DQG Θ LV WKH WKUHH DWWLWXGH
8$9V DUH WUDQVIRUPHG LQWR DQ +FRQILJXUDWLRQ ZKHUH θ1 = DQJOHV RI %968$9V LH (XOHU $QJOH φ LV WKH DQJOH
θ3 = π2 , θ2 = θ4 = 0 :KHQ LW LV QHFHVVDU\ WR DYRLG REVWDFOHV EHWZHHQ WKH TXDGURWRU DQG WKH xD[LV θ LV WKH DQJOH EHWZHHQ
DKHDG RU VFDQ FORVH WR WKH YHUWLFDO VXUIDFH IRU GHWHFWLRQ 7 WKH %968$9V DQG WKH yD[LV DQG ψ LV WKH DQJOH EHWZHHQ
W\SH FRQILJXUDWLRQ IRU %968$9V ZLOO EH EHWWHU WKDQ WKDW RI WKH %968$9V DQG WKH zD[LV ω b = [ ωxb ωyb ωzb ] =

593
Authorized licensed use limited to: Polytechnic University of Bucharest. Downloaded on March 22,2025 at 09:50:46 UTC from IEEE Xplore. Restrictions apply.
[ p q r ]  ZKHUH p, q, r GHQRWH WKH WKUHH FRPSRQHQWV RI )XUWKHU ZH FDQ DFTXLUH WKH IROORZLQJ HTXDWLRQV
DQJXODU YHORFLWLHV ω b IRU %968$9 ERGLHV $GGLWLRQDOO\
⎡ ⎤ ⎧
1 tan θ sin φ tan θ cos φ ṗ = J1xx [τx + qr(Jyy − Jzz )],
⎪
⎪
W =⎣ 0 cos φ − sin φ ⎦. ⎨
0 sin φ / cos θ cos φ / cos θ q̇ = J1yy [τy + pr(Jzz − Jxx )], 
⎪
⎪
⎩
7KHUHIRUH WKH DWWLWXGH NLQHPDWLF PRGHO RI %968$9V FDQ ṙ = J1zz [τz + pq(Jxx − Jyy )].
EH FRQFOXGHG DV
⎡ ⎤ ⎡ ⎤⎡ ⎤
φ̇ 1 tan θ sin φ tan θ cos φ p
⎣ θ̇ ⎦ = ⎣ 0 cos φ − sin φ ⎦⎣ q ⎦.  /HW [ U1 U2 U3 U4 ] = [ f τx τy τz ]  7KH
ψ̇ 0 sin φ / cos θ cos φ / cos θ r LQSXWV WR WKH G\QDPLF PRGHO DUH U1  U2  U3  DQG U4 
1H[W WKH SRVLWLRQ DQG DWWLWXGH G\QDPLFV RI %968$9V &RPELQHG  ZLWK   WKH G\QDPLF PRGHOV RI %968$9V
ZLOO EH LQWURGXFHG 7KH SRVLWLRQ G\QDPLFV HTXDWLRQ LV VKRZQ FDQ EH FDOFXODWHG
EHORZ ⎧
mv̇e = Ge − f b ,  ⎪
⎪ ẍ = − Um1 (cos ψ sin θ cos φ + sin ψ sin φ )
⎪
⎪
7KH YHFWRU GHQRWHG E\ e LV H[SUHVVHG ZLWKLQ WKH LQHUWLDO FRRU ⎪
⎪
⎪
⎪ ÿ = − Um1 (sin ψ sin θ cos φ − cos ψ sin φ )
GLQDWH V\VWHP ZKHUHDV b VLJQLILHV WKH YHFWRU DV UHSUHVHQWHG ⎪
⎪
⎪
⎨ z̈ = g − U1 cos φ cos θ
LQ WKH ERG\¶V FRRUGLQDWH V\VWHP 7R FRQYHUW WKH WHQVLRQ IRUFH m

f b IURP WKH ERG\ FRRUGLQDWH V\VWHP WR WKH LQHUWLDO FRRUGLQDWH ⎪
⎪ φ̈ = J1xx [U2 + qr(Jyy − Jzz )]
⎪
⎪
V\VWHP PXOWLSO\ LW E\ WKH URWDWLRQ PDWUL[ Reb RQ WKH OHIW VLGH ⎪
⎪
⎪
⎪ θ̈ = J1yy [U3 + pr(Jzz − Jxx )]
:H FDQ JHW WKH IROORZLQJ HTXDWLRQ ⎪
⎪
⎪
⎩ ψ̈ = 1 [U + pq(J − J )]
fb Jzz 4 xx yy
v̇e = ge − Reb , 
m
ZKHUH
⎡ ⎤
cθ cψ cψ sθ sφ − sψ cφ cψ sθ cφ + sψ sφ % &HQWHU RI *UDYLW\ DQG ,QHUWLD 7HQVRU
Reb = ⎣ cθ sψ sψ sθ sφ + cψ cφ sψ sθ cφ − cψ sφ ⎦ ,
−sθ sφ cθ cφ cθ :KHQ %968$9 HQWHUV WKH PLVVLRQ PRGH LWV FHQWHU RI
ZKHUH cθ LV WKH FRV IXQFWLRQ sθ LV WKH VLQ IXQFWLRQ )XUWKHU JUDYLW\ &R* ZLOO QR ORQJHU FRLQFLGH ZLWK WKH JHRPHWULF
 FDQ EH \LHOGHG DV FHQWHU 7KHUHIRUH WKH SRVLWLRQ RI &R* VKRXOG EH UHFDOFX
⎡ ⎤ ⎡ ⎤ ⎡ ⎤ ODWHG $GGLWLRQDOO\ WKH GHIRUPDWLRQ RI 968$9V ZLOO FKDQJH
v̇x 0 cψ sθ cφ + sψ sφ
f
⎣ v̇y ⎦ = ⎣ 0 ⎦ − ⎣ sψ sθ cφ − cψ sφ ⎦ . LWV PRPHQW RI LQHUWLD /HW rG ∈ R3 GHQRWH WKH &R* DQG LWV

v̇z g
m
cφ cθ FDOFXODWLRQ IRUPXOD LV DV IROORZV

$FFRUGLQJ WR (XOHU HTXDWLRQV ZH KDYH

mbody rbody + ma ra
J ω̇ b + ω b × J ω b = Ga + τ ,  rG = ,
mall
ZKHUH ω b LV WKH DQJXODU YHORFLW\ LQ WKH ERG\¶V FRRUGLQDWH
V\VWHP Ga LV J\URVFRSLF WRUTXH EXW IRU VLPSOLFLW\ ZH LJQRUH 4
LWV HIIHFW τ UHSUHVHQWV WKH WRUTXH FUHDWHG E\ WKH SURSHOOHU ZKHUH ma = ∑ (ma ra,i + mm rm,i + mr r,i ) mbody LV WKH PDVV
i=1
VSOLW LQWR UROO τx  SLWFK τy  DQG \DZ τz WRUTXHV DORQJ WKH ERG\ RI WKH %968$9 FHQWUDO ERG\ rbody LV WKH FHQWHU RI PDVV
D[HV 7KHUHIRUH WKH LQHUWLD PDWUL[ LV UHSUHVHQWHG DV &R0 IRU %968$9V ma LV WKH PDVV RI HDFK DUP RI %96
⎡ ⎤
Jxx 8$9V ra,i LV WKH &R0 RI HDFK DUP IRU TXDGFRSWHUV mr LV
J=⎣ Jyy ⎦.  WKH PDVV RI WKH EUXVKOHVV PRWRU RQ HDFK DUP rr,i LV WKH &R0
Jzz RI EUXVKOHVV PRWRUV RQ HDFK DUP mm LV WKH PDVV RI VHUYR
PRWRU IRU GULYLQJ HDFK DUP RI %968$9V rm,i LV WKH &R0
$GGLWLRQDOO\ ω b ¶V DQJXODU YHORFLW\ FRPSRQHQWV DORQJ WKH RI VHUYR PRWRUV mall LV WKH WRWDO PDVV RI %968$9V
ERG\ D[HV DUH p, q DQG r HTXLYDOHQW WR wx  wy DQG wz 
7R FDOFXODWH WKH PRPHQW RI LQHUWLD RI WKH TXDGURWRU ZH
UHVSHFWLYHO\ ⎡ ⎤ ⎡ ⎤
ωx p FDQ YLHZ %$98$9V DV D FRPELQDWLRQ RI WKH PRPHQWV RI
ω b = ⎣ ωy ⎦ = ⎣ q ⎦ .  LQHUWLD RI WKH LQGLYLGXDO SDUWV DQG FRPELQH WKHP E\ WKH
ωz r SDUDOOHO D[LV WKHRUHP 7KH FHQWUDO ERG\ LV FRQVLGHUHG DV D
UHFWDQJXODU SULVP ZLWK GLPHQVLRQV 2l, 2l DQG hbody  (DFK DUP
6XEVWLWXWLQJ  DQG  LQWR   LW FDQ EH FDOFXODWHG WKDW LV PRGHOHG DV D UHFWDQJXODU SULVP ZLWK GLPHQVLRQV b, wa  DQG
⎡ ⎤ ⎡ ⎤ ⎡ ⎤
Jxx ṗ qr(Jyy − Jzz ) τx ha  $GGLWLRQDOO\ VHUYR PRWRUV DUH PRGHOHG DV D F\OLQGHU ZLWK
⎣ Jyy q̇ ⎦ = ⎣ pr(Jzz − Jxx ) ⎦ + ⎣ τy ⎦ .  UDGLXV rm DQG KHLJKW hm  ZKLOH EUXVKOHVV PRWRUV DUH PRGHOHG
Jzz ṙ pq(Jxx − Jyy ) τz DV D F\OLQGHU ZLWK UDGLXV rr DQG KHLJKW hr  %DVHG RQ WKH DERYH

594
Authorized licensed use limited to: Polytechnic University of Bucharest. Downloaded on March 22,2025 at 09:50:46 UTC from IEEE Xplore. Restrictions apply.
GHVFULSWLRQV LW FDQ EH REWDLQHG $GGLWLRQDOO\ WRUTXH PDJQLWXGHV FDQ EH UHSUHVHQWHG DV
⎡ 2 ⎤
h + 4l 2
mbody ⎣ body ⎦, Mi = cM ϖi2 , 
Jbody = h2body + 4l 2
12
4l 2 + 4l 2 ZKHUH cM LV WKH FRQVWDQW 6LQFH WKH IRXU DUPV RI %968$9V
⎡ 2 ⎤
wa + h2a RQO\ URWDWH DURXQG WKH zb D[LV WKH WRWDO WKUXVW f DQG WKH \DZ
ma ⎣ ⎦,
Ja = h2a + b2 PRPHQW Tz UHPDLQ FRQVWDQW 7KH UROO PRPHQW Tx DQG WKH
12
w2a + b2 SLWFK PRPHQW Ty GHSHQG RQ WKH URWDWLRQ DQJOHV RI WKH IRXU
⎡ 2 ⎤
3r + h2m DUPV θi  7KXV WKH FRQWURO DOORFDWLRQ PDWUL[ LV H[SUHVVHG DV
mm ⎣ m 2 + h2 ⎦,
Jm = 3rmo m ⎡ ⎤ ⎡ 2 ⎤
12 2 f ϖ1
6rm
⎡ 2 ⎤ ⎢ τx ⎥ ⎢ ϖ2 ⎥
3r + h2r ⎢ ⎥ ⎢ 2 ⎥,
mr ⎣ r ⎣ τy ⎦ = A ⎣ ϖ 2 ⎦ 
Jr = 3rr2 + h2r ⎦. 3
12 2
τz ϖ42
6rr
:KHQ DUPV VHUYR PRWRUV DQG EUXVKOHVV PRWRUV URWDWH ZKHUH A LV FRQWURO DOORFDWLRQ PDWUL[ $ FDQ EH UHSUHVHQWHG
DURXQG WKH ERG\ FRRUGLQDWH V\VWHP D[LV WKHLU PRPHQWV RI LQ DV
⎡ ⎤
HUWLD DOVR URWDWH +RZHYHU VLQFH VHUYR PRWRUV DQG EUXVKOHVV e11 e12 e13 e14
PRWRUV DUH FRQVLGHUHG F\OLQGHUV WKHLU PRPHQWV RI LQHUWLD ⎢ e21 e22 e23 e24 ⎥
A=⎢ ⎣ e31 e32 e33
⎥,
GR QRW FKDQJH ZKHQ URWDWLQJ DERXW zD[LV 7KHUHIRUH WKH e34 ⎦
FKDQJH LQ WKH PRPHQWV RI LQHUWLD IRU PRWRUV DQG SURSHOOHUV e41 e42 e43 e44
FDQ EH LJQRUHG 7KH PRPHQW RI LQHUWLD RI D ERG\ LQKHUHQWO\
DOLJQV ZLWK LWV RZQ FRRUGLQDWH V\VWHP HOLPLQDWLQJ WKH QHHG ZKHUH e11 = e12 = e13 = e14 = cT , e21 = −cT (b cos θ1 +
IRU URWDWLRQDO DGMXVWPHQWV &RQVHTXHQWO\ WKH LQHUWLD RI DUPV l − rG,y ), e22 = cT (b cos θ2 + l − rG,y ), e23 = cT (b sin θ3 + l −
FDQ EH VWUDLJKWIRUZDUGO\ UHSUHVHQWHG LQ WKLV FRQWH[W rG,y ), e24 = −cT (b sin θ4 + l − rG,y ), e31 = cT (b sin θ1 + l −
rG,x ), e32 = −cT (b sin θ2 + l − rG,x ), e33 = cT (b cos θ3 + l −
Ja,i = Rz (θi )Ja Rz (θi ) , i ∈ (1, 2, 3, 4),  rG,x ), e34 = −cT (b cos θ4 + l − rG,x ), e41 = e42 = cM , e43 =
7KH URWDWLRQ PDWUL[ Rz (θi ) UHYROYHV DURXQG WKH zD[LV DQG LWV e44 = −cM .
YDOXH LV GHSHQGHQW RQ WKH YDULDEOH θi 
⎡ ⎤ ,9 (;3(5,0(176
cθi −sθi 0
Rz (θi ) = ⎣ sθi cθi 0 ⎦ .
0 0 1 $ ([SHULPHQWDO 3ODWIRUP

,Q VXPPDU\ WKH PRPHQW RI LQHUWLD IRU %968$9V ZLWK 7KH )LJ  GLVSOD\V WKH VHOIFRQVWUXFWHG SURWRW\SH RI %96
DQ\ FRQILJXUDWLRQ FDQ EH FDOFXODWHG DV IROORZV 8$9V ZKLFK PDLQO\ GLYLGHG LQWR IOLJKW FRQWURO PRGXOH ‚
IOLJKW GULYHQ PRGXOH ƒ YDULDEOH VWUXFWXUH GULYHQ PHFKDQLVP
4
J = Jbody − mbody [rbody − rG ]2 + ∑ msum ,  „ DQG YDULDEOH VWUXFWXUH FRQWURO PRGXOH  $GGLWLRQDOO\
i=1 WKH DUPV DUH PDGH RI FDUERQ ILEHU PDWHULDO WR LQFUHDVH
ZKHUH msum = Ja,i − ma,i [ra,i − rG ]2 + Jm,i − mm [rm,i − rG ]2 + VWLIIQHVV DQG VWUHQJWK HQVXULQJ VWDELOLW\ GXULQJ IOLJKW 7KH
Jr,i − mr,i [rr,i − rG ]2 . GURQH RI WKH FHQWUDO ERG\ LV PDQXIDFWXUHG XVLQJ ' SULQWLQJ
ZKHUH HOHFWURQLF GHYLFHV VXFK DV IOLJKW FRQWURO ERDUGV SRZHU
& &RQWURO $OORFDWLRQ GLVWULEXWLRQ ERDUGV VHUYR FRQWURO ERDUGV DQG EDWWHULHV DUH
7R DFKLHYH KRYHU RI %968$96 ZH QHHG WR FRQWURO WKH PDLQO\ FRQFHQWUDWHG )RXU +366* GLJLWDO VHUYRV DUH
YHORFLWLHV RI WKH TXDGFRSWHU LQ DOO VL[ GHJUHHV RI IUHHGRP XWLOL]HG WR GULYH WKH IRXU DUPV¶ URWDWLRQ SURYLGLQJ VLJQLILFDQW
WR EH ]HUR 7KHUHIRUH ZH QHHG WR PDNH WKH WKUXVW HTXDO WRUTXH WR HQKDQFH WKH GURQH¶V VWLIIQHVV 7KHVH VHUYRV DUH
WR WKH ZHLJKW DQG τx  τy  DQG τz HTXDO WR ]HUR 7R DF FRQWUROOHG E\ 3:0 VLJQDOV VHQW E\ DQ $UGXLQR FRQWURO
FXUDWHO\ FRQWURO %968$9V WKH UHODWLRQVKLS EHWZHHQ WKH ERDUG WR DFKLHYH WKH WDUJHW DQJOHV (DFK DUP HQGV ZLWK
FRQWURO LQSXWV [ U1 U2 U3 U4 ] = [ f τx τy τz ] D 7PRWRU )SUR,9  .9 EUXVKOHVV PRWRU UHJXODWHG
DQG WKH SURSHOOHU VSHHGV ϖi DIWHU REWDLQLQJ WKH G\QDPLF DQG E\ (0$; $ HOHFWURQLF VSHHG FRQWUROOHUV (6&V  7KHVH
NLQHPDWLF PRGHOV VKRXOG EH FDOFXODWHG (6&V UHFHLYH VSHHG FRQWURO FRPPDQGV IURP WKH IOLJKW FRQWURO
)RU WKH WKUXVW f RI D VLQJOH SURSHOOHU LQ WKH DEVHQFH ERDUG 7KH %968$9 XWLOL]HV D 3L[KDZN & IOLJKW FRQWURO
RI ZLQG GXULQJ KRYHU WKH WKUXVW RI WKH SURSHOOHU FDQ EH ERDUG RSHUDWLQJ DW  0+] ,W LV IXHOHG E\ D 6 OLWKLXP
H[SUHVVHG DV EDWWHU\ RI  P$K FDSDFLW\ 7KH HQWLUH V\VWHP LQFOXGLQJ
fi = cT ϖi2 ,  HOHFWURQLFV ZHLJKV J DQG KDV D GLDJRQDO ZKHHOEDVH
RI PP 6RPH LPSRUWDQW SDUDPHWHUV RI %968$9V DUH
ZKHUH cT LV D FRQVWDQW DQG ϖi LV WKH SURSHOOHU¶V URWDWLRQDO VKRZQ LQ 7DEOH , 7KH IRXU FRQILJXUDWLRQV RI %968$9V DUH
VSHHG VKRZQ LQ )LJ 

595
Authorized licensed use limited to: Polytechnic University of Bucharest. Downloaded on March 22,2025 at 09:50:46 UTC from IEEE Xplore. Restrictions apply.
 D ॽFRQILJXUDWLRQ E ;FRQILJXUDWLRQ

F +FRQILJXUDWLRQ G 7FRQILJXUDWLRQ
)LJ  0DLQ PRGXOHV RI %968$9V
)LJ  +RYHU H[SHULPHQWV RI %968$9V ZLWK GLIIHUHQW
FRQILJXUDWLRQV

7$%/( ,, 7KH DQJOHV RI WKH VHUYRV

&RQILJXUDWLRQ θ1 θ2 θ3 θ4
;FRQILJXUDWLRQ ◦ ◦ ◦ ◦
+FRQILJXUDWLRQ ◦ ◦ ◦ ◦
D ; E + 7FRQILJXUDWLRQ ◦ ◦ ◦ ◦
ॽFRQILJXUDWLRQ ◦ ◦ ◦ ◦

9 &21&/86,216
7KLV SDSHU FRQVWUXFWV NLQHPDWLF DQG G\QDPLF PRGHOV IRU
%968$9V 7R HQVXUH VWDEOH IOLJKW LQ DV\PPHWULF VHWXSV
ZH¶YH IRUPXODWHG D PRGHO ZLWK DGMXVWDEOH FHQWHU RI JUDYLW\
DQG PRPHQW RI LQHUWLD :H¶YH DOVR GHULYHG WKH FRQWURO DOOR
F ॽ G 7 FDWLRQ PDWUL[ )OLJKW WHVWV UHYHDO VWDEOH SHUIRUPDQFH DFURVV
)LJ  )RXU FRQILJXUDWLRQV RI %968$9V IRXU FRQILJXUDWLRQ PRGHV HQKDQFLQJ WKH 8$9¶V YHUVDWLOLW\
IRU FRPSOH[ WDVNV DQG QDUURZ VSDFHV
5ൾൿൾඋൾඇർൾඌ
7$%/( , 3DUDPHWHUV RI %968$9V >@ ' )ORUHDQR DQG 5 - :RRG ³6FLHQFH WHFKQRORJ\ DQG WKH IXWXUH RI
VPDOO DXWRQRPRXV GURQHV´ 1DWXUH YRO  QR  SS ±
3DUDPHWHUV 9DOXHV 
>@ 5 $XVWLQ 8QPDQQHG DLUFUDIW V\VWHPV 8$96 GHVLJQ GHYHORSPHQW DQG
0DVV  J GHSOR\PHQW -RKQ :LOH\ 6RQV 
:KHHOEDVH  PP >@ * +RIIPDQQ + +XDQJ 6 :DVODQGHU DQG & 7RPOLQ ³4XDGURWRU
9ROWDJH  9 KHOLFRSWHU IOLJKW G\QDPLFV DQG FRQWURO 7KHRU\ DQG H[SHULPHQW´ LQ
%DWWHU\ FDSDFLW\  P$K $,$$ JXLGDQFH QDYLJDWLRQ DQG FRQWURO FRQIHUHQFH DQG H[KLELW 
S 
>@ 3 &DVWLOOR 5 /R]DQR DQG $ ']XO ³6WDELOL]DWLRQ RI D PLQLURWRUFUDIW
KDYLQJ IRXU URWRUV´ LQ  ,(((56- LQWHUQDWLRQDO FRQIHUHQFH RQ
LQWHOOLJHQW URERWV DQG V\VWHPV ,526 ,((( &DW 1R &+ 
YRO  ,(((  SS ±
>@ 6 *XSWH 3 , 7 0RKDQGDV DQG - 0 &RQUDG ³$ VXUYH\ RI
TXDGURWRU XQPDQQHG DHULDO YHKLFOHV´ LQ  3URFHHGLQJV RI ,(((
6RXWKHDVWFRQ  SS ±
% +RYHU ([SHULPHQWV ZLWK 'LIIHUHQW &RQILJXUDWLRQV >@ 5 & /HLVKPDQ - & 0DFGRQDOG 5 : %HDUG DQG 7 : 0F/DLQ
³4XDGURWRUV DQG DFFHOHURPHWHUV 6WDWH HVWLPDWLRQ ZLWK DQ LPSURYHG
G\QDPLF PRGHO´ ,((( &RQWURO 6\VWHPV 0DJD]LQH YRO  QR  SS
$V VKRZQ LQ )LJ  WKH KRYHU H[SHULPHQWV ZLWK GLIIHUHQW ± 
FRQILJXUDWLRQV DUH FRQGXFWHG LQ WKH DFWXDO H[SHULPHQW ZH >@ $ 7D\HEL DQG 6 0F*LOYUD\ ³$WWLWXGH VWDELOL]DWLRQ RI D YWRO TXDGURWRU
DLUFUDIW´ ,((( 7UDQVDFWLRQV RQ &RQWURO 6\VWHPV 7HFKQRORJ\ YRO 
QHHG WR HQVXUH WKDW WKHUH LV D FHUWDLQ VDIH GLVWDQFH EHWZHHQ QR  SS ± 
WKH SURSHOOHUV DQG WKH HOHFWURQLF FRPSRQHQWV DW WKH FHQWHU RI >@ + %RXDGL 0 %RXFKRXFKD DQG 0 7DGMLQH ³0RGHOOLQJ DQG VWDEL
WKH ERG\ 7KHUHIRUH WKH DFWXDO DQJOHV RI WKH IRXU VHUYRV DUH OL]LQJ FRQWURO ODZV GHVLJQ EDVHG RQ VOLGLQJ PRGH IRU DQ XDY W\SH
TXDGURWRU´ ,)$& 3URFHHGLQJV 9ROXPHV YRO  QR  SS ±
DV VKRZQ LQ 7DEOH ,, ([SHULPHQWDO UHVXOWV GHPRQVWUDWH WKDW 
EDVHG RQ WKH NLQHPDWLFV DQG G\QDPLFV PRGHO HVWDEOLVKHG LQ >@ 0 <. &KXD ) 5 <X - /L < =KRX DQG / /DPRQW ³0HGLXP
WKLV SDSHU WKH LPSOHPHQWDWLRQ GLVWULEXWLRQ DQG DGMXVWPHQW DFFHVV FRQWURO IRU XQPDQQHG DHULDO YHKLFOH 8$9 DGKRF QHWZRUNV
ZLWK IXOOGXSOH[ UDGLRV DQG PXOWLSDFNHW UHFHSWLRQ FDSDELOLW\´ ,(((
RI %968$9 WRUTXH XQGHU GLIIHUHQW FRQILJXUDWLRQV FDQ EH 7UDQVDFWLRQV RQ 9HKLFXODU 7HFKQRORJ\ YRO  QR  SS ±
DFKLHYHG WKHUHE\ DFKLHYLQJ D VWDEOH KRYHULQJ JRDO 

596
Authorized licensed use limited to: Polytechnic University of Bucharest. Downloaded on March 22,2025 at 09:50:46 UTC from IEEE Xplore. Restrictions apply.
>@ 3 0 .RUQDWRZVNL 0 )HURVNKDQ : - 6WHZDUW DQG ' )ORUHDQR ³$
PRUSKLQJ FDUJR GURQH IRU VDIH IOLJKW LQ SUR[LPLW\ RI KXPDQV´ ,(((
5RERWLFV DQG $XWRPDWLRQ /HWWHUV YRO  QR  SS ± 
>@ 8 5 0RJLOL DQG % 'HHSDN ³5HYLHZ RQ DSSOLFDWLRQ RI GURQH V\VWHPV
LQ SUHFLVLRQ DJULFXOWXUH´ 3URFHGLD &RPSXWHU 6FLHQFH YRO  SS
± 
>@ 5 6KDUPD ³5HYLHZ RQ DSSOLFDWLRQ RI GURQH V\VWHPV LQ SUHFLVLRQ
DJULFXOWXUH´ -RXUQDO RI $GYDQFHG 5HVHDUFK LQ (OHFWURQLFV (QJLQHHULQJ
DQG 7HFKQRORJ\ YRO  QR  SS ± 
>@ 3 0 .RUQDWRZVNL 0 )HURVNKDQ : - 6WHZDUW DQG ' )ORUHDQR ³$
PRUSKLQJ FDUJR GURQH IRU VDIH IOLJKW LQ SUR[LPLW\ RI KXPDQV´ ,(((
5RERWLFV DQG $XWRPDWLRQ /HWWHUV YRO  QR  SS ± 
>@ . 6LQJK 0 0HKQGLUDWWD DQG 0 )HURVNKDQ ³4XDGSOXV GHVLJQ
PRGHOLQJ DQG UHFHGLQJKRUL]RQEDVHG FRQWURO RI D K\SHUG\QDPLF
TXDGURWRU´ ,((( 7UDQVDFWLRQV RQ $HURVSDFH DQG (OHFWURQLF 6\VWHPV
YRO  QR  SS ± 
>@ 6 'HUURXDRXL 0 *XLDWQL < %RX]LG , 'LE DQG 1 0RXGMDUL ³'\
QDPLF PRGHOLQJ RI D WUDQVIRUPDEOH TXDGURWRU´ LQ  ,QWHUQDWLRQDO
&RQIHUHQFH RQ 8QPDQQHG $LUFUDIW 6\VWHPV ,&8$6  ,((( 
SS ±
>@ ' +X = 3HL - 6KL DQG = 7DQJ ³'HVLJQ PRGHOLQJ DQG FRQWURO RI
D QRYHO PRUSKLQJ TXDGURWRU´ ,((( 5RERWLFV DQG $XWRPDWLRQ /HWWHUV
YRO  QR  SS ± 
>@ < %DL DQG 6 *XUXUDMDQ ³(YDOXDWLRQ RI D EDVHOLQH FRQWUROOHU IRU
DXWRQRPRXV ¶ILJXUH¶ IOLJKWV RI D PRUSKLQJ JHRPHWU\ TXDGFRSWHU
)OLJKW SHUIRUPDQFH´ 'URQHV YRO  QR  S  
>@ ' )DODQJD . .OHEHU 6 0LQWFKHY ' )ORUHDQR DQG ' 6FDUDPX]]D
³7KH IROGDEOH GURQH $ PRUSKLQJ TXDGURWRU WKDW FDQ VTXHH]H DQG IO\´
,((( 5RERWLFV DQG $XWRPDWLRQ /HWWHUV YRO  QR  SS ±

>@ 0 =KDR 7 $Q]DL ) 6KL ; &KHQ . 2NDGD DQG 0 ,QDED
³'HVLJQ PRGHOLQJ DQG FRQWURO RI DQ DHULDO URERW GUDJRQ $ GXDOURWRU
HPEHGGHG PXOWLOLQN URERW ZLWK WKH DELOLW\ RI PXOWLGHJUHHRIIUHHGRP
DHULDO WUDQVIRUPDWLRQ´ ,((( 5RERWLFV DQG $XWRPDWLRQ /HWWHUV YRO 
QR  SS ± 

597
Authorized licensed use limited to: Polytechnic University of Bucharest. Downloaded on March 22,2025 at 09:50:46 UTC from IEEE Xplore. Restrictions apply.