[发明专利]一种复杂约束下的移动机器人跟踪控制方法有效
申请号: | 202111041211.6 | 申请日: | 2021-09-07 |
公开(公告)号: | CN113805585B | 公开(公告)日: | 2023-03-21 |
发明(设计)人: | 赵承浩;郑世祺;徐彬彬 | 申请(专利权)人: | 中国地质大学(武汉) |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 武汉知产时代知识产权代理有限公司 42238 | 代理人: | 魏波 |
地址: | 430000 湖*** | 国省代码: | 湖北;42 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 复杂 约束 移动 机器人 跟踪 控制 方法 | ||
1.一种复杂约束下的移动机器人跟踪控制方法,其特征在于:包括以下步骤:
步骤1、输入机器人的目标点,并设定机器人的初始状态,同时对机器人的每个部件进行受力分析,建立机器人的动力学模型,设置复杂约束机器人控制器;
步骤2、遥控控制机器人使用二维激光雷达扫描周围环境,通过SLAM算法创建环境地图;
步骤3、利用A-star路径规划算法在所述环境地图中进行规划,并计算得到最优路径,从而获得机器人期望轨迹;
步骤4、通过激光雷达、编码器实时监测机器人的状态信息;
步骤5、设计复杂约束受限控制算法,根据机器人的实时状态信息,得到实际轨迹与期望轨迹的偏差,把此偏差输入到复杂约束机器人控制器,通过约束受限控制算法得到复杂约束虚拟控制律;具体的,所述复杂约束受限控制算法的设计包括速度约束受限控制算法的设计和位置约束受限控制算法的设计:
步骤5.1、位置约束受限控制算法设计如下:
采用backstepping的方法,基于对数函数z1为位置偏差,然后选取满足约束条件的Lyapunov函数V1,V10,为满足位置约束条件的Lyapunov函数,对所选取的Lyapunov函数求一阶导数,并化简得到其中位置约束虚拟控制律运用杨氏不等式使得进而确定合适的位置约束虚拟控制律α1;其中a12k1H1,b1s1H1z1,a1、b1分别代表位置约束状态的上下限,a1、b1、k1均为常数;
步骤5.2、速度约束受限控制算法设计如下:
采用backstepping的方法,基于对数函数z2为速度偏差,然后选取满足约束条件的Lyapunov函数V2,V20,为满足速度约束条件的Lyapunov函数,对所选取的Lyapunov函数求一阶导数,并化简得到其中速度约束虚拟控制律运用杨氏不等式使得进而确定合适的速度虚拟控制律α2;其中a22k2H2,b2s2H2z2,a2、b2分别代表速度约束状态的上下限,a2、b2、k2均为常数;
步骤5.3、综合位置约束虚拟控制律和速度约束虚拟控制律,得到的动态复杂约束虚拟控制律α(t);
步骤6、同时将机器人的实时状态信息反馈给RBF自适应神经网络,RBF自适应神经网络算法通过逼近未知非线性项,来确定自适应虚拟控制律
步骤7、将复杂约束虚拟控制律和自适应虚拟控制律进行结合,得到最终的实际控制律;
步骤8、实际控制律控制机器人的电机转速,来控制机器人持续平稳的运行;
步骤9:判断机器人是否到达目标点,如果到达目标点,机器人停止运行,如果没有到达目标点,重复步骤3至8,直至到达目标点。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国地质大学(武汉),未经中国地质大学(武汉)许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111041211.6/1.html,转载请声明来源钻瓜专利网。
- 上一篇:轴用快速夹紧装置
- 下一篇:一种低负担和高效率的变电站智能巡检系统