[发明专利]一种基于自主建图的路线修正方法、装置以及电子设备在审

专利信息
申请号: 202110725907.4 申请日: 2021-06-29
公开(公告)号: CN113566837A 公开(公告)日: 2021-10-29
发明(设计)人: 唐铭锴;郑林伟;李远航;陈映冰;刘天瑜;王鲁佳;刘明 申请(专利权)人: 深圳一清创新科技有限公司
主分类号: G01C21/34 分类号: G01C21/34
代理公司: 深圳市六加知识产权代理有限公司 44372 代理人: 许铨芬
地址: 518000 广东省深圳市南山区粤海街道高新区社区粤*** 国省代码: 广东;44
权利要求书: 查看更多 说明书: 查看更多
摘要:
搜索关键词: 一种 基于 自主 路线 修正 方法 装置 以及 电子设备
【权利要求书】:

1.一种基于自主建图的路线修正方法,其特征在于,包括:

获取跳变轨迹点,以及获取所述跳变轨迹点的得分,其中,所述跳变轨迹点的得分表示所述跳变轨迹点的曲率相对于与跳变轨迹点相邻的第一轨迹点的曲率、第二轨迹点的曲率的变化情况;

获取所述跳变轨迹点周围的目标修正点,其中,所述目标修正点的得分最小,其中,所述目标修正点的得分最小表示所述目标修正点的曲率相对于所述第一轨迹点的曲率、第二轨迹点的曲率的变化最小;

用所述目标修正点替换所述跳变轨迹点。

2.根据权利要求1所述的方法,其特征在于,所述获取所述跳变轨迹点周围的目标修正点的步骤,进一步包括:

获取距离所述跳变轨迹点预设步长的多个修正点,分别计算所述多个修正点的得分;

判断所述多个修正点的得分是否均不小于所述跳变轨迹点的得分;

若否,则获取所述多个修正点中得分最小的选定修正点;

用所述选定修正点替换所述跳变轨迹点,以及返回所述获取距离所述跳变轨迹点预设步长的多个修正点,分别计算所述多个修正点的得分的步骤,直到所述多个修正点的得分均不小于所述跳变轨迹点的得分,将最终获得的所述选定修正点作为所述目标修正点。

3.根据权利要求2所述的方法,其特征在于,所述跳变轨迹点的坐标为(x,y),所述距离所述跳变轨迹点预设步长的多个修正点的坐标分别为(x+step,y)、(x-step,y)、(x,y+step)和(x,y-step),其中,所述step为所述预设步长。

4.根据权利要求1-3任意一项所述的方法,其特征在于,所述获取跳变轨迹点,以及获取所述跳变轨迹点的得分的步骤之前,所述方法还包括:

判断所述跳变轨迹点的初始得分是否大于预设阈值;

若是,则获取所述跳变轨迹点的初始横纵坐标;

根据所述初始横纵坐标,将所述跳变轨迹点调整至所述第一轨迹点和第二轨迹点所在的曲线,所述获取跳变轨迹点为获取调整后的跳变轨迹点,所述获取所述跳变轨迹点的得分为获取调整后的跳变轨迹点的得分;

若否,则直接执行所述获取跳变轨迹点,以及获取所述跳变轨迹点的得分的步骤。

5.根据权利要求1-3任意一项所述的方法,其特征在于,所述获取跳变轨迹点的步骤,进一步包括:

获取待测轨迹点的曲率;

获取与所述待测轨迹点相邻的第一轨迹点的曲率;

获取与所述待测轨迹点相邻的第二轨迹点的曲率;

根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分;

判断所述待测轨迹点的得分是否大于预设值;

若是,则确定所述待测轨迹点是跳变轨迹点;

否则,确定所述待测轨迹点不是跳变轨迹点。

6.根据权利要求5所述的方法,其特征在于,所述获取待测轨迹点的曲率的步骤,进一步包括:

拟合所述待测轨迹点和第二轨迹点所在的曲线的轨迹方程;

根据所述轨迹方程,获取所述待测轨迹点的曲率。

7.根据权利要求5所述的方法,其特征在于,所述根据所述待测轨迹点的曲率,所述第一轨迹点的曲率,以及所述第二轨迹点的曲率,计算所述待测轨迹点的得分的公式为:

scorei=|Ki-Ki-1|+|Ki+1-Ki|;

其中,所述scorei为所述待测轨迹点的得分,所述Ki为所述待测轨迹点的曲率,所述Ki-1为所述第一轨迹点的曲率,所述Ki-1为所述第一轨迹点相对于所述待测轨迹点的曲率,所述Ki+1为所述第二轨迹点的曲率,所述Ki+1为所述第二轨迹点相对于所述待测轨迹点的曲率。

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

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

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

×

专利文献下载

说明:

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

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

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

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

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

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

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

钻瓜专利网在线咨询

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

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