Hierarchical Adaptive Information Filtering Algorithm Considering System Noise and Observation Noise
-
摘要: 高精度的载体动态导航与定位不仅需要对载体异常扰动和观测异常有良好控制，还需要对状态方程系统噪声及观测噪声的时变特性有准确认识和处理。首先针对包含系统噪声的动力学模型和包含时变观测噪声的导航系统，提出一种基于信息滤波形式的分级自适应滤波算法。然后针对系统噪声的渐变性和突变性，增加了遗忘因子和二段自适应因子，提高了对突变噪声估计的稳定性；顾及观测噪声的时变特性，采用传感器间差分和观测数据历元差分法估计观测噪声协方差。最后进行了仿真实验和深海拖体实验，结果表明，该算法不仅可以有效地估计系统噪声，还能准确地估计时变观测噪声的协方差阵，提高水下载体动态参数的估计精度。Abstract: High-precision carrier dynamic navigation and positioning requires not only good control of abnormal disturbance and observation abnormality, but also accurate recognition and processing of time-varying characteristics of noise and observation noise in equation of state system. Aiming at the system noise dynamics model and the time-varying observation noise navigation system, and based on information filtering, a hierarchical adaptive filtering algorithm is proposed. The unbiasedness and effectiveness of the new algorithm are proved. Considering the gradual and fast changes of system noise, the new algorithm adds forgetting factor or two-stage adaptive factor to improve the stability of noise estimation for catastrophic systems. In addition, considering the time-varying of the observation noise, two different difference observation data are used and the covariance of the observation noise is effectively estimated by using the high-precision equation of state. The simulation and experimental results show that the new filtering algorithm can not only estimate the system noise simply and effectively, but also estimate the covariance matrix of the observation noise effectively, which improves the accuracy of parameter estimation of dynamic system.
-
目前，北斗导航卫星系统(BDS)已实现局域覆盖，随着系统建设的不断完善和应用的不断拓展，与之相关的各类数据处理软件的开发成为重要的研究内容。因此，自主开发北斗高精度数据处理软件，成为发展高精度位置服务的迫切任务[1-8]。因北斗导航卫星系统与GPS在星座构造、坐标框架、时间系统、信号频率等方面具有明显差异[9-15]，现有的高精度GPS数据处理软件无法直接处理北斗数据。本文针对北斗高精度数据处理的系统设计、数据流、功能模块及高精度算法实现等进行了研究，研制开发了一套高精度北斗基线解算软件BGO(BeiDou Navigation Satellite System/Global Positioning System Office)，并将其用于高速铁路高精度控制测量建网。通过与商业软件TGO(Trimble Geomatics Office)和TBC(Trimble Business Center)，及高精度科研软件Bernese进行对比测试、性能分析，验证了该软件的正确性和有效性。
1 系统的设计与模块算法的实现
1.1 系统设计与数据流分析
北斗和GPS基线解算软件主要包含北斗基线处理、GPS基线处理及联合基线处理3大模块。各模块间相互独立，但使用相同的数据结构，且数据流基本一致。数据处理流程如图 1所示。
基线解算之前，需选择有效双频观测数据，具体包含低高度角卫星剔除、观测值粗差剔除、星历未获取观测数据剔除等。剔除质量较差的观测数据可通过可视化的方式实现。通过双频数据组合有效消除电离层延迟影响，伪距消电离组合能算出测站精确至10 m内的概略位置，从而形成网络拓扑图，便于用户查看站点的平面分布。基线解算时，北斗与GPS独立系统数据处理算法相同；联合处理需选择统一的坐标和时间框架，随着多余观测数的增加，还需设置合理的模糊度固定限值。基线解算后，进行网平差，应剔除不合格基线，直至平差结果满足要求。
1.2 高精度基线解算算法实现
高精度基线解算利用双差观测量建立误差方程，北斗双差观测量构造如式(1)：
$$ \mathit{\Delta} \nabla L^{{C_m}{C_n}}_{{S_i}{S_j}} = \left( {L^{{C_n}}_{{S_j}} - L^{{C_n}}_{{S_i}}} \right) - \left( {L^{{C_m}}_{{S_j}} - L^{{C_m}}_{{S_i}}} \right) $$ (1) 式中，Δ▽L表示双差观测量；Si和Sj表示任意站点；Cm和Cn表示任意北斗卫星。
依据式(1)构建的双差观测量，建立误差方程，如式(2)：
$$ \left[ \begin{array}{l} \mathit{\Delta} \nabla \boldsymbol{\varPhi} \\ \mathit{\Delta} \nabla \boldsymbol{P} \end{array} \right] = \boldsymbol{BX} + \boldsymbol{A}\mathit{\Delta} \nabla \boldsymbol{N} + \boldsymbol{V} $$ (2) 式中，Δ▽Φ和Δ▽P分别表示卫星载波相位和伪距双差观测量；X表示基线向量；Δ▽N表示双差整周模糊度；B和A为系数阵；V为残差向量。
利用式(2)构建的误差方程，解算基线向量和双差整周模糊度浮点解。利用LAMBAD方法[16, 17]固定双差整周模糊度后去除。再利用载波相位观测值获取高精度基线向量结果。基线解算过程中，主要利用抗差估计的切比雪夫多项式拟合法[18]及MW-GF组合法[19]探测与修复周跳。
对北斗和GPS双系统基线解算，只需将各系统的双差观测量误差方程叠加后平差计算，即可实现双系统联合基线解算。但需注意，星间差分需选择同一系统卫星，否则会引入系统间信号硬件延迟[20]，影响双差整周模糊度的固定。另外，北斗和GPS在时间框架、坐标框架等存在一定差异，双系统联合解算需保证框架的统一。
北斗和GPS时间转换公式如式(3)：
$$ {t_C} = {t_G}-14\;{\rm{s}} $$ (3) 式中，tC和tG分别表示北斗时和GPS时，两者均为原子时，起算原点不同[13]。
北斗和GPS坐标转换公式如式(4)：
$$ \begin{array}{c} \left[ {\begin{array}{*{20}{c}} {{X_C}}\\ {{Y_C}}\\ {{Z_C}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} {{X_G}}\\ {{Y_G}}\\ {{Z_G}} \end{array}} \right] + \left[ {\begin{array}{*{20}{c}} {{T_X}}\\ {{T_Y}}\\ {{T_Z}} \end{array}} \right] + \\ \left[ {\begin{array}{*{20}{c}} D&{ - {R_Z}}&{{R_Y}}\\ {{R_Z}}&D&{ - {R_X}}\\ { - {R_Y}}&{{R_X}}&D \end{array}} \right]\left[ {\begin{array}{*{20}{c}} {{X_G}}\\ {{Y_G}}\\ {{Z_G}} \end{array}} \right] \end{array} $$ (4) 式中，北斗坐标(XC，YC，ZC)与GPS坐标(XG，YG，ZG)可通过七参数TX、TY、TZ、D、RX、RY、RZ进行转换。北斗CGCS2000坐标系采用ITRF97框架2000历元的坐标和速度场，当前GPS WGS84坐标和ITRF08基本一致。因此，可利用ITRF97框架2000历元与ITRF08间转换的七参数(ITRF网站公布)实现北斗与GPS坐标框架的统一[11, 12]。
2 BGO数据处理实例与性能测试
2.1 高速铁路CPI控制网基线解算
处理高速铁路CPI控制网时，通过读取观测文件和星历文件，单点定位生成控制网的基线网络拓扑图，如图 2所示。基线解算前，设置相关参数包括卫星截止高度角、误差限差参数、框架、对流层模型、电离层模型、模糊度Ratio值、同步最小观测历元数等。设置完成后，可选择北斗、GPS、联合3种模式进行基线解算。基线解算完成后，软件界面中将显示解算的基线分量及其精度，并可显示残差向量检核基线解算效果。
2.2 BGO、TGO、Bernese软件处理GPS基线结果比较
为了测试BGO解算GPS基线的正确性，将其与TGO和Bernese软件处理结果进行了比较，得到57条GPS基线(基线最长6 667 m，最短446 m)的比较结果，如图 3所示。
![]()
图 3 BGO、TGO、Bernese软件处理GPS基线分量比较Figure 3. Comparing GPS Baseline Components from BGO, TGO and Bernese Software图 3(a)、3(b)分别表示BGO软件与TGO、Bernese软件处理GPS基线分量的差值ΔX、ΔY、ΔZ。图 3(a)中，BGO和TGO有52条基线在X、Y、Z方向的分量差值均在2 cm内，有48条基线各分量差值在mm级。TGO解算少量基线验后方差分量超限，与BGO基线分量差值较大。图 3(b)中，BGO和Bernese有55条基线在X、Y、Z方向的分量差值均在2 cm内，有49条基线各分量差值在mm级。
图 4(a)~4(c)分别表示BGO、TGO、Bernese软件处理GPS基线的内符合精度σX、σY、σZ(BGO、TGO、Bernese软件基线解算精度分别精确至0.1 mm、1 mm和0.1 mm)。整体上，约90%的基线3个软件的解算精度相当。
![]()
图 4 BGO、TGO、Bernese的GPS基线内符合精度比较Figure 4. Comparing GPS Baseline Precision from BGO, TGO and Bernese Software2.3 BGO、TBC软件处理北斗与GPS联合基线结果
为了测试BGO解算北斗与GPS联合基线的性能，本文选用美国Trimble的商业软件TBC与之进行比较。同上57条基线，每条基线观测数据均包含北斗与GPS观测数据。图 5展示了BGO和TBC处理北斗与GPS联合基线分量的差值ΔX、ΔY、ΔZ。图 5可见，98%的基线分量差值分布在mm级，表明BGO软件处理联合基线能达到与TBC软件相当的水平。另外，两者内符合精度绝大部分均在mm级，故图 5中未加以比较。
![]()
图 5 BGO与TBC软件处理北斗与GPS联合基线分量比较Figure 5. Comparing BDS and GPS Combined Baseline Components from BGO and TBC Software由此可知，BGO软件处理GPS基线、北斗与GPS联合基线的内外符合精度能达到TGO、Bernese、TBC相当的水平。因此，以BGO软件处理GPS、北斗与GPS联合基线结果为参考值，分析该软件处理北斗基线结果的正确性和可靠性，如图 6和图 7所示。图 6比较了北斗与GPS、联合基线分量的差值，图 7比较了北斗、GPS、联合基线解算的内符合精度。
![]()
图 6 BGO软件处理北斗与GPS、联合基线分量比较Figure 6. Comparing BDS, GPS and BDS/GPS Combined Baseline Components from BGO Software![]()
图 7 北斗、GPS、联合基线解的内符合精度统计Figure 7. The Statistics of Precision of BDS, GPS and BDS/GPS Combined Baseline Solutions图 6(a)表示BGO软件处理北斗与GPS基线分量的差值ΔX、ΔY、ΔZ，其中有43条基线在X、Y、Z方向上的分量差值Δx、Δy、Δz在2 cm内，有31条基线在X、Y、Z方向上的分量差值在mm级。图 6(b)表示BGO软件处理北斗与联合基线分量的差值，其中有54条基线在X、Y、Z方向上的分量差值在2 cm内，有38条基线在X、Y、Z方向上的分量差值在mm级(图 6中第6条基线北斗为浮点解，各分量差值结果较大，图中置为0)。
图 7中，93%的联合基线在X、Y、Z方向上的分量精度分别优于0.5 mm、1 mm、0.5 mm；约90%的北斗基线和95%的GPS基线在X、Y、Z方向上的分量精度分别优于1 mm、2 mm、1 mm。由北斗、GPS、联合基线3者精度比较可知，在北斗试运行阶段，GPS基线内符合精度略优于北斗，北斗与GPS联合系统基线内符合精度明显高于独立系统。
2.4 BGO基线网平差及其精度分析
BGO具备网平差功能，根据网平差后的基线分量改正数、相对中误差、点位精度等判断基线解算结果的可靠性。对上述解算的北斗、GPS、联合基线分别进行无约束网平差。
北斗、GPS、联合基线无约束网平差的平差改正数δX、δY、δZ绝大部分在±1 cm内，如图 8(a)~8(c)所示。最弱边相对中误差优于5.5 ppm(规范限值)，具体见表 1。据图 8、表 1及《高速铁路工程测量规范》[21]可知，BGO能合理稳定地解算北斗、GPS及联合基线，解算结果中的基线向量改正数、最弱边相对中误差、最弱点点位精度均满足CPI控制测量要求，各系统解算均能精确获得24个CPI控制点坐标。
![]()
图 8 GPS、北斗、联合无约束网平差基线向量改正数Figure 8. Baseline Vector Corrections from GPS, BDS and BDS/GPS Combined Unconstrained Adjustment表 1 GPS、北斗、联合无约束平差结果统计Table 1. The Statistics of GPS, BDS and BDS/GPS Combined Unconstrained Adjustment Results解算模式 独立基线 多余观测数 控制点个数 最弱边相对中误差/ppm 最弱点点位精度/mm GPS 55 66 24 3.6 23.6 北斗 51 57 24 3.1 26.9 联合 57 72 24 3.7 17.9 3 结语
本文系统地研究了北斗与GPS联合基线解算的算法，自主开发了北斗高精度基线解算软件BGO。通过实测高铁CPI控制网的数据处理测试表明：软件能进行高精度地处理北斗与GPS数据, 以及北斗与GPS联合数据处理；GPS基线解算性能与天宝TGO软件相当，能达到与Bernese软件一致的精度；北斗与GPS基线处理能达到与TBC相当的水平。BGO最大的优势在于能对北斗和GPS进行联合解算，从而提高北斗或GPS单系统的基线解算合格率和精度。经高速铁路CPI控制网实例测试，证明该软件处理基线结果可用于高精度北斗和GPS测量控制网的数据处理。
-
![]()
图 4 超短基线量测噪声矩阵的自适应估计结果
Figure 4. Adaptive Estimation Results of Observation Noise Matrix of USBL
![]()
图 5 深海拖体和GAPS超短基线定位系统
Figure 5. Deep-Sea Towing Vehicle and GAPS USBL Positioning System
![]()
图 6 导航传感器时间戳及水下拖体的运动轨迹
Figure 6. Time Stamp of Navigation Sensors and Motion Track of Underwater Towed Vehicle
表 1 导航传感器的测量误差仿真参数
Table 1 Simulation Parameters of Measurement Errors of Navigation Sensor
噪声类型 USBL/m DVL/(m·s-1) 航向角/(°) 姿态角/(°) 随机噪声 0.005r 0.03 0.10 0.03 系统噪声 cos(t/3 600) 0.05V 0.05 0.01 注：r表示USBL基阵到信标的斜距；t表示仿真时间；V表示水下载体速度 
下载: 导出CSV
表 2 4种算法的定位精度/m
Table 2 Positioning Accuracies of Four Algorithms/m
定位精度 USBL+Depth组合 KF算法 增广KF算法 本文算法 水平方向精度 1.94 2.46 1.06 0.94 垂直方向精度 1.68 1.03 0.81 0.76
下载: 导出CSV
-
[1] 杨元喜, 何海波, 徐天河.论动态自适应滤波[J].测绘学报, 2001, 30(4):293-298 doi: 10.3321/j.issn:1001-1595.2001.04.004 Yang Yuanxi, He Haibo, Xu Tianhe.Adaptive Robust Filtering for Kinematic GPS Positioning[J].Acta Geodaetica et Cartographica Sinica, 2001, 30(4):293-298 doi: 10.3321/j.issn:1001-1595.2001.04.004
[2] 欧吉坤, 柴艳菊, 袁运斌.自适应选权滤波[C].重力学与固体潮学术研讨会, 武汉, 2014 Ou Jikun, Chai Yanju, Yuan Yunbin.Adaptive Filtering for Kinematic Positioning by Selection of the Parameter Weights[C].Symposium on Gravity and Solid Tide, Wuhan, China, 2014
[3] 崔先强, 杨元喜, 高为广.多种有色噪声自适应滤波算法的比较[J].武汉大学学报·信息科学版, 2006, 31(8):731-735 http://ch.whu.edu.cn/article/id/2533 Cui Xianqiang, Yang Yuanxi, Gao Weiguang.Comparison of Adaptive Filter Algrithmetics in Controlling Influence of Colored Noises[J].Geomatics and Information Science of Wuhan University, 2006, 31(8):731-735 http://ch.whu.edu.cn/article/id/2533
[4] 赵长胜, 陶本藻.有色噪声作用下的卡尔曼滤波[J].武汉大学学报·信息科学版, 2008, 33(2):180-182 http://ch.whu.edu.cn/article/id/1550 Zhao Changsheng, Tao Benzao.Kalman Filtering of Linear System with Colored Noises[J].Geomatics and Information Science of Wuhan University, 2008, 33(2):180-182 http://ch.whu.edu.cn/article/id/1550
[5] Yang Y, Gao W.An Optimal Adaptive Kalman Filter[J].Journal of Geodesy, 2006, 80(4):177-183 doi: 10.1007/s00190-006-0041-0
[6] Zhou Q, Zhang H, Li Y, et al.An Adaptive Low-Cost GNSS/MEMS-IMU Tightly-Coupled Integration System with Aiding Measurement in a GNSS Signal-Challenged Environment[J].Sensors, 2015, 15(9):23 953-23 982 doi: 10.3390/s150923953
[7] Jiang L, Zhang H.Redundant Measurement-Based Second Order Mutual Difference Adaptive Kalman Filter[J].Automatica, 2019, 100:396-402 doi: 10.1016/j.automatica.2018.11.037
[8] 隋立芬, 刘雁雨, 王威.自适应序贯平差及其应用[J].武汉大学学报·信息科学版, 2007, 32(1):51-54 http://ch.whu.edu.cn/article/id/1797 Sui Lifen, Liu Yanyu, Wang Wei.Adaptive Sequential Adjustment and Its Application[J].Geomatics and Information Science of Wuhan University, 2007, 32(1):51-54 http://ch.whu.edu.cn/article/id/1797
[9] Zhang Qinghua.Adaptive Kalman Filter for Actuator Fault Diagnosis[J].Automatica, 2018, 93:333-342 doi: 10.1016/j.automatica.2018.03.075
[10] Tsai S H, Lin M H, Zheng C H, et al.Actuator Fault Detection and Performance Recovery with Kalman Filter-Based Adaptive Observer[J].International Journal of General Systems, 2007, 36(4):375-398 doi: 10.1080/03081070600928963
[11] 杨元喜, 徐天河.基于移动开窗法协方差估计和方差分量估计的自适应滤波[J].武汉大学学报·信息科学版, 2003, 28(6):714-718 http://ch.whu.edu.cn/article/id/4832 Yang Yuanxi, Xu Tianhe.An Adaptive Kalman Filter Combining Variance Component Estimation with Covariance Matrix Estimation Based on Moving Window[J].Geomatics and Information Science of Wuhan University, 2003, 28(6):714-718 http://ch.whu.edu.cn/article/id/4832
[12] 徐韩, 曾超, 黄清华.一种基于渐消因子的区间卡尔曼滤波器方法[J].武汉大学学报·信息科学版, 2017, 42(12):1 826-1 833 doi: 10.13203/j.whugis20150567 Xu Han, Zeng Chao, Huang Qinghua.Kalman Filtering for Ultra-Tight Coupled from Stable State to Catastrophe State in Noise Condition[J].Geomatics and Information Science of Wuhan University, 2017, 42(12):1 826-1 833 doi: 10.13203/j.whugis20150567
-
期刊类型引用(8)
1. 张莹，任战利，兰华平，祁凯，邢光远，夏岩. 关中盆地新近系蓝田-灞河组热储层物性及渗流特征研究. 地质通报. 2024(05): 712-725 . 
百度学术
2. 吴陈冰洁，罗璐，高楠安，汪新伟，崔梓贤. 关中盆地西安凹陷新近系砂岩热储特征研究. 现代地质. 2024(06): 1571-1584 . 百度学术
3. 张欢，陈应涛，陶威，陈涛，余文鑫，艾卉卉. 不同拉伸方式和速度下的伸展构造砂箱物理模拟实验研究. 西北地质. 2023(02): 327-336 . 百度学术
4. 颜复康，田镇，杨志强，杨兵，梁沛. 厄瓜多尔俯冲区震间闭锁与粘弹性变形研究. 大地测量与地球动力学. 2023(10): 1080-1085 . 百度学术
5. 张莹，任战利，邢光远，祁凯，夏岩. 渭河盆地新近系热储层特征. 地质通报. 2023(11): 1993-2005 . 百度学术
6. 徐斌，张艳. 地下水化学类型分区的GIS空间分析模型. 武汉大学学报(信息科学版). 2019(06): 866-874 . 百度学术
7. 闫俊义，吕睿，赵涛，王莹，白若冰，古云鹤. 关中盆地地壳应力场特征分析. 山西地震. 2019(03): 39-41 . 百度学术
8. 白相东，关成尧，张艳，袁四化，刘晓燕. 渭河盆地断层系统运动学体制分解与探讨. 防灾科技学院学报. 2018(03): 8-16 . 百度学术
其他类型引用(10)
计量
- 文章访问数: 1117
- HTML全文浏览量: 354
- PDF下载量: 117
- 被引次数: 18
