一种考虑偏差时引入伪测量的重力梯度运动学导航方法技术

一种考虑偏差时引入伪测量的重力梯度运动学导航方法，属于自主导航领域。其步骤如下：一：准备工作：给出重力梯度相关的计算公式，以及重力梯度在不同坐标系下的表示；二：设置解算初始参数，准备数据，例如迭代初值、测量方差的选取等；三：利用EGM2008模型计算重力梯度值和重力梯度对位置的偏导阵；四：引入伪测量，构建运动学导航观测模型；五：利用非线性最小二乘方法进行迭代求解。通过以上步骤，引入伪测量，增加了观测信息，然后构建考虑测量偏差的重力梯度序贯运动学导航观测方程。摆脱了传统卫星定轨应用中对卫星动力学约束的依赖，将重力梯度导航的应用扩展到一般物体，从而大大提高了重力梯度定位导航的应用潜力和应用价值。

A Kinematic Navigation Method of Gravity Gradient with Pseudo-Measurement Considering Deviation

A gravity gradient kinematics navigation method which incorporates pseudo-measurement when considering deviation belongs to the field of autonomous navigation. The steps are as follows: 1. Preparations: giving the formula of gravity gradient correlation and the representation of gravity gradient in different coordinate systems; 2. Setting up the initial parameters of solution and preparing data, such as the selection of iteration initial value and measurement variance; 3. Using EGM2008 model to calculate gravity gradient value and gravity gradient partial matrix to position; 4. Introducing pseudo-measurement to construct motion. Learn navigation observation model; Fifth, use the non-linear least squares method to solve iteratively. Through the above steps, the pseudo-measurement is introduced to increase the observation information, and then the gravity gradient sequential kinematic navigation observation equation considering the measurement deviation is constructed. The application of gravity gradient navigation is extended to general objects, which greatly improves the application potential and value of gravity gradient positioning and navigation.

【技术实现步骤摘要】
一种考虑偏差时引入伪测量的重力梯度运动学导航方法
本专利技术提供一种考虑偏差时引入伪测量的重力梯度运动学导航方法，它涉及一种基于重力梯度测量的序贯运动学定位方法和偏差固定方法，即一种对无动力学约束的静止或者运动载体利用重力梯度测量进行位置估计和测量偏差估计的方法，属于导航

