CN109946730A - 一种车路协同下基于超宽带的车辆高可靠融合定位方法 - Google Patents
一种车路协同下基于超宽带的车辆高可靠融合定位方法 Download PDFInfo
- Publication number
- CN109946730A CN109946730A CN201910168341.2A CN201910168341A CN109946730A CN 109946730 A CN109946730 A CN 109946730A CN 201910168341 A CN201910168341 A CN 201910168341A CN 109946730 A CN109946730 A CN 109946730A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- uwb
- observation
- gnss
- positioning
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Landscapes
- Navigation (AREA)
Abstract
本发明公开了一种车路协同场景下的车辆高可靠融合定位方法,针对城市环境下,车载卫星导航易使用受限,定位准确性及可靠性不高等问题,在传统的车载卫星与惯性组合导航的基础上,引入了超宽带(Ultra‑Wideband,UWB)定位技术,通过合理布局UWB节点,结合非视距(Not Line of Sight,NLOS)误差处理算法,减小UWB观测值误差,在此基础之上,基于扩展卡尔曼滤波算法实现了车辆的融合定位。相比于传统的车载卫星与惯性组合导航,本发明中的方法,在城市环境,尤其是卫星信号受严重遮挡的复杂环境(如城市峡谷、交叉路口等)下,可靠性更高,有助于实现车辆的连续、完整、可靠、实时定位。
Description
技术领域
本发明涉及车辆导航定位领域,特别涉及一种面向城市车路协同环境下的车辆高可靠融合定位方法。
背景技术
随着经济社会的发展与进步,我国的机动车保有量快速增加,道路交通面临着巨大的挑战,为了解决日益严峻的城市交通问题,智能车路协同系统(Intelligent VehicleInfrastructure Cooperative Systems,IVICS)应运而生,并逐步成为智能交通系统(Intelligent Transport Systems,ITS)研究的最新发展方向。无论是车路协同的应用,还是智能交通的实现,都离不开高精度车辆定位技术:只有在实现准确、可靠车辆定位的前提下,全方位实施车车、车路动态实时信息交互,并在全时空动态交通信息采集与融合的基础上开展车辆主动安全控制和道路协同管理,充分实现人车路的有效协同,才能够有效地指挥调度车辆,改善城市交通,保证车辆安全行驶。因此,车辆定位技术是车路协同乃至智能交通等研究的基础与核心内容之一。
目前常见的车辆导航定位技术包括:航位推算(Dead Reckoning,DR),惯性导航系统(Inertial Navigation System,INS),卫星导航(Global Navigation SatelliteSystem,GNSS)等。由于单一定位技术的存在各自不足,为了实现城市环境下的准确、可靠、连续、完整定位,多采用两种及两种以上的定位技术相结合,其中GNSS/INS融合定位的应用最为广泛:GNSS/INS融合定位可以解决卫星信号短时中断情况下的定位问题,并在一定程度上补偿INS的累积误差,能够满足相对开阔环境下的车辆定位需求,但在卫星信号长时间中断环境(如城市峡谷、隧道等)中,若GNSS无法正常工作,仅依靠INS自主推算,依然会导致较大的定位误差。
近年来,基于超宽带(Ultra-Wideband,UWB)的无线定位技术的兴起和迅速发展为实现车辆在GNSS受限环境下的可靠定位提供了新思路,目前,UWB定位技术主要被用于室内定位领域如人员、智能小车、机器人定位等。由于UWB的带宽极宽,脉冲信号穿透力强,多径分辨能力良好等技术优点,基于UWB实现室外环境下的车辆定位亦具备了一定的可行性,在传感器层,若引入相对可靠的UWB信息源,则能够有效提高融合定位系统的鲁棒性,但在复杂城市环境下,UWB信号易受周围行驶的车辆、道路两旁的树木以及建筑物的干扰而出现多路径以及非视距误差,若将信号质量较差的UWB观测量用于融合定位,势必导致融合精度的下降,因此,如何针对相对复杂的交通场景(如十字交叉路口、环岛路口等),结合道路交通设施,合理布局路侧UWB节点,在车路协同下实现人车路信息动态交互,进而选取合适的方法,辨识与补偿非视距误差,提高用于融合的UWB观测信息的可靠性,是实现基于UWB的车辆融合定位亟待解决的关键问题。
发明内容
技术问题:针对城市环境下,车载卫星导航易使用受限,定位准确性及可靠性不高等问题,在传统的车载卫星与惯性组合导航的基础上,引入了超宽带(Ultra-Wideband,UWB)定位技术,通过合理布局UWB节点,结合非视距误差处理算法,减小UWB观测值误差,并在此基础之上,基于扩展卡尔曼滤波算法实现了车辆的融合定位。
技术方案:为实现上述目的,本发明采用如下技术方案:首先,在道路两旁布置UWB固定节点,并通过高精度差分GNSS获取UWB固定节点的位置坐标;其次,在车辆顶部布置一个UWB移动节点,采用到达时间差法,获得该UWB移动节点到各个UWB固定节点的距离;然后,根据当前时刻之前的历史距离观测值建立ARIMA模型,利用ARIMA模型逐一对各个UWB固定节点进行NLOS辨识;最终,根据修正后的UWB距离观测值,基于扩展卡尔曼滤波实现车辆的融合定位获取车辆的精确位置。
下面结合附图,对本发明的思路作进一步的说明:
本发明的流程如图1所示。
一种车路协同下基于超宽带的车辆高可靠融合定位方法,其特征在于,在典型城市车路协同场景下,在车载卫星与惯性组合导航的基础上,引入超宽带(Ultra-Wideband,UWB)定位,通过合理布局UWB节点,结合非视距(Not Line of Sight,NLOS)误差处理算法,减小UWB观测值误差,在此基础之上,基于扩展卡尔曼滤波算法实现车辆高可靠融合定位,所述方法包括如下步骤:
步骤1)确定UWB布局方案,在道路两旁布置UWB固定节点,并测量UWB固定节点的位置坐标;
其中UWB固定节点的数目与安装位置要针对实际的交通场景,综合考虑成本与定位精度需求,确定合理的布局方案,请参考图2中,本发明为典型城市交叉路口区域提出的一种布局方案:在十字交叉路口的四个不同方向的道路两旁以及交叉路口环岛区域的中心,总共布设了九个UWB固定节点,这种布局方式,能够最大限度的覆盖整个交叉路口,实现车辆在路口区域的完整定位,并且在环岛中心布置的UWB节点,不易受遮挡干扰,有助于定位精度的提高;
步骤2)在车辆质心正上方的车顶上布置一个UWB移动节点,移动节点会跟随车辆移动,因此,移动节点的坐标即认为是车辆的坐标,UWB移动节点将周期性的发送并接收各个固定节点返回的信号,根据信号发送与返回的时间信息,采用到达时间差法(TimeDifference of Arrival,TDOA)计算出车载UWB移动节点到各个UWB固定节点间的距离;
若UWB节点间无遮挡,即视距(Line of sight,LOS)传播,则计算出的距离观测值近似于真实值,但在如图3中所示的动态交通场景下,UWB节点间的直线传播易受周围行驶的车辆,道路两旁的树木以及建筑物等遮挡,信号传播路径出现反射、衍射等现象,即非视距传播(Not Line of Sight,NLOS),则距离观测值含有较大的误差,若引入定位解算,会严重影响定位精度;
步骤3)根据当前时刻之前的历史距离观测值建立差分整合移动平均自回归模型(Autoregressive Integrated Moving Average model,ARIMA),利用ARIMA模型逐一对各个UWB固定节点进行NLOS辨识,并根据辨识结果对距离观测值进行补偿校正,具体过程如下:
31)检验由初始时刻到当前时刻的距离观测值组成的时间序列的平稳性,若为非平稳的时间序列,则对序列进行差分处理,差分处理的阶数为d,使之转化为平稳时间序列;
32)平稳化处理后,根据平稳时间序列的自相关函数和偏相关函数,确定ARIMA模型的阶数,ARIMA模型的阶数分别为p和q;
33)采用条件最小二乘法,估计ARIMA模型中的自回归部分以及滑动平均部分的参数;
34)对已建立的ARIMA(p,d,q)模型的残差序列进行单位根检验,判断其是否为白噪声序列,若通过检验,则可进行预测,否则,需重新进行模型参数估计直至通过检验为止;
35)利用通过检验的ARIMA模型对当前时刻UWB移动节点与UWB固定节点间的距离进行预测,得到当前时刻的距离预测值当前时刻的距离观测值为d(t),预测值与观测值差的绝对值为
36)根据交通场景的复杂程度以及定位精度的需求设置NLOS辨识的阈值θthr,若则判定UWB移动节点与UWB固定节点之间为NLOS传播,其距离观测值d(t)存在较大的非视距误差,并根据ARIMA模型的预测值,修正移动节点与UWB固定节点间的距离观测值;
步骤4)结合车载GNSS、陀螺仪以及轮速传感器输出的观测信息,利用扩展卡尔曼滤波算法实现车辆的精确定位,具体步骤如下:
41)首先,建立车辆定位系统的扩展卡尔曼滤波状态模型
系统状态向量为
其中,为车辆纬度信息,λ为车辆经度信息,h为车辆高度信息;ve为车辆的东向速度,vn为车辆的北向速度,vu为车辆的垂向速度;p为车辆的俯仰角,r为车辆的侧倾角,A为车辆的航向角;sfod为轮速精度因子误差,bω为陀螺仪随机漂移,bGNSS为GNSS接收机钟差,dGNSS为GNSS接收机钟差漂移率,bUWB为UWB的偏移误差;
系统外部输入向量为U=[vod aod fx fy ωz]
其中,vod为轮速传感器测得的车辆速度,aod为车辆纵向加速度,fx为车辆纵向加速度测量值,fy为车辆横向加速度测量值,ωz为陀螺仪输出的横摆角速度;
系统状态方程为:
其中,X(k)为离散时刻k的系统状态向量,X(k-1),U(k-1),W(k-1),T(k-1)分别为离散时刻(k-1)的系统状态向量、外部输入向量、系统噪声向量,外部输入噪声向量;RM为地球子午线半径,RN为地球卯酉圈半径,Δt为采样间隔;γw为轮速传感器与时间相关的误差,σw为其对应的噪声方差;βz为陀螺仪随机漂移,σz为其对应的噪声方差;
42)然后,建立车辆定位系统的扩展卡尔曼滤波观测模型
系统观测向量为
其中,分别为m个GNSS卫星的伪距观测量,为n个UWB固定节点的经步骤3)修正后的距离观测值;
系统观测方程为:
Z(k)=H(k)·X(k)+V(k)
其中,Z(k),H(k)为离散时刻k的系统观测向量以及系统观测矩阵,V(k)为离散时刻k的观测噪声向量;
观测噪声向量V(k)对应的观测噪声方差阵为R(k):
R(k)=diag[RGNSS RUWB]
其中,RGNSS为GNSS的观测噪声方差阵,RUWB为UWB的观测噪声方差阵;
43)根据步骤41)所述的系统状态模型,步骤42)所述的观测模型,进行扩展卡尔曼滤波的时间更新和测量更新过程,得到车辆的精确的位置信息。
本发明的有益效果为:
1.本发明中利用ARIMA模型对UWB非视距节点进行辨识及误差补偿,可以有效减小动态环境下由非视距或多路径导致的UWB观测误差对系统融合精度的影响,有助于提高融合定位的准确性与可靠性。
2.本发明中的方法,解决了实际交通环境下,将UWB定位技术应用于车辆导航领域,并实现城市车辆的高可靠融合定位问题,相比于传统的车载卫星与惯性组合导航,本发明中的方法,在城市环境,尤其是卫星信号受严重遮挡的复杂环境(如城市峡谷、交叉路口等)下,可靠性更高,有助于实现车辆的连续、完整、可靠、实时定位。
附图说明
图1是本发明的流程图。
图2是典型城市十字交叉路口环境下的UWB节点布局示意图。
图3是动态交通场景下视距与非视距UWB节点示意图。
图4是引入了UWB观测信息前、后的车辆定位轨迹对比图。
图5是引入了UWB观测信息前、后融合定位误差图。
具体实施方式
下面结合附图和实施例对本申请作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅用于解释相关发明,而非对该发明的限定。
随着经济社会的发展与进步,我国的机动车保有量快速增加,道路交通面临着巨大的挑战,为了解决日益严峻的城市交通问题,智能车路协同系统(Intelligent VehicleInfrastructure Cooperative Systems,IVICS)应运而生,并逐步成为智能交通系统(Intelligent Transport Systems,ITS)研究的最新发展方向。无论是车路协同的应用,还是智能交通的实现,都离不开高精度车辆定位技术:只有在实现准确、可靠车辆定位的前提下,全方位实施车车、车路动态实时信息交互,并在全时空动态交通信息采集与融合的基础上开展车辆主动安全控制和道路协同管理,充分实现人车路的有效协同,才能够有效地指挥调度车辆,改善城市交通,保证车辆安全行驶。因此,车辆定位技术是车路协同乃至智能交通等研究的基础与核心内容之一。
目前常见的车辆导航定位技术包括:航位推算(Dead Reckoning,DR),惯性导航系统(Inertial Navigation System,INS),卫星导航(Global Navigation SatelliteSystem,GNSS)等。由于单一定位技术的存在各自不足,为了实现城市环境下的准确、可靠、连续、完整定位,多采用两种及两种以上的定位技术相结合,其中GNSS/INS融合定位的应用最为广泛:GNSS/INS融合定位可以解决卫星信号短时中断情况下的定位问题,并在一定程度上补偿INS的累积误差,能够满足相对开阔环境下的车辆定位需求,但在卫星信号长时间中断环境(如城市峡谷、隧道等)中,若GNSS无法正常工作,仅依靠INS自主推算,依然会导致较大的定位误差。
近年来,基于超宽带(Ultra-Wideband,UWB)的无线定位技术的兴起和迅速发展为实现车辆在GNSS受限环境下的可靠定位提供了新思路,目前,UWB定位技术主要被用于室内定位领域如人员、智能小车、机器人定位等。由于UWB的带宽极宽,脉冲信号穿透力强,多径分辨能力良好等技术优点,基于UWB实现室外环境下的车辆定位亦具备了一定的可行性,在传感器层,若引入相对可靠的UWB信息源,则能够有效提高融合定位系统的鲁棒性,但在复杂城市环境下,UWB信号易受周围行驶的车辆、道路两旁的树木以及建筑物的干扰而出现多路径以及非视距误差,若将信号质量较差的UWB观测量用于融合定位,势必导致融合精度的下降,因此,如何针对相对复杂的交通场景(如十字交叉路口、环岛路口等),结合道路交通设施,合理布局路侧UWB节点,在车路协同下实现人车路信息动态交互,进而选取合适的方法,辨识与补偿非视距误差,提高用于融合的UWB观测信息的可靠性,是实现基于UWB的车辆融合定位亟待解决的关键问题。
针对城市环境下,车载卫星导航易使用受限,定位准确性及可靠性不高等问题,在传统的车载卫星与惯性组合导航的基础上,引入了超宽带(Ultra-Wideband,UWB)定位技术,通过合理布局UWB节点,结合非视距误差处理算法,减小UWB观测值误差,并在此基础之上,基于扩展卡尔曼滤波算法实现了车辆的融合定位。
请参考图1,其示出了根据本发明中的方法实现车辆高可靠融合定位方法的一个实施例的流程:
首先,在道路两旁布置UWB固定节点,并通过高精度差分GNSS获取UWB固定节点的位置坐标;其次,在车辆顶部布置一个UWB移动节点,采用到达时间差法,获得该UWB移动节点到各个UWB固定节点的距离;然后,根据当前时刻之前的历史距离观测值建立ARIMA模型,利用ARIMA模型逐一对各个UWB固定节点进行NLOS辨识;最终,根据修正后的UWB距离观测值,基于扩展卡尔曼滤波实现车辆的融合定位获取车辆的精确位置。
下面结合附图,对本发明的思路作进一步的说明:
一种车路协同下基于超宽带的车辆高可靠融合定位方法,其特征在于,在典型城市车路协同场景下,在车载卫星与惯性组合导航的基础上,引入超宽带(Ultra-Wideband,UWB)定位,通过合理布局UWB节点,结合非视距(Not Line of Sight,NLOS)误差处理算法,减小UWB观测值误差,在此基础之上,基于扩展卡尔曼滤波算法实现车辆高可靠融合定位,所述方法包括如下步骤:
步骤1)确定UWB布局方案,在道路两旁布置UWB固定节点,并测量UWB固定节点的位置坐标;
其中UWB固定节点的数目与安装位置要针对实际的交通场景,综合考虑成本与定位精度需求,确定合理的布局方案,请参考图2中,本发明为典型城市交叉路口区域提出的一种布局方案:在十字交叉路口的四个不同方向的道路两旁以及交叉路口环岛区域的中心,总共布设了九个UWB固定节点,这种布局方式,能够最大限度的覆盖整个交叉路口,实现车辆在路口区域的完整定位,并且在环岛中心布置的UWB节点,不易受遮挡干扰,有助于定位精度的提高;
步骤2)在车辆质心正上方的车顶上布置一个UWB移动节点,移动节点会跟随车辆移动,因此,移动节点的坐标即认为是车辆的坐标,UWB移动节点将周期性的发送并接收各个固定节点返回的信号,根据信号发送与返回的时间信息,采用到达时间差法(TimeDifference of Arrival,TDOA)计算出车载UWB移动节点到各个UWB固定节点间的距离;
若UWB节点间无遮挡,即视距(Line of sight,LOS)传播,则计算出的距离观测值近似于真实值,但在如图3中所示的动态交通场景下,UWB节点间的直线传播易受周围行驶的车辆,道路两旁的树木以及建筑物等遮挡,信号传播路径出现反射、衍射等现象,即非视距传播(Not Line of Sight,NLOS),则距离观测值含有较大的误差,若引入定位解算,会严重影响定位精度;
步骤3)根据当前时刻之前的历史距离观测值建立差分整合移动平均自回归模型(Autoregressive Integrated Moving Average model,ARIMA),ARIMA模型是由Box和Jenkins提出的著名的时间序列分析方法,又称为Box-Jenkins模型,具体模型可参考文献:“Pankratz A.Forecasting with univariate Box-Jenkins models:Concepts and cases[M].John Wiley&Sons,2009.”
本发明中针对NLOS的UWB节点距离观测值存在较大误差的问题,提出了一种基于ARIMA模型的NLOS辨识与补偿方法,利用ARIMA模型逐一对各个UWB固定节点进行NLOS辨识,并根据辨识结果对距离观测值进行补偿校正,具体过程如下:
31)检验由初始时刻到当前时刻的距离观测值组成的时间序列的平稳性,若为非平稳的时间序列,则对序列进行差分处理,差分处理的阶数为d,使之转化为平稳时间序列;
32)平稳化处理后,根据平稳时间序列的自相关函数和偏相关函数,确定ARIMA模型的阶数,ARIMA模型的阶数分别为p和q;
33)采用条件最小二乘法,估计ARIMA模型中的自回归部分以及滑动平均部分的参数;
34)对已建立的ARIMA(p,d,q)模型的残差序列进行单位根检验,判断其是否为白噪声序列,若通过检验,则可进行预测,否则,需重新进行模型参数估计直至通过检验为止;
35)利用通过检验的ARIMA模型对当前时刻UWB移动节点与UWB固定节点间的距离进行预测,得到当前时刻的距离预测值当前时刻的距离观测值为d(t),预测值与观测值差的绝对值为
36)根据交通场景的复杂程度以及定位精度的需求设置NLOS辨识的阈值θthr,若则判定UWB移动节点与UWB固定节点之间为NLOS传播,其距离观测值d(t)存在较大的非视距误差,并根据ARIMA模型的预测值,修正移动节点与UWB固定节点间的距离观测值;
本实施例中,具体采用的是ARIMA(2,1,1)模型,NLOS辨识阈值θthr为0.5米。
步骤4)结合车载GNSS、陀螺仪以及轮速传感器输出的观测信息,利用扩展卡尔曼滤波算法实现车辆的精确定位,具体步骤如下:
41)首先,建立车辆定位系统的扩展卡尔曼滤波状态模型
系统状态向量为
其中,为车辆纬度信息,λ为车辆经度信息,h为车辆高度信息;ve为车辆的东向速度,vn为车辆的北向速度,vu为车辆的垂向速度;p为车辆的俯仰角,r为车辆的侧倾角,A为车辆的航向角;sfod为轮速精度因子误差,bω为陀螺仪随机漂移,bGNSS为GNSS接收机钟差,dGNSS为GNSS接收机钟差漂移率,bUWB为UWB的偏移误差;
系统外部输入向量为U=[vod aod fx fy ωz]
其中,vod为轮速传感器测得的车辆速度,aod为车辆纵向加速度,fx为车辆纵向加速度测量值,fy为车辆横向加速度测量值,ωz为陀螺仪输出的横摆角速度;
系统状态方程为:
其中,X(k)为离散时刻k的系统状态向量,X(k-1),U(k-1),W(k-1),T(k-1)分别为离散时刻(k-1)的系统状态向量、外部输入向量、系统噪声向量,外部输入噪声向量;RM为地球子午线半径,RN为地球卯酉圈半径,Δt为采样间隔;γw为轮速传感器与时间相关的误差,σw为其对应的噪声方差;βz为陀螺仪随机漂移,σz为其对应的噪声方差;
42)然后,建立车辆定位系统的扩展卡尔曼滤波观测模型
系统观测向量为
其中,分别为m个GNSS卫星的伪距观测量,为n个UWB固定节点经步骤3)修正后的距离观测值;
系统观测方程为:
Z(k)=H(k)·X(k)+V(k)
其中,Z(k),H(k)为离散时刻k的系统观测向量以及系统观测矩阵,V(k)为离散时刻k的观测噪声向量;
观测噪声向量V(k)对应的观测噪声方差阵为R(k):
R(k)=diag[RGNSS RUWB]
其中,RGNSS为GNSS的观测噪声方差阵,RUWB为UWB的观测噪声方差阵;
43)根据步骤41)所述的系统状态模型,步骤42)所述的观测模型,进行扩展卡尔曼滤波的时间更新和测量更新过程,得到车辆的精确的位置信息。
在本实施实例中,为了检验提出的算法对车辆定位精度提高的有益效果,开展了实车试验:对本发明中提出的GNSS/INS/UWB融合定位方法与传统的GNSS/INS融合定位方法进行了对比,图4为一组试验结果对比图,图5为两种方法的欧氏距离误差图,表1列出了两种方法的定位误差统计。
表1两种方法的欧氏距离定位误差对比表(单位:米)
由图4、图5及表1的结果可以明显看出,加入了经ARIMA模型处理后的UWB观测信息后,车辆定位的轨迹更加接近于真实值,误差更小,相比于传统的GNSS/INS融合定位方法,本实施例中的提出的GNSS/INS/UWB的融合定位算法精度更高。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (1)
1.一种车路协同下基于超宽带的车辆高可靠融合定位方法,其特征在于,所述方法包括如下步骤:
步骤1)确定UWB布局方案,在道路两旁布置UWB固定节点,并测量UWB固定节点的位置坐标;
步骤2)在车辆顶部布置一个UWB移动节点,采用到达时间差法获得该UWB移动节点到各个UWB固定节点的距离观测值;
步骤3)根据当前时刻之前的历史距离观测值建立差分整合移动平均自回归模型,利用ARIMA模型逐一对各个UWB固定节点进行NLOS辨识,并根据辨识结果对距离观测值进行补偿校正,具体过程如下:
<1>.检验由初始时刻到当前时刻的距离观测值组成的时间序列的平稳性,若为非平稳的时间序列,则对序列进行差分处理,使之转化为平稳时间序列;
<2>.平稳化处理后,根据平稳时间序列的自相关函数和偏相关函数,确定ARIMA模型的阶数;
<3>.采用条件最小二乘法,估计ARIMA模型中的自回归部分以及滑动平均部分的参数;
<4>.对已建立的ARIMA模型的残差序列进行单位根检验,判断其是否为白噪声序列,若通过检验,则可进行预测,否则,需重新进行模型参数估计直至通过检验为止;
<5>.利用通过检验的ARIMA模型对当前时刻UWB移动节点与UWB固定节点间的距离进行预测,得到当前时刻的距离预测值当前时刻的距离观测值为d(t),预测值与观测值差的绝对值为
<6>.根据交通场景的复杂程度以及定位精度的需求设置NLOS辨识的阈值θthr,若则判定UWB移动节点与UWB固定节点之间为NLOS传播,其距离观测值d(t)存在较大的非视距误差,并根据ARIMA模型的预测值,修正移动节点与UWB固定节点间的距离观测值;
步骤4)结合车载GNSS、陀螺仪以及轮速传感器输出的观测信息,利用扩展卡尔曼滤波算法实现车辆的精确定位,具体步骤如下:
41)首先,建立车辆定位系统的扩展卡尔曼滤波状态模型
系统状态向量为
其中,为车辆纬度信息,λ为车辆经度信息,h为车辆高度信息;ve为车辆的东向速度,vn为车辆的北向速度,vu为车辆的垂向速度;p为车辆的俯仰角,r为车辆的侧倾角,A为车辆的航向角;sfod为轮速精度因子误差,bω为陀螺仪随机漂移,bGNSS为GNSS接收机钟差,dGNSS为GNSS接收机钟差漂移率,bUWB为UWB的偏移误差;
系统外部输入向量为U=[vod aod fx fy ωz]
其中,vod为轮速传感器测得的车辆速度,aod为车辆纵向加速度,fx为车辆纵向加速度测量值,fy为车辆横向加速度测量值,ωz为陀螺仪输出的横摆角速度;
系统状态方程为:
其中,X(k)为离散时刻k的系统状态向量,X(k-1),U(k-1),W(k-1),T(k-1) 分别为离散时刻(k-1)的系统状态向量、外部输入向量、系统噪声向量,外部输入噪声向量;RM为地球子午线半径,RN为地球卯酉圈半径,Δt为采样间隔;γw为轮速传感器与时间相关的误差,σw为其对应的噪声方差;βz为陀螺仪随机漂移,σz为其对应的噪声方差;
42)然后,建立车辆定位系统的扩展卡尔曼滤波观测模型
系统观测向量为
其中,分别为m个GNSS卫星的伪距观测量,为n个UWB固定节点的经步骤3)修正后的距离观测值;
系统观测方程为:
Z(k)=H(k)·X(k)+V(k)
其中,Z(k),H(k)为离散时刻k的系统观测向量以及系统观测矩阵,V(k)为离散时刻k的观测噪声向量;
观测噪声向量V(k)对应的观测噪声方差阵为R(k):
R(k)=diag[RGNSS RUWB]
其中,RGNSS为GNSS的观测噪声方差阵,RUWB为UWB的观测噪声方差阵;
43)根据步骤41)所述的系统状态模型,步骤42)所述的观测模型,进行扩展卡尔曼滤波的时间更新和测量更新过程,得到车辆的精确的位置信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910168341.2A CN109946730B (zh) | 2019-03-06 | 2019-03-06 | 一种车路协同下基于超宽带的车辆高可靠融合定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910168341.2A CN109946730B (zh) | 2019-03-06 | 2019-03-06 | 一种车路协同下基于超宽带的车辆高可靠融合定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109946730A true CN109946730A (zh) | 2019-06-28 |
CN109946730B CN109946730B (zh) | 2022-05-13 |
Family
ID=67009114
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910168341.2A Active CN109946730B (zh) | 2019-03-06 | 2019-03-06 | 一种车路协同下基于超宽带的车辆高可靠融合定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109946730B (zh) |
Cited By (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110702118A (zh) * | 2019-10-25 | 2020-01-17 | 桂林电子科技大学 | 一种基于agv的室外定位导航系统及其定位方法 |
CN110839225A (zh) * | 2019-11-14 | 2020-02-25 | 北京星云互联科技有限公司 | 室内定位方法及装置、路侧及车载设备、车路协同系统和计算机可读存储介质 |
CN110879071A (zh) * | 2019-12-06 | 2020-03-13 | 成都云科新能汽车技术有限公司 | 基于车路协同的高精度定位系统及定位方法 |
CN110926460A (zh) * | 2019-10-29 | 2020-03-27 | 广东工业大学 | 一种基于IMU的uwb定位异常值处理方法 |
CN111163419A (zh) * | 2020-02-07 | 2020-05-15 | 北京大学 | 车辆协作动态追踪中基于状态均值的恶意用户检测方法 |
CN111770451A (zh) * | 2020-05-26 | 2020-10-13 | 同济大学 | 一种基于车路协同的道路车辆定位及感知方法和装置 |
CN112068173A (zh) * | 2020-08-09 | 2020-12-11 | 河南工业大学 | 一种基于环路和积数据关联算法的协同导航方法 |
CN112325878A (zh) * | 2020-10-30 | 2021-02-05 | 南京航空航天大学 | 基于ukf与空中无人机节点辅助的地面载体组合导航方法 |
CN112488150A (zh) * | 2020-11-04 | 2021-03-12 | 浙江吉利控股集团有限公司 | 一种基于车路协同的目标修正方法、装置、系统及存储介质 |
CN112833897A (zh) * | 2020-12-24 | 2021-05-25 | 浙江合众新能源汽车有限公司 | 基于车路协同与高精度定位融合的车辆定位方法与装置 |
CN112833876A (zh) * | 2020-12-30 | 2021-05-25 | 西南科技大学 | 一种融合里程计与uwb的多机器人协作定位方法 |
CN113156479A (zh) * | 2021-03-23 | 2021-07-23 | 同济大学 | 一种室外乡村道路场景的组合定位方法 |
CN113763738A (zh) * | 2021-09-14 | 2021-12-07 | 上海智能网联汽车技术中心有限公司 | 车路协同系统路侧感知与车端感知实时匹配的方法及系统 |
CN113840226A (zh) * | 2020-06-23 | 2021-12-24 | 维沃移动通信有限公司 | 信息传输方法、装置及通信设备 |
CN114088091A (zh) * | 2022-01-21 | 2022-02-25 | 北京慧拓无限科技有限公司 | 一种基于多传感器的井工矿位姿融合方法和系统 |
CN114390672A (zh) * | 2021-12-15 | 2022-04-22 | 广州杰赛科技股份有限公司 | 一种车辆智能定位方法、装置、设备及介质 |
CN114527487A (zh) * | 2022-02-24 | 2022-05-24 | 东南大学 | 点云稀疏场景下主动特征辅助的自适应融合定位方法 |
CN114639267A (zh) * | 2022-03-07 | 2022-06-17 | 华设设计集团股份有限公司 | 一种车路协同环境中车辆避撞预警方法 |
CN114928881A (zh) * | 2022-04-18 | 2022-08-19 | 上海大学 | 基于超宽带和视觉智能装置的协同定位系统及定位方法 |
FR3129219A1 (fr) * | 2021-11-18 | 2023-05-19 | Commissariat à l'Energie Atomique et aux Energies Alternatives | Procédé de localisation d'un véhicule |
CN117148406A (zh) * | 2023-10-30 | 2023-12-01 | 山东大学 | 一种室内外无缝弹性融合定位方法、系统、介质及设备 |
CN117553811A (zh) * | 2024-01-08 | 2024-02-13 | 武汉大学 | 基于路侧相机与车载gnss/ins的车路协同定位导航方法及系统 |
CN117804448A (zh) * | 2024-02-23 | 2024-04-02 | 北京理工大学 | 一种自主系统定位方法、装置、计算机设备及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103744096A (zh) * | 2013-12-23 | 2014-04-23 | 北京邮电大学 | 一种多信息融合的定位方法和装置 |
CN106845392A (zh) * | 2017-01-18 | 2017-06-13 | 华中科技大学 | 一种基于众包轨迹的室内转角地标的匹配及识别方法 |
CN107064974A (zh) * | 2017-02-28 | 2017-08-18 | 广东工业大学 | 一种抑制城市峡谷多径卫星信号的定位方法和系统 |
CN107346460A (zh) * | 2017-07-18 | 2017-11-14 | 吉林大学 | 基于智能网联系统下前车运行信息的未来工况预测方法 |
CN108364463A (zh) * | 2018-01-30 | 2018-08-03 | 重庆交通大学 | 一种交通流量的预测方法和系统 |
-
2019
- 2019-03-06 CN CN201910168341.2A patent/CN109946730B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103744096A (zh) * | 2013-12-23 | 2014-04-23 | 北京邮电大学 | 一种多信息融合的定位方法和装置 |
CN106845392A (zh) * | 2017-01-18 | 2017-06-13 | 华中科技大学 | 一种基于众包轨迹的室内转角地标的匹配及识别方法 |
CN107064974A (zh) * | 2017-02-28 | 2017-08-18 | 广东工业大学 | 一种抑制城市峡谷多径卫星信号的定位方法和系统 |
CN107346460A (zh) * | 2017-07-18 | 2017-11-14 | 吉林大学 | 基于智能网联系统下前车运行信息的未来工况预测方法 |
CN108364463A (zh) * | 2018-01-30 | 2018-08-03 | 重庆交通大学 | 一种交通流量的预测方法和系统 |
Cited By (34)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110702118A (zh) * | 2019-10-25 | 2020-01-17 | 桂林电子科技大学 | 一种基于agv的室外定位导航系统及其定位方法 |
WO2021082790A1 (zh) * | 2019-10-29 | 2021-05-06 | 广东工业大学 | 一种基于IMU的uwb定位异常值处理方法 |
CN110926460A (zh) * | 2019-10-29 | 2020-03-27 | 广东工业大学 | 一种基于IMU的uwb定位异常值处理方法 |
CN110839225A (zh) * | 2019-11-14 | 2020-02-25 | 北京星云互联科技有限公司 | 室内定位方法及装置、路侧及车载设备、车路协同系统和计算机可读存储介质 |
CN110879071A (zh) * | 2019-12-06 | 2020-03-13 | 成都云科新能汽车技术有限公司 | 基于车路协同的高精度定位系统及定位方法 |
CN111163419B (zh) * | 2020-02-07 | 2020-11-27 | 北京大学 | 车辆协作动态追踪中基于状态均值的恶意用户检测方法 |
CN111163419A (zh) * | 2020-02-07 | 2020-05-15 | 北京大学 | 车辆协作动态追踪中基于状态均值的恶意用户检测方法 |
CN111770451A (zh) * | 2020-05-26 | 2020-10-13 | 同济大学 | 一种基于车路协同的道路车辆定位及感知方法和装置 |
CN111770451B (zh) * | 2020-05-26 | 2022-02-18 | 同济大学 | 一种基于车路协同的道路车辆定位及感知方法和装置 |
CN113840226A (zh) * | 2020-06-23 | 2021-12-24 | 维沃移动通信有限公司 | 信息传输方法、装置及通信设备 |
CN112068173A (zh) * | 2020-08-09 | 2020-12-11 | 河南工业大学 | 一种基于环路和积数据关联算法的协同导航方法 |
CN112068173B (zh) * | 2020-08-09 | 2024-03-22 | 河南工业大学 | 一种基于环路和积数据关联算法的协同导航方法 |
CN112325878A (zh) * | 2020-10-30 | 2021-02-05 | 南京航空航天大学 | 基于ukf与空中无人机节点辅助的地面载体组合导航方法 |
CN112488150A (zh) * | 2020-11-04 | 2021-03-12 | 浙江吉利控股集团有限公司 | 一种基于车路协同的目标修正方法、装置、系统及存储介质 |
CN112833897A (zh) * | 2020-12-24 | 2021-05-25 | 浙江合众新能源汽车有限公司 | 基于车路协同与高精度定位融合的车辆定位方法与装置 |
CN112833876B (zh) * | 2020-12-30 | 2022-02-11 | 西南科技大学 | 一种融合里程计与uwb的多机器人协作定位方法 |
CN112833876A (zh) * | 2020-12-30 | 2021-05-25 | 西南科技大学 | 一种融合里程计与uwb的多机器人协作定位方法 |
CN113156479A (zh) * | 2021-03-23 | 2021-07-23 | 同济大学 | 一种室外乡村道路场景的组合定位方法 |
CN113763738A (zh) * | 2021-09-14 | 2021-12-07 | 上海智能网联汽车技术中心有限公司 | 车路协同系统路侧感知与车端感知实时匹配的方法及系统 |
CN113763738B (zh) * | 2021-09-14 | 2022-11-11 | 上海智能网联汽车技术中心有限公司 | 车路协同系统路侧感知与车端感知实时匹配的方法及系统 |
FR3129219A1 (fr) * | 2021-11-18 | 2023-05-19 | Commissariat à l'Energie Atomique et aux Energies Alternatives | Procédé de localisation d'un véhicule |
EP4184208A1 (fr) | 2021-11-18 | 2023-05-24 | Commissariat à l'énergie atomique et aux énergies alternatives | Procédé de localisation d'un véhicule |
CN114390672A (zh) * | 2021-12-15 | 2022-04-22 | 广州杰赛科技股份有限公司 | 一种车辆智能定位方法、装置、设备及介质 |
CN114088091A (zh) * | 2022-01-21 | 2022-02-25 | 北京慧拓无限科技有限公司 | 一种基于多传感器的井工矿位姿融合方法和系统 |
CN114527487A (zh) * | 2022-02-24 | 2022-05-24 | 东南大学 | 点云稀疏场景下主动特征辅助的自适应融合定位方法 |
CN114639267A (zh) * | 2022-03-07 | 2022-06-17 | 华设设计集团股份有限公司 | 一种车路协同环境中车辆避撞预警方法 |
CN114928881A (zh) * | 2022-04-18 | 2022-08-19 | 上海大学 | 基于超宽带和视觉智能装置的协同定位系统及定位方法 |
CN114928881B (zh) * | 2022-04-18 | 2024-05-14 | 上海大学 | 基于超宽带和视觉智能装置的协同定位系统及定位方法 |
CN117148406A (zh) * | 2023-10-30 | 2023-12-01 | 山东大学 | 一种室内外无缝弹性融合定位方法、系统、介质及设备 |
CN117148406B (zh) * | 2023-10-30 | 2024-01-30 | 山东大学 | 一种室内外无缝弹性融合定位方法、系统、介质及设备 |
CN117553811A (zh) * | 2024-01-08 | 2024-02-13 | 武汉大学 | 基于路侧相机与车载gnss/ins的车路协同定位导航方法及系统 |
CN117553811B (zh) * | 2024-01-08 | 2024-04-19 | 武汉大学 | 基于路侧相机与车载gnss/ins的车路协同定位导航方法及系统 |
CN117804448A (zh) * | 2024-02-23 | 2024-04-02 | 北京理工大学 | 一种自主系统定位方法、装置、计算机设备及存储介质 |
CN117804448B (zh) * | 2024-02-23 | 2024-04-30 | 北京理工大学 | 一种自主系统定位方法、装置、计算机设备及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN109946730B (zh) | 2022-05-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109946730A (zh) | 一种车路协同下基于超宽带的车辆高可靠融合定位方法 | |
CN109946731A (zh) | 一种基于模糊自适应无迹卡尔曼滤波的车辆高可靠融合定位方法 | |
Jiang et al. | A multi-sensor positioning method-based train localization system for low density line | |
Milanés et al. | Autonomous vehicle based in cooperative GPS and inertial systems | |
CN104076382B (zh) | 一种基于多源信息融合的车辆无缝定位方法 | |
CN101334288B (zh) | 基于标准线路匹配的公交准确定位方法 | |
US11874366B2 (en) | High-precision vehicle positioning method based on ultra-wideband in intelligent vehicle infrastructure cooperative systems | |
CN105792135B (zh) | 一种定位车辆所在车道的方法及装置 | |
CN111123334B (zh) | 一种极限工况下多车协同定位平台及定位方法 | |
JP4090852B2 (ja) | Gps測位による列車走行情報検出装置及びその列車走行情報検出方法 | |
AU2021106247A4 (en) | Vehicle fusion positioning method based on V2X and laser point cloud registration for advanced automatic driving | |
JP2007284013A (ja) | 車両位置測位装置及び車両位置測位方法 | |
CN201600789U (zh) | 基于卫星定位的智能交通防碰撞系统 | |
CN114609657A (zh) | 一种基于信息融合的永磁磁悬浮列车交通定位系统及方法 | |
CN111221020A (zh) | 一种室内外定位方法、装置及系统 | |
CN101408434A (zh) | 移动终端的零位漂移及双模定位和单模定位方法 | |
Jiang et al. | A seamless train positioning system using a LiDAR-aided hybrid integration methodology | |
CN109343096A (zh) | 基于gsm-r通信系统的gnss辅助相对导航方法及系统 | |
CN114216459A (zh) | Elm辅助的gnss/ins组合导航无人靶车定位方法 | |
CN116358515A (zh) | 一种低速无人驾驶系统的建图定位方法与装置 | |
CN114111811A (zh) | 一种自动驾驶公交客车的导航控制系统和方法 | |
CN110345949A (zh) | 一种车辆所在车道的定位方法及其系统 | |
Ke et al. | Integrated positioning method for intelligent vehicle based on GPS and UWB | |
CN113593285A (zh) | 一种智能公交车自动驾驶靠站管理系统 | |
CN113587915A (zh) | 一种高精密度导航配置方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |