卡尔曼滤波器在GPS系统中的应用

1、卡尔曼滤波器在GPS系统中的应用摘要： 目前，随着GPS应用范围的扩大，传统的定位方法越来越不能满足其日益增长的 性能要求。因此将卡尔曼滤波理论应用到卫星导航中对国防和民用事业具有非常 重要的意义。 关键词：GPS卫星卡尔曼滤波 二系统组成： 2.0 GPS介绍 GPS即全球定位系统(GlobalPositioningSystem) 。简单地说，这是一个由覆盖全球的 24颗卫星组成的卫星系统。这个系统可以保证在任意时刻，地球上任意一点都可以同时观 测到4颗卫星，以保证卫星可以采集到该观测点的经纬度和高度，以便实现导航、定位、授时等功能。这项技术可以用来引导飞机、船舶、车辆以及个人，安全、准确地

2、沿着选定的路 线，准时到达目的地。GPS主要有三大部分组成：空间卫星星座部分、地面监控部门和用户设备部分(GPS接收机)。目前，随着 GPS应用范围的扩大，传统的定位方法越来越不能满足其日益增长的性能 要求。因此将卡尔曼滤波理论应用到卫星导航中对国防和民用事业具有非常重要的意义 空间部分GPS的空间部分是由24颗工作卫星组成，它位于距地表20200km的上空，均匀分布在6 个轨道面上(每个轨道面4颗)，轨道倾角为55 “。此外，还有 4颗备份卫星在轨运行。卫 星的分布使得在全球任何地方、任何时间都可观测到 4颗以上的卫星，并能保持良好定位解算精度的几何图像。这就提供了在时间上连续的全球导航能力

3、。GPSS星产生两组电码，一组称为 C/A 码(Coarse/AequlsitionCodell023MHz);一组称为 p 码(ProeiseCodel0123MHz),P码因频率较高，不易受干扰，定位精度高，因此受美国军方管制，并设有密码，一般民间 无法解读，主要为美国军方服务。C/A码人为采取措施而刻意降低精度后，主要开放给民间使用(2) 地面控制部分地面控制部分由一个主控站，5个全球监测站和 3个地面控制站组成。监测站均装配有精密的艳钟和能够连续测量到所有可见卫星的接受机。监测站将取得的卫星观测数据，包括电离层和气象数据，经过初步处理后，传送到主控站。主控站位于美国克罗拉多 (Colo

4、rado) 的法尔孔(Falcon)空军基地，它的作用是根据各监测站收集跟踪数据，计算出卫星的轨道和时钟参数，然后将结果送到3个地面控制站。地面控制站在每颗卫星运行至上空时，把这些导航数据及主控站指令注入到卫星。这种注入对每颗GPS卫星每天一次,并在卫星离开注入站作用范围之前进行最后的注入。如果某地面站发生故障，那么在卫星中预存的导航信息还 可用一段时间，但导航精度会逐渐降低。(3) 用户部分用户设备部分即GPS言号接收机。其主要功能是能够捕获到按一定卫星截止角所选择的 待测卫星，并跟踪这些卫星的运行。当接收机捕获到跟踪的卫星信号后，即可测量出接收夭线至卫星的伪距离和距离的变化率，解调出卫星轨

5、道参数等数据。根据这些数据，接收机中的微处理计算机就可按定位解算方法进行定位计算，计算出用户所在地理位置的经纬度、高度、速度、时间等信息。接收机硬件和机内软件以及GPS数据的后处理软件包构成完整的GPS用户设备。GPS收机的结构分为天线单元和接收单元两部分。接收机一般采用机内和 机外两种直流电源。 设置机内电源的目的在于更换外电源时不中断连续观测。在用机外电源时机内电池自动充电。关机后，机内电池为RAM存储器供电，以防止数据丢失。目前各种类型的接受机体积越来越小，重量越来越轻，便于野外观测使用 2.1 GPS定位原理GPS定位的方法是多种多样的，用户可以根据不同的用途采用不同的定位方法。GPS

6、定位方法可依据不同的分类标准，作如下划分：(l) 伪距定位根据定位所采用的观测值伪距定位。伪距定位所采用的观测值为GPSJ距观测值，所采用的伪距观测值既可以是 C/A码伪距，也可以是P码伪距。伪距定位的优点是数据处理简 单，对定位条件的要求低，不存在整周模糊度的问题，可以非常容易地实现实时定位；其缺点是观测值精度低，C/A码伪距观测值的精度一般为 3米，而P码伪距观测值的精度一般也 在30个厘米左右，从而导致定位成果精度低，另外，若采用精度较高的码伪距观测值，还 存在AS的问题。(2) 载波相位定位载波相位定位所采用的观测值为GPS勺载波相位观测值，即 Ll、玩或它们的某种线性组合。载波相位定

