Abstract: In this paper, a robust Kalman filter is proposed for Mars entry navigation. The multiple uncertainties present in the. Mars atmosphere density together ...
Proceedings of the 34th Chinese Control Conference July 28-30, 2015, Hangzhou, China
$5REXVW.DOPDQ)LOWHUIRU0DUV(QWU\1DYLJDWLRQ =KHQJVKL @DQDFFXUDWHGHWHUPLQDWLRQRIDWPRVSKHUHGHQVLW\FDQVWLOO QRW EH DFKLHYHG GXH WR WKH UDQGRPQHVV DQG WLPHYDU\LQJ GLVWXUEDQFH7KLVXQFHUWDLQW\LQWKHDWPRVSKHUHGHQVLW\FDQ EH UHJDUGHG DV WKH SDUDPHWHU XQFHUWDLQW\ LQ WKH G\QDPLF
7KLVZRUNLVVXSSRUWHGE\1DWLRQDO%DVLF5HVHDUFK3URJUDPRI&KLQD 3URJUDP &% 1DWLRQDO 1DWXUDO 6FLHQFH )RXQGDWLRQ RI &KLQD 5HVHDUFK )XQG IRU WKH 'RFWRUDO 3URJUDP RI +LJKHU (GXFDWLRQ RI &KLQD DQG 6FLHQFH DQG 7HFKQRORJ\ ,QQRYDWLRQ7HDPRI%HLMLQJ,QVWLWXWHRI7HFKQRORJ\
PRGHORI0DUVHQWU\,QWKLVFLUFXPVWDQFHLIWKHQDYLJDWLRQ UHOLHV RQ DQ DFFXUDWH G\QDPLF PRGHO WKH VWDELOLW\ RI HVWLPDWLRQ FDQQRW EH JXDUDQWHHG )XUWKHUPRUH WKH KLJK VSHHGRIVSDFHFUDIWZLOOFDXVHWKHLRQL]DWLRQRIDWPRVSKHUH 7KLVSKHQRPHQRQPD\UHVXOWLQDQXQH[SHFWHGPHDVXUHPHQW QRLVH HVSHFLDOO\ IRU UDGLRPHWULF PHDVXUHPHQWV 7KHVH XQPRGHOHGPHDVXUHPHQWQRLVHVZLOODOVRUHGXFHWKHVWDELOLW\ RI QDYLJDWLRQ ILOWHU 7KHUHIRUH KRZ WR DFKLHYH D KLJK UREXVWQHVV XQGHU WKH PRGHO SDUDPHWHU XQFHUWDLQW\ DQG XQPRGHOHG PHDVXUHPHQW QRLVHV VKRXOG EH HPSKDVL]HG LQ QDYLJDWLRQILOWHUGHVLJQ $PRQJYDULRXVNLQGVRIILOWHUVIRURSWLPDOHVWLPDWLRQIRU QRQOLQHDUG\QDPLFV\VWHPVWKHPRVWZLGHO\XVHGDSSURDFK LV WKH (.) H[WHQGHG .DOPDQ ILOWHU > @ +RZHYHU WKH WUXQFDWLRQHUURUVFDXVHGE\OLQHDUL]DWLRQPD\VORZGRZQWKH FRQYHUJHQFHDQGGHFUHDVHWKHDFFXUDF\7RDFFRXQWIRUWKH QRQOLQHDU G\QDPLF PRGHO DGYDQFHG ILOWHULQJ DOJRULWKPV VXFK DV 8.) 8QVFHQWHG .DOPDQ )LOWHU > @ (Q.) (QVHPEOH .DOPDQ )LOWHU >@ DQG (Q65) (QVHPEOH 6TXDUH5RRW)LOWHU >@KDYHEHHQSURSRVHG7KHVHILOWHUV XVHDVHWRIVLJPDSRLQWRUHQVHPEOHVSURSDJDWLQJZLWKWKH QRQOLQHDUV\VWHPWRQXPHULFDOO\FRPSXWHWKHYDULDQFHDQG FRYDULDQFH PDWULFHV $QRWKHU NLQG RI ILOWHUV FDOFXODWHV WKH HUURUSURSDJDWLRQZLWKWKHKHOSRISRO\QRPLDOFKDRVZKLFK PD\ LQFUHDVH WKH HIILFLHQF\ >@ ,Q WKH DOJRULWKP WKH SURSDJDWLRQRIVWDWH¶VPHDQDQGYDULDQFHFDQEHFDOFXODWHG XVLQJ WKH FRHIILFLHQWV RI SRO\QRPLDO FKDRV +RZHYHU WKH PDLQHVWLPDWLRQIUDPHZRUNRIWKHVHILOWHUVVWLOOIROORZVWKH EDVLF.DOPDQVFKHPH0HDQZKLOHWKH3DUWLFOH)LOWHUVZHUH GHYHORSHG WR FRPSXWH WKH VHTXHQWLDO %D\HVLDQ HVWLPDWLRQ EDVHGRQDODUJHQXPEHURISDUWLFOHV>@1HYHUWKHOHVV WKH DFFXUDF\ UHOLHV VLJQLILFDQWO\ XSRQ WKH QXPEHU RI SDUWLFOHV ZKLFK UHVWULFWV LWV SUDFWLFDO XVDJH ,W VKRXOG EH QRWLFHG WKDW WKH ILOWHUV PHQWLRQHG DERYH DOO UHO\ RQ D UHODWLYHO\ DFFXUDWH G\QDPLF PRGHO ,I ODUJH XQFHUWDLQW\ LV SUHVHQW LQ WKH G\QDPLF PRGHO WKH VWDELOLW\ RI ILOWHU DOJRULWKPZLOOEHGHFUHDVHG
5014
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
'\QDPLFVRI0DUV(QWU\1DYLJDWLRQ6\VWHP %DVHG RQ WKH ODWHVW UHVHDUFK RQ WKH FRPPXQLFDWLRQ EODFNRXW >@ WKH UDGLRPHWULF PHDVXUHPHQWV WR WKH 0DUV RUELWHUVRUEHDFRQVFDQEHLQWURGXFHGWRKHOSGHWHUPLQHWKH VSDFHFUDIW¶VVWDWHV VHH)LJ
DUH WKUHHD[LV SRVLWLRQ DQG YHORFLW\ YHFWRUV UHVSHFWLYHO\ 7KH DWPRVSKHUH RI 0DUV LV DVVXPHG WR EH VWHDG\ )XUWKHUPRUH LW LV DVVXPHG WKDW WKH VSDFHFUDIW IOLHV ZLWK D ]HURWULPDQJOHRIDWWDFNDQGD]HURVLGHVOLSDQJOHGXULQJWKH DWPRVSKHULFHQWU\7KHPRWLRQRIWKHHQWU\YHKLFOHLVWKXV JRYHUQHGE\WKHIROORZLQJHTXDWLRQV v ª º ª r º « v v vur vur r »» « » « ¬v ¼ « D v L FRV V v u v u r L VLQ V v u r g r » ¬ ¼ ,QWKHHTXDWLRQıLVWKHEDQNLQJDQJOHZKLFKSURYLGHVWKH FRQWURO RI VSDFHFUDIW L DQG D UHIHU WR WKH OLIW DQG GUDJ DFFHOHUDWLRQWHUPVg VWDQGVIRUWKHJUDYLW\DFFHOHUDWLRQ7KH JUDYLW\OLIWDQGGUDJDFFHOHUDWLRQVDUHPRGHOHGE\ g P r °° ® L U v CL S m ° °¯ D U v CD S m ZKHUHȝLVWKH0DUWLDQJUDYLWDWLRQDOFRQVWDQWSDQGmDUH WKHUHIHUHQFHDUHDDQGPDVVRIWKHHQWU\YHKLFOH CLDQGCD GHQRWHVWKHOLIWDQGGUDJFRHIILFLHQWVUHVSHFWLYHO\ȡ UHIHUVWR WKH0DUVDWPRVSKHULFGHQVLW\ZKLFKLVWKHPRVWXQFHUWDLQ SDUDPHWHU LQ WKH G\QDPLF PRGHO :H FDQ DEEUHYLDWH VXFK HTXDWLRQDV x f x ȡ 2EVHUYDWLRQ0RGHO %\DQDO\]LQJWKHUDQJHDQG'RSSOHUVKLIWHGVLJQDOVIURP WUDQVFHLYHU WKH UDGLRPHWULF PHDVXUHPHQWV WR WKH 0DUV RUELWHUV DUH SURYLGHG 7KH UDGLDO UDQJH FDQ EH VLPSO\ PRGHOHGE\ Ri
ri B r
xiB x yiB y ziB z
i " n ZKHUH Ri UHIHUVWRWKHUDGLDOUDQJHEHWZHHQVSDFHFUDIWDQG WKHiWKRUELWHUnLVWKHQXPEHURIRUELWHUVZHXVH,WVKRXOG EH QRWLFHG WKDW EHFDXVH WKH VSDFHFUDIW PRYHV GXULQJ WKH HQWU\SKDVHWKHYDOXHRIrFKDQJHVZLWKWLPH0HDQZKLOH WKH UDGLRPHWULF PHDVXUHPHQWV IURP IL[HG JURXQG EDVHG EHDFRQV DUH IRFXVHG VR rBi LV FRQVWDQW GXULQJ WKH HQWU\ SKDVH 7KHUDGLDOYHORFLW\LVWKHWLPHUDWHRIWKHUDGLDOUDQJHWKXV WKHREVHUYDWLRQRIUDGLDOYHORFLW\LVWKHQJLYHQE\ Vi dRi dt vx xBi x v y yBi y vz zBi z Ri
v ni i " n ZKHUHViGHQRWHVWKHUDGLDOYHORFLW\EHWZHHQWKHYHKLFOHDQG WKH iWK RUELWHU )XUWKHUPRUH ni UHIHUV WR WKH XQLW SRVLWLRQ YHFWRUIURPWKHVSDFHFUDIWWRRUELWHUVDWLVI\LQJ T rBi r ni ª¬ nix niy niz º¼ rBi r
)LJ 7KH0DUVHQWU\QDYLJDWLRQEDVHGRQ0DUVQHWZRUNV
'\QDPLF0RGHO 7KH G\QDPLF PRGHO RI VSDFHFUDIW LV FRQVWUXFWHG LQ WKH 0DUVLQHUWLDOIUDPH7KHVL[GLPHQVLRQDOVWDWHRIVSDFHFUDIW LVGHILQHGDVx >rTvT@TLQZKLFKr >xyz@TDQGv >vxvyvz@T
:KHQ WKH PHDVXUHPHQW QRLVH LV SUHVHQW WKH REVHUYDWLRQ PRGHORIUDGLDOUDQJHDQGYHORFLW\FDQEHFKDUDFWHUL]HGE\ yRi Ri H Ri ZRi ® ¯ yVi Vi HVi ZVi :H FDOO İRi DQG İVi WKH PRGHOHG UDQJH DQG YHORFLW\ PHDVXUHPHQWQRLVHZKLFKFDQEHUHJDUGHGDVXQFRUUHODWHG
5015
]HURPHDQ*DXVVLDQQRLVHVZLWKWKHVWDQGDUGGHYLDWLRQVRI ıRiDQGıVi)XUWKHUPRUHȦRiDQGȦViDUHXQPRGHOHGUDQJH DQG YHORFLW\ PHDVXUHPHQW QRLVHV ZKLFK DUH FDXVHG E\ SODVPDLQWHUIHUHQFHDQGRWKHUXQFHUWDLQW\GLVWXUEDQFH %\ LQWURGXFLQJ PHDVXUHPHQWV RI UDQJH DQGRU YHORFLW\ IURP GLIIHUHQW RUELWHUV GLIIHUHQW 0DUV RUELWHUEDVHG QDYLJDWLRQ VFHQDULRV FDQ EH LQLWLDWHG ,Q WKH IROORZLQJ DQDO\VLV ZH PDLQO\ FRQVLGHU WKH QDYLJDWLRQ VFHQDULR SURFHVVLQJ RI UDQJH PHDVXUHPHQWV IRUP PXOWLSOH JURXQG EDVHG EHDFRQV 7KH REVHUYDWLRQ PRGHO RI UDGLRPHWULF PHDVXUHPHQWVFDQEHDEEUHYLDWHGDVy h x İR+ȦR
5REXVW.DOPDQ)LOWHU ,Q WKLV VHFWLRQ WKH DOJRULWKP RI UREXVW .DOPDQ ILOWHU LV GHYHORSHGZLWKWKHFRQVLGHUDWLRQRIWKHHIIHFWRIDWPRVSKHUH GHQVLW\XQFHUWDLQW\DQGXQPRGHOHGPHDVXUHPHQWQRLVH7KH DOJRULWKP RI UREXVW .DOPDQ ILOWHU FDQ EH GLYLGHG LQWR WZR SKDVHV VWDWHSURSDJDWLRQDQGVWDWHDVVLPLODWLRQ,QRUGHUWR LQKHULW WKH (.)¶V DGYDQWDJHV RI HDV\ LPSOHPHQWDWLRQ DQG ORZ FRPSXWDWLRQDO FRVW WKH EDVLF ILOWHULQJ VFKHPH LV WKH VDPH DV WUDGLWLRQDO (.) 2QO\ WKH .DOPDQ ILOWHU JDLQ LV QHZO\GHULYHGWRDFFRXQWIRUWKHSDUDPHWHUXQFHUWDLQW\DQG XQPRGHOHGPHDVXUHPHQWQRLVH7KHGHWDLOHGGHVFULSWLRQRI WKHDOJRULWKPLVDVIROORZV 6WDWH3URSDJDWLRQ
,WLVDVVXPHGWKDWWKHRSWLPDOHVWLPDWLRQDWWLPHtkLV xka WKHVWDWHYDULDQFHLV Pka 7KHQWKHVWDWHSURSDJDWLRQIURPtk WRtkFDQEHSHUIRUPHGE\ tk
xkf
³
PDWUL[ DQG yk LV WKH PHDVXUHPHQW ,Q WKH DOJRULWKP RI (.)WKHVWDWHHVWLPDWLRQHUURUFDQEHFDOFXODWHGE\ xk xka xk xkf K k ª¬ yk ykf º¼ | > I K k H k @ xk xkf K k İk | > I K k H k @ ĭk k xk x
K
İ
k k
7KHUHIRUHWKHDVVLPLODWHGVWDWHYDULDQFHLVGHWHUPLQHGDV
Pka
> I K k H k @ Pk f > I K k H k @
T
K k RK kT
ZKHUH R LV WKH YDULDQFH PDWUL[ RI PRGHOHG PHDVXUHPHQW QRLVHVDWLVI\LQJ ªV R O º « » T % R E İR İR « » » «O V Rn ¼ ¬ a %\ PLQLPL]LQJ WKH WUDFH RI Pk WKH .DOPDQ JDLQ LV FRPSXWHGE\
ª¬ H k Pk f H kT R º¼ H k Pk f +RZHYHU LQ VXFK DOJRULWKP WKH XQFHUWDLQW\ RI DWPRVSKHUHGHQVLW\DQGXQPRGHOHGPHDVXUHPHQWQRLVHDUH QRWWDNHQLQWRFRQVLGHUDWLRQZKLFKOHDGVWRDZHDNVWDELOLW\ 7R LPSURYH WKH UREXVWQHVV RI (.) ZH QHZO\ GHULYH WKH VWDWHHVWLPDWLRQHUURUE\ xk xka xk xkf K k ª¬ yk ykf º¼
K kT
| > I K k H k @ xk xkf K k İk K k Ȧk
| > I K k H k @ ª¬ĭk k xk xka ĭkU k U k UÖ k º¼
f xka UÖ k dt
K k İk K k Ȧk
tk
,QWKHHTXDWLRQ xkf LVWKHIRUHFDVWHGVWDWHDWtk UÖ k UHIHUV WRWKHQRPLQDODWPRVSKHUHGHQVLW\DWWLPHtkZKLFKFDQEH FDOFXODWHGE\DQH[SRQHQWLDOPRGHO UÖ k U H[S ª¬ r rka hs º¼ ZKHUH U u NJP LV WKH UHIHUHQFH GHQVLW\ r NP LV WKH UHIHUHQFH UDGLDO SRVLWLRQ DQG
a k
ī k ek K k İk ȉ k 'U k K k Ȧk
LQZKLFK ĭkU k LVWKHSDUDPHWHUWUDQVLWLRQPDWUL[%HFDXVH
,Q WKH GDWD DVVLPLODWLRQ SKDVH WKH IRUHFDVWHG VWDWH LV XSGDWHGE\WKHPHDVXUHPHQWV-XVWOLNHWKH(.)ZHDOVRXVH WKHOLQHDUDVVLPLODWLRQVFKHPH xka xkf K k yk ykf
WKH UHODWLRQVKLS EHWZHHQ WKH VWDWH DW tk DQG tk FDQ EH DSSUR[LPDWHO\H[SUHVVHGDV ª º ª rk º « rk 'tvk 't ak » | «v » « » ¬ k ¼ « 'tak ¬ ¼» WKHSDUDPHWHUWUDQVLWLRQPDWUL[FDQEHFDOFXODWHGE\ ª wak º « 't wU » x w k » U k « ĭk k « wak » wU k « 't » wU k ¼ ¬ ,WVKRXOGEHQRWLFHGWKDWWKHILUVWWZRWHUPVRQWKHULJKWLV WKHVDPHDV(T +RZHYHUWKHDGGLWLRQDOWHUPVRIERWK DWPRVSKHUH GHQVLW\ XQFHUWDLQW\ DQG XQPRGHOHG PHDVXUHPHQW QRLVH DOVR DIIHFW WKH HVWLPDWLRQ HUURU )XUWKHUPRUH EHFDXVH WKH VWDWLVWLFDO SURSHUWLHV RI DWPRVSKHUH GHQVLW\ XQFHUWDLQW\ DQG XQPRGHOHG PHDVXUHPHQWQRLVHDUHXQNQRZQVXFKLQIOXHQFHFDQQRWEH VLPSO\GHVFULEHGE\YDULDQFHPDWULFHV,QRUGHUWRDFFRXQW IRUWKHFRQWULEXWLRQRIDWPRVSKHUHGHQVLW\XQFHUWDLQW\DQG XQPRGHOHG PHDVXUHPHQW QRLVH WR WKH HVWLPDWLRQ HUURU ZH ILUVWGHILQHWZRDGGLWLRQDOHUURUVWHUPV ekU ȉ k 'U k ekw K k wk
ZKHUH xka LVWKHDVVLPLODWHGVWDWHDWtk K k LVWKH JDLQ
ZKHUH ekU LVWKHHUURUWHUPFDXVHGE\DWPRVSKHUHGHQVLW\
hs PUHIHUVWRWKHDWPRVSKHULFVFDOHKHLJKW rka LVWKH RSWLPDOHVWLPDWHGSRVLWLRQYHFWRUDWWLPHtk 7KHQWKHIRUHFDVWHGPHDVXUHPHQWLVPRGHOHGDV ykf h xkf
7KHSURSDJDWLRQRIVWDWHYDULDQFHLVSHUIRUPHGE\ Pk f ĭk k Pka ĭkT k ZKHUH ĭk k LVWKHVWDWHWUDQVLWLRQPDWUL[VDWLVI\LQJ
wf § wf · 't ¨ a ¸ wxka © wxk ¹ ,QWKHHTXDWLRQ 't LVWKHWLPHVSDQEHWZHHQtkDQG tk
ĭk k
I 't
'DWD$VVLPLODWLRQ
5016
XQFHUWDLQW\DQG ekw LVWKHHUURUWHUPFDXVHGE\XQPRGHOHG PHDVXUHPHQWQRLVH7KHUHIRUHZHFDQJHW ȉ k 'U k
d ȉ k
d K k
F
'U k
tr ȉ k ȉ kT 'U k
D e
w k
K k Ȧk
F
Ȧk
tr K k K
ZKHUH LQGLFDWHV WKH QRUP ZKLOH
F
T k
Ȧk
E LQGLFDWHV WKH
)UREHQLXVQRUP ,Q WKLV FLUFXPVWDQFH ZH FRQVWUXFW WKH SHUIRUPDQFHLQGH[DV J tr Pka wtr ȉ k ȉ kT w tr K k K kT ,QWKHHTXDWLRQwDQGwDUHZHLJKWLQJVFRUUHVSRQGLQJ WR WKH DWPRVSKHUH GHQVLW\ XQFHUWDLQW\ DQG XQPRGHOHG PHDVXUHPHQW QRLVH UHVSHFWLYHO\ )RU RQH WKLQJ WKH SHUIRUPDQFH LQGH[ UHIOHFWV WKH HVWLPDWLRQ DFFXUDF\ tr Pka IRU DQRWKHU WKH WHUPV tr ȉ k ȉ kT DQG tr K k K kT PLQLPL]HWKHLQIOXHQFHRIDWPRVSKHUHGHQVLW\ XQFHUWDLQW\ DQG XQPRGHOHG PHDVXUHPHQW QRLVH WR WKH HVWLPDWLRQHUURUZKLFKLPSURYHWKHUREXVWQHVVRIILOWHU7KH RSWLPDO JDLQ PDWUL[ LV GHULYHG E\ PLQLPL]LQJ WKH SHUIRUPDQFHLQGH[7KHHTXLYDOHQWFRPSXWDWLRQPHWKRGLV WRVROYHWKHIROORZLQJHTXDWLRQ wJ O wK kT 7KHVROXWLRQRIVXFKHTXDWLRQLVJLYHQE\ K kopt
ª¬ H k Pk f w H k ĭU º¼
T
T f T ¬ª w H k ĭU H k w I H k Pk H k R º¼
ZKHUH
ĭU
,QWKLVFKDSWHUWKHVLPXODWLRQVRI0DUVHQWU\QDYLJDWLRQ XVLQJ UDQJH PHDVXUHPHQWV WR WKUHH UDGLR EHDFRQV DUH SHUIRUPHG :LWK WKH FRQVLGHUDWLRQ RI DWPRVSKHUH GHQVLW\ XQFHUWDLQW\DQGXQPRGHOHGPHDVXUHPHQWQRLVHWKHEHQHILW RIUREXVW.DOPDQILOWHURYHUWKHH[WHQGHG.DOPDQILOWHULV GHPRQVWUDWHG)XUWKHUPRUHXVLQJ0RQWH&DUORVLPXODWLRQV WKHFRQWULEXWLRQRIZHLJKWLQJVWRHVWLPDWLRQSHUIRUPDQFHLV DQDO\]HGDQGWKHRSWLPDOYDOXHRIFRHIILFLHQWVaDQG aDUH UHFRPPHQGHG 3HUIRUPDQFHRI5REXVW.DOPDQ)LOWHU
)LUVWRIDOOWKHQDYLJDWLRQVFHQDULRLVLQLWLDWHG7KHLQLWLDO FRQGLWLRQRIWKHHQWU\YHKLFOHLVOLVWHGDVIROORZVZKLFKLV DQHTXLYDOHQWGHVFULSWLRQRIWKHLQLWLDOVWDWHLQ5HI>@ x NP y NP z NP vx PV v y PV vx PV )XUWKHUPRUHWKHSRVLWLRQVRIWKUHHEHDFRQVDUHDVIROORZV xB NP yB NP z B NP xB NP yB NP z B P xB NP yB NP z B NP 7KHVWDQGDUGGHYLDWLRQVRIPRGHOHGUDQJHPHDVXUHPHQW QRLVHLVDVVXPHGWREHıRi P7KHDWPRVSKHUHGHQVLW\ XQFHUWDLQW\LVDVVXPHGWREHWKHRIDWPRVSKHUHGHQVLW\ SOXV D ELDV RI u NJP )XUWKHUPRUH WKH XQPRGHOHG PHDVXUHPHQWQRLVHFRQWDLQVDPEHDFRQSRVLWLRQHUURU ZKLWH QRLVH DQG D P ELDV 7KH DWPRVSKHUH GHQVLW\ XQFHUWDLQW\ DQG XQPRGHOHG PHDVXUHPHQW QRLVH RI ILUVW EHDFRQDUHVKRZQLQ)LJDQG)LJ í3
Atmosphere density uncertainty (kg/m3)
ekU
1DYLJDWLRQ6LPXODWLRQV
ĭkU k ĭkU k T
,W FDQ EH IRXQG WKDW WKH DGGLWLRQDO WHUPV RI DWPRVSKHUH GHQVLW\ XQFHUWDLQW\ DQG XQPRGHOHG PHDVXUHPHQW QRLVH ³GHFUHDVH´WKHYDOXHRIWUDGLWLRQDO.DOPDQJDLQPDWUL[7KH YDOXH RI w DQG w FDQ EH GHWHUPLQHG E\ WKH SULRUL XSSHU QRUP RI DWPRVSKHUH GHQVLW\ XQFHUWDLQW\ DQG XQPRGHOHG PHDVXUHPHQWQRLVH w
a 'U w
a Ȧ
ZKHUH a DQG a DUH FRHIILFLHQWV ,W LV IRXQG WKDW WKH WZR ZHLJKWLQJV w DQG w LQGLFDWH WKH VLJQLILFDQFH RI DWPRVSKHUH GHQVLW\ XQFHUWDLQW\ DQG XQPRGHOHG PHDVXUHPHQW QRLVH ,I w DQG w WKH UREXVW .DOPDQ ILOWHUGHJHQHUDWHWRWKHH[WHQGHG.DOPDQILOWHU,Iw LW PHDQVWKDWWKHDPSOLWXGHRIXQPRGHOHGPHDVXUHPHQWQRLVH
f 7KHUHIRUH WKH PHDVXUHPHQWV DUH
ĭU H kT H k ĭU H kT DQGWKHVWDWHHVWLPDWLRQLV
FRPSOHWHO\EDVHGRQWKHPHDVXUHPHQWV %DVHGRQSUHYLRXVDQDO\VLVLWLVLQIHUUHGWKDWWKHYDOXHRI aDQGaKDYHLPSDFWRQWKHHVWLPDWLRQSHUIRUPDQFH7KH GHWDLOHG GLVFXVVLRQ DERXW WKH RSWLPDO GHWHUPLQDWLRQ RI a DQGaFDQEHIRXQGLQWKHIROORZLQJVHFWLRQ
1.5 1 0.5 0 í0.5 í1 í1.5 í2
0
50
100 150 Time (s)
200
250
400
XQUHOLDEOH ,Q VXFK FLUFXPVWDQFH K O DQG QR GDWD DVVLPLODWLRQ LV SHUIRUPHG ,I w LW PHDQV WKDW WKH DPSOLWXGH RI DWPRVSKHUH GHQVLW\ XQFHUWDLQW\ LV LQILQLW\ 7KHUHIRUH WKH HVWLPDWLRQ HUURU LV VROHO\ FDXVHG EH WKH DWPRVSKHUH GHQVLW\ XQFHUWDLQW\ ,Q VXFK FLUFXPVWDQFH K kopt
x 10
)LJ $WPRVSKHUHGHQVLW\XQFHUWDLQW\ Unmodeled measurement noise of first beacon (m)
LV LQILQLW\ w
2
300 200 100 0 í100 í200 í300
0
50
100 150 Time (s)
200
250
)LJ 8QPRGHOHGPHDVXUHPHQWQRLVHRIEHDFRQ
$ VHFRQG VLPXODWLRQ KDV EHHQ SHUIRUPHG WR VLPXODWH WKH 0DUV HQWU\ QDYLJDWLRQ DQG FRPSDUH WKH QDYLJDWLRQSHUIRUPDQFHWLPH0RQWH&DUORVLPXODWLRQV
5017
DUH UXQ WR FDOFXODWH WKH ı HUURU ERXQG RI HDFK VWDWH 7KH FRPSDULVRQRI(.)DQG5.)LVVKRZQLQ)LJ
3
10
2
10
1
10
3
0
10
2
10
1
50 100 150 200 250 Time, s
0
50 100 150 200 250 Time, s
0
50 100 150 200 250 Time, s
2
2 1
2
10
a
2
0
0.5
0
a
1.5
1
0
10
2
2
1
2
1 0 0
a2
1
a1
D ıHUURUERXQGRIx G ıHUURUERXQGRIvx
0
10
0
50 100 150 200 250 Time, s
2
10
0
10
300 200 100 2
2
1
0
50 100 150 200 250 Time, s
)LJ 1DYLJDWLRQFRPSDULVRQRI(.)DQG5.)
a2
0
10
2
0
0
2
1
1
1 0 0
a2
a
1
a
1
E ıHUURUERXQGRIy G ıHUURUERXQGRIvy
%HFDXVHWKHXQFHUWDLQW\RIDWPRVSKHUHGHQVLW\DQGWKH XQPRGHOHGPHDVXUHPHQWQRLVHWKHQDYLJDWLRQSHUIRUPDQFH RIH[WHQGHG.DOPDQILOWHULVGHJUDGHG+RZHYHULIZHXVH WKHUREXVW.DOPDQILOWHUWKHHVWLPDWLRQHUURULVPRUHUREXVW WR WKH DWPRVSKHUH GHQVLW\ XQFHUWDLQW\ DQG WKH XQPRGHOHG PHDVXUHPHQWQRLVH7KHVLPXODWLRQUHVXOWVVKRZWKDWWKHı HUURU ERXQG RI HDFK VWDWH LV ORZHU WKDQ WKH WUDGLWLRQDO H[WHQGHG .DOPDQ ILOWHU ZKLFK LQGLFDWHV WKDW WKH SURSRVHG UREXVW .DOPDQ ILOWHU LV PRUH VXLWDEOH IRU WKH 0DUV HQWU\ QDYLJDWLRQ ZLWK DWPRVSKHUH GHQVLW\ XQFHUWDLQW\ DQG WKH XQPRGHOHGPHDVXUHPHQWQRLVH 0HDQZKLOHWKHHYROXWLRQRIWKHSHUIRUPDQFHLQGH[HVJ IURPERWKH[WHQGHG.DOPDQILOWHUDQGWKHSURSRVHGUREXVW .DOPDQILOWHUDUHDOVRFRPSDUHGLQ)LJ,WLVREYLRXVWKDW WKHSHUIRUPDQFHLQGH[IURPUREXVW.DOPDQILOWHULVVPDOOHU WKDQ WKDW IURP WKH H[WHQGHG .DOPDQ ILOWHU 7KLV DOVR GHPRQVWUDWHV WKH LPSURYHG QDYLJDWLRQ SHUIRUPDQFH XVLQJ WKHUREXVW.DOPDQILOWHU 10
10
3σ error bound of vx (m/s)
10
50 100 150 200 250 Time, s
3
3σ error bound of vy (m/s)
0
10
4
2
10
2
2
1 a2
1 0
0
a
1
3σ error bound of vz (m/s)
1
sσ error bound of x (m)
10
0
10
3σ error bound of y (m)
2
2
10
3σ error bound of z (m)
10
3σ bound vx, m/s
3
3σ bound vy, m/s
10
Robust Kalman Filter
3σ bound vz, m/s
3σ bound z, m
3σ bound y, m
3σ bound x, m
Extended Kalman Filter
,Q HDFK FDVH WKH VLPXODWLRQ UXQV WLPHV DQG WKH FRUUHVSRQGLQJıHUURUERXQGVDUHFRPSXWHG7KHıHUURU ERXQGV DW WKH HQG RI HQWU\ SKDVH LV XVHG WR TXDQWLI\ WKH QDYLJDWLRQDFFXUDF\ZKLFKDUHLOOXVWUDWHGLQ)LJ
6 4 2 0 2
2
1 a2
1 0
0
a1
F ıHUURUERXQGRIz G ıHUURUERXQGRIvz )LJ ıHUURUERXQGVZLWKGLIIHUHQWaDQGa
,WLVVKRZQWKDWERWKaDQGaPD\DIIHFWWKHQDYLJDWLRQ DFFXUDF\ &RPSDUHG ZLWK a a LV WKH PDLQ FRQWULEXWRU :LWKWKHLQFUHDVHRIaWKHıHUURUERXQGVRIVL[VWDWHVDUH UHGXFHGUDSLGO\HVSHFLDOO\IURPWR+RZHYHUDOWKRXJK WKHıHUURUERXQGVDUHDOVRUHGXFHGZLWKWKHLQFUHDVHRIa VXFK WUHQG LV PXFK OHVV REYLRXV )XUWKHUPRUH IRU WKH HVWLPDWLRQRIvWKHQDYLJDWLRQDFFXUDF\FDQQRWEHLPSURYHG XQOLPLWHGO\E\LQFUHDVLQJaDQGa:KHQa!WKHıHUURU ERXQGV RI v VWDUW WR LQFUHDVH DJDLQ 7KHUHIRUH WKH UHFRPPHQGHGYDOXHVRIaDQGaDUHDERXWa DQGa
Performance index
&RQFOXVLRQ
10
3
Extended Kalman Filter Robust Kalman Filter 10
2
0
50
100 150 Time, s
200
250
)LJ (YROXWLRQRIWKHSHUIRUPDQFHLQGH[HV
2SWLPDO9DOXHRIaDQGa
1H[WZHIRFXVRQWKHFRQWULEXWLRQRIFRHIILFLHQWVWRWKH QDYLJDWLRQDFFXUDF\:HFKRRVHWKHERWKaDQGaIURPWR
,QWKLVSDSHUDQRYHOUREXVW.DOPDQILOWHULVSURSRVHGWR GHDO ZLWK WKH DWPRVSKHUH GHQVLW\ XQFHUWDLQW\ DQG WKH XQPRGHOHG PHDVXUHPHQW QRLVH LQ WKH 0DUV HQWU\ SKDVH %HVLGHVWKHWUDFHRIHUURUYDULDQFHPDWUL[LQWKHSHUIRUPDQFH LQGH[WKHZHLJKWHGWHUPVRIWUDQVLWLRQPDWUL[RIDWPRVSKHUH GHQVLW\XQFHUWDLQW\DQGWKHXQPRGHOHGPHDVXUHPHQWQRLVH ZKLFK LQGLFDWH WKH FRUUHVSRQGLQJ JDLQ WR WKH HVWLPDWLRQ HUURUDUHDGGHGWRLPSURYHWKHUREXVWQHVVRIHVWLPDWLRQHUURU 7KH RSWLPDO JDLQ PDWUL[ LV GHULYHG E\ PLQLPL]LQJ WKH SHUIRUPDQFH LQGH[ 6LPXODWLRQ UHVXOWV IURP 0DUV HQWU\ QDYLJDWLRQ VFHQDULR GHPRQVWUDWH WKDW PRUH DFFXUDWH HVWLPDWLRQ DQG UREXVWQHVV WR QRLVHV FDQ EH DFKLHYHG IURP WKHSURSRVHGUREXVW.DOPDQILOWHU:LWKWKHFRQVLGHUDWLRQRI WKH DWPRVSKHUH GHQVLW\ XQFHUWDLQW\ DQG XQPRGHOHG PHDVXUHPHQW QRLVH WKH LQGH[ SHUIRUPDQFH RI UREXVW .DOPDQILOWHULVDOVRVPDOOHUWKDQWKHH[WHQGHG.DOPDQILOWHU
5018
7KH HIIHFWV RI FRHIILFLHQWV WR WKH QDYLJDWLRQ DFFXUDF\ LV DQDO\]HG DQG WKH UHFRPPHQGHG YDOXHV RI FRHIILFLHQWV ZKLFKDUHa DQGa DUHGHWHUPLQHGEDVHGRQ0RQWH &DUORVLPXODWLRQV
5HIHUHQFHV >@ 5 ' %UDXQ DQG 5 0 0DQQLQJ 0DUV H[SORUDWLRQ HQWU\ GHVFHQW DQG ODQGLQJ FKDOOHQJHV Journal of Spacecraft and Rockets SS± >@ (*/LJKWVH\$0RJHQVHQ3'%XUNKDUW7$(O\DQG &'XQFDQ5HDOWLPHQDYLJDWLRQIRU0DUVPLVVLRQVXVLQJWKH 0DUV QHWZRUN Journal of Spacecraft and Rockets ± >@ -)/pYHVTXHDQG-GH/DIRQWDLQH,QQRYDWLYHQDYLJDWLRQ VFKHPHVIRUVWDWHDQGSDUDPHWHUHVWLPDWLRQGXULQJ0DUVHQWU\ Journal of Guidance, Control, and Dynamics ± >@ +/-XVWKDQG+65DPH\0DUV*5$0 LPSURYLQJ WKH SUHFLVLRQ RI 0DUV*5$0 LQ 4th International Workshop on the Mars Atmosphere: Modelling and Observations)HE± >@ (0LOORXU))RUJHW)*RQ]DOH]*DOLQGRHWDO7KHODWHVW 9HUVLRQ 0DUV FOLPDWH GDWDEDVH LQ 3rd International Workshop on the Mars Atmosphere: Modeling and Observation >@ $+-D]ZLQVNLStochastic Processes and Filtering Theory 6DQ'LHJR $FDGHPLF3UHVV FKDSWHU >@ - / &UDVVLGLV DQG - / -XQNLQV Optimal Estimation of Dynamic Systems 2nd ed %RFD 5DWRQ &KDSPDQ +DOO&5&FKDSWHU >@ 6-XOLHUDQG-8KOPDQQ8QVFHQWHGILOWHULQJDQGQRQOLQHDU HVWLPDWLRQProceedings of the IEEE ± > @ *&KRZGKDU\DQG5-DWHJDRQNDU$HURG\QDPLFSDUDPHWHU HVWLPDWLRQIURPIOLJKWGDWDDSSO\LQJH[WHQGHGDQGXQVFHQWHG .DOPDQ ILOWHU Aerospace Science and Technology ± >@ * (YHQVHQ 6HTXHQWLDO GDWD DVVLPLODWLRQ ZLWK D QRQOLQHDU TXDVLJHRVWURSKLF PRGHO XVLQJ 0RQWH &DUOR PHWKRGV WR IRUHFDVW HUURU VWDWLVWLFV Journal of Geophysical Research & ± >@ * (YHQVHQ 6DPSOLQJ VWUDWHJLHV DQG VTXDUH URRW DQDO\VLV VFKHPHVIRUWKH(Q.)Ocean Dynamics ±
>@ - /L DQG ' ;LX $ JHQHUDOL]HG SRO\QRPLDO FKDRV EDVHG HQVHPEOH .DOPDQ ILOWHU ZLWK KLJK DFFXUDF\ Journal of Computational Physics ± >@ 23DMRQN%95RVLü$/LWYLQHQNRDQG+*0DWWKLHV$ GHWHUPLQLVWLF ILOWHU IRU QRQ*DXVVLDQ %D\HVLDQ HVWLPDWLRQ DSSOLFDWLRQV WR G\QDPLFDO V\VWHP HVWLPDWLRQ ZLWK QRLV\ PHDVXUHPHQWV Physica D ± >@ ( ' %ODQFKDUG $ 6DQGX DQG & 6DQGX $ 3RO\QRPLDO FKDRVEDVHG.DOPDQILOWHUDSSURDFKIRUSDUDPHWHUHVWLPDWLRQ RI PHFKDQLFDO V\VWHPV Journal of Dynamic Systems, Measurement, and Control >@ 30'MXULü-+.RWHFKD-=KDQJ@ ) *XVWDIVVRQ 1 %HUJPDQ 8 )RUVVHOO - -DQVVRQ 5 .DUOVVRQDQG3-1RUGOXQG3DUWLFOHILOWHUVIRUSRVLWLRQLQJ QDYLJDWLRQ DQG WUDFNLQJ IEEE Transactions on Signal Processing ± >@ -.LP07DQGDOH3.0HQRQDQG(2KOPH\HU3DUWLFOH ILOWHUIRUEDOOLVWLFWDUJHWWUDFNLQJZLWKJOLQWQRLVHJournal of Guidance, Control, and Dynamics >@ %&KHQ:&KHQDQG+:X5REXVW++LQILQLW\*OREDO /LQHDUL]DWLRQ)LOWHU'HVLJQIRU1RQOLQHDU6WRFKDVWLF6\VWHPV IEEE Transactions on Circuits and Systems I ± > @ + *DR ; 0HQJ DQG 7 &KHQ $ SDUDPHWHUGHSHQGHQW DSSURDFK WR UREXVW +LQI ILOWHULQJ IRU WLPHGHOD\ V\VWHPV ,(((7UDQVDFWLRQVRQDXWRPDWLFFRQWURO ± >@ .1DJSDODQG3.KDUJRQHNDU)LOWHULQJDQGVPRRWKLQJLQ DQ+LQILQLW\VHWWLQJInstitute of Electrical and Electronics Engineers Transactions on Automatic Control ± >@ '6LPRQ2SWLPDO6WDWH(VWLPDWLRQ .DOPDQ+LQILQLW\DQG 1RQOLQHDU$SSURDFKHV+RERNHQ -RKQ:LOH\ 6RQV >@ - / &UDVVLGLV DQG ) / 0DUNOH\ 3UHGLFWLYH ILOWHULQJ IRU QRQOLQHDU V\VWHPV Journal of Guidance, Control, and Dynamics ± >@ ' ' 0RUDELWR 7KH 6SDFHFUDIW FRPPXQLFDWLRQV EODFNRXW SUREOHP HQFRXQWHUHG GXULQJ SDVVDJH RU HQWU\ RI SODQHWDU\ DWPRVSKHUHV1$6$-HW3URSXOVLRQ/DE5HSW,3135 /RV$QJHOHV$XJ >@ =
