利索能及
我要发布
收藏
专利号: 2021100155407
申请人: 中智行科技有限公司
专利类型:发明专利
专利状态:已下证
更新日期:2026-06-16
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种路径规划方法,其特征在于,包括:获取环境信息、自身状态信息和道路地图;

根据所述自身状态信息对所述道路地图进行栅格化得到栅格地图,所述栅格地图包括多个栅格;

根据所述环境信息确定所述栅格的权重;

确定所述栅格地图中目标障碍物对应的栅格序列集合,所述栅格序列集合包括多个栅格序列;

确定所述目标障碍物的速度,以及所述栅格序列中障碍物的速度;

根据所述栅格序列中障碍物的速度确定所述目标障碍物位于所述栅格序列的期望速度;

根据所述目标障碍物位于所述栅格序列的期望速度和所述目标障碍物的速度,确定所述栅格序列的消耗时间;

确定所述栅格序列集合中栅格序列的总消耗时间,所述总消耗时间为所述栅格序列的消耗时间之和;

根据所述栅格的权重、所述总消耗时间和所述栅格序列的消耗时间,确定所述栅格序列对应的轨迹概率;

根据目标栅格序列确定所述目标障碍物的预测轨迹,所述目标栅格序列为所述栅格序列集合中栅格序列所对应轨迹概率的数值大于预设阈值的栅格序列;

根据所述预测轨迹进行自身路径规划,得到规划路径。

2.如权利要求1所述的路径规划方法,其特征在于,所述栅格序列中包括多个栅格,所述根据所述目标障碍物位于所述栅格序列的期望速度和所述目标障碍物的速度,确定所述栅格序列的消耗时间,包括:确定所述栅格序列中的相邻栅格,所述相邻栅格为两两相邻的栅格;

当所述相邻栅格位于同一车道时,根据所述目标障碍物的速度确定所述目标障碍物在所述相邻栅格之间行驶所耗的第一时间;

当所述相邻栅格位于不同车道时,根据所述目标障碍物位于所述栅格序列的期望速度和所述目标障碍物的速度确定所述目标障碍物在所述相邻栅格之间行驶所耗的第二时间;

对所述栅格序列中所有所述相邻栅格的第一时间和第二时间进行求和处理,得到所述栅格序列的消耗时间。

3.如权利要求1所述的路径规划方法,其特征在于,所述根据所述栅格的权重、所述总消耗时间和所述栅格序列的消耗时间,确定所述栅格序列对应的轨迹概率,包括:确定所述栅格序列的消耗时间相对所述总消耗时间的消耗比例;

根据所述栅格的权重对所述消耗比例进行加权,得到所述栅格序列对应的轨迹概率。

4.如权利要求1所述的路径规划方法,其特征在于,所述自身状态信息包括自身定位信息和自身运动速度,所述根据所述自身状态信息对所述道路地图进行栅格化得到栅格地图,包括:

根据预设长度系数和所述自身运动速度确定栅格长度;

根据所述道路地图中车道的宽度确定栅格宽度;

以所述自身定位信息在所述道路地图中的位置为基准,根据所述栅格长度和所述栅格宽度对所述道路地图进行栅格化,得到栅格地图。

5.如权利要求1所述的路径规划方法,其特征在于,所述环境信息包括所述目标障碍物的当前位置、所述目标障碍物的朝向和所述目标障碍物的速度,所述根据目标栅格序列确定所述目标障碍物的预测轨迹,包括:确定所述道路地图中车道的朝向;

根据所述目标障碍物的速度、所述目标障碍物的当前位置、所述目标障碍物的朝向和所述车道的朝向,确定收敛系数;

根据所述目标障碍物的当前位置、所述目标障碍物的速度和所述收敛系数,以预设时间间隔在所述目标栅格序列中生成多个轨迹点;

根据所述多个轨迹点确定所述目标障碍物的预测轨迹。

6.如权利要求5所述的路径规划方法,其特征在于,所述目标障碍物的当前位置包括当前横向位置和当前纵向位置,所述根据所述目标障碍物的当前位置、所述目标障碍物的速度和所述收敛系数,以预设时间间隔在所述目标栅格序列中生成多个轨迹点,包括:根据所述目标障碍物的速度,以所述预设时间间隔将所述当前纵向位置进行修改,得到轨迹点的纵向位置;

根据所述收敛系数,以预设时间间隔将所述当前横向位置进行修改,得到轨迹点的横向位置;

根据所述轨迹点的纵向位置和所述轨迹点的横向位置,在所述目标栅格序列中生成轨迹点。

7.如权利要求1所述的路径规划方法,其特征在于,所述根据所述环境信息确定所述栅格的权重,包括:

根据所述环境信息确定所述栅格地图中障碍物的分布情况;

确定所述栅格上一时刻的权重;

根据所述栅格地图中障碍物的分布情况对所述上一时刻的权重进行更新,得到所述栅格当前时刻的权重。

8.一种路径规划装置,其特征在于,包括:获取单元,用于获取环境信息、自身状态信息和道路地图;

栅格化单元,用于根据所述自身状态信息对所述道路地图进行栅格化得到栅格地图,所述栅格地图包括多个栅格;

权重单元,用于根据所述环境信息确定所述栅格的权重;

序列单元,用于确定所述栅格地图中目标障碍物对应的栅格序列集合,所述栅格序列集合包括多个栅格序列;

概率单元,用于确定所述目标障碍物的速度,以及所述栅格序列中障碍物的速度;

概率单元,还用于根据所述栅格序列中障碍物的速度确定所述目标障碍物位于所述栅格序列的期望速度;

概率单元,还用于根据所述目标障碍物位于所述栅格序列的期望速度和所述目标障碍物的速度,确定所述栅格序列的消耗时间;

概率单元,还用于确定所述栅格序列集合中栅格序列的总消耗时间,所述总消耗时间为所述栅格序列的消耗时间之和;

概率单元,还用于根据所述栅格的权重、所述总消耗时间和所述栅格序列的消耗时间,确定所述栅格序列对应的轨迹概率;

轨迹单元,用于根据目标栅格序列确定所述目标障碍物的预测轨迹,所述目标栅格序列为所述栅格序列集合中栅格序列所对应轨迹概率的数值大于预设阈值的栅格序列;

规划单元,用于根据所述预测轨迹进行自身路径规划,得到规划路径。

9.一种电子设备,其特征在于,包括处理器和存储器,所述存储器存储有多条指令;所述处理器从所述存储器中加载指令,以执行如权利要求1 7任一项所述的路径规划方法中~

的步骤。

10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有多条指令,所述指令适于处理器进行加载,以执行权利要求1 7任一项所述的路径规划方法中的步~

骤。