预览加载中,请您耐心等待几秒...
1/10
2/10
3/10
4/10
5/10
6/10
7/10
8/10
9/10
10/10

亲,该文档总共24页,到这已经超出免费预览范围,如果喜欢就直接下载吧~

如果您无法下载资料,请参考说明:

1、部分资料下载需要金币,请确保您的账户上有足够的金币

2、已购买过的文档,再次下载不重复扣费

3、资料包下载后请先用软件解压,在使用对应软件打开

(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号CN113671941A(43)申请公布日2021.11.19(21)申请号202010414249.2(22)申请日2020.05.15(71)申请人北京京东乾石科技有限公司地址100176北京市大兴区北京经济技术开发区科创十一街18号院2号楼19层A1905室(72)发明人李柏边学鹏(74)专利代理机构北京品源专利代理有限公司11332代理人孟金喆(51)Int.Cl.G05D1/02(2020.01)权利要求书2页说明书15页附图6页(54)发明名称一种轨迹规划方法、装置、设备和存储介质(57)摘要本发明实施例公开了一种轨迹规划方法、装置、设备和存储介质,该方法包括:获取对目标车辆进行轨迹决策所获得的初始轨迹信息;构建目标车辆对应的目标轨迹规划非线性命题,其中,目标轨迹规划非线性命题包括:轨迹代价函数和行驶约束条件,行驶约束条件包括:基于隧道化建模方式确定的碰撞躲避约束条件;根据初始轨迹信息,对目标轨迹规划非线性命题进行求解,确定出目标车辆对应的目标规划轨迹。通过本发明实施例的技术方案,可以提高轨迹规划效率。CN113671941ACN113671941A权利要求书1/2页1.一种轨迹规划方法,其特征在于,包括:获取对目标车辆进行轨迹决策所获得的初始轨迹信息;构建所述目标车辆对应的目标轨迹规划非线性命题,其中,所述目标轨迹规划非线性命题包括:轨迹代价函数和行驶约束条件,所述行驶约束条件包括:基于隧道化建模方式确定的碰撞躲避约束条件;根据所述初始轨迹信息,对所述目标轨迹规划非线性命题进行求解,确定出所述目标车辆对应的目标规划轨迹。2.根据权利要求1所述的方法,其特征在于,基于隧道化建模方式确定碰撞躲避约束条件,包括:将两个预设半径的圆形区域覆盖所述目标车辆的车体区域,并确定两个圆心的运动轨迹;根据两个圆心的运动轨迹和所述预设半径,确定在轨迹规划时域中的每个采样时刻下每个圆心对应的局部隧道区域;根据所述局部隧道区域,确定碰撞躲避约束条件。3.根据权利要求2所述的方法,其特征在于,根据两个圆心的运动轨迹和所述预设半径,确定在轨迹规划时域中的每个采样时刻下每个圆心对应的局部隧道区域,包括:根据两个圆心的运动轨迹,确定在规划时域中的每个采样时刻下两个圆心的圆心位置;基于所述预设半径,以每个圆心的圆心位置为中心进行增量式拓展,确定每个采样时刻下的每个圆心对应的局部隧道区域。4.根据权利要求3所述的方法,其特征在于,基于所述预设半径,以每个圆心的圆心位置为中心进行增量式拓展,确定每个采样时刻下的每个圆心对应的局部隧道区域,包括:以当前采样时刻下当前圆心的圆心位置为中心,沿X轴和Y轴正负方向,分别扩展长度为预设半径的距离,构建以所述圆心位置为中心的四边形;分别沿着所述四边形的四条扩张边逐次向外扩张预设距离,获得每次扩张的扩张区域;若检测到所述扩张区域与行驶场景中的障碍物区域不存在重叠部分,则基于该扩张区域更新所述四边形,并对更新后的四边形继续扩张操作;若检测到所述扩张区域与行驶场景中的障碍物区域存在重叠部分,则停止该扩张区域对应的扩张边的扩张操作,继续其他扩张边的扩张操作;在所述四条扩张边的扩张操作均停止时,根据当前四边形确定当前采样时刻下的当前圆心对应的局部隧道区域。5.根据权利要求4所述的方法,其特征在于,根据当前四边形确定当前采样时刻下的当前圆心对应的局部隧道区域,包括:将当前四边形的四条边向中心收缩长度为预设半径的距离,并将收缩后的四边形的区域确定为当前采样时刻下的当前圆心对应的局部隧道区域。6.根据权利要求2所述的方法,其特征在于,根据所述局部隧道区域,确定碰撞躲避约束条件,包括:确定在笛卡尔坐标系中所述局部隧道区域的四个区域顶点的位置坐标;2CN113671941A权利要求书2/2页根据所述四个区域顶点的位置坐标,确定每个采样时刻下每个圆心的位置坐标的约束范围,获得碰撞躲避约束条件。7.根据权利要求1所述的方法,其特征在于,所述行驶约束条件还包括:目标车辆的运动学约束条件、边值约束条件和车辆内部机械限制条件。8.根据权利要求1-7任一所述的方法,其特征在于,构建所述目标车辆对应的目标轨迹规划非线性命题,包括:构建所述目标车辆对应的第一轨迹规划非线性命题,其中,所述第一轨迹规划非线性命题包括:目标函数和边界约束条件,所述目标函数是基于轨迹代价函数、目标车辆的运动学约束条件和基于隧道化建模方式确定的碰撞躲避约束条件对应的两个圆心的圆心关联关系确定的;构建所述目标车辆对应的第二轨迹规划非线性命题,其中,所述第二轨迹规划非线性命题包括:轨迹代价函数和行驶约束条件;相应地,根据所述初始轨迹信息,对所述目标轨迹规划非线性命题进行求解,确定出所述目标车辆对应的目标规