CN104990554B - Gnss盲区中基于vanet车辆间协作的惯性导航定位方法 - Google Patents
Gnss盲区中基于vanet车辆间协作的惯性导航定位方法 Download PDFInfo
- Publication number
- CN104990554B CN104990554B CN201510220375.3A CN201510220375A CN104990554B CN 104990554 B CN104990554 B CN 104990554B CN 201510220375 A CN201510220375 A CN 201510220375A CN 104990554 B CN104990554 B CN 104990554B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mover
- vehicle
- msubsup
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 230000004807 localization Effects 0.000 title abstract 2
- 238000005516 engineering process Methods 0.000 claims abstract description 58
- 239000013598 vector Substances 0.000 claims description 21
- 238000005259 measurement Methods 0.000 claims description 13
- 238000001514 detection method Methods 0.000 claims description 8
- 238000004891 communication Methods 0.000 claims description 7
- 238000007499 fusion processing Methods 0.000 claims description 5
- 238000006073 displacement reaction Methods 0.000 claims description 4
- 230000004927 fusion Effects 0.000 claims description 3
- 230000008859 change Effects 0.000 claims description 2
- 238000001914 filtration Methods 0.000 claims description 2
- 230000006872 improvement Effects 0.000 claims description 2
- 238000012545 processing Methods 0.000 claims description 2
- 230000004044 response Effects 0.000 claims description 2
- 238000005303 weighing Methods 0.000 claims description 2
- 230000002457 bidirectional effect Effects 0.000 claims 1
- 238000005070 sampling Methods 0.000 claims 1
- 101001093748 Homo sapiens Phosphatidylinositol N-acetylglucosaminyltransferase subunit P Proteins 0.000 abstract description 3
- 230000008901 benefit Effects 0.000 description 13
- 230000001133 acceleration Effects 0.000 description 5
- 238000009825 accumulation Methods 0.000 description 5
- 230000033001 locomotion Effects 0.000 description 4
- 238000012423 maintenance Methods 0.000 description 3
- 239000011159 matrix material Substances 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 239000013589 supplement Substances 0.000 description 1
- 230000001502 supplementing effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明公开了GNSS盲区中基于VANET车辆间协作的惯性导航定位方法,该方法在GNSS盲区使用惯性导航定位技术进行单独定位的基础上,引入协作定位的理念,解决GNSS盲区中单独使用惯性导航INS进行定位时定位误差随时间积累造成的定位性能较差问题,包括:首先,车辆之间通过DSRC进行通信,共享车辆自身的INS位置信息、里程仪的速度信息,ID等;其次,各车辆根据接收到的邻近车辆的速度信息等检测车辆与邻近车辆“相遇”时刻;再次,根据相遇时刻得到车辆相遇时的距离;然后,利用航位推算将本地的INS位置信息和车辆之间的距离,得到车辆的绝对位置;最后,再使用数字地图技术修正最终的位置信息。
Description
技术领域
本发明涉及GNSS盲区车辆自组织网络VANET中的车辆协作定位技术、车辆之间的V2V通信、惯性导航***INS技术,特别涉及一种基于车辆之间协作的INS导航定位方法。
背景技术
目前,车辆定位技术有很多,其中,全球卫星导航***(GNSS,Global NavigationSatellite Systems)是使用最多的定位***,也被认为是为智能交通***应用提供位置信息服务的关键技术,许多应用***都采用GNSS技术来提供高精度的位置信息。导航以及基于位置的信息服务,特别是车辆安全和紧急避险等都需要精确的位置信息作为前提,在很大程度上依赖车辆位置信息。GNSS技术目前可以提供10米左右精度的位置信息,无法满足车辆安全在内的高精度定位要求,再加上在城市密集区或隧道等区域,GNSS信号被遮挡,无法获取车辆位置信息,这也是车辆安全应用面临的挑战。
为了弥补GNSS盲区定位的不足,常使用惯性导航INS定位技术,INS虽然具备不依赖外界信号,同时不受外界信号的干扰,稳定性较高,重量轻、体积小易于维护,短时间内定位精度高的优点,但是INS单独定位时存在误差随时间积累的特点,较长时间的定位中,由于误差积累造成定位精度的严重下降,因此不适合长时间的单独的车辆定位。将INS与GNSS技术进行组合定位,可以实现彼此的优势互补,有效地解决GNSS盲区的定位问题,从而实现较好的车辆定位及导航等应用。因此,近年来INS与GNSS的组合定位成为了导航定位的研究热点。GNSS技术、INS技术的单独定位,或两者结合的组合定位,都属于单节点的独立定位,定位精度难以满足车辆安全在内的现代ITS应用的可行性要求。高精度的数字地图可以用来修正GNSS或INS技术的定位误差,从而提高定位精度,但是数字地图技术不能单独用来定位。
为了应对单节点定位精度不高以及适用性和定位精度受限带来的挑战,基于车与车,车与基础设施,车与人等相互通信的现代协作定位技术应运而生。现代协作定位技术是在车载自组网下的车辆间相互合作的定位技术,该技术通过车与车、车与路边设施等通信,获取邻近参考点的位置速度等信息,再将接收到的数据与本地数据根据融合算法进行融合处理,然后充分利用多源数据的优势,协调相互作用的结果,获取更加准确的数据信息,进而在GNSS信号覆盖盲区实现定位,在GNSS信号较强地区实现增强GNSS定位的目的。
现有的技术方案一
惯性导航INS定位技术,通过在车载上安装惯性测量单元(即:IMU),如陀螺仪与加速度计等敏感***的导航参数解算***,提供车辆运动情况下的加速度和方位角信息,再通过航位推算得到目标车辆的位置与速度信息。INS虽然具备不依赖外界信号,同时不受外界信号的干扰,稳定性较高,重量轻、体积小易于维护,短时间内定位精度高的优点。GNSS技术进行组合定位,可以实现彼此的优势互补,有效地解决GNSS盲区的定位问题,从而实现较好的车辆定位及导航等应用。但是,INS虽然具备不依赖外界信号,同时不受外界信号的干扰,稳定性较高,重量轻、体积小易于维护,短时间内定位精度高的优点,但是INS单独定位时存在误差随时间积累的特点,较长时间的定位中,由于误差积累造成定位精度的严重下降,因此不适合长时间的单独的车辆定位。
现有的技术方案二
组合导航是两种或两种以上的导航技术的组合,组合导航一般有互补功能,即组合后的导航功能虽然与各分***的导航功能相同,但是合理的利用了分***的特点,从而扩大了适用范围和导航精度,并且有余度功能,增加了***的可靠性。目前应用较多的是INS/GNSS组合的定位技术,先利用GNSS的数据作为基数据,在其基础上利用INS技术实现盲区的定位,对于GNSS信号盲区短时间的定位来说,可以为其提供很好的信息补充。但是,组合定位技术仍然需要INS在盲区中的自主定位,长时间定位时定位误差积累问题仍然无法消除;而且无论是GNSS技术、INS技术以,或两者结合的组合定位,都属于单节点的独立定位,定位精度难以满足车辆安全在内的现代ITS应用的可行性要求。而本发明能够很好地解决上面的问题。
发明内容
本发明目的在于提供了一种GNSS盲区中基于VANET车辆间协作的惯性导航定位方法,该方法在GNSS盲区使用惯性导航定位技术进行单独定位的基础上,引入协作定位的理念,解决GNSS盲区中单独使用惯性导航INS进行定位时定位误差随时间积累造成的定位性能较差问题,它包括以下步骤:首先,车辆之间通过DSRC进行通信,共享车辆自身的INS位置信息、里程仪的速度信息,ID等;其次,各车辆根据接收到的邻近车辆的速度信息等检测车辆与邻近车辆“相遇”时刻;再次,根据相遇时刻得到车辆相遇时的距离;然后,利用航位推算将本地的INS位置信息和车辆之间的距离,得到车辆的绝对位置;最后,再使用数字地图技术修正最终的位置信息。本发明的有益效果是:在发挥INS定位技术补充GNSS信号盲区的位置和速度信息的优势的同时,根据车辆间通信带来的多源数据优势,减小INS随时间积累的测量误差,再利用数字地图技术进一步修正测量误差,从而获得高精度的盲区车辆绝对位置信息。
本发明解决其技术问题所采取的技术方案是:一种GNSS盲区中基于VANET车辆间协作的惯性导航定位方法,该方法包括如下步骤:
步骤1:车辆通过广播发送各自的位置速度消息,邻近车辆接收周围车辆发送的消息并存储至本地空间。
步骤2:各车辆根据观测到的邻近车辆信号的多普勒频移以及邻近车辆广播消息中包含的速度等信息,利用匹配滤波器时间检测方法得到峰值输出时刻,根据峰值输出时刻得到车辆与邻近车辆的“相遇”时刻,由“相遇”时刻得到车辆相遇时的距离。
步骤3:利用航位推算数据融合处理车辆本地的INS位置信息和车辆之间的距离,得到车辆的绝对位置。
步骤4:使用数字地图技术修正得到最终的位置信息。
有益效果:
1、本发明在GNSS盲区中,可以使用INS/GNSS组合的方式实现盲区的定位,但是组合定位技术仍然是单一目标车辆的定位,定位性能仍然不足,VANET下的协作定位技术是多目标车辆相互协作的定位技术,可以提高定位的精度。
2、本发明在协作定位技术中,暂时还未出现INS的协作定位,本发明发挥INS定位技术补充GNSS信号盲区的位置和速度信息的优势的同时,利用基于车辆间协作带来的多源数据,减小INS的积累误差,改善INS单独定位的性能。
3、本发明在协作减小INS积累误差的基础上,再利用数字地图技术进一步修正测量误差,从而获得高精度的盲区车辆绝对位置信息。
4、本发明在发挥INS定位技术补充GNSS信号盲区的位置和速度信息的优势的同时,根据车辆间通信带来的多源数据优势,减小INS随时间积累的测量误差,再利用数字地图技术进一步修正测量误差,从而获得高精度的盲区车辆绝对位置信息。
附图说明
图1为本发明的方法流程图。
图2为本发明GNSS盲区车辆间协作惯性导航定位。
具体实施方式
下面结合说明书附图对本发明创造作进一步的详细说明。
如图1所示,一种GNSS盲区中基于VANET车辆间协作的惯性导航定位方法,该方法包括如下步骤:
步骤1:车辆通过广播发送各自的位置速度消息,邻近车辆接收周围车辆发送的消息并存储至本地空间。
步骤2:各车辆根据观测到的邻近车辆信号的多普勒频移以及邻近车辆广播消息中包含的速度等信息,利用匹配滤波器时间检测方法得到峰值输出时刻,根据峰值输出时刻得到车辆与邻近车辆的“相遇”时刻,由“相遇”时刻得到车辆相遇时的距离。
步骤3:利用航位推算数据融合处理车辆本地的INS位置信息和车辆之间的距离,得到车辆的绝对位置。
步骤4:使用数字地图技术修正得到最终的位置信息。
本发明在隧道或城市密集区,GNSS信号被阻挡,定位性能大大降低,这种情况下常使用惯性导航INS进行绝对定位。传统的车辆定位中已有大量的INS应用实例,但是INS定位误差具有随时间积累的特性,比较经典的误差累积是时间超过30秒时,误差超过50米,而且在VANET下车辆协作定位中仍未出现INS的应用。由于协作定位需要两个以上的独立部分进行通信,共享彼此的位置信息,所以GNSS盲区中广泛使用INS/GNSS组合定位技术不能看作协作定位技术。本发明关注VANET下的V2V基础上的INS定位技术,利用INS的定位优势,提出一种新的协作定位技术,实现GNSS盲区的车辆绝对定位。如图2所示处于盲区中的车辆可以通过V2V通信接收周围车辆广播的位置速度信息;并通过观测周围车辆广播信号的多普勒频移结合广播信号中包含的位置速度信息确定当前车辆与邻近车辆的“相遇”时刻;继而根据此“相遇”时刻得到本车与邻近车辆的相对距离,使用航位推算数据融合处理得到车辆的绝对位置;最后使用数字地图修正得到最终的位置信息。
一、车辆运动模型
在使用惯性导航INS技术进行车辆定位时,如果已知欧拉角在t0时刻的初始化状态和惯性测量器件提供的载体系下的加速度,以及车辆的旋转矩阵,就能根据车辆的运动模型,测量车辆在t>t0时刻的位置和速度信息。其中,车辆的运动模型可以表示如下:
“·”表示对时间的求导,pn是车辆在导航系中的位置矢量,vn是车辆在导航系中的速度矢量,ab是车辆在载体系中的加速度矢量,是从车辆载体系到导航系转换时的旋转矩阵,G是地球重力加速度。对于ENU坐标来说,G在东北两个方向的加速度分量为0,G≈-9.8m/s2,方向竖直向下。欧拉角根据如下公式进行更新:
VANET中的车辆协作惯性导航方法是基于惯性导航INS的位置估计方法,通过与经过该车辆附近的车辆进行协作,估计出该车的位置信息。假设车辆k、l对应的欧拉角分别为和本发明中提到的经过彼此的车辆,都是指在双车道上行驶的运动方向相反的车辆。如果车辆k、l经过彼此时的时间为t=tp,则两车辆的欧拉角满足:
假设在车辆经过彼此时刻的行驶轨迹平行,也即是车辆在该时刻不变换行驶方向。基于车辆协作的惯性导航定位方法也是基于经过彼此时刻tp和经过时刻的相对距离r(tp)的测量方法。在本发明中采用接收到的邻近车辆信号的多普勒频移测量tp和r(tp)。
二、车辆间基于多普勒频移的相对距离的测量
车辆l接收到来自车辆k发射信号的多普勒频移可以表示为:
其中ft表示发射频率,c是光速,r表示车辆之间的距离。公式(7)又可表示为:
其中,v=vk+vl,表示车辆k、l之间的相对速度。在此,假设车辆经过彼此时刻的速度不变。如附图1所示,车辆经过彼此时多普勒频移为0,基于这一特性可以测量tp和r(tp)。针对经过时刻的时间,可以利用匹配滤波器进行检测,匹配滤波器的脉冲响应为:
其中,α为调谐参数,设α=30,表示两个车辆在信号进行滤波期间行进的距离。从车辆通信时提供的里程仪信息中得到速度v,并且假设里程仪不存在观测误差。r0是经过彼此的车辆之间的距离,先假设为10米,实际上该参数为待测量。r0真实值不影响滤波器对时间tp的检测。从附图2中得知,采用匹配滤波器进行时间检测时,实质是检测滤波器的最大输出时刻,r0只会影响滤波器的最大输出值,而不会影响最大值输出时的时间。滤波器峰值输出时刻均是tmax=tp+α/2v,根据峰值输出时刻,可以检测到车辆经过彼此时的时间。假设tp是起始时刻,为了测量r(tp),公式(8)可以改为:
Y(t-tp)=r2(tp)+ζ(t-tp) (10)
其中:
是计算得到的两车之间的相对速度,是目标车辆观测到的多普勒频移,ζ是由于未知和的真实值而设置的误差值。根据公式(10),用Y(ti-tp)的平均均方差计算r(tp):
其中,N表示车辆经过彼此时刻前后的采样数,理论上N的值越大越好,为了在尽可能短的时间得出车辆间的距离,一般设N为
三、基于航位推算的车辆绝对定位
在利用本发明提出的惯性导航协作定位技术进行GNSS盲区定位时,假设参与协作的车辆通过DSRC广播各自的ID、INS提供的位置和欧拉角以及里程表提供的速度信息,每辆车都能收到来自周边的所有车辆的广播信息,采用基于车辆协作的惯性导航定位技术时,协作的车辆必须能够识别经过的车辆,并且能够将自身的数据信息与接收到的经过车辆的信息进行融合。车辆协作的惯性导航定位方法是基于已知目标车辆经过每一个邻近车辆的时间和经过时刻两者之间的距离来实现定位的方法,因此实现定位需要两步,先测量经过时刻tp,然后再获取tp时刻目标车辆与邻近车辆的距离r(tp)。在获取tp和经过时刻的两车距离r(tp)的基础上,融合与其通信的车辆基于INS的定位数据,可以消除欧拉角和位置信息的误差。假设t=tp时刻,车辆协作惯性导航定位技术数据融合之前,对车辆k和l来自INS的欧拉角测量值为和公式(6)是协作车辆间满足的第一个约束条件,最优欧拉角函数满足如下关系式:
其中,是采用本发明提出的定位技术后改善之后的欧拉角,γ表示权重系数,用来权衡每辆车的最小成本函数。为了使目标车辆获取高精度的欧拉角,权重系数取值应尽可能大。根据公式(13)的最小成本函数可以得到:
基于车辆协作惯性导航方法的欧拉角测量估计为:
在对车辆k、l进行定位处理时,使用公式(15)可以更新欧拉角值,再使用公式(3)-公式(5),可以消除更新欧拉角后的误差。
在t=tp时刻,该方案中车辆所受另一个约束条件是两车之间的相对位置矢量。考虑到和是车辆k、l基于本发明提出的方法的位置估计矢量,正交于道路方向,并且在正常行驶条件下,如没有发生向路边的滑动情况,并且沿道路行驶的方向不变。的第一列是vk=[cosψcosθ,sinψcosθ,-sinθ]T,并且vl=-vk,分别是车辆k、l速度的单位向量。“T”是转置符号。归一化的速度矢量作为道路方向测量的一个参数,使用公式(14)测量的欧拉角,用于测量道路方向。
假设和分别是车辆k、l在t=tp时刻采用INS技术获得的位置矢量,二者分别基于两个位移矢量转变为和该位移矢量沿道路方向和垂直道路方向的长度分别为:Δl和ΔL,满足如下公式:
其中,pkl是垂直于vk和vl的单位向量,同时满足:
联立(15-17)得到:
使用Δl可以计算得到pkl:
对(16)、(17)求差,用代替可得:
两边都求绝对值可得:
由公式(22)可知ΔL有两个解,所求解取决于t=tp时刻的定位误差和靠左或靠右的交通规则。将Δl和ΔL以及pkl代入公式(15)和(22),可以得到和然后再使用数字地图对位置信息进行修正,从而得到更优的GNSS盲区车辆位置信息。
Claims (2)
1.GNSS盲区中基于VANET车辆间协作的惯性导航定位方法,其特征在于,所述方法包括如下步骤:
步骤1:车辆通过广播发送各自的位置速度消息,邻近车辆接收周围车辆发送的消息并存储至本地空间;
步骤2:各车辆根据观测到的邻近车辆信号的多普勒频移以及邻近车辆广播消息中包含的速度信息,利用匹配滤波器时间检测方法得到峰值输出时刻,根据峰值输出时刻得到车辆与邻近车辆的“相遇”时刻,由“相遇”时刻得到车辆相遇时的距离;
车辆l接收到来自车辆k发射信号的多普勒频移表示为:
<mrow>
<msub>
<mi>&Delta;f</mi>
<mrow>
<mi>k</mi>
<mi>l</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mo>-</mo>
<msub>
<mi>f</mi>
<mi>t</mi>
</msub>
</mrow>
<mi>c</mi>
</mfrac>
<mfrac>
<mrow>
<msub>
<mi>dr</mi>
<mrow>
<mi>k</mi>
<mi>l</mi>
</mrow>
</msub>
</mrow>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
其中ft表示发射频率,c是光速,r表示车辆之间的距离,公式(7)表示为:
<mrow>
<mi>&Delta;</mi>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>-</mo>
<msub>
<mi>t</mi>
<mi>p</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mo>-</mo>
<mo>&lsqb;</mo>
<mi>t</mi>
<mo>-</mo>
<msub>
<mi>t</mi>
<mi>p</mi>
</msub>
<mo>&rsqb;</mo>
<msub>
<mi>f</mi>
<mi>t</mi>
</msub>
<msup>
<mi>v</mi>
<mn>2</mn>
</msup>
</mrow>
<mrow>
<mi>c</mi>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>&lsqb;</mo>
<mi>t</mi>
<mo>-</mo>
<msub>
<mi>t</mi>
<mi>p</mi>
</msub>
<mo>&rsqb;</mo>
</mrow>
<mn>2</mn>
</msup>
<msup>
<mi>v</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mi>r</mi>
<mn>2</mn>
</msup>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mi>p</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,v=vk+vl,表示车辆k、l之间的相对速度,在此,假设车辆经过彼此时刻的速度不变,车辆经过彼此时多普勒频移为0,基于这一特性测量tp和r(tp),针对经过时刻的时间,利用匹配滤波器进行检测,匹配滤波器的脉冲响应为:
其中,α为调谐参数,设α=30,表示两个车辆在信号进行滤波期间行进的距离,从车辆通信时提供的里程仪信息中得到速度v,并且假设里程仪不存在观测误差,r0是经过彼此的车辆之间的距离,先假设为10米,实际上该参数为待测量,r0真实值不影响滤波器对时间tp的检测,采用匹配滤波器进行时间检测时,实质是检测滤波器的最大输出时刻,r0只会影响滤波器的最大输出值,而不会影响最大值输出时的时间,滤波器峰值输出时刻均是tmax=tp+α/2v,根据峰值输出时刻,检测到车辆经过彼此时的时间,假设tp是起始时刻,为了测量r(tp),公式(8)改为:
Y(t-tp)=r2(tp)+ζ(t-tp) (10)
其中:
<mrow>
<mi>Y</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>-</mo>
<msub>
<mi>t</mi>
<mi>p</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<mi>t</mi>
<mo>-</mo>
<msub>
<mi>t</mi>
<mi>p</mi>
</msub>
<mo>&rsqb;</mo>
</mrow>
<mn>2</mn>
</msup>
<msup>
<mover>
<mi>v</mi>
<mo>^</mo>
</mover>
<mn>2</mn>
</msup>
<mo>&lsqb;</mo>
<mfrac>
<mrow>
<msubsup>
<mi>f</mi>
<mi>t</mi>
<mn>2</mn>
</msubsup>
<msup>
<mover>
<mi>v</mi>
<mo>^</mo>
</mover>
<mn>2</mn>
</msup>
</mrow>
<mrow>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mi>&Delta;</mi>
<msup>
<mover>
<mi>f</mi>
<mo>^</mo>
</mover>
<mn>2</mn>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>-</mo>
<msub>
<mi>t</mi>
<mi>p</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>-</mo>
<mn>1</mn>
<mo>&rsqb;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>11</mn>
<mo>)</mo>
</mrow>
</mrow>
是计算得到的两车之间的相对速度,是目标车辆观测到的多普勒频移,ζ是由于未知和的真实值而设置的误差值,根据公式(10),用Y(ti-tp)的平均均方差计算r(tp):
<mrow>
<mover>
<mi>r</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mi>p</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msqrt>
<mrow>
<mfrac>
<mn>1</mn>
<mi>N</mi>
</mfrac>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mi>N</mi>
<mn>2</mn>
</mfrac>
</mrow>
<mfrac>
<mi>N</mi>
<mn>2</mn>
</mfrac>
</munderover>
<mi>Y</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mi>p</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,N表示车辆经过彼此时刻前后的采样数,理论上N的值越大越好,设N为
步骤3:利用航位推算数据融合处理车辆本地的INS位置信息和车辆之间的距离,得到车辆的绝对位置;
实现定位需要两步,先测量经过时刻tp,然后再获取tp时刻目标车辆与邻近车辆的距离r(tp),在获取tp和经过时刻的两车距离r(tp)的基础上,融合与其通信的车辆基于INS的定位数据,消除欧拉角和位置信息的误差,假设t=tp时刻,车辆协作惯性导航定位技术数据融合之前,对车辆k和l来自INS的欧拉角测量值为和 是协作车辆间满足的第一个约束条件,最优欧拉角函数满足如下关系式:
其中,是采用定位技术后改善之后的欧拉角,γ表示权重系数,用来权衡每辆车的最小成本函数,为了使目标车辆获取高精度的欧拉角,根据公式(13)的最小成本函数得到:
基于车辆协作惯性导航方法的欧拉角测量估计为:
在对车辆k、l进行定位处理时,使用公式(15)更新欧拉角值,再使用欧拉角根据如下公式进行更新:
消除更新欧拉角后的误差;
在t=tp时刻,车辆所受另一个约束条件是两车之间的相对位置矢量,考虑到和是车辆k、l基于位置估计矢量,正交于道路方向,并且在正常行驶条件下,如没有发生向路边的滑动情况,并且沿道路行驶的方向不变,的第一列是vk=[cosψcosθ,sinψcosθ,-sinθ]T,并且vl=-vk,分别是车辆k、l速度的单位向量,“T”是转置符号,归一化的速度矢量作为道路方向测量的一个参数,使用公式(14)测量的欧拉角,用于测量道路方向;
假设和分别是车辆k、l在t=tp时刻采用INS技术获得的位置矢量,二者分别基于两个位移矢量转变为和该位移矢量沿道路方向和垂直道路方向的长度分别为:Δl和ΔL,满足如下公式:
<mrow>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>k</mi>
<mo>+</mo>
</msubsup>
<mo>=</mo>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>k</mi>
<mo>-</mo>
</msubsup>
<mo>+</mo>
<msub>
<mi>v</mi>
<mi>k</mi>
</msub>
<mi>&Delta;</mi>
<mi>l</mi>
<mo>+</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>k</mi>
<mi>l</mi>
</mrow>
</msub>
<mi>&Delta;</mi>
<mi>L</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>16</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>l</mi>
<mo>+</mo>
</msubsup>
<mo>=</mo>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>l</mi>
<mo>-</mo>
</msubsup>
<mo>+</mo>
<msub>
<mi>v</mi>
<mi>l</mi>
</msub>
<mi>&Delta;</mi>
<mi>l</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>k</mi>
<mi>l</mi>
</mrow>
</msub>
<mi>&Delta;</mi>
<mi>L</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>17</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,pkl是垂直于vk和vl的单位向量,同时满足:
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>k</mi>
<mo>+</mo>
</msubsup>
<mo>-</mo>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>l</mi>
<mo>+</mo>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<msub>
<mi>v</mi>
<mi>k</mi>
</msub>
<mo>=</mo>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>k</mi>
<mo>+</mo>
</msubsup>
<mo>-</mo>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>l</mi>
<mo>-</mo>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<msub>
<mi>v</mi>
<mi>l</mi>
</msub>
<mo>=</mo>
<mn>0</mn>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>18</mn>
<mo>)</mo>
</mrow>
</mrow>
联立(15-17)得到:
<mrow>
<mi>&Delta;</mi>
<mi>l</mi>
<mo>=</mo>
<mn>0.5</mn>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>k</mi>
<mo>-</mo>
</msubsup>
<mo>-</mo>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>l</mi>
<mo>-</mo>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
<msub>
<mover>
<mi>v</mi>
<mo>^</mo>
</mover>
<mi>k</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>19</mn>
<mo>)</mo>
</mrow>
</mrow>
使用Δl计算得到pkl:
<mrow>
<msub>
<mi>p</mi>
<mrow>
<mi>k</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>k</mi>
<mo>-</mo>
</msubsup>
<mo>-</mo>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>l</mi>
<mo>-</mo>
</msubsup>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>v</mi>
<mi>k</mi>
</msub>
<mi>&Delta;</mi>
<mi>l</mi>
<mo>)</mo>
</mrow>
<mo>/</mo>
<mo>|</mo>
<mo>|</mo>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>k</mi>
<mo>-</mo>
</msubsup>
<mo>-</mo>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>l</mi>
<mo>-</mo>
</msubsup>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>v</mi>
<mi>k</mi>
</msub>
<mi>&Delta;</mi>
<mi>l</mi>
<mo>|</mo>
<mo>|</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>20</mn>
<mo>)</mo>
</mrow>
</mrow>
对(16)、(17)求差,用代替得到:
<mrow>
<mo>|</mo>
<mover>
<mi>r</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mi>p</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mn>2</mn>
<mi>&Delta;</mi>
<mi>L</mi>
<mo>|</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>k</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>=</mo>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>k</mi>
<mo>-</mo>
</msubsup>
<mo>-</mo>
<msubsup>
<mover>
<mi>P</mi>
<mo>^</mo>
</mover>
<mi>l</mi>
<mo>-</mo>
</msubsup>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>v</mi>
<mi>k</mi>
</msub>
<mi>&Delta;</mi>
<mi>l</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>21</mn>
<mo>)</mo>
</mrow>
</mrow>
两边都求绝对值得到:
由公式(22)可知ΔL有两个解,所求解取决于t=tp时刻的定位误差和靠左或靠右的交通规则,将Δl和ΔL以及pkl代入公式(15)和(22),得到和然后再使用数字地图对位置信息进行修正,从而得到更优的GNSS盲区车辆位置信息;
步骤4:使用数字地图技术修正得到最终的位置信息;
所述方法的车辆“相遇”是指代目标车辆与相反方向行驶的邻近车辆在经过彼此时刻的相遇,相遇时的距离,为车辆垂直于行驶方向的距离。
2.根据权利要求1所述的一种GNSS盲区中基于VANET车辆间协作的惯性导航定位方法,其特征在于,所述方法的车辆之间相互通信,共享自身的位置,ID和速度信息,并且协作的车辆为双向道路上行驶方向相反的车辆。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510220375.3A CN104990554B (zh) | 2015-05-04 | 2015-05-04 | Gnss盲区中基于vanet车辆间协作的惯性导航定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510220375.3A CN104990554B (zh) | 2015-05-04 | 2015-05-04 | Gnss盲区中基于vanet车辆间协作的惯性导航定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104990554A CN104990554A (zh) | 2015-10-21 |
CN104990554B true CN104990554B (zh) | 2018-03-13 |
Family
ID=54302396
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510220375.3A Active CN104990554B (zh) | 2015-05-04 | 2015-05-04 | Gnss盲区中基于vanet车辆间协作的惯性导航定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104990554B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106885567B (zh) * | 2015-12-15 | 2020-04-03 | 华为技术有限公司 | 一种惯导协作定位方法及定位设备 |
CN105824039A (zh) * | 2016-03-17 | 2016-08-03 | 孙红星 | 基于里程计的克服卫星失锁时的gnss/ins车载组合定位定向算法 |
CN106767783A (zh) * | 2016-12-15 | 2017-05-31 | 东软集团股份有限公司 | 基于车载通信的定位修正方法和装置 |
DE102017203838B4 (de) * | 2017-03-08 | 2022-03-17 | Audi Ag | Verfahren und System zur Umfelderfassung |
CN107315826B (zh) * | 2017-07-05 | 2019-09-20 | 成都四相致新科技有限公司 | 一种定位***盲区动态检测方法 |
CN108846598A (zh) * | 2018-03-29 | 2018-11-20 | 宏图物流股份有限公司 | 一种车辆定位的方法及装置 |
CN109782320A (zh) * | 2019-03-13 | 2019-05-21 | 中国人民解放军海军工程大学 | 运输队列定位方法及*** |
CN112880699B (zh) * | 2021-01-19 | 2023-03-10 | 中国人民解放军空军工程大学 | 一种基于脑选择性注意机制的车辆协作定位方法 |
CN114114245B (zh) * | 2022-01-27 | 2022-04-12 | 成都工航科技有限公司 | 一种高速列车定位方法及*** |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1755096A1 (en) * | 2004-05-24 | 2007-02-21 | Matsushita Electric Industrial Co., Ltd. | Digital map position information transmitting method, position information transmitter, and position information receiver |
CN101160553A (zh) * | 2005-01-05 | 2008-04-09 | 通用汽车公司 | 交通工具之间相对空间信息的确定 |
CN201751861U (zh) * | 2010-04-19 | 2011-02-23 | 重庆星熠导航设备有限公司 | 一种惯性辅助卫星导航***的接收机 |
CN103269478A (zh) * | 2013-05-17 | 2013-08-28 | 南京邮电大学 | 车载自组织网络中基于位置信息的快速广播方法 |
CN103383464A (zh) * | 2013-05-17 | 2013-11-06 | 南京邮电大学 | 一种车辆定位***中改善定位精度方法 |
CN104280746A (zh) * | 2013-07-04 | 2015-01-14 | 南京理工大学 | 一种惯性辅助gps的深组合半实物仿真*** |
-
2015
- 2015-05-04 CN CN201510220375.3A patent/CN104990554B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1755096A1 (en) * | 2004-05-24 | 2007-02-21 | Matsushita Electric Industrial Co., Ltd. | Digital map position information transmitting method, position information transmitter, and position information receiver |
CN101160553A (zh) * | 2005-01-05 | 2008-04-09 | 通用汽车公司 | 交通工具之间相对空间信息的确定 |
CN201751861U (zh) * | 2010-04-19 | 2011-02-23 | 重庆星熠导航设备有限公司 | 一种惯性辅助卫星导航***的接收机 |
CN103269478A (zh) * | 2013-05-17 | 2013-08-28 | 南京邮电大学 | 车载自组织网络中基于位置信息的快速广播方法 |
CN103383464A (zh) * | 2013-05-17 | 2013-11-06 | 南京邮电大学 | 一种车辆定位***中改善定位精度方法 |
CN104280746A (zh) * | 2013-07-04 | 2015-01-14 | 南京理工大学 | 一种惯性辅助gps的深组合半实物仿真*** |
Non-Patent Citations (4)
Title |
---|
Improvement of Dead Reckoning Accuracy of a Mobile Robot by Slip Detection and Compensation using Multiple Model Approach;Hyoung-Ki Lee, et al;《2008 IEEE/RSJ International Conference on Intelligent Robots and Systems》;20080926;第1140-1147页 * |
VANET中基于Doppler-RSS的混合测距方法研究;夏向兰等;《计算机技术与发展》;20150430;第25卷(第4期);第225-228页 * |
一种基于协作和多普勒频移的车辆定位算法;邵震洪等;《东南大学学报》;20131130;第43卷(第6期);第1135-1140页 * |
车载自组网中车辆相对定位研究;赵璐等;《中国通信学会信息通信网络技术委员会13年年会论文集》;20131231;第83-86页 * |
Also Published As
Publication number | Publication date |
---|---|
CN104990554A (zh) | 2015-10-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104990554B (zh) | Gnss盲区中基于vanet车辆间协作的惯性导航定位方法 | |
CN208635810U (zh) | 用于陆地车辆导航的***以及车辆 | |
CN107315413B (zh) | 一种车车通信环境下考虑车辆间相对位置的多车协同定位算法 | |
US9162682B2 (en) | Method and device for determining the speed and/or position of a vehicle | |
Alam et al. | Cooperative inertial navigation for GNSS-challenged vehicular environments | |
US9897455B2 (en) | Travel route information generation apparatus | |
CN106646570A (zh) | 一种多基站卫星差分定位和惯导组合的车辆精准定位方法 | |
CN206704211U (zh) | 基于移动闭塞的重载列车定位*** | |
CA2694020A1 (en) | Global positioning system error correction, vehicle tracking and object location | |
TW202145763A (zh) | 側行鏈路定位:在往返時間定位與單程時間定位之間切換 | |
CN106710281A (zh) | 车辆定位数据获取方法及装置 | |
CN104835353A (zh) | Vanet中基于ins和gnss伪距双差的协作相对定位方法 | |
CN109307877A (zh) | 高精度车辆定位***和高精度车辆定位方法 | |
CN112346103A (zh) | 基于v2x的智能网联汽车动态协同定位方法与装置 | |
CN104422448A (zh) | 一种车辆定位方法及装置 | |
CN107274721A (zh) | 一种智能交通***中多车辆协作定位方法 | |
WO2016145887A1 (zh) | 一种obu定位细分推算方法和*** | |
CN106093992A (zh) | 一种基于cors的亚米级组合定位导航***及导航方法 | |
CN103575297B (zh) | 基于卫星导航接收机的gnss和mimu组合导航航向角估计方法 | |
US9784841B2 (en) | Method of determining the own-vehicle position of a motor vehicle | |
KR20170110218A (ko) | 차선 별 교통량 측정 방법 및 이를 이용한 지능형 교통정보 제공 시스템 | |
CN103675867B (zh) | 定位单元及其方法 | |
Heirich et al. | Measurement methods for train localization with onboard sensors | |
Ahmed et al. | Minimizing GPS dependency for a vehicle’s trajectory identification by using data from smartphone inertial sensors and onboard diagnostics device | |
KR102599260B1 (ko) | 센서 융합을 이용한 고도 측정 장치 및 방법 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |