一种基于卡尔曼滤波的GPS单点定位系统技术方案

技术编号:14551303 阅读:69 留言:0更新日期:2017-02-05 00:25
一种基于卡尔曼滤波的GPS单点定位系统,首先建立GPS定位的卡尔曼滤波模型和方程式,之后进行卡尔曼滤波递推计算;在每一个定位历元过程中,卡尔曼滤波器首先利用状态方程来对接收机当前的位置、速度、GPS接收机时钟差来进行预测;然后,依据这一状态先验估计值和卫星星历所提供的卫星位置和速度,卡尔曼滤波器就能够预测GPS接收机对各颗卫星的伪距和多普勒频移值,这些测量预测值和接收机的实际测量值之差又形成了测量残余;最后,卡尔曼滤波器通过对测量残余进行处理就能够得到系统状态估计值的校正量以及校正以后的最优估计值。本发明专利技术主要研究了GPS单点定位的方法以及卡尔曼滤波技术,以有效提高定位的估计精度。

A GPS single point positioning system based on Calman filter

A Calman filter GPS single point positioning system based on Calman filter model and the equation established GPS positioning, after Calman filter recursive calculation; in each epoch positioning process, Calman filter firstly using the state equations of position, velocity and current receiver GPS receiver clock error to predict; then on the basis of this, state a priori estimate and the satellite ephemeris provided by the satellite position and velocity, the Calman filter can predict the GPS receiver to the satellite pseudorange and Doppler frequency shift value, the predictive value and the receiver measured actual measured value difference and the formation of measuring residual; finally, based on Calman filter the measurement of the residual processing can obtain the correction value of system state estimation and optimal estimation value after correction. The invention mainly studies the method of GPS single point positioning and Calman filtering technology, so as to effectively improve the estimation precision of positioning.

【技术实现步骤摘要】

本专利技术涉及的是一种卫星定位方法,特别涉及的是一种基于卡尔曼滤波的GPS单点定位系统
技术介绍
全球定位系统(简称GPS)是美国国防部于1973年开始建立的卫星导航定位系统。这个系统当初建立的主要目的是为了给海陆空运载工具提供导航和定位服务。经过20年的不断发展,耗费了数百亿美元,于1994年3月10日将24颗卫星全部部署完毕。10多年的军用、民用导航定位实践证明,GPS卫星导航定位系统能在全球98%以上的范围内同时向多个用户提供全天候、高精度的导航定位服务。在日常生活中,大部分的GPS定位应用都是采用相对定位。由于相对定位忽略了复杂的误差因素,所以定位方程解算起来比较快速,在定位精度要求不是很高的日常生活中,这种定位方式无疑即节约了时间,又保证了定位精度。但是采用相对定位方式进行定位时,必须把一台放在已知点上的接收机作为基准接收机,这无疑增加了定位的成本,而且还使操作变的复杂。另外由于影响定位精度的误差(如对流层延迟误差)等这些误差会随着接收机和卫星的距离的增加而逐渐的变得不相关,所以必须通过延迟接收机的观测时间来使定位的精度达到预期的精度。这些缺点大大限制了GPS相对定位的使用范围。对于这个问题,1997年美国喷气推进实验室(JPL)的zumbeger等人提出了一种有效的解决方案,即非差精密单点定位方法。传统的GPS单点定位需要已知接收机观测到的伪距值、利用导航电文提供的卫星轨道参数计算出的卫星坐标以及卫星时钟的改正数,才能进行定位。传统的GPS单点定位的优点是采集和处理数据比较简单,用户只需用一台GPS接收机就能获得其在WGS--84坐标系中的三维坐标。但是由于受到接收机观测到的伪距的精度、利用卫星导航电文求得的卫星位置的精度以及卫星时钟的精度的影响,传统的GPS单点定位精度不是很高,所以传统的GPS单点定位只能用于一些低精度的领域中。
技术实现思路
本专利技术以得到定位的最佳估计为目的,主要研究GPS单点定位的方法以及卡尔曼滤波技术,以有效提高定位的估计精度。本专利技术的目的是这样实现的:首先建立GPS定位的卡尔曼滤波模型和方程式,之后进行卡尔曼滤波递推计算。在每一个定位历元过程中,卡尔曼滤波器首先利用状态方程来对接收机当前的位置、速度、GPS接收机时钟差来进行预测;然后,依据这一状态先验估计值和卫星星历所提供的卫星位置和速度,卡尔曼滤波器就能够预测GPS接收机对各颗卫星的伪距和多普勒频移值,这些测量预测值和接收机的实际测量值之差又形成了测量残余;最后,卡尔曼滤波器通过对测量残余进行处理就能够得到系统状态估计值的校正量以及校正以后的最优估计值。在利用卡尔曼滤波进行测速、定位时需要建立合理、准确的运动模型,不准确的载体运动模型将会导致滤波在计算过程中产生发散现象。常速模型和常加速模型是卡尔曼滤波常用的两种运动模型,其中常速模型是最理想化、最简单的一种运动模型。在本专利技术中采用常速模型,根据误差观测方程,自主推导出卡尔曼滤波的基本模型如下:卡尔曼滤波模型可以概括为:状态方程:=+(1)观测方程:=HX+(2)式中:(0,),(0,)为系统噪声和观测噪声=(3)=(4)状态方程中的状态转移矩阵为=(5)干扰矩阵为=(6)T为数据采样间隔;系数矩阵为=(7)在上式中:=,=,=;=。附图说明图1为GPS定位的卡尔曼滤波算法流程。具体实施方式下面结合附图举例对本专利技术做更详细地描述:结合图1,图1为GPS定位的卡尔曼滤波算法流程。首先建立GPS定位的卡尔曼滤波模型和方程式,之后进行卡尔曼滤波递推计算。在每一个定位历元过程中,卡尔曼滤波器首先利用状态方程来对接收机当前的位置、速度、GPS接收机时钟差来进行预测;然后,依据这一状态先验估计值和卫星星历所提供的卫星位置和速度,卡尔曼滤波器就能够预测GPS接收机对各颗卫星的伪距和多普勒频移值,这些测量预测值和接收机的实际测量值之差又形成了测量残余;最后,卡尔曼滤波器通过对测量残余进行处理就能够得到系统状态估计值的校正量以及校正以后的最优估计值。单点定位的卡尔曼滤波模型一般为常速模型,通过采用上述模型来进行滤波处理时可以获得比较高的定位精度。用户的三维位置和速度是当然得状态变量。由于GPS系统是利用用户时钟来测定电波到达时间,而用户时钟一般为石英钟,精度和稳定性都不高,因而用户时钟的钟差和频差也将作为状态变量。忽略相位模糊度,将接收机天线的速度、三维坐标、接收机钟差和频漂作为状态向量。卡尔曼滤波的状态向量为:=(8)标准卡尔曼滤波要求系统的观测模型和状态方程是线性的,而GPS单点定位中的观测方程是非线性的,所以要对观测方程进行线性化的处理。常用的线性化的方法是把滤波的一步预测值作为近似值,对观测方程在一步预测值处进行泰勒展开,对观测方程进行线性化处理,这种方法称为扩展的卡尔曼滤波。观测误差方程为=-+c(9)在k点的概略坐标(,,)(由观测文件中读取)处,将=+,=+,=+带入上式中,进行泰勒展开,忽略二阶以上的高次项,即可得出伪距定位的线性方程=++++c(10)式中:=,=,=;(,,)为接收机k到卫星j的观测向量的方向余弦;=;为接收机k到卫星j的距离的近似值。把线性化后的误差方程写成矩阵形式=HX+。本文档来自技高网
...

