[发明专利]基于GNSS的紫外敏感器系统误差在轨标定方法有效
申请号: | 201710201657.8 | 申请日: | 2017-03-30 |
公开(公告)号: | CN106996779B | 公开(公告)日: | 2019-08-20 |
发明(设计)人: | 郑伟;安雪滢;王奕迪;霍梦晨;吴杰 | 申请(专利权)人: | 中国人民解放军国防科学技术大学 |
主分类号: | G01C21/16 | 分类号: | G01C21/16 |
代理公司: | 长沙七源专利代理事务所(普通合伙) 43214 | 代理人: | 欧颖;吴婷 |
地址: | 410073 *** | 国省代码: | 湖南;43 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明提供了一种基于GNSS的紫外敏感器系统误差在轨标定方法,在GNSS可用时利用最小二乘法处理紫外敏感器测量量与GNSS高精度定位结果,可较为准确地得到导航系统的系统误差估计值,用于在GNSS不可用时对导航信息进行补偿,以提高导航精度,操作简单、适用范围广,紫外敏感器的系统误差模型改变后也能依据本发明的方法类推出紫外敏感器的系统误差,可扩展性强。本发明在系统误差估计过程中,没有对状态量进行扩展,在滤波估计中,状态维数不再进行增加,维数的减少有利于增强滤波器的稳定性和加快滤波收敛速度,故本发明给出的系统误差估计方法能够较快地给出高精度的系统误差估计结果。 | ||
搜索关键词: | 基于 gnss 紫外 敏感 系统误差 标定 方法 | ||
【主权项】:
1.一种基于GNSS的紫外敏感器系统误差在轨标定方法,其特征在于,包括以下步骤:1)在GNSS可用时,使高轨卫星上的星载接收机对GNSS卫星进行观测,建立GNSS伪距观测方程;使高轨卫星上的紫外线敏感器对地球进行观测,建立紫外敏感器观测方程;2)利用步骤1得到的GNSS测量信息得到高轨卫星位置信息,通过非线性滤波算法处理高轨卫星位置信息,得到GNSS伪距测量信息下的高精度导航结果;3)通过最小二乘法处理步骤1得到的紫外敏感器观测量与步骤2得到的高精度导航结果,得到紫外敏感器的误差估计值;4)以步骤3得到的紫外敏感器的误差估计值为标定值,在GNSS不可用时对高轨卫星的导航信息进行补偿,从而提高导航精度;步骤1中,紫外敏感器的观测方程如式1所示:
其中,Δx、Δy分别为紫外光学敏感轴在像平面内由于像点提取误差、主点偏差、焦距偏差、成像平面的倾斜与旋转,以及镜头畸变误差因素的影响造成的x轴和y轴的像素偏差;f为紫外敏感器的焦距;
为紫外敏感器测量的地心惯性系下的高轨卫星质心位置矢量;
为测量系到惯性系的转换矩阵,
为紫外敏感器的测量量,εr为观测随机噪声;步骤1中,GNSS伪距观测方程如式2所示:
其中,下标j表示GNSS卫星编号,ρj为伪距测量值,即高轨卫星与GNSS卫星之间的距离,也是GNSS的测量量,
为GNSS卫星在信号发射时刻的地心惯性位置矢量,rI为高轨卫星在信号接收时刻的地心惯性位置矢量,c为导航信号传播速度,δtj为GNSS卫星钟差,δtr为高轨卫星上的接收机钟差,δρj,ion为电离层时延误差;
为高轨卫星上的接收机伪距测量噪声;步骤2中,采用扩展卡尔曼滤波对GNSS测量信息进行处理,具体步骤为:2.1)建立式3的非线性离散系统:
其中,xk+1为高轨卫星在k+1时刻的状态量,zk+1为高轨卫星在k+1时刻的测量量,其包括紫外测量量和GNSS测量量,h(xk+1)为观测方程,其包括式1与式2所表示的观测方程,f(xk)为高轨卫星的轨道动力学方程,wk、vk+1均为高斯白噪声,且互不相关,其统计特性如式4:
其中,Qk为对称非负定矩阵,Rk为对称正定矩阵,初始状态x0独立于wk、vk,其均值和协方差如式5:
2.2)初始化状态量
和方差阵P0如式6‑1与式6‑2:![]()
2.3)将状态方程和测量方程分别围绕k+1时刻的滤波值
展开成泰勒级数,并在
附近线性化,可得式7与式8:![]()
其中,T为滤波更新周期,
为zk+1在
附近进行一阶泰勒展开得到的线性化观测矩阵,
为状态一步预测,即k时刻的状态xk只经过如式7的状态更新得到的k+1时刻的状态
2.4)时间更新,具体如式9‑1、式9‑2与式10:xk+1,k=Φk+1xk/k (式9‑1);
其中,
I为单位矩阵,Φk+1为由式10得到的状态转移矩阵,
为状态转移矩阵Φk+1的转置,
为过程噪声协方差阵,f(x)为高轨卫星的轨道动力学方程;2.5)测量更新,具体如式11~式14:状态量更新如式11:xk+1=xk+1,k+Kk+1(zk+1‑h(xk+1,k))(式11);其中,Kk+1为滤波增益,h(xk+1,k)为由一步预测状态
经观测方程得到的预测观测量;滤波增益如式12:
其中,Hk+1为观测矩阵,
为观测矩阵Hk+1的转置,Pk+1,k为预测方差阵,Rv,k+1为测量噪声协方差阵;协方差阵更新如式13:Pk+1=(I‑Kk+1Hk+1)Pk+1,k(式13);其中,
h(x)为由式1与式2所示的观测方程;2.6)利用式11和式13获得的状态量
和方差阵
返回扩展卡尔曼滤波器,用于下一时刻,经过一定的循环迭代次数,最终得到GNSS伪距测量信息下的高精度导航结果![]()
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国人民解放军国防科学技术大学,未经中国人民解放军国防科学技术大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201710201657.8/,转载请声明来源钻瓜专利网。