CN110979339A - 一种基于v2v的前方道路形态重建方法 - Google Patents

一种基于v2v的前方道路形态重建方法 Download PDF

Info

Publication number
CN110979339A
CN110979339A CN201911169460.6A CN201911169460A CN110979339A CN 110979339 A CN110979339 A CN 110979339A CN 201911169460 A CN201911169460 A CN 201911169460A CN 110979339 A CN110979339 A CN 110979339A
Authority
CN
China
Prior art keywords
road
target vehicle
vehicle
preset threshold
judging
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
Application number
CN201911169460.6A
Other languages
English (en)
Other versions
CN110979339B (zh
Inventor
周琼峰
季丹
唐培培
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing Desai Xiwei Automobile Electronics Co Ltd
Original Assignee
Nanjing Desai Xiwei Automobile Electronics Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nanjing Desai Xiwei Automobile Electronics Co Ltd filed Critical Nanjing Desai Xiwei Automobile Electronics Co Ltd
Priority to CN201911169460.6A priority Critical patent/CN110979339B/zh
Publication of CN110979339A publication Critical patent/CN110979339A/zh
Application granted granted Critical
Publication of CN110979339B publication Critical patent/CN110979339B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/06—Road conditions
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/06—Road conditions
    • B60W40/072—Curvature of the road
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/06—Road conditions
    • B60W40/076—Slope angle of the road
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00—Input parameters relating to overall vehicle dynamics
    • B60W2520/06—Direction of travel
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00—Input parameters relating to overall vehicle dynamics
    • B60W2520/10—Longitudinal speed
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00—Input parameters relating to overall vehicle dynamics
    • B60W2520/10—Longitudinal speed
    • B60W2520/105—Longitudinal acceleration
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2530/00—Input parameters relating to vehicle conditions or values, not covered by groups B60W2510/00 or B60W2520/00

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Mathematical Physics (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Traffic Control Systems (AREA)

Abstract

本发明涉及一种基于V2V的前方道路形态重建方法，包括通过V2V模块实时获取主车四周的目标车辆的行驶信息并保存；根据保存的目标车辆的历史行驶信息，形成目标车辆的航迹，并计算航迹的曲率、航向以及与主车的相对偏移量；根据目标车辆的航迹的曲率、航向、与主车的相对偏移量以及主车和目标车辆的行驶信息判断主车前方一定距离范围内的道路形态，并根据主道路形态建立道路形态地图。本发明通过V2V模块实时获取主车四周的目标车辆的行驶信息，以确定目标车辆的航迹，从而确定主车前方的道路形态，并根据道路形态建立的道路形态地图，为主车的驾驶提供一定的指导作用，解决了连续弯路难以判断前向车辆、计算跟车距离和碰撞时间的问题，保证了行驶安全。

Description

一种基于V2V的前方道路形态重建方法
技术领域
本发明涉及道路安全技术领域，特别是涉及一种基于V2V的前方道路形态重建方法。
背景技术
目前许多智能驾驶辅助***没有地图匹配和道路识别，导致碰撞预警等功能容易误报和漏报。如基于V2X技术的车辆预警***，如果没有地图匹配和道路识别，使其无法识别前方道路形态，从而对车辆行驶状态估计偏差较大；而道路形态未知，导致无法针对复杂路段做出及时的判断，在多目标多场景的预警过程中产生较多的误报。
发明内容
本发明为克服上述现有技术所述的不足，提供一种基于V2V的前方道路形态重建方法。
为解决上述技术问题，本发明的技术方案如下：
一种基于V2V的前方道路形态重建方法，其特征在于，包括如下步骤：
通过V2V模块实时获取主车四周的目标车辆的行驶信息并保存；
根据保存的目标车辆的历史行驶信息，形成目标车辆的航迹，并计算航迹的曲率、航向以及与主车的相对偏移量；
根据目标车辆的航迹的曲率、航向、与主车的相对偏移量以及主车和目标车辆的行驶信息判断主车前方一定距离范围内的道路形态；
根据主车前方一定距离范围内的道路形态建立一定区域内的道路形态地图。
进一步的，作为优选技术方案，判断主车前方一定距离范围内的道路形态具体包括：
计算道路曲率半径，当道路曲率半径大于第一预设阈值时，则判断道路形态为直行道路，否则，判断道路形态为弯曲道路；
当目标车辆的航向角与主车的航向角之差在90°与第二预设阈值之和或之差范围内，或目标车辆的航向角与主车的航向角之差在-90°与第二预设阈值之和或之差范围内时，则判断主车前方一定距离范围内的道路存在交叉路口；
获取目标车辆的高度，根据所述高度计算目标车辆所行驶道路的坡度，当所述坡度大于第三预设阈值时，则判断道路形态为斜坡；
当目标车辆的横摆角速度在第四预设阈值和第五预设阈值之间变化时，则判断道路形态为直行道路，否则，判断道路形态为转弯；并根据车速判断道路形态是否为高速的下匝道。
进一步的，作为优选技术方案，所述道路曲率半径为目标车辆的航迹的曲率的倒数；所述第一预设阈值为2000m；所述第二预设阈值的设置范围为10°-30°；所述第三预设阈值设置范围为1.5°-5°。
进一步的，作为优选技术方案，判断道路为斜坡具体包括：
当目标车辆的高度在一段时间内持续增加，计算的目标车辆所行驶道路的坡度大于第三预设阈值时，则判断道路形态为上坡；
当目标车辆的高度在一段时间内持续下降，计算的目标车辆所行驶道路的坡度大于第三预设阈值时，则判断道路形态为下坡。
进一步的，作为优选技术方案，判断道路为斜坡具体包括：
根据获取的目标车辆的高度，确定目标车辆的高度在一段时间内的变化曲线，当目标车辆的高度变化曲线的斜率大于第三预设阈值时，则判断道路形态为上坡；
目标车辆的高度变化曲线的斜率小于负的第三预设阈值时，则判断道路形态为下坡。
进一步的，作为优选技术方案，判断道路形态为转弯具体包括：目标车辆的横摆角速度小于第四预设阈值，且逐渐减小时，则认为目标车辆进入左转弯，在左转弯的弯道上行驶，判断道路形态为左转弯；
目标车辆的横摆角速度大于第五预设阈值，且逐渐增大时，则认为目标车辆进入右转弯，在右转弯的弯道上行驶，判断道路形态为右转弯。
进一步的，作为优选技术方案，所述第四预设阈值设置范围为-1--5°/s，所述第五预设阈值设置为1-5°/s。
进一步的，作为优选技术方案，所述曲率通过目标车辆的横摆角速度与车速计算；
所述航向为目标车辆的航向角；
所述目标车辆与主车的相对偏移量通过主车与目标车辆的位置信息计算。
进一步的，作为优选技术方案，所述计算目标车辆与主车的相对偏移量具体包括：
以主车为坐标原点建立的相对坐标系；
获取目标车辆在相对坐标系下的坐标；
根据目标车辆的坐标计算目标车辆与主车的相对位置，即为目标车辆与主车的相对偏移量。
进一步的，作为优选技术方案，还包括：
计算主车与多个目标车辆的横向距离，并根据多个横向距离估计当前道路的宽度和车道数量；
计算弯曲道路的长度和曲率，所述曲率通过目标车辆的横摆角速度与车速计算；
所述弯曲道路的长度通过距离主车最近的目标车辆的历史行驶信息积分计算。
与现有技术相比，本发明技术方案的有益效果是：
本发明通过V2V模块实时获取主车四周的目标车辆的行驶信息，以确定目标车辆的航迹，从而确定主车前方的道路形态，并根据道路形态建立的道路形态地图，为主车的驾驶提供一定的指导作用，解决了连续弯路难以判断前向车辆、计算跟车距离和碰撞时间的问题，保证了行驶安全。
附图说明
图1为本发明方法步骤流程图。
图2为本发明以主车为坐标原点建立的相对坐标系示意图。
图3为本发明道路形态示意图。
图4为本发明道路形态示意图。
图5为本发明道路形态示意图。
图6为本发明道路形态示意图。
图7为本发明道路形态示意图。
附图仅用于示例性说明，不能理解为对本专利的限制；为了更好说明本实施例，附图某些部件会有省略、放大或缩小，并不代表实际产品的尺寸；对于本领域技术人员来说，附图中某些公知结构及其说明可能省略是可以理解的；相同或相似的标号对应相同或相似的部件；附图中描述位置关系的用语仅用于示例性说明，不能理解为对本专利的限制。
具体实施方式
下面结合附图对本发明的较佳实施例进行详细阐述，以使本发明的优点和特征更易被本领域技术人员理解，从而对本发明的保护范围作出更为清楚的界定。
实施例1
一种基于V2V的前方道路形态重建方法，如图1所示，包括如下步骤：
S10. 通过V2V模块实时获取主车四周的目标车辆的行驶信息并保存。
所采集的目标车辆的行驶信息包括当前时刻目标车辆位置坐标、车速、加速度、航向角、横摆角速度、数据采集时间等。所采集的范围为V2V模块的通讯范围内。
S20. 根据保存的目标车辆的历史行驶信息，形成目标车辆的航迹，并计算航迹的曲率、航向以及与主车的相对偏移量。
本步骤具体包括：
获取保存的目标车辆的历史行驶信息，对其异常数据进行处理后，形成航迹。
计算航迹的曲率、航向以及与主车的相对偏移量。
具体为：
曲率通过目标车辆的横摆角速度与车速计算。
例如，曲率为横摆角速度与车速之比。
航向为目标车辆的航向角。
目标车辆与主车的相对偏移量通过主车与目标车辆的位置信息计算。
例如，如图2所示：
以主车为坐标原点建立的相对坐标系；
获取目标车辆在相对坐标系下的坐标；
根据目标车辆的坐标计算目标车辆与主车的相对位置，即为目标车辆与主车的相对偏移量。
具体通过以下公式计算：
Figure DEST_PATH_IMAGE001
+
Figure 156528DEST_PATH_IMAGE002
Figure DEST_PATH_IMAGE003
+
Figure 752595DEST_PATH_IMAGE004
Figure DEST_PATH_IMAGE005
=
Figure 698816DEST_PATH_IMAGE006
Figure DEST_PATH_IMAGE007
=
Figure 253294DEST_PATH_IMAGE008
-
Figure DEST_PATH_IMAGE009
Figure 855439DEST_PATH_IMAGE010
=
Figure DEST_PATH_IMAGE011
Figure 786355DEST_PATH_IMAGE012
=
Figure DEST_PATH_IMAGE013
Figure 55925DEST_PATH_IMAGE014
=
Figure DEST_PATH_IMAGE015
Figure 46883DEST_PATH_IMAGE016
=
Figure DEST_PATH_IMAGE017
+
Figure 447909DEST_PATH_IMAGE018
Figure DEST_PATH_IMAGE019
=
Figure 887243DEST_PATH_IMAGE020
Figure DEST_PATH_IMAGE021
其中，（
Figure 306591DEST_PATH_IMAGE022
，
Figure DEST_PATH_IMAGE023
）表示主车的行驶状态，（
Figure 438758DEST_PATH_IMAGE024
，
Figure DEST_PATH_IMAGE025
）表示目标车辆的 行驶状态，
Figure 310768DEST_PATH_IMAGE009
表示主车的车速，
Figure 130956DEST_PATH_IMAGE023
表示主车的航向角，
Figure 906276DEST_PATH_IMAGE026
表示目标车辆的车速，
Figure 583245DEST_PATH_IMAGE025
表示目 标车辆的航向角，
Figure DEST_PATH_IMAGE027
、y表示目标车辆相对于主车的位置分量，
Figure 880235DEST_PATH_IMAGE007
、
Figure 989267DEST_PATH_IMAGE010
表示目标车辆相对于 主车的速度分量，
Figure 399520DEST_PATH_IMAGE012
表示目标车辆相与主车之间的直线距离，
Figure 247390DEST_PATH_IMAGE028
表示目标车辆相对于主车 的方向角，
Figure 93992DEST_PATH_IMAGE016
表示（
Figure 255983DEST_PATH_IMAGE007
，
Figure 5896DEST_PATH_IMAGE010
）在
Figure 24667DEST_PATH_IMAGE012
方向上的分量，
Figure DEST_PATH_IMAGE029
表示主车的车辆长度的一半，
Figure 92986DEST_PATH_IMAGE030
表示 目标车辆的车辆长度的一半，
Figure DEST_PATH_IMAGE031
表示主车与目标车辆的碰撞时间。
S30. 根据目标车辆的航迹的曲率、航向、与主车的相对偏移量以及主车和目标车辆的行驶信息判断主车前方一定距离范围内的道路形态。其中，一定距离范围具体为V2V模块的通讯范围。
判断主车前方一定距离范围内的道路形态具体包括：
S301. 计算道路曲率半径，当道路曲率半径大于第一预设阈值时，则判断道路形态为直行道路，否则，判断道路形态为弯曲道路。其中，第一预设阈值设置为2000m，
如图3-4所示，具体为：
计算道路曲率半径，道路曲率半径为目标车辆的航迹的曲率的倒数；
当道路曲率半径大于第一预设阈值时，则判断道路形态为直行道路，否则，判断道路形态为弯曲道路。
计算当前路段的车道数量和道路宽度；
具体为：通过上述步骤中建立的相对坐标系计算主车与多个目标车辆的横向距离，并根据多个横向距离估计当前道路的宽度和车道数量。
当道路形态为弯曲道路时，还可计算弯曲道路的长度和曲率；其中，曲率通过目标车辆的横摆角速度与车速计算，弯曲道路的长度通过距离主车最近的目标车辆的历史行驶信息积分计算，即得到前方弯曲道路最短长度。
S302. 当目标车辆的航向角与主车的航向角之差在90°与第二预设阈值之和或之差范围内，或目标车辆的航向角与主车的航向角之差在-90°与第二预设阈值之和或之差范围内时，则判断主车前方一定距离范围内的道路存在交叉路口。
如图5-6所示，具体为：
目标车辆的航向角与主车的航向角之差＜90°±第二预设阈值，或目标车辆的航向角与主车的航向角之差＜-90°±第二预设阈值，则判断主车前方一定距离范围内的道路存在交叉路口。其中，第二预设阈值的设置范围为10°-30°，优选的，第二预设阈值的设置为20°。
在本步骤中，还包括判断是否为上下高架，具体包括：
获取目标车辆的高度，根据高度计算目标车辆所行驶道路的坡度，当坡度大于第三预设阈值时，则判断道路形态为斜坡，即上下高架。
判断道路为斜坡具体包括：
当目标车辆的高度在一段时间内持续增加，计算的目标车辆所行驶道路的坡度大于第三预设阈值时，则判断道路形态为上坡。
当目标车辆的高度在一段时间内持续下降，计算的目标车辆所行驶道路的坡度大于第三预设阈值时，则判断道路形态为下坡。
其中，坡度通过目标车辆的行驶距离和高度变化计算。
判断道路为斜坡还可通过以下方式：
根据获取的目标车辆的高度，确定目标车辆的高度在一段时间内的变化曲线，当目标车辆的高度变化曲线的斜率大于第三预设阈值时，则判断道路形态为上坡；
目标车辆的高度变化曲线的斜率小于负的第三预设阈值时，则判断道路形态为下坡。
在上述步骤中，第三预设阈值设置范围为1.5°-5°，优选的，第三预设阈值设置为1°、2°、3°或4°。
S303. 当目标车辆的横摆角速度在第四预设阈值和第五预设阈值之间变化时，则判断道路形态为直行道路，否则，判断道路形态为转弯；并根据车速判断道路形态是否为高速的下匝道。
如图7所示，具体为：
目标车辆的横摆角速度小于第四预设阈值，且逐渐减小时，则认为目标车辆进入左转弯，在左转弯的弯道上行驶，若保持一个较大的负值，如-30~-10°/s之间，判断道路形态为左转弯。
目标车辆的横摆角速度大于第五预设阈值，且逐渐增大时，则认为目标车辆进入右转弯，在右转弯的弯道上行驶，若保持一个较大的正值，如10~30°/s之间，判断道路形态为右转弯。
其中，第四预设阈值设置范围为-1--5°/s，第五预设阈值设置范围为1-5°/s，优选的，第四预设阈值设置为-3°/s，第五预设阈值设置设置为3°/s，而第四预设阈值和第五预设阈值的绝对值相同。
当车速大于第六预设阈值时，则判断车辆行驶在高速路上，判断道路形态为高速的下匝道，其中，第六预设阈值的设置范围为70-90 km/h，优选的第六预设阈值的设置为80km/h。
S40. 根据主车前方一定距离范围内的道路形态建立一定区域内的道路形态地图。
根据道路形态、目标车辆的行驶方向、相应道路形态对应的道路曲率半径、道路宽度、长度、车道数量等相关信息建立一定区域内的道路形态地图，为主车的驾驶提供一定的指导作用。
显然，本发明的上述实施例仅仅是为清楚地说明本发明所作的举例，而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说，在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明权利要求的保护范围之内。

Claims (10)

1.一种基于V2V的前方道路形态重建方法，其特征在于，包括如下步骤：
通过V2V模块实时获取主车四周的目标车辆的行驶信息并保存；
根据保存的目标车辆的历史行驶信息，形成目标车辆的航迹，并计算航迹的曲率、航向以及与主车的相对偏移量；
根据目标车辆的航迹的曲率、航向、与主车的相对偏移量以及主车和目标车辆的行驶信息判断主车前方一定距离范围内的道路形态；
根据主车前方一定距离范围内的道路形态建立一定区域内的道路形态地图。
2.根据权利要求1所述的基于V2V的前方道路形态重建方法，其特征在于，判断主车前方一定距离范围内的道路形态具体包括：
计算道路曲率半径，当道路曲率半径大于第一预设阈值时，则判断道路形态为直行道路，否则，判断道路形态为弯曲道路；
当目标车辆的航向角与主车的航向角之差在90°与第二预设阈值之和或之差范围内，或目标车辆的航向角与主车的航向角之差在-90°与第二预设阈值之和或之差范围内时，则判断主车前方一定距离范围内的道路存在交叉路口；
获取目标车辆的高度，根据所述高度计算目标车辆所行驶道路的坡度，当所述坡度大于第三预设阈值时，则判断道路形态为斜坡；
当目标车辆的横摆角速度在第四预设阈值和第五预设阈值之间变化时，则判断道路形态为直行道路，否则，判断道路形态为转弯，并根据车速判断道路形态是否为高速的下匝道。
3.根据权利要求2所述的基于V2V的前方道路形态重建方法，其特征在于，所述道路曲率半径为目标车辆的航迹的曲率的倒数；所述第一预设阈值为2000m；所述第二预设阈值的设置范围为10°-30°；所述第三预设阈值设置范围为1.5°-5°。
4.根据权利要求2所述的基于V2V的前方道路形态重建方法，其特征在于，判断道路为斜坡具体包括：
当目标车辆的高度在一段时间内持续增加，计算的目标车辆所行驶道路的坡度大于第三预设阈值时，则判断道路形态为上坡；
当目标车辆的高度在一段时间内持续下降，计算的目标车辆所行驶道路的坡度大于第三预设阈值时，则判断道路形态为下坡。
5.根据权利要求2所述的基于V2V的前方道路形态重建方法，其特征在于，判断道路为斜坡具体包括：
根据获取的目标车辆的高度，确定目标车辆的高度在一段时间内的变化曲线，当目标车辆的高度变化曲线的斜率大于第三预设阈值时，则判断道路形态为上坡；
目标车辆的高度变化曲线的斜率小于负的第三预设阈值时，则判断道路形态为下坡。
6.根据权利要求2所述的基于V2V的前方道路形态重建方法，其特征在于，判断道路形态为转弯具体包括：目标车辆的横摆角速度小于第四预设阈值，且逐渐减小时，则认为目标车辆进入左转弯，在左转弯的弯道上行驶，判断道路形态为左转弯；
目标车辆的横摆角速度大于第五预设阈值，且逐渐增大时，则认为目标车辆进入右转弯，在右转弯的弯道上行驶，判断道路形态为右转弯。
7.根据权利要求6所述的基于V2V的前方道路形态重建方法，其特征在于，所述第四预设阈值设置范围为-1--5°/s，所述第五预设阈值设置为1-5°/s。
8.根据权利要求1所述的基于V2V的前方道路形态重建方法，其特征在于，
所述曲率通过目标车辆的横摆角速度与车速计算；
所述航向为目标车辆的航向角；
所述目标车辆与主车的相对偏移量通过主车与目标车辆的位置信息计算。
9.根据权利要求8所述的基于V2V的前方道路形态重建方法，其特征在于，所述计算目标车辆与主车的相对偏移量具体包括：
以主车为坐标原点建立的相对坐标系；
获取目标车辆在相对坐标系下的坐标；
根据目标车辆的坐标计算目标车辆与主车的相对位置，即为目标车辆与主车的相对偏移量。
10.根据权利要求1所述的基于V2V的前方道路形态重建方法，其特征在于，还包括：
计算主车与多个目标车辆的横向距离，并根据多个横向距离估计当前道路的宽度和车道数量；
计算弯曲道路的长度和曲率，所述曲率通过目标车辆的横摆角速度与车速计算；
所述弯曲道路的长度通过距离主车最近的目标车辆的历史行驶信息积分计算。
CN201911169460.6A 2019-11-26 2019-11-26 一种基于v2v的前方道路形态重建方法 Active CN110979339B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911169460.6A CN110979339B (zh) 2019-11-26 2019-11-26 一种基于v2v的前方道路形态重建方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911169460.6A CN110979339B (zh) 2019-11-26 2019-11-26 一种基于v2v的前方道路形态重建方法

Publications (2)

Publication Number Publication Date
CN110979339A true CN110979339A (zh) 2020-04-10
CN110979339B CN110979339B (zh) 2021-03-30

Family

ID=70086813

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911169460.6A Active CN110979339B (zh) 2019-11-26 2019-11-26 一种基于v2v的前方道路形态重建方法

Country Status (1)

Country Link
CN (1) CN110979339B (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112699575A (zh) * 2021-01-22 2021-04-23 中汽创智科技有限公司 一种虚拟车辆测试平台中相对位置测算方法及***
CN113345227A (zh) * 2021-05-31 2021-09-03 上海涵润汽车电子有限公司 一种随机交通流生成方法及装置
CN113568025A (zh) * 2020-10-12 2021-10-29 株式会社电装 基于gnss的车道判别方法及装置
CN113804211A (zh) * 2021-08-06 2021-12-17 荣耀终端有限公司 一种高架识别方法及装置
CN115127562A (zh) * 2021-03-26 2022-09-30 深圳联友科技有限公司 一种道路匹配方法及装置
CN115257771A (zh) * 2022-09-28 2022-11-01 天津所托瑞安汽车科技有限公司 一种路口识别方法、电子设备和存储介质
CN116578891A (zh) * 2023-07-14 2023-08-11 天津所托瑞安汽车科技有限公司 道路信息重构方法、终端及存储介质

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004243903A (ja) * 2003-02-14 2004-09-02 Nissan Motor Co Ltd 車両用走行制御装置
CN104835353A (zh) * 2015-05-04 2015-08-12 南京邮电大学 Vanet中基于ins和gnss伪距双差的协作相对定位方法
EP3121762A1 (en) * 2015-07-20 2017-01-25 Dura Operating, LLC Sensor fusion of camera and v2v data for vehicles
US20190077402A1 (en) * 2017-09-13 2019-03-14 Lg Electronics Inc. Driving assistance apparatus for vehicle and control method thereof

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004243903A (ja) * 2003-02-14 2004-09-02 Nissan Motor Co Ltd 車両用走行制御装置
CN104835353A (zh) * 2015-05-04 2015-08-12 南京邮电大学 Vanet中基于ins和gnss伪距双差的协作相对定位方法
EP3121762A1 (en) * 2015-07-20 2017-01-25 Dura Operating, LLC Sensor fusion of camera and v2v data for vehicles
CN106485949A (zh) * 2015-07-20 2017-03-08 德韧营运有限责任公司 针对车辆的摄像机和v2v数据的传感器融合
US20190077402A1 (en) * 2017-09-13 2019-03-14 Lg Electronics Inc. Driving assistance apparatus for vehicle and control method thereof

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113568025A (zh) * 2020-10-12 2021-10-29 株式会社电装 基于gnss的车道判别方法及装置
CN112699575A (zh) * 2021-01-22 2021-04-23 中汽创智科技有限公司 一种虚拟车辆测试平台中相对位置测算方法及***
CN115127562A (zh) * 2021-03-26 2022-09-30 深圳联友科技有限公司 一种道路匹配方法及装置
CN113345227A (zh) * 2021-05-31 2021-09-03 上海涵润汽车电子有限公司 一种随机交通流生成方法及装置
CN113804211A (zh) * 2021-08-06 2021-12-17 荣耀终端有限公司 一种高架识别方法及装置
CN113804211B (zh) * 2021-08-06 2023-10-03 荣耀终端有限公司 一种高架识别方法及装置
CN115257771A (zh) * 2022-09-28 2022-11-01 天津所托瑞安汽车科技有限公司 一种路口识别方法、电子设备和存储介质
CN116578891A (zh) * 2023-07-14 2023-08-11 天津所托瑞安汽车科技有限公司 道路信息重构方法、终端及存储介质
CN116578891B (zh) * 2023-07-14 2023-10-03 天津所托瑞安汽车科技有限公司 道路信息重构方法、终端及存储介质

Also Published As

Publication number Publication date
CN110979339B (zh) 2021-03-30

Similar Documents

Publication Publication Date Title
CN110979339B (zh) 一种基于v2v的前方道路形态重建方法
CN107646114B (zh) 用于估计车道的方法
CN107702716B (zh) 一种无人驾驶路径规划方法、***和装置
CN107451521B (zh) 车辆车道图估算
DE102006037993B4 (de) Verfahren zum Voraussagen des Pfads eines Host-Fahrzeugs in Bezug auf ein fahrendes entferntes Führungsfahrzeug
EP3644294B1 (en) Vehicle information storage method, vehicle travel control method, and vehicle information storage device
US10796574B2 (en) Driving assistance method and device
EP2461305B1 (en) Road shape recognition device
EP3667638B1 (en) Traffic lane information management method, running control method, and traffic lane information management device
US20120303222A1 (en) Driver assistance system
US20200341474A1 (en) Method and device for generating an autonomous driving trajectory of a vehicle
CN110379203B (zh) 一种行车转向碰撞预警方法
CN107830865B (zh) 一种车辆目标分类方法、装置、***及计算机程序产品
EP3715204A1 (en) Vehicle control device
CN105937912A (zh) 车辆的地图数据处理装置
CN110956810B (zh) 一种基于rsu和v2x的复杂道路前向预警方法
KR20180092101A (ko) Ecu, 상기 ecu를 포함하는 무인 자율 주행 차량, 및 이의 주행 차로 판단 방법
CN113343746A (zh) 用于车辆行驶表面上的车道检测的方法和设备
JP2019109675A (ja) 運転行動データ生成装置、運転行動データベース
KR101503473B1 (ko) 차량의 주행 상황 판단 시스템 및 방법
JP2009075933A (ja) 分岐路内位置演算装置、分岐路内位置演算方法、および、分岐路内位置演算プログラム
JP6941178B2 (ja) 自動運転制御装置及び方法
CN104334428A (zh) 车道标记横穿报警***
Lee et al. Collision risk assessment for possible collision vehicle in occluded area based on precise map
CN115520218A (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