CN107168305A - 路口场景下基于Bezier和VFH的无人车轨迹规划方法 - Google Patents
路口场景下基于Bezier和VFH的无人车轨迹规划方法 Download PDFInfo
- Publication number
- CN107168305A CN107168305A CN201710214224.6A CN201710214224A CN107168305A CN 107168305 A CN107168305 A CN 107168305A CN 201710214224 A CN201710214224 A CN 201710214224A CN 107168305 A CN107168305 A CN 107168305A
- Authority
- CN
- China
- Prior art keywords
- point
- track
- bezier
- vfh
- sector
- 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 28
- 238000013439 planning Methods 0.000 title claims abstract description 26
- 230000004888 barrier function Effects 0.000 claims abstract description 35
- 230000009471 action Effects 0.000 claims abstract description 14
- 238000001514 detection method Methods 0.000 claims abstract description 5
- 238000010586 diagram Methods 0.000 claims description 6
- 239000012634 fragment Substances 0.000 claims description 3
- 239000002245 particle Substances 0.000 claims description 3
- 238000013459 approach Methods 0.000 claims description 2
- 230000007547 defect Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 238000012216 screening Methods 0.000 description 3
- PCTMTFRHKVHKIS-BMFZQQSSSA-N (1s,3r,4e,6e,8e,10e,12e,14e,16e,18s,19r,20r,21s,25r,27r,30r,31r,33s,35r,37s,38r)-3-[(2r,3s,4s,5s,6r)-4-amino-3,5-dihydroxy-6-methyloxan-2-yl]oxy-19,25,27,30,31,33,35,37-octahydroxy-18,20,21-trimethyl-23-oxo-22,39-dioxabicyclo[33.3.1]nonatriaconta-4,6,8,10 Chemical group C1C=C2C[C@@H](OS(O)(=O)=O)CC[C@]2(C)[C@@H]2[C@@H]1[C@@H]1CC[C@H]([C@H](C)CCCC(C)C)[C@@]1(C)CC2.O[C@H]1[C@@H](N)[C@H](O)[C@@H](C)O[C@H]1O[C@H]1/C=C/C=C/C=C/C=C/C=C/C=C/C=C/[C@H](C)[C@@H](O)[C@@H](C)[C@H](C)OC(=O)C[C@H](O)C[C@H](O)CC[C@@H](O)[C@H](O)C[C@H](O)C[C@](O)(C[C@H](O)[C@H]2C(O)=O)O[C@H]2C1 PCTMTFRHKVHKIS-BMFZQQSSSA-N 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 2
- 230000008901 benefit Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 230000008447 perception Effects 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 210000004556 brain Anatomy 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000001149 cognitive effect Effects 0.000 description 1
- 230000009514 concussion Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000011438 discrete method Methods 0.000 description 1
- 238000004387 environmental modeling Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012913 prioritisation Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000000717 retained effect Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000001953 sensory effect Effects 0.000 description 1
- 239000000758 substrate Substances 0.000 description 1
- 238000012360 testing method Methods 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0217—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with energy consumption, time reduction or distance reduction criteria
Abstract
本发明提供一种路口场景下基于Bezier和VFH的无人车轨迹规划方法。包括:1)获取本次轨迹规划的起始点位姿P0(x0,y0,θ0)和目标点位姿P3(x3,y3,θ3);2)采用三阶Bezier曲线模型生成从起始点P0到目标点P3的轨迹簇A1;3)依据最大曲率约束对轨迹簇进行筛选得到轨迹簇A2,对A2进行碰撞检测,得到无碰轨迹簇A3;4)若A3非空,在A3中依据轨迹最平滑原则选择最优轨迹输出给控制层,结束;否则,转步骤5;5)对原始VFH算法中的活动区域进行改善,建立扇形活动区域;6)利用障碍物信息建立栅格图;7)将扇形活动区域划分成多个扇区,判断是否有障碍物;8)与Bezier曲线相结合选择最优轨迹点;9)步骤8生成的离散点集做控制点生成B样条曲线作为无人车最终轨迹。
Description
技术领域
本发明涉及智能交通系统技术领域,特别涉及无人驾驶车辆在路口这样的复杂交通场景下的实时轨迹规划方法。
背景技术
随着汽车产业和计算机技术的飞速发展,无人驾驶车辆在机器人领域里取得了空前的进步。决策系统做为无人驾驶车辆的“大脑”,在感知系统认知周围环境后,需要做出安全可执行的决策,确定当前的有效行为及行为的目标状态,然后规划运动轨迹。路口是交通网络拓扑结构的节点,是交通事故的频发地段。所以,解决无人车在路口处的轨迹规划问题意义重大。经典的轨迹规划方法分为两大类,一类是直接有解析解,基于多项式、正弦曲线、回旋曲线、Bezier曲线等方法确定参数直接生成轨迹的解析解;第二类方法是基于采样的方式生成由离散点组成的轨迹,有A*、RRT、人工势场法,VFH等多种方法解决不同环境中的轨迹规划问题。
Bezier是解析法生成轨迹的典型方法。其优点是在无障碍物或者障碍物稀疏时,生成轨迹快且平滑性好。缺点在于障碍物密集时难于通过调整参数获得有效轨迹[1]。
A*算法是经典的运动规划算法,其优点是具有启发性,能够较快的得到全局最优轨迹,然而其搜索步长难以确定,在复杂并且范围较大的规划环境中效率低下[2]。
RRT算法是由美国UIUC教授S.M.LaValle提出的,该算法在扩展节点时考虑了运动系统的运动学微分方程约束,因此,生成的运动轨迹满足全局最优约束和系统自身微分约束,可见,RRT算法可以很好的解决高维度、动态环境、含有微分约束的运动规划问题,然而,其需要确定的参数数量较多,要达到比较好的规划效果,往往难度较大[3]。
人工势场法是轨迹规划算法中较成熟且高效的规划方法,它将环境信息转化为引力场和斥力场模型。人工势场法的一个缺陷就是当目标在障碍物的影响范围内时,整个势场中除目标点外还可能存在其它的局部极小点,机器人可能陷入局部极小点而不能达到目标点。此外,轨迹经过障碍物附近时由于合力方向变化产生抖动现象。
VFH算法将机器人的工作环境分解为具有二值信息的栅格单元,每个矩形栅格中有一个累积值,表示在此处存在障碍物的可信度,高的累积值表示存在障碍物的可信度高。栅格选得小,环境信息存储量大,决策速度慢;栅格选得大,环境分辨率下降,在障碍物环境中发现轨迹的能力减弱[4]。
VFH算法具有很强的避障能力,能够在复杂多障碍物环境中找到无碰撞的运动轨迹;在路口这样复杂的环境下适合使用栅格图进行环境建模,而VFH算法恰好是基于障碍物栅格表示的运动规划方法;VFH算法的规划空间是连续的,这方便将车辆的运动学约束加进来[5]。
然而,VFH算法是为移动机器人设计的,直接使用在无人驾驶车辆上往往达不到预期的目标,主要有以下三个问题:原始VFH算法是一种基于感知数据的实时运动规划方法,直接使用必然导致运动轨迹不平滑而出现“震荡”现象[6];原始VFH算法活动区域中的部分运动状态点对无人驾驶车辆来讲是不可达的;VFH算法得到的是稀疏的位置点集,缺乏其它运动状态信息,不能引导车辆行驶[7]。
以下给出检索的相关文献:
[1]L.Han,H.Yashiro,H.T.N.Nejad,Q.H.Do,and S.Mita,“Bezier curve basedpath planning for autonomous vehicle in urban environment,”in 2010IEEEIntelligent Vehicles Symposium(IV).IEEE,2010,pp.1036–1042.
[2]Huyn N,Dechter R,Pearl J.Probabilistic analysis of the complexityof A*[J].Artificial Intelligence,1980.15(3):241~254.
[3]La Valle S M,Kuffner J J.Rapidly-exploring random trees:Progressand prospects[C]//4th International Workshop on Algorithmic Foundation ofRobotics.Wellesley,USA:A K Pe-ters,2000:293-308.
[4]J.Borenstein and Y.Koren,“The vector field histogram-fast obstacleavoidance for mobile robots,”IEEE Transactions on Robotics and Automation,vol.7,no.3,pp.278–288,1991.
[5]I.Ulrich and J.Borenstein,“VFH+:Reliable obstacle avoidance forfast mobile robots,”in 1998IEEE International Conference on Robotics andAutomation.IEEE,1998,pp.1572–1577.
[6]I.Ulrich and J.Borenstein,“VFH*:Local obstacle avoidance withlook-ahead verification,”in 2000IEEE International Conference on Robotics andAutomation.IEEE,2000,pp.2505–2511.
[7]D.Jiea,M.Xueming,and P.Kaixiang,“IVFH*:Real-time dynamic obstacleavoidance for mobile robots,”in 2010 11th International Conference on ControlAutomation Robotics and Vision(ICARCV).IEEE,2010,pp.844–847.
发明内容
本发明的目的在于提供一种路口场景下基于Bezier曲线和VFH方法的无人车实时轨迹规划方法,解决上述现有理论与技术上存在的缺陷或不足。本发明用三阶Bezier曲线做为无人驾驶车辆的行驶轨迹;同时对传统VFH算法做出改进,将VFH算法和Bezier曲线相结合,克服VFH算法的缺陷;并且用分层的思想将两种运动规划方法同时用于路口的轨迹规划,划分优先级。
为达到用三阶Bezier曲线做轨迹规划,本发明采用了以下技术方案:
1、路口场景下基于Bezier曲线和VFH方法的无人车实时轨迹规划方法,包括以下步骤:
步骤一,从行为决策层获取当前行为方式及本次轨迹规划的起始点位姿P0(x0,y0,θ0)和目标点位姿P3(x3,y3,θ3);
步骤二,采用三阶Bezier曲线模型生成从起始点P0到目标点P3的轨迹簇A1采用三阶Bezier曲线模型生成从起始点P0到目标点P3的轨迹簇A1,选择4个控制点的三阶Bezier曲线进行规划,根据车辆端点处的最小转弯半径求出P0P1和P2P3的下限,同时我们依据线段|P0P3|的长度确定P0P1和P2P3的上限,在得到控制点P1和P2的范围后,在范围内等间隔离散的取多个不同的P1和P2,得到多组控制点,进而得到多条满足端点曲率约束的几何轨迹,称之为轨迹簇,用A1表示。
步骤三,在得到满足曲率约束的轨迹之后,进行碰撞检测,得到无碰轨迹簇A3。若无碰轨迹簇非空,则顺序进行步骤四。若无碰轨迹簇为空,进入步骤五;
步骤四,选择最优轨迹
在得到满足曲率约束并无碰的轨迹之后,我们需要进一步选择最优轨迹。以轨迹最平滑为标准选择最优轨迹,可抽象成
步骤五,对原始VFH算法中的活动区域进行改善
rmin表示车辆的最小转弯半径,s表示车辆行进过程中的搜索步长;
步骤六,利用障碍物信息建立栅格图
由于障碍物被抽象成一个box,收到的障碍物信息是box的四个角点坐标,因此可根据四个角点建立栅格图,以栅格图正中心为原点建立坐标系,将box的四个角点坐标映射到栅格图坐标系中;
步骤七,将扇形活动区域划分成多个扇区,并判断是否有障碍物占据
对于栅格图上每一个被障碍物占据的栅格,将它们抽象成一个质点,判断该栅格是否落入扇形区域中;若落入,判断是落入到哪一个扇区中,否则认为该障碍物目前不在搜索范围内,最终对每个扇区的被障碍物占据的栅格个数做出统计;
步骤八,与Bezier曲线相结合选择最优轨迹点
如果有多个扇区都是可行的,那么将选择一个最优的扇区所对应的轨迹点,这里主要有两个约束条件来筛选出最优轨迹点。一是考虑车宽,二是考虑目标点位姿。
步骤九,离散点集做控制点生成B样条曲线
B样条的数学模型描述如下:
式中,Pi,n(t)表示第i+1个n阶B样条曲线片段;n表示B样条曲线的阶数;t为参数,取值为[0,1];Pi+k为控制点;Fk,n(t)为B样条基函数。
B样条的数学模型描述如下:
式中,Pi,n(t)表示第i+1个n阶B样条曲线片段;n表示B样条曲线的阶数;t为参数,取值为[0,1];Pi+k为控制点;Fk,n(t)为B样条基函数。
所述的采用三阶Bezier曲线模型生成从起始点P0到目标点P3的轨迹簇A1,选择4个控制点的三阶Bezier曲线进行规划,根据车辆端点处的最小转弯半径求出P0P1和P2P3的下限,同时我们依据线段|P0P3|的长度确定P0P1和P2P3的上限,在得到控制点P1和P2的范围后,在范围内等间隔离散的取多个不同的P1和P2,得到多组控制点,进而得到多条满足端点曲率约束的几何轨迹,称之为轨迹簇,用A1表示。
与Bezier曲线相结合选择最优轨迹点,使其逼近目标点位姿并且轨迹足够平滑,即从A2筛选出最光滑的一条曲线作为参考轨迹,VFH算法搜索轨迹点的过程中,在满足车宽的情况下,总是寻找最贴近参考轨迹的点,即所有可行扇区中离参考轨迹距离最短的点,作为最优轨迹点。
本发明的创新点在于将解析方法(对应Bezier曲线)和离散方法(对应VFH算法)结合起来,使无人车在避障的同时,又能够沿着光滑的路径以期望的位姿达到目标点,避免了无人车驶出路口后由于朝向角的偏差引起震荡。
附图说明
图1是本发明的流程示意图;
图2是三阶贝塞尔曲线的生成示意图;
图3是VFH算法中无人车的活动区域改进示意图;
图4是将障碍物信息映射到栅格图坐标系下的示意图;
图5是将活动区域分成多个扇区,并判断每个扇区是否被障碍物占据的示意图,其中,红色线对应的扇区表示被障碍物占据;
图6是基于贝塞尔曲线选择最优轨迹点的示意图,其中,粗线表示贝塞尔曲线,圆弧上距离该粗线最短的点是最优轨迹点。
具体实施方式
下面结合附图对本发明作进一步说明。
参见图1,基于分层思想的路口运动规划方法分为两部分,包括的各个步骤如下:
1)根据起始点和目标点位姿信息规划Bezier曲线,具体步骤如下:
(1a)从感知处获取起始点和目标点的位姿信息x,y,θ(x坐标,y坐标,朝向角);
(1b)寻找合适的,多种组合的控制点,生成多条Bezier曲线;
Bezier曲线的数学模型如下所示。
Bezier曲线是一种特殊的多项式曲线,假设给定n+1个控制点Pi(i=0,1,....,n),则n阶Bezier曲线可以表示为:
其中bi,n(t)为n阶伯恩斯坦基底多项式,其数学定义为:
其中,n为Bezier曲线的阶数;t是控制参数,取值范围为[0,1];Pi表示第i+1个控制点。参数t在[0,1]范围内连续变化,则得到n阶Bezier曲线。依次连接控制点Pi,得到的凸多边形称之为控制多边形,其中P0和Pn分别为第一个和最后一个控制点,Bezier曲线必然在控制多边形内部。
根据公式1‐1和1‐2,得到3阶Bezier曲线的x,y坐标分别为:
x(t)=x0(1-t)3+3x1t(1-t)2+3x2t2(1-t)+x3t3,t∈[0,1]
y(t)=y0(1-t)3+3y1t(1-t)2+3y2t2(1-t)+y3t3,t∈[0,1]
整理成关于参数的三阶多项式有:
x(t)=[(x3-x0)+3(x1-x2)]t3+3(x0-2x1+x2)t2+3(x1-x0)t+x0,t∈[0,1]
y(t)=[(y3-y0)+3(y1-y2)]t3+3(y0-2y1+y2)t2+3(y1-y0)t+y0,t∈[0,1]
为了表示方便,将公式简化成如下形式:
x(t)=a3t3+a2t2+a1t+a0,t∈[0,1] (1-3)
y(t)=b3t3+b2t2+b1t+b0,t∈[0,1] (1-4)
式中,a3=(x3-x0)+3(x1-x2),a2=3(x0-2x1+x2),a1=3(x1-x0),a0=x0,b3=(y3-y0)+3(y1-y2),b2=3(y0-2y1+y2),b1=3(y1-y0),b0=y0。
三阶Bezier曲线的斜率曲线为:
曲率曲线为:
根据图2,已知起始点位姿P0(x0,y0,θ0)和目标点位姿P3(x3,y3,θ3),现确定另外两个控制点P1(x1,y1)和P2(x2,y2)的选取范围:由公式(1-6)可求得起始点P0处的曲率为
目标点P3处的曲率为
随着|P0P1|和|P2P3|的增大,轨迹端点处的曲率半径也会随之增大,所以车辆端点处的最小转弯半径对应着|P0P1|和|P2P3|的下限。即
其中,rmin表示车辆的最小转弯半径。同时,我们依据线段P0P3的长度确定|P0P1|和|P2P3|的上限,即|P0P1|≤|P0P3|及|P2P3|≤|P0P3|。因此我们可以确定控制点的选择有如下约束:
l1≤|P0P1|≤l3,l2≤|P2P3|≤l3
现对|P0P1|和|P2P3|的取值范围三等分,可以得到4个控制点,即P1(x1,y1)和P2(x2,y2)各有4种取值,用公式表示如下:
对于P1,有:
对于P2,有:
由于P1和P2各有4种取值,因此有4x4=16种组合的控制点,对应的有16条Bezier曲线。若将|P0P1|和|P2P3|的取值范围n等分,可以得到n+1个控制点,对应的有(n+1)2条Bezier曲线。
得到每组控制点后,可以计算出参数方程(1-3)、(1-4)的系数a0,a1,a2,a3以及b0,b1,b2,b3,从而得到Bezier曲线方程,即无人车辆的轨迹方程。
(1c)通过曲率约束对多条Bezier曲线进行筛选;
得到候选轨迹簇之后,需要依据最大曲率约束对轨迹簇进行筛选,因为在某一条轨迹上存在最小转弯半径小于车辆的固有转弯半径(低速下是个定值)的点,那么该轨迹对车辆来讲是不可行的。由于每一条轨迹都是用位置点集表示的,可根据公式
计算出每一个点的曲率,从而得到每个点的曲率半径
然后判断曲线是否存在某点的曲率半径满足
r≤rmin
若满足,则该曲线是不可行的,舍弃该曲线;否则,保留该曲线。
(1d)通过碰撞检测对多条Bezier曲线再一次进行筛选;
通过步骤(1c)筛选后的轨迹,考虑到车辆行进过程中需要避开障碍物,因此还需要对轨迹进一步做碰撞检测,选出无碰的轨迹。
(1e)若经过(1c)、(1d)步骤筛选后已无剩下Bezier曲线,则认为Bezier曲线规划路口可行轨迹失败,转用VFH与Bezier曲线相结合的方法;否则,通过轨迹最平滑准则在剩余的曲线里筛选出最优的轨迹。
若步骤(1d)筛选后还有满足要求的曲线,那么我们需要选择一条最优的曲线做为车辆最终的轨迹;现我们以轨迹最平滑为准则,选出最优轨迹。
首先,根据公式
计算出每一个点的曲率κ,然后根据公式
可以得到曲率平方和最小的那条曲线,该曲线就是最平滑的曲线,同时也是满足曲率要求,无碰的可行轨迹。
2)若Bezier曲线簇都不满足以上约束,导致不存在期望的轨迹,则用VFH算法与Bezier曲线相结合的算法规划轨迹,具体步骤如下:
(2a)根据车辆运动学模型确定车辆的活动区域;
由图3可知,根据车辆的最小转弯半径rmin以及搜索步长s,可以得到活动区域在车体当前位姿下的极坐标表示:
P表示以车辆后轴中心为坐标原点,航向角方向为零度的极坐标系;
ρ表示活动区域的距离范围,并且有ρ∈[0,ρmax],ρmax表示最大活动距离;
表示活动区域的角度范围,并且有:
则搜索到的轨迹点必然在弧线上。
(2b)从传感器获取障碍物信息建立栅格图;
由于VFH算法是用栅格图来表征环境的,因此获取障碍物信息后需要以栅格图的形式表现出来。
障碍物可以看成是一个box,因此从传感器处收到的是该box的四个角点坐标,现需要根据这4个坐标点将障碍物映射到栅格图坐标系中。
如图4所示,以车体的朝向为X轴正方向,车的后轴中心点为坐标系原点建立右手坐标系做为栅格图坐标系。假设该栅格图的尺寸是GridM*GridN,即有GridM行,GridN列;且分辨率是Ratio,即每个栅格的长宽都是Ratio;4个角点坐标分别是(x1,y1)、(x2,y2)、(x3,y3)、(x4,y4)。首先获得包围box的虚线框,步骤如下:令
xmin=min{x1,x2,x3,x4},xmax={x1,x2,x3,x4}
ymin=min{y1,y2,y3,y4},ymax=max{y1,y2,y3,y4}
可以通过如下公式
计算出虚线框在栅格图上的位置。其中,Rowmin表示虚线框所占据的行的最小值,Rowmax表示所占据的行的最大值;Colmin表示虚线框所占据的列的最小值,Colmax表示所占据的列的最大值。[]符号表示向下取整,比如[1.5]=1。
计算出Rowmin、Rowmax、Colmin、Colmax后,我们就知道了虚线框所包含的每一个栅格的位置。接下来要做的是判断虚线框里的每一个栅格是否落在box内,具体方法是判断每一个栅格的四个角点是否存在一个或多个点落入到box内;若存在,则认为该栅格是被障碍物占据的,相应的值用1表示;若不存在,则该栅格未被障碍物占据,相应的值用0表示。
现介绍如何判断一个点是否落入到凸四边形内。假设该凸四边形为ABCD,且ABCD为顺时针,待判断的点为M,则需要满足:
ABxAM>0,BCxBM>0,CDxCM>0,DAxDM>0
即可证明点M在凸四边形内部。
计算出每个栅格对应的0‐1值,相当于建立起了栅格图。
(2c)将活动区域分成多个扇区,并判断每个扇区是否有障碍物占据;
假设活动区域的角度为ω,将活动区域分成k个扇区,如图5所示,则每个扇区的角度为w/k。
现判断每个被障碍物占据的栅格是否在某个扇区内,具体步骤为:将每个栅格抽象成质点,可以是每个栅格的中心点,假设该栅格处于第Row行,第Col列,则该栅格的坐标点(x,y)为:
从而可以计算出该栅格与车体的距离,若该距离小于搜索步长s,则用角度继续判断是否在扇区内:计算该栅格坐标点与车体坐标点连线所形成的与X轴的夹角,假设为θ,若则证明该栅格确实在活动区域内,然后通过下式
计算出具体位于哪个扇区(n表示第n个扇区,n=0,1,2,.....,k)。最后对每个扇区的被障碍物占据的栅格个数做统计,若某个扇区的该数值大于0,则认为有障碍物占据,是不可行的;否则认为是可行的扇区。
(2d)考虑车宽对可行扇区进行筛选;
一般每个扇区对应的弧长只有0.42m左右,而车宽有2m,这意味着若车选择了该扇区,虽然该扇区没有障碍物,但邻近扇区有障碍物依旧有可能产生碰撞,因此选择扇区时应考虑车宽。根据计算可知,5个扇区对应的弧长大于2m,又由于车体的对称性,选择的可行扇区需满足其左边相邻的两个扇区与右边相邻的两个扇区也是可行的。
(2e)用Bezier曲线做为参考曲线选择最优扇区;
经过(2d)步骤后,选出的满足上述条件的扇区可能有多个,因此我们选择用Bezier曲线做为参考曲线选择最优扇区。首先根据起始点和目标点的位姿以及轨迹最平滑准则选出一条最平滑的Bezier曲线做为参考曲线,如图6所示,具体过程可参照(1)中的步骤;由于每个扇区都对应一个轨迹点,对于每一个满足(2d)条件的扇区,都可以通过其对应的轨迹点算出该点距离Bezier曲线的最短距离(由于Bezier曲线是用点集表示,计算最短距离时可先计算轨迹点距离曲线上每一个点的距离,然后在这些距离里取最短距离)。假设Bezier曲线由n个点表示,满足(2d)条件的扇区有m个,对于每一个扇区,可以计算出该扇区对于参考线的最短距离
di,min=min{di,1,di,2,....,di,n},i=1,2,...,m
其中,i表示第i个满足(2d)条件的扇区,di,n表示第i个扇区对参考线上第n个点的距离,di,min表示第i个扇区距离参考线的最短距离。最后,我们可以通过公式
k=argmin(di,min),k=1,2,3,...,m
计算出哪个扇区是距离参考线最短,并认为该扇区是最优扇区,该扇区对应的轨迹点是最优轨迹点。
(2f)离散位置点集做控制点生成B样条曲线;
由(2e)步骤得到的轨迹点属于位置点集,无朝向角、速度等信息,而且点比较稀疏,无法做为车辆的可行轨迹。这里依据位置点集生成B样条曲线的方式生成可行驶路径。根据上述的B样条数学模型,取n=3,k=3带入公式(2-1)和(2-2)中得到三阶B样条曲线的基函数为:
现将位置点集做为B样条曲线的控制点即可得到最终轨迹,该轨迹含有位置信息,航向角信息和曲率信息,可以做为无人驾驶车辆的可行路径。
我们分别验证了路口存在单障碍物以及多障碍物时该路径规划算法的有效性。实验结果显示,无人车在遇到障碍物时能够有效避障并保持安全距离,绕过障碍物后在Bezier曲线的约束下能够按照期望的目标位姿回到目标点上,该算法实时有效。
Claims (4)
1.路口场景下基于Bezier和VFH的无人车轨迹规划方法,其特征在于:包括以下步骤:
步骤一:从行为决策层获取当前行为方式及本次轨迹规划的起始点位姿P0(x0,y0,θ0)和目标点位姿P3(x3,y3,θ3);
步骤二:采用三阶Bezier曲线模型生成从起始点P0到目标点P3的轨迹簇A1;
步骤三:依据最大曲率约束对轨迹簇A1进行筛选得到轨迹簇A2,对A2进行碰撞检测,得到无碰轨迹簇A3;
步骤四:若A3非空,在A3中依据轨迹最平滑原则选择最优轨迹输出给控制层,结束;否则,转步骤5;
以轨迹最平滑为标准选择最优轨迹,可抽象成
<mrow>
<msub>
<mi>tra</mi>
<mrow>
<mi>o</mi>
<mi>p</mi>
<mi>t</mi>
<mi>i</mi>
<mi>m</mi>
<mi>a</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>arg</mi>
<mi>min</mi>
<munder>
<mo>&Sigma;</mo>
<mrow>
<msub>
<mi>tra</mi>
<mi>i</mi>
</msub>
</mrow>
</munder>
<msup>
<mi>&kappa;</mi>
<mn>2</mn>
</msup>
</mrow>
步骤五:对原始VFH算法中的活动区域进行改善,建立扇形活动区域;
rmin表示车辆的最小转弯半径,s表示车辆行进过程中的搜索步长;
步骤六:利用障碍物信息建立栅格图;
由于障碍物被抽象成一个box,收到的障碍物信息是box的四个角点坐标,因此可根据四个角点建立栅格图,以栅格图正中心为原点建立坐标系,将box的四个角点坐标映射到栅格图坐标系中;
步骤七:将扇形活动区域划分成多个扇区,并判断是否有障碍物占据;
对于栅格图上每一个被障碍物占据的栅格,将它们抽象成一个质点,判断该栅格是否落入扇形区域中;若落入,判断是落入到哪一个扇区中,否则认为该障碍物目前不在搜索范围内,最终对每个扇区的被障碍物占据的栅格个数做出统计;
步骤八:与Bezier曲线相结合选择最优轨迹点,使其逼近目标点位姿并且轨迹足够平滑;
步骤九:步骤八生成的离散点集做控制点生成B样条曲线做为无人车最终轨迹;
给定m+n+1个控制点Pi(i=0,1,..,m+n),根据B样条的数学模型构造m+1段n次B样条曲线;依次拼接全部曲线段,所组成的整条曲线就是n次B样条曲线;依次连接所有控制点所组成的多边形称为B样条曲线的特征多边形。
2.根据权利要求1所述的路口场景下基于Bezier和VFH的无人车轨迹规划方法,其特征在于,B样条的数学模型描述如下:
式中,Pi,n(t)表示第i+1个n阶B样条曲线片段;n表示B样条曲线的阶数;t为参数,取值为[0,1];Pi+k为控制点;Fk,n(t)为B样条基函数。
3.根据权利要求1所述的路口场景下基于Bezier和VFH的无人车轨迹规划方法,其特征在于,所述的采用三阶Bezier曲线模型生成从起始点P0到目标点P3的轨迹簇A1,选择4个控制点的三阶Bezier曲线进行规划,根据车辆端点处的最小转弯半径求出P0P1和P2P3的下限,同时我们依据线段|P0P3|的长度确定P0P1和P2P3的上限,在得到控制点P1和P2的范围后,在范围内等间隔离散的取多个不同的P1和P2,得到多组控制点,进而得到多条满足端点曲率约束的几何轨迹,称之为轨迹簇,用A1表示。
4.根据权利要求1所述的路口场景下基于Bezier和VFH的无人车轨迹规划方法,其特征在于,与Bezier曲线相结合选择最优轨迹点,使其逼近目标点位姿并且轨迹足够平滑,即从A2筛选出最光滑的一条曲线作为参考轨迹,VFH算法搜索轨迹点的过程中,在满足车宽的情况下,总是寻找最贴近参考轨迹的点,即所有可行扇区中离参考轨迹距离最短的点,作为最优轨迹点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710214224.6A CN107168305B (zh) | 2017-04-01 | 2017-04-01 | 路口场景下基于Bezier和VFH的无人车轨迹规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710214224.6A CN107168305B (zh) | 2017-04-01 | 2017-04-01 | 路口场景下基于Bezier和VFH的无人车轨迹规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107168305A true CN107168305A (zh) | 2017-09-15 |
CN107168305B CN107168305B (zh) | 2020-03-17 |
Family
ID=59849636
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710214224.6A Expired - Fee Related CN107168305B (zh) | 2017-04-01 | 2017-04-01 | 路口场景下基于Bezier和VFH的无人车轨迹规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107168305B (zh) |
Cited By (43)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107963077A (zh) * | 2017-10-26 | 2018-04-27 | 东软集团股份有限公司 | 一种车辆通过路口的控制方法、装置及系统 |
CN108121347A (zh) * | 2017-12-29 | 2018-06-05 | 北京三快在线科技有限公司 | 用于控制设备运动的方法、装置及电子设备 |
CN108549385A (zh) * | 2018-05-22 | 2018-09-18 | 东南大学 | 一种结合a*算法和vfh避障算法的机器人动态路径规划方法 |
CN109375632A (zh) * | 2018-12-17 | 2019-02-22 | 清华大学 | 自动驾驶车辆实时轨迹规划方法 |
CN109434831A (zh) * | 2018-11-12 | 2019-03-08 | 深圳前海达闼云端智能科技有限公司 | 机器人运行方法、装置、机器人、电子设备及可读介质 |
CN109471441A (zh) * | 2018-12-11 | 2019-03-15 | 湖南三智能控制设备有限公司 | 路面机械设备及其上线规划方法、系统和可读存储介质 |
CN109557912A (zh) * | 2018-10-11 | 2019-04-02 | 同济大学 | 一种自动驾驶特种作业车辆的决策规划方法 |
CN109656250A (zh) * | 2018-12-26 | 2019-04-19 | 芜湖哈特机器人产业技术研究院有限公司 | 一种激光叉车的路径跟踪方法 |
CN109668569A (zh) * | 2018-12-08 | 2019-04-23 | 华东交通大学 | 一种智能驾驶中路径快速生成方法 |
CN109885891A (zh) * | 2019-01-24 | 2019-06-14 | 中国科学院合肥物质科学研究院 | 一种智能车gpu并行加速轨迹规划方法 |
CN109902141A (zh) * | 2017-12-08 | 2019-06-18 | 三星电子株式会社 | 运动规划的方法和自主代理 |
CN109947112A (zh) * | 2019-04-04 | 2019-06-28 | 大连理工大学 | 两轮自平衡车直线定点运动的最优时间轨迹规划方法 |
CN110427046A (zh) * | 2019-07-26 | 2019-11-08 | 沈阳航空航天大学 | 一种三维平滑随机游走无人机群移动模型 |
CN110440806A (zh) * | 2019-08-12 | 2019-11-12 | 苏州寻迹智行机器人技术有限公司 | 一种激光与二维码融合的agv精确定位方法 |
CN110502010A (zh) * | 2019-08-15 | 2019-11-26 | 同济大学 | 一种基于贝塞尔曲线的移动机器人室内自主导航控制方法 |
CN110553660A (zh) * | 2019-08-31 | 2019-12-10 | 武汉理工大学 | 一种基于a*算法和人工势场的无人车轨迹规划方法 |
CN110657814A (zh) * | 2018-06-29 | 2020-01-07 | 比亚迪股份有限公司 | 轨迹规划方法和装置、车辆及其控制方法和系统 |
CN110730934A (zh) * | 2018-08-01 | 2020-01-24 | 深圳市大疆创新科技有限公司 | 轨迹切换的方法和装置 |
CN110865642A (zh) * | 2019-11-06 | 2020-03-06 | 天津大学 | 一种基于移动机器人的路径规划方法 |
CN110908373A (zh) * | 2019-11-11 | 2020-03-24 | 南京航空航天大学 | 一种基于改进人工势场的智能车辆轨迹规划方法 |
CN111189453A (zh) * | 2020-01-07 | 2020-05-22 | 深圳南方德尔汽车电子有限公司 | 基于Bezier全局路径规划方法、装置、计算机设备及存储介质 |
CN111523719A (zh) * | 2020-04-16 | 2020-08-11 | 东南大学 | 一种基于铰接车辆运动学约束的混合路径规划方法 |
CN111599179A (zh) * | 2020-05-21 | 2020-08-28 | 北京航空航天大学 | 一种基于风险动态平衡的无信号交叉口自动驾驶运动规划方法 |
CN111615618A (zh) * | 2018-12-26 | 2020-09-01 | 百度时代网络技术(北京)有限公司 | 用于自动驾驶车辆的高速规划的基于多项式拟合的参考线平滑方法 |
CN111656420A (zh) * | 2018-01-18 | 2020-09-11 | 株式会社电装 | 交叉点内的行驶轨道数据生成装置、交叉点内的行驶轨道数据生成程序以及存储介质 |
CN111707269A (zh) * | 2020-06-23 | 2020-09-25 | 东南大学 | 一种三维环境下的无人机路径规划方法 |
CN111750859A (zh) * | 2020-05-29 | 2020-10-09 | 广州极飞科技有限公司 | 过渡路径规划方法及相关装置 |
WO2020220604A1 (zh) * | 2019-04-30 | 2020-11-05 | 南京航空航天大学 | 一种多agv系统动态障碍物实时避障方法及避障系统 |
CN112099493A (zh) * | 2020-08-31 | 2020-12-18 | 西安交通大学 | 一种自主移动机器人轨迹规划方法、系统及设备 |
CN112129291A (zh) * | 2020-08-26 | 2020-12-25 | 南京航空航天大学 | 一种基于Bezier曲线的固定翼无人机航迹优化方法 |
CN112132869A (zh) * | 2020-11-02 | 2020-12-25 | 中远海运科技股份有限公司 | 一种车辆目标轨迹跟踪方法和装置 |
CN112269965A (zh) * | 2020-08-10 | 2021-01-26 | 中国北方车辆研究所 | 一种非完整约束条件下的连续曲率路径优化方法 |
CN113165652A (zh) * | 2018-11-09 | 2021-07-23 | 伟摩有限责任公司 | 使用基于网格的方法检验预测轨迹 |
CN113442140A (zh) * | 2021-06-30 | 2021-09-28 | 同济人工智能研究院(苏州)有限公司 | 一种基于Bezier寻优的笛卡尔空间避障规划方法 |
CN113467498A (zh) * | 2021-07-14 | 2021-10-01 | 西北工业大学 | 一种基于Bezier-凸优化的运载火箭上升段轨迹规划方法 |
CN113495562A (zh) * | 2021-06-07 | 2021-10-12 | 深圳市道通智能汽车有限公司 | 仿真路径生成方法、装置、设备以及计算机存储介质 |
CN114038203A (zh) * | 2022-01-12 | 2022-02-11 | 成都四方伟业软件股份有限公司 | 一种交通仿真中两点路口车道的曲线拟合方法及装置 |
CN114184206A (zh) * | 2021-12-03 | 2022-03-15 | 北京车慧达科技有限公司 | 一种基于车辆轨迹点生成行驶路线的方法和装置 |
CN115520218A (zh) * | 2022-09-27 | 2022-12-27 | 李晓赫 | 自动驾驶车辆四点转弯轨迹规划方法 |
WO2023070258A1 (zh) * | 2021-10-25 | 2023-05-04 | 华为技术有限公司 | 一种车辆的轨迹规划方法、装置及车辆 |
WO2023124339A1 (zh) * | 2021-12-29 | 2023-07-06 | 灵动科技(北京)有限公司 | 路径规划方法、运动控制方法及计算机程序产品 |
CN117533354A (zh) * | 2023-12-28 | 2024-02-09 | 安徽蔚来智驾科技有限公司 | 轨迹生成方法、行驶控制方法、存储介质及智能设备 |
CN114184206B (zh) * | 2021-12-03 | 2024-04-19 | 北京车慧达科技有限公司 | 一种基于车辆轨迹点生成行驶路线的方法和装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20120098152A (ko) * | 2011-02-28 | 2012-09-05 | 한국과학기술연구원 | 이동 로봇의 경로 생성 시스템 |
CN104133473A (zh) * | 2008-10-24 | 2014-11-05 | 格瑞股份公司 | 自主驾驶车辆的控制方法 |
CN106313047A (zh) * | 2016-09-28 | 2017-01-11 | 华中科技大学 | 一种基于Bezier样条的机器人实时拐角过渡方法 |
CN106382944A (zh) * | 2016-10-08 | 2017-02-08 | 浙江国自机器人技术有限公司 | 一种移动机器人的路线规划方法 |
CN106647754A (zh) * | 2016-12-20 | 2017-05-10 | 安徽农业大学 | 一种果园履带机器人路径规划方法 |
-
2017
- 2017-04-01 CN CN201710214224.6A patent/CN107168305B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104133473A (zh) * | 2008-10-24 | 2014-11-05 | 格瑞股份公司 | 自主驾驶车辆的控制方法 |
KR20120098152A (ko) * | 2011-02-28 | 2012-09-05 | 한국과학기술연구원 | 이동 로봇의 경로 생성 시스템 |
CN106313047A (zh) * | 2016-09-28 | 2017-01-11 | 华中科技大学 | 一种基于Bezier样条的机器人实时拐角过渡方法 |
CN106382944A (zh) * | 2016-10-08 | 2017-02-08 | 浙江国自机器人技术有限公司 | 一种移动机器人的路线规划方法 |
CN106647754A (zh) * | 2016-12-20 | 2017-05-10 | 安徽农业大学 | 一种果园履带机器人路径规划方法 |
Non-Patent Citations (1)
Title |
---|
姜楠 等: "无人驾驶车实时地图构建与自主运动规划", 《第三十一届中国控制会议论文集C卷》 * |
Cited By (63)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107963077B (zh) * | 2017-10-26 | 2020-02-21 | 东软集团股份有限公司 | 一种车辆通过路口的控制方法、装置及系统 |
US10928825B2 (en) | 2017-10-26 | 2021-02-23 | Neusoft Reach Automotive Technology (Shanghai) Co., Ltd. | Method, device and system for controlling vehicle passing through intersection |
CN107963077A (zh) * | 2017-10-26 | 2018-04-27 | 东软集团股份有限公司 | 一种车辆通过路口的控制方法、装置及系统 |
CN109902141A (zh) * | 2017-12-08 | 2019-06-18 | 三星电子株式会社 | 运动规划的方法和自主代理 |
CN109902141B (zh) * | 2017-12-08 | 2024-02-09 | 三星电子株式会社 | 运动规划的方法和自主代理 |
CN108121347A (zh) * | 2017-12-29 | 2018-06-05 | 北京三快在线科技有限公司 | 用于控制设备运动的方法、装置及电子设备 |
CN111656420B (zh) * | 2018-01-18 | 2022-05-03 | 株式会社电装 | 交叉点内的行驶轨道数据生成装置、以及存储介质 |
CN111656420A (zh) * | 2018-01-18 | 2020-09-11 | 株式会社电装 | 交叉点内的行驶轨道数据生成装置、交叉点内的行驶轨道数据生成程序以及存储介质 |
CN108549385A (zh) * | 2018-05-22 | 2018-09-18 | 东南大学 | 一种结合a*算法和vfh避障算法的机器人动态路径规划方法 |
CN108549385B (zh) * | 2018-05-22 | 2021-05-04 | 东南大学 | 一种结合a*算法和vfh避障算法的机器人动态路径规划方法 |
CN110657814A (zh) * | 2018-06-29 | 2020-01-07 | 比亚迪股份有限公司 | 轨迹规划方法和装置、车辆及其控制方法和系统 |
CN110730934A (zh) * | 2018-08-01 | 2020-01-24 | 深圳市大疆创新科技有限公司 | 轨迹切换的方法和装置 |
WO2020024134A1 (zh) * | 2018-08-01 | 2020-02-06 | 深圳市大疆创新科技有限公司 | 轨迹切换的方法和装置 |
CN109557912B (zh) * | 2018-10-11 | 2020-07-28 | 同济大学 | 一种自动驾驶特种作业车辆的决策规划方法 |
CN109557912A (zh) * | 2018-10-11 | 2019-04-02 | 同济大学 | 一种自动驾驶特种作业车辆的决策规划方法 |
CN113165652A (zh) * | 2018-11-09 | 2021-07-23 | 伟摩有限责任公司 | 使用基于网格的方法检验预测轨迹 |
CN113165652B (zh) * | 2018-11-09 | 2022-07-05 | 伟摩有限责任公司 | 使用基于网格的方法检验预测轨迹 |
WO2020098551A1 (zh) * | 2018-11-12 | 2020-05-22 | 深圳前海达闼云端智能科技有限公司 | 机器人运行方法、装置、机器人、电子设备及可读介质 |
CN109434831A (zh) * | 2018-11-12 | 2019-03-08 | 深圳前海达闼云端智能科技有限公司 | 机器人运行方法、装置、机器人、电子设备及可读介质 |
CN109668569A (zh) * | 2018-12-08 | 2019-04-23 | 华东交通大学 | 一种智能驾驶中路径快速生成方法 |
CN109471441A (zh) * | 2018-12-11 | 2019-03-15 | 湖南三智能控制设备有限公司 | 路面机械设备及其上线规划方法、系统和可读存储介质 |
CN109375632A (zh) * | 2018-12-17 | 2019-02-22 | 清华大学 | 自动驾驶车辆实时轨迹规划方法 |
CN111615618B (zh) * | 2018-12-26 | 2023-08-29 | 百度时代网络技术(北京)有限公司 | 用于自动驾驶车辆的高速规划的基于多项式拟合的参考线平滑方法 |
CN109656250A (zh) * | 2018-12-26 | 2019-04-19 | 芜湖哈特机器人产业技术研究院有限公司 | 一种激光叉车的路径跟踪方法 |
CN111615618A (zh) * | 2018-12-26 | 2020-09-01 | 百度时代网络技术(北京)有限公司 | 用于自动驾驶车辆的高速规划的基于多项式拟合的参考线平滑方法 |
CN109885891B (zh) * | 2019-01-24 | 2022-09-30 | 中国科学院合肥物质科学研究院 | 一种智能车gpu并行加速轨迹规划方法 |
CN109885891A (zh) * | 2019-01-24 | 2019-06-14 | 中国科学院合肥物质科学研究院 | 一种智能车gpu并行加速轨迹规划方法 |
CN109947112A (zh) * | 2019-04-04 | 2019-06-28 | 大连理工大学 | 两轮自平衡车直线定点运动的最优时间轨迹规划方法 |
WO2020220604A1 (zh) * | 2019-04-30 | 2020-11-05 | 南京航空航天大学 | 一种多agv系统动态障碍物实时避障方法及避障系统 |
CN110427046B (zh) * | 2019-07-26 | 2022-09-30 | 沈阳航空航天大学 | 一种三维平滑随机游走无人机群移动模型 |
CN110427046A (zh) * | 2019-07-26 | 2019-11-08 | 沈阳航空航天大学 | 一种三维平滑随机游走无人机群移动模型 |
CN110440806A (zh) * | 2019-08-12 | 2019-11-12 | 苏州寻迹智行机器人技术有限公司 | 一种激光与二维码融合的agv精确定位方法 |
CN110502010A (zh) * | 2019-08-15 | 2019-11-26 | 同济大学 | 一种基于贝塞尔曲线的移动机器人室内自主导航控制方法 |
CN110502010B (zh) * | 2019-08-15 | 2021-06-04 | 同济大学 | 一种基于贝塞尔曲线的移动机器人室内自主导航控制方法 |
CN110553660A (zh) * | 2019-08-31 | 2019-12-10 | 武汉理工大学 | 一种基于a*算法和人工势场的无人车轨迹规划方法 |
CN110865642A (zh) * | 2019-11-06 | 2020-03-06 | 天津大学 | 一种基于移动机器人的路径规划方法 |
CN110908373A (zh) * | 2019-11-11 | 2020-03-24 | 南京航空航天大学 | 一种基于改进人工势场的智能车辆轨迹规划方法 |
CN111189453A (zh) * | 2020-01-07 | 2020-05-22 | 深圳南方德尔汽车电子有限公司 | 基于Bezier全局路径规划方法、装置、计算机设备及存储介质 |
CN111523719B (zh) * | 2020-04-16 | 2024-03-15 | 东南大学 | 一种基于铰接车辆运动学约束的混合路径规划方法 |
CN111523719A (zh) * | 2020-04-16 | 2020-08-11 | 东南大学 | 一种基于铰接车辆运动学约束的混合路径规划方法 |
CN111599179A (zh) * | 2020-05-21 | 2020-08-28 | 北京航空航天大学 | 一种基于风险动态平衡的无信号交叉口自动驾驶运动规划方法 |
CN111750859A (zh) * | 2020-05-29 | 2020-10-09 | 广州极飞科技有限公司 | 过渡路径规划方法及相关装置 |
CN111750859B (zh) * | 2020-05-29 | 2021-11-05 | 广州极飞科技股份有限公司 | 过渡路径规划方法及相关装置 |
CN111707269A (zh) * | 2020-06-23 | 2020-09-25 | 东南大学 | 一种三维环境下的无人机路径规划方法 |
CN112269965B (zh) * | 2020-08-10 | 2024-04-05 | 中国北方车辆研究所 | 一种非完整约束条件下的连续曲率路径优化方法 |
CN112269965A (zh) * | 2020-08-10 | 2021-01-26 | 中国北方车辆研究所 | 一种非完整约束条件下的连续曲率路径优化方法 |
CN112129291A (zh) * | 2020-08-26 | 2020-12-25 | 南京航空航天大学 | 一种基于Bezier曲线的固定翼无人机航迹优化方法 |
CN112099493A (zh) * | 2020-08-31 | 2020-12-18 | 西安交通大学 | 一种自主移动机器人轨迹规划方法、系统及设备 |
CN112132869A (zh) * | 2020-11-02 | 2020-12-25 | 中远海运科技股份有限公司 | 一种车辆目标轨迹跟踪方法和装置 |
CN113495562B (zh) * | 2021-06-07 | 2024-03-29 | 深圳市塞防科技有限公司 | 仿真路径生成方法、装置、设备以及计算机存储介质 |
CN113495562A (zh) * | 2021-06-07 | 2021-10-12 | 深圳市道通智能汽车有限公司 | 仿真路径生成方法、装置、设备以及计算机存储介质 |
CN113442140B (zh) * | 2021-06-30 | 2022-05-24 | 同济人工智能研究院(苏州)有限公司 | 一种基于Bezier寻优的笛卡尔空间避障规划方法 |
CN113442140A (zh) * | 2021-06-30 | 2021-09-28 | 同济人工智能研究院(苏州)有限公司 | 一种基于Bezier寻优的笛卡尔空间避障规划方法 |
CN113467498B (zh) * | 2021-07-14 | 2022-07-01 | 西北工业大学 | 一种基于Bezier-凸优化的运载火箭上升段轨迹规划方法 |
CN113467498A (zh) * | 2021-07-14 | 2021-10-01 | 西北工业大学 | 一种基于Bezier-凸优化的运载火箭上升段轨迹规划方法 |
WO2023070258A1 (zh) * | 2021-10-25 | 2023-05-04 | 华为技术有限公司 | 一种车辆的轨迹规划方法、装置及车辆 |
CN114184206A (zh) * | 2021-12-03 | 2022-03-15 | 北京车慧达科技有限公司 | 一种基于车辆轨迹点生成行驶路线的方法和装置 |
CN114184206B (zh) * | 2021-12-03 | 2024-04-19 | 北京车慧达科技有限公司 | 一种基于车辆轨迹点生成行驶路线的方法和装置 |
WO2023124339A1 (zh) * | 2021-12-29 | 2023-07-06 | 灵动科技(北京)有限公司 | 路径规划方法、运动控制方法及计算机程序产品 |
CN114038203A (zh) * | 2022-01-12 | 2022-02-11 | 成都四方伟业软件股份有限公司 | 一种交通仿真中两点路口车道的曲线拟合方法及装置 |
CN115520218A (zh) * | 2022-09-27 | 2022-12-27 | 李晓赫 | 自动驾驶车辆四点转弯轨迹规划方法 |
CN117533354A (zh) * | 2023-12-28 | 2024-02-09 | 安徽蔚来智驾科技有限公司 | 轨迹生成方法、行驶控制方法、存储介质及智能设备 |
CN117533354B (zh) * | 2023-12-28 | 2024-04-02 | 安徽蔚来智驾科技有限公司 | 轨迹生成方法、行驶控制方法、存储介质及智能设备 |
Also Published As
Publication number | Publication date |
---|---|
CN107168305B (zh) | 2020-03-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107168305A (zh) | 路口场景下基于Bezier和VFH的无人车轨迹规划方法 | |
CN109375632A (zh) | 自动驾驶车辆实时轨迹规划方法 | |
CN105549597B (zh) | 一种基于环境不确定性的无人车动态路径规划方法 | |
CN112378408A (zh) | 一种实现轮式移动机器人实时避障的路径规划方法 | |
CN110749333A (zh) | 基于多目标优化的无人驾驶车辆运动规划方法 | |
CN112577506B (zh) | 一种自动驾驶局部路径规划方法和系统 | |
CN112965485B (zh) | 一种基于二次区域划分的机器人全覆盖路径规划方法 | |
CN113593228B (zh) | 一种高速公路瓶颈区域自动驾驶协同控制方法 | |
CN112435504B (zh) | 一种车路协同环境下的集中式协同轨迹规划方法和装置 | |
Mouhagir et al. | A markov decision process-based approach for trajectory planning with clothoid tentacles | |
CN114706400A (zh) | 一种越野环境下基于改进的a*算法的路径规划方法 | |
Sun et al. | Human-like highway trajectory modeling based on inverse reinforcement learning | |
Huang et al. | Research on path planning algorithm of autonomous vehicles based on improved RRT algorithm | |
CN116360457A (zh) | 一种基于自适应栅格和改进a*-dwa融合算法的路径规划方法 | |
Mokhtari et al. | Safe deep q-network for autonomous vehicles at unsignalized intersection | |
CN115826586B (zh) | 一种融合全局算法和局部算法的路径规划方法及系统 | |
CN116804879A (zh) | 一种改进蜣螂算法融合dwa算法的机器人路径规划框架方法 | |
CN116909131A (zh) | 一种面向无信号交叉口的车辆编队轨迹规划建模方法 | |
CN116331264A (zh) | 一种未知障碍物分布的避障路径鲁棒规划方法及系统 | |
Song et al. | A TC-RRT-based path planning algorithm for the nonholonomic mobile robots | |
CN115202357A (zh) | 一种基于脉冲神经网络的自主建图方法 | |
Speidel et al. | Towards courteous behavior and trajectory planning for automated driving | |
Huang et al. | General Optimal Trajectory Planning: Enabling Autonomous Vehicles with the Principle of Least Action | |
CN111596668A (zh) | 基于逆向强化学习的移动机器人拟人化路径规划方法 | |
Cao et al. | Predictive trajectory planning for on-road autonomous vehicles based on a spatiotemporal risk field |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200317 |