[发明专利]一种无人车循迹控制方法、装置、设备及存储介质在审
申请号: | 201910236893.2 | 申请日: | 2019-03-27 |
公开(公告)号: | CN109901586A | 公开(公告)日: | 2019-06-18 |
发明(设计)人: | 陈宇建;石添华;吴敏;张文超 | 申请(专利权)人: | 厦门金龙旅行车有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 厦门智慧呈睿知识产权代理事务所(普通合伙) 35222 | 代理人: | 郭福利 |
地址: | 361000 福建省厦*** | 国省代码: | 福建;35 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 无人车 预设 轨迹坐标 实时位置信息 存储介质 位置偏移 循迹控制 循迹 行驶 地图坐标 连续序列 实时比对 实时位置 行驶轨迹 行驶过程 最佳路径 坐标转换 坐标点 纠正 驾驶 保证 规划 | ||
1.一种无人车循迹控制方法,其特征在于,包括:
获取无人车实时位置信息;
基于所述无人车实时位置信息与预设轨迹坐标序列,对所述无人车的循迹路径进行位置偏移纠正;其中,所述预设轨迹坐标序列为所述无人车预设行驶轨迹基于WGS-84坐标转换下形成的一段连续序列的地图坐标点。
2.根据权利要求1所述的无人车循迹控制方法,其特征在于,获取无人车的实时位置之后,还包括:
基于所述无人车实时位置信息和WGS-84坐标转换,获取所述无人车实时位置的实时坐标。
3.根据权利要求2所述的无人车循迹控制方法,其特征在于,基于所述无人车实时位置与预设轨迹坐标序列,对所述无人车的循迹路径进行位置偏移纠正的步骤具体包括:
匹配所述实时坐标与所述预设轨迹坐标序列,从所述预设轨迹坐标序列中获取与所述实时坐标距离最近的定位坐标;
基于所述定位坐标,生成局部轨迹坐标序列;
基于所述实时坐标和所述局部轨迹坐标序列,计算所述无人车循迹偏移的角度,用以对所述无人车的循迹路径进行位置偏移纠正。
4.根据权利要求3所述的无人车循迹控制方法,其特征在于,匹配所述实时坐标与所述预设轨迹坐标序列,获取与所述实时坐标距离最近的定位坐标的步骤包括:
基于预设的距离计算公式获取所述预设轨迹坐标序列当中某个坐标点pi(Xi,Yi)与所述实时坐标点pk(Xk,Yk)之间的距离D;
当所述距离D小于或等于预设最小距离阈值时,将此时的坐标点pi(Xi,Yi)记为与所述实时坐标距离最近的定位坐标。
5.根据权利要求4所述的无人车循迹控制方法,其特征在于,根据所述定位坐标,生成局部轨迹坐标序列的步骤包括:
以所述定位坐标为起点,采集所述定位坐标预设范围阈值内的所有所述预设轨迹坐标序列,生成所述局部轨迹坐标序列。
6.根据权利要求5所述的无人车循迹控制方法,其特征在于,根据所述实时坐标和所述局部轨迹坐标序列,计算所述无人车循迹偏移的角度的步骤包括:
选取所述局部轨迹坐标序列的任一坐标点pt(Xt,Yt);
基于角度计算公式获取所述实时坐标点pk(Xk,Yk)与所述局部轨迹坐标序列的任一坐标点pt(Xt,Yt)之间的角度,以使所述无人车能够根据所述角度沿循迹路径进行位置偏移纠正。
7.一种无人车循迹控制装置,其特征在于,包括:
位置获取单元,用于获取无人车实时位置;
偏移纠正单元,用于基于所述无人车实时位置与预设轨迹坐标序列,对所述无人车的循迹路径进行位置偏移纠正;其中,所述预设轨迹坐标序列为所述无人车预设行驶轨迹基于WGS-84坐标转换下形成的一段连续序列的地图坐标点。
8.根据权利要求7所述的无人车循迹控制装置,其特征在于,所述偏移纠正单元包括:
匹配模块,用于匹配所述实时坐标与所述预设轨迹坐标序列,从所述预设轨迹坐标序列中获取与所述实时坐标距离最近的定位坐标;
局部轨迹生产模块,用于基于所述定位坐标,生成局部轨迹坐标序列;
角度计算模块,用于基于所述实时坐标和所述局部轨迹坐标序列,计算所述无人车循迹偏移的角度,用以对所述无人车的循迹路径进行位置偏移纠正。
9.一种车载计算设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现如权利要求1~6所述的无人车循迹控制方法。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现权利要求1~6任一项所述无人车循迹控制方法的步骤。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于厦门金龙旅行车有限公司,未经厦门金龙旅行车有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910236893.2/1.html,转载请声明来源钻瓜专利网。