自适应抗差Kalman滤波在多天线原始观测值瞬时姿态确定中的应用

㊀２０１５年９月A c t aG e o d a e t i c ae tC a r t o g r a p h i c aS i n i c a S e p t e m b e r,２０１５㊀㊀第４４卷㊀第９期测㊀绘㊀学㊀报V o l．４４,N o．９引文格式:G A N Y u,S U IL i f e n,L I U C h a n g j i a n,e t a l．I n s t a n t a n e o u sA t t i t u d eD e t e r m i n a t i o nB a s e do nO r i g i n a lM u l t iＧa n t e n n aO b s e r v aＧt i o n sU s i n g A d a p t i v e l y R o b u s tK a l m a nF i l t e r i n g[J]．A c t aG e o d a e t i c a e tC a r t o g r a p h i c aS i n i c a,２０１５,４４(９):９４５Ｇ９５１．(甘雨,隋立芬,刘长建,等．自适应抗差K a l m a n滤波在多天线原始观测值瞬时姿态确定中的应用[J]．测绘学报,２０１５,４４(９):９４５Ｇ９５１．)D O I:１０．１１９４７/j．A G C S．２０１５．２０１４０４９２自适应抗差K a l m a n滤波在多天线原始观测值瞬时姿态确定中的应用甘㊀雨,隋立芬,刘长建,董㊀明信息工程大学地理空间信息学院,河南郑州４５００００I n s t a n t a n e o u sA t t i t u d eD e t e r m i n a t i o nB a s e do nO r i g i n a l M u l t iＧa n t e n n aO b s e rＧv a t i o n sU s i n g A d a p t i v e l y R o b u s t K a l m a nF i l t e r i n gG A NY u,S U I L i f e n,L I UC h a n g j i a n,D O N G M i n gI n s t i t u t eo f S u r v e y i n g a n dM a p p i n g,I n f o r m a t i o nE n g i n e e r i n g U n i v e r s i t y,Z h e n g z h o u４５００００,C h i n aA b s t r a c t:A t t i t u d ed e t e r m i n a t i o nd i r e c t l y b y c a r r i e r p h a s eo b s e r v a t i o nm a k e so p t i m a l u s eo f o b s e r v a t i o n a n da t t i t u d ec o n s t r a i n t s．T h e p h a s e m o d e l sb a s e do n m i s a l i g n m e n ta n g l ea n d m u l t i p l i c a t i v e q u a t e r n i o n e r r o r a r ed e r i v e d．T h e s t a t em o d e l s f o r a t t i t u d ee s t i m a t i o nw i t ha n dw i t h o u t e x t e r n a l a n g u l a r r a t e s e n s o r s a r eb o t h e r e c t e d．T h ea t t i t u d ee r r o r sa r ee s t i m a t e db y a d a p t i v e l y r o b u s t f i l t e r i n g,i nw h i c h t h ea d a p t i v e f a c t o r s o f a m b i g u i t y a n da t t i t u d e e r r o r a r e d e c i d e d r e s p e c t i v e l y f o l l o w i n g t h e i d e ao fm u l t i a d a p t i v e f a c t o r f i l t e r i n g．T h e f a c t o r o f a t t i t u d e i s d e t e r m i n e d b y a t h r e eＧs e c t i o n f u n c t i o n c o n t a i n i n g R a t i o．A d a p t i v e l y r o b u s t f i l t e r i n g m a k e s t h eb e s t u s e o f c o n s t r a i n t a n d h i s t o r i c a l i n f o r m a t i o n,f u s i n g t h e m i n t h e c a l c u l a t i o n o f f l o a t s o l u t i o n．A s t h ea c c u r a c y o f f l o a t s o l u t i o na n d t h e s t r u c t u r e o f c o v a r i a n c em a t r i x a r e i m p r o v e d g r e a t l y,t h e f i x s o l u t i o n c a nb e s e a r c h e de f f i c i e n t l y u s i n g L A MB D A(l e a s tＧs q u a r e sa m b i g u i t y d e c o r r e l a t i o na d j u s t m e n t) m e t h o dm e r e l y,p e r f e c t l y f u l f i l l i n g t h er e a lＧt i m er e q u i r e m e n t．F i e l dt e s to fas h i pＧb a s e dt h r e eＧa n t e n n aa t t i t u d e s y s t e m i su s e dt ov a l i d a t e t h e p r o p o s e dm e t h o d．I t i ss h o w e dt h a td i r e c ta t t i t u d ed e t e r m i n a t i o nb a s e do na d a p t i v e l y r o b u s t f i l t e r i n g h a s o b v i o u s a d v a n t a g e s i ne f f ic i e n c y a nd re l i a b i l i t y．K e y w o r d s:a d a p t i v e l y r o b u s t f i l t e r i n g;m u l t ia d a p t i v ef a c t o r s;m u l t iＧa n t e n n a s;i n s t a n t a n e o u sr e s o l u t i o n; q u a t e r n i o n e r r o r;m i s a l i g n m e n t a n g l eF o u n d a t i o n s u p p o r t:T h eN a t i o n a l N a t u r a l S c i e n c eF o u n d a t i o no f C h i n a(N o s．４１２７４０１６;４０９７４０１０);K e y F u n d o fG e o g r a p h i c I n f o r m a t i o nE n g i n e e r i n g N a t i o n a l K e y L a b o r a t o r y(N o．S K L G I E２０１４ＧZＧ２Ｇ１)摘㊀要:由载波相位观测值直接解算姿态能实现观测及姿态约束信息的最优利用.本文推导了基于失准角及乘性误差四元数的载波相位观测模型,分别建立了有外部角速度传感器和无外部传感器辅助下姿态参数估计的状态模型;利用自适应抗差滤波估计姿态误差,借鉴分类自适应因子的思想,分别确定模糊度和姿态误差参数的自适应因子,其中姿态自适应因子由R a t i o值构造的三段函数确定.自适应抗差滤波能够充分利用约束信息和历史信息,将其融合在浮点解计算过程中,极大提高模糊度浮点解精度及其协方差的结构,在此基础上使用整数最小二乘模糊度降相关平差法(l e a s tＧs q u a r e sa m b i g u i t y d e c o r r e l a t i o na d j u s t m e n t,L A M B D A)方法即能快速搜索出固定解,满足实时性需求.采用实测舰载G N S S３天线测姿算例对方法进行了验证,结果表明,基于自适应抗差滤波的观测值直接定姿方法效率高㊁可靠性好.关键词:自适应抗差滤波;分类自适应因子;多天线;瞬时解算;误差四元数;失准角中图分类号:P２２８㊀㊀㊀㊀文献标识码:A㊀㊀㊀㊀文章编号:１００１Ｇ１５９５(２０１５)０９Ｇ０９４５Ｇ０７基金项目:国家自然科学基金(４１２７４０１６;４０９７４０１０);地理信息工程国家重点实验室重点基金(S K L G I E２０１４ＧZＧ２Ｇ１)S e p t e m b e r２０１５V o l．４４N o．９A G C S h t t p:ʊx b．s i n o m a p s．c o m１㊀引㊀言G N S S测姿具有成本低㊁初始化快㊁误差相对稳定等特点,已成为G N S S应用研究的热点.目前在双天线单瞬时定向方面的研究较为深入,一般通过约束条件辅助单基线求解,再基于基线结果计算姿态,这一领域已有丰富成果[１Ｇ４].在多基线方面,有学者研究了整体解算方法[５Ｇ６],但是需先解基线再解姿态,无法直接利用原始观测值测姿.文献[７]提出在多基线解算过程中固定模糊度,再将模糊度回代求解四元数参数,以充分利用观测信息,但本质上仍属基线解算模型.文献[８]以方向余弦阵为姿态参数,利用原始观测值计算方向余弦和模糊度浮点解,将方向余弦的正交约束引入到模糊度搜索中,利用M C L AM B D A方法(m u l t i v a r i a t ec o n s t r a i n e dL AM B D A)进行搜索.由于约束信息的引入,使得模糊度的搜索空间不再为椭球体,整周模糊度的搜索负担远高于一般的L A M B D A方法[９],且方向余弦阵含９个参数,解算效率偏低,影响实时应用.目前未形成可靠的由载波相位观测解算欧拉角或四元数固定解的理论.现有测姿方法使用最小二乘进行单历元解算以避免周跳探测问题,历史信息没有得到充分利用.使用自适应选权滤波[１０]㊁自适应抗差滤波[１１Ｇ１２]等方法均能高效地平衡历史信息和当前观测,其中自适应抗差滤波具有抵御粗差干扰的能力,在城区及海上姿态测量等应用中能发挥优势.实际上,只要不使用模糊度历史信息,使用滤波的方式也无须探测周跳,可实现瞬时定姿.本文推导了基于失准角及乘性误差四元数的载波相位观测模型,分别建立有外部角速度传感器和无外部传感器辅助下姿态参数估计的状态模型;使用自适应抗差滤波估计姿态,借鉴分类自适应因子的思想,对模糊度参数和姿态误差参数分别自适应,通过模糊度自适应因子控制模糊度先验值的信任度,若选择极小的自适应因子,可在滤波框架内免去探测周跳过程;根据R a t i o值确定姿态参数的自适应因子.自适应抗差滤波能够充分利用约束信息和历史信息,将其融合在浮点解计算过程中,极大提高模糊度浮点解精度及其协方差的结构,在此基础上使用L AM B D A方法即能快速搜索出固定解.采用实测舰载G N S S３天线测姿算例证明了本文方法的有效性.２㊀基于姿态误差和模糊度参数的载波相位观测模型㊀㊀设在主天线i和天线j同步观测到卫星p㊁q,可组站星双差观测方程λΔΔΦp,q i,j＝ΔΔρp,q i,j－λΔΔN p,q i,j－ΔΔd I＋ΔΔd T＋eΔΔΦ(１)式中,ΔΔ为站星双差算子;λ为波长;Φ为载波相位观测值;N为模糊度;ρ为星地距离;d I为电离层折射延迟;d T为对流层折射延迟;eΔΔΦ为双差观测噪声.将式(１)在基线初值b０i j处展开并忽略大气折射延迟项,有㊀㊀λΔΔΦp q i j＝－(l q j－l p j) b i j＋(l q j－l p j)b０i j＋ΔΔρp q i j０－λΔΔN p q i j＋ΔΔeΦ(２)式中,b i j为基线参数;l q j和l p j为方向余弦矢量;ΔΔρp q i j０＝ρq j０－ρq i－ρp j０＋ρp i.整理可得基线观测模型为㊀(L p q i j)ᶄ＝(L p qΦ,i j－B q p i j)＝－(l q j－l p j) b i j－λΔΔN p q i j＋ΔΔeΦ(３)L p qΦ,i j＝λΔΔΦp q i j－ΔΔρp q i j０(４)B p q i j＝－(l q j－l p j) (－b０i j)(５)由于G N S S观测方程为非线性,姿态参数之间的关系也为非线性,因此,姿态估计中一般计算名义姿态中包含的姿态误差,再对名义姿态进行误差修正.这里分别从失准角和乘性四元数这两种姿态误差参数的角度推导相应的载波相位观测方程.设载体坐标系为b系,当地水平坐标系为n 系,载体姿态可用姿态矩阵C n b表示.设名义当地水平坐标系为nᶄ系,定义n系到nᶄ系的失准角为φ,它表示实际当地水平系n和名义当地水平系nᶄ之间的旋转矢量,可理解为名义系nᶄ的误差.若失准角较小,其近似等于俯仰㊁横滚和航向的欧拉角误差,这里为了保证严密性,依旧称之失准角而非欧拉角误差.n和nᶄ之间的关系可用式(６)的姿态矩阵的形式表示[１３]C nᶄn＝[I－(φˑ)](６)式中,(φˑ)为φ的叉乘矩阵,为一反对称阵.失准角㊁名义姿态阵C nᶄb㊁姿态阵C n b之间的关系如式(７)所示C n b＝C n nᶄC nᶄb＝(C nᶄn)T C nᶄb＝[I＋(φˑ)]C nᶄb(７)式(３)中的b i j为地固系e系中的基线,加上上标为b e i j,由坐标旋转关系,有６４９第９期甘㊀雨,等:自适应抗差K a l m a n 滤波在多天线原始观测值瞬时姿态确定中的应用b e i j ＝C e n [I ＋(φˑ)]C n ᶄb b b j ＝C e n [I ＋(φˑ)]b n ᶄj(８)式中,b b j 为已知载体系内的基线;b n ᶄj 为nᶄ系的结果.将式(８)代入式(３),得㊀(L p q i j )ᶄ＝－(l q j －l p j ) C e n [(φˑ)b n ᶄj ＋b n ᶄj ]－λΔΔN p q i j ＋ΔΔe Φ(９)㊀(L p q i j )ᶄ＝－(l q j －l p j ) C e n [－(b nᶄj ˑ)φ＋b n ᶄj ]－λΔΔN p q i j ＋ΔΔe Φ(１０)整理可得基于失准角参数的载波相位观测方程(L p q i j )ᵡ＝a j φ－λΔΔN p q i j ＋ΔΔe Φ(１１)式中,(L p q i j )ᵡ＝(L p q i j )ᶄ－[－(l q j －l p j ) C e n b n ᶄj ];a j ＝－(l q j －l p j ) C e n [－(b n ᶄj ˑ)].对于天线j １和主天线i ,按照式(１１)可由所有观测卫星得到矩阵形式的观测方程为L ᵡj １＝A j １φ＋M j １ΔΔN i j １＋e j１,ΔΔΦ(１２)式中,L ᵡj １＝L Φ,j １－B j １－[G i j １ C e n b n ᶄj １];G i j 为方向余弦－(l q j －l pj )构成矩阵,即观测设计阵;A j １＝G i j １C e n [－(b n ᶄj１ˑ)];M j １为模糊度系数阵.若有天线(j １,j ２, ,jm ),则基于失准角和模糊度参数(略去双差算子)的载波相位观测模型为L ＝A X ＋e ΔΔΦ＝A φN éëêêùûúú＋e ΔΔΦ(１３)式中,L ＝L ᵡj １L ᵡj２ L ᵡjm []T ;A 的计算公式为A ＝A j １M j １A j ２M j ２⋮⋮A j mM j m éëêêêêêùûúúúúú(１４)前面推导了基于失准角表示姿态误差的观测方程,也可采用乘性误差四元数δQ ＝δq ０δq []T的形式.在误差角为小量下,有[１３]C n n ᶄ＝I ＋２[δq ˑ](１５)δQ ʈ１δq []Tʈ１φ/２[]T (１６)仅需将式(１２)稍作改动即可得到基于乘性误差四元数的载波相位观测方程L ᵡj １＝A j １δq ＋M j １ΔΔN i j １＋e j１,ΔΔΦ(１７)式中,A j １＝２G i j １C e n [－(b n ᶄj１ˑ)].若G N S S 姿态测量系统含m 条基线,使用基线解算模型需解算３m 个基线参数,而使用基于失准角或误差四元数的观测值模型仅解算３个姿态参数,效率更高.３㊀姿态估计的状态模型四元数微分方程为[７]̇Q ＝１２Q ⊗ωb nb (１８)式中,ωb n b 为载体系相对于当地水平系的旋转角速度在载体系中的投影;⊗为四元数乘法;ωb n b 视为零标量四元数０ωb n b []T .若采用的坐标系为左手系,则微分方程略有不同,可见文献[１３].设计算的名义四元数为^Q ,也满足^Q＝１２^Q ⊗^ωb n b (１９)由姿态矩阵与姿态四元数之间的关系可得乘性误差四元数δQ 满足δQ ＝Q ⊗^Q∗(２０)式中,^Q ∗为^Q 的共轭四元数,对式(２０)求导,得δ̇Q ＝̇Q ⊗^Q ∗＋Q ⊗^Q∗(２１)将式(１８)㊁式(１９)代入式(２１)δ̇Q ＝１２Q ⊗ωb n b ⊗^Q ∗－１２Q ⊗^ωb n b ⊗^Q ∗＝１２Q ⊗ωb n b ⊗Q ∗⊗Q ⊗^Q ∗－１２Q ⊗^Q ∗⊗^Q ⊗^ωb n b ⊗^Q ∗＝１２ωn n b ⊗δQ －１２δQ ⊗^ωn n b ＝１２^ωn n b ⊗δQ －１２δQ ⊗^ωn n b －１２δωn n b ⊗δQ (２２)根据四元数乘法准则,得^ωn n b ⊗δQ －δQ ⊗^ωn n b ＝㊀０－(^ωn n b )T ^ωn n b(^ωn n b ˑ)éëêêêùûúúú δQ －０－(^ωn n b )T ^ωn n b －(^ωn n bˑ)éëêêêùûúúú δQ ＝㊀０００２(^ωn n b ˑ)éëêêùûúú δQ (２３)δ̇Q ＝０００(^ωn n b ˑ)éëêêùûúú δQ －１２δωn n b ⊗δQ (２４)由式(１６),得δ̇q ＝(^ωn n b ˑ)δq －１２δωn n b ⊗δQ(２５)̇φ＝(^ωn n b ˑ)φ－δωn n b ⊗δQ (２６)式(２５)㊁式(２６)的右端第２项即为状态噪声.若有外部角速度传感器如陀螺仪的辅助,则可直接使用式(２５)或式(２６)建立状态方程,否则,无法获得角速度^ωn n b ,此时将式(２６)改化为̇φ＝－(φˑ)ωn n b －δωn n b ⊗δQ (２７)将ω扩展为状态参数并用随机游走模型表示,纳入式(２７)并离散化７４９S e pt e m b e r ２０１５V o l ．４４N o ．９A G C S h t t p :ʊx b ．s i n o m a ps ．c o m φωéëêêùûúúk ＝I －(φˑ)k －１I０éëêêùûúúφωéëêêùûúúk －１＋w φw ωéëêêùûúúk (２８)即为无外部角速度传感器辅助下的姿态估计状态模型.４㊀自适应抗差滤波的应用及自适应因子的确定㊀㊀综合式(１３)㊁式(２８)可得基于载波相位观测值估计姿态的滤波模型为X k ＝φωN éëêêêêùûúúúúk＝Φk ,k －１X k －１＋W k ＝I －(φˑ)k －１０I ００００I éëêêêêùûúúúúφωN éëêêêêùûúúúúk －１＋w φw ωw N éëêêêêùûúúúúk(２９)L k ＝A k X k ＋e k(３０)式(３０)中的A 与式(１３)略有不同,为A ＝A j １０M j １A j ２０M j ２⋮⋮⋮A j m ０M j m éëêêêêêùûúúúúú(３１)使用姿态误差而非姿态本身作为滤波中的姿态参数,可以减小观测方程线性化引起的模型误差.设计算的名义姿态阵C n ᶄb,滤波估计得到的失准角^φ,代入式(６)㊁式(７),即可对名义姿态进行修正,修正后的^C n b 即为滤波解.在k 时刻,以k －１时刻的滤波解^C n b ,k －１作为名义解.若k 时刻成功固定模糊度即得到失准角固定解时,应在完成姿态修正后将失准角^φ置零后传递至下一历元.若前一时刻姿态估计精度高,则本时刻名义解较为可靠,应信任状态预测信息,若名义解精度不高,则使用自适应因子减小状态信息的贡献.姿态误差㊁角速度㊁模糊度属不同类型的参数,很难采用统一的自适应因子进行调节,分类因子自适应滤波可对不同的分量选取不同的自适应因子.分类因子自适应抗差滤波解为[１４Ｇ１５]^X k ＝A T k P k A k ＋ P X k []－１A T k P k L k ＋ P X k X k [](３２)Σ^X k ＝A T k P k A k ＋ P X k []－１(３３)式中, P k 为抗差等价权矩阵,可由H u b e r 函数确定[１５]p i ＝p i V ki ɤc p i cV kiV k i＞c ìîíïïïï(３４)式中, V k i 为标准化残差;c 为常量,可取１．０~１．５. PX k 为状态预测的自适应权矩阵,有 P X k ＝α１２k P X k α１２k(３５)式中,αk 为自适应因子矩阵,即αk ＝αφαωαN éëêêêêùûúúúúk(３６)由于ω为间接观测量,这里不作自适应,有αω＝１(３７)αN 可调整模糊度先验信息的权重,若进行周跳探测得到各卫星中最大周跳估值为d ^N ,顾及周跳探测量自身的噪声,可选取自适应因子为αN ＝σ２Nd ^N ２＋σ２D T(３８)式中,σ N为模糊度预测标准差,主要由设定的模糊度状态噪声决定;σD T 为周跳探测量的中误差,周跳估值越大,模糊度自适应因子越小,一般αN ＜１.若要免去周跳探测步骤以便瞬时解算,则可取αN 为一极小值,如αN ＝１．０e －８,此时,模糊度先验信息的权重降至极小,不受周跳干扰.自适应滤波常用的误差判别统计量包括状态不符值或预测残差等,G N S S 定姿中,在模糊度固定前,无法获得足够精度的上述统计量.考虑姿态误差的预测性能本质上由名义解即前一历元姿态滤波解的精度决定,其对应的R a t i o 值能够在一定程度上反映其可靠程度,αφ由三段函数表示αφ,k ＝０R a t k －１＜c ０R a t k －１－c ０c ０ɤR a t k －１＜c １１R a t k －１ȡc １ìîíïïïï(３９)式中,R a t 为R a t i o 值,一般取c ０＝２㊁c １＝３.５㊀计算与比较本文算例使用实测舰载G P S３个天线姿态测量双频数据进行计算和比较分析,３个天线构成两条独立基线,基线的载体系坐标分别为０．０１５．００．０[]T ㊁１４．５２５．１０．０[]T .由于海面环境复杂,加之天线间距离较远,双差后部分观测值仍受到较为严重的多路径效应影响,以单个历元而言它们表现出粗差性质.姿态解算中模糊度固定解的搜索均采用L AM B D A 方法,若R a t i o 值超过３,则视相应历元成功固定.设计以下４种方案计算浮点解进行对比.方案１:单历元最小二乘;８４９第９期甘㊀雨,等:自适应抗差K a l m a n 滤波在多天线原始观测值瞬时姿态确定中的应用方案２:单历元抗差估计;方案３:自适应滤波;方案４:自适应抗差滤波.方案３和方案４中,取模糊度自适应因子αN ＝１．０e －８,即完全不使用模糊度先验信息,以和方案１㊁方案２形成对照,因此４个方案均无须主探测周跳.方案３中仅使用了自适应因子,未使用抗差等价权控制粗差干扰.共有１８００个观测历元,表１所示为各方案的模糊度固定结果比较,图１为观测卫星数及P D O P 值,图２ 图５分别为各方案的航向角估计结果,其中固定解用直线绘制,浮点解用 ∗表示.图６ 图９分别为各方案的模糊度精度衰减因子A D O P 值结果.A D O P 能有效表征模型几何强度,可对模糊度固定成功率进行近似[１６].虽没有外部姿态结果作为参考真值,但只要模糊度固定正确,４种方案的姿态结果基本一致,而姿态浮点解相对固定解会有较大突变,这点可由图１ 图４看出,因此,主要从模糊度固定成功率的角度评价４种方案.采用 逐历元L ＋M C L A B M D A 的方法也进行了解算,但M C L AM B D A 算法无法使用R a t i o 检验等方法评价固定效果,对比他们的模糊度固定解,M C L AM B D A 算法中１７８３个历元的解与本文自适应抗差滤波法完全相同,说明两种方法的正确率相当,这里主要比较它与本文方法的效率差异,结果如表２所示(计算平台:H Pd v ４Ｇ３１２４t x).表１㊀模糊度固定结果T a b ．１㊀R e s u l t s o fA m b i g u i t y F i x i n gn u m b e r o f f i x e da mb i gu i t i e s f i x r a t e/(％)s c h e m e １１５３２８５．１１s c h e m e ２１５８９８８．２８s c h e m e ３１６７１９２．８３s c h e m e ４１７９１９９．５０图１㊀观测卫星数及P D O P 值F i g．１㊀O b s e r v e d s a t e l l i t en u m b e r a n dP D OP 图２㊀方案１航向角F i g．２㊀Y a wo f s c h e m e１图３㊀方案２航向角F i g．３㊀Y a wo f s c h e m e２图４㊀方案３航向角F i g．４㊀Y a wo f s c h e m e ３表２㊀所有历元姿态解算总耗时T a b ．２㊀T o t a l t i m e c o s t o f a t t i t u d e d e t e r m i n a t i o no f a l le po c h s ss c h e m e １s c h e m e ４M C L AM B D A６１．１５７．６５１４．７９４９S e pt e m b e r ２０１５V o l ．４４N o ．９A G C S h t t p :ʊx b ．s i n o m a ps ．c om 图５㊀方案４航向角F i g．５㊀Y a wo f s c h e m e４图６㊀方案１的A D O P 值F i g．６㊀A D O Po f s c h e m e１图７㊀方案２的A D O P 值F i g．７㊀A D O Po f s c h e m e ２㊀㊀从以上结果可以看出:(１)相对于最小二乘,抗差估计能够较好地抵制粗差干扰,提高测姿的可靠性,但是由于未充分利用历史信息,仅由当前观测值定姿的成功率不高.抗差估计结果的A D O P 结果较最小二乘略差,因为抗差估计对粗差观测值进行降权,观测值整体利用率更低.图８㊀方案３的A D O P 值F i g．８㊀A D O Po f s c h e m e３图９㊀方案４的A D O P 值F i g．９㊀A D O Po f s c h e m e ４(２)自适应滤波通过自适应因子合理利用历史约束信息,改善观测结构,提高固定率,并具备一定的抗粗差能力,但整体上仍受到粗差观测值影响.(３)自适应抗差滤波能够合理利用姿态历史信息,改善整体的结构,显著减小A D O P 值,且很好地抵御了粗差干扰,大大提高模糊度固定成功率.实际上９个未成功固定的历元中,有４个历元固定解正确而未通过R a t i o 检验,而在另外５个历元处存在较多粗差,同时自适应因子为０,观测结构较差,无法得到可靠的浮点解.(４)由于在搜索过程中引入约束条件,M C L AM B D A 的计算效率较低,耗时远高于自适应抗差滤波方法.通常自适应抗差滤波比最小二乘更为耗时(如浮点解计算阶段),但由于自适应抗差滤波得到的浮点解精度高于最小二乘,因此在模糊度搜索过程中更快,整体上效率稍高.０５９第９期甘㊀雨,等:自适应抗差K a l m a n滤波在多天线原始观测值瞬时姿态确定中的应用６㊀结㊀论目前没有可靠的由G N S S载波相位观测值直接解算欧拉角或四元数的理论.基于原始观测值直接定姿的难点在于如何合理利用约束信息,自适应抗差K a l m a n滤波能将姿态约束信息通过状态模型与当前的观测模型融合起来,本文通过建立合适的状态模型和调节自适应因子,最大限度地发挥历史信息的作用,同时通过抗差等价权抵制粗差观测值的影响,实现可靠㊁高效的姿态确定.除自适应因子减小同时又出现粗差这类情况,本文方法均能实现瞬时姿态解算.通过模糊度参数的自适应,可以结合周跳探测结果调整模糊度历史信息的权重,并可转换为无须周跳探测的模式,增加了数据处理的灵活性.本文建立姿态估计状态模型可以用于陀螺等外部传感器和G N S S进行组合测姿的情况,因此自适应抗差K a l m a n滤波实现瞬时姿态确定的方法能用于任何含多天线G N S S的姿态测量系统中,具有广阔的应用前景.参考文献:[１]㊀L I U Z h i j i a n,L I U Y i．A l g o r i t h m o f aR e a lＧt i m eA t t i t u d e S y s t e m U s i n g N o nＧd e d i c a t e d G P S R e c e i v e r s[J]．A c t aG e o d a e t i c a e tC a r t o g r a p h i c aS i n i c a,２００５,３４(３):２１３Ｇ２１７．(刘志俭,刘毅．一种基于非专用接收机的G P S实时定姿算法[J]．测绘学报,２００５,３４(３):２１３Ｇ２１７．) [２]㊀L I U G e n y o u,O UJ i k u n．D e t e r m i n i n g A t t i t u d ew i t hS i n g l eE p o c h G P S A l g o r i t h m a n dI t s P r e c i s i o n A n a l y s i s[J]．G e o m a t i c s a n d I n f o r m a t i o nS c i e n c eo fW u h a nU n i v e r s i t y,２００３,２８(６):７３２Ｇ７３５．(刘根友,欧吉坤．G P S单历元定向和测姿算法及其精度分析[J]．武汉大学学报:信息科学版,２００３,２８(６):７３２Ｇ７３５．)[３]㊀L I Z h e n g h a n g,L I U W a n k e,L O U Y i d o n g,e t a l．H e a d i n gD e t e r m i n a t i o n A l g o r i t h m w i t hS i n g l eE p o c h D u a lＧf r e q u e n c yG P SD a t a[J]．G e o m a t i c s a n d I n f o r m a t i o nS c i e n c eo fW u h a nU n i v e r s i t y,２００７,３２(９):７５３Ｇ７５６．(李征航,刘万科,楼益栋,等．基于双频G P S数据的单历元定向算法研究[J]．武汉大学学报:信息科学版,２００７,３２(９):７５３Ｇ７５６．) [４]㊀T A N G W e i m i n g,L ID i,C H IF e n g m i n g．R e s e a r c ho nS i n g l eE p o c h O r i e n t a t i o n A l g o r i t h m o f B e i D o u N a v i g a t i o nS a t e l l i t e S y s t e m[J]．G e o m a t i c s a n d I n f o r m a t i o n S c i e n c e o fW u h a nU n i v e r s i t y,２０１３,３８(９):１０１４Ｇ１０１７．(唐卫明,李笛,迟凤明．北斗卫星导航系统单历元定向算法研究[J]．武汉大学学报:信息科学版,２０１３,３８(９):１０１４Ｇ１０１７．) [５]㊀L U G a n g,C A N N O N M E．A t t i t u d eD e t e r m i n a t i o nU s i n ga M u l t iＧa n t e n n aG P SS y s t e mf o rH y d r o g r a p h i cA p p l i c a t i o n s[J]．M a r i n eG e o d e s y,１９９４,１７(４):２３７Ｇ２５０．[６]㊀W A N G C,L A C H A P E L L EG．G P SA t t i t u d eD e t e r m i n a t i o nR e l i a b i l i t y P e r f o r m a n c e I m p r o v e m e n t U s i n g L o w C o s tR e c e i v e r s[C]ʊP r o c e e d i n g s o ft h e１５t h I n t e r n a t i o n a lT e c h n i c a lM e e t i n g o f t h eS a t e l l i t eD i v i s i o no f t h e I n s t i t u t eo fN a v i g a t i o n．P o r t l a n d,O R:[s．n．],２００２:１０６４Ｇ１０７４．[７]㊀S C H L E P P EJ．D e v e l o p m e n t o f aR e a lＧt i m eA t t i t u d e S y s t e m U s i n g a Q u a t e r n i o n P a r a m e t e r i z a t i o na n d N o nＧd e d i c a t e dG P SR e c e i v e r s[D]．A l b e r t a,C a n a d a:T h eU n i v e r s i t y o fC a l g a r y,１９９６．[８]㊀T E U N I S S E NPJG．A G e n e r a lM u l t i v a r i a t eF o r m u l a t i o n o f t h e M u l t iＧa n t e n n aG N S S A t t i t u d eD e t e r m i n a t i o nP r o b l e m[J]．A r t i f i c i a l S a t e l l i t e s,２００７,４２(２):９７Ｇ１１１．[９]㊀WANG B i n g,S U IL i f e n,Z HANG Q i n g h u a,e ta l．R e s e a r c h o n A t t i t u d e D e t e r m i n a t i o n A l g o r i t h m s U s i n gG P S[J]．G e o m a t i c sa n dI n f o r m a t i o nS c i e n c eo f W u h a nU n i v e r s i t y,２０１３,３８(１２):１３９２Ｇ１３９５．(王冰,隋立芬,张清华,等．利用G P S解算载体测姿的算法研究[J]．武汉大学学报:信息科学版,３８(１２):１３９２Ｇ１３９５．)[１０]㊀C HA IY a n j u．T h e o r y a n d M e t h o df o r I m p r o v i n g t h e N a v i g a t i o nA c c u r a c y o fG P S/I N SI n t e g r a t i o nb y D i g g i n gt h eH i d d e n I n f o r m a t i o n[D]．W u h a n:I n s t i t u t e o f G e o d e s ya n dG e o p h y s i c s,C h i n e s eA c a d e m y o f S c i e n c e s,２００８．(柴艳菊．挖掘信息提高G P S/I N S导航精度的理论与方法研究[D]．武汉:中国科学院测量与地球物理研究所,２００８．) [１１]㊀YANG Y u a n x i,HE H a i b o,XU G u o c h a n g．A N e wA d a p t i v e l y R o b u s t F i l t e r i n g f o r K i n e m a t i c G e o d e t i cP o s i t i o n i n g[J]．J o u r n a l o fG e o d e s y,２００１,７５(２Ｇ３):１０９Ｇ１１６．[１２]㊀Y A N G Y u a n x i,H E H a i b o,X U T i a n h e．A d a p t i v eR o b u s tF i l t e r i n g f o r K i n e m a t i cG P S P o s i t i o n i n g[J]．A c t aG e o d a e t i c ae tC a r t o g r a p h i c aS i n i c a,２００１,３０(４):２９３Ｇ２９８．(杨元喜,何海波,徐天河．论动态自适应滤波[J]．测绘学报,２００１,３０(４):２９３Ｇ２９８．)[１３]㊀MA R K L E Y F L．A t t i t u d eE r r o rR e p r e s e n t a t i o n s f o r K a l m a nF i l t e r i n g[J]．J o u r n a l o fG u i d a n c e,C o n t r o l,a n dD y n a m i c s,２００３,２６(２):３１１Ｇ３１７．[１４]㊀C U IX i a n q i a n g,Y A N GY u a n x i．A d a p t i v e l y R o b u s tF i l t e r r i n g w i t hC l a s s i f i e dA d a p t i v eF a c t o r s[J]．P r o g r e s s i nN a t u r a l S c iＧe n c e,２００６,１６(４):４９０Ｇ４９４．(崔先强,杨元喜．分类因子自适应抗差滤波[J]．自然科学进展,２００６,１６(４):４９０Ｇ４９４．) [１５]㊀Y A N G Y u a n x i,C U IX i a n q i a n g．A d a p t i v e l y R o b u s tF i l t e r w i t h M u l t iA d a p t i v eF a c t o r s[J]．S u r v e y R e v i e w,２００８,４０(３０９):２６０Ｇ２７０．[１６]㊀O D I J K D,T E U N I S S E N P J G．A D O P i nC l o s e dF o r mf o raH i e r a r c h y o f M u l t iＧf r e q u e n c y S i n g l eＧb a s e l i n e G N S S M o d e l s[J]．J o u r n a l o fG e o d e s y,２００８,８２(８):４７３Ｇ４９２．(责任编辑:张艳玲)收稿日期:２０１４Ｇ０９Ｇ２４修回日期:２０１５Ｇ０５Ｇ１４第一作者简介:甘雨(１９８８ ),男,博士生,研究方向为G N S S定位测姿㊁组合导航.F i r s t a u t h o r:G A NY u(１９８８ ),m a l e,d o c t o r a l c a n d i d a t e, m a j o r s i nG N S S p o s i t i o n i n g,a t t i t u d ed e t e r m i n a t i o na n d i n t e g r a t e dn a v i g a t i o n．EＧm a i l:g a n y u０９９＠１６３．c o m１５９。