CN109227545B - 一种基于可达集估计的柔性机械臂目标追踪控制方法 - Google Patents
一种基于可达集估计的柔性机械臂目标追踪控制方法 Download PDFInfo
- Publication number
- CN109227545B CN109227545B CN201811279572.2A CN201811279572A CN109227545B CN 109227545 B CN109227545 B CN 109227545B CN 201811279572 A CN201811279572 A CN 201811279572A CN 109227545 B CN109227545 B CN 109227545B
- Authority
- CN
- China
- Prior art keywords
- fuzzy
- mechanical arm
- membership function
- formula
- controller
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1612—Programme controls characterised by the hand, wrist, grip control
Abstract
本发明涉及一种基于可达集估计的柔性机械臂目标追踪控制方法,首先搭建仿人机械臂柔性运动系统,使用中立II型T‑S模糊方法去建立柔性仿人机械臂的非线性动态系统。考虑到中立II型T‑S模糊系统的模糊隶属度函数难以准确获得,取模糊系统的模糊隶属度函数上下界的中间值作为控制器模糊隶属度函数。基于可达集估计的方法,设计中立II型模糊控制器,使得仿人机械臂的目标追踪误差可以被控制在允许的误差范围内。本发明设计的一种基于可达集估计的柔性机械臂目标追踪控制方法,该方法设计的中立II型模糊控制器可以使仿人柔性机械臂的目标追踪误差控制在允许的范围内,具有广阔的市场应用前景。
Description
技术领域
本发明涉及机器人领域,特别是一种基于可达集估计的柔性机械臂目标追踪控制方法。
背景技术
机器人可代替或协助人类完成各种艰苦或危险的工作,对其研发就显得非常重要。仿人机械臂是实现机器人抓取的关键,对其末端的定位与稳定工作的要求极高。然而,传动的控制方法忽略了臂杆传动的柔性会导致机械臂末端定位的困难,并极易引发系统工作不稳定。
发明内容
有鉴于此,本发明的目的是提出一种基于可达集估计的柔性机械臂目标追踪控制方法,使得仿人机械臂的目标追踪误差可以被控制在允许的误差范围内。
本发明采用以下方案实现:一种基于可达集估计的柔性机械臂目标追踪控制方法,具体包括以下步骤:
步骤S1:搭建仿人机械臂柔性运动系统;其中,所述仿人机械臂柔性运动系统包括机械臂驱动电机、机械臂目标负载、机械臂目标输出轴、阻尼组件、齿轮传动组件、刚性组件、驱动输出轴、以及基体;
步骤S2:根据物理学原理以及中立II型T-S模糊模型的表达方法,建立柔性仿人机械臂的非线性动态系统;
步骤S3:考虑到中立II型T-S模糊系统的模糊隶属度函数难以准确获得,取模糊系统的模糊隶属度函数上下界的中间值作为控制器模糊隶属度函数;基于可达集估计的方法,设计中立II型模糊控制器,使得仿人机械臂的目标追踪误差可以被控制在允许的误差范围内。
进一步地,步骤S2具体包括以下步骤:
步骤S21:根据搭建的仿人机械臂柔性运动系统,分成输入传动系统、中间传动系统、以及输出传动系统;其中,输入传动系统模型如公式(1)所示:
步骤S22:考虑到中间传动系统存在齿轮传动组件,存在间隙非线性死区模型如下:
考虑输出传动系统模型如下:
和
和
式中,φout表示输出轴的角速度,ζout表示输出轴的角加速度;
其中i∈[1,2,3],初始值是0,并且
进一步地,步骤S3具体包括以下步骤:
步骤S31:考虑到中立II型T-S模糊系统的模糊隶属度函数难以准确获得,取模糊系统的模糊隶属度函数上下界的中间值作为控制器模糊隶属度函数,定义
步骤S32:建立如下的李雅普诺夫函数:
其中P是正定对称的矩阵;
式中,Sym(*)表示Sym(*)=*T+*,*表示矩阵的对称转置,
对公式(15)两端乘以eat,得到:
步骤S33:对公式(16)进行积分后,得到:
并且根据公式(19)和公式(20),得到:
与现有技术相比,本发明有以下有益效果:本发明设计的中立II型模糊控制器可以使仿人柔性机械臂的目标追踪误差控制在允许的范围内,具有广阔的市场应用前景。
附图说明
图1为本发明实施例的柔性机械臂传动系统示意图。
图2为本发明实施例的方法流程示意图。
图1中,100为搭建的仿人机械臂柔性运动系统,10为机械臂驱动电机、20为机械臂目标负载、30为机械臂目标输出轴、40为阻尼组件、50为齿轮传动组件、60为刚性组件、70为驱动输出轴、80为基体。
具体实施方式
下面结合附图及实施例对本发明做进一步说明。
应该指出,以下详细说明都是示例性的,旨在对本申请提供进一步的说明。除非另有指明,本文使用的所有技术和科学术语具有与本申请所属技术领域的普通技术人员通常理解的相同含义。
需要注意的是,这里所使用的术语仅是为了描述具体实施方式,而非意图限制根据本申请的示例性实施方式。如在这里所使用的,除非上下文另外明确指出,否则单数形式也意图包括复数形式,此外,还应当理解的是,当在本说明书中使用术语“包含”和/或“包括”时,其指明存在特征、步骤、操作、器件、组件和/或它们的组合。
如图1以及图2所示,本实施例提供了一种基于可达集估计的柔性机械臂目标追踪控制方法,具体包括以下步骤:
步骤S1:搭建仿人机械臂柔性运动系统;其中,所述仿人机械臂柔性运动系统包括机械臂驱动电机、机械臂目标负载、机械臂目标输出轴、阻尼组件、齿轮传动组件、刚性组件、驱动输出轴、以及基体;
步骤S2:根据物理学原理以及中立II型T-S模糊模型的表达方法,建立柔性仿人机械臂的非线性动态系统;
步骤S3:考虑到中立II型T-S模糊系统的模糊隶属度函数难以准确获得,取模糊系统的模糊隶属度函数上下界的中间值作为控制器模糊隶属度函数;基于可达集估计的方法,设计中立II型模糊控制器,使得仿人机械臂的目标追踪误差可以被控制在允许的误差范围内。
在本实施例中,步骤S2具体包括以下步骤:
步骤S21:根据搭建的仿人机械臂柔性运动系统,分成输入传动系统、中间传动系统、以及输出传动系统;其中,输入传动系统模型如公式(1)所示:
步骤S22:考虑到中间传动系统存在齿轮传动组件,存在间隙非线性死区模型如下:
考虑输出传动系统模型如下:
和
和
式中,φout表示输出轴的角速度,ζout表示输出轴的角加速度;
其中i∈[1,2,3],初始值是0,并且
在本实施例中,步骤S3具体包括以下步骤:
步骤S31:考虑到中立II型T-S模糊系统的模糊隶属度函数难以准确获得,取模糊系统的模糊隶属度函数上下界的中间值作为控制器模糊隶属度函数,定义
步骤S32:建立如下的李雅普诺夫函数:
其中P是正定对称的矩阵;
式中,Sym(*)表示Sym(*)=*T+*,*表示矩阵的对称转置,
对公式(15)两端乘以eat,得到:
步骤S33:对公式(16)进行积分后,得到:
并且根据公式(19)和公式(20),得到:
以上所述仅为本发明的较佳实施例,凡依本发明申请专利范围所做的均等变化与修饰,皆应属本发明的涵盖范围。
Claims (3)
1.一种基于可达集估计的柔性机械臂目标追踪控制方法,其特征在于:包括以下步骤:
步骤S1:搭建仿人机械臂柔性运动系统;其中,所述仿人机械臂柔性运动系统包括机械臂驱动电机、机械臂目标负载、机械臂目标输出轴、阻尼组件、齿轮传动组件、刚性组件、驱动输出轴、以及基体;
步骤S2:根据物理学原理以及中立II型T-S模糊模型的表达方法,建立柔性仿人机械臂的非线性动态系统;
步骤S3:考虑到中立II型T-S模糊系统的模糊隶属度函数难以准确获得,取模糊系统的模糊隶属度函数上下界的中间值作为控制器模糊隶属度函数;基于可达集估计的方法,设计中立II型模糊控制器,使得仿人机械臂的目标追踪误差可以被控制在允许的误差范围内。
2.根据权利要求1所述的一种基于可达集估计的柔性机械臂目标追踪控制方法,其特征在于:步骤S2具体包括以下步骤:
步骤S21:根据搭建的仿人机械臂柔性运动系统,分成输入传动系统、中间传动系统、以及输出传动系统;其中,输入传动系统模型如公式(1)所示:
步骤S22:考虑到中间传动系统存在齿轮传动组件,存在间隙非线性死区模型如下:
考虑输出传动系统模型如下:
和
和
式中,φout表示输出轴的角速度,ζout表示输出轴的角加速度;
其中i∈[1,2,3],初始值是0,并且
3.根据权利要求1所述的一种基于可达集估计的柔性机械臂目标追踪控制方法,其特征在于:步骤S3具体包括以下步骤:
步骤S31:考虑到中立II型T-S模糊系统的模糊隶属度函数难以准确获得,取模糊系统的模糊隶属度函数上下界的中间值作为控制器模糊隶属度函数,定义
步骤S32:建立如下的李雅普诺夫函数:
其中P是正定对称的矩阵;
式中,Sym(*)表示Sym(*)=*T+*,*表示矩阵的对称转置,
对公式(15)两端乘以eat,得到:
步骤S33:对公式(16)进行积分后,得到:
并且根据公式(19)和公式(20),得到:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811279572.2A CN109227545B (zh) | 2018-10-30 | 2018-10-30 | 一种基于可达集估计的柔性机械臂目标追踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811279572.2A CN109227545B (zh) | 2018-10-30 | 2018-10-30 | 一种基于可达集估计的柔性机械臂目标追踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109227545A CN109227545A (zh) | 2019-01-18 |
CN109227545B true CN109227545B (zh) | 2020-05-05 |
Family
ID=65079452
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811279572.2A Active CN109227545B (zh) | 2018-10-30 | 2018-10-30 | 一种基于可达集估计的柔性机械臂目标追踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109227545B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109773799B (zh) * | 2019-03-27 | 2020-05-05 | 闽江学院 | 一种刚性仿人机械手多速率采样协调控制方法 |
CN110011421B (zh) * | 2019-04-28 | 2020-07-07 | 闽江学院 | 一种自我触发的能源互联网电力路由器网络控制方法 |
CN111716360B (zh) * | 2020-06-30 | 2021-05-18 | 河北工业大学 | 一种基于模糊逻辑的柔性关节机械臂采样控制方法及装置 |
CN111856939B (zh) * | 2020-07-30 | 2022-04-19 | 中国科学院光电技术研究所 | 一种用于光电跟踪系统的模糊ii型控制器设计方法 |
CN112894819A (zh) * | 2021-01-29 | 2021-06-04 | 佛山树客智能机器人科技有限公司 | 一种基于双神经网络的机器人动力学运动控制方法及装置 |
CN117193001B (zh) * | 2023-09-25 | 2024-04-09 | 南通大学 | 一种基于积分强化学习的双曲趋近律滑模控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013003845A (ja) * | 2011-06-16 | 2013-01-07 | Institute Of National Colleges Of Technology Japan | 組み込み知能コントローラ、制御システム、制御プログラム、記録媒体、及び制御方法 |
CN104260107A (zh) * | 2014-09-04 | 2015-01-07 | 北京邮电大学 | 一种实现空间机械臂柔性关节齿隙补偿的方法 |
CN104932271A (zh) * | 2015-06-08 | 2015-09-23 | 浙江工业大学 | 一种机械臂伺服系统的神经网络全阶滑模控制方法 |
CN106113040A (zh) * | 2016-07-19 | 2016-11-16 | 浙江工业大学 | 基于串并联估计模型的柔性机械臂系统模糊控制方法 |
CN108284442A (zh) * | 2017-01-24 | 2018-07-17 | 中国北方车辆研究所 | 一种基于模糊神经网络的机械臂柔性关节控制方法 |
-
2018
- 2018-10-30 CN CN201811279572.2A patent/CN109227545B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013003845A (ja) * | 2011-06-16 | 2013-01-07 | Institute Of National Colleges Of Technology Japan | 組み込み知能コントローラ、制御システム、制御プログラム、記録媒体、及び制御方法 |
CN104260107A (zh) * | 2014-09-04 | 2015-01-07 | 北京邮电大学 | 一种实现空间机械臂柔性关节齿隙补偿的方法 |
CN104932271A (zh) * | 2015-06-08 | 2015-09-23 | 浙江工业大学 | 一种机械臂伺服系统的神经网络全阶滑模控制方法 |
CN106113040A (zh) * | 2016-07-19 | 2016-11-16 | 浙江工业大学 | 基于串并联估计模型的柔性机械臂系统模糊控制方法 |
CN108284442A (zh) * | 2017-01-24 | 2018-07-17 | 中国北方车辆研究所 | 一种基于模糊神经网络的机械臂柔性关节控制方法 |
Non-Patent Citations (1)
Title |
---|
基于T-S模型的迭代学习控制算法及其在机器人点位控制中的仿真研究;张丽萍等;《系统仿真学报》;20050131;第17卷(第1期);166-169 * |
Also Published As
Publication number | Publication date |
---|---|
CN109227545A (zh) | 2019-01-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109227545B (zh) | 一种基于可达集估计的柔性机械臂目标追踪控制方法 | |
CN111152225B (zh) | 存在输入饱和的不确定机械臂固定时间轨迹跟踪控制方法 | |
Verstraten et al. | Series and parallel elastic actuation: Impact of natural dynamics on power and energy consumption | |
CN104723340B (zh) | 基于连接和阻尼配置的柔性关节机械臂的阻抗控制方法 | |
Slotine et al. | Adaptive manipulator control: A case study | |
CN109927032A (zh) | 一种基于高阶滑模观测器的机械臂轨迹跟踪控制方法 | |
US7986118B2 (en) | Open-loop torque control on joint position-controlled robots | |
CN108549235B (zh) | 一种电机驱动单连杆机械手的有限时神经网络控制方法 | |
CN113681543B (zh) | 一种基于模型预测的机械臂零力控制方法 | |
CN110842913B (zh) | 一种单关节机械臂的自适应滑模迭代学习控制方法 | |
CN109656139B (zh) | 机器人驱控一体系统的自适应建模方法 | |
Barbalata et al. | Position/force operational space control for underwater manipulation | |
Rojko et al. | Sliding-mode motion controller with adaptive fuzzy disturbance estimation | |
CN109483542B (zh) | 一种基于非线性运动学模型的机器人控制方法 | |
Rajeev et al. | Modeling a controller for an articulated robotic arm | |
Farid et al. | Computationally efficient algorithm to generate a waypoints-based trajectory for a quadrotor UAV | |
Rani et al. | Motion/force control scheme for electrically driven cooperative multiple mobile manipulators | |
CN109905067B (zh) | 电机驱动系统结构与控制一体优化方法 | |
Ghani et al. | Comparative assessment for two wheels inverted pendulum mobile robot using robust control | |
Ren et al. | Extended state observer based robust friction compensation for tracking control of an omnidirectional mobile robot | |
CN116079741B (zh) | 一种电机驱动单连杆机械臂的自适应控制方法 | |
CN109648566B (zh) | 电机参数未知的全方位移动机器人的轨迹跟踪控制方法 | |
Haung et al. | FAT-based adaptive sliding control for flexible arms: Theory and experiments | |
Ren et al. | Passivity-based tracking control of an omnidirectional mobile robot using only one geometrical parameter | |
CN113283090B (zh) | 基于蜂群算法的飞机舵机电动伺服系统摩擦补偿方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |