CN107340772A - 一种面向无人驾驶的拟人化参考轨迹规划方法 - Google Patents
一种面向无人驾驶的拟人化参考轨迹规划方法 Download PDFInfo
- Publication number
- CN107340772A CN107340772A CN201710559890.3A CN201710559890A CN107340772A CN 107340772 A CN107340772 A CN 107340772A CN 201710559890 A CN201710559890 A CN 201710559890A CN 107340772 A CN107340772 A CN 107340772A
- Authority
- CN
- China
- Prior art keywords
- mrow
- track
- curve
- msub
- turning 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 34
- 230000001133 acceleration Effects 0.000 claims abstract description 14
- 230000010354 integration Effects 0.000 claims abstract description 13
- 230000015572 biosynthetic process Effects 0.000 claims description 2
- 230000008859 change Effects 0.000 claims description 2
- 238000005452 bending Methods 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 7
- 230000008569 process Effects 0.000 description 3
- 230000009467 reduction Effects 0.000 description 2
- 241000208340 Araliaceae Species 0.000 description 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 1
- 235000003140 Panax quinquefolius Nutrition 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000035772 mutation Effects 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
- 238000011144 upstream manufacturing 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Abstract
本发明涉及一种面向无人驾驶的拟人化参考轨迹规划方法,包括以下步骤:建立车辆转向模型,根据车辆基本参数,生成车辆转向时的动力学约束;根据车辆上层决策获取道路的地图信息,根据地图信息得到参考轨迹的起终点约束信息;根据车辆转向时的动力学约束和参考轨迹的起终点约束信息,生成若干条基本满足车辆转向的几何学和动力学约束且符合人的驾驶习惯和转向规律的转弯轨迹曲线,形成基本可行轨迹簇;以横向加速度对时间的积分为指标,从基本可行轨迹簇中选择最为舒适的一条作为最终生成的最佳路口内参考行驶轨迹。本发明方法考虑人的驾驶特性,模拟人的驾驶规律,生成的参考行驶轨迹符合人的驾驶习惯。
Description
技术领域
本发明属于无人驾驶汽车导航领域,尤其涉及一种面向无人驾驶的拟人化参考轨迹规划方法。
背景技术
无人车导航模块综合了感知的结果,并考虑车辆动力学特性,输出一条可以行驶的轨迹。在城市结构化道路的完全自动驾驶汽车导航中,导航任务一般分为三层:任务规划层、行为决策层和轨迹规划层。轨迹规划层一般分两步进行:不考虑移动障碍物的参考轨迹生成和考虑移动障碍物的局部轨迹规划。对于轨迹规划问题,在路口这样复杂的场景中,参考轨迹尤其重要,它弥补了上层任务规划的不完整性,同时利用地理信息降低感知难度,而且增加了最终行车轨迹的全局最优性。
目前,路口转向参考轨迹的生成方法尚不完善,一般用直线连接、圆弧连接或在地图上手动画出虚拟车道线的方式生成,对汽车动力学特性、人类驾驶员驾驶习惯以及乘坐舒适性等因素的考虑尚不深入。另外,手动画线方式本身效率不高,不适于无人车大范围的行驶导航。因此,现在亟需一种适用于解决多种路口内部多种转向情形下的参考轨迹自动规划方法,同时考虑汽车动力学特性、人类驾驶员驾驶习惯和乘坐舒适性等因素,提高轨迹规划的合理性。
发明内容
针对上述问题,本发明的目的是提供一种面向无人驾驶的拟人化参考轨迹规划方法,适用于多种路口内部、多种转向情形下的参考轨迹自动规划,同时考虑汽车动力学特性、人类驾驶员驾驶习惯和乘坐舒适性等因素,提高轨迹规划的合理性,为进一步的无人车控制提供目标轨迹。
为实现上述目的,本发明采取以下技术方案:一种面向无人驾驶的拟人化参考轨迹规划方法,包括以下步骤:
1)建立车辆转向模型,根据车辆基本参数,生成车辆转向时的动力学约束;
2)根据车辆上层决策获取道路的地图信息,根据地图信息得到参考轨迹的起终点约束信息;
3)根据车辆转向时的动力学约束和参考轨迹的起终点约束信息,生成若干条基本满足车辆转向的几何学和动力学约束且符合人的驾驶习惯和转向规律的转弯轨迹曲线,形成基本可行轨迹簇;
4)以横向加速度对时间的积分为指标,从基本可行轨迹簇中选择最为舒适的一条作为最终生成的最佳路口内参考行驶轨迹。
所述步骤1)中的车辆转向模型为:
式中,Π为转弯轨迹曲线;s为转弯轨迹曲线的任意弧长;l为转弯轨迹曲线Π的长度。
所述步骤1)中的车辆基本参数包括车辆轴距L、外侧转向轮最大转角β和转弯轨迹曲线曲率变化率最大值σmax;
车辆转向时的动力学约束为:
κ(s)≤κmax,s∈[0,l]
式中,κ(s)为转弯轨迹曲线任意弧长s处的曲率;κmax为转弯轨迹曲线曲率的最大值;为转弯轨迹曲线曲率的导数。
所述步骤2)中的车辆上层决策是指给出从“入车道”进入路口,后经“出车道”驶出路口的决策;道路的地图信息包括入车道结束中心点pi的位置和方向信息pi=(xi,yi,θi),以及出车道起始中心点pe的位置和方向信息pe=(xe,ye,θe);其中,xi、yi为入车道结束中心点的经纬度坐标,θi为入车道结束中心点处的理想行车方向;xe、ye为出车道起始中心点的经纬度坐标,θe为出车道起始中心点处的理想行车方向;得到的参考轨迹的起终点约束信息为:Π(0)=pi且Π(l)=pe。
所述步骤3)中基本可行轨迹簇的生成,具体包括以下步骤:
①根据车辆转向时的动力学约束和参考轨迹的起终点约束信息,确定转向轨迹曲线参数l、l1、l2、κmax的求解空间为:
l1=λ1l,l2=λ2l且0≤λ1≤λ2≤1
0≤κmax≤σmax·max(l1,l-l2)
式中,l1和l2分别为转弯轨迹曲线中曲率增加段和曲率减小段的长度;λ1和λ2分别为转弯轨迹曲线中曲率增加段和曲率减小段占转弯轨迹曲线总长度的比例;
②建立转向轨迹曲线终点处的车辆车身方向角以及横坐标和纵坐标的计算公式;
③根据转向轨迹曲线终点处的车辆车身方向角以及横坐标和纵坐标的计算公式,计算求解空间中的点(li,l1i,l2i,κmaxi)的终点处的车辆车身方向角及横纵坐标θei,xei,yei;如果θei,xei,yei在出车道中心点信息θe,xe,ye的可行领域内,则将该曲线留在曲线簇中,最终得到一定数量曲线的基本可行轨迹簇。
所述步骤②中的转向轨迹曲线终点处的车辆车身方向角计算公式为:
转向轨迹曲线终点的横坐标和纵坐标的计算公式分别为:
式中,θ(s)为转弯轨迹曲线任意弧长s处的方向角。
所述步骤③中的可行领域是指转向轨迹曲线的终点位置加上半个车身的宽度不能超出车道实线,且终点处的车身方向角不能超过限定值。
所述步骤4)中横向加速度对时间的积分为:
式中,k为基本可行轨迹簇中转向轨迹曲线的曲率;v为车速;s为转弯轨迹曲线的任意弧长;l为转弯轨迹曲线的长度;最为舒适即横向加速度对时间的积分a值最小。
本发明由于采取以上技术方案,其具有以下优点:1、本发明的一种面向无人驾驶的拟人化参考轨迹规划方法,生成的参考轨迹与上下游路段连接处曲率连续,从而保证轨迹追踪的可行性,降低控制的难度。2、本发明的一种面向无人驾驶的拟人化参考轨迹规划方法,考虑不同车辆的转向特性,保证轨迹适用于不同车型车辆的追踪控制。3、本发明的一种面向无人驾驶的拟人化参考轨迹规划方法,考虑车辆动力学特性,尤其考虑乘坐感受,提高了轨迹追踪时的舒适性。4、本发明的一种面向无人驾驶的拟人化参考轨迹规划方法,考虑人的驾驶特性,模拟人的驾驶规律,生成的轨迹符合人的驾驶习惯。
附图说明
图1是本发明方法的流程示意图;
图2是四轮汽车转向时车辆姿态及转弯轨迹示意图;
图3是交叉路口地图道路信息示意图;
图4是入车道结束中心点信息示意图;
图5是理想的行驶轨迹示意图;
图6是转向曲率模型示意图;
图7是转向过程示意图;
图8是基本可行轨迹簇示意图。
具体实施方式
下面结合附图和实施例对本发明进行详细的描述。
如图1所示,本发明提供的一种面向无人驾驶的拟人化参考轨迹规划方法,适用于无人车在路口场景下的路口内部参考行驶轨迹的规划,具体包括以下步骤:
1)车辆转向建模:建立车辆转向模型,根据车辆基本参数,生成车辆转向时的动力学约束。
如图2所示,转弯轨迹曲线Π为车辆后轴中点P扫过的轨迹,在点P处,转弯轨迹曲线Π的切线与车身方向平行,瞬时半径ρ即为此刻的车辆转弯半径。采用曲率-弧长参数来表示转弯轨迹曲线Π,路口内参考行驶轨迹的规划问题可归结为计算转弯轨迹曲线其中,s为转弯轨迹曲线的任意弧长,l为转弯轨迹曲线Π的长度。
转弯轨迹曲线Π应满足车辆转向时的动力学约束。其中,车辆转弯过程中,由于转向机构的限制,车辆转弯半径不能小于最小转弯半径Rmin,即转弯轨迹曲线的曲率不应超过最大值κmax,因此有κ(s)≤κmax,s∈[0,l],其中,κ(s)为转弯轨迹曲线任意弧长s处的曲率。
设车辆后轴中点P的坐标为(x,y),车身方向与x轴夹角为θ;获取车辆轴距L和外侧转向轮最大转角β,可以生成转向约束中的最大曲率为:
考虑到实际转向过程中转向角不能发生突变,这要求转弯轨迹曲线曲率的导数存在且连续。事实上,转向轮转动的速度是受限的,转弯轨迹曲线曲率变化率存在最大值σmax(由经验得到),因此有s∈[0,l],其中,为转弯轨迹曲线曲率的导数。
2)地图信息获取:根据车辆上层决策获取道路的地图信息,根据地图信息得到参考轨迹的起终点约束信息。
如图3所示,当车辆上层决策给出从“入车道”进入路口,后经“出车道”驶出路口时,从地图中获取的道路信息应包括入车道结束中心点pi的位置和方向信息pi=(xi,yi,θi),以及出车道起始中心点pe的位置和方向信息pe=(xe,ye,θe);其中,xi、yi为入车道结束中心点的经纬度坐标,θi为入车道结束中心点处的理想行车方向;xe、ye为出车道起始中心点的经纬度坐标,θe为出车道起始中心点处的理想行车方向。如图4所示,入车道结束中心点处的理想行车方向θi定义为垂直于车道结束线指向交叉口内部的向量与正北方向所呈逆时针夹角,出车道起始中心点处的理想行车方向θe定义与入车道结束中心点处的理想行车方向θi定义类似。
如图5所示,理想的行驶轨迹假定汽车沿入车道结束中心点pi沿方向θi进入交叉口,经历转向过程后,沿出车道起始中心点pe沿方向θe驶出交叉口,因此有起终点限制条件为:Π(0)=pi且Π(l)=pe。
3)基本可行轨迹簇生成:根据车辆转向时的动力学约束和起终点限制条件,生成若干条基本满足车辆转向的几何学和动力学约束且符合人的驾驶习惯和转向规律的转弯轨迹曲线,形成基本可行轨迹簇。
首先,以入车道结束中心点为坐标原点,入车道中心点的入方向为y轴,将出车道起始中心点的经纬度坐标转化为笛卡尔坐标,相关方法已很成熟,这里不赘述。
然后,生成考虑人的驾驶习惯和转向规律的连续曲率转弯轨迹曲线。人的驾驶习惯可以描述为:在车辆进入交叉口时,开始转动方向盘;方向盘到达一定角度后,保持方向盘转角一段时间,如交叉口较小,该段时间会缩短或不存在;在车辆即将驶出交叉口时,回正方向盘至方向盘转角为0。如图6所示,为了模拟这一转向过程,同时不增加转弯轨迹曲线的复杂程度,本发明的曲率模型将转向过程分为三段:第一段中,转弯轨迹曲线曲率从0开始随弧长增加均匀增加,对应车辆进入交叉口的逐渐转动方向盘过程;第二段中曲率到达最大值,并保持一段弧长,对应车辆经过交叉口的保持方向盘转角过程;第三段中曲率均匀减小到0,对应转向过程最后阶段方向盘逐渐回正的过程。各段对应的转向轨迹如图7所示。
给定转弯过程中的参数,即唯一确定转弯轨迹曲线。适当放开入车道结束中心点的约束,即终点限制条件Π(l)=pe转化为Π(l)在pe的一定矩形范围中,这样即会得到一个参考轨迹曲线的基本可行轨迹簇。
基于上述原理,基本可行轨迹簇的生成,具体包括以下步骤:
①根据车辆转向时的动力学约束和起终点限制条件,确定转向轨迹曲线参数l、l1、l2、κmax的求解空间:
l1=λ1l,l2=λ2l且0≤λ1≤λ2≤1
0≤kmax≤σmax·max(l1,-l2)
式中,l1和l2分别为转弯轨迹曲线中曲率增加段和曲率减小段的长度;λ1和λ2分别为转弯轨迹曲线中曲率增加段和曲率减小段占转弯轨迹曲线总长度的比例。
②建立转向轨迹曲线终点处的车辆车身方向角以及横坐标和纵坐标的计算公式:
由曲率的定义可知,转向轨迹曲线任意弧长s处的切线方向为:
因此在转向轨迹曲线的终点l处的车辆车身方向角为:
则转向轨迹曲线终点的横坐标和纵坐标分别为:
式中,θ(s)为转弯轨迹曲线任意弧长s处的方向角。
③根据转向轨迹曲线终点处的车辆车身方向角以及横坐标和纵坐标的计算公式,计算求解空间中的点(li,l1i,l2i,κmaxi)在终点处的车身方向角及横纵坐标θei,xei,yei;如果θei,xei,yei在出车道中心点信息θe,xe,ye的可行领域内,则将该曲线留在曲线簇中;最终得到一定数量曲线的基本可行轨迹簇,如图8所示。
其中,可行领域是指转向轨迹曲线的终点位置加上半个车身的宽度不能超出车道实线,且终点处的车身方向角不能超过限定值;限定值根据经验一般取±30°。
4)最优轨迹选取:以横向加速度对时间的积分为指标,从基本可行轨迹簇中选择最为舒适的一条作为本发明最终生成的参考行驶轨迹。
转向轨迹曲线上任意一点的横向加速度为:
at=kv2
则横向加速度对时间的积分为:
式中,k为基本可行轨迹簇中转向轨迹曲线的曲率;v为车速,一般取平均车速,比如30km/h。
遍历基本可行轨迹簇中所有的转向轨迹曲线,选择a值最小的转向轨迹曲线,即得到最终的最佳路口内参考行驶轨迹。
上述各实施例仅用于说明本发明,其中各部件的结构、设置位置及其连接方式等都是可以有所变化的,凡是在本发明技术方案的基础上进行的等同变换和改进,均不应排除在本发明的保护范围之外。
Claims (10)
1.一种面向无人驾驶的拟人化参考轨迹规划方法,包括以下步骤:
1)建立车辆转向模型,根据车辆基本参数,生成车辆转向时的动力学约束;
2)根据车辆上层决策获取道路的地图信息,根据地图信息得到参考轨迹的起终点约束信息;
3)根据车辆转向时的动力学约束和参考轨迹的起终点约束信息,生成若干条基本满足车辆转向的几何学和动力学约束且符合人的驾驶习惯和转向规律的转弯轨迹曲线,形成基本可行轨迹簇;
4)以横向加速度对时间的积分为指标,从基本可行轨迹簇中选择最为舒适的一条作为最终生成的最佳路口内参考行驶轨迹。
2.如权利要求1所述的一种面向无人驾驶的拟人化参考轨迹规划方法,其特征在于,所述步骤1)中的车辆转向模型为:
<mrow>
<mo>&Pi;</mo>
<mo>:</mo>
<mi>s</mi>
<mo>&RightArrow;</mo>
<mo>&Pi;</mo>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>,</mo>
<mo>&ForAll;</mo>
<mi>s</mi>
<mo>&Element;</mo>
<mo>&lsqb;</mo>
<mn>0</mn>
<mo>,</mo>
<mi>l</mi>
<mo>&rsqb;</mo>
</mrow>
式中,Π为转弯轨迹曲线;s为转弯轨迹曲线的任意弧长;l为转弯轨迹曲线Π的长度。
3.如权利要求2所述的一种面向无人驾驶的拟人化参考轨迹规划方法,其特征在于,所述步骤1)中的车辆基本参数包括车辆轴距L、外侧转向轮最大转角β和转弯轨迹曲线曲率变化率最大值σmax;
车辆转向时的动力学约束为:
κ(s)≤κmax,s∈[0,l]
<mrow>
<msub>
<mi>&kappa;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mi>L</mi>
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
</mrow>
<mrow>
<mover>
<mi>&kappa;</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>&le;</mo>
<msub>
<mi>&sigma;</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>,</mo>
<mi>s</mi>
<mo>&Element;</mo>
<mo>&lsqb;</mo>
<mn>0</mn>
<mo>,</mo>
<mi>l</mi>
<mo>&rsqb;</mo>
</mrow>
式中,κ(s)为转弯轨迹曲线任意弧长s处的曲率;κmax为转弯轨迹曲线曲率的最大值;为转弯轨迹曲线曲率的导数。
4.如权利要求2或3所述的一种面向无人驾驶的拟人化参考轨迹规划方法,其特征在于,所述步骤2)中的车辆上层决策是指给出从“入车道”进入路口,后经“出车道”驶出路口的决策;道路的地图信息包括入车道结束中心点pi的位置和方向信息pi=(xi,yi,θi),以及出车道起始中心点pe的位置和方向信息pe=(xe,ye,θe);其中,xi、yi为入车道结束中心点的经纬度坐标,θi为入车道结束中心点处的理想行车方向;xe、ye为出车道起始中心点的经纬度坐标,θe为出车道起始中心点处的理想行车方向;得到的参考轨迹的起终点约束信息为:Π(0)=pi且Π(l)=pe。
5.如权利要求4所述的一种面向无人驾驶的拟人化参考轨迹规划方法,其特征在于,所述步骤3)中基本可行轨迹簇的生成,具体包括以下步骤:
①根据车辆转向时的动力学约束和参考轨迹的起终点约束信息,确定转向轨迹曲线参数l、l1、l2、κmax的求解空间为:
<mrow>
<mi>l</mi>
<mo>&Element;</mo>
<mrow>
<mo>(</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>e</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>y</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mi>e</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
<mo>,</mo>
<mo>|</mo>
<mrow>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>e</mi>
</msub>
</mrow>
<mo>|</mo>
<mo>+</mo>
<mo>|</mo>
<mrow>
<msub>
<mi>y</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mi>e</mi>
</msub>
</mrow>
<mo>|</mo>
<mo>)</mo>
</mrow>
</mrow>
l1=λ1l,l2=λ2l且0≤λ1≤λ2≤1
0≤κmax≤σmax·max(l1,l-l2)
式中,l1和l2分别为转弯轨迹曲线中曲率增加段和曲率减小段的长度;λ1和λ2分别为转弯轨迹曲线中曲率增加段和曲率减小段占转弯轨迹曲线总长度的比例;
②建立转向轨迹曲线终点处的车辆车身方向角以及横坐标和纵坐标的计算公式;
③根据转向轨迹曲线终点处的车辆车身方向角以及横坐标和纵坐标的计算公式,计算求解空间中的点(li,l1i,l2i,κmaxi)的终点处的车辆车身方向角及横纵坐标θei,xei,yei;如果θei,xei,yei在出车道中心点信息θe,xe,ye的可行领域内,则将该曲线留在曲线簇中,最终得到一定数量曲线的基本可行轨迹簇。
6.如权利要求5所述的一种面向无人驾驶的拟人化参考轨迹规划方法,其特征在于,所述步骤②中的转向轨迹曲线终点处的车辆车身方向角计算公式为:
<mrow>
<mi>&theta;</mi>
<mrow>
<mo>(</mo>
<mi>l</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<munderover>
<mo>&Integral;</mo>
<mn>0</mn>
<mi>l</mi>
</munderover>
<mi>&kappa;</mi>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>s</mi>
<mo>+</mo>
<msub>
<mi>&theta;</mi>
<mi>i</mi>
</msub>
</mrow>
转向轨迹曲线终点的横坐标和纵坐标的计算公式分别为:
<mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>l</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<munderover>
<mo>&Integral;</mo>
<mn>0</mn>
<mi>l</mi>
</munderover>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>s</mi>
<mo>+</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
</mrow>
<mrow>
<mi>y</mi>
<mrow>
<mo>(</mo>
<mi>l</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<munderover>
<mo>&Integral;</mo>
<mn>0</mn>
<mi>l</mi>
</munderover>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mi>&theta;</mi>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>s</mi>
<mo>+</mo>
<msub>
<mi>y</mi>
<mi>i</mi>
</msub>
</mrow>
式中,θ(s)为转弯轨迹曲线任意弧长s处的方向角。
7.如权利要求5或6所述的一种面向无人驾驶的拟人化参考轨迹规划方法,其特征在于,所述步骤③中的可行领域是指转向轨迹曲线的终点位置加上半个车身的宽度不能超出车道实线,且终点处的车身方向角不能超过限定值。
8.如权利要求1或2或3或5或6所述的一种面向无人驾驶的拟人化参考轨迹规划方法,其特征在于,所述步骤4)中横向加速度对时间的积分为:
a=∫0 lkv ds
式中,k为基本可行轨迹簇中转向轨迹曲线的曲率;v为车速;s为转弯轨迹曲线的任意弧长;l为转弯轨迹曲线的长度;最为舒适即横向加速度对时间的积分a值最小。
9.如权利要求4所述的一种面向无人驾驶的拟人化参考轨迹规划方法,其特征在于,所述步骤4)中横向加速度对时间的积分为:
a=∫0 lkv ds
式中,k为基本可行轨迹簇中转向轨迹曲线的曲率;v为车速;s为转弯轨迹曲线的任意弧长;l为转弯轨迹曲线的长度;最为舒适即横向加速度对时间的积分a值最小。
10.如权利要求7所述的一种面向无人驾驶的拟人化参考轨迹规划方法,其特征在于,所述步骤4)中横向加速度对时间的积分为:
a=∫0 lkv ds
式中,k为基本可行轨迹簇中转向轨迹曲线的曲率;v为车速;s为转弯轨迹曲线的任意弧长;l为转弯轨迹曲线的长度;最为舒适即横向加速度对时间的积分a值最小。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710559890.3A CN107340772B (zh) | 2017-07-11 | 2017-07-11 | 一种面向无人驾驶的拟人化参考轨迹规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710559890.3A CN107340772B (zh) | 2017-07-11 | 2017-07-11 | 一种面向无人驾驶的拟人化参考轨迹规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107340772A true CN107340772A (zh) | 2017-11-10 |
CN107340772B CN107340772B (zh) | 2020-05-22 |
Family
ID=60218529
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710559890.3A Active CN107340772B (zh) | 2017-07-11 | 2017-07-11 | 一种面向无人驾驶的拟人化参考轨迹规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107340772B (zh) |
Cited By (33)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108920753A (zh) * | 2018-05-25 | 2018-11-30 | 江苏大学 | 一种基于优秀驾驶员行驶轨迹的弯道彩色路面设计方法 |
CN109189872A (zh) * | 2018-08-13 | 2019-01-11 | 武汉中海庭数据技术有限公司 | 高精度地图数据验证装置及方法 |
CN109375632A (zh) * | 2018-12-17 | 2019-02-22 | 清华大学 | 自动驾驶车辆实时轨迹规划方法 |
CN109557912A (zh) * | 2018-10-11 | 2019-04-02 | 同济大学 | 一种自动驾驶特种作业车辆的决策规划方法 |
CN109655076A (zh) * | 2019-02-22 | 2019-04-19 | 百度在线网络技术(北京)有限公司 | 车辆转弯的速度规划方法、装置和存储介质 |
WO2019104581A1 (zh) * | 2017-11-30 | 2019-06-06 | 深圳市大疆创新科技有限公司 | 轨迹生成方法、装置和无人驾驶地面车辆 |
CN109955853A (zh) * | 2017-12-14 | 2019-07-02 | 百度(美国)有限责任公司 | 用于操作自动驾驶车辆的方法、系统和存储介质 |
CN109990794A (zh) * | 2018-01-02 | 2019-07-09 | 通用汽车环球科技运作有限责任公司 | 具有动态成本学习的自主驾驶轨迹规划器 |
CN110186470A (zh) * | 2019-04-26 | 2019-08-30 | 纵目科技(上海)股份有限公司 | 符合车辆动力学的参考线生成系统、终端和使用方法 |
CN110187639A (zh) * | 2019-06-27 | 2019-08-30 | 吉林大学 | 一种基于参数决策框架的轨迹规划控制方法 |
CN110487285A (zh) * | 2019-08-27 | 2019-11-22 | 湖北亿咖通科技有限公司 | 一种车辆低速转弯时的路径规划控制方法和电子设备 |
CN110654372A (zh) * | 2018-06-29 | 2020-01-07 | 比亚迪股份有限公司 | 车辆驾驶控制方法、装置、车辆和存储介质 |
CN111433102A (zh) * | 2017-12-18 | 2020-07-17 | 智加科技公司 | 用于自动驾驶车辆中的集合车辆控制预测的方法和系统 |
CN111488674A (zh) * | 2020-03-12 | 2020-08-04 | 上海理工大学 | 一种平面交叉口车辆运行轨迹模拟方法 |
CN111656420A (zh) * | 2018-01-18 | 2020-09-11 | 株式会社电装 | 交叉点内的行驶轨道数据生成装置、交叉点内的行驶轨道数据生成程序以及存储介质 |
CN111679667A (zh) * | 2020-05-20 | 2020-09-18 | 东南大学 | 一种面向无人驾驶赛车的路径与车速协同规划方法 |
CN112005184A (zh) * | 2018-04-24 | 2020-11-27 | 罗伯特·博世有限公司 | 用于将车辆的未来驾驶操纵与至少一个同伴车辆的同伴操纵进行协作协调的方法和设备 |
CN112061115A (zh) * | 2020-08-18 | 2020-12-11 | 三一专用汽车有限责任公司 | 车辆行驶路径获取方法、装置和计算机可读存储介质 |
CN112146667A (zh) * | 2020-09-29 | 2020-12-29 | 广州小鹏自动驾驶科技有限公司 | 一种车辆过渡轨迹的生成方法和装置 |
CN112424047A (zh) * | 2017-11-22 | 2021-02-26 | 伟摩有限责任公司 | 将不适感用于自主车辆的速度规划 |
CN112622934A (zh) * | 2020-12-25 | 2021-04-09 | 上海商汤临港智能科技有限公司 | 一种参考轨迹点和参考轨迹生成方法、驾驶方法以及车辆 |
CN112677995A (zh) * | 2021-01-07 | 2021-04-20 | 腾讯科技(深圳)有限公司 | 一种车辆轨迹规划方法、装置、存储介质及设备 |
CN113110523A (zh) * | 2021-05-27 | 2021-07-13 | 青岛星华智能装备有限公司 | 一种单舵轮agv的轨迹规划方法 |
TWI737437B (zh) * | 2020-08-07 | 2021-08-21 | 財團法人車輛研究測試中心 | 軌跡決定方法 |
CN113928372A (zh) * | 2021-11-08 | 2022-01-14 | 中车株洲电力机车有限公司 | 虚拟轨道列车及其轨道生成方法、辅助驾驶方法、系统 |
CN114184201A (zh) * | 2020-09-15 | 2022-03-15 | 郑州宇通客车股份有限公司 | 一种用于路口的转向路径生成方法、系统及车辆 |
US11285970B2 (en) | 2019-03-12 | 2022-03-29 | Apollo Intelligent Driving Technology (Beijing) Co., Ltd. | Vehicle track prediction method and device, storage medium and terminal device |
CN114435396A (zh) * | 2022-01-07 | 2022-05-06 | 北京理工大学前沿技术研究院 | 一种智能车辆交叉口行为决策方法 |
CN114550571A (zh) * | 2020-11-26 | 2022-05-27 | 华为技术有限公司 | 一种车道线标注方法、装置、存储介质及计算机程序产品 |
CN115520218A (zh) * | 2022-09-27 | 2022-12-27 | 李晓赫 | 自动驾驶车辆四点转弯轨迹规划方法 |
US11634134B2 (en) | 2018-11-13 | 2023-04-25 | Waymo Llc | Using discomfort for speed planning in responding to tailgating vehicles for autonomous vehicles |
WO2023134364A1 (zh) * | 2022-01-12 | 2023-07-20 | 华为技术有限公司 | 引导车辆行驶的方法、地图生成方法及相关系统 |
US11762392B2 (en) | 2017-11-22 | 2023-09-19 | Waymo Llc | Using discomfort for speed planning in autonomous vehicles |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1577199A (zh) * | 2003-06-26 | 2005-02-09 | 丰田自动车株式会社 | 用于车辆的驾驶辅助装置及其方法 |
CN102741109A (zh) * | 2009-12-04 | 2012-10-17 | 罗伯特·博世有限公司 | 用于确定道路的弯道区段的相交轨迹的方法和控制设备 |
CN103906673A (zh) * | 2011-10-27 | 2014-07-02 | 罗伯特·博世有限公司 | 用于引导车辆的方法和驾驶员辅助系统 |
US20150330209A1 (en) * | 2012-12-13 | 2015-11-19 | Schlumberger Technology Corporation | Optimal trajectory control for directional drilling |
CN105549597A (zh) * | 2016-02-04 | 2016-05-04 | 同济大学 | 一种基于环境不确定性的无人车动态路径规划方法 |
CN106114507A (zh) * | 2016-06-21 | 2016-11-16 | 百度在线网络技术(北京)有限公司 | 用于智能车辆的局部轨迹规划方法和装置 |
CN106515722A (zh) * | 2016-11-08 | 2017-03-22 | 西华大学 | 一种垂直泊车轨迹规划方法 |
CN106873600A (zh) * | 2017-03-31 | 2017-06-20 | 深圳市靖洲科技有限公司 | 一种面向无人自行车的局部避障路径规划方法 |
-
2017
- 2017-07-11 CN CN201710559890.3A patent/CN107340772B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1577199A (zh) * | 2003-06-26 | 2005-02-09 | 丰田自动车株式会社 | 用于车辆的驾驶辅助装置及其方法 |
CN102741109A (zh) * | 2009-12-04 | 2012-10-17 | 罗伯特·博世有限公司 | 用于确定道路的弯道区段的相交轨迹的方法和控制设备 |
CN103906673A (zh) * | 2011-10-27 | 2014-07-02 | 罗伯特·博世有限公司 | 用于引导车辆的方法和驾驶员辅助系统 |
US20150330209A1 (en) * | 2012-12-13 | 2015-11-19 | Schlumberger Technology Corporation | Optimal trajectory control for directional drilling |
CN105549597A (zh) * | 2016-02-04 | 2016-05-04 | 同济大学 | 一种基于环境不确定性的无人车动态路径规划方法 |
CN106114507A (zh) * | 2016-06-21 | 2016-11-16 | 百度在线网络技术(北京)有限公司 | 用于智能车辆的局部轨迹规划方法和装置 |
CN106515722A (zh) * | 2016-11-08 | 2017-03-22 | 西华大学 | 一种垂直泊车轨迹规划方法 |
CN106873600A (zh) * | 2017-03-31 | 2017-06-20 | 深圳市靖洲科技有限公司 | 一种面向无人自行车的局部避障路径规划方法 |
Non-Patent Citations (2)
Title |
---|
屈盼让 等: "基于B样条曲线的无人车路径规划算法", 《电脑知识与技术》 * |
杜明博: "基于人类驾驶行为的无人驾驶车辆行为决策与运动规划方法研究", 《中国博士学位论文全文数据库 工程科技II辑》 * |
Cited By (49)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11762392B2 (en) | 2017-11-22 | 2023-09-19 | Waymo Llc | Using discomfort for speed planning in autonomous vehicles |
CN112424047A (zh) * | 2017-11-22 | 2021-02-26 | 伟摩有限责任公司 | 将不适感用于自主车辆的速度规划 |
WO2019104581A1 (zh) * | 2017-11-30 | 2019-06-06 | 深圳市大疆创新科技有限公司 | 轨迹生成方法、装置和无人驾驶地面车辆 |
CN109955853A (zh) * | 2017-12-14 | 2019-07-02 | 百度(美国)有限责任公司 | 用于操作自动驾驶车辆的方法、系统和存储介质 |
CN109955853B (zh) * | 2017-12-14 | 2021-08-31 | 百度(美国)有限责任公司 | 用于操作自动驾驶车辆的方法、系统和存储介质 |
CN111433102B (zh) * | 2017-12-18 | 2024-01-16 | 智加科技公司 | 用于自动驾驶车辆中的集合车辆控制预测的方法和系统 |
CN111433102A (zh) * | 2017-12-18 | 2020-07-17 | 智加科技公司 | 用于自动驾驶车辆中的集合车辆控制预测的方法和系统 |
CN109990794A (zh) * | 2018-01-02 | 2019-07-09 | 通用汽车环球科技运作有限责任公司 | 具有动态成本学习的自主驾驶轨迹规划器 |
CN111656420B (zh) * | 2018-01-18 | 2022-05-03 | 株式会社电装 | 交叉点内的行驶轨道数据生成装置、以及存储介质 |
CN111656420A (zh) * | 2018-01-18 | 2020-09-11 | 株式会社电装 | 交叉点内的行驶轨道数据生成装置、交叉点内的行驶轨道数据生成程序以及存储介质 |
CN112005184A (zh) * | 2018-04-24 | 2020-11-27 | 罗伯特·博世有限公司 | 用于将车辆的未来驾驶操纵与至少一个同伴车辆的同伴操纵进行协作协调的方法和设备 |
CN108920753A (zh) * | 2018-05-25 | 2018-11-30 | 江苏大学 | 一种基于优秀驾驶员行驶轨迹的弯道彩色路面设计方法 |
CN108920753B (zh) * | 2018-05-25 | 2023-01-17 | 江苏大学 | 一种基于优秀驾驶员行驶轨迹的弯道彩色路面设计方法 |
CN110654372B (zh) * | 2018-06-29 | 2021-09-03 | 比亚迪股份有限公司 | 车辆驾驶控制方法、装置、车辆和存储介质 |
CN110654372A (zh) * | 2018-06-29 | 2020-01-07 | 比亚迪股份有限公司 | 车辆驾驶控制方法、装置、车辆和存储介质 |
CN109189872A (zh) * | 2018-08-13 | 2019-01-11 | 武汉中海庭数据技术有限公司 | 高精度地图数据验证装置及方法 |
CN109557912B (zh) * | 2018-10-11 | 2020-07-28 | 同济大学 | 一种自动驾驶特种作业车辆的决策规划方法 |
CN109557912A (zh) * | 2018-10-11 | 2019-04-02 | 同济大学 | 一种自动驾驶特种作业车辆的决策规划方法 |
US11634134B2 (en) | 2018-11-13 | 2023-04-25 | Waymo Llc | Using discomfort for speed planning in responding to tailgating vehicles for autonomous vehicles |
CN109375632A (zh) * | 2018-12-17 | 2019-02-22 | 清华大学 | 自动驾驶车辆实时轨迹规划方法 |
CN109655076A (zh) * | 2019-02-22 | 2019-04-19 | 百度在线网络技术(北京)有限公司 | 车辆转弯的速度规划方法、装置和存储介质 |
US11285970B2 (en) | 2019-03-12 | 2022-03-29 | Apollo Intelligent Driving Technology (Beijing) Co., Ltd. | Vehicle track prediction method and device, storage medium and terminal device |
CN110186470A (zh) * | 2019-04-26 | 2019-08-30 | 纵目科技(上海)股份有限公司 | 符合车辆动力学的参考线生成系统、终端和使用方法 |
CN110187639B (zh) * | 2019-06-27 | 2021-05-11 | 吉林大学 | 一种基于参数决策框架的轨迹规划控制方法 |
CN110187639A (zh) * | 2019-06-27 | 2019-08-30 | 吉林大学 | 一种基于参数决策框架的轨迹规划控制方法 |
CN110487285B (zh) * | 2019-08-27 | 2021-01-29 | 湖北亿咖通科技有限公司 | 一种车辆低速转弯时的路径规划控制方法和电子设备 |
CN110487285A (zh) * | 2019-08-27 | 2019-11-22 | 湖北亿咖通科技有限公司 | 一种车辆低速转弯时的路径规划控制方法和电子设备 |
CN111488674A (zh) * | 2020-03-12 | 2020-08-04 | 上海理工大学 | 一种平面交叉口车辆运行轨迹模拟方法 |
CN111488674B (zh) * | 2020-03-12 | 2024-01-16 | 上海理工大学 | 一种平面交叉口车辆运行轨迹模拟方法 |
CN111679667B (zh) * | 2020-05-20 | 2022-09-02 | 东南大学 | 一种面向无人驾驶赛车的路径与车速协同规划方法 |
CN111679667A (zh) * | 2020-05-20 | 2020-09-18 | 东南大学 | 一种面向无人驾驶赛车的路径与车速协同规划方法 |
TWI737437B (zh) * | 2020-08-07 | 2021-08-21 | 財團法人車輛研究測試中心 | 軌跡決定方法 |
CN112061115A (zh) * | 2020-08-18 | 2020-12-11 | 三一专用汽车有限责任公司 | 车辆行驶路径获取方法、装置和计算机可读存储介质 |
CN114184201A (zh) * | 2020-09-15 | 2022-03-15 | 郑州宇通客车股份有限公司 | 一种用于路口的转向路径生成方法、系统及车辆 |
CN114184201B (zh) * | 2020-09-15 | 2023-08-25 | 宇通客车股份有限公司 | 一种用于路口的转向路径生成方法、系统及车辆 |
CN112146667A (zh) * | 2020-09-29 | 2020-12-29 | 广州小鹏自动驾驶科技有限公司 | 一种车辆过渡轨迹的生成方法和装置 |
CN114550571A (zh) * | 2020-11-26 | 2022-05-27 | 华为技术有限公司 | 一种车道线标注方法、装置、存储介质及计算机程序产品 |
WO2022110749A1 (zh) * | 2020-11-26 | 2022-06-02 | 华为技术有限公司 | 一种车道线标注方法、装置、存储介质及计算机程序产品 |
CN112622934B (zh) * | 2020-12-25 | 2022-06-24 | 上海商汤临港智能科技有限公司 | 一种参考轨迹点和参考轨迹生成方法、驾驶方法以及车辆 |
CN112622934A (zh) * | 2020-12-25 | 2021-04-09 | 上海商汤临港智能科技有限公司 | 一种参考轨迹点和参考轨迹生成方法、驾驶方法以及车辆 |
WO2022148282A1 (zh) * | 2021-01-07 | 2022-07-14 | 腾讯科技(深圳)有限公司 | 一种车辆轨迹规划方法、装置、存储介质及设备 |
CN112677995A (zh) * | 2021-01-07 | 2021-04-20 | 腾讯科技(深圳)有限公司 | 一种车辆轨迹规划方法、装置、存储介质及设备 |
CN113110523A (zh) * | 2021-05-27 | 2021-07-13 | 青岛星华智能装备有限公司 | 一种单舵轮agv的轨迹规划方法 |
CN113928372A (zh) * | 2021-11-08 | 2022-01-14 | 中车株洲电力机车有限公司 | 虚拟轨道列车及其轨道生成方法、辅助驾驶方法、系统 |
CN113928372B (zh) * | 2021-11-08 | 2023-12-12 | 中车株洲电力机车有限公司 | 虚拟轨道列车及其轨道生成方法、辅助驾驶方法、系统 |
CN114435396B (zh) * | 2022-01-07 | 2023-06-27 | 北京理工大学前沿技术研究院 | 一种智能车辆交叉口行为决策方法 |
CN114435396A (zh) * | 2022-01-07 | 2022-05-06 | 北京理工大学前沿技术研究院 | 一种智能车辆交叉口行为决策方法 |
WO2023134364A1 (zh) * | 2022-01-12 | 2023-07-20 | 华为技术有限公司 | 引导车辆行驶的方法、地图生成方法及相关系统 |
CN115520218A (zh) * | 2022-09-27 | 2022-12-27 | 李晓赫 | 自动驾驶车辆四点转弯轨迹规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107340772B (zh) | 2020-05-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107340772A (zh) | 一种面向无人驾驶的拟人化参考轨迹规划方法 | |
CN109927716B (zh) | 基于高精度地图的自主垂直泊车方法 | |
CN107813820A (zh) | 一种仿优秀驾驶员的无人车换道路径规划方法 | |
CN110286681B (zh) | 一种变曲率弯道的动态自动驾驶换道轨迹规划方法 | |
CN103158703A (zh) | 一种平行泊车的控制方法 | |
CN107315411A (zh) | 一种基于车车协同下无人驾驶车辆的换道轨迹规划方法 | |
CN109017793B (zh) | 基于前后轴融合参考的自主停车导航及控制方法 | |
CN109144076A (zh) | 一种多车辆横纵向耦合协同控制系统及控制方法 | |
CN109976159A (zh) | 基于安全可控域的智能车辆横向控制方法 | |
CN107161207A (zh) | 一种基于主动安全的智能汽车轨迹跟踪控制系统及控制方法 | |
WO2019228435A1 (zh) | 用于移动载具的路径跟踪方法 | |
CN105857312B (zh) | 一种高速公路重型卡车速度行驶优化方法 | |
CN110502009A (zh) | 基于航向预估的无人驾驶车辆路径跟踪控制方法 | |
CN110286671B (zh) | 一种基于回旋曲线的自动驾驶车辆路径生成方法 | |
Jin et al. | An adaptive motion planning technique for on-road autonomous driving | |
CN102741109A (zh) | 用于确定道路的弯道区段的相交轨迹的方法和控制设备 | |
CN108423067A (zh) | 水平泊车控制方法及控制系统 | |
CN106886604A (zh) | 一种适用于车道级导航定位的交叉路口路网模型 | |
CN114265411B (zh) | 一种解决车辆预测模型性能受限于感知数据性能的方法 | |
CN112660124A (zh) | 一种用于换道场景的协同自适应巡航控制方法 | |
CN110920616A (zh) | 一种智能车换道轨迹及换道轨迹跟随控制方法 | |
CN104732066B (zh) | 路径约束条件下车辆行为时空演化的建模方法及其应用 | |
CN111896004A (zh) | 一种狭窄通道车辆轨迹规划方法及系统 | |
CN111086510B (zh) | 一种基于预测函数控制的前轮转向车辆车道保持控制方法 | |
CN103258440A (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 | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20191231 Address after: 100083 401a, floor 4, building 6, yard 1, Zhongguancun East Road, Haidian District, Beijing Applicant after: Beijing Chaoxing Future Technology Co., Ltd Address before: 100084 Beijing, Haidian District, 100084 box office box office, Tsinghua University, Applicant before: Tsinghua University |
|
GR01 | Patent grant | ||
GR01 | Patent grant |