[发明专利]自动驾驶路径规划方法、装置、电子设备、介质及车辆有效
申请号: | 202210234793.8 | 申请日: | 2022-03-10 |
公开(公告)号: | CN114719875B | 公开(公告)日: | 2023-05-05 |
发明(设计)人: | 任凯 | 申请(专利权)人: | 阿波罗智能技术(北京)有限公司 |
主分类号: | G01C21/34 | 分类号: | G01C21/34 |
代理公司: | 中科专利商标代理有限责任公司 11021 | 代理人: | 范芳茗 |
地址: | 100085 北京市*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 自动 驾驶 路径 规划 方法 装置 电子设备 介质 车辆 | ||
1.一种路径规划方法,包括:
响应于检测到待避让的障碍物,基于车辆的转向参数和行进参数,分别以多个转向约束来生成多条路径;其中,所述车辆的转向参数包括车辆驱动轮的正向最大转向速度和反向最大转向速度,所述转向约束包括车辆驱动轮的正向最大转向角度和反向最大转向角度,所述路径包括第一段、第二段和第三段;
从所述多条路径中去除与所述障碍物相交的路径,得到至少一条候选路径;
根据所述至少一条候选路径对应的转向约束,在所述至少一条候选路径中确定车辆的行驶路径;
其中,所述分别以多个转向约束来生成多条路径包括:针对至少一个转向约束,
基于车辆驱动轮的正向最大转向速度和行进参数来生成第一段,直至计算出车辆驱动轮的转向角度达到正向最大转向角度;
从第一段的末端开始,基于车辆驱动轮的反向最大转向速度和行进参数来生成第二段,直至计算出车辆驱动轮的转向角度达到反向最大转向角度;以及
从第二段的末端开始,基于车辆驱动轮的正向最大转向速度和行进参数来生成第三段,直至计算出车辆驱动轮的转向角度小于或等于预设角度。
2.根据权利要求1所述的方法,其中,所述路径的第一段、第二段和第三段各自包括多个位置点,所述位置点是使用以下公式来生成的:
x(s)=∫0scos(θ)ds
y(s)=∫0ssin(θ)ds
c=atan(lk0)
其中,x表示位置点的横坐标,y表示位置点的纵坐标,s表示位置点与路径的起始点之间沿着路径的距离,wmax表示车辆的转向参数,其中wmax为正值表示车辆驱动轮的正向最大转向速度,wmax为负值表示车辆驱动轮的反向最大转向速度,θ表示路径在位置点处的切线相对于横坐标方向的角度,v表示车辆行进方向上的速度,k0表示路径的起始点处的曲率,1表示车辆的车轴距,θ0表示路径的起始点处车身纵轴相对于横坐标方向的角度,c表示常数,其中所述行进参数包括v和k0。
3.根据权利要求2所述的方法,其中,车辆驱动轮的转向角度是使用以下公式计算的:
其中,表示车辆驱动轮的转向角度,1表示车辆的车轴距,κ表示路径在当前生成的位置点处的曲率。
4.根据权利要求1至3中任一项所述的方法,其中,所述根据候选路径对应的转向约束,在所述至少一条候选路径中确定车辆的行驶路径包括:
在所述至少一条候选路径中选择转向约束值最小的候选路径作为车辆的行驶路径,其中所述转向约束包括正向最大转向角度和反向最大转向角度,所述转向约束值是根据所述正向最大转向角度和反向最大转向角度的绝对值来确定的。
5.根据权利要求1至3中任一项所述的方法,还包括:在确定车辆的行驶路径之后,响应于再次检测到待避让的障碍物且所述再次检测到的障碍物与所确定的行驶路径不相交,将所确定的行驶路径复用为用于避让所述再次检测到的障碍物的行驶路径。
6.根据权利要求1至3中任一项所述的方法,其中,从所述多条路径中去除与所述障碍物相交的路径包括:
确定所述障碍物的轮廓;
从所述多条路径中去除与所述障碍物的轮廓相交的路径。
7.根据权利要求6所述的方法,还包括:在从所述路径中去除与所述障碍物的轮廓相交的路径之前,将所述障碍物的轮廓以预设的比例扩大。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于阿波罗智能技术(北京)有限公司,未经阿波罗智能技术(北京)有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202210234793.8/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种用于CTP制版机的转辊清洁结构
- 下一篇:一种整车需求扭矩控制方法