[发明专利]轮式机器人的PID调参方法、装置、设备及存储介质在审

专利信息
申请号: 202211508549.2 申请日: 2022-11-28
公开(公告)号: CN115933363A 公开(公告)日: 2023-04-07
发明(设计)人: 陈文成;吕朝顺;邝昌根 申请(专利权)人: 劢微机器人科技(深圳)有限公司
主分类号: G05B11/42 分类号: G05B11/42
代理公司: 深圳市恒程创新知识产权代理有限公司 44542 代理人: 孔德丞
地址: 518000 广东省深圳市光*** 国省代码: 广东;44
权利要求书: 查看更多 说明书: 查看更多
摘要:
搜索关键词: 轮式 机器人 pid 方法 装置 设备 存储 介质
【权利要求书】:

1.一种轮式机器人的PID调参方法,其特征在于,所述方法包括以下步骤:

根据轮式机器人的实际横向坐标和实际航向角分别计算横向跟踪误差和航向角跟踪误差;

基于所述横向跟踪误差、所述航向角跟踪误差和PID控制参数更新Q值表,所述PID控制参数包含比例参数、积分参数和微分参数;

基于所述Q值表获得控制输入指令,并将所述控制输入指令传输至所述轮式机器人,以使所述轮式机器人根据所述控制输入指令更新横向坐标和航向角;

当更新后的横向坐标和航向角满足预设条件时,对所述PID控制参数对应的参数空间进行离散化,确定最优PID控制参数。

2.如权利要求1所述的轮式机器人的PID调参方法,其特征在于,所述根据轮式机器人的实际横向坐标和实际航向角分别计算横向跟踪误差和航向角跟踪误差之前,还包括:

以轮式机器人的中心为坐标原点建立空间直角坐标系;

通过雷达和惯性测量单元分别获取所述轮式机器人在所述空间直角坐标系中的实际横向坐标和实际航向角。

3.如权利要求1所述的轮式机器人的PID调参方法,其特征在于,所述根据轮式机器人的实际横向坐标和实际航向角分别计算横向跟踪误差和航向角跟踪误差,包括:

将预设横向坐标与实际横向坐标的差值设为横向跟踪误差;

将预设航向角与实际航向角的差值设为航向角跟踪误差。

4.如权利要求1所述的轮式机器人的PID调参方法,其特征在于,所述根据预设概率随机选取PID控制参数,基于所述横向跟踪误差、所述航向角跟踪误差和所述PID控制参数更新Q值表,所述PID控制参数包含比例参数、积分参数和微分参数,包括:

按照预设概率选取PID控制参数;

将所述横向跟踪误差和所述航向角跟踪误差输入至奖惩函数中,获得奖励值;

基于所述奖励值和所述PID控制参数更新Q值表。

5.如权利要求1所述的轮式机器人的PID调参方法,其特征在于,所述基于所述Q值表获得控制输入指令,并将所述控制输入指令传输至所述轮式机器人,以使所述轮式机器人根据所述控制输入指令更新横向坐标和航向角,包括:

提取出所述Q值表中最大Q值对应的PID控制参数;

基于所述最大Q值对应的参数获得控制输入指令;

将所述控制输入指令传输至所述轮式机器人,以使所述轮式机器人根据所述控制输入指令更新横向坐标和航向角。

6.如权利要求1所述的轮式机器人的PID调参方法,其特征在于,所述当更新后的横向坐标和航向角满足预设条件时,对所述PID控制参数对应的参数空间进行离散化,确定最优PID控制参数,包括:

根据更新后的横向坐标、更新后的航向角,分别计算更新后的横向跟踪误差、更新后的航向角跟踪误差;

若所述更新后的横向跟踪误差和所述更新后的航向角跟踪误差均满足预设条件,则对所述PID控制参数对应的参数空间进行离散化,确定最优PID控制参数。

7.如权利要求1所述的轮式机器人的PID调参方法,其特征在于,所述当更新后的横向坐标和航向角满足预设条件时,对所述PID控制参数对应的参数空间进行离散化,确定最优PID控制参数之前,还包括:

当更新后的横向坐标和航向角不满足预设条件时,重复以下步骤直至横向坐标和航向角满足预设条件:

根据轮式机器人的当前横向坐标和当前航向角分别计算当前横向跟踪误差和当前航向角跟踪误差;

基于所述当前横向跟踪误差、所述当前航向角跟踪误差和PID控制参数更新Q值表;

基于所述Q值表获得控制输入指令,并将所述控制输入指令传输至所述轮式机器人,以使所述轮式机器人根据所述控制输入指令更新横向坐标和航向角。

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

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

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

×

专利文献下载

说明:

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

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

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

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

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

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

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

钻瓜专利网在线咨询

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

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