[发明专利]一种车辆的轨迹规划方法、装置、存储介质及汽车有效
| 申请号: | 201910950676.X | 申请日: | 2019-10-08 |
| 公开(公告)号: | CN111169469B | 公开(公告)日: | 2021-03-12 |
| 发明(设计)人: | 尚秉旭;刘洋;陈志新;王洪峰;陈捷;李宇寂;许朝文 | 申请(专利权)人: | 中国第一汽车股份有限公司 |
| 主分类号: | B60W30/06 | 分类号: | B60W30/06;B60W30/09;B60W30/12;B60W30/18;B60W40/105;B60W40/109;B60W40/114;B60W50/00;B60W60/00 |
| 代理公司: | 北京远智汇知识产权代理有限公司 11659 | 代理人: | 范坤坤 |
| 地址: | 130011 吉林省长春市*** | 国省代码: | 吉林;22 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 一种 车辆 轨迹 规划 方法 装置 存储 介质 汽车 | ||
1.一种车辆的轨迹规划方法,其特征在于,包括:
获取在起点位置及终点位置时车辆到车道线的侧向偏差、车辆相对于车道线的侧向速度以及车辆相对于车道线的侧向加速度;
获取预先设计的轨迹方程,并基于侧向加速度对所述轨迹方程进行拟合处理;
基于所述侧向偏差、侧向速度和侧向加速度求解拟合后的轨迹方程,得到轨迹曲线,以基于所述轨迹曲线进行自动驾驶。
2.根据权利要求1所述的方法,其特征在于,所述轨迹方程包括:
在设定时间段内不连续的状态函数,且所述设定时间段包括至少两个时间子区域,在各个所述时间子区间内所述状态函数均为连续函数,其中,所述状态函数基于侧向偏差、侧向速度、侧向加速度和加速度变化率构成。
3.根据权利要求2所述的方法,其特征在于,基于侧向加速度对所述轨迹方程进行拟合处理,包括:
基于所述侧向加速度采用贝塞尔曲线对各个所述时间子区域内的所述状态函数进行拟合处理,得到拟合后的轨迹方程。
4.根据权利要求3所述的方法,其特征在于,基于所述侧向加速度采用贝塞尔曲线对各个所述时间子区域内的所述状态函数进行拟合处理,包括:
获取预先定义的侧向加速度的贝塞尔曲线,作为侧向加速度函数:
分别对所述加速度函数进行一次积分和二次积分得到侧向速度函数和侧向位移函数;
根据所述侧向加速度函数、侧向速度函数和侧向位移函数确定拟合后的轨迹方程。
5.根据权利要求1所述的方法,其特征在于,基于所述侧向偏差、侧向速度和侧向加速度求解拟合后的轨迹方程,得到轨迹曲线,包括:
根据所述侧向偏差、侧向速度和侧向加速度分别计算各个所述时间子区间内的速度差值和位移差值;
基于所述速度差值和位移差值确定各个所述子区间的中间点位置的侧向加速度和所述子区间的起点位置至所述中间点位置的时间差;
基于起点位置、中间点位置及终点位置时车辆到车道线的侧向偏差、车辆相对于车道线的侧向速度以及车辆相对于车道线的侧向加速度,确定所述轨迹方程对应的轨迹曲线。
6.一种车辆的轨迹规划装置,其特征在于,包括:
速度获取模块,用于获取在起点位置及终点位置时车辆到车道线的侧向偏差、车辆相对于车道线的侧向速度以及车辆相对于车道线的侧向加速度;
方程拟合模块,用于获取预先设计的轨迹方程,并基于侧向加速度对所述轨迹方程进行拟合处理;
曲线确定模块,用于基于所述侧向偏差、侧向速度和侧向加速度求解拟合后的轨迹方程,得到轨迹曲线,以基于所述轨迹曲线进行自动驾驶。
7.根据权利要求6所述的装置,其特征在于,所述轨迹方程包括:
在设定时间段内不连续的状态函数,且所述设定时间段包括至少两个时间子区域,在各个所述时间子区间内所述状态函数均为连续函数,其中,所述状态函数基于侧向偏差、侧向速度、侧向加速度和加速度变化率构成;
以及,方程拟合模块具体用于:
基于所述侧向加速度采用贝塞尔曲线对各个所述时间子区域内的所述状态函数进行拟合处理,得到拟合后的轨迹方程。
8.根据权利要求7所述的装置,其特征在于,曲线确定模块具体用于:
根据所述侧向偏差、侧向速度和侧向加速度分别计算各个所述时间子区间内的速度差值和位移差值;
基于所述速度差值和位移差值确定各个所述子区间的中间点位置的侧向加速度和所述子区间的起点位置至所述中间点位置的时间差;
基于起点位置、中间点位置及终点位置时车辆到车道线的侧向偏差、车辆相对于车道线的侧向速度以及车辆相对于车道线的侧向加速度,确定所述轨迹方程对应的轨迹曲线。
9.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现如权利要求1-5中任一所述的车辆的轨迹规划方法。
10.一种汽车,其特征在于,包括:
一个或多个处理器;
存储装置,用于存储一个或多个程序;
传感器,用于采集在起点位置及终点位置时车辆到车道线的侧向偏差、车辆相对于车道线的侧向速度以及车辆相对于车道线的侧向加速度;
当所述一个或多个程序被所述一个或多个处理器执行,使得所述一个或多个处理器实现如权利要求1-5中任一所述的车辆的轨迹规划方法。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国第一汽车股份有限公司,未经中国第一汽车股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910950676.X/1.html,转载请声明来源钻瓜专利网。
- 上一篇:互联网平台下获取劳动时间储蓄养老和各种互助
- 下一篇:网络系统





