[发明专利]自动驾驶控制方法、装置、设备及存储介质有效
申请号: | 201910484607.4 | 申请日: | 2019-06-05 |
公开(公告)号: | CN110244721B | 公开(公告)日: | 2022-04-12 |
发明(设计)人: | 刘振;刘石劬;贾丙西 | 申请(专利权)人: | 杭州飞步科技有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 北京同立钧成知识产权代理有限公司 11205 | 代理人: | 朱颖;臧建明 |
地址: | 310012 浙江省杭州市西湖*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 自动 驾驶 控制 方法 装置 设备 存储 介质 | ||
1.一种自动驾驶控制方法,其特征在于,包括:
获取当前时刻目标车辆的运行状态信息,所述运行状态信息包括所述目标车辆当前的第一位置、运行速度、运行方向;
基于所述第一位置、所述运行速度和所述运行方向,确定所述目标车辆运行预设时长后的第二位置,并确定所述第二位置处的车道宽度值,以及所述第二位置距离车道中心线的第一距离;
基于所述第一距离和所述车道宽度值进行求和处理,得到所述目标车辆运行所述预设时长后与所述车道中心线之间的距离约束参数;
基于所述距离约束参数调节在所述目标车辆中运行的轨迹跟踪函数的参数,以使所述目标车辆根据所述轨迹跟踪函数输出的方向盘控制量运行,其中,所述轨迹跟踪函数用于根据所述目标车辆与车道中心线之间的距离,输出车辆方向盘的控制量,使得所述目标车辆在车道的预设位置上运行;
其中,所述距离约束参数b的取值为:
其中,k为离散时刻,MAPlimit(k)为目标车辆在所述第二位置时的车道宽度值,||er(0)||为目标车辆在所述第一位置时与车道中心线之间距离,er(k+1)为目标车辆在所述第二位置时域车道中心线之间的距离。
2.根据权利要求1所述的方法,其特征在于,所述基于所述第一位置、所述运行速度和所述运行方向,确定所述目标车辆运行所述预设时长后的第二位置,包括:
基于所述运行速度和所述预设时长执行运算操作,获得所述目标车辆在所述预设时长的时间内可运行的第二距离;
以所述第一位置为起点,沿所述运行方向,确定所述目标车辆运行所述第二距离后的第二位置。
3.根据权利要求2所述的方法,其特征在于,所述基于所述运行速度和所述预设时长执行运算操作,获得所述目标车辆在所述预设时长的时间内可运行的第二距离,包括:
获取当前时刻所述目标车辆的加速度;
基于所述加速度、所述运行速度和所述预设时长执行运算操作,获得所述目标车辆在所述预设时长的时间内可运行的第二距离。
4.根据权利要求1所述的方法,其特征在于,所述基于所述第一距离和所述车道宽度值进行求和处理,得到所述目标车辆运行所述预设时长后与所述车道中心线之间的距离约束参数,包括:
获取所述目标车辆在所述第一位置处与所述车道中心线之间的第三距离;
对所述第一距离、所述第三距离和所述车道宽度值进行求和处理,得到所述目标车辆运行所述预设时长后与所述车道中心线之间的距离约束参数。
5.一种自动驾驶控制装置,其特征在于,包括:
获取模块,用于获取当前时刻目标车辆的运行状态信息,所述运行状态信息包括所述目标车辆当前的第一位置、运行速度、运行方向;
距离确定模块,用于基于所述第一位置、所述运行速度和所述运行方向,确定所述目标车辆运行预设时长后的第二位置,并确定所述第二位置处的车道宽度值,以及所述第二位置距离车道中心线的第一距离;
约束确定模块,基于所述第一距离和所述车道宽度值进行求和处理,得到所述目标车辆运行所述预设时长后与所述车道中心线之间的距离约束参数;
求解模块,用于基于所述距离约束参数调节在所述目标车辆中运行的轨迹跟踪函数的参数,以使所述目标车辆根据所述轨迹跟踪函数输出的方向盘控制量运行,其中,所述轨迹跟踪函数用于根据所述目标车辆与车道中心线之间的距离,输出车辆方向盘的控制量,使得所述目标车辆在车道的预设位置上运行;
其中,所述距离约束参数b的取值为:
其中,k为离散时刻,MAPlimit(k)为目标车辆在所述第二位置时的车道宽度值,||er(0)||为目标车辆在所述第一位置时与车道中心线之间距离,er(k+1)为目标车辆在所述第二位置时域车道中心线之间的距离。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于杭州飞步科技有限公司,未经杭州飞步科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910484607.4/1.html,转载请声明来源钻瓜专利网。