一种基于卡尔曼滤波的GPS单点定位系统.pdf

(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号CN105510942A(43)申请公布日2016.04.20(21)申请号201510987332.8(22)申请日2015.12.27(71)申请人哈尔滨米米米业科技有限公司地址150001黑龙江省哈尔滨市南岗区南通大街145号(72)发明人王树鑫(51)Int.Cl.G01S19/42(2010.01)G01S19/37(2010.01)权利要求书2页说明书4页附图1页(54)发明名称一种基于卡尔曼滤波的GPS单点定位系统(57)摘要一种基于卡尔曼滤波的GPS单点定位系统，首先建立GPS定位的卡尔曼滤波模型和方程式，之后进行卡尔曼滤波递推计算；在每一个定位历元过程中，卡尔曼滤波器首先利用状态方程来对接收机当前的位置、速度、GPS接收机时钟差来进行预测；然后，依据这一状态先验估计值和卫星星历所提供的卫星位置和速度，卡尔曼滤波器就能够预测GPS接收机对各颗卫星的伪距和多普勒频移值，这些测量预测值和接收机的实际测量值之差又形成了测量残余；最后，卡尔曼滤波器通过对测量残余进行处理就能够得到系统状态估计值的校正量以及校正以后的最优估计值。本发明主要研究了GPS单点定位的方法以及卡尔曼滤波技术，以有效提高定位的估计精度。CN105510942ACN105510942A权利要求书1/2页1.一种基于卡尔曼滤波的GPS单点定位系统，其特征在于：首先建立GPS定位的卡尔曼滤波模型和方程式，之后进行卡尔曼滤波递推计算；在每一个定位历元过程中，卡尔曼滤波器首先利用状态方程来对接收机当前的位置、速度、GPS接收机时钟差来进行预测；然后，依据这一状态先验估计值和卫星星历所提供的卫星位置和速度，卡尔曼滤波器就能够预测GPS接收机对各颗卫星的伪距和多普勒频移值，这些测量预测值和接收机的实际测量值之差又形成了测量残余；最后，卡尔曼滤波器通过对测量残余进行处理就能够得到系统状态估计值的校正量以及校正以后的最优估计值。2.根据权利要求1所述的一种基于卡尔曼滤波的GPS单点定位系统，其特征在于：在利用卡尔曼滤波进行测速、定位时需要建立合理、准确的运动模型，不准确的载体运动模型将会导致滤波在计算过程中产生发散现象；常速模型和常加速模型是卡尔曼滤波常用的两种运动模型，其中常速模型是最理想化、最简单的一种运动模型；在本系统中采用常速模型，根据误差观测方程，自主推导出卡尔曼滤波的基本模型如下：卡尔曼滤波模型可以概括为：状态方程：=+(1)观测方程：=HX+(2)式中：（0，），（0，）为系统噪声和观测噪声=(3)=(4)状态方程中的状态转移矩阵为=(5)干扰矩阵为2CN105510942A权利要求书2/2页=(6)T为数据采样间隔；系数矩阵为=(7)在上式中：=，=,=；=。3CN105510942A说明书1/4页一种基于卡尔曼滤波的GPS单点定位系统技术领域[0001]本发明涉及的是一种卫星定位方法，特别涉及的是一种基于卡尔曼滤波的GPS单点定位系统。背景技术[0002]全球定位系统(简称GPS)是美国国防部于1973年开始建立的卫星导航定位系统。这个系统当初建立的主要目的是为了给海陆空运载工具提供导航和定位服务。经过20年的不断发展，耗费了数百亿美元，于1994年3月10日将24颗卫星全部部署完毕。10多年的军用、民用导航定位实践证明，GPS卫星导航定位系统能在全球98%以上的范围内同时向多个用户提供全天候、高精度的导航定位服务。[0003]在日常生活中，大部分的GPS定位应用都是采用相对定位。由于相对定位忽略了复杂的误差因素,所以定位方程解算起来比较快速，在定位精度要求不是很高的日常生活中，这种定位方式无疑即节约了时间，又保证了定位精度。但是采用相对定位方式进行定位时，必须把一台放在已知点上的接收机作为基准接收机,这无疑增加了定位的成本，而且还使操作变的复杂。另外由于影响定位精度的误差(如对流层延迟误差)等这些误差会随着接收机和卫星的距离的增加而逐渐的变得不相关,所以必须通过延迟接收机的观测时间来使定位的精度达到预期的精度。这些缺点大大限制了GPS相对定位的使用范围。对于这个问题，1997年美国喷气推进实验室(JPL)的zumbeger等人提出了一种有效的解决方案,即非差精密单点定位方法。[0004]传统的GPS单点定位需要已知接收机观测到的伪距值、利用导航电文提供的卫星轨道参数计算出的卫星坐标以及卫星时钟的改正数,才能进行定位。传统的GPS单点定位的优点是采集和处理数据比较简单,用户只需用一台GPS接收机就能获得其在WGS--84坐标系中的三维坐标。但是由于受到接收机观测到的伪距的精度、利用卫星导航电文求得的卫星位置的精度以及卫星时钟的精度的影响,传统的GPS单点定位精度不是很高，所以