[发明专利]机器人路径目标点跟踪方法、装置、电子设备及存储介质在审

专利信息
申请号: 202111026181.1 申请日: 2021-09-02
公开(公告)号: CN113741456A 公开(公告)日: 2021-12-03
发明(设计)人: 冷晓琨;常琳;何治成;白学林;柯真东;王松;吴雨璁;黄贤贤 申请(专利权)人: 乐聚(深圳)机器人技术有限公司
主分类号: G05D1/02 分类号: G05D1/02
代理公司: 北京超凡宏宇专利代理事务所(特殊普通合伙) 11463 代理人: 曹瑞敏
地址: 518110 广东省深圳市*** 国省代码: 广东;44
权利要求书: 查看更多 说明书: 查看更多
摘要:
搜索关键词: 机器人 路径 目标 跟踪 方法 装置 电子设备 存储 介质
【权利要求书】:

1.一种机器人路径目标点跟踪方法,其特征在于,包括:

获取机器人的当前落脚点位置和目标跟踪点位置;

根据所述当前落脚点位置和所述目标跟踪点位置,采用第一线性控制器获取机器人在至少一个移动方向上的第一控制参数,所述第一控制参数包括:第一比例项控制参数、第一积分项控制参数以及第一误差修正项控制参数;

根据所述机器人在至少一个移动方向上的第一控制参数,控制所述机器人从所述当前落脚点位置移动至所述目标跟踪点位置。

2.根据权利要求1所述的方法,其特征在于,所述根据所述机器人在至少一个移动方向上的第一控制参数,控制所述机器人从所述当前落脚点位置移动至所述目标跟踪点位置,包括:

根据所述当前落脚点位置和所述目标跟踪点位置,采用第二线性控制器获取所述机器人的转角控制参数,所述转角控制参数包括:第二比例项控制参数和第二积分项控制参数;

根据所述机器人在至少一个移动方向上的第一控制参数和所述转角控制参数,控制所述机器人从所述当前落脚点位置移动至所述目标跟踪点位置。

3.根据权利要求1或2所述的方法,其特征在于,所述根据所述当前落脚点位置和所述目标跟踪点位置,采用第一线性控制器获取机器人在至少一个移动方向上的第一控制参数,包括:

根据所述当前落脚点位置和所述目标跟踪点位置,分别获取所述当前落脚点位置和所述目标跟踪点位置在第一移动方向上的第一位置偏差、所述目标跟踪点位置相对于所述当前落脚点位置的第一转角偏差;

根据所述第一位置偏差,采用第一线性控制器分别计算所述第一比例项控制参数和所述第一积分项控制参数;

根据所述第一转角偏差,采用第一线性控制器计算所述第一误差修正项控制参数;

根据所述第一比例项控制参数、所述第一积分项控制参数、以及所述第一误差修正项控制参数,计算机器人在第一移动方向上的第一控制参数。

4.根据权利要求3所述的方法,其特征在于,所述根据所述第一位置偏差,采用第一线性控制器计算所述第一比例项控制参数,包括:

根据所述第一位置偏差和第一预设比例项系数,计算初始比例项控制参数;

若确定初始比例项控制参数大于预设比例项控制阈值,则将所述预设比例项控制阈值作为第一比例项控制参数;

若确定初始比例项控制参数小于所述预设比例项控制阈值,则将所述初始比例项控制参数作为所述第一比例项控制参数。

5.根据权利要求3所述的方法,其特征在于,所述根据所述第一位置偏差,采用第一线性控制器计算所述第一积分项控制参数,包括:

根据所述第一位置偏差对应的第一控制周期,获取第一预设数量个历史控制周期内多个历史第一位置偏差的第一位置偏差和;

根据第一预设积分项系数和所述第一位置偏差和,计算所述第一积分项控制参数。

6.根据权利要求3所述的方法,其特征在于,所述根据所述第一转角偏差,采用第一线性控制器计算所述第一误差修正项控制参数,包括:

根据第一预设误差修正项系数和所述第一转角偏差,采用所述第一线性控制器计算所述第一误差修正项控制参数。

7.根据权利要求2所述的方法,其特征在于,所述根据所述当前落脚点位置和所述目标跟踪点位置,采用第二线性控制器获取所述机器人的转角控制参数,包括:

根据所述当前落脚点位置和所述目标跟踪点位置,获取所述目标跟踪点位置相对于所述当前落脚点位置的第二转角偏差;

根据所述第二转角偏差和第二预设比例项系数,采用所述第二线性控制器计算所述第二比例项控制参数;

根据所述第二转角偏差对应的第二控制周期,获取第二预设数量个历史控制周期内多个历史第二转角偏差的第二转角偏差和;

根据第二预设积分项系数和所述第二转角偏差和,计算所述第二积分项控制参数。

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

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

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

×

专利文献下载

说明:

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

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

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

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

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

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

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

钻瓜专利网在线咨询

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

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