CN115932923A - 一种基于v2v的共享gnss车辆增强协作定位方法 - Google Patents
一种基于v2v的共享gnss车辆增强协作定位方法 Download PDFInfo
- Publication number
- CN115932923A CN115932923A CN202211710699.1A CN202211710699A CN115932923A CN 115932923 A CN115932923 A CN 115932923A CN 202211710699 A CN202211710699 A CN 202211710699A CN 115932923 A CN115932923 A CN 115932923A
- Authority
- CN
- China
- Prior art keywords
- observation
- vehicle
- ambiguity
- gnss
- double
- 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.)
- Pending
Links
Images
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于V2V的共享GNSS车辆增强协作定位方法,车辆搭载的GNSS接收机接收卫星的原始观测值,利用车载通讯设备向周围的车辆传送自身的GNSS观测值,同时接收来自周围车辆的GNSS观测值,实现车辆间的GNSS信息交互。通过建立车间双差模型,消除卫星钟差、接收机钟差、电离层延迟、对流层延迟等误差,通过固定车间双差整周模糊度得到各车辆间的V2V相对位置速度,车辆间共享接收机单点定位结果和求得的V2V相对位置速度,经协作定位算法得到较单点定位更准确的绝对位置。
Description
技术领域
本发明涉及定位技术领域,具体涉及一种基于V2V的共享GNSS车辆增强协作定位方法。
背景技术
随着车辆导航、自动驾驶等技术的发展,高精度高可靠性定位已成为智能汽车的核心关键技术。目前车辆定位主要采用卫星导航技术、惯性导航技术及基于视觉的导航技术等。其中GNSS(Global navigation satellite system,全球卫星导航***)应用广泛,其可以为全球用户提供全天候、全天时、高精度的定位服务。随着我国北斗三号***的建成及在全球范围内提供高精度服务,以北斗卫星导航***为代表的GNSS***会在车辆定位领域发挥越来越重要的作用。
基于GNSS的车辆绝对位置可以根据SPP(Single Point Positioning,单点定位)或RTK(Real-time Kinematic,实时动态载波相位差分定位技术)定位获得。单点定位获得的位置精度一般在3到10米,仅能提供车辆的概略位置。采用RTK技术可以获取车辆的实时厘米级定位结果,但是RTK基准站的建设成本高,每个基准站仅能覆盖有限的区域,需建立基准站与移动站之间稳定的通讯链路,实施过程中易发生因通讯中断而得不到有效定位位置的现象,且RTK技术需要用户向基准站发送自身位置,可能涉及隐私泄露等问题。
随着无线通信技术的不断进步,V2X(vehicle-to-everything,车与外界的信息交换***)迅速发展。V2X主要包括V2N(车辆与网络)、V2V(车辆与车辆)、V2I(车辆与道路基础设施)和V2P(车辆与行人)。其中V2V(Vehicle-to-Vehicle,车与车间)通信技术不受限于固定式基站,可为移动中的车辆提供端到端的无线通信。通过V2V通信技术,车辆终端彼此直接交换信息,无需通过基站转发。
采用V2V通信技术可以实现车辆间GNSS信息的共享,利用车辆间的GNSS原始观测值作差分可以消除电离层误差、对流层误差、卫星时钟误差、接收机时钟等误差,这种协作定位方式可以获得厘米级的V2V相对位置,且不用建设基站,但是其无法得到车辆准确的绝对位置。
发明内容
本发明针对现有技术的上述缺点,提出了一种基于V2V的共享GNSS车辆增强协作定位方法,车辆搭载的GNSS接收机接收卫星的原始观测值,利用车载通讯设备向周围的车辆传送自身的GNSS观测值,同时接收来自周围车辆的GNSS观测值,实现车辆间的GNSS信息交互。通过建立车间双差模型,消除卫星钟差、接收机钟差、电离层延迟、对流层延迟等误差,通过固定车间双差整周模糊度得到各车辆间的V2V相对位置速度,车辆间共享接收机单点定位结果和求得的V2V相对位置速度,经协作定位算法得到较单点定位更准确的绝对位置。
本发明提出的一种基于V2V的共享GNSS车辆增强协作定位方法,包括以下步骤:
步骤S1:各车辆利用车载GNSS接收机接收GNSS原始观测数据;
步骤S2:各车辆利用搭载的通讯设备向周围的车辆传送自身的GNSS观测值,同时接收来自周围车辆的GNSS观测值;
步骤S3:针对某一台车辆,当其接收到来自周围车辆GNSS观测值时,通过建立车间双差模型消除误差,得到V2V双差观测值;
步骤S4:在当前历元,基于V2V双差观测模型,应用扩展Kalman滤波得到相对位置和速度的浮点解,通过固定双差整周模糊度得到固定解,即该历元下V2V相对位置和速度。求得所有车辆之间的V2V相对位置和速度并在车间共享;
步骤S5:各车辆利用伪距等原始观测数据对自身做单点定位(SPP),同时利用粗差检测剔除计算过程中残差较大的的卫星,得到粗略的绝对位置、速度和几何精度因子GDOP,GDOP值可以反映单点定位的不确定性。各车辆间共享单点定位结果及GDOP;
步骤S6:开始第一轮定位,按照GDOP从高到低排序,首先选择位置不确定性最大,即GDOP值最大的车辆节点作为优先定位的用户节点,其余节点作为用户节点的参考节点。利用用户节点和各参考节点间的V2V相对位置和速度作为约束,结合参考节点自身的GNSS原始观测信息滤波求解得到用户节点更准确的绝对位置和速度。按GDOP从高到低的排序,其余节点依次作为用户节点,更新各节点的位置速度并共享;
步骤S7:第一轮定位后,所有节点的位置和速度估计作为下一轮迭代的初值,更新所有车辆节点的位置和速度。每完成一轮迭代之后,所有节点的位置估计精度都将有所提高,故每轮迭代结束后将各节点的位置和速度误差协方差适当降低,以逐渐减少对自身GNSS观测数据信任程度,而更加相信参考节点的信息。经若干次迭代,即可有效提高各车辆的定位精度,得到较单点定位更准确的位置和速度。
进一步的,所述步骤S1中,GNSS原始观测数据为伪距观测值、载波相位观测值、多普勒观测值以及卫星星历,融合观测方程可表示如下:
其中,r表示接收机,s表示卫星,为伪距观测值,为以米为单位的载波相位观测值,为多普勒观测值,为卫星s到接收机r的真实几何距离,c为光速,δtr为接收机钟差,δts为卫星钟差,为电离层延迟误差,为对流层延迟误差,εP、εΦ、εD为伪距、载波相位、多普勒的观测噪声,λ为载波波长,为载波相位整周模糊度。
进一步的,所述步骤S2中,作为优选,各车辆的通讯装置采用基于5G的车联网技术5G-V2X。
进一步的,所述步骤S3中,参与运算的原始GNSS观测值一般只有载波相位和伪距,而该两种观测量均是对距离的一阶观测量,对于速度变化的估计误差将上升到原观测误差的倍。当运动载体变速特征显著,将带来较大的模型误差,造成估计精度降低。针对这一问题,本发明将多普勒观测量用于载波相位的定位解算。V2V双差观测值包括双差伪距观测值、双差载波相位观测值、双差多普勒观测值,公式如下:
其中,i,j表示两相邻车辆上的接收机,p,q表示两颗不同的卫星,▽Δ为双差符号,分别为双差伪距观测值、双差载波相位观测值、双差多普勒观测值,表示卫星p,q在两台接收机i,j间的双差几何距离,为双差载波相位整周模糊度,分别表示双差伪距观测值噪声、双差载波相位观测值噪声和双差多普勒观测值噪声。
进一步的,所述步骤S4中,设两相邻车辆上的接收机i,j的共视卫星为m颗,卫星1为参考星,Kalman滤波状态参数分别为V2V相对位置、V2V相对速度以及双差模糊度,记为其偏导矩阵记为H,Kalman量测向量记为可得Kalman滤波观测方程w为量测噪声且服从高斯分布w~N(0,R),R为量测噪声w的协方差矩阵。利用扩展Kalman滤波(EKF)可以解算得到模糊度参数和其他参数的浮点解X及其对应的协方差矩阵Q,其中表示n个双差模糊度参数的浮点解,表示基线向量坐标增量的浮点解。
进一步的,所述步骤S4中,针对全模糊度固定算法难以固定所有模糊度的问题,本发明在LAMBDA算法基础上采用基于模糊度固定成功概率的子集选取方法的部分模糊度算法,降低模糊度维数,减小模糊度搜索的空间,提高模糊度固定率和定位可靠性。将原空间的浮点模糊度和方差作为输入,利用LAMBDA算法中的降相关过程将原始空间的模糊度及其方差转换为新空间内的模糊度矢量和对应的协方差矩阵:式中ZT为降相关矩阵。计算模糊度固定成功率,公式如下:
其中,k为向量中满足上式的最大模糊度个数,σi|I表示为模糊度搜索时第i次搜索的条件方差的均方根,由对角矩阵D(D为的Cholesky分解因子)得到,预设一个成功率阈值P0,依次选择最小方差的模糊度参数,计算相应的累积成功率P,直到大于成功阈值P0或者所有的模糊度参数都满足要求。根据此步骤从降相关后的向量中挑选符合要求的n-i+1个模糊度的子集,利用LAMBDA算法中的搜索过程固定该n-i+1个模糊度参数。根据前i个模糊度参数与后n-i+1个模糊度参数之间的相关性,即利用对应的协方差阵调整前i个参数,得到模糊度的固定解通过获得最后的坐标固定解,式中为基线固定解,即得到该历元下车辆i,j的V2V相对位置和速度ΔrijΔvij,其误差为
进一步的,所述步骤S5中,车辆在城市峡谷等恶劣观测条件下行驶时受遮挡和多径效影响导致观测值噪声大,若直接使用会对定位结果产生影响,本发明针对此问题对伪距进行粗差探测,在单点定位中采用卡方检验的方法探测并剔除残差较大的卫星。在卡方检验中,每颗卫星的观测残差统计量可表示为:χ2=Vz Τ(HkPk/k-1Hk Τ+Rk)Vz。
其中,Vz表示当前历元的某颗卫星的残差,Hk为滤波的设计矩阵,Pk/k-1为待估参数的协方差矩阵,Rk为观测噪声矩阵。在α=0.01/n置信区间内(n表示当前历元的可用卫星数),依次对每颗卫星进行卡方检验,如果其中某颗卫星的χ2超过设定的阈值,则将其标记成粗差并剔除。
进一步的,所述步骤S5中,原始单点定位求解的基本思想是利用单台接收机的伪距和伪距率作为观测,采用Kalman滤波估计接收接收机的位置和速度,对接收机i,状态向量为:其中,ri vi为接收机i的位置和速度,δti 为接收机i的钟差和钟漂。其***运动方程为其中,为状态转移矩阵,其中I3表示3×3单位矩阵,Δt表示时间间隔,数字下标1,3表示行数和列数,Wk-1为***噪声。量测为各车辆的伪距观测量和伪距率观测量(伪距率可以由多普勒观测量求得,即:
其中sp=[rp vp]为卫星p的位置、速度,可通过卫星星历求得,hP为伪距量测函数:hP(xi,sp)=||rp-ri||+δti,为伪距率量测函数:εP和为伪距和伪距率的量测噪声。上式用Zk=h(Xk)+Vk表示, 为量测噪声。已知***运动方程和量测方程,利用EKF即可求得接收机位置速度。EKF公式如下:
其中Pk/k-1为k-1时刻到k时刻的一步预测误差协方差矩阵,Pk为k时刻估计误差协方差矩阵,Kk为Kalman增益,Qk-1表示***过程噪声,Rk为量测噪声Vk的协方差矩阵。最终求得单点定位接收机的位置和速度为其噪声为
进一步的,所述步骤S6中,改进后利用V2V相对位置和速度作为约束结合用户节点自身GNSS观测数据做滤波解算,设共有n个车辆节点。求解用户节点u的位置和速度,状态向量的选取为:***的运动学方程为Xu,k=Fk/k-1Xu,k-1+Wk-1,其中Fk/k-1为状态转移矩阵,Wk-1为***噪声。量测为卫星伪距、伪距率和V2V相对位置及速度,即:
进一步的,所述步骤S4、S5和S6中,标准EKF滤波假设观测噪声服从0均值高斯分布,然而GNSS测量不可避免地会受到周跳或粗差的影响,尤其是在遮挡严重等复杂的环境中,这与上述假设相违背。为抵抗异常测量的影响,本发明构建鲁棒EKF滤波模型,引入鲁棒因子
其中其中Zk,i表示k时刻第i个观测量,表示观测函数,k0和k1的优选取值为1和3。通过鲁棒因子区分量测信息的可信度,将量测信息分为三个等级,根据鲁棒因子调整观测误差协方差矩阵R:建立鲁棒EKF滤波,其中Rij表示调整前R矩阵第i行j列的元素。
进一步的,所述步骤S7中,作为优选,迭代次数设置为n次,第x(x<n)轮迭代结束后将参考节点的位置误差协方差调整为初始协方差的1/x。
本发明的优点在于,利用V2V通信技术共享车辆GNSS信息,应用协作定位的思想,在不依赖于固定基准站和移动网络服务商的前提下提升了车辆的绝对定位精度,为偏远地区等难以架设基站的地区提供了仅使用GNSS信息就能获得较单点定位更高精度的定位方法。同时,该技术不仅局限于车辆协作定位,同样可以拓展至船舶编队、无人机编队等需要高精度位置信息的应用场景。
附图说明
图1为本发明基于V2V的共享GNSS车辆增强协作定位方法的流程图;
图2为车辆间共享GNSS观测数据并求得V2V相对位置速度的示意图;
图3为各车辆单点定位得到粗略定位结果的示意图;
图4为车辆协作定位示意图;
图5为本发明单台车辆内部***图及信息交互示意图;
图6为本发明的***图及多车信息交互示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明提出了一种基于V2V的共享GNSS车辆增强协作定位方法,车辆搭载的GNSS接收机接收卫星的原始观测值,利用车载通讯设备向周围的车辆传送自身的GNSS观测值,同时接收来自周围车辆的GNSS观测值,实现车辆间的GNSS信息交互。通过建立车间双差模型,消除卫星钟差、接收机钟差、电离层延迟、对流层延迟等误差,通过固定车间双差整周模糊度得到各车辆间的V2V相对位置速度,车辆间共享接收机单点定位结果和求得的V2V相对位置速度,经协作定位算法得到较单点定位更准确的绝对位置。
实施例1
步骤S1:各车辆利用车载GNSS接收机接收GNSS原始观测数据;
步骤S2:各车辆利用搭载的通讯设备向周围的车辆传送自身的GNSS观测值,同时接收来自周围车辆的GNSS观测值;
步骤S3:针对某一台车辆,当其接收到来自周围车辆GNSS观测值时,通过建立车间双差模型消除误差,得到V2V双差观测值;
步骤S4:在当前历元,基于V2V双差观测模型,应用扩展Kalman滤波得到相对位置和速度的浮点解,通过固定双差整周模糊度得到固定解,即该历元下V2V相对位置和速度。求得所有车辆之间的V2V相对位置和速度并在车间共享;
步骤S5:各车辆利用伪距等原始观测数据对自身做单点定位(SPP),同时利用粗差检测剔除计算过程中残差较大的的卫星,得到粗略的绝对位置、速度和几何精度因子GDOP,该值可以反映单点定位的不确定性。各车辆间共享单点定位结果及GDOP;
步骤S6:开始第一轮定位,按照GDOP从高到低排序,首先选择位置不确定性最大,即GDOP值最大的车辆节点作为优先定位的用户节点,其余节点作为用户节点的参考节点。利用用户节点和各参考节点间的V2V相对位置和速度作为约束,结合参考节点自身的GNSS原始观测信息滤波求解得到用户节点更准确的绝对位置和速度。按GDOP从高到低的排序,其余节点依次作为用户节点,更新各节点的位置速度并共享;
步骤S7:第一轮定位后,所有节点的位置和速度估计作为下一轮迭代的初值,更新所有车辆节点的位置和速度。每完成一轮迭代之后,所有节点的位置估计精度都将有所提高,故每轮迭代结束后将各节点的位置和速度误差协方差适当降低,以逐渐减少对自身GNSS观测数据信任程度,而更加相信参考节点的信息。经若干次迭代,即可有效提高各车辆的定位精度,得到较单点定位更准确的位置和速度。
步骤S1中,GNSS原始观测数据为伪距观测值、载波相位观测值、多普勒观测值以及卫星星历,融合观测方程可表示如下:
其中,r表示接收机,s表示卫星,为伪距观测值,为以米为单位的载波相位观测值,为多普勒观测值,为卫星s到接收机r的真实几何距离,c为光速,δtr为接收机钟差,δts为卫星钟差,为电离层延迟误差,为对流层延迟误差,εP、εΦ、εD为伪距、载波相位、多普勒的观测噪声,λ为载波波长,为载波相位整周模糊度。
步骤S2中,各车辆的通讯装置采用基于5G的车联网技术5G-V2X。
步骤S3中,参与运算的原始GNSS观测值一般只有载波相位和伪距,而该两种观测量均是对距离的一阶观测量,对于速度变化的估计误差将上升到原观测误差的倍。当运动载体变速特征显著,将带来较大的模型误差,造成估计精度降低。针对这一问题,本发明将多普勒观测量用于载波相位的定位解算。V2V双差观测值包括双差伪距观测值、双差载波相位观测值、双差多普勒观测值,公式如下:
其中,i,j表示两相邻车辆上的接收机,p,q表示两颗不同的卫星,为双差符号,分别为双差伪距观测值、双差载波相位观测值、双差多普勒观测值,表示卫星p,q在两台接收机i,j间的双差几何距离,为双差载波相位整周模糊度,分别表示双差伪距观测值噪声、双差载波相位观测值噪声和双差多普勒观测值噪声。
步骤S4中,设两相邻车辆上的接收机i,j的共视卫星为m颗,卫星1为参考星,Kalman滤波状态参数分别为V2V相对位置、V2V相对速度以及双差模糊度,记为其偏导矩阵记为H,Kalman量测向量记为可得Kalman滤波观测方程w为量测噪声且服从高斯分布w~N(0,R),R为量测噪声w的协方差矩阵。利用扩展Kalman滤波(EKF)可以解算得到模糊度参数和其他参数的浮点解X及其对应的协方差矩阵Q,其中表示n个双差模糊度参数的浮点解,表示基线向量坐标增量的浮点解。
步骤S4中,针对全模糊度固定算法难以固定所有模糊度的问题,本发明在LAMBDA算法基础上采用基于模糊度固定成功概率的子集选取方法的部分模糊度算法,降低模糊度维数,减小模糊度搜索的空间,提高模糊度固定率和定位可靠性。将原空间的浮点模糊度和方差作为输入,利用LAMBDA算法中的降相关过程将原始空间的模糊度及其方差转换为新空间内的模糊度矢量和对应的协方差矩阵:式中ZT为降相关矩阵。计算模糊度固定成功率,公式如下:
其中k为向量中满足上式的最大模糊度个数,σi|I表示为模糊度搜索时第i次搜索的条件方差的均方根,由对角矩阵D(D为的Cholesky分解因子)得到,预设一个成功率阈值P0,依次选择最小方差的模糊度参数,计算相应的累积成功率P,直到大于成功阈值P0或者所有的模糊度参数都满足要求。根据此步骤从降相关后的向量中挑选符合要求的n-i+1个模糊度的子集,利用LAMBDA算法中的搜索过程固定该n-i+1个模糊度参数。根据前i个模糊度参数与后n-i+1个模糊度参数之间的相关性,即利用对应的协方差阵调整前i个参数,得到模糊度的固定解通过获得最后的坐标固定解,式中为基线固定解,即得到该历元下车辆i,j的V2V相对位置和速度ΔrijΔvij,其误差为
步骤S5中,车辆在城市峡谷等恶劣观测条件下行驶时受遮挡和多径效影响导致观测值噪声大,若直接使用会对定位结果产生影响,本发明针对此问题对伪距进行粗差探测,在单点定位中采用卡方检验的方法探测并剔除残差较大的卫星。在卡方检验中,每颗卫星的观测残差统计量可表示为:χ2=Vz Τ(HkPk/k-1Hk Τ+Rk)Vz。
其中:Vz表示当前历元的某颗卫星的残差,Hk为滤波的设计矩阵,Qk/k-1为待估参数的协方差矩阵,Rk为观测噪声矩阵。在α=0.01/n置信区间内(n表示当前历元的可用卫星数),依次对每颗卫星进行卡方检验,如果其中某颗卫星的χ2超过设定的阈值,则将其标记成粗差并剔除。
步骤S5中,原始单点定位求解的基本思想是利用单台接收机的伪距和伪距率作为观测,采用Kalman滤波估计接收接收机的位置和速度,对接收机i,状态向量为:其中,ri vi为接收机i的位置和速度,δti 为接收机i的钟差和钟漂。其***运动方程为其中为状态转移矩阵,其中I3表示3×3单位矩阵,Δt表示时间间隔,数字下标1,3表示行数和列数,Wk-1为***噪声。量测为各车辆的伪距观测量和伪距率观测量(伪距率可以由多普勒观测量求得,即:
其中sp=[rp vp]为卫星p的位置、速度,可通过卫星星历求得,hP为伪距量测函数:hP(xi,sp)=||rp-ri||+δti,为伪距率量测函数:εP和为伪距和伪距率的量测噪声。上式用Zk=h(Xk)+Vk表示, 为量测噪声。已知***运动方程和量测方程,利用EKF即可求得接收机位置速度。EKF公式如下:
其中Pk/k-1为k-1时刻到k时刻的一步预测误差协方差矩阵,Pk为k时刻估计误差协方差矩阵,Kk为Kalman增益,Qk-1表示***过程噪声,Rk为量测噪声Vk的协方差矩阵。最终求得单点定位接收机的位置和速度为其噪声为
步骤S6中,改进后利用V2V相对位置和速度作为约束结合用户节点自身GNSS观测数据做滤波解算,设共有n个车辆节点。求解用户节点u的位置和速度,状态向量的选取为:***的运动学方程为Xu,k=Fk/k-1Xu,k-1+Wk-1,其中Fk/k-1为状态转移矩阵,Wk-1为***噪声。量测为卫星伪距、伪距率和V2V相对位置及速度,即:
步骤S4、S5和S6中,标准EKF滤波假设观测噪声服从0均值高斯分布,然而GNSS测量不可避免地会受到周跳或粗差的影响,尤其是在遮挡严重等复杂的环境中,这与上述假设相违背。为抵抗异常测量的影响,本发明构建鲁棒EKF滤波模型,引入鲁棒因子
步骤S7中,迭代次数设置为n次,第x(x<n)轮迭代结束后将参考节点的位置误差协方差调整为初始协方差的1/x。
实施例2
图2、3、4出示了一个采用本发明基于V2V的共享GNSS车辆增强协作定位方法的四车编队示意图。
如图2所示,首先四台车辆利用携带的GNSS接收机接收来自卫星的GNSS观测值,利用5G-V2X设备,在四台车辆间共享各车辆GNSS接收机接收到的原始观测数据。以车辆1与车辆2为例,每两台车间通过共享的GNSS观测组成双差观测模型,通过滤波和模糊度固定求得两车间的相对位置速度,得到四台车辆间的V2V相对位置和速度。
如图3所示,以车辆1为例,四台车辆根据自身GNSS接收机的伪距等观测数据做单点定位,求得各车辆单点定位得到的粗略位置和速度以及几何精度因子GDOP值。
利用5G-V2X设备共享上述步骤中得到的车间V2V相对位置速度及四台车单点定位得到的粗略位置速度以及GDOP值。
如图4所示,开始第一轮协作定位:按GDOP值降序排序,将四台车编号为节点1,节点2,节点3,节点4。首先选择节点1作为用户节点,其余三台车辆作为参考节点。除利用用户节点自身的伪距等GNSS观测值外,将参考节点单点定位位置和与用户节点间的相对位置作为约束辅助用户节点做滤波定位。节点1定位完成后,更新其自身位置,接着节点2作为用户节点,其余车辆作为参考节点,对节点2进行定位。以此类推直到节点4定位完成。
第一轮定位完成后,各节点的位置精度理论上有所提升,因此开始第二轮定位前将各节点位置误差的协方差调整为初始位置协方差的1/2,再分别按顺序将节点1234作为用户节点做滤波定位。以此类推,第x轮定位开始前将各节点位置误差协方差变为初始位置协方差的1/x,共进行10轮定位迭代,最终得到四车协作定位的最终结果。
实施例3
图5、6出示了一种基本发明一种基于V2V的共享GNSS车辆协作定位方法的***,该***主要包括:若干GNSS接收机,若干5G-V2X模块,若干V2V定位模块、单点定位模块和协作定位模块。
如图5所示,GNSS接收机用于接收卫星伪距,载波相位,多普勒观测等GNSS原始观测数据并将数据提供给5G-V2X模块、V2V定位模块,单点定位模块和协作定位模块;5G-V2X模块用于车间V2V通信,共享各车辆GNSS原始观测数据,车辆单点解定位结果及GDOP,以及协作定位过程中车辆的实时定位结果;V2V定位模块利用来自GNSS接收机和5G-V2X模块的数据计算本车辆与其他车辆间的相对位置速度;单点定位模块利用来自GNSS接收机的数据计算车辆单点定位结果和GDOP;协作定位模块利用来自GNSS接收机、V2V定位模块和5G-V2X模块的数据计算车辆协作定位位置及速度。
如图6所示,为本发明的***图和车间数据交互示意图,其中V2V定位模块、单点定位模块和协作定位模块结合统称为数据处理模块。各车辆通过5G-V2X模块与其他所有车辆交换GNSS原始观测数据信息、单点定位信息、及协作定位过程信息,最终实现各车辆协作定位。
Claims (10)
1.一种基于V2V的共享GNSS车辆增强协作定位方法,其特征在于,包括以下步骤:
步骤S1:各车辆利用车载GNSS接收机接收GNSS原始观测数据;
步骤S2:各车辆利用搭载的通讯设备向周围的车辆传送自身的GNSS观测值,同时接收来自周围车辆的GNSS观测值;
步骤S3:针对某一台车辆,当其接收到来自周围车辆GNSS观测值时,通过建立V2V双差观测模型消除误差,得到V2V双差观测值;
步骤S4:在当前历元,基于V2V双差观测模型,应用扩展Kalman滤波得到相对位置和速度的浮点解;通过固定双差整周模糊度得到固定解,即该历元下V2V相对位置和速度,求得所有车辆之间的V2V相对位置和速度并在车间共享;
步骤S5:各车辆利用原始观测数据对自身做单点定位SPP,同时利用粗差检测剔除计算过程中残差较大的的卫星,得到粗略的绝对位置、速度和几何精度因子GDOP,GDOP值反映单点定位的不确定性,各车辆间共享单点定位结果及GDOP;
步骤S6:开始第一轮定位,按照GDOP从高到低排序,首先选择位置不确定性最大,即GDOP值最大的车辆节点作为优先定位的用户节点,其余节点作为用户节点的参考节点;利用用户节点和各参考节点间的V2V相对位置和速度作为约束,结合参考节点自身的GNSS原始观测信息滤波求解得到用户节点更准确的绝对位置和速度;按GDOP从高到低的排序,其余节点依次作为用户节点,更新各节点的位置速度并共享;
步骤S7:第一轮定位后,所有节点的位置和速度估计作为下一轮迭代的初值,更新所有车辆节点的位置和速度;每完成一轮迭代之后,所有节点的位置估计精度都将有所提高,故每轮迭代结束后将各节点的位置和速度误差协方差适当降低,以逐渐减少对自身GNSS观测数据信任程度,而更加相信参考节点的信息;经若干次迭代,即可有效提高各车辆的定位精度,得到较单点定位更准确的位置和速度。
3.根据权利要求1所述的一种基于V2V的共享GNSS车辆增强协作定位方法,其特征在于,所述步骤S2中,各车辆的通讯装置采用基于5G的车联网技术5G-V2X;所述步骤S7中,迭代次数设置为n次,第x,x<n轮迭代结束后将参考节点的位置误差协方差调整为初始协方差的1/x。
4.根据权利要求1所述的一种基于V2V的共享GNSS车辆增强协作定位方法,其特征在于,所述步骤S3中,参与运算的原始GNSS观测值有载波相位和伪距,而这两种观测量均是对距离的一阶观测量,对于速度变化的估计误差将上升到原观测误差的倍;当运动载体变速特征显著,将带来较大的模型误差,造成估计精度降低;针对这一问题,将多普勒观测量用于载波相位的定位解算,建立V2V双差观测模型,V2V双差观测值包括双差伪距观测值、双差载波相位观测值、双差多普勒观测值,公式如下:
6.根据权利要求1所述的一种基于V2V的共享GNSS车辆增强协作定位方法,其特征在于,所述步骤S4中,针对全模糊度固定算法难以固定所有模糊度的问题,在LAMBDA算法基础上采用基于模糊度固定成功概率的子集选取方法的部分模糊度算法,降低模糊度维数,减小模糊度搜索的空间,提高模糊度固定率和定位可靠性;将原空间的浮点模糊度和方差作为输入,利用LAMBDA算法中的降相关过程将原始空间的模糊度及其方差转换为新空间内的模糊度矢量和对应的协方差矩阵:式中ZT为降相关矩阵,计算模糊度固定成功率,公式如下:
其中,k为向量中满足上式的最大模糊度个数,σi|I表示为模糊度搜索时第i次搜索的条件方差的均方根,由对角矩阵D,D为的Cholesky分解因子,得到,预设一个成功率阈值P0,依次选择最小方差的模糊度参数,计算相应的累积成功率P,直到大于成功阈值P0或者所有的模糊度参数都满足要求;根据此步骤从降相关后的向量中挑选符合要求的n-i+1个模糊度的子集,利用LAMBDA算法中的搜索过程固定该n-i+1个模糊度参数;根据前i个模糊度参数与后n-i+1个模糊度参数之间的相关性,即利用对应的协方差阵调整前i个参数,得到模糊度的固定解通过获得最后的坐标固定解,式中为基线固定解,即得到该历元下车辆i,j的V2V相对位置和速度ΔrijΔvij,其误差为
7.根据权利要求1所述的一种基于V2V的共享GNSS车辆增强协作定位方法,其特征在于,所述步骤S5中,车辆在城市峡谷等恶劣观测条件下行驶时受遮挡和多径效影响导致观测值噪声大,若直接使用会对定位结果产生影响,针对此问题对伪距进行粗差检测,在单点定位中采用卡方检验的方法检测并剔除残差较大的卫星;在卡方检验中,每颗卫星的观测残差统计量可表示为:χ2=Vz Τ(HkPk/k-1Hk Τ+Rk)Vz
其中,Vz表示当前历元的某颗卫星的残差,Hk为滤波的设计矩阵,Pk/k-1为待估参数的协方差矩阵,Rk为观测噪声矩阵;在α=0.01/n置信区间内,n表示当前历元的可用卫星数,依次对每颗卫星进行卡方检验,如果其中某颗卫星的χ2超过设定的阈值,则将其标记成粗差并剔除。
8.根据权利要求1所述的一种基于V2V的共享GNSS车辆增强协作定位方法,其特征在于,所述步骤S5中,单点定位求解的基本思想是利用单台接收机的伪距和伪距率作为观测,采用Kalman滤波估计接收接收机的位置和速度,对接收机i,状态向量为:其中,rivi为接收机i的位置和速度,δti 为接收机i的钟差和钟漂;其***运动方程为其中,为状态转移矩阵,其中I3表示3×3单位矩阵,Δt表示时间间隔,数字下标1,3表示行数和列数;Wk-1为***噪声;量测为各车辆的伪距观测量和伪距率观测量,伪距率由多普勒观测量求得,即:
其中sp=[rpvp]为卫星p的位置、速度,可通过卫星星历求得,hP为伪距量测函数:hP(xi,sp)=rp-ri+δti,为伪距率量测函数:εP和为伪距和伪距率的量测噪声;上式用Zk=h(Xk)+Vk表示,为量测噪声;已知***运动方程和量测方程,利用EKF即可求得接收机位置速度,EKF公式如下:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211710699.1A CN115932923A (zh) | 2022-12-29 | 2022-12-29 | 一种基于v2v的共享gnss车辆增强协作定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211710699.1A CN115932923A (zh) | 2022-12-29 | 2022-12-29 | 一种基于v2v的共享gnss车辆增强协作定位方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115932923A true CN115932923A (zh) | 2023-04-07 |
Family
ID=86555930
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211710699.1A Pending CN115932923A (zh) | 2022-12-29 | 2022-12-29 | 一种基于v2v的共享gnss车辆增强协作定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115932923A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116299623A (zh) * | 2023-05-12 | 2023-06-23 | 武汉大学 | 一种城市复杂场景下的ppp和ins紧组合方法与*** |
CN116819585A (zh) * | 2023-08-31 | 2023-09-29 | 长沙金维信息技术有限公司 | 基于非线性优化的gnss单点定位方法及导航方法 |
CN117991308A (zh) * | 2024-04-03 | 2024-05-07 | 长江三峡集团实业发展(北京)有限公司 | 一种面向复杂环境gnss数据质量的高精度数据处理方法 |
-
2022
- 2022-12-29 CN CN202211710699.1A patent/CN115932923A/zh active Pending
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116299623A (zh) * | 2023-05-12 | 2023-06-23 | 武汉大学 | 一种城市复杂场景下的ppp和ins紧组合方法与*** |
CN116819585A (zh) * | 2023-08-31 | 2023-09-29 | 长沙金维信息技术有限公司 | 基于非线性优化的gnss单点定位方法及导航方法 |
CN116819585B (zh) * | 2023-08-31 | 2023-12-29 | 长沙金维信息技术有限公司 | 基于非线性优化的gnss单点定位方法及导航方法 |
CN117991308A (zh) * | 2024-04-03 | 2024-05-07 | 长江三峡集团实业发展(北京)有限公司 | 一种面向复杂环境gnss数据质量的高精度数据处理方法 |
CN117991308B (zh) * | 2024-04-03 | 2024-06-07 | 长江三峡集团实业发展(北京)有限公司 | 一种面向复杂环境gnss数据质量的高精度数据处理方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1902505B (zh) | 组合使用本地rtk***与区域性、广域或全球载波相位定位***的方法 | |
Hedgecock et al. | High-accuracy differential tracking of low-cost GPS receivers | |
CN115932923A (zh) | 一种基于v2v的共享gnss车辆增强协作定位方法 | |
RU2446416C2 (ru) | Способ повышения надежности информации о местоположении при переходе от региональной, широкомасштабной или глобальной дифференциальной навигации по фазе несущей (wadgps) к локальной кинематической в реальном времени (rtk) навигационной системе | |
CN107710017A (zh) | 用于在实时运动模式和相对定位模式之间切换的卫星导航接收器及方法 | |
CN103744096B (zh) | 一种多信息融合的定位方法和装置 | |
EP1336864B1 (en) | Method and system for GPS position determination from calculated time | |
CN101156080B (zh) | 一种基于gps导航卫星***发射信号主要用于地形运动、大型设施以及民用建筑工程监控和测量的***和方法 | |
CN101371159A (zh) | 组合使用本地定位***、本地rtk***与区域、广域或全球载波相位定位***的方法 | |
JP4798168B2 (ja) | 相対位置検知装置、及び相対位置検知システム | |
US20070057839A1 (en) | Carrier phase gps positioning device and method | |
CN101743453A (zh) | 任务后高精确度定位和定向*** | |
JP2010503836A (ja) | 統合型移動端末ナビゲーション | |
CN114562992B (zh) | 一种基于因子图及场景约束的多径环境组合导航方法 | |
Zhang et al. | A novel GNSS based V2V cooperative localization to exclude multipath effect using consistency checks | |
JP2010071686A (ja) | 測位装置、コンピュータプログラム及び測位方法 | |
CN110749907A (zh) | 一种基于北斗动定位中接收机的钟差补偿方法及其*** | |
Gogoi et al. | On the cooperative ranging between android smartphones sharing raw GNSS measurements | |
JP2009025233A (ja) | 搬送波位相式測位装置 | |
CN116009042A (zh) | 一种单站载波历元间差分实时探测相对形变的方法及*** | |
Tolman et al. | Absolute precise kinematic positioning with GPS and GLONASS | |
Hu et al. | Performance evaluation of stereo vision aided loosely coupled GNSS/SINS integration for land vehicle navigation in different urban environments | |
Zheng et al. | 5G-aided RTK positioning in GNSS-deprived environments | |
EP4314900A1 (en) | Cooperative state tracking of multiple vehicles using individual and joint estimations | |
CN108205151B (zh) | 一种低成本gps单天线姿态测量方法 |
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 |