7、位的优点是观测值的精度高，一般优于2个毫米；其缺点是数据处理过程复杂，存在整周模糊度的问题。(3) 绝对定位绝对定位又称为单点定位，这是一种采用一台接收机进行定位的模式，确定的是接收机天线的绝对坐标。这种定位模式的特点是作业方式简单，可随机作业。绝对定位一般用于导航和精度要求不高的应用中。(4) 相对定位相对定位又称为差分定位， 这种定位模式采用两台以上的接收机，同时对组相同的卫星进行观测，以确定接收机天线间的相互位置关系。(6) .动态定位所谓动态定位，就是在进行GP奚位时，认为接收机的天线在整个观测中的位置是变化 的。也就是说，在数据处理时，将接收机天线的位置作为一时间的改变而改变的量。动

8、态定 位又分为儿nematic和D" amic两类。(7) 静态定位所谓静态定位，就是在进行 GPS定位时，认为接收机的天线在整个观测中的位置是保 持不变的。也就是说，在数据处理时，将接收机天线的位置作不随时间的改变而改变的量。 在测量中，静态定位一般用于高精度的测量其具体观测模式多台接收机在不同的测站上进行 静止同步观测，时间由几分、几小时甚至数十小时不等。2.2 GPS的绝对定位GPS绝对定位的实质是基于测量学中的空间距离后方交会。在GPS观测我们得到卫星的位置和卫星和测点的距离(伪距)，然后就以卫星为球心、以为半径做球面。如果同时观测 了 3颗卫星，我们便得到 3个球面。用数学

9、语言即可组成包括3个未知数(X , Y, Z)的3个方程式。这3个球面相交的一点， 是我们要求的测点的位置。也就是，对这3个方程式求解，便得到该点的坐由于卫星钟与接收机钟之间的钟差所引入的误差，称之为伪距。由于接收机测量的是伪距，在观测值中存在着接收机钟差，加之测量点的三维坐标为待求值，一共有4个未知数。要求解出这4个未知数，必须有4个方程式。为此，要实现单点绝对定位必须同 时观测4个卫星，组成定位的基本方程。设 p为伪距观测量，R为接收机到卫星的真距离， 公为接收机钟差，则观测方程为 ：可=R+C I =、. X Xp）2 M Yp）2 亿Zp）2 C .，*10式中，假定伪距观测值 p己经

10、过星历中的对流层和电离层改正；（xp、yp、zp）为接收机的地心坐标，是待求量；（x1、y1、z1）为卫星夕的瞬时地心坐标，可由卫星星历电文中求出。如下图所示：图一 GPS绝对定位图为了求解方便和数据处理的需要，将式 （1.0）进行微分，做线性化处理，并接收机的概略坐标（xp0、 y p0Zp0作为初始值代入，得到d：=X1 *Rdx+二dy+Zdz式中，dt=cd E为接收机钟差对应的空间距离，R = J（Xi _Xp。）2_Yp。）2 十亿 _Zp。）2从式（1.1）中看出，三个坐标分量的系数是接收机到卫星的单位矢量分别向 三个坐标轴投影的方向余弦。采用符号：XXp0ZZp0 n =Ri上

11、式中（1, m, n）为第i颗卫星观测方向的方向余弦。4颗卫星组成一个方程组，下标 k为测站号，组成一个矩阵形式方程。 AX=L解方程即可得到接收机地心坐标的唯一解。2.3与传播途径有关的误差（1）电离层折射在地球上空距地面 50 一 100km之间的电离层中，气体分子受到太阳等夭体各种射线辐射 产生强烈电离，形成大量的自由电子和正离子。当G户S信号通过电离层时， 与其他电磁波一样，信号的路径要发生弯曲，传播速度也会发生变化，从而使测量的距离发生偏差，这种影响称为电离层折射。对于电离层折射可用3种方法来减弱它的影响：利用双频观测值，利用不同频率的观测值组合来对电离层的延迟进行改正。利用电离层模

12、型加以改正。利用同步观测值求差，这种方法对于短基线的效果尤为明显。(2) 对流层折射对流层的高度为4Okm以下的大气底层，其大气密度比电离层更大，大气状态也更复杂。 对流层与地面接触并从地面得到辐射热能，其温度随高度的增加而降低。GPS言号通过对流层时，也使传播的路径发生弯曲，从而使测量距离产生偏差，这种现象称为对流层折射。减弱对流层折射的影响主要有三种措施：采用对流层模型加以改正，其气象参数在测站直接 测定。引入描述对流层影响的附加待估参数，在数据处理中一并求得。利用同步观测量求差。(3) 多路径效应测站周围的反射物所反射的卫星信号(反射波)进入接收机天线，将和直接来自卫星的信号(直接波)产

