[发明专利]路径规划方法、装置、电子设备和存储介质有效

专利信息
申请号: 202010156517.5 申请日: 2020-03-09
公开(公告)号: CN113448324B 公开(公告)日: 2023-08-04
发明(设计)人: 万印康;唐李征 申请(专利权)人: 北京合众思壮科技股份有限公司
主分类号: G05D1/02 分类号: G05D1/02
代理公司: 北京中知法苑知识产权代理有限公司 11226 代理人: 李明;赵吉阳
地址: 100176 北京市*** 国省代码: 北京;11
权利要求书: 查看更多 说明书: 查看更多
摘要:
搜索关键词: 路径 规划 方法 装置 电子设备 存储 介质
【权利要求书】:

1.一种路径规划方法,应用在自动驾驶过程中实现对角线作业,其特征在于,包括:

根据预先获取的作业区域边界信息获取所述作业区域对应的规则作业区域,其中,所述规则作业区域在所述作业区域内;

根据所述规则作业区域的边界信息以及预先获取的作业车辆初始位置信息,生成第一对角线作业路径path1

根据所述path1,生成所述规则作业区域内对角线作业路径集path={path1,path2,…,pathk,…,pathN},其中,N=2,k∈[1,N];

确定所述path中每条pathk的作业顺序;

根据所述path以及每条所述pathk的作业顺序完成路径规划;

所述方法,还包括:

在切换对角线作业路径时,采用Dubins转向方式,生成对角线路径切换过渡路径;

则所述根据所述path以及每条所述pathk的作业顺序完成路径规划替换为:

根据所述path、每条所述pathk的作业顺序以及所述对角线路径切换过渡路径完成路径规划;

其中,所述Dubins转向方式为CrClCr模式转向,所述CrClCr模式转向的数学模型如下:

Dall=D1+D2+D3=θse+2D2

其中,Ds-e为转向出入射点的欧式距离值,θs、θe为出入射转向角,mod(θx,2π)为对θx除2π取余,θ1θ2分别是路径过渡节点与o的夹角,o为过渡圆心,Dall为CrClCr模式转向中D1、D2和D3组成的所述对角线路径切换过渡路径。

2.根据权利要求1所述的方法,其特征在于,所述根据所述规则作业区域的边界信息以及预先获取的作业车辆初始位置信息,生成第一对角线作业路径path1包括:

根据所述作业车辆初始位置信息确定与所述规则作业区域的第一长边的第一夹角;

根据所述第一夹角和所述作业车辆初始位置信息生成初始射线路径,获取所述初始射线路径与所述规则作业区域的第二长边的交点;

在所述第二长边的交点上,采用镜面反射方式对所述初始射线路径进行反射,生成第二射线路径,获取所述第二射线路径与所述第一长边的交点;

以此方法类推,直至生成的射线路径与所述第一长边和所述第二长边均无交点时结束,进而生成所述第一对角线作业路径path1

3.根据权利要求1所述的方法,其特征在于,还包括:

根据预先获取的所述作业车辆的转弯半径和作业幅宽为所述path中每条pathk生成转弯过渡路径;

则所述根据所述path以及每条所述pathk的作业顺序完成路径规划替换为:

根据所述path、每条所述pathk的作业顺序以及每条所述pathk的转弯过渡路径完成路径规划。

4.根据权利要求1-3中任意一项所述的方法,其特征在于,还包括:

对预先获取的各项参数进行完整性和合理性判断,当判断结果为不合理和/或不完整时,提示相关判断结果。

下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。

该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京合众思壮科技股份有限公司,未经北京合众思壮科技股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服

本文链接:http://www.vipzhuanli.com/pat/books/202010156517.5/1.html,转载请声明来源钻瓜专利网。

×

专利文献下载

说明:

1、专利原文基于中国国家知识产权局专利说明书;

2、支持发明专利 、实用新型专利、外观设计专利(升级中);

3、专利数据每周两次同步更新,支持Adobe PDF格式;

4、内容包括专利技术的结构示意图流程工艺图技术构造图

5、已全新升级为极速版,下载速度显著提升!欢迎使用!

请您登陆后,进行下载,点击【登陆】 【注册】

关于我们 寻求报道 投稿须知 广告合作 版权声明 网站地图 友情链接 企业标识 联系我们

钻瓜专利网在线咨询

周一至周五 9:00-18:00

咨询在线客服咨询在线客服
tel code back_top