【技术实现步骤摘要】
一种速度规划方法、装置、电子设备及存储介质
[0001]本专利技术涉及自动驾驶
,具体涉及一种速度规划方法、装置、电子设备及存储介质。
技术介绍
[0002]速度规划作为自动驾驶的关键技术,其主要是根据车辆的轨迹规划输出的最优轨迹信息,确定车辆沿这条路线行进的速度。由于希望改变在该路线上的速度,所以真正需要选择的是与该路线上的路径点相关的一系列速度。不适当的目标速度和加速度会超出车辆运动的极限工况,且影响到驾乘人员的安全性和舒适性。
[0003]现有速度规划方法是一种对带有多约束条件的二次型目标函数的求解,其中目标函数为:
[0004][0005]约束条件为
[0006][0007][0008][0009][0010][0011][0012]其中,s
i
、分别为第i时刻的位置、速度、加速度、加加速度。速度约束最大值与当前道路曲率相关,曲率curve越大越小。
[0013]根据以上约束条件求解目标函数f的最小值f
min
,以及对应的各时刻位置、速度、加速
【技术保护点】
【技术特征摘要】
1.一种速度规划方法,其特征在于,包括:获取当前场景信息;确定所述当前场景信息对应的速度规划目标函数及预设约束条件;计算所述当前场景信息对应的速度约束最大值,根据计算结果更新所述预设约束条件,得到更新后的约束条件;根据所述更新后的约束条件求解所述目标函数的最小值,得到各时刻点的速度规划参数;所述速度规划参数包括位置、速度、加速度和加加速度;基于各时刻点的所述速度规划参数生成速度规划方案。2.根据权利要求1所述的速度规划方法,其特征在于,所述计算所述当前场景信息对应的约束速度最大值,包括:获取当前车速;获取所述当前场景信息对应的后瞄路径点数、曲率比例系数、速度比例系数和最小前瞄路径点数;根据所述当前车速、所述后瞄路径点数、所述曲率比例系数、所述速度比例系数和所述最小前瞄路径点数计算前瞄路径点、当前路径点和后瞄路径点中每一路径点对应的速度约束最大值;遍历所述前瞄路径点、当前路径点和后瞄路径点中每一路径点对应的所述速度约束最大值,得到所述速度约束最大值的最小值;将所述预设约束条件中的预设速度约束最大值替换为所述速度约束最大值的最小值,得到更新后的约束条件。3.根据权利要求2所述的速度规划方法,其特征在于,所述根据所述当前车速、所述后瞄路径点数、所述曲率比例系数、所述速度比例系数和所述最小前瞄路径点数计算当前路径点对应的速度约束最大值,包括:根据所述当前车速、所述速度比例系数和所述最小前瞄路径点数计算前瞄路径点数;根据所述前瞄路径点数、所述后瞄路径点数和所述曲率比例系数计算所述当前路径点对应的速度约束最大值。4.根据权利要求3所述的速度规划方法,其特征在于,所述根据所述当前车速、所述速度比例系数和所述最小前瞄路径点数计算前瞄路径点数的计算方法如下:q=[k
v
*cur_speed]+b,(k
v
>0,cur_speed≥0,b∈N
+
)其中,q为所述前瞄路径点数;cur_speed为自动驾驶车辆当前速度,cur_speed≥0;k
v
为速度比例系数,k
v
>0;b为所述最小前瞄路径点数,b∈N
...
【专利技术属性】
技术研发人员:李丰军,周剑光,李奇达,吕文平,黄润,
申请(专利权)人:中汽创智科技有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。