CN110597247A - 一种多车辆避障路径规划方法 - Google Patents
一种多车辆避障路径规划方法 Download PDFInfo
- Publication number
- CN110597247A CN110597247A CN201910780078.2A CN201910780078A CN110597247A CN 110597247 A CN110597247 A CN 110597247A CN 201910780078 A CN201910780078 A CN 201910780078A CN 110597247 A CN110597247 A CN 110597247A
- Authority
- CN
- China
- Prior art keywords
- driving
- road section
- road
- selected vehicle
- path
- 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
- 238000000034 method Methods 0.000 title claims abstract description 37
- 230000002457 bidirectional effect Effects 0.000 claims description 9
- 230000008569 process Effects 0.000 abstract description 14
- 238000004364 calculation method Methods 0.000 description 4
- 230000008859 change Effects 0.000 description 4
- 238000004458 analytical method Methods 0.000 description 3
- 230000004888 barrier function Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000011218 segmentation Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Traffic Control Systems (AREA)
Abstract
一种涉及交通领域的一种多车辆避障路径规划方法,所述方法包括:规划选定车辆在目标道路上的行驶路径并存储规划的选定车辆行驶路径至处理器;将目标道路的行驶区域进行区域划分为多个路段区域并根据所述路段区域将规划的选定车辆行驶路径分为多个行驶路段;当车辆行驶到一定路程时,对路段区域进行路障位置查询;根据查询结果及其他车辆行驶路径,判断第二行驶路段上是否存在路障或存在选定车辆与其他车辆碰撞的可能;在查询到第二行驶路段上存在路障或存在选定车辆与其他车辆碰撞的可能的情况下,对第二行驶路段及第三行驶路段进行重新规划并存储至处理器。解决了如何在实际行驶过程中动态调整多辆车的路径从而实现安全驾驶的问题。
Description
技术领域
本发明涉及交通领域,更具体地,涉及一种多车辆避障路径规划方法。
背景技术
自动驾驶技术是目前人工智能方向上的热门研究课题,而避障作为自动驾驶车辆在行驶过程中非常重要的部分。自动驾驶车辆的全局路径规划为车辆规划出了一条在已知环境地图信息下的最优路径,但车辆在前进过程中,处在不可预测和高度动态的城市道路环境中,障碍物很可能出现在已经规划好的全局路径上,也有可能在前进的过程中一些障碍(行人或车辆等)动态地出现在路径上。自动驾驶车辆必须对这些不可预测的事件以某种方式做出反应,进行局部避障,使之仍然能够顺利到达目的地、完成任务。
对比文件CN201811359384.0提出了一种自动驾驶道路规划方法,针对道路规划及避障处理提出了解决方法,但是对比文件仅仅针对了车辆的实时道路避障,但若是在发现障碍之后再做处理会使得车辆的处理时间过于紧迫且处理的动作及难度过大,更进一步的导致车辆行驶过程中安全无法有效保障。在车辆实际行驶过程中,城市道路环境中实际行驶的每一辆车都是另外一辆车前进过程中的障碍物,如何在实际行驶过程中动态调整多辆车的路径从而实现安全驾驶是一个重要的研究课题。
发明内容
本发明旨在克服上述现有技术问题,提供了一种多车辆避障路径规划方法,解决了如何在实际行驶过程中动态调整多辆车的路径从而实现安全驾驶的问题。
一种多车辆避障路径规划方法,其特征在于,所述方法包括:
规划选定车辆在目标道路上的行驶路径并存储规划的选定车辆行驶路径;
将目标道路的行驶区域进行区域划分为多个路段区域并根据所述路段区域将规划的选定车辆行驶路径分为多个行驶路段;
当选定车辆沿规划的选定车辆行驶路径行驶并距离第二行驶路段一定路程时,对区域划分结果内的第二行驶路段对应的路段区域进行路障位置查询;
根据所述路障位置的查询结果及存储的其他车辆行驶路径,判断第二行驶路段上是否存在路障或存在选定车辆与其他车辆碰撞的可能;
在查询到第二行驶路段上存在路障或存在选定车辆与其他车辆碰撞的可能的情况下,对第二行驶路段及第三行驶路段进行重新规划并对第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径进行存储;
其中,所述第二行驶路段为规划的选定车辆行驶路径内的选定车辆的当前行驶路段的下一段行驶路段,所述第三行驶路段为规划的选定车辆行驶路径内的所述第二行驶路段的下一段行驶路段,所述选定车辆行驶路径为选定车辆在目标道路上的移动方位及移动速度,所述其他车辆行驶路径为其他车辆在目标道路上的移动方位及移动速度。
结合常规的规划方式并基于传统规划方式进行了改进,在进行了出发时的规划后对路段区域进行了切割,对即将跨越区域边界的车辆进行规划路线的修正,避免了预判不及时而导致的路线改动不及时;且由于对路线的更改更具前瞻性,可以避免与其它行驶路径存储于处理器中的其他车辆相撞,进而可将重新规划的路线反馈给后续其他跨越的车辆,有效避免了由于规划路线改动而导致的其他自动控制车辆与重新规划路线的车辆相撞,解决了如何在实际行驶过程中动态调整多辆车的路径从而实现安全驾驶的技术问题。
优选的,所述目标道路上设有用于确认路障位置的感应器。
相比较于设置于车辆上的传感器,设置于道路上的传感器可以更稳定地识别路障与车辆的位置。
优选的,所述规划选定车辆在目标道路上的行驶路径并存储规划的选定车辆行驶路径至处理器的步骤具体包括:
查询路障位置;
使用双向RRT算法及差分约束系统结合进入位置、离开位置、路障位置及目标道路的交通规则四个因素对选定车辆行驶路径进行规划;
通过存储的其他车辆行驶路径判断规划的选定车辆行驶路径是否存在与其他车辆碰撞的可能;
若规划的选定车辆行驶路径不存在与其它车辆碰撞的可能,则存储所述规划的选定车辆行驶路径;
其中,所述进入位置为选定车辆在目标道路行驶的起始位置,所述离开位置为选定车辆行驶离开目标道路的位置。
结合双向RRT算法的特性及设定好的交通规则可以设计差分约束系统以高效确定最优的行驶路径,同时可以借由处理器中存储的其他车辆行驶路线可以保证选定车辆沿规划的路线行驶不会与其他已规划车辆相撞。
优选的,所述将目标道路的行驶区域进行区域划分为多个路段区域并根据所述路段区域将规划的选定车辆行驶路径分为多个行驶路段的步骤具体包括:
将所述目标道路的行驶区域的平面区域内的车流行驶方向的垂直方向确定为目标道路的区域切割方向;
根据目标道路的区域切割方向、车流行驶方向、目标道路内的弯道位置及切割范围将所述目标道路的行驶区域切割为多个路段区域;
其中,所述切割范围为路段区域所包含的最大及最小道路长度。
由于道路情况往往并不相同,面对不同道路的切割方式也理应不同,由于针对于路段分析时,相向车道的行车相对独立,分离双向车道的行车区域可以降低路段区域分析的负担和要求,且由于去噪提升了规划的有效性。
优选的,所述当选定车辆沿规划的选定车辆行驶路径行驶并距离第二行驶路段一定路程时,对区域划分结果内的第二行驶路段对应的路段区域进行路障位置查询的步骤具体包括:
定位选定车辆位置并通过所述选定车辆行驶路径计算选定车辆预计进入第二行驶路段所剩余的时间;
判断所述选定车辆预计进入第二行驶路段所剩余的时间是否小于或等于预设的阈值;
在所述选定车辆预计进入第二行驶路段所剩余的时间小于等于预设的阈值的情况下,对区域划分结果内的第二行驶路段对应的路段区域进行路障位置查询。
基于所述方法的分段规划的提前规划,提前规划过早则容易导致规划的有效性大大降低,而过晚则可能使得车辆的位置与规划路线出现冲突,但若设定一定行程内进行提前规划,则针对于不同速度的车辆容易出现规划的前后与进入下一路段的前后并不同步,因此对车辆的速度进行计算进而计算进入下一路段的时间可以解决规划与现实不同步的问题。
优选的,所述在查询到第二行驶路段上存在路障或存在选定车辆与其他车辆碰撞的可能的情况下,对第二行驶路段及第三行驶路段进行重新规划并对第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径进行存储的步骤具体包括:
在查询到第二行驶路段上存在路障或存在选定车辆与其他车辆碰撞的可能的情况下,查询第三行驶路段对应的路段区域的路障位置;
根据存储的其他车辆行驶路径及第二行驶路段及第三行驶路段对应的路段区域的路障位置重新规划第二行驶路段及第三行驶路段;
结合存储的其他车辆行驶路径判断第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径上是否存在选定车辆与其他车辆碰撞的可能;
在第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径存在选定车辆与其他车辆碰撞的可能的情况下,调节第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径的选定车辆在目标道路上的移动速度直到第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径不存在选定车辆与其他车辆碰撞的可能;
对不存在选定车辆与其他车辆碰撞的可能的重新规划后的选定车辆行驶路径进行存储。
在出现需要重新规划的情况下,若仅选择第二行驶路段进行重新规划,由于受限于新增的路障重新规划的难度较大,若同时选择第二行驶路段和第三行驶路段进行重新规划,则重新规划的空间较大且能一定程度上提升重新规划的成功率。
优选的,所述根据存储的其他车辆行驶路径及第二行驶路段及第三行驶路段对应的路段区域的路障位置重新规划第二行驶路段及第三行驶路段的步骤具体包括:
在查询到第二行驶路段上存在路障或存在选定车辆与其他车辆碰撞的可能的情况下,对存储的其他车辆行驶路径进行分析以确认是否存在参照路径;
在存在参照路径的情况下,根据参照路径的出发时间及离开时间选取最优参照路径;
基于所述最优参照路径的移动方位重新规划第二行驶路段及第三行驶路段;
其中,所述出发时间为进入第二行驶路段的时间,所述离开时间为离开第三行驶路段的时间,所述参照路径为与第二行驶路段有相同起始位置并与第三行驶路段有相同离开位置的其他车辆行驶路径包含的部分路段。
若存在参照路径,则在参照路径的基础上进行规划可以有效避免由于重新规划而导致的交通混乱及堵塞,同时基于参照路径的移动方位的路径规划可以避免重复的路径计算,降低了路径的总计算量。
优选的,所述传感器包括红外传感器及压力传感器。
若使用视屏识别则容易出现识别不及时的问题,且若仅是用于识别路障位置,视屏的识别效率及成功率都不高,因此选用压力传感器结合红外传感器对路障进行识别在识别速度和有效性都更为优秀。
与现有技术相比,本发明的有益效果为:
1.通过设计了分段路径分析,解决了如何在实际行驶过程中动态调整多辆车的路径从而实现安全驾驶的问题;
2.基于多段动态调整的基础,设计了鲁棒性更高的步骤流程;
3.设计了用于降低计算量的步骤,避免在多车交互时由于计算量过大而出现的规划混乱;
4.受限于交通规则,基于双向RRT算法的计算量在应用的场景中非常低,同时双向RRT算法的路径规划具有更高的权威性;
5.针对不同场景设计了不同的分段方法,提升了方法的应用场景范围。
附图说明
图1为本发明的流程图。
图2为本发明区域划分的示意图。
图3为本发明重新规划路径的示意图。
具体实施方式
本发明附图仅用于示例性说明,不能理解为对本发明的限制。为了更好说明以下实施例,附图某些部件会有省略、放大或缩小,并不代表实际产品的尺寸;对于本领域技术人员来说,附图中某些公知结构及其说明可能省略是可以理解的。
实施例1
如图1到3所示,本实施例提供了一种多车辆避障路径规划方法,解决了如何在实际行驶过程中动态调整多辆车的路径从而实现安全驾驶的问题。
一种多车辆避障路径规划方法,其特征在于,所述方法包括:
规划选定车辆在目标道路上的行驶路径并存储规划的选定车辆行驶路径;
将目标道路的行驶区域进行区域划分为多个路段区域并根据所述路段区域将规划的选定车辆行驶路径分为多个行驶路段;
当选定车辆沿规划的选定车辆行驶路径行驶并距离第二行驶路段一定路程时,对区域划分结果内的第二行驶路段对应的路段区域进行路障位置查询;
根据所述路障位置的查询结果及存储的其他车辆行驶路径,判断第二行驶路段上是否存在路障或存在选定车辆与其他车辆碰撞的可能;
在查询到第二行驶路段上存在路障或存在选定车辆与其他车辆碰撞的可能的情况下,对第二行驶路段及第三行驶路段进行重新规划并对第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径进行存储;
其中,所述第二行驶路段为规划的选定车辆行驶路径内的选定车辆的当前行驶路段的下一段行驶路段,所述第三行驶路段为规划的选定车辆行驶路径内的所述第二行驶路段的下一段行驶路段,所述选定车辆行驶路径为选定车辆在目标道路上的移动方位及移动速度,所述其他车辆行驶路径为其他车辆在目标道路上的移动方位及移动速度。
结合常规的规划方式并基于传统规划方式进行了改进,在进行了出发时的规划后对路段区域进行了切割,对即将跨越区域边界的车辆进行规划路线的修正,避免了预判不及时而导致的路线改动不及时;且由于对路线的更改更具前瞻性,可以避免与其它行驶路径存储于处理器中的其他车辆相撞,进而可将重新规划的路线反馈给后续其他跨越的车辆,有效避免了由于规划路线改动而导致的其他自动控制车辆与重新规划路线的车辆相撞,解决了如何在实际行驶过程中动态调整多辆车的路径从而实现安全驾驶的技术问题。
在具体实施过程中,所述目标道路上设有用于确认路障位置的感应器。
相比较于设置于车辆上的传感器,设置于道路上的传感器可以更稳定地识别路障与车辆的位置。
具体的,所述规划选定车辆在目标道路上的行驶路径并存储规划的选定车辆行驶路径至处理器的步骤具体包括:
查询路障位置;
使用双向RRT算法及差分约束系统结合进入位置、离开位置、路障位置及目标道路的交通规则四个因素对选定车辆行驶路径进行规划;
通过存储的其他车辆行驶路径判断规划的选定车辆行驶路径是否存在与其他车辆碰撞的可能;
若规划的选定车辆行驶路径不存在与其它车辆碰撞的可能,则存储所述规划的选定车辆行驶路径;
其中,所述进入位置为选定车辆在目标道路行驶的起始位置,所述离开位置为选定车辆行驶离开目标道路的位置。
结合双向RRT算法的特性及设定好的交通规则可以设计差分约束系统以高效确定最优的行驶路径,同时可以借由处理器中存储的其他车辆行驶路线可以保证选定车辆沿规划的路线行驶不会与其他已规划车辆相撞。
具体的,所述将目标道路的行驶区域进行区域划分为多个路段区域并根据所述路段区域将规划的选定车辆行驶路径分为多个行驶路段的步骤具体包括:
将所述目标道路的行驶区域的平面区域内的车流行驶方向的垂直方向确定为目标道路的区域切割方向;
根据目标道路的区域切割方向、车流行驶方向、目标道路内的弯道位置及切割范围将所述目标道路的行驶区域切割为多个路段区域;
其中,所述切割范围为路段区域所包含的最大及最小道路长度。
由于道路情况往往并不相同,面对不同道路的切割方式也理应不同,由于针对于路段分析时,相向车道的行车相对独立,分离双向车道的行车区域可以降低路段区域分析的负担和要求,且由于去噪提升了规划的有效性。
具体的,所述当选定车辆沿规划的选定车辆行驶路径行驶并距离第二行驶路段一定路程时,对区域划分结果内的第二行驶路段对应的路段区域进行路障位置查询的步骤具体包括:
定位选定车辆位置并通过所述选定车辆行驶路径计算选定车辆预计进入第二行驶路段所剩余的时间;
判断所述选定车辆预计进入第二行驶路段所剩余的时间是否小于或等于预设的阈值;
在所述选定车辆预计进入第二行驶路段所剩余的时间小于等于预设的阈值的情况下,对区域划分结果内的第二行驶路段对应的路段区域进行路障位置查询。
设选定车辆的速度为v,剩余路程为s,进入时间为t,则可知:
所以可得
其中t0为预设的阈值。
基于所述方法的分段规划的提前规划,提前规划过早则容易导致规划的有效性大大降低,而过晚则可能使得车辆的位置与规划路线出现冲突,但若设定一定行程内进行提前规划,则针对于不同速度的车辆容易出现规划的前后与进入下一路段的前后并不同步,因此对车辆的速度进行计算进而计算进入下一路段的时间可以解决规划与现实不同步的问题。
具体的,所述在查询到第二行驶路段上存在路障或存在选定车辆与其他车辆碰撞的可能的情况下,对第二行驶路段及第三行驶路段进行重新规划并对第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径进行存储的步骤具体包括:
在查询到第二行驶路段上存在路障或存在选定车辆与其他车辆碰撞的可能的情况下,查询第三行驶路段对应的路段区域的路障位置;
根据存储的其他车辆行驶路径及第二行驶路段及第三行驶路段对应的路段区域的路障位置重新规划第二行驶路段及第三行驶路段;
结合存储的其他车辆行驶路径判断第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径上是否存在选定车辆与其他车辆碰撞的可能;
在第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径存在选定车辆与其他车辆碰撞的可能的情况下,调节第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径的选定车辆在目标道路上的移动速度直到第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径不存在选定车辆与其他车辆碰撞的可能;
对不存在选定车辆与其他车辆碰撞的可能的重新规划后的选定车辆行驶路径进行存储。
在出现需要重新规划的情况下,若仅选择第二行驶路段进行重新规划,由于受限于新增的路障重新规划的难度较大,若同时选择第二行驶路段和第三行驶路段进行重新规划,则重新规划的空间较大且能一定程度上提升重新规划的成功率。
具体的,所述根据存储的其他车辆行驶路径及第二行驶路段及第三行驶路段对应的路段区域的路障位置重新规划第二行驶路段及第三行驶路段的步骤具体包括:
在查询到第二行驶路段上存在路障或存在选定车辆与其他车辆碰撞的可能的情况下,对存储的其他车辆行驶路径进行分析以确认是否存在参照路径;
在存在参照路径的情况下,根据参照路径的出发时间及离开时间选取最优参照路径;
基于所述最优参照路径的移动方位重新规划第二行驶路段及第三行驶路段;
其中,所述出发时间为进入第二行驶路段的时间,所述离开时间为离开第三行驶路段的时间,所述参照路径为与第二行驶路段有相同起始位置并与第三行驶路段有相同离开位置的其他车辆行驶路径包含的部分路段。
若存在参照路径,则在参照路径的基础上进行规划可以有效避免由于重新规划而导致的交通混乱及堵塞,同时基于参照路径的移动方位的路径规划可以避免重复的路径计算,降低了路径的总计算量。
具体的,所述传感器包括红外传感器及压力传感器。
若使用视屏识别则容易出现识别不及时的问题,且若仅是用于识别路障位置,视屏的识别效率及成功率都不高,因此选用压力传感器结合红外传感器对路障进行识别在识别速度和有效性都更为优秀。
显然,本发明的上述实施例仅仅是为清楚地说明本发明技术方案所作的举例,而并非是对本发明的具体实施方式的限定。凡在本发明权利要求书的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明权利要求的保护范围之内。
Claims (8)
1.一种多车辆避障路径规划方法,其特征在于,所述方法包括:
规划选定车辆在目标道路上的行驶路径并存储规划的选定车辆行驶路径;
将目标道路的行驶区域进行区域划分为多个路段区域并根据所述路段区域将规划的选定车辆行驶路径分为多个行驶路段;
当选定车辆沿规划的选定车辆行驶路径行驶并距离第二行驶路段一定路程时,对区域划分结果内的第二行驶路段对应的路段区域进行路障位置查询;
根据所述路障位置的查询结果及存储的其他车辆行驶路径,判断第二行驶路段上是否存在路障或存在选定车辆与其他车辆碰撞的可能;
在查询到第二行驶路段上存在路障或存在选定车辆与其他车辆碰撞的可能的情况下,对第二行驶路段及第三行驶路段进行重新规划并对第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径进行存储;
其中,所述第二行驶路段为规划的选定车辆行驶路径内的选定车辆的当前行驶路段的下一段行驶路段,所述第三行驶路段为规划的选定车辆行驶路径内的所述第二行驶路段的下一段行驶路段,所述选定车辆行驶路径为选定车辆在目标道路上的移动方位及移动速度,所述其他车辆行驶路径为其他车辆在目标道路上的移动方位及移动速度。
2.根据权利要求1所述的一种多车辆避障路径规划方法,其特征在于,所述目标道路上设有用于确认路障位置的感应器。
3.根据权利要求1所述的一种多车辆避障路径规划方法,其特征在于,所述规划选定车辆在目标道路上的行驶路径并存储规划的选定车辆行驶路径的步骤具体包括:
查询路障位置;
使用双向RRT算法及差分约束系统结合进入位置、离开位置、路障位置及目标道路的交通规则四个因素对选定车辆行驶路径进行规划;
通过存储的其他车辆行驶路径判断规划的选定车辆行驶路径是否存在与其他车辆碰撞的可能;
若规划的选定车辆行驶路径不存在与其它车辆碰撞的可能,则存储所述规划的选定车辆行驶路径;
其中,所述进入位置为选定车辆在目标道路行驶的起始位置,所述离开位置为选定车辆行驶离开目标道路的位置。
4.根据权利要求1所述的一种多车辆避障路径规划方法,其特征在于,所述将目标道路的行驶区域进行区域划分为多个路段区域并根据所述路段区域将规划的选定车辆行驶路径分为多个行驶路段的步骤具体包括:
将所述目标道路的行驶区域的平面区域内的车流行驶方向的垂直方向确定为目标道路的区域切割方向;
根据目标道路的区域切割方向、车流行驶方向、目标道路内的弯道位置及切割范围将所述目标道路的行驶区域切割为多个路段区域;
其中,所述切割范围为路段区域所包含的最大及最小道路长度。
5.根据权利要求1所述的一种多车辆避障路径规划方法,其特征在于,所述当选定车辆沿规划的选定车辆行驶路径行驶并距离第二行驶路段一定路程时,对区域划分结果内的第二行驶路段对应的路段区域进行路障位置查询的步骤具体包括:
定位选定车辆位置并通过所述选定车辆行驶路径计算选定车辆预计进入第二行驶路段所剩余的时间;
判断所述选定车辆预计进入第二行驶路段所剩余的时间是否小于或等于预设的阈值;
在所述选定车辆预计进入第二行驶路段所剩余的时间小于等于预设的阈值的情况下,对区域划分结果内的第二行驶路段对应的路段区域进行路障位置查询。
6.根据权利要求1所述的一种多车辆避障路径规划方法,其特征在于,所述在查询到第二行驶路段上存在路障或存在选定车辆与其他车辆碰撞的可能的情况下,对第二行驶路段及第三行驶路段进行重新规划并对第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径进行存储的步骤具体包括:
在查询到第二行驶路段上存在路障或存在选定车辆与其他车辆碰撞的可能的情况下,查询第三行驶路段对应的路段区域的路障位置;
根据存储的其他车辆行驶路径及第二行驶路段及第三行驶路段对应的路段区域的路障位置重新规划第二行驶路段及第三行驶路段;
结合存储的其他车辆行驶路径判断第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径上是否存在选定车辆与其他车辆碰撞的可能;
在第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径存在选定车辆与其他车辆碰撞的可能的情况下,调节第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径的选定车辆在目标道路上的移动速度直到第二行驶路段及第三行驶路段重新规划后的选定车辆行驶路径不存在选定车辆与其他车辆碰撞的可能;
对不存在选定车辆与其他车辆碰撞的可能的重新规划后的选定车辆行驶路径进行存储。
7.根据权利要求6所述的一种多车辆避障路径规划方法,其特征在于,所述根据存储的其他车辆行驶路径及第二行驶路段及第三行驶路段对应的路段区域的路障位置重新规划第二行驶路段及第三行驶路段的步骤具体包括:
在查询到第二行驶路段上存在路障或存在选定车辆与其他车辆碰撞的可能的情况下,对存储的其他车辆行驶路径进行分析以确认是否存在参照路径;
在存在参照路径的情况下,根据参照路径的出发时间及离开时间选取最优参照路径;
基于所述最优参照路径的移动方位重新规划第二行驶路段及第三行驶路段;
其中,所述出发时间为进入第二行驶路段的时间,所述离开时间为离开第三行驶路段的时间,所述参照路径为与第二行驶路段有相同起始位置并与第三行驶路段有相同离开位置的其他车辆行驶路径包含的部分路段。
8.根据权利要求2所述的一种多车辆避障路径规划方法,其特征在于,所述传感器包括红外传感器及压力传感器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910780078.2A CN110597247B (zh) | 2019-08-22 | 2019-08-22 | 一种多车辆避障路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910780078.2A CN110597247B (zh) | 2019-08-22 | 2019-08-22 | 一种多车辆避障路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110597247A true CN110597247A (zh) | 2019-12-20 |
CN110597247B CN110597247B (zh) | 2022-12-06 |
Family
ID=68855297
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910780078.2A Active CN110597247B (zh) | 2019-08-22 | 2019-08-22 | 一种多车辆避障路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110597247B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111061278A (zh) * | 2019-12-31 | 2020-04-24 | 苏州极智嘉机器人有限公司 | 一种路径规划方法、装置、计算机设备及存储介质 |
CN112233445A (zh) * | 2020-09-28 | 2021-01-15 | 上海思寒环保科技有限公司 | 一种智能路障规避方法及系统 |
CN113138598A (zh) * | 2021-03-31 | 2021-07-20 | 深圳市优必选科技股份有限公司 | 一种智能小车的控制方法及智能小车 |
CN114170844A (zh) * | 2021-12-03 | 2022-03-11 | 广东嘉腾机器人自动化有限公司 | 多辆agv同场运行情况下的防碰撞方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101762278A (zh) * | 2010-01-25 | 2010-06-30 | 深圳市凯立德计算机系统技术有限公司 | 一种导航系统进行实时导航的方法及导航系统 |
US20160144859A1 (en) * | 2014-11-21 | 2016-05-26 | Hyundai Motor Company | System and method for autonomous navigation of vehicle |
CN106679685A (zh) * | 2016-12-29 | 2017-05-17 | 鄂尔多斯市普渡科技有限公司 | 一种用于车辆导航的行车路径规划方法 |
CN108257416A (zh) * | 2016-12-28 | 2018-07-06 | 华为技术有限公司 | 路径规划的方法、装置和系统 |
CN108981704A (zh) * | 2018-07-13 | 2018-12-11 | 昆明理工大学 | 一种基于动态步长的目标引力双向rrt路径规划方法 |
CN109000676A (zh) * | 2018-06-22 | 2018-12-14 | 东华大学 | 一种vanet环境下结合预测信息的路径规划方法 |
CN109814580A (zh) * | 2019-04-03 | 2019-05-28 | 深圳市佳顺智能机器人股份有限公司 | 自动导引运输车的避障方法、系统、主机及存储介质 |
CN109887278A (zh) * | 2019-02-25 | 2019-06-14 | 百度在线网络技术(北京)有限公司 | 车辆的路口行车方法、装置和终端 |
CN110027551A (zh) * | 2019-05-09 | 2019-07-19 | 禾多科技(北京)有限公司 | 应用于自动泊车的多车调度方法 |
-
2019
- 2019-08-22 CN CN201910780078.2A patent/CN110597247B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101762278A (zh) * | 2010-01-25 | 2010-06-30 | 深圳市凯立德计算机系统技术有限公司 | 一种导航系统进行实时导航的方法及导航系统 |
US20160144859A1 (en) * | 2014-11-21 | 2016-05-26 | Hyundai Motor Company | System and method for autonomous navigation of vehicle |
CN108257416A (zh) * | 2016-12-28 | 2018-07-06 | 华为技术有限公司 | 路径规划的方法、装置和系统 |
CN106679685A (zh) * | 2016-12-29 | 2017-05-17 | 鄂尔多斯市普渡科技有限公司 | 一种用于车辆导航的行车路径规划方法 |
CN109000676A (zh) * | 2018-06-22 | 2018-12-14 | 东华大学 | 一种vanet环境下结合预测信息的路径规划方法 |
CN108981704A (zh) * | 2018-07-13 | 2018-12-11 | 昆明理工大学 | 一种基于动态步长的目标引力双向rrt路径规划方法 |
CN109887278A (zh) * | 2019-02-25 | 2019-06-14 | 百度在线网络技术(北京)有限公司 | 车辆的路口行车方法、装置和终端 |
CN109814580A (zh) * | 2019-04-03 | 2019-05-28 | 深圳市佳顺智能机器人股份有限公司 | 自动导引运输车的避障方法、系统、主机及存储介质 |
CN110027551A (zh) * | 2019-05-09 | 2019-07-19 | 禾多科技(北京)有限公司 | 应用于自动泊车的多车调度方法 |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111061278A (zh) * | 2019-12-31 | 2020-04-24 | 苏州极智嘉机器人有限公司 | 一种路径规划方法、装置、计算机设备及存储介质 |
CN111061278B (zh) * | 2019-12-31 | 2022-12-30 | 苏州极智嘉机器人有限公司 | 一种路径规划方法、装置、计算机设备及存储介质 |
CN112233445A (zh) * | 2020-09-28 | 2021-01-15 | 上海思寒环保科技有限公司 | 一种智能路障规避方法及系统 |
CN112233445B (zh) * | 2020-09-28 | 2022-03-01 | 上海思寒环保科技有限公司 | 一种智能路障规避方法及系统 |
CN113138598A (zh) * | 2021-03-31 | 2021-07-20 | 深圳市优必选科技股份有限公司 | 一种智能小车的控制方法及智能小车 |
CN114170844A (zh) * | 2021-12-03 | 2022-03-11 | 广东嘉腾机器人自动化有限公司 | 多辆agv同场运行情况下的防碰撞方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110597247B (zh) | 2022-12-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110597247B (zh) | 一种多车辆避障路径规划方法 | |
CN112203918B (zh) | 轨迹规划 | |
JP6911214B1 (ja) | 軌道計画 | |
CN111383474B (zh) | 自动驾驶车辆的决策系统及方法 | |
JP7401650B2 (ja) | 偶発事象対応計画及び安全保障 | |
US11022450B2 (en) | Route planning for an autonomous vehicle | |
US20230347877A1 (en) | Navigation Based on Detected Size of Occlusion Zones | |
CN112498365B (zh) | 基于置信度水平和距离、响应于障碍物的自动驾驶车辆的延迟决策 | |
EP3407329B1 (en) | Driving assistance method and device | |
CN112265542B (zh) | 一种自动驾驶会车场景处理方法及其装置、车辆 | |
RU2744018C1 (ru) | Способ управления вождением и оборудование управления вождением | |
EP2629167B1 (en) | Vehicle system and method for controlling the vehicle system | |
RU2743683C1 (ru) | Способ управления вождением и оборудование управления вождением | |
CN110667578A (zh) | 自动驾驶车辆的横向决策系统及横向决策确定方法 | |
CN111284493A (zh) | 用于控制车辆行驶的装置和方法 | |
CN113936491B (zh) | 一种基于5g网络的自动驾驶路况导航方法、系统及介质 | |
CN110361028B (zh) | 一种基于自动驾驶循迹的路径规划结果生成方法及系统 | |
KR20210109635A (ko) | 진입하거나 진출하는 차량을 검출하기 위한 방법 및 제어 유닛 | |
WO2021261227A1 (ja) | 駐停車地点管理装置、駐停車地点管理方法、車両用装置 | |
CN111731294A (zh) | 行驶控制装置、行驶控制方法以及存储程序的存储介质 | |
CN115140096A (zh) | 一种基于样条曲线与多项式曲线的自动驾驶轨迹规划方法 | |
Neel et al. | Improving bounds on occluded vehicle states for use in safe motion planning | |
JP2020009189A (ja) | 渋滞状態特定方法、渋滞状態特定装置及びコンピュータプログラム | |
CN115056787A (zh) | 自动驾驶的速度决策规划系统、方法及自动驾驶车辆 | |
KR20220136679A (ko) | 주행 제어 장치 및 방법 |
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 |