本发明属于定位导航的技术领域;具体涉及一种基于城市多路径误差抑制的相对定位方法。
背景技术:
全球定位系统(globalpositionsystem,gps)能够自主地为用户提供地理空间定位信息,其应用范围遍布交通导航、大地测绘、灾难救援等各个领域。gps接收机定位中产生伪距和载波相位两个距离测量值,其中均包含着各种误差,包括卫星时钟误差、星历误差、电离层和对流层误差、多路径误差等。随着人们对实现高精度定位的需求日益增加,导航定位中的干扰抑制成为研究热点。随着智能交通系统的发展,车辆导航应用对定位精度的要求越来越高,由于道路两旁高楼建筑物的遮挡,多路径效应已成为影响gps高精度定位的主要误差源。多路径效应是指卫星信号在传播过程中经过障碍物发生反射或衍射现象,导致载波相位测量误差和伪距测量误差,降低系统的定位精度和可靠性。
目前针对多路径误差,国内外学者提出了不同的抑制方法,如:基于接收天线设计的多路径误差抑制技术,通过改进接收机内部相关器与鉴相器的多路径误差抑制技术,基于数据处理的多路径误差抑制技术。其中基于数据处理的多路径误差抑制方法因符合软件接收机的发展趋势成为近年来研究的热点。
技术实现要素:
本发明提出了一种基于城市多路径误差抑制的相对定位方法,针对在城市环境中车辆导航易受到多路径信号干扰的问题,通过数据处理估计多路径参数,进而抑制多路径误差,实现城市环境下的车辆高精度相对定位。
本发明通过以下技术方案实现:
一种基于城市多路径误差抑制的相对定位方法,所述相对定位方法包括以下步骤:
步骤1:建立gps伪距观测方程,对观测量进行双差处理后,得到接收机间相对位置信息;
步骤2:采用最小二乘方法对gps原始数据进行解算,根据伪距观测方程,输出gps导航位置估计值;
步骤3:建立多路径干扰下的车辆导航定位的状态方程和量测方程,对双差处理后的导航数据进行稀疏算法处理,解算出多路径误差;
步骤4:根据步骤3解算出的多路径误差,校正伪距和多普勒频移观测值,利用卡尔曼滤波方法输出校正后的相对位置信息;
进一步的,所述步骤1具体为,接收机的伪距观测方程式如下:
ρi=ri+δ+εi+ζi
其中,ρi为接收机与第i颗卫星之间的伪距测量值,ri为接收机与第i颗卫星之间的几何距离,δ为接收机噪声,εi为卫星噪声,ζi为多路径误差;
两台接收机在同一时刻对两颗卫星的距离测量值定义为:
其中,
根据以上四个伪距观测方程,接收机a和b在同一时刻对卫星i和j的伪距双差测量值可表达为:
式中,
其中,
进一步的,所述步骤2包括以下步骤,
步骤2.1:根据gps原始数据中的星历信息,获得卫星的位置;
步骤2.2:应用最小二乘法,对gps原始数据进行定位解算,将伪距作为观测量,计算gps接收机位置估计值;
利用最小二乘法公式y=d·δx解得两台接收机间相对距离为,
δx=(dtd)-1dty
其中,
进一步的,所述步骤3包括以下步骤,
步骤3.1:建立多路径干扰下的车辆导航定位的状态方程和量测方程;状态方程为:
其中,状态变量为
系统矩阵φ定义如下:
其中,τ为两个观测时刻间的时长,i3为3×3的单位矩阵;
系统量测方程为:z=hx+ζ
其中,
步骤3.2:利用稀疏性,建立多路径误差估计模型,
式中,w为权重矩阵,λ为调和参数,argmin表示使目标函数取最小值时的变量值,即当
利用最小二乘解,x=(hth)-1ht(z-ζ),能进一步得到多路径误差估计模型为:
其中,
步骤3.3:选取权重矩阵w与调和参数λ,
w为权重矩阵,定义如下:
w(cni,ei)=w2(ei)/w1(cni)
其中,cn为卫星实时载噪比,e为卫星高度角,f、t、a为关于权重函数值大小的中间参数;
调和参数λ基于bic准则进行选择,bic准则表达如下:
其中,
步骤3.4:解算出β,进而估计出多路径误差ζ=w-1β。
进一步的,所述步骤4包括以下步骤:
步骤4.1:根据状态方程和量测方程,给定初始状态估计
步骤4.2:根据步骤4.1的给定值,采用卡尔曼滤波进行导航信息数据融合,
一步预测:
状态估计协方差:
增益矩阵:
滤波估计值:
滤波估计方差:pk=(i-kkhk)pk/k-1
根据以上公式得到相对位置信息。
本发明的有益效果是:
本发明利用稀疏理论估计多路径误差,对gps输出数据加以校正,然后应用卡尔曼滤波进行数据处理,得到最终的相对位置信息,提高城市环境下的车辆相对位置精度。
附图说明
附图1本发明的总体实现流程图。
附图2本发明中包含的稀疏算法流程图。
附图3本发明实施例2验证示意图。
具体实施方式
下面将结合本发明实施例中的附图对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
实施例1
一种基于城市多路径误差抑制的相对定位方法,所述相对定位方法包括以下步骤:
步骤1:建立gps伪距观测方程,对观测量进行双差处理后,得到接收机间相对位置信息;
接收机的伪距观测方程式如下:
ρi=ri+δ+εi+ζi
其中,ρi为接收机与第i颗卫星之间的伪距测量值,ri为接收机与第i颗卫星之间的几何距离,δ为接收机噪声,εi为卫星噪声,ζi为多路径误差。
两台接收机在同一时刻对两颗卫星的距离测量值定义为:
其中,
根据以上四个伪距观测方程,接收机a和b在同一时刻对卫星i和j的伪距双差测量值可表达为:
式中,
其中,
步骤2:采用最小二乘方法对gps原始数据进行解算,根据伪距观测方程,输出gps导航位置估计值;
步骤2.1:根据gps原始数据中的星历信息,获得卫星的位置;
步骤2.2:应用最小二乘法,对gps原始数据进行定位解算,将伪距作为观测量,计算gps接收机位置估计值;
利用最小二乘法公式y=d·δx解得两台接收机间相对距离为,
δx=(dtd)-1dty
其中,
步骤3:建立多路径干扰下的车辆导航定位的状态方程和量测方程,对双差处理后的导航数据进行稀疏算法处理,解算出多路径误差,提高gps导航信息的准确性;如图2稀疏算法流程图所示,
步骤3.1:建立多路径干扰下的车辆导航定位的状态方程和量测方程。
状态方程为:
其中,状态变量为
系统矩阵φ定义如下:
其中,τ为两个观测时刻间的时长,i3为3×3的单位矩阵。
系统量测方程为:z=hx+ζ
其中,
步骤3.2:利用稀疏性,建立多路径误差估计模型,
式中,w为权重矩阵,λ为调和参数,argmin表示使目标函数取最小值时的变量值,即当
利用最小二乘解,x=(hth)-1ht(z-ζ),可以进一步得到多路径误差估计模型为:
其中,
步骤3.3:选取权重矩阵w与调和参数λ,
w为权重矩阵,定义如下:
w(cni,ei)=w2(ei)/w1(cni)
其中,cn为卫星实时载噪比,e为卫星高度角,f、t、a为关于权重函数值大小的中间参数;
调和参数λ基于bic准则进行选择,bic准则表达如下:
其中,
步骤3.4:解算出β,进而估计出多路径误差ζ=w-1β。
步骤4:根据步骤3解算出的多路径误差,校正伪距和多普勒频移观测值,利用卡尔曼滤波方法输出校正后的相对位置信息;
步骤4.1:根据状态方程和量测方程,给定初始状态估计
步骤4.2:根据步骤4.1的给定值,采用卡尔曼滤波进行导航信息数据融合,
一步预测:
状态估计协方差:
增益矩阵:
滤波估计值:
滤波估计方差:pk=(i-kkhk)pk/k-1
其中,kk为滤波增益矩阵;
根据以上公式得到相对位置信息。
实施例2
在城市楼间环境中进行静态和动态实验验证。
首先考虑两个gps接收机之间为静态的场景,基线长度约为20米,观测时间在15min左右,然后给出一个移动节点和一个静止节点组成的动态实验。利用采集到的数据,比较了采用绝对位置差分定位、伪距双差定位和基于多路径抑制的相对定位算法估计的相对距离。
图3所示,提出的算法能有效减轻多路径误差,提高相对定位精度。
绝对位置差分定位:d(t)=||pa(t)-pb(t)||,pa(t)、pb(t)分别为接收机a和b的位置。
伪距双差定位:融合两台接收机的gps观测值,由步骤2估计出相对位置(包含有多路径误差)。
多路径抑制定位:在伪距双差定位基础上,对多路径误差进行抑制,进而提高相对定位精度。