Attitude Control of a Satellite by Using Digital Signal
Processing
Adrielle C. Santana1, Luiz S. MartinsFilho1,*, Ricardo O. Duarte2, Gilberto Arantes Jr.3, Ivan S. Casella1
8QLYHUVLGDGH)HGHUDOGR$%&6DQWR$QGUp63%UD]LO
8QLYHUVLGDGH)HGHUDOGH0LQDV*HUDLV%HOR+RUL]RQWH0*%UD]LO 3 8QLYHUVLWlW%UHPHQ%UHPHQ*HUPDQ\
Abstract:7KLVDUWLFOHKDVGLVFXVVHGWKHGHYHORSPHQWRIDWKUHHD[LVDWWLWXGHGLJLWDOFRQWUROOHUIRUDQDUWL¿FLDO satellite using a digital signal processor. The main motivation of this study is the attitude control system of the VDWHOOLWH0XOWL0LVVLRQ3ODWIRUPGHYHORSHGE\WKH%UD]LOLDQ1DWLRQDO,QVWLWXWHIRU6SDFH5HVHDUFKIRUDSSOLFDWLRQLQ GLIIHUHQWVRUWRIPLVVLRQV7KHFRQWUROOHUGHVLJQZDVEDVHGRQWKHWKHRU\RIWKH/LQHDU4XDGUDWLF*DXVVLDQ5HJXODWRU V\QWKHVL]HGIURPWKHOLQHDUL]HGPRGHORIWKHPRWLRQRIWKHVDWHOOLWHLHWKHNLQHPDWLFVDQGG\QDPLFVRIDWWLWXGH 7KHDWWLWXGHDFWXDWRUVFRQVLGHUHGLQWKLVVWXG\DUHSDLUVRIFROGJDVMHWVSRZHUHGE\DSXOVHZLGWKSXOVHIUHTXHQF\ PRGXODWRU,QWKH¿UVWVWDJHRIWKHSURMHFWGHYHORSPHQWDV\VWHPFRQWUROOHUIRUFRQWLQXRXVWLPHZDVVWXGLHGZLWK the aim of testing the adequacy of the adopted control. The next steps had included an analysis of discretization WHFKQLTXHVWKHVHWWLQJWLPHRIVDPSOLQJUDWHDQGWKHWHVWLQJRIWKHGLJLWDOYHUVLRQRIWKH/LQHDU4XDGUDWLF*DXVVLDQ 5HJXODWRUFRQWUROOHULQWKH0$7/$%6,08/,1.7RIXO¿OOWKHVWXG\WKHFRQWUROOHUZDVLPSOHPHQWHGLQDGLJLWDO VLJQDOSURFHVVRUVSHFL¿FDOO\WKH%ODFN¿Q%)IURP$QDORJ'HYLFHVDORQJZLWKWKHSXOVHZLGWKSXOVHIUHTXHQF\ modulator. The validation tests used a scheme of cosimulation, where the model of the satellite was simulated in 0$7/$%6,08/,1.ZKLOHWKHFRQWUROOHUDQGPRGXODWRUZHUHSURFHVVHGLQWKHGLJLWDOVLJQDOSURFHVVRUZLWKD WRROFDOOHG3URFHVVRU,QWKH/RRSZKLFKDFWHGDVDGDWDFRPPXQLFDWLRQOLQNEHWZHHQERWKHQYLURQPHQWVIXQFWLRQ and required time to achieve a given mission accuracy are determined, and results are provided as illustration.
Keywords:6DWHOOLWH$WWLWXGH&RQWURO/LQHDU4XDGUDWLF*DXVVLDQ&RQWURO'LJLWDO6LJQDO3URFHVVRU3XOVH:LGWK Pulse Frequency Modulation.
INTRODUCTION
7KHGHYHORSPHQWRIVDWHOOLWHVLQ%UD]LOKDVEHFRPHLQWKH ODVWGHFDGHVDVXEMHFWRIH[WUHPHLPSRUWDQFH7KHHFRQRPLF UHOHYDQFHDQGVWUDWHJLFUROHIRUWKHQDWLRQDUHDSSHDOLQJ7KHUH DUHVFLHQWL¿FDQGWHFKQRORJLFDOHIIRUWVIURPWKHJRYHUQPHQWLQ RUGHUWRVWLPXODWHWKHVSDFHUHVHDUFK7KHUHDUHDOVRLQUHVHDUFK FHQWHUVDQGLQWKHSULYDWHVHFWRU1RZDGD\VPDQ\DFWLYLWLHV DUH DVVRFLDWHG ZLWK WKH DFKLHYHPHQWV DQG WHFKQRORJLFDO EUHDNWKURXJKLQVSDFH7KHDSSOLFDELOLW\RIVDWHOOLWHVFDQEH IRXQGIRUDODUJHQXPEHURISXUSRVHVHJWHUUHVWULDOPDULWLPH DQGDHULDOQDYLJDWLRQE\XVLQJ*36FRPPXQLFDWLRQZHDWKHU IRUHFDVWLQJHWF
___________________
5HFHLYHG$FFHSWHG
DXWKRU IRU FRUUHVSRQGHQFH OXL]PDUWLQV#XIDEFHGXEU $Y GRV (VWDGRV%DQJ~6DQWR$QGUp63%UD]LO
FRQVLVWV RI D FDUULHU PRGXOH WKDW FDQ LQFRUSRUDWH GLIIHUHQW SD\ORDGV IRU GLIIHUHQW DSSOLFDWLRQV VXFK DV WKH$PD]RQ VDWHOOLWHIRU(DUWKREVHUYDWLRQDQGVXUYHLOODQFH
7KH 003 VDWHOOLWH LV EHLQJ GHYHORSHG DW WKH 1DWLRQDO ,QVWLWXWHIRU6SDFH5HVHDUFK,13(DFURQ\PVLQ3RUWXJXHVH $FFRUGLQJ WR WKH GLUHFWRU RI ,13( *LOEHUWR &DPDUD WKH %UD]LOLDQVSDFHLQGXVWU\LVFKDUDFWHUL]HGE\WKHVSHFLDOL]DWLRQLQ GLIIHUHQWDUHDVVXFKDVFDPHUDVIRUUHPRWHVHQVLQJVWUXFWXUHV HWF +RZHYHU WKHUH LV QR FRPSDQ\ LQ WKH FRXQWU\ DEOH WR GHYHORSRUWKDWKROGVWKHWHFKQRORJ\RIDQ$&'+V\VWHP7KLV LVDUHVXOWRIQRVSHFLDOL]HGPDQSRZHU7KHDFWXDOHGXFDWLRQDO IRUPDWLRQLVIRFXVHGRQWKHGHYHORSPHQWRIKDUGZDUHEXWQRW VRIWZDUH0LOHVNL
,QWKLVFRQWH[WWKHREMHFWLYHRIWKLVSDSHUZDVWRFRQWULEXWH WRRYHUFRPHWKLVODFNRIWHFKQRORJLFDOFDSDELOLW\7KLVSDSHU VWXGLHVDQDWWLWXGHFRQWUROV\VWHP$&6PRUHVSHFL¿FDOO\ DGLJLWDOV\VWHPIRUDWWLWXGHFRQWUROIRUWKUHHD[LVVWDELOL]HG VDWHOOLWHV 7KH GHYHORSPHQW RQ DQ HPEHGGHG V\VWHP LV DGGUHVVHG,QWKLVFDVHWKHLQIRUPDWLRQREWDLQHGE\WKHVHQVRUV LVSHUIRUPHGE\DGLJLWDOVLJQDOSURFHVVRU'637KHFRQWUROOHU GHVLJQ LV EDVHG XSRQ D OLQHDUTXDGUDWLF *DXVVLDQ /4* RSWLPDOFRQWUROZKLFKLVDZHOONQRZQFRQWUROWKHRU\LQWHUPV RIVSDFHDSSOLFDWLRQV7KHGHVLJQFRPELQHVD.DOPDQ¿OWHUDQG DOLQHDUTXDGUDWLFUHJXODWRU/45FRQWUROODZ
,Q DGGLWLRQ ZLWKLQ WKH V\QWKHVLV RI WKH FRQWURO ODZ ZH DGRSWHG D SXOVHZLGWK SXOVH IUHTXHQF\ 3:3) PRGXODWRU ZKLFKLVUHVSRQVLEOHIRUPRGXODWLQJWKHVLJQDOFRQWUROVHQWWRWKH UHDFWLRQWKUXVWHUVWKDWDUHFRQVLGHUHGLQWKLVZRUN7KHTXDOLW\ RIDQ$&6XVLQJSURSXOVLRQFRQWUROOHUVLVVWURQJO\LQÀXHQFHG E\ WKH PRGXODWLRQ RI WKH FRQWURO FRPPDQG7KHUHIRUH WKH SUDFWLFDOLVVXHRIWUDQVODWLQJWKHFRQWLQXRXVGHVLUHGVLJQDOWRDQ RQRIIVLJQDOLVGRQH
THE MMP SATELLITE
7KH 003 VDWHOOLWH LV D SURMHFW EDVHG RQ DQ DGYDQFHG FRQFHSWLQWHUPVRIDUFKLWHFWXUHRIDVDWHOOLWH,WLQWHQGVWR EULQJ WRJHWKHU LQ RQH YHUVDWLOH SODWIRUP DOO HTXLSPHQW WKDW DUH HVVHQWLDO WR WKH RSHUDWLRQ RI D VDWHOOLWH VXFK DV SRZHU JHQHUDWLRQDQGGLVWULEXWLRQDWWLWXGHFRQWURODQGSURSXOVLRQ HWF,WFDQDFFRPSOLVKDYDULHW\RIDSSOLFDWLRQVZLWKGLIIHUHQW RUELWVDQGPLVVLRQUHTXLUHPHQWV
,QWKLVDUFKLWHFWXUHWKHUHLVDSK\VLFDOVHSDUDWLRQEHWZHHQ WKHSODWIRUPDQGWKHSD\ORDGPRGXOH7KHUHDIWHUERWKPRGXOHV FDQEHGHVLJQEXLOWDQGWHVWHGVHSDUDWHO\EHIRUHWKHLQWHJUDWLRQ DQG¿QDODVVHPEO\DQGWHVWLQJRIWKHVDWHOOLWH7KHDGYDQWDJH
DVVRFLDWHG ZLWK WKH 003 FRQFHSW LV WKH FRVW UHGXFWLRQ LQ PDQXIDFWXUHRIWKHVDWHOOLWHLHWKHQDYLJDWLRQPRGXOHZRXOG EHWKHVDPHXQOHVVDQ\XSGDWHVDQGXSJUDGHVDUHLPSOHPHQWHG UHJDUGOHVVRIWKHSD\ORDGKRVWLQJWKH003)LJXUHLOOXVWUDWHV WKH003,13(
6RPH DSSOLFDWLRQV DUH DOUHDG\ SODQQHG IRU WKH 003 LQFOXGLQJ WKH ¿UVW 5HPRWH 6HQVLQJ 6DWHOOLWH 665 DOVR QDPHG$PD]RQLD7KH$PD]RQLDZLOOEHHTXLSSHGZLWK LQVWUXPHQWDWLRQIRULPDJLQJDZLGH¿HOGLPDJHU$:),IXOO GHYHORSHGLQ%UD]LO,WLVDOVRHTXLSSHGZLWKWUDQVSRQGHUVIRU FROOHFWLQJGDWDIURPGDWDFROOHFWLQJSODWIRUPV'&3VZKLFK FDQEHXVHGIRU:HDWKHU)RUHFDVWLQJDQG&OLPDWH6WXGLHVLQ %UD]LO,13(,WVDSSOLFDWLRQVLQFOXGHHYDOXDWLRQDQG HVWLPDWLRQRISURGXFWLYLW\LQFXOWLYDWHGDUHDVDQGPRQLWRULQJ RISROOXWLRQLQFRDVWDODUHDV7KHPDLQREMHFWLYHRIWKHPLVVLRQ LVWKHDFTXLVLWLRQRIGDWDIRUPRQLWRULQJWKH$PD]RQV\VWHP 7KH5HPRWH6HQVLQJ6DWHOOLWH665DOVRNQRZQDV0XOWL $SSOLFDWLRQ3XUSRVH6$50$36$5LVDQRWKHUFDQGLGDWH WRDIXWXUHPLVVLRQEDVHGRQ0030$36$5LVWKHUHVXOWRI DMRLQWVWXG\FRQGXFWHGE\,13(DQGWKH*HUPDQ$HURVSDFH &HQWHU'/5WDUJHWLQJDPLVVLRQIRUDVVHVVPHQWPDQDJHPHQW DQGPRQLWRULQJRIQDWXUDOUHVRXUFHVFRPSULVLQJFDUWRJUDSK\ IRUHVWU\ JHRORJ\ JHRPRUSKRORJ\ K\GURORJ\ DJULFXOWXUH GLVDVWHU PDQDJHPHQW RFHDQRJUDSK\ XUEDQ VWXGLHV DQG VHFXULW\6FKU|GHUet al
Attitude model: kinematics and dynamics
WKHVDWHOOLWH,WVRULJLQFRLQFLGHVZLWKWKHFHQWHURIWKHPDVVRI WKHVDWHOOLWH7KHD[LVz0 RIWKH/9/+IUDPHLVGH¿QHGE\WKH VDWHOOLWHUDGLXVYHFWRUWKHD[LVy0 E\WKHRUELWDOQRUPDODQGWKH D[LVx0 FRPSOHWHVDULJKWKDQGHGFRRUGLQDWHIUDPH
7KHERG\RUVDWHOOLWHFRRUGLQDWHIUDPHx ,y ,zKDVLWVRULJLQ LQWKHFHQWHURIPDVVRIWKHVDWHOOLWH 7KHLUD[HVFRLQFLGHZLWKWKHSULQFLSDOD[HVRILQHUWLDRIWKH ERG\7KHQRPLQDORUWKHGHVLUHGDWWLWXGHLVRQHWKDWWKHD[HV RIWKHUHIHUHQFHERG\DUHDOLJQHGZLWKWKRVHRIWKHUHIHUHQFH IUDPH/9/+:LHDQG$UDSRVWDWKLV7KH(XOHU¶VDQJOHV DUHXVHGWRSDUDPHWHUL]HWKHDWWLWXGHWKHVHTXHQFHRIURWDWLRQV LVFKRVHQ7KHURWDWLRQPDWUL[LVJLYHQE\(TXDWLRQ 6KXVWHU R
c c s c s
c s s s c c c s s s s c
s s c s c s c c s s c c
x X
} i } i i
z } z i } z } z i } z i
z } z i } z } z i } z i -- + + + - + = R T S S SS V X W W WW 7KHNLQHPDWLFVHTXDWLRQLVREWDLQHGE\WKHWLPHGHULYDWLYH RIWKHURWDWLRQPDWUL[HTXDWLRQ6KXVWHUWKHQ(T ( ) ( ) ( )
R t
o
=S^
~ th
R t7KH NLQHPDWLFV HTXDWLRQ FDQ EH VLPSOLILHG LI RQH FRQVLGHUV VPDOO DQJOH PDQHXYHUV LQ WKLV FDVH ZH FDQ DSSUR[LPDWHsinz,sini,sin},cosz,cosiecos}to
, , ,1, 1 e 1
z i } UHVSHFWLYHO\ 0RUHRYHU WKH QRQOLQHDU WHUPV
, , }i }z izo o o
^ hDUHYHU\VPDOOFRPSDUHGWRWKHOLQHDURQHV7KH YHORFLWLHV}
o
andio
DUH DOVR VPDOO FRPSDUHG WR WKH RUELWDO YHORFLW\ Ȧ$UDQWHV -Uet al &RQVLGHULQJ WKRVH DSSUR[LPDWLRQV WKH NLQHPDWLF HTXDWLRQ LV JLYHQ E\ (T1 ib b 0 z i } } z ~ = +~
-o
o
o
R
T
S
S
SS
R
T
S
S
SS
V
X
W
W
WW
V
X
W
W
WW
(3),Q WKLV SDSHU WKH VDWHOOLWH LV PRGHOHG DV D ULJLG ERG\ 7KHUHIRUHWKHG\QDPLFPRGHOFDQEHREWDLQHGZLWK(XOHU¶V HTXDWLRQ WKDW GHVFULEHV WKH URWDWLRQ RI D ULJLG ERG\ 7KH G\QDPLFHTXDWLRQLVJLYHQE\(T dt dh h ext b ib b b
x
=
8 B
+
~ #:HUHZULWHWKHH[SUHVVLRQDV(T
(~ibb)J ibb=xdb+xbp
+
o
ZKHUH
JLVWKHLQHUWLDPDWUL[RIWKHVDWHOOLWH d b
x
UHSUHVHQWVWKHWRUTXHV IURP H[WHUQDO SHUWXUEDWLRQV DFWLQJ RQ WKH VDWHOOLWH DQG pb
x
UHSUHVHQWVWKHFRQWUROWRUTXHVIJxIJyIJz$OOYHFWRUVGHVFULEHGLQWKHERG\IUDPH ib b
~
LVWKHDQJXODU YHORFLW\RIWKHERG\ZLWKUHVSHFWWRWKHLQHUWLDOIUDPHZULWWHQ LQWKHERG\IUDPH7KHJUDYLW\JUDGLHQWLVWKHRQO\H[WHUQDO SHUWXUEDWLRQ FRQVLGHUHG LQ WKLV ZRUN ,WV HIIHFW FDQQRW EH QHJOHFWHGLQDORZRUELWVDWHOOLWHDQDV\PPHWULFERG\VXEMHFW WRWKH(DUWKJUDYLWDWLRQDO¿HOGZLOOH[SHULHQFHDWRUTXHWHQGLQJ WRDOLJQWKHD[LVRIPLQRULQHUWLDZLWKWKH¿HOGGLUHFWLRQ7KH JUDYLW\JUDGLHQWWRUTXHLVPRGHOHGDV(T 3 J J J J 0 g b z y x z 0 2 x ~ z i =-^
^
h
h
R
T
S
S
SS
V
X
W
W
WW
6XEVWLWXWLQJWKHDSSOLHGWRUTXHVDQGWKHNLQHPDWLFHTXDWLRQ (T LQWR WKH G\QDPLF HTXDWLRQ DQG UHSUHVHQWLQJ WKH G\QDPLFHTXDWLRQLQWKHVWDWHVSDFHIRUPZHKDYH$UDQWHV-Uet al(T
x Ax Bu
y Cx Du
= +
= +
o
CONTINUOUSTIME LQG CONTROL
7KH /4* LV GHVLJQHG XSRQ WKH OLQHDUL]DWLRQ RI WKH G\QDPLFPRGHO7KHWKHRU\LVGHYHORSHGIRUOLQHDUV\VWHPV +RZHYHUWKHVLPXODWLRQWDNHVLQWRFRQVLGHUDWLRQWKHFRPSOHWH QRQOLQHDUPRGHORIWKHVDWHOOLWH
7KH RSWLPDO FRQWURO DSSURDFK FRQVLVWV RI PLQLPL]LQJ D TXDGUDWLF FRVW IXQFWLRQ DQG FRPSXWLQJ D IHHGEDFN JDLQ PDWUL['RUDWRet al7KHRSWLPL]DWLRQSUREOHPDLPV DWREWDLQLQJDFRQWUROODZH[SUHVVHGE\DOLQHDUUHODWLRQVKLS EHWZHHQWKHVWDWHYDULDEOHxH[SUHVVLQJWKH(XOHUVDQJOHV DQGWKHDQJXODUYHORFLWLHVDQGWKHFRQWUROYDULDEOHuDSSOLHG WRUTXHVJLYHQE\(T
u K (t)x
ZLWK D JDLQK WKDW PLQLPL]HV D TXDGUDWLF FRVW IXQFWLRQ IRUPXODWHGDV(T
x x u u
Jlqr TQc TRc dt T
0
+
=
#
6
@
ZKHUHQc DQGRc DUHWKHZHLJKWPDWULFHVRIVWDWHDQGFRQWURO YHFWRUV UHVSHFWLYHO\ 7KH JDLQ PDWUL[. IRU WKH RSWLPDO FRQWUROODZLVREWDLQHGE\VROYLQJWKHDOJHEUDLFPDWUL[5LFFDWL HTXDWLRQ IRU D WLPHLQYDULDQW V\VWHP DQG FRQVLGHULQJ DQ LQ¿QLWHKRUL]RQFRQWH[W(T
A PT PA PBRc B PT Qc 0
1
+ - - + =
ZKHUHADQGBDUHWKHPDWULFHVRIWKHOLQHDUL]HGDWWLWXGH PRGHO 7KH RSWLPDO FRQWURO JDLQ LV JLYHQ LQ WHUPV RI WKH VROXWLRQPRIWKH5LFFDWLHTXDWLRQ(T
K=R B P-1 T
'XHWRWKHSUHVHQFHRIQRLVHD¿OWHULVQHHGHGWRREWDLQ PRUHUHOLDEOHLQIRUPDWLRQDERXWWKHVWDWHVPHDVXUHGE\WKH VHQVRUV)RUWKHLQFOXVLRQRIDVHQVRUVVLJQDOV¿OWHULQJZH DGRSWHGWKHFRQWUROOHUGHVLJQEDVHGRQWKHWKHRU\RI/4* 7KH/4*UHJXODWRUSUREOHPFDQEHGHVFULEHGDVWKHV\QWKHVLV RIDFRQWUROODZZKLFKVWDELOL]HVWKHV\VWHPDQGPLQLPL]HVD TXDGUDWLFHUURUFULWHULRQ'RUDWR et al:HFRQVLGHULQ
WKLVZRUNWKHSUHVHQFHRIZKLWHQRLVHLQWKHREVHUYDWLRQVDQG WKDWWKHV\VWHPLVREVHUYDEOH,QWKH/4*LVVXHZHZDQWWR PLQLPL]HWKHFRVWIXQFWLRQDVLQ(T
ZKHUHQf LVWKHFRYDULDQFHPDWUL[RIWKHPHDVXUHPHQWVQRLVH DQGRf LV WKH FRYDULDQFH PDWUL[ RI WKH G\QDPLFV QRLVH WR UHSUHVHQWWKHLQDFFXUDF\RIWKHPRGHO7KHVROXWLRQRIWKH /4*SUREOHPZLOOEHJLYHQE\GLYLGLQJWKHPDLQSUREOHP LQWRWZRVXESUREOHPVVHWWLQJWKHFRQWUROOHUIRUWKHOLQHDU TXDGUDWLFGHWHUPLQLVWLFSUREOHPSUHYLRXVO\GH¿QHGVHWWLQJ WKH.DOPDQ%XF\¿OWHUIRURSWLPXPHVWLPDWLRQRI
x
t
VWDWH[ 7KH IRUPXODWLRQ RI WKH .DOPDQ%XF\ ¿OWHU LV JLYHQ E\(T( )
x
to
=Axt
+Bu+L y-Cxt
ZKHUH/LVWKH.DOPDQ¿OWHUJDLQWKDWLVREWDLQHGE\VROYLQJ WKHDOJHEUDLF5LFFDWLPDWUL[HTXDWLRQ(T
A ST +SA-SCR-f1C ST +Qf =0
7KHJDLQRIWKHRSWLPDO¿OWHULVJLYHQE\(T
L Rf C ST
1
= -
$IWHU REWDLQLQJ/ LW LV SRVVLEOH WR REWDLQ WKH WUDQVIHU IXQFWLRQRIRSHQORRS/4*FRQWUROOHUDFFRUGLQJWR$UDQWHV
-Uet al
( ) ( )
(s) s s
KlqgG =K I-A+BK+LC-1LG
ZKHUHLVWKHWUDQVIHUIXQFWLRQRIWKHDWWLWXGHG\QDPLFV 7KHPDWULFHV4cDQGRc DUHFRPSXWHGE\DGMXVWPHQWVIURP
WKHYDOXHVREWDLQHGE\XVLQJWKHUXOHRI%U\VRQDQG 4cDQGRc DUHREWDLQHGE\KHXULVWLFLWHUDWLYHDGMXVWPHQWV7KH
FRPSOHWHFRQWUROV\VWHPLPSOHPHQWHGDQGWHVWHGLQ0$7/$% 6,08/,1.HQYLURQPHQWLVLOOXVWUDWHGLQ)LJ
Gas jets actuation
7KHOLQHDUTXDGUDWLFFRQWUROOHUDFWLRQFDQEHLPSOHPHQWHG XVLQJDFWXDWRUVVXFKDVUHDFWLRQZKHHOVDQGPDJQHWLFDFWXDWRUV IRUDFRQWLQXRXVFRQWUROFRPPDQG+RZHYHUGXULQJRUELWDO RSHUDWLRQVVXFKDVUDSLGGHWXPEOLQJPDQHXYHUVWKHUHTXLUHG WRUTXHVDUHXVXDOO\WRRKLJKIRUUHDFWLRQZKHHOV7KHUHIRUH RQRII SURSXOVLRQ VWUDWHJLHV DUH XVHG IRU VXFK RSHUDWLRQV $UDQWHV-Uet al7KHFKRLFHRIFROGJDVMHWVDFWXDWLRQ
LQWKHSUHVHQWVWXG\DLPVDWWHVWLQJWKHFRQWUROLQDPRVWFULWLFDO VLWXDWLRQLQWHUPVRIWKHVPDOODWWLWXGHDGMXVWPHQWVGLI¿FXOWLHV )XWXUHZRUNVVKRXOGXVHRWKHUDFWXDWRUW\SHVHJUHDFWLRQ ZKHHOVPDJQHWLFWRUTXHUVLQFOXGLQJFRPELQHGXVHZLWKJDV MHWV,WLVLPSRUWDQWWRPHQWLRQWKDWJDVMHWVDUHDOVRXVHGIRU UHDFWLRQZKHHOVGHVDWXUDWLRQ
7KH¿ULQJRIJDVMHWVLVFRQWUROOHGE\D3:3)PRGXODWRU %XFN 7KH 3:3) LV DQ LQWHUHVWLQJ RSWLRQ IRU WKH WKUXVWHUVFRQWUROV\VWHPGXHWRLWVDGYDQWDJHVRYHURWKHUW\SHV RISXOVHPRGXODWRUV3:3)LVGHVLJQHGWRSURYLGHSURSXOVLRQ RXWSXWSURSRUWLRQDOWRWKHLQSXWFRPPDQG7KHPRGXODWRU RSWLPL]HV WKH XVH RI SURSHOODQWV LW SURYLGHV D VPRRWKHU )LJXUH 7KH/LQHDUTXDGUDWLF*DXVVLDQFRQWUROV\VWHPGHYHORSHG
FRQWURODQGLQFUHDVHVWKHHTXLSPHQWOLIH7KH3:3)VWUXFWXUH LVVKRZQLQ)LJ$UDQWHV-Uet al
:KHQWKHSRVLWLYHLQSXWLQWKH6FKPLWWWULJJHULVJUHDWHU
than 8
onWKHWULJJHURXWSXWLV8m,IWKHLQSXWIDOOVEHORZ8off WKHWULJJHURXWSXWEHFRPHVQXOO7KLVUHVSRQVHLVDOVRUHÀHFWHG IRU QHJDWLYH LQSXWV7KH HUURU VLJQDOe(t) LV WKH GLIIHUHQFH
EHWZHHQWKHRXWSXWRI6FKPLWWWULJJHU8on DQGV\VWHPLQSXW
r(t)7KLVHUURULVVHQWWRDSUH¿OWHUZKRVHLQSXWf(t)IHHGVWKH
6FKPLWWWULJJHU$UDQWHV-Uet al
Simulations results for continuoustime LQG controller
7KH UHVXOWV REWDLQHG LQ WKH FDVH RI FRQWLQXRXV WLPH /4* FRQWUROOHU LQ 0$7/$%6,08/,1. HQYLURQPHQW FRQVLGHULQJDQLQLWLDOHUURURILQWKHWKUHH(XOHUVDQJOHV DUHVKRZQLQ)LJ,WFDQEHVHHQWKDWHYHQIRUDIDLUO\ODUJH GHYLDWLRQ LQ WKH VWDELOL]DWLRQ PRGH FRQWH[W WKH FRQWUROOHU PHHWVWKHVSHFL¿FDWLRQRIXSSHUHUURUOLPLW7KLVHUURUFDQ EHLPSURYHGE\XVLQJRWKHUW\SHVRIDFWXDWRUVOLNHUHDFWLRQ ZKHHOVZKLFKKDYHKLJKHUUHVROXWLRQLQDFWLRQ
DIGITAL LQG CONTROLLER
7KH/4*FRQWUROOHUGHVLJQLQDGLJLWDOYHUVLRQUHTXLUHV VRPH VWXG\ VWHSV RI PDMRU LPSRUWDQFH IRU D VXFFHVVIXO LPSOHPHQWDWLRQRIWKHDOJRULWKPLQDQHPEHGGHG'63,QWKLV VHFWLRQZHSUHVHQWWKHPDLQGHVLJQDQDO\VLVDQGGHFLVLRQVZLWK UHVSHFWWRWLPHRIVDPSOLQJWHFKQLTXHRIV\VWHPGLVFUHWL]DWLRQ DQGDGDSWLRQRIWKH/4*FRQWUROOHURULJLQDOO\GHVLJQHGIRU FRQWLQXRXVWLPHV\VWHPVWRGLVFUHWHWLPHDSSOLFDWLRQ
Selection of the sampling time
7KHDSSURSULDWHVHOHFWLRQRIWKHVDPSOLQJSHULRGT is a
FUXFLDOIDFWRULQWKHGLJLWDOFRQWUROOHUGHVLJQVLQFHLIWKLVSHULRG
LVWRRODUJHWKHUHDUHSUREOHPVLQWKHVLJQDOUHFRQVWUXFWLRQDQG LILWLVWRRVPDOOV\VWHPLQVWDELOLW\DQGSURFHVVLQJFDSDFLW\ SUREOHPVFDQRFFXU,QSULQFLSOHRQHFDQEHOLHYHWKDWVPDOOHU VDPSOLQJSHULRGLVWKHEHVWGLJLWDODSSUR[LPDWLRQ+RZHYHULI WKHVDPSOLQJSHULRGLVWRRVPDOOWKHFRQWUROOHUSROHVDSSURDFK WKH XQLW FDXVLQJ LQVWDELOLW\ $FFRUGLQJ WR WKH HTXDWLRQ PDSSLQJIURPVDQGzVSDFHVZKHUHz esTZHFDQVHHWKDWLI
TLVYHU\VPDOOWHQGLQJWR]HURWKHSROHVRIWKHFRQWUROOHULQ
]WHQGWRZKLFKDUHWKRVHRIDPDUJLQDOO\XQVWDEOHV\VWHP PDNLQJWKHFORVHGORRSV\VWHPXQVWDEOH+RZHYHULWLVQRW QHFHVVDU\WKDWTDSSURDFKHV]HURWRVWDUWWKHSUREOHPVLILWLV
VPDOOHQRXJKWKHSROHVDWzFDQQRWEHDQ\PRUHGLVWLQJXLVKHG
E\WKHFRPSXWHUXQLW)XUWKHUPRUHVPDOOVDPSOLQJSHULRGV FDQLQWURGXFHVLJQL¿FDQWGLVWRUWLRQVLQWKHV\VWHPG\QDPLFV EHKDYLRU6RDUHV
9HU\ODUJHVDPSOLQJSHULRGVPD\UHVXOWLQYLRODWLRQRIWKH UXOHHVWDEOLVKHGE\WKHVDPSOLQJWKHRUHPZKLFKVD\VWKDWWKH VDPSOLQJIUHTXHQF\ȦsPXVWEHWZLFHJUHDWHUWKDQWKHKLJKHVW VLJQDOFRPSRQHQWIUHTXHQF\ȦM ǖVWURPDQG:LWWHUQPDUN ,IWKHFRQGLWLRQRIWKHWKHRUHPLVQRWVDWLV¿HGWKHUHDUH LQIRUPDWLRQORVVHVLQWKHVLJQDOUHFRQVWUXFWLRQ
$UHDVRQDEOHFKRLFHIRUWKHVDPSOLQJUDWHLVWRWLPHV WKHEDQGZLGWKRIWKHV\VWHPȦ%LQFORVHGORRSǖVWURPDQG
:LWWHUQPDUN$VXJJHVWLRQRI)UDQNOLQet al
)LJXUH 6FKHPHRIWKHSXOVHZLGWKIUHTXHQF\PRGXODWRU
)LJXUH 6LPXODWLRQ UHVXOWV RI DWWLWXGH FRQWURO IRU WKUHH DQJOHV
(rollz,pitchi,yall})
LV WR DGRSW D VDPSOLQJ IUHTXHQF\ JUHDWHU WKDQ Ȧ% LQ RUGHUWRKDYHDIDLUO\VPRRWKFRQWUROUHVSRQVH,Q'RUIDQG %LVKRSWKHLQGLFDWLRQLVWRDGRSWWKHVDPSOLQJSHULRG
T fB)ZKHUHfB = Ȧ%ʌDQGfBLVWKHEDQGZLGWKRIWKH FORVHGORRSFRQWLQXRXVV\VWHP,QWKLVZRUNZHDGRSWHGWKH VDPSOLQJSHULRGFRUUHVSRQGLQJWRfBZKLFKLVDQDYHUDJH YDOXHRIWKHOLWHUDWXUHVXJJHVWLRQV,QRUGHUWRDQDO\]HWKH V\VWHP IUHTXHQFLHV ZH FRQVLGHU WKH OLQHDUL]HG HTXDWLRQ RI WKH G\QDPLFV RI DWWLWXGH DFFRUGLQJ WR (XOHU¶V DQJOHV (rollz,pitchi,yall})
)RUHDFKG\QDPLFVHTXDWLRQVZHFDOFXODWHGWKHRSHQORRS WUDQVIHUIXQFWLRQRI/4*FRQWUROOHU7KHFORVHGORRSWUDQVIHU IXQFWLRQLVREWDLQHGE\FRQVLGHULQJDXQLW\IHHGEDFN1H[W ZHSHUIRUPHGDIUHTXHQF\DQDO\VLVRIWKHV\VWHPE\WKH%RGH SORWRIWKHWKUHHWUDQVIHUIXQFWLRQVDQGWKHEDQGZLGWKZDV LGHQWL¿HGIRUHDFKHTXDWLRQVHSDUDWHO\
)RUHDFKWUDQVIHUIXQFWLRQDGLIIHUHQWYDOXHRIEDQGZLGWK ZDVREWDLQHG7KHREWDLQHGEDQGZLGWKYDOXHVIRUUROOSLWFK DQG\DZDQJOHVZHUHUHVSHFWLYHO\DQG UDGV7KHKLJKHVWYDOXHRIEDQGZLGWKZDVFKRVHQIRUWKLV ZRUNVLQFHWKH/4*FRQWUROODZDSSUR[LPDWHVDFRQWLQXRXV WLPH FRQWURO ZKHQ WKH VDPSOLQJ SHULRG DSSURDFKHV ]HUR 7DNLQJWKLVLQWRDFFRXQWWKHFKRLFHRIWKHKLJKHUEDQGZLGWK ZLOOSURYLGHDVDPSOLQJSHULRGFORVHUWR]HUR7KHREWDLQHG PD[LPXPVDPSOLQJSHULRGZDVDSSUR[LPDWHO\VHFRQGV 7KLVUHIHUHQFHYDOXHRIVDPSOLQJSHULRGVHUYHVDVDVWDUWLQJ SRLQWWRDWXQLQJDQGDGMXVWPHQWSURFHGXUHWKHUHDIWHUDEHWWHU VDPSOLQJWLPHYDOXHLVDGRSWHGLQWKLVZRUN,WZDVREVHUYHG WKDWYDOXHVKLJKHUWKDQVHFRQGVUHVXOWHGLQDEDGG\QDPLF EHKDYLRUZLWKWKHDSSHDUDQFHRIODUJHRVFLOODWLRQVDURXQGWKH UHIHUHQFH]HUR9DOXHVVPDOOHUWKDQVHFRQGVUHVXOWHGLQ DFRQVLGHUDEOHLPSURYHPHQWRIWKLVG\QDPLFV$IWHUVHYHUDO UHFXUVLYHDGMXVWPHQWVWKHYDOXHRIPVZDVFRQVLGHUHGDV DTXLWHVDWLVIDFWRU\YDOXHFRQVLGHULQJWKHGHVLUHGSRLQWLQJ DFFXUDF\ )XUWKHUPRUH VLQFH WKH PD[LPXP VSHHG RI WKH DGRSWHG'63FRUHLV0+]DVDPSOLQJSHULRGRIPV LVDUHDVRQDEOHYDOXHLWFDQSURFHVVWKHUHFHLYHGVLJQDODQG FRPSXWHWKHFRQWUROVLJQDOLQWKHFRVLPXODWLRQLQWKHLQWHUYDO EHWZHHQVDPSOHV
System discretization
7KHGHVLJQRIFRQWUROV\VWHPVLQWKHFRQWLQXRXVGRPDLQ LVPDWKHPDWLFDOO\VLPSOHUDQGDOORZVWKHXVHRIDODUJHVHW RI WRROV ,Q WKH FDVH RI FRQWURO V\VWHP GHVLJQ LQ GLVFUHWH GRPDLQWKHPDWKHPDWLFDOSUREOHPLVTXLWHPRUHFRPSOLFDWHG ,QDGGLWLRQLQWKHFRQWLQXRXVWLPHGRPDLQWKHYLVXDOL]DWLRQ
RIWKHUHODWLRQVKLSEHWZHHQSK\VLFDOUHDOLW\DQGPDWKHPDWLFDO UHSUHVHQWDWLRQRIDFRQWUROV\VWHPLVPRUHHYLGHQW7KHUHIRUH WKH XVXDO VWDUWLQJ SRLQW IRU D GLVFUHWH WLPH FRQWURO GHVLJQ LV WKH FRQWLQXRXV WLPH FRQWURO V\VWHP VWXG\ IROORZHG E\ GLVFUHWL]DWLRQSURFHGXUHV
7KHUH DUH VHYHUDO PHWKRGV RI GLVFUHWL]DWLRQ RI D JLYHQ FRQWLQXRXVWLPHV\VWHPDQGWKH\DUHEDVLFDOO\GLYLGHGLQWR RSHQORRSPHWKRGVDQGFORVHGORRSPHWKRGV,QWKHRSHQ ORRSPHWKRGVWKHGLVFUHWL]DWLRQHVVHQWLDOO\FRQVLVWVRIWXUQLQJ WKH WUDQVIHU IXQFWLRQ*V in *] 7KLV WUDQVIRUPDWLRQ LV
SHUIRUPHGE\VXEVWLWXWLQJWKHWHUPVLQVE\]RQHVWRVDWLVI\ VRPHFULWHULRQ,QWKHFORVHGORRSPHWKRGVWKHGLVFUHWL]DWLRQ RIDFRQWUROOHUIXQFWLRQ*VLVREWDLQHGWDNLQJLQWRDFFRXQW LQIRUPDWLRQIURPWKHRSHUDWLRQRIWKHFORVHGORRSV\VWHPDQG DOVRWKHNQRZOHGJHRIDOOWKHWUDQVIHUIXQFWLRQVLQYROYHGLQWKH V\VWHPLQFOXGLQJWKHSODQWWKDWLVLQWULQVLFDOO\FRQWLQXRXV ,Q6RDUHVVHYHUDOPHWKRGVRIGLVFUHWL]DWLRQDUH SUHVHQWHGDQGFRPSDUHG$PRQJWKHPWKHRSHQORRSPHWKRG RIWUDQVIRUPDWLRQRI7XVWLQDOVRFDOOHGELOLQHDUWUDQVIRUPDWLRQ JLYLQJVDWLVIDFWRU\UHVXOWVHYHQZKHQFRPSDUHGWRFORVHGORRS RQHV±ZKLFKRIWHQKDYHEHWWHUUHVXOWVE\WDNLQJLQWRDFFRXQW WKHZKROHV\VWHP±ZKHQDSSOLHGWRV\VWHPVRIORZRUGHU DQGDOVRFRPSDUHGZLWKWKHV\VWHPRI*UHQREOHZKLFKLVRI RUGHU7KH*UHQREOHV\VWHPFRQVLVWVRIDSODQWFRQVLGHUHGDV DEHQFKPDUNGHYHORSHGE\WKH$XWRPDWLF&RQWURO/DERUDWRU\ RI*UHQREOH$QRWKHUZHOONQRZQGLVFUHWL]DWLRQPHWKRGLV RIUHWDLQLQJHOHPHQWVZKHUHWKHPRVWXVHGLVWKH]HURRUGHU KROGHU=2+
2QHRIWKHPRVWSRSXODUPHWKRGVLV(XOHU¶VDOVRNQRZQ DVIRUZDUGGLIIHUHQFH6RDUHV7KLVPHWKRGFRQVLVWVRI DSSUR[LPDWLQJWKHPDSSLQJRIWKH]SODQH]LQWKHVSODQHDVD WUXQFDWHGVHULHVH[SDQVLRQOLNHLQ(T
1
z e sT s
T
z 1
sT
&
. .
= + -
,QWKHVWDELOLW\DQDO\VLVRIWKLVPHWKRGLWFRXOGEHREVHUYHG DSUREOHPLWLVSRVVLEOHWKDWDVWDEOHV\VWHPLQVLVPDSSHGWR DQXQVWDEOHV\VWHPLQ]$OWKRXJKVLPSOHWKLVPHWKRGLVYHU\ RIWHQDGRSWHG
7KHPHWKRGRI7XVWLQVELOLQHDUWUDQVIRUPDWLRQLVQRWEDVHG RQWKHDSSUR[LPDWLRQRIVDVLQWKHFDVHRIRWKHUPHWKRGV ,WLVEDVHGRQWKHDSSUR[LPDWLRQRIWKHLQWHJUDOUHSUHVHQWHG E\WKHIDFWRUV6RDUHV$SSURDFKLQJWKHLQWHJUDOE\ WUDSH]RLGDOLQWHJUDWLRQPHWKRGZHREWDLQ(T
z z s
T 1
2 1
. +
Design of the digital controller
7KHG\QDPLFVRIWKHVDWHOOLWHSODQWLQWKHFDVHRIGLVFUHWH FRQWURO UHPDLQV WKH VDPH DV LQ WKH FRQWLQXRXV WLPH FDVH )LJXUH LOOXVWUDWHV WKH /4* FRQWUROOHU VFKHPH DIWHU LWV GLVFUHWL]DWLRQ7KHPDLQFKDQJHREVHUYHGLQWKLVVFKHPHLV WKHDGGLWLRQRID=2+LQWKHRXWSXWVLJQDOZKLFKLVVHQWWRWKH VDWHOOLWHVEORFNDVLQGLFDWHGE\WKHRXWSXWQDPHG³WRUTXH´ 7KHVHQVRUVVLJQDOVDUHUHFHLYHGE\WKH³PHDVXUHGVWDWHV´ JDWHZD\ )LQDOO\ WKH FRQWUROOHU VXEV\VWHP ZDV FKDQJHG E\ WKH GLVFUHWL]DWLRQ LQ WHUPV RI LWV LQWHJUDWLRQ IXQFWLRQ
Results of digital LQG control simulations
)LJXUH VKRZV WKH UHVXOWV RI VLPXODWLRQV FDUULHG RXW H[FOXVLYHO\LQ0$7/$%6,08/,1.HQYLURQPHQWXVLQJWKH GLVFUHWH/4*FRQWUROOHUSUHYLRXVO\REWDLQHGE\WKHPHWKRGRI 7XVWLQVWUDQVIRUPDWLRQDQGWKHFRQWUROOHGSODQWPRGHOLQJWKH QRQOLQHDUDUWL¿FLDOVDWHOOLWH)LJXUHDOVRVKRZVWKHYDULDWLRQ RIWKHWKUHHDWWLWXGH(XOHUVDQJOHV7KLVVLPXODWLRQFRQVLGHUHG WKHVDPHLQLWLDOGHYLDWLRQRIIRUHDFKRIWKHWKUHHDQJOHV
VALIDATION TESTS
7KH YDOLGDWLRQ RI WKH GLJLWDO DWWLWXGH FRQWUROOHU ZDV FDUULHGWKURXJKDVFKHPHRIFRVLPXODWLRQZKHUHDFRPSXWHU SHUIRUPVWKHVLPXODWLRQRIWKHVDWHOOLWHVPRWLRQLQ0$7/$% 6,08/,1. XVLQJ PRGHOV RI DWWLWXGH NLQHPDWLFV DQG G\QDPLFVDQGD%ODFN¿Q'63GHYLFHLQVWDOOHGRQ$'63 %)NLW$QDORJ'HYLFHVSOD\VWKHGLJLWDO/4*FRQWUROOHU SURFHVVLQJDQGDOVRWKH3:3)PRGXODWRU
7KLV W\SH RI YDOLGDWLRQ VFKHPH KDV EHHQ XVHG DV D ZD\ WR PRYH EH\RQG RQ VWULFWO\ FRPSXWHU VLPXODWLRQV
JLYLQJ RSSRUWXQLW\ WR VWXG\ UHDOLVWLF SUREOHPV UHODWHG WR FRPPXQLFDWLRQDQGWRH[FKDQJHGDWDEHWZHHQWKHHPEHGGHG SURFHVVRU DQG WKH FRQWUROOHG V\VWHP VXFK DV WLPH GHOD\V UHOLDELOLW\RIWUDQVPLWWHGDQGUHFHLYHGGDWDSURFHVVLQJWLPHRI WKHFRQWUROOHUDPRQJRWKHUV
$QH[DPSOHRIWKLVNLQGRIDSSOLFDWLRQFDQEHIRXQGLQ 6HHODHQGHUZKHUHD¿HOGSURJUDPPDEOHJDWHDUUD\ )3*$SURFHVVRUSHUIRUPVWKHDWWLWXGHFRQWURORIDVDWHOOLWH VLPXODWHGLQFRPSXWHUFRPELQLQJWKH0$7/$%6,08/,1. DQG/DE9,(:57WRROV7KLVDWWLWXGHFRQWUROXVHVUHDFWLRQ ZKHHOVDVDFWXDWRUV
7KHYDOLGDWLRQWHVWVFRPSULVHWZRGLVWLQFWVFHQDULRV,QWKH ¿UVWRQHWKHWHVWVFRQVLGHUWKHVDPHFDVHVWXGLHGLQWKHSUHFHGHQW VHFWLRQVLHWKUHHD[HVDWWLWXGHVWDELOL]DWLRQ,QWKHVHFRQG VFHQDULRWKHDWWLWXGHFRQWUROLVDLPHGDWSHUIRUPLQJDPDQHXYHU WRDFKLHYHDQHZRULHQWDWLRQWKDWLVDWDVNRIDWWLWXGHWUDFNLQJ
Cosimulation scheme
7KH FRVLPXODWLRQ VFKHPH LV EDVHG RQ WKH FRPSXWHU FRPPXQLFDWLRQZLWKWKH'63)LJZKLFKLVIDFLOLWDWHGE\
)LJXUH 6FKHPHRIWKHGLVFUHWOLQHDUTXDGUDWLF*DXVVLDQFRQWUROOHU
)LJXUH 6LPXODWLRQUHVXOWVRIGLVFUHWHWLPHDWWLWXGHFRQWUROLQWHUPV RIWKH(XOHUVDQJOHV
0$7/$%6,08/,1.WRRODOORZLQJLQWHJUDWLRQRIVHYHUDO H[WHUQDOSURFHVVRUVLQFOXGLQJWKH%)E\FUHDWLQJDEORFN 3URFHVVRU,QWKH/RRS 3,/ LQ WKH VLPXODWLRQ GLDJUDP LQ 6,08/,1.7KLVFRPPXQLFDWLRQLVPDGHSRVVLEOHWKURXJK WKHLQWHUDFWLRQRIWKH0$7/$%6,08/,1.ZLWKWKH%) GHYHORSPHQWHQYLURQPHQWWKH9LVXDO'63
7KH EORFN 3,/ LV LQVHUWHG LQWR WKH EORFN GLDJUDP GHYHORSHGLQWKH6,08/,1.HQYLURQPHQW,WLVUHVSRQVLEOH IRUWKHFRPPXQLFDWLRQZLWKWKH'63LWLVLQFKDUJHRIVHQGLQJ WKHLQIRUPDWLRQRIWKHVDWHOOLWHDWWLWXGHDQGRIUHFHLYLQJWKH FRPPDQGVUHODWHGWRWKHFRQWURODFWLRQWKHJDVMHWVGULYLQJ IURPWKH3:3)PRGXODWRU
Tests results for attitude stabilization
)LJXUHVKRZVWKHUHVXOWVIRUWKHWKUHH(XOHU¶VDQJOHVRIWKH YDOLGDWLRQWHVWVIRUWKHFDVHRIWKUHHD[LVVWDELOL]DWLRQVFKHPH XVLQJFRVLPXODWLRQ7KHFRQVLGHUHGLQLWLDOGHYLDWLRQLV IRUHDFKWKUHH(XOHU¶VDQJOHDVLQWKHFDVHRIWKHSUHYLRXV VLPXODWLRQV
$FRPSDUDWLYHDQDO\VLVRIWKHREWDLQHGUHVXOWVLQWKHFDVH RIFRQWLQXRXV/4*FRQWUROOHUVKRZQLQ)LJDQGWKRVH REWDLQHG LQ WKH VFKHPH RI FRVLPXODWLRQ )LJ FDQ EH PDGHIURPDSORWRIWKHGLIIHUHQFHVRIWKHUHVXOWV7KLVSORWRI GLIIHUHQFHVLVVKRZQLQ)LJ
7KHGLIIHUHQFHVDUHVPDOOHUWKDQIRUWKHWKUHHDQJOHV +RZHYHU ZH FDQQRW FRQFOXGH DERXW WKH EHVW SUHFLVLRQ VFHQDULR%RWKVLPXODWLRQVPHWWKHDFFXUDF\VSHFL¿FDWLRQV QHYHUWKHOHVV WKH VLPXODWLRQ RI FRQWLQXRXVWLPH V\VWHP ODFNVRIUHDOLVPIRUDQH[SHULPHQWDODSSOLFDWLRQ,QIDFWWKH VPDOOGLIIHUHQFHEHWZHHQWKHWZRFDVHVVKRZVRQO\WKDWWKH FRVLPXODWLRQVFKHPHZRUNVYHU\VLPLODUO\WRWKHLGHDOL]HG
)LJXUH &RVLPXODWLRQVFKHPHZLWKWKHGLJLWDOVLJQDOSURFHVVRU SURFHVVLQJ OLQHDUTXDGUDWLF *DXVVLDQ FRQWUROOHU DQG WKH SXOVH ZLGWKIUHTXHQF\ PRGXODWRU DQG 0$7/$% 6,08/,1.VLPXODWLQJWKHPRWLRQRIWKHVDWHOOLWHDWWLWXGH
)LJXUH &RVLPXODWLRQ UHVXOWV RI DWWLWXGH FRQWURO XVLQJ D GLJLWDO VLJQDOSURFHVVRUIRUWKHWKUHHDQJOHV
RQH VXJJHVWLQJ DQ RSWLPLVWLF RXWFRPH LQ UHODWLRQ WR WKH H[SHFWDWLRQVRIDQH[SHULPHQWDODSSOLFDWLRQ
,QWHUPVRIDGRSWHGVDPSOLQJWLPHLWZDVREVHUYHGWKDWWKH VLPXODWLRQLQ0$7/$%6,08/,1.ZDLWVWKH'63SURFHVVLQJ WRFRQWLQXHWKHFDOFXODWLRQVSUHYHQWLQJLWIURPVRPHSUREOHP UHODWHGWRWKHLQWHUYDOEHWZHHQWZRFRQWUROOHUVSURFHVVLQJDQG DFWXDWLRQ+RZHYHUWKHUHLVD'63GHYHORSPHQWSODWIRUPWRRO WKDWDOORZVWKHPHDVXUHPHQWRISURFHVVLQJWLPHDQGGDWDWUDI¿F &RQVHTXHQWO\LWLVSRVVLEOHWRYHULI\WKDWWKH'63SURFHVVLQJ WLPHUHPDLQVLQIHULRUWRWKHPD[LPXPSHULRGSURYLGHGIRU VDPSOLQJPVLQWKLVVWXG\7KLVWRROLVWKH&\FOH&RXQWHU ZKLFKFRQVLGHUVWKHIUHTXHQF\RIWKH'63FRUH0+] 7KH REWDLQHG UHVXOW ZDV SURFHVVLQJ DQG WUDI¿F WLPH RI
îZKLFKLVPXFKVPDOOHUWKDQWKHWLPHDYDLODEOHGXHWR
WKHVDPSOLQJSHULRG,WLVSRVVLEOHWRFRQFOXGHWKDWWKHUHDUHQR SUREOHPVLQWKLVDSSOLFDWLRQUHODWHGWRWKHDVSHFWRIWKHFRQWUROOHU GLVFUHWL]DWLRQDQGWKHXVHRIDGLJLWDOSURFHVVRUWRSHUIRUP WKH IXQFWLRQ RI FRQWUROOLQJ DQG PRGXODWLQJ WKH DFWXDWRUV
Tests results for attitude maneuver tracking
,QWKLVVHFRQGWHVWFDVHWKHVDWHOOLWHLVFRPPDQGHGWRFKDQJH LWVDWWLWXGHLQLWLDOO\ZLWKWKUHHDQJOHVUROOSLWFKDQG\DZDW WKHVDPHYDOXHRIIRUDQHZDWWLWXGHGH¿QHGE\WKHYDOXHV DQGUHVSHFWLYHO\7KHUHVXOWVDUHVKRZQLQ)LJ ,WZDVREVHUYHGWKDWWKHFRQWUROOHUSHUIRUPVVDWLVIDFWRULO\ LWVWDVNZLWKWUDFNLQJPDQHXYHUWLPHRIDERXWVHFRQGV $Q LPSRUWDQW UHPDUN WKH JDS DQJOHV EHWZHHQ LQLWLDO DQG ¿QDO DWWLWXGHV DUH UHODWLYHO\ ODUJH IRU WKH FRQVLGHUHG DSSUR[LPDWLRQVLQWKHV\QWKHVLVRI/4*FRQWUROODZ,QWKH FRQWUROOHUGHVLJQZHDGRSWHGDOLQHDUL]HGPRGHOIRUVPDOO DQJOHYDOXHVZKHUHDVLQWKHVLPXODWLRQRIWKHPRWLRQRIWKH VDWHOOLWH DWWLWXGH ZH XVHG QRQOLQHDU PRGHOV RI NLQHPDWLFV DQG G\QDPLFV 7KHVH PRGHOV LQ WKH FDVH RI ODUJH DQJOHV H[KLELW YHU\ GLIIHUHQW EHKDYLRUV RI WKH OLQHDUL]HG PRGHO HVSHFLDOO\ IRU KLJKHU DQJXODU YHORFLWLHV ,W VKRZV WKDW WKH DGRSWHGFRQWUROOHUDFKLHYHVDGHTXDWHSHUIRUPDQFHHYHQZLWK WKLVGLIIHUHQFHEHWZHHQPRGHOVDQGLWSUHVHQWVLQWHUHVWLQJ IHDWXUHVRIUREXVWQHVVVXJJHVWLQJIXUWKHUVWXGLHVRQWKLVLVVXH
CONCLUSIONS
7KLVSDSHUSUHVHQWVGLIIHUHQWVWDJHVRIGHVLJQLQJDGLJLWDO FRQWUROOHUIRUDUWL¿FLDOVDWHOOLWHDWWLWXGHEDVHGRQWKHWKHRU\ RI/4*UHJXODWRUGH¿QHGIURPWKHOLQHDUL]HGPRGHORIWKH DWWLWXGHG\QDPLFV7KHVDWHOOLWHFRQVLGHUHGLQWKLVVWXG\ZDVWKH
003GHYHORSHGDW,13(,QRUGHUWRGHDOZLWKPRUHUHDOLVWLF IHDWXUHVWKHFRQWUROOHUZDVGHYHORSHGDQGLPSOHPHQWHGLQD GLJLWDOSURFHVVRUDQGWHVWHGZLWKLQDFRVLPXODWLRQVFKHPH LQ0$7/$%6,08/,1.VLPXODWLRQRIWKHVDWHOOLWHPRWLRQ DQG '63 3:3) FRQWUROOHU DQG PRGXODWRU 7KH UHVXOWV RIQXPHULFDOVLPXODWLRQVIRUWKHWKUHHVWDJHVRIWKHVWXG\ GHYHORSPHQWVKRZWKHVXLWDELOLW\RIWKH/4*FRQWUROOHUDV ZHOODVWKHSURFHVVRIGLVFUHWL]DWLRQRIWKHGHVLJQHGFRQWUROOHU DQGWKHLPSOHPHQWDWLRQLQD'63
&RQWLQXLW\ RI WKH SURMHFW FDQ FRQVLGHU WKUHH PDLQ SRVVLELOLWLHV7KH¿UVWZLOOEHWKHGHVLJQLQJDQGWHVWYDOLGDWLRQ RI YDULDQW FRQWUROOHUV EDVHG RQ GLIIHUHQW DSSURDFKHV DQG WKHRULHV7KHVHFRQGRQHLQYROYHVWKHXVHRIRWKHUW\SHVRI DFWXDWRUV VXFK DV UHDFWLRQ ZKHHOV DQG PDJQHWLF WRUTXHUV FRQVLGHUHGDOVRLQXVHFRPELQHGZLWKJDVMHWVDQGRWKHUPRGHV RUSKDVHVRIVWDELOL]DWLRQRIWKHVDWHOOLWH7KHODWWHUDOWHUQDWLYH LV WR FRQWLQXH WKH VWXG\ XVLQJ H[SHULPHQWDO SODWIRUPV SRVVLEO\LQVLPSOL¿HGH[SHULPHQWDODUUDQJHPHQWVLQUHODWLRQ WRDUHDOVDWHOOLWHLQÀLJKW7KLVRSWLRQDOORZVWKHSHUIRUPDQFH DQDO\VLV RI WKH FRQWUROOHU LQ DFWLRQ LQ DQ H[SHULPHQWDO V\VWHP 7KH FRVLPXODWLRQ VFKHPH DGGV DVSHFWV RI UHDOLVP LQ WKH VLPXODWLRQV WKDW FRXOG QRW EH HQWLUHO\ GRQH LQ WKH FRPSXWLQJ HQYLURQPHQW EXW LW GRHV QRW
)LJXUH &RVLPXODWLRQ UHVXOWV RI DWWLWXGH FRQWURO IRU WKH WKUHH (XOHU¶VDQJOHVFRQVLGHULQJDWUDFNLQJPDQHXYHU
UHSODFH WKH RSSRUWXQLW\ WR YHULI\ DVSHFWV RI WKH W\SLFDO SK\VLFDOH[SHULPHQWV
ACKNOWLEDGEMENTS
7KH DXWKRUV DFNQRZOHGJH WKH VXSSRUW RI$%& )HGHUDO 8QLYHUVLW\8)$%&Coordenação de Aperfeiçoamento de 3HVVRDOGH1tYHO6XSHULRU&$3(6and of the Fundação de Amparo à Pesquisa do Estado de São Paulo)$3(63
REFERENCES
$UDQWHV-U*et al³2SWLPDORQRIIDWWLWXGHFRQWUROIRU
WKH%UD]LOLDQPXOWLPLVVLRQSODWIRUPVDWHOOLWH´0DWKHPDWLFDO 3UREOHPVLQ(QJLQHHULQJY,'
ǖVWURP.-:LWWHUQPDUN%³&RPSXWHU&RQWUROOHG 6\VWHPV7KHRU\DQG'HVLJQ´1HZ-HUVH\86$3UHQWLFH+DOO
%U\VRQ-U$(³&RQWURORI6SDFHFUDIWDQG$LUFUDIW´ 1HZ-HUVH\86$3ULQFHWRQ8QLYHUVLW\3UHVV
%XFN 19 ³0LQLPXP9LEUDWLRQ 0DQHXYHUV 8VLQJ ,QSXW6KDSLQJDQG3XOVH:LGWK3XOVH)UHTXHQF\0RGXODWHG 7KUXVWHU&RQWURO´0V&7KHVLV1DYDO3RVWJUDGXDWH6FKRRO 0RQWHUH\&DOLIRUQLD86$
'RUDWR 3et al ³/LQHDU 4XDGUDWLF &RQWURO DQ
,QWURGXFWLRQ´1HZ-HUVH\86$3UHQWLFH+DOO
'RUI5&%LVKRS5+³0RGHUQ&RQWURO6\VWHPV´ 8SSHU6DGGOH5LYHU1HZ-HUVH\(8$3HDUVRQ3UHQWLFH+DOO
)UDQNOLQ*)et al³'LJLWDO&RQWURORI'\QDPLF6\VWHPV´
0DQLR 3DUN &DOLIRUQLD 86$$GGLVRQ :HVOH\ /RQJPDQ ,13(,QVWLWXWR1DFLRQDOGH3HVTXLVDV(VSDFLDLV6mR -RVpGRV&DPSRV6mR3DXOR%UD]LO5HWULHYHGLQ0DUFK IURPKWWSZZZLQSHEU
,13( ± ,QVWLWXWR 1DFLRQDO GH 3HVTXLVDV (VSDFLDLV ³3URJUDPD(VSDFLDO%UDVLOHLURGH2EVHUYDomRGD7HUUD´$QDLV 6HPLQiULRGH$YDOLDomRH3ODQHMDPHQWRGD2%7&DPSRVGR -RUGmR6mR3DXOR%UD]LO
0LOHVNL$0³(QWUHYLVWDFRP*LOEHUWR&kPDUD3DUWH ,,´3RUWDO3DQRUDPD(VSDFLDO5HWULHYHGLQ0DUFK IURPKWWSSDQRUDPDEORJVSRWFRPHQWUHYLVWDFRP JLOEHUWRFDPDUDSDUWHLLKWPO
6FKU|GHU5et al³0DSVDUDVPDOOOEDQGVDUPLVVLRQ
IRUODQGREVHUYDWLRQ´$FWD$VWURQDXWLFD9ROS
6KXVWHU0'³$VXUYH\RIDWWLWXGHUHSUHVHQWDWLRQV´7KH -RXUQDORIWKH$VWURQDXWLFDO6FLHQFHV9RO1RS
6HHODHQGHU*³(PXODomRH&R6LPXODomRGR6LVWHPDGH &RQWUROHGH$WLWXGHGD300HGR6LVWHPD(OHWUR+LGUiXOLFRGH XPD$HURQDYH8VDQGR)3*$V´06F7KHVLV,QVWLWXWR1DFLRQDO GH 3HVTXLVDV (VSDFLDLV 6mR -RVp GRV &DPSRV 63 %UD]LO
6RDUHV 3025 ³'LVFUHWL]DomR GH &RQWURODGRUHV &RQWtQXRV´ 'LVVHUWDomR GH 0HVWUDGR )DFXOGDGH GH (QJHQKDULDGD8QLYHUVLGDGHGR3RUWR3RUWR3RUWXJDO