13、生干涉，从而使观测值偏离，产生所谓的“多路径误差”。这种由于多路径的信号传播所引起的干涉时延效应被称作多路径效应。减弱多路径误差的方法主要有：选择合适的站址。测站不宜选择在山坡、山谷和盆地中，应离开高层建筑物。选择较好的接收机天线，在天线中设置径板，抑制极化特性不同的反射信号。 3、与GPSg收机有关的误差(4) 接收机钟差GPS接收机一般采用高精度的石英钟，接收机的钟面时与GpS标准时之间的差异称为接收机钟差。把每个观测时刻的接收机钟差当作一个独立的未知数，并认为各观测时刻的接收机钟差间是相关的，在数据处理中与观测站的位置参数卡尔曼滤波在卫星导航中的应用研究 并求解，可减弱接收机钟差的影响。

14、(5) 接收机的位置误差接收机天线相位中心相对测站标石中心位置的误差，叫接收机位置误差。 其中括天线置平和对中误差，量取天线高误差。在精密定位时，要仔细操作，来尽量减这种误差影响。变 形监测中，应采用有强制对中装置的观测墩。相位中心随着号输入的强度和方向不同而有所变化，这种差别叫天线相位中心的位置偏差。这种偏差的影响可达数毫米至厘米。而如何减少相位中心的偏移是天线设计中的一重要问题。在实际工作中若使用同一类天线，在相距不远的两个或多个测站同步测同一组卫星，可通过观测值求差来减弱相位偏移的影响。但这时各测站的天线应按天线附有的方位标进行定向，使之根据罗盘指向磁北极o。(6) 接收机天线相位中心偏

15、差在G户S测量时，观测值都是以接收机天线的相位中心位置为准的，而天线的位中心与 其几何中心，在理论上应保持一致。 但是观测时天线的相位中心随着信输入的强度和方向不 同而有所变化，这种差别叫天线相位中心的位置偏差。这种差的影响可达数毫米至厘米。而如何减少相位中心的偏移是天线设计中的一个重要问题。三卡尔曼滤波在卫星导航中的应用GPS动态卡尔曼滤波算法系统主要应用在机动状态载体，因此采用最能描述载体强烈机 动的当前统计模型。(1)状态方程建立。所用GPS接收系统给出的是在地理坐标系中的经度、纬度和高度值。一般要先将地理坐标Bx 'x。kWxWbxByy°y+Wy+Wby<Bz

16、J0 )J<Wz J<Wbz>系转换为地球直角坐标系，并依次定义描述接收机在 差等信息.3个坐标轴的位置、速度、加速度、误TX =x,x,x,如 y, y, y, ；y,z,z,z, ；z4x,x,x, * y, y,y, y,z,z,z, ；z分别为机动状态载体在 3个坐标轴上的位置、速度、加速度和位置误: 科夫过程表示各个位置误差，总位置误差可看作有色噪声，则可表述为通常采用一阶马尔x , -y, -z1zWzT z上述3式中，Tz分别对应马尔科夫过程的相关时间常数。W为对应3条坐标上的高斯白噪声，则系统方程可写为X(t) = AX(t) +U (t) +W(t) (3)

17、式中，系统的状态转移矩阵为Ax04 404 404 4Ay04 404 404 4AzU(t)=0 0ax/ ax 0 0 0x axay / ay0 0 0 aj- az 0Tz azW(t)=0 0W& Wx 00Way Wy0 0 Wa WTdzz(2)观测方程的建立将GPS接收机输出的定位结果为x0y0z°,那么在其中分另U包括真实状态变量x, y, z和一阶马尔科夫过程误差义，勾，&z和量测误差Wbx , Wby, Wbz 即若取 Z =Bx,By,Bz11X =x,x,x, ；x,y, y, y, y,z,z,z, T10V = Wbx，Wby,WtJ12

18、则矩阵形式为 z = HX V13其中的观测矩阵可表示为1 0 01 00000000"H= 00001 001 0000141000000001 001 ,由建立的方程得知，这是一个可观测的线性卡尔曼模型。(3)自适应卡尔曼滤波方程的建立。通过上述方程，可建立卡尔曼滤波方程如下X (k+1/k) =Q(k+1/k)X(k)15X (k+1) =X(k+1/k)+k(k+1)B(k+1)H(k+1)X(k+1/k)16K (k+1) =Rk+1/ k)HT(k +1)H(k+1)P(k+1)HT(k + 1)+R(k+1)17P (k+1/k) =Mk+1)*(k+1/k)P(kNT(k+1/k)+e(k)18P (k+1) =I-k(k+1)H (k+1)P(k+1/k)19体(k+1/k ) 1 x其中，4(k+1/k ) =00004 (k+1/k)01 y04(k+1/k)1z20T2102*1=01 T 0x0 0109 00e*1 T 02*1=01T0y0 010/0 00 e212223Px(k 十1/ k)00式中巾(k +1/ k)=0ey(k+1/ k)0< 00ez(k +1/ k),24'1 T (T/