技术介绍
全张量重力梯度匹配导航技术是一种新兴的自主导航方式。其利用地球本身的重力梯度信息，通过建模、匹配等方法对载体位置进行估计。重力梯度匹配导航技术具有实时、全自主、抗干扰等诸多优势，通过在载体平台上安装一个重力梯度仪作为测量仪器，得到六个输出量，如果不考虑仪器的测量偏差，则一个时刻的测量数据可以直接解算出位置信息。由于重力梯度匹配导航技术具有完全自主、抗干扰、无误差积累等优点，在未来有望成为新一代的主流导航系统。重力梯度是重力势对位置的二阶导数，是一个3阶对称方阵，其中只有五个元素是相互独立的。在通常的重力梯度辅助导航系统或者作为单独的导航系统中，一般不考虑重力梯度仪的测量偏差。在重力梯度导航方式作为单独工作的导航系统中，目前已经有融合卫星动力学信息的导航方式出现。重力梯度定位精度依赖于重力梯度仪的测量精度和重力场模型的精度，同时依赖于是否有其它信息的约束，比如动力学信息。依据是否利用卫星动力学信息，可以将重力梯度导航方式分为动力学导航和运动学导航。其中运动学导航算法因为不需要动力学信息的约束，适用范围更广，可以为车辆、舰船、飞机、火箭和卫星等提供导航信息。在不考虑仪器测量偏差的情况下，运动学导航算法可以利用六个重力梯度测量量来估计三个位置信息，根据仪器测量数据和相对应的测量方差，利用迭代非线性最小二乘解算得到位置信息。此种方法相当于对于每一时刻进行单点定位解算。在考虑仪器测量偏差时，由于仪器测量偏差未知，因此需要将仪器测量偏差当作未知量进行估计。这样就增加了未知量的个数，有九个未知量，而观测方程还是只有六个，因此观测方程秩亏，无法解算。由于考虑重力梯度仪测量偏差时运动学解算方程秩亏的问题，目前重力梯度导航的研究主要有两方面，第一是作为辅助导航方式应用在舰船、潜艇等载体上，第二是结合卫星动力学信息对卫星进行导航。本专利技术在运动学导航方法的基础上提出了一种考虑测量偏差的序贯运动学导航方法，该方法引入了伪测量，从而增加了每个历元的观测信息，解决了普通运动学导航观测方程秩亏的问题，而且可以同时对载体位置和仪器测量偏差进行估计。由于是运动学导航方法，因此该方法可以摆脱对卫星动力学信息的依赖，能够用于普通载体如汽车、火箭、飞机等的导航。
技术实现思路
(一)专利技术目的：本专利技术以序贯运动学导航算法基础，针对考虑带有偏差的运动学导航中秩亏的问题，提出了一种引入伪测量的序贯运动学导航方法。(二)技术方案本专利技术提出一种考虑偏差时引入伪测量的重力梯度运动学导航方法，其步骤如下：步骤一：准备工作首先，重力梯度定义为重力势函数对位置的二阶导数，以U表示地球重力势，其表达形式如下：式中GM表示地球的引力常数，表示地球半径，Cnm和Snm表示重力场模型中的球谐项系数，其值由重力场模型给出。m和n表示重力场模型的阶次数(order，degree)。Vnm和Wnm的计算可参见Montenbruck所著《SatelliteOrbits》一书。现总结如下：式中，r表示位置[x，y，z]处与地球球心之间的距离，根据上面式(2)和式(3)，可以分别迭代计算各个阶次的Vnm和Wnm，给出零阶零次的V00和W00，其递推计算过程如下：重力梯度张量是重力势对位置的二阶导数，单位为E(1E＝10-9s-2)，其张量矩阵在坐标系ECEF下的表达式如下：为Vnm，Wnm相对于位置的二阶偏导，式(7)为Vnm对位置的二阶导数，式(8)为Wnm对位置的二阶导数。GGTE为ECEF坐标系下的重力梯度张量矩阵。由上面(2)式到(8)式即可计算出在地球固连坐标系ECEF下某一位置处的重力梯度。重力梯度仪的的测量值是在重力梯度仪坐标系(GRF)下表示的，在实际定位中涉及到重力梯度在不同坐标系下的表示，下面给出重力梯度在地球固连坐标系(ECEF)和重力梯度仪坐标系(GRF)之间的转换关系：其中Tecef2grf表示ECEF到GRF坐标系的转换矩阵，在实际中可以由其他手段如星敏感器获得。GGTE表示ECEF坐标系下的重力梯度张量矩阵。Tecef2grf的表达形式如下：cij表示矩阵第i行第j列的元素。考虑到重力梯度张量矩阵是一个对称矩阵，重力梯度仪实际输出是张量矩阵GGT中上三角的6个测量结果，组成一个包含6个元素的向量。其表达式为：式中VG表示重力梯度在重力梯度仪坐标系(GRF)下的分量。实际重力梯度仪测量中，包含较大偏差，给出考虑测量偏差时的重力梯度原始观测方程如下：式中表示GRF坐标系下的观测值，HT表示重力梯度从ECEF到GRF的转换矩阵，是一个6×6的矩阵，矩阵中的元素cij即是Tecef2grf中第i行，第j列的元素。表示重力梯度在ECEF坐标系位置r处的真实值，b表示重力梯度仪的测量偏差，w表示重力梯度仪的测量噪声。重力梯度与位置之间是强非线性关系，在利用重力梯度求解位置信息时需将原始观测方程线性化，为统一计算将测量方程在[r0，b0]处线性化，过程如下：将上式整理得到考虑测量偏差的重力梯度线性化观测方程如下：其中表示在位置r＝r0处重力梯度向量对位置向量的偏导阵。步骤二：初始参数设置给出历元k时的位置初值rk0和测量偏差初值bk0，可将上一历元的估计结果作为本历元的位置初值rk0和偏差初值bk0：以及实际观测测量方差阵Rrk和偏差观测测量方差阵Rbk。实际观测测量方差取值为GOCE星载重力梯度仪测量方差：Rrk＝diag([15151535015500])2(17)且实际测量方差不随时间变化。由于测量偏差是伪测量，不存在实际的测量，也就不存在测量方差，利用测量偏差不随时间变化的特性，由于将k-1历元的估计值作为本历元的测量值，故可将k-1历元的偏差估计的协方差Pb(k-1)作为本历元的测量方差Rbk：Rbk＝Pb(k-1)(18)上面的位置初值、偏差初值和偏差测量方差阵都牵涉到上一历元的信息，对于第一个历元，由于没有上一历元信息，需要给出先验信息，假定位置初值r10、偏差初值b10，以及偏差的测量方差Rb1。第一历元的信息是任意给出的，存在很大不确定性，因此第一时刻的测量方差阵需要给出一个稍大一些的值，例如第一时刻六个偏差的初值误差都是104mE，则取测量噪声都为104mE量级，即：Rb1＝diag([104104104104104104])(19)然后，将历元k时ECEF坐标系与GRF坐标系之间的转换矩阵Tecef2grf提取出来，并根据式(13)构造出相应的HTk，在实际测量中，Tecef2grf可以由其它手段获得，如星敏等设备。步骤三：计算位置rk0处的重力梯度值GGV(rk0)和偏导阵Hg(rk0)由式(2)到式(8)，可以求出在ECEF坐标系下位置rk0处的重力梯度张量矩阵，由于矩阵是对称的，因此，只需取下(上)三角元素即可，得到GGV(rk0)如下：GGV(rk0)＝GGTE[1，5，9，2，3，6]＝[GGVxx，GGVyy，GGVzz，GGVxy，G本文档来自技高网...

【技术保护点】
1.一种考虑偏差时引入伪测量的重力梯度运动学导航方法，其特征在于：首先以重力梯度作为单独的导航系统，并将其应用到航天器导航上；其次，仅仅将重力梯度值为测量值，结合高精度重力场模型，通过模型解算重力梯度；并考虑重力梯度仪所带有的测量偏差，利用运动学序贯方法估计出载体所处的位置信息及速度信息；另外，为弥补考虑测量偏差时重力梯度运动学导航观测方程秩亏的问题，方法引入了伪测量的概念，解决了观测方程秩亏的问题，可以实现卫星位置与偏差的同时估计。本方法主要实施步骤为：设置初始参数；采用高精度的EGM2008模型计算地球固联坐标系(ECEF)相应位置处的重力梯度值

【技术特征摘要】
1.一种考虑偏差时引入伪测量的重力梯度运动学导航方法，其特征在于：首先以重力梯度作为单独的导航系统，并将其应用到航天器导航上；其次，仅仅将重力梯度值为测量值，结合高精度重力场模型，通过模型解算重力梯度；并考虑重力梯度仪所带有的测量偏差，利用运动学序贯方法估计出载体所处的位置信息及速度信息；另外，为弥补考虑测量偏差时重力梯度运动学导航观测方程秩亏的问题，方法引入了伪测量的概念，解决了观测方程秩亏的问题，可以实现卫星位置与偏差的同时估计。本方法主要实施步骤为：设置初始参数；采用高精度的EGM2008模型计算地球固联坐标系(ECEF)相应位置处的重力梯度值和重力梯度对位置的偏导阵Hg；为解决考虑测量偏差时同时估计偏差和位置造成的观测方程秩亏的问题，首先在重力梯度运动学实时定位导航中引入了伪测量的概念，利用测量偏差几乎不随时间变化这一特点，将前一历元的测量偏差的估计量作为本历元测量偏差的虚拟观测量，并构建引入伪测量的运动学导航观测方程。最后，对测量方程进行线性化，并通过迭代最小二乘方法进行求解。得到卫星位置和重力梯度仪的测量偏差。通过以上步骤，引入伪测量，增加了观测信息，然后构建考虑测量偏差的重力梯度序贯运动学导航观测方程。摆脱了传统卫星定轨应用中对卫星动力学约束的依赖，将重力梯度导航的应用扩展到一般物体。2.权利要求1中所述的一种考虑偏差时引入伪测量的重力梯度运动学导航方法，其特征在于：将运动学导航的方式引入重力梯度导航体系中，不使用卫星所受到的动力学约束信息。考虑测量偏差时重力梯度运动学导航的线性化观测方程可以写成如下形式：其中表示重力梯度仪坐标系(GRF)下测量得到的重力梯度向量，表示在ECEF坐标系下位置r0处的重力梯度向量，HT表示将重力梯度向量从ECEF坐标系到GRF坐标系下的转换矩阵，大小为6×6，在实际中由其它方式得到。Hg(r0)表示ECEF坐标系下的重力梯度向量对位置r0的偏导阵，表达形式为r和r0表示分别表示在本历元的实际位置和线性化位置，即位置初值。b和b0分别表示本历元重力梯度仪的测量偏差真值和测量偏差的线性化点，即偏差初值。w表示重力梯度仪真实测量的测量偏差，考虑为满足高斯分布的均值为零的白噪声。作者所采用的GOCE卫星星载重力梯度仪的测量方差量级为Rg＝diag([15151535015500]m...

【专利技术属性】
技术研发人员：陈培，韩锦飞，孙秀聪，谭玉龙，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：北京,11