CN110530378A - 一种基于v2x的map消息集的车辆定位方法 - Google Patents
一种基于v2x的map消息集的车辆定位方法 Download PDFInfo
- Publication number
- CN110530378A CN110530378A CN201910803655.5A CN201910803655A CN110530378A CN 110530378 A CN110530378 A CN 110530378A CN 201910803655 A CN201910803655 A CN 201910803655A CN 110530378 A CN110530378 A CN 110530378A
- Authority
- CN
- China
- Prior art keywords
- lane
- point
- section
- reference point
- location
- 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
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
-
- 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/34—Route searching; Route guidance
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/40—Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P]
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于V2X的MAP消息集的车辆定位方法，其依据MAP消息集，对MAP的节点下的有向路段进行筛选定位计算，再对符合要求的有向路段下的车道进行筛选定位计算，最终输出对应的某一个符合车辆所在位置要求(即符合定位要求)的节点、有向路段、车道的相关信息，供各类V2I应用进行调用；其最大程度的满足了车辆不同道路路型的准确定位要求，从而提高了V2I应用的效率与稳定性，能满足未来V2I应用发展的需求，以更好的适应量产。
Description
技术领域
本发明属于汽车车联网(即V2X)技术领域，具体涉及一种基于V2X的MAP消息集的车 辆定位方法。
背景技术
随着V2X技术的发展以及国家对V2X技术的大力普及，越来越多的V2X应用被挖掘。其中， V2I主要指车与路侧设备互联的一种通信手段，当车辆越来越智能的时候，仅仅只靠单车智 能驾驶已经无法满足复杂环境下的应用与发展了，这个时候就需要通过基础设施的建设， 加强路的智能，通过V2X中的V2I来建立车路协同系统，从而达成一个全新的智能交通系统。 目前各大开发厂商对V2I应用较为广泛的场景有：红绿灯识别提醒、闯红灯预警、逆向车道 预警、实时道路交通信息类预警等等。而这些场景都有一个共同点，那就是必须依赖于路 侧设备向车辆端设备发送的MAP(即地图)消息集而开发的车辆定位方法，MAP消息集包括 地图的若干个节点数据、若干个有向路段数据(包括若干个路段参考点数据、有向路段宽 度等)和若干个车道数据(包括若干个车道参考点数据、车道宽度等)以及其他附属数据。 目前设计的定位方法普遍分为两类：一类是过于简单，只能简单满足直线道路定位，在弯 道定位时往往有较大误差，在复杂密集的道路往往会导致定位错误，存在不能适应各个不 同的道路，不能适应匝道，不能适应弯道，不能适应多交叉路口的情况；另一类是过于复 杂，定位算法过于冗长，复杂度高，容易出错，对设备的要求高，计算量大，不利于车载 端设备的量产，会导致车载端设备为满足性能而成本过高，定位时效性差，往往不能很好 的满足应用的使用要求。
发明内容
本发明的目的是提供一种基于V2X的MAP消息集的车辆定位方法，以最大程度的满足 车辆不同道路路型的准确定位。
本发明所述的基于V2X的MAP消息集的车辆定位方法，由车辆端设备执行，包括：
步骤一、获取MAP消息集和车辆位置信息，然后执行步骤二；
步骤二、判断是否存在未遍历的节点，如果是，则执行步骤三，否则判定车辆不在当 前MAP(即地图)范围内，然后结束；
步骤三、从未遍历的节点中按顺序选取一个节点，然后执行步骤四；
步骤四、判断选取的节点下是否存在未遍历的有向路段，如果是，则执行步骤五，否 则返回执行步骤二；
步骤五、从未遍历的有向路段中按顺序选取一个有向路段，然后执行步骤六；
步骤六、判断选取的有向路段是否符合定位要求，如果是，则执行步骤七，否则返回 执行步骤四；
步骤七、判断选取的有向路段下是否存在未遍历的车道，如果是，则执行步骤八，否 则返回执行步骤四；
步骤八、从未遍历的车道中按顺序选取一个车道，然后执行步骤九；
步骤九、判断选取的车道是否符合定位要求，如果是，则执行步骤十，否则返回执行 步骤七；
步骤十、记录符合定位要求的节点、有向路段和车道的相关数据，然后结束。
优选的，所述选取的有向路段是否符合定位要求的判断方式包括：
S1、判断选取的有向路段的路段参考点数量，如果路段参考点数量小于2，则判定选取 的有向路段不符合定位要求，如果路段参考点数量等于2，则执行S2，否则执行S4；
S2、将两个路段参考点以及车辆位置点带入定位算法中，计算得到路段定位参数Ⅰ， 然后执行S3；
S3、判断路段定位参数Ⅰ是否满足路段定位条件，如果是，则判定选取的有向路段符 合定位要求，否则判定选取的有向路段不符合定位要求；
S4、判断选取的有向路段线是否存在未遍历的路段参考点，如果是，则执行S5，否则 判定选取的有向路段不符合定位要求；
S5、在未遍历的路段参考点中按顺序选取一个路段参考点，同时也选取与该路段参考 点相邻的一个路段参考点，然后执行S6；
S6、将S5中选取的两个相邻的路段参考点以及车辆位置点带入定位算法中，计算得到 路段定位参数Ⅱ，然后执行S7；
S7、判断路段定位参数Ⅱ是否满足路段定位条件，如果是，则判定选取的有向路段符 合定位要求，否则返回执行S4。
优选的，所述选取的车道是否符合定位要求的判断方式包括：
P1、判断选取的车道的车道参考点数量，如果车道参考点数量小于2，则判定选取的车 道不符合定位要求，如果车道参考点数量等于2，则执行P2，否则执行P4；
P2、将两个车道参考点以及车辆位置点带入定位算法中，计算得到车道定位参数Ⅰ， 然后执行P3；
P3、判断车道定位参数Ⅰ是否满足车道定位条件，如果是，则判定选取的车道符合定 位要求，否则判定选取的车道不符合定位要求；
P4、判断选取的车道是否存在未遍历的车道参考点，如果是，则执行P5，否则判定选 取的车道不符合定位要求；
P5、在未遍历的车道参考点中按顺序选取一个车道参考点，同时也选取与该车道参考 点相邻的一个车道参考点，然后执行P6；
P6、将P5中选取的两个相邻的车道参考点以及车辆位置点带入定位算法中，计算得到 车道定位参数Ⅱ，然后执行P7；
P7、判断车道定位参数Ⅱ是否满足车道定位条件，如果是，则判定选取的车道符合定 位要求，否则返回执行P4。
优选的，所述定位算法包括：
第一步、连接输入的两个参考点Point[i]、Point[i+1]以及车辆位置点HV，构成一个 三角形，然后执行第二步；
第二步、根据3个点的经纬度，计算参考点Point[i]到车辆位置点HV的方向角和参考 点Point[i]到参考点Point[i+1]的方向角，然后执行第三步；
第三步、将第二步中计算得到的2个方向角相减并取绝对值，再转换成三角形内角(即 取小于180°的部分)，得到三角形中以参考点Point[i]为顶点的夹角αj，其中， j＝1或2或3或4，然后执行第四步；
第四步、根据3个点的经纬度，计算参考点Point[i+1]到车辆位置点HV的方向角和参 考点Point[i+1]到参考点Point[i]的方向角，然后执行第五步；
第五步、将第四步中计算得到的2个方向角相减并取绝对值，再转换成三角形内角(即 取小于180°的部分)，得到三角形中以参考点Point[i+1]为顶点的夹角βj，然后执行第六 步；
第六步、利用两个参考点Point[i]、Point[i+1]的经纬度值，计算参考点Point[i]到 参考点Point[i+1]的距离dj，然后执行第七步；
第七步、利用距离dj以及夹角αj、βj，根据余弦定理及海伦公式，计算得到车辆位置点HV到两个参考点Point[i]、Point[i+1]连线的距离Lj。
采用“三角形定位计算”的方法，选取两个参考点以及车辆位置点，两两连线，构成一个三角形，通过三角形的各项数学性质，最终计算出我们需要的数值内容(即距离Lj、夹角αj、夹角βj)，其定位计算简单而准确，减少了定位计算量。
优选的，所述路段定位参数Ⅰ包括连接两个路段参考点以及车辆位置点而构成的一个 三角形中，以一个路段参考点为顶点的夹角α1、以另一个路段参考点为顶点的夹角β1以及 车辆位置点到两个路段参考点连线的距离L1；如果α1≤90°且β1≤90°且 则表示路段定位参数Ⅰ满足路段定位条件；所述路段定位参数Ⅱ包括连接所述S5中选取的两个相邻的路段参考点以及车辆位置点而构成的一个三角形中，以相邻的一个路段参考点为顶点的夹角α2、以相邻的另一个路段参考点为顶点的夹角β2以及车辆位置点到两个相邻的路段参考点连线的距离L2；如果α2≤90°且β2≤90°且 则表示路段定位参数Ⅱ满足路段定位条件；其中，LinkWidth表示选取的有向 路段的宽度(由MAP消息集提供)。
优选的，所述车道定位参数Ⅰ包括连接两个车道参考点以及车辆位置点而构成的一个 三角形中，以一个车道参考点为顶点的夹角α3、以另一个车道参考点为顶点的夹角β3以及 车辆位置点到两个车道参考点连线的距离L3；如果α3≤90°且β3≤90°且 则表示车道定位参数Ⅰ满足车道定位条件；所述车道定位参数Ⅱ包括连接所述P5中选取的两个相邻的车道参考点以及车辆位置点而构成的一个三角形中，以相邻的一个车道参考点为顶点的夹角α4、以相邻的另一个车道参考点为顶点的夹角β4以及车辆位置点到两个相邻的车道参考点连线的距离L4；如果α4≤90°且β4≤90°且 则表示车道定位参数Ⅱ满足车道定位条件；其中LaneWidth表示选取的车道 的宽度(由MAP消息集提供)。
本发明依据MAP消息集，对MAP的节点下的有向路段进行筛选定位计算，再对符合要 求的有向路段下的车道进行筛选定位计算，最终输出对应的某一个符合车辆所在位置要求 (即符合定位要求)的节点、有向路段、车道的相关信息，供各类V2I应用进行调用；其最大程度的满足了车辆不同道路路型的准确定位要求，从而提高了V2I应用的效率与稳定性，能满足未来V2I应用发展的需求，以更好的适应量产。
附图说明
图1为本发明的定位流程图。
图2为本发明中对选取的有向路段是否符合定位要求进行判断的流程图。
图3为本发明中对选取的车道是否符合定位要求进行判断的流程图。
图4为本发明中的定位算法的流程图。
图5为本发明中的定位算法的数学模型示意图。
具体实施方式
下面结合附图对本发明作详细说明。
首先，阐述定位算法内容，取MAP消息集中有序且相邻的两个参考点，这两个参考点 可以是任意有向路段的两个参考点，也可以是任意车道上的两个点，设这两个参考点为Point[i]、Point[i+1]，这两个参考点的位置坐标分别是其经纬度值，由MAP消息集提供，设车辆位置点为HV，车辆位置点坐标为其此时的经纬度值，由GPS提供。
如图4、图5所示，该定位算法的具体过程包括：
第一步、连接输入的两个参考点Point[i]、Point[i+1]以及车辆位置点HV，构成一个 三角形，然后执行第二步；
第二步、根据3个点的经纬度，计算参考点Point[i]到车辆位置点HV的方向角和参考 点Point[i]到参考点Point[i+1]的方向角，然后执行第三步；
第三步、将第二步中计算得到的2个方向角相减并取绝对值，再转换成三角形内角(即 取小于180°的部分)，得到三角形中以参考点Point[i]为顶点的夹角αj，其中， j＝1或2或3或4，然后执行第四步；
第四步、根据3个点的经纬度，计算参考点Point[i+1]到车辆位置点HV的方向角和参 考点Point[i+1]到参考点Point[i]的方向角，然后执行第五步；
第五步、将第四步中计算得到的2个方向角相减并取绝对值，再转换成三角形内角(即 取小于180°的部分)，得到三角形中以参考点Point[i+1]为顶点的夹角βj，然后执行第六 步；
第六步、利用两个参考点Point[i]、Point[i+1]的经纬度值，计算参考点Point[i]到 参考点Point[i+1]的距离dj，然后执行第七步；
第七步、利用距离dj以及夹角αj、βj，根据余弦定理及海伦公式，计算得到车辆位置点HV到两个参考点Point[i]、Point[i+1]连线的距离Lj。
确定好定位算法后，将其封装为一个定位算法函数存储在车载端设备内，在车载端设 备收到MAP消息集且解析完成后，根据当前的GPS信息，配合上定位逻辑，不断引用定位 算法函数，从而完成整个定位过程，最终输出定位结果，以供各类V2I应用进行调用。
然后，阐述定位逻辑内容，本发明需要利用定位算法函数，进行节点层筛选、有向路 段层筛选、车道层筛选，最终找到符合要求的MAP定位结果。
如图1、图2、图3所示的基于V2X的MAP消息集的车辆定位方法，由车辆端设备执行，包括：
步骤一、车辆端设备通过V2I方式从路侧设备处获取MAP消息集，通过GPS获取车辆位置信息，然后执行步骤二；
步骤二、判断是否存在未遍历的节点，如果是，则执行步骤三，否则判定车辆不在当 前MAP(即地图)范围内，然后结束；
步骤三、从MAP消息集的未遍历的节点(可能是一个节点，也可能是多个节点)中按顺序选取一个节点，然后执行步骤四；
步骤四、判断选取的节点下是否存在未遍历的有向路段，如果是，则执行步骤五，否 则返回执行步骤二；
步骤五、从选取的节点下的未遍历的有向路段(可能是一个有向路段，也可能是多个 有向路段)中按顺序选取一个有向路段，然后执行步骤六；
步骤六、判断选取的有向路段是否符合定位要求，如果是，则执行步骤七，否则返回 执行步骤四；
步骤七、判断选取的有向路段下是否存在未遍历的车道，如果是，则执行步骤八，否 则返回执行步骤四；
步骤八、从选取的有向路段下的未遍历的车道(可能是一个车道，也可能是多个车道) 中按顺序选取一个车道，然后执行步骤九；
步骤九、判断选取的车道是否符合定位要求，如果是，则执行步骤十，否则返回执行 步骤七；
步骤十、调用用户自定义的数据结构，记录符合定位要求的节点、有向路段和车道的 相关数据，然后结束。
其中，选取的有向路段是否符合定位要求的判断方式包括：
S1、判断选取的有向路段的路段参考点数量，如果路段参考点数量小于2，则判定选取 的有向路段不符合定位要求，如果路段参考点数量等于2，则执行S2，否则(即如果路段 参考点数量大于2)执行S4；
S2、将两个路段参考点以及车辆位置点带入定位算法中，计算得到连接两个路段参考 点以及车辆位置点而构成的一个三角形中，以一个路段参考点为顶点的夹角α1、以另一个 路段参考点为顶点的夹角β1以及车辆位置点到两个路段参考点连线的距离L1，然后执行S3；
S3、判断是否α1≤90°且β1≤90°且如果是，则判定选取的有 向路段符合定位要求，否则判定选取的有向路段不符合定位要求；
S4、判断选取的有向路段是否存在未遍历的路段参考点，如果是，则执行S5，否则判 定选取的有向路段不符合定位要求；
S5、在选取的有向路段的未遍历的路段参考点(可能是一个路段参考点，也可能是多 个路段参考点)中按顺序选取一个路段参考点，同时也选取与该路段参考点相邻的一个路 段参考点，然后执行S6；
S6、将S5中选取的两个相邻的路段参考点以及车辆位置点带入定位算法中，计算得到 连接S5中选取的两个相邻的路段参考点以及车辆位置点而构成的一个三角形中，以相邻的 一个路段参考点为顶点的夹角α2、以相邻的另一个路段参考点为顶点的夹角β2以及车辆位 置点到两个相邻的路段参考点连线的距离L2，然后执行S7；
S7、判断是否α2≤90°且β2≤90°且如果是，则判定选取的有 向路段符合定位要求，否则返回执行S4。
其中，选取的车道是否符合定位要求的判断方式包括：
P1、判断选取的车道的车道参考点数量，如果车道参考点数量小于2，则判定选取的车 道不符合定位要求，如果车道参考点数量等于2，则执行P2，否则(即如果车道参考点数 量大于2)执行P4；
P2、将两个车道参考点以及车辆位置点带入定位算法中，计算得到连接两个车道参考 点以及车辆位置点而构成的一个三角形中，以一个车道参考点为顶点的夹角α3、以另一个 车道参考点为顶点的夹角β3以及车辆位置点到两个车道参考点连线的距离L3，然后执行P3；
P3、判断是否α3≤90°且β3≤90°且如果是，则判定选取的车 道符合定位要求，否则判定选取的车道不符合定位要求；
P4、判断选取的车道是否存在未遍历的车道参考点，如果是，则执行P5，否则判定选 取的车道不符合定位要求；
P5、在选取的车道的未遍历的车道参考点(可能是一个车道参考点，也可能是多个车 道参考点)中按顺序选取一个车道参考点，同时也选取与该车道参考点相邻的一个车道参 考点，然后执行P6；
P6、将P5中选取的两个相邻的车道参考点以及车辆位置点带入定位算法中，计算得到 连接P5中选取的两个相邻的车道参考点以及车辆位置点而构成的一个三角形中，以相邻的 一个车道参考点为顶点的夹角α4、以相邻的另一个车道参考点为顶点的夹角β4以及车辆位 置点到两个相邻的车道参考点连线的距离L4，然后执行P7；
P7、判断是否α4≤90°且β4≤90°且如果是，则判定选取的车 道符合定位要求，否则返回执行P4。
Claims (6)
1.一种基于V2X的MAP消息集的车辆定位方法，由车辆端设备执行，其特征在于，包括：
步骤一、获取MAP消息集和车辆位置信息，然后执行步骤二；
步骤二、判断是否存在未遍历的节点，如果是，则执行步骤三，否则判定车辆不在当前MAP范围内，然后结束；
步骤三、从未遍历的节点中按顺序选取一个节点，然后执行步骤四；
步骤四、判断选取的节点下是否存在未遍历的有向路段，如果是，则执行步骤五，否则返回执行步骤二；
步骤五、从未遍历的有向路段中按顺序选取一个有向路段，然后执行步骤六；
步骤六、判断选取的有向路段是否符合定位要求，如果是，则执行步骤七，否则返回执行步骤四；
步骤七、判断选取的有向路段下是否存在未遍历的车道，如果是，则执行步骤八，否则返回执行步骤四；
步骤八、从未遍历的车道中按顺序选取一个车道，然后执行步骤九；
步骤九、判断选取的车道是否符合定位要求，如果是，则执行步骤十，否则返回执行步骤七；
步骤十、记录符合定位要求的节点、有向路段和车道的相关数据，然后结束。
2.根据权利要求1所述的基于V2X的MAP消息集的车辆定位方法，其特征在于，所述选取的有向路段是否符合定位要求的判断方式包括：
S1、判断选取的有向路段的路段参考点数量，如果路段参考点数量小于2，则判定选取的有向路段不符合定位要求，如果路段参考点数量等于2，则执行S2，否则执行S4；
S2、将两个路段参考点以及车辆位置点带入定位算法中，计算得到路段定位参数Ⅰ，然后执行S3；
S3、判断路段定位参数Ⅰ是否满足路段定位条件，如果是，则判定选取的有向路段符合定位要求，否则判定选取的有向路段不符合定位要求；
S4、判断选取的有向路段是否存在未遍历的路段参考点，如果是，则执行S5，否则判定选取的有向路段不符合定位要求；
S5、在未遍历的路段参考点中按顺序选取一个路段参考点，同时也选取与该路段参考点相邻的一个路段参考点，然后执行S6；
S6、将S5中选取的两个相邻的路段参考点以及车辆位置点带入定位算法中，计算得到路段定位参数II，然后执行S7；
S7、判断路段定位参数II是否满足路段定位条件，如果是，则判定选取的有向路段符合定位要求，否则返回执行S4。
3.根据权利要求2所述的基于V2X的MAP消息集的车辆定位方法，其特征在于，所述选取的车道是否符合定位要求的判断方式包括：
P1、判断选取的车道的车道参考点数量，如果车道参考点数量小于2，则判定选取的车道不符合定位要求，如果车道参考点数量等于2，则执行P2，否则执行P4；
P2、将两个车道参考点以及车辆位置点带入定位算法中，计算得到车道定位参数I，然后执行P3；
P3、判断车道定位参数I是否满足车道定位条件，如果是，则判定选取的车道符合定位要求，否则判定选取的车道不符合定位要求；
P4、判断选取的车道是否存在未遍历的车道参考点，如果是，则执行P5，否则判定选取的车道不符合定位要求；
P5、在未遍历的车道参考点中按顺序选取一个车道参考点，同时也选取与该车道参考点相邻的一个车道参考点，然后执行P6；
P6、将P5中选取的两个相邻的车道参考点以及车辆位置点带入定位算法中，计算得到车道定位参数II，然后执行P7；
P7、判断车道定位参数II是否满足车道定位条件，如果是，则判定选取的车道符合定位要求，否则返回执行P4。
4.根据权利要求2或3所述的基于V2X的MAP消息集的车辆定位方法，其特征在于，所述定位算法包括：
第一步、连接输入的两个参考点Point[i]、Point[i+1]以及车辆位置点HV，构成一个三角形，然后执行第二步；
第二步、根据3个点的经纬度，计算参考点Point[i]到车辆位置点HV的方向角和参考点Point[i]到参考点Point[i+1]的方向角，然后执行第三步；
第三步、将第二步中计算得到的2个方向角相减并取绝对值，再转换成三角形内角，得到三角形中以参考点Point[i]为顶点的夹角αj，其中，j＝1或2或3或4，然后执行第四步；
第四步、根据3个点的经纬度，计算参考点Point[i+1]到车辆位置点HV的方向角和参考点Point[i+1]到参考点Point[i]的方向角，然后执行第五步；
第五步、将第四步中计算得到的2个方向角相减并取绝对值，再转换成三角形内角，得到三角形中以参考点Point[i+1]为顶点的夹角βj，然后执行第六步；
第六步、利用两个参考点Point[i]、Point[i+1]的经纬度值，计算参考点Point[i]到参考点Point[i+1]的距离dj，然后执行第七步；
第七步、利用距离dj以及夹角αj、βj，根据余弦定理及海伦公式，计算得到车辆位置点HV到两个参考点Point[i]、Point[i+1]连线的距离Lj。
5.根据权利要求4所述的基于V2X的MAP消息集的车辆定位方法，其特征在于：所述路段定位参数I包括连接两个路段参考点以及车辆位置点而构成的一个三角形中，以一个路段参考点为顶点的夹角α1、以另一个路段参考点为顶点的夹角β1以及车辆位置点到两个路段参考点连线的距离L1；如果α1≤90°且β1≤90°且则表示路段定位参数I满足路段定位条件；所述路段定位参数II包括连接所述S5中选取的两个相邻的路段参考点以及车辆位置点而构成的一个三角形中，以相邻的一个路段参考点为顶点的夹角α2、以相邻的另一个路段参考点为顶点的夹角β2以及车辆位置点到两个相邻的路段参考点连线的距离L2；如果α2≤90°且β2≤90°且则表示路段定位参数II满足路段定位条件；其中，LinkWidth表示选取的有向路段的宽度。
6.根据权利要求4所述的基于V2X的MAP消息集的车辆定位方法，其特征在于：所述车道定位参数I包括连接两个车道参考点以及车辆位置点而构成的一个三角形中，以一个车道参考点为顶点的夹角α3、以另一个车道参考点为顶点的夹角β3以及车辆位置点到两个车道参考点连线的距离L3；如果α3≤90°且β3≤90°且则表示车道定位参数I满足车道定位条件；所述车道定位参数II包括连接所述P5中选取的两个相邻的车道参考点以及车辆位置点而构成的一个三角形中，以相邻的一个车道参考点为顶点的夹角α4、以相邻的另一个车道参考点为顶点的夹角β4以及车辆位置点到两个相邻的车道参考点连线的距离L4；如果α4≤90°且β4≤90°且则表示车道定位参数II满足车道定位条件；其中LaneWidth表示选取的车道的宽度。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910803655.5A CN110530378B (zh) | 2019-08-28 | 2019-08-28 | 一种基于v2x的map消息集的车辆定位方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910803655.5A CN110530378B (zh) | 2019-08-28 | 2019-08-28 | 一种基于v2x的map消息集的车辆定位方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110530378A true CN110530378A (zh) | 2019-12-03 |
| CN110530378B CN110530378B (zh) | 2021-04-06 |
Family
ID=68665045
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910803655.5A Active CN110530378B (zh) | 2019-08-28 | 2019-08-28 | 一种基于v2x的map消息集的车辆定位方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110530378B (zh) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111006680A (zh) * | 2019-12-04 | 2020-04-14 | 无锡物联网创新中心有限公司 | 一种基于v2i技术的自动驾驶车辆路径规划系统及方法 |
| CN113252050A (zh) * | 2021-06-11 | 2021-08-13 | 天津所托瑞安汽车科技有限公司 | 一种路线匹配方法、装置、设备及存储介质 |
Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP2679955A2 (en) * | 2012-06-28 | 2014-01-01 | Delphi Technologies, Inc. | Map matching method for vehicle safety warning system |
| CN105021202A (zh) * | 2014-04-29 | 2015-11-04 | 高德软件有限公司 | 一种地图匹配方法及设备 |
| CN105206090A (zh) * | 2015-10-13 | 2015-12-30 | 厦门星辰天羽汽车设计有限公司 | 一种车辆定位方法 |
| KR20170040620A (ko) * | 2015-10-05 | 2017-04-13 | 한국전자통신연구원 | 차량의 자율 주행 보조 장치 및 방법 |
| JP2017156704A (ja) * | 2016-03-04 | 2017-09-07 | 三菱電機株式会社 | 基盤的地図データ |
| CN107230375A (zh) * | 2016-03-24 | 2017-10-03 | 北京握奇智能科技有限公司 | 一种车辆定位方法及系统 |
| JP2018036075A (ja) * | 2016-08-29 | 2018-03-08 | 株式会社Ｓｏｋｅｎ | 自車位置特定装置、自車位置特定方法 |
| CN109756867A (zh) * | 2018-12-29 | 2019-05-14 | 广州中国科学院软件应用技术研究所 | 一种基于lte-v的车路协同车载终端应用系统 |
| CN110164166A (zh) * | 2018-02-11 | 2019-08-23 | 北京图森未来科技有限公司 | 一种车辆定位系统、方法和装置 |
-
2019
- 2019-08-28 CN CN201910803655.5A patent/CN110530378B/zh active Active
Patent Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP2679955A2 (en) * | 2012-06-28 | 2014-01-01 | Delphi Technologies, Inc. | Map matching method for vehicle safety warning system |
| CN105021202A (zh) * | 2014-04-29 | 2015-11-04 | 高德软件有限公司 | 一种地图匹配方法及设备 |
| KR20170040620A (ko) * | 2015-10-05 | 2017-04-13 | 한국전자통신연구원 | 차량의 자율 주행 보조 장치 및 방법 |
| CN105206090A (zh) * | 2015-10-13 | 2015-12-30 | 厦门星辰天羽汽车设计有限公司 | 一种车辆定位方法 |
| JP2017156704A (ja) * | 2016-03-04 | 2017-09-07 | 三菱電機株式会社 | 基盤的地図データ |
| CN107230375A (zh) * | 2016-03-24 | 2017-10-03 | 北京握奇智能科技有限公司 | 一种车辆定位方法及系统 |
| JP2018036075A (ja) * | 2016-08-29 | 2018-03-08 | 株式会社Ｓｏｋｅｎ | 自車位置特定装置、自車位置特定方法 |
| CN110164166A (zh) * | 2018-02-11 | 2019-08-23 | 北京图森未来科技有限公司 | 一种车辆定位系统、方法和装置 |
| CN109756867A (zh) * | 2018-12-29 | 2019-05-14 | 广州中国科学院软件应用技术研究所 | 一种基于lte-v的车路协同车载终端应用系统 |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111006680A (zh) * | 2019-12-04 | 2020-04-14 | 无锡物联网创新中心有限公司 | 一种基于v2i技术的自动驾驶车辆路径规划系统及方法 |
| CN111006680B (zh) * | 2019-12-04 | 2020-12-08 | 无锡物联网创新中心有限公司 | 一种基于v2i技术的自动驾驶车辆路径规划系统及方法 |
| CN113252050A (zh) * | 2021-06-11 | 2021-08-13 | 天津所托瑞安汽车科技有限公司 | 一种路线匹配方法、装置、设备及存储介质 |
| CN113252050B (zh) * | 2021-06-11 | 2021-10-29 | 天津所托瑞安汽车科技有限公司 | 一种路线匹配方法、装置、设备及存储介质 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110530378B (zh) | 2021-04-06 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Schroedl et al. | Mining GPS traces for map refinement | |
| Chen et al. | High-precision lane-level road map building for vehicle navigation | |
| US9377313B2 (en) | Methods and systems for creating digital street network database | |
| CN100463009C (zh) | 一种交通信息融合处理方法和系统 | |
| Massow et al. | Deriving HD maps for highly automated driving from vehicular probe data | |
| CN104101353B (zh) | 一种导航方法、装置和实时导航系统 | |
| CN102879003B (zh) | 基于gps终端的面向车辆位置跟踪的地图匹配方法 | |
| US20080262721A1 (en) | Map generation system and map generation method by using GPS tracks | |
| CN109798911A (zh) | 一种用于代客泊车的全局路径规划方法 | |
| CN106931981A (zh) | 一种导航剩余时间的生成方法及装置 | |
| CN107578620B (zh) | 基于车道级系统的道路通行能力的计算方法、系统和装置 | |
| JP2015004814A (ja) | レーン地図生成装置及びプログラム | |
| CN114512007B (zh) | 交叉路口通行协调方法和装置 | |
| CN110174110B (zh) | 地图对应的方法和装置、电子设备、计算机可读介质 | |
| CN104471350A (zh) | 车载用交通信息通知装置 | |
| CN109655055A (zh) | 一种轨检机器人的定位方法 | |
| CN105096590B (zh) | 交通信息生成方法和交通信息生成设备 | |
| CN111982135B (zh) | 一种基于不同协议的地图格式之间的转换方法 | |
| CN109520499B (zh) | 基于车辆gps轨迹数据实现区域实时等时线的方法 | |
| CN106355890A (zh) | 一种对目标车辆分类的判断方法及装置 | |
| CN110530378A (zh) | 一种基于v2x的map消息集的车辆定位方法 | |
| CN103700314A (zh) | 一种位置定位方法、装置及电子地图 | |
| CN107591013A (zh) | 一种同行路线上不同车辆位置信息实时共享方法和系统 | |
| CN111829536A (zh) | 导航地图路网生成方法、装置、存储介质及电子设备 | |
| CN114518122A (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 | ||
| EE01 | Entry into force of recordation of patent licensing contract |
Application publication date: 20191203 Assignee: CHONGQING CHANGAN NEW ENERGY AUTOMOBILE TECHNOLOGY Co.,Ltd. Assignor: Chongqing Changan Automobile Co.,Ltd. Contract record no.: X2021500000014 Denomination of invention: A vehicle location method based on v2x map message set Granted publication date: 20210406 License type: Common License Record date: 20211014 |
|
| EE01 | Entry into force of recordation of patent licensing contract |