一种V2X中基于节点选取的协同定位方法技术

本发明专利技术提出的一种V2X中基于节点选取的协同定位方法，其实施方案如下：首先，协同节点根据定位信息计算自身的定位结果，评估定位精度计算定位不确定度，并播发当前历元的定位状态向量、定位不确定度和观测卫星集合。其次，根据上述步骤收集协同节点位置相关信息，包括协同节点位置、定位不确定度和卫星观测集合，计算目标节点粗位置，并通过目标节点收集到的测距信息确定测距连通性，由此可以计算协同节点提供的定位性能增益，确定协同节点的优劣，并通过贪婪式节点选取策略选取部分协同节点，从而构建最优协同定位系统。最后，根据构建的协同定位系统，收集对应的定位相关信息，融合由车间测距模块获得的车间测距值，并将协同节点的定位不确定度作为先验信息，通过设计的半定规划定位算法解算出最优估计位置。本发明专利技术通过构建了考虑多重因素的节点选取框架，构建了理论性能更优的协同定位系统，并将协同节点的先验信息设计到定位算法中，提升了实际定位性能。提升了实际定位性能。提升了实际定位性能。

【技术实现步骤摘要】
一种V2X中基于节点选取的协同定位方法


[0001]本专利技术设计属于区域卫星导航协同定位领域，具体涉及到一种V2X中基于节点选取的协同定位方法。

技术介绍

[0002]全球卫星导航系统(Global Navigation Satellites Systems,GNSS)是广泛使用提供定位信息的系统。在降级环境中，仅依靠GNSS可能无法满足车辆的定位要求。随着车联网(Vehicle
‑
to
‑
Everything,V2X)技术的发展，车与车(Vehicle
‑
to
‑
Vehicle,V2V)、车与人(Vehicle
‑
to
‑
Pedestrian,V2P)、车与基础设施(Vehicle
‑
to
‑
Infrastructure,V2I)等方面之间可以实现实时信息的共享，这些信息共享的对象可以统称为节点。这些多种类型的节点之间可以通过共享位置、速度等节点状态信息和各种传感器的原始观测信息，实现协同定位。通过利用V2X，实现节点之间的定位相关信息共享，可以显著提升单个节点的定位性能上界，从而提高定位的精度和可靠性。
[0003]融合DGNSS和节点间测距的协同定位算法已经得到了充分的研究。然而，由于V2X支持的海量连接，使得众多类型和众多数量的节点之间都可以共享信息实现协同定位，但不同节点对协同定位提供的增益是不同的。一方面，观测值质量较差或定位精度较低的节点被纳入到目标节点协同定位系统中，可能会导致协同定位性能的降低，因为定位精度差的节点带来的性能降低可能会比通过观测量带来的性能增益更大。另一方面，随着协同定位系统规模逐渐扩大，节点的定位性能上界将趋于收敛，引入一个新的协同节点带来的性能增益将会下降同时在V2X中能获得显著增益的协同节点变得缺乏，而使用V2X中的所有节点组建协同定位系统也并不合理。另外，在定位算法中忽略协同节点的位置误差也会导致定位性能的降低。因此，V2X中组建一个定位性能较优、规模合适的协同定位系统，设计合理的协同定位算法具有重要意义。
[0004]节点选取技术通过选取对目标节点定位性能增益最优的有限个节点，对限制系统规模下提高定位性能具有重要作用。然而目前缺乏对基于DGNSS和节点间测距的协同定位系统中节点选取技术的研究，因此针对该协同定位系统进行分析，提出有效的节点选取方法，并提出充分融合协同节点定位信息的定位算法具有重要意义。

技术实现思路

[0005]本专利技术的目的在于提供一种V2X中基于节点选取的协同定位方法。降级环境下，由于信号遮挡、多径和非视距等干扰，目标节点自身的定位精度受限。得益于V2X的发展，基于DGNSS和节点间测距的协同定位技术为目标节点定位提供了高精度定位解，然而受限于协同系统的规模和有限的通信资源等，选取部分协同节点组合最优定位系统具有重要研究意义。但当前大部分节点选取技术更多的是只对节点的卫星观测条件、节点间测距和节点位置不确定度中的一种或两种进行了考量，这种节点选取技术必然会导致协同定位系统的次优解。另外，现有协同定位方法大多忽视了协同节点的位置误差，将具有较大位置误差的协
同节点纳入协同定位系统将显著导致定位估计性能的降低，所以将协同节点的先验定位信息考虑到定位算法中以约束目标的定位解将对提高目标节点定位性能具有重要意义。因此，如何设计有效的节点选取算法，综合考量节点的卫星观测条件、节点间测距和节点定位不确定度，从而构建最优协同定位系统具有重要意义，同时，如何设计考虑节点定位不确定度的协同定位算法对提升定位性能也有关键作用。
[0006]为了实现上述目的，本专利技术提供了一种V2X中基于节点选取的协同定位方法，本专利技术由协同节点定位解算和定位评估、协同节点定位相关信息播发、协同节点选取及协同定位系统组建和目标节点定位估计组成。本专利技术提出将协同节点的卫星观测、测距条件和定位不确定度纳入到节点选取的综合考量中，并通过等效费歇尔信息矩阵(Equivalent Fisher Information Matrix,EFIM)评估不同协同节点提供的定位性能增益的大小，实现协同节点的优选。提出将协同节点的不确定度融合到基于DGNSS和节点间测距的定位算法中，以对协同节点的位置进行约束从而提高定位性能。
[0007]本专利技术提出的具有节点选取的协同定位方法，其具体实施步骤如下：
[0008]步骤一：协同节点根据定位信息计算自身的定位结果，评估定位精度计算定位不确定度，并播发当前历元的定位状态向量、定位不确定度和观测卫星集合。
[0009]步骤二：收集步骤一协同节点位置相关信息，包括协同节点位置、定位不确定度和观测卫星集合，并由目标节点收集到测距信息判断测距连通性；通过EFIM计算协同节点提供的定位性能增益，确定协同节点的优劣，并通过贪婪式节点选取策略选取部分更优的协同节点，从而构建最优协同定位系统。
[0010]步骤三：根据构建的协同定位系统，收集对应的定位相关信息，融合由车间测距模块获得的车间测距值，并将协同节点的定位不确定性作为先验信息，通过设计的半定规划定位算法解算出最优估计位置。
[0011]其中，在步骤一中所述的“协同节点根据定位信息计算自身的定位结果，评估的定位精度计算定位不确定度，并播发当前历元的定位状态向量、定位不确定度和观测卫星数”，其做法如下：
[0012]S11、通过协同节点i得高精度接收机获取协同节点精确位置以及当前历元的观测卫星集合{NS}
i
；
[0013]S12、结合协同节点i的原始观测量信息通过电离层延时误差模型和对流层延时误差模型计算电离层延时T及对流层延时I，计算修正后接收机原始观测量的FIM，获取当前历元协同节点的定位不确定度ΔX
i
；
[0014]S13、存储当前历元的原始观测量，并播发当前历元的定位解卫星观测集合{NS}
i
和定位不确定度ΔX
i
。
[0015]其中，在步骤二中所述的“收集步骤一协同节点位置相关信息，包括协同节点位置、定位不确定度和卫星观测集合，并由目标节点收集到的测距信息判断测距连通性，由此可以计算协同节点提供的定位性能增益，确定协同节点的优先级，并通过贪婪式节点选取策略选取部分协同节点，从而构建最优协同定位系统”，其做法如下：
[0016]S21、获取当前历元所有协同节点的位置相关信息，包括协同节点位置、定位不确定度和观测卫星数量；
[0017]S22、通过目标节点的定位信息计算粗略位置，并使用目标节点收集到的测距信息判断协同节点的测距连通性；
[0018]S23、计算协同节点与目标节点间定位FIM，计算对目标定位性能增益的EFIM，选取一个具有最优EFIM行列式的协同节点；
[0019]S24、判断协同系统规模是否达到设定目标M，如果达到要求停止选取，协同定位系统组建完成，否则，保留当前已选取的协同节点，在本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种V2X中基于节点选取的协同定位方法，其特征在于：利用协同节点的卫星观测、定位不确定度和测距连通性来评估对目标节点提供的定位增益，以选取最优的部分协同节点组建协同定位系统，并在定位算法中考虑协同节点定位不确定度来提高目标节点定位精度。该方法步骤如下：步骤一：协同节点计算自身的定位结果，计算定位不确定度，并播发当前历元的定位状态向量、定位不确定度和观测卫星集合；步骤二：收集步骤一协同节点位置相关信息，计算目标节点粗位置，并通过目标节点收集的测距信息判断测距连通性；通过EFIM计算协同节点提供的定位性能增益，确定协同节点的优劣，并通过贪婪式节点选取策略选取部分更优的协同节点，从而构建最优协同定位系统；步骤三：根据步骤二构建的协同定位系统，收集对应的定位相关信息，融合由车间测距模块获得的车间测距值，并将协同节点的定位不确定性作为先验信息，通过设计的半定规划定位算法解算出最优估计位置。2.根据权利要求1所述的一种V2X中基于节点选取的协同定位方法，其特征在于节点选取算法综合考量了协同节点的卫星观测、位置不确定度和测距连通性对目标节点的定位增益，并在定位中考虑了协同节点位置误差；所述步骤一具体过程如下：S21、通过协同节点i的高精度接收机获取协同节点精确位置以及当前历元的观测卫星集合{NS}
i
；S22、结合协同节点i的原始观测量信息通过电离层延时误差模型和对流层延时误差模型计算电离层延时T及对流层延时I，计算修正后接收机原始观测量的FIM，获取当前历元协同节点的定位不确定度ΔX
i
；S23、存储当前历元的原始观测量，并播发当前历元的定位解卫星观测集合{NS}
i
和定位不确定度ΔX
i
。3.根据权利要求2中S21所述的卫星观测集合{NS}
i
，其表示协同节点i在该历元观测到所有卫星编号的集合，无需相应的观测量原始数据。4.根据权利要求2中S22所述的定位不确定度ΔX
i
，其特征在于采用协同节点的卫星观测条件计算定位估计的性能界，在无偏估计中采用该性能界作为估计误差的协方差矩阵，即定位不确定度。5.根据权利要求1所述的通过EFIM计算定位性能增益，选取部分最优的协同节点组建协同定位系统，其特征在于EFIM综合考虑协同节点的卫星观测、定位不确定度和测距连通性，从而构建更优的协同定位系统，具体过程如下：S51、获取当前历元所有协同节点的定位相关信息，包括协同节点位置、定位不确定度和观测卫星集合；S52、通过目标节点的定位信息计算粗略位置，并结合目标节点收集到的测距信息确定协同节点的测距连通性；S53、计算协同节点与目标节点间定位FIM，计算对目标定位性能增益的EFIM，通过贪婪式策略选取一定数量的协同节点。6.根据权利要求5中S51所述的收集协同节点定位相关信息，其特征在于收集的...

【专利技术属性】
技术研发人员：王健蓉，赵洪博，龚汉彪，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：