【技术保护点】
一种基于卡尔曼滤波的GPS单点定位系统,其特征在于:首先建立GPS定位的卡尔曼滤波模型和方程式,之后进行卡尔曼滤波递推计算;在每一个定位历元过程中,卡尔曼滤波器首先利用状态方程来对接收机当前的位置、速度、GPS接收机时钟差来进行预测;然后,依据这一状态先验估计值和卫星星历所提供的卫星位置和速度,卡尔曼滤波器就能够预测GPS接收机对各颗卫星的伪距和多普勒频移值,这些测量预测值和接收机的实际测量值之差又形成了测量残余;最后,卡尔曼滤波器通过对测量残余进行处理就能够得到系统状态估计值的校正量以及校正以后的最优估计值。

【技术特征摘要】
1.一种基于卡尔曼滤波的GPS单点定位系统,其特征在于:首先建立GPS定位的卡尔曼
滤波模型和方程式,之后进行卡尔曼滤波递推计算;在每一个定位历元过程中,卡尔曼滤波
器首先利用状态方程来对接收机当前的位置、速度、GPS接收机时钟差来进行预测;然后,依
据这一状态先验估计值和卫星星历所提供的卫星位置和速度,卡尔曼滤波器就能够预测
GPS接收机对各颗卫星的伪距和多普勒频移值,这些测量预测值和接收机的实际测量值之
差又形成了测量残余;最后,卡尔曼滤波器通过对测量残余进行处理就能够得到系统状态
估计值的校正量以及校正以后的最优估计值。
2.根据权利要求1所述的一种基于卡尔曼滤波的GPS单点定位系统,其特征在于:在利
用卡尔曼滤波进行...

【专利技术属性】
技术研发人员:王树鑫
申请(专利权)人:哈尔滨米米米业科技有限公司
类型:发明
国别省市:黑龙江;23

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1