CN109514559B - 基于输出重定义的柔性机械臂时标分离鲁棒控制方法 - Google Patents
基于输出重定义的柔性机械臂时标分离鲁棒控制方法 Download PDFInfo
- Publication number
- CN109514559B CN109514559B CN201811586695.0A CN201811586695A CN109514559B CN 109514559 B CN109514559 B CN 109514559B CN 201811586695 A CN201811586695 A CN 201811586695A CN 109514559 B CN109514559 B CN 109514559B
- Authority
- CN
- China
- Prior art keywords
- output
- mechanical arm
- input
- subsystem
- control method
- 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
- 238000000034 method Methods 0.000 title claims abstract description 41
- 238000000926 separation method Methods 0.000 title claims abstract description 9
- 239000011159 matrix material Substances 0.000 claims description 27
- 238000013016 damping Methods 0.000 claims description 3
- 230000014509 gene expression Effects 0.000 claims 7
- 230000001629 suppression Effects 0.000 abstract description 5
- 238000013461 design Methods 0.000 description 4
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000002441 reversible effect Effects 0.000 description 1
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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提出了一种基于输出重定义的柔性机械臂时标分离鲁棒控制方法。该方法包括:搭建柔性机械臂动力学模型;调整柔性机械臂动力学模型输出,得到输入输出子系统和内动态子系统;设计鲁棒控制方法;设计状态反馈控制方法;根据鲁棒控制方法,得到第一控制输入;根据状态反馈控制方法,得到第二控制输入;将第一控制输入和第二控制输入结合,得到结合数据;将结合数据输入至柔性机械臂动力学模型,得到输出数据;将输出数据分别与柔性机械臂的关节角的期望数据和弹性振动数据比较,得到比较差值;当比较差值在比较阈值范围内,输出用于表示控制有效的标识。本发明实施例可以实现机械臂关节角对期望指令的跟踪,同时实现弹性模态的抑制,减小振动。
Description
技术领域
本发明涉及机器人控制的技术领域,尤其是涉及一种基于输出重定义的柔性机械臂时标分离鲁棒控制方法。
背景技术
柔性机械臂由于动力学模型存在较强的不确定性,不利于控制算法设计。多种控制理论已经成功应用于柔性机械臂控制,其中比例微分控制算法简单,然而对于外界干扰抵抗力差,智能学习控制对不确定信息有较好的学习效果,然而在线更新参数多导致解算速度偏慢。
《Two Performance Enhanced Control of Flexible-Link Manipulator withSystem Uncertainty And Disturbances》(BIN XU,YUAN YUAN,《SCIENCE CHINAINFORMATION SCIENCE》,Vol.60050202:1-050202:11)一文采用输出重定义对柔性机械臂动力学模型进行了处理,使模型避免了非最小相位问题,针对模型不确定项,论文采用神经网络进行逼近学习,控制算法最终使得关节角有效跟踪了期望指令,然而为了得到好的逼近效果,神经网络在线更新参数较多,使得算法解算速度偏慢。
发明内容
为解决现有控制技术在柔性机械臂控制过程中的不足,本发明提出了一种基于输出重定义的柔性机械臂鲁棒控制方法,该方法通过对柔性机械臂动力学模型进行输入输出线性化处理,使对象分为输入输出子系统和内动态子系统,针对输入输出子系统,采用对象标称信息进行控制算法设计,对于不确定部分,通过估计上界的方法实现补偿控制。该策略可以实现对模型不确定项的有效处理,同时符合工程应用中简化算法的要求。
一种基于输出重定义的柔性机械臂鲁棒控制方法,通过以下步骤实现:
(a)考虑n自由度柔性机械臂动力学模型:
其中M为正定对称惯性矩阵,是与哥氏力和向心力有关的项,D1、D2为阻尼矩阵,K2为刚度矩阵,u为关节输入力矩;是由机械臂关节角和柔性模态组成的广义矢量,其中θi为第i个关节角变量,δi,j是第i个连杆的第j个模态变量;
针对系统存在的非最小相位特性,进行输出重定义并写成矩阵形式:y=θ+Cδ其中,m为模态阶数,-1<αi<1由设计者给定,li为第i个连杆的长度,φi,j为第i个连杆的第j阶模态函数值;定义可得动态方程,具体包括输入输出子系统(4)和内动态子系统(5):
B(α,θ,δ)=H11+CH21,
输入输出子系统(4)进一步可以写作:
其中,k1∈Rn*n为正定对称非奇异矩阵;
定义误差信号e2=μ2-u2d,则e2的误差动力学方程为:
设计控制器:
其中,k2∈Rn*n为正定对称非奇异矩阵;ω0为正常数,e2=[e21,e22,…e2n]T。
其中,ρ∈Rn*n,γ∈Rn*n为正定对称非奇异矩阵。
u=uex+uin (12)
(e)根据所得到的控制输入u,返回柔性机械臂模型(1)中,对关节角进行控制使其跟踪上期望指令,同时实现连杆弹性模态抑制,减小振动。
本发明与现有技术相比有益效果可以为:
(1)该方法提取了对象模型的集总不确定项,降低了控制律设计复杂性;
(2)采用估计不确定上界的方法进行补偿控制,更新算法简单,提高解算速度。
附图说明
为了更清楚地说明本发明实施的技术方案,下面将对本发明的是说了中需要使用的附图作简单的解算。显而易见,下面所描述的附图仅仅是本发明的一些实施例,对于本领域的技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明一实施例的基于输出重定义的柔性机械臂时标分离鲁棒控制方法的流程示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述。显然,所描述的实施例是本发明的一部分实施例,而不是全部实施例。基于本发明中的实施例,本领域的普通技术人员在没有做出创造性劳动的前提下,所获得的所有其他实施例,都属于本发明保护的范围。
下面将详细描述本发明实施例的各个方面的特征。在下面的详细描述中,提出了许多具体的细节,以便对本发明的全面理解。但是,对于本领域的普通技术人员来说,很明显的是,本发明也可以在不需要这些具体细节的情况下就可以实施。下面对实施例的描述仅仅是为了通过示出本发明的示例对本发明更好的理解。本发明不限于下面所提供的任何具体设置和方法,而是覆盖了不脱离本发明精神的前提下所覆盖的所有的产品结构、方法的任何改进、替换等。在各个附图和下面的描述中,没有示出公知的结构和技术,以避免对本发明造成不必要的模糊。
需要说明的是,在不冲突的情况下,本发明实施例及实施例中的特征可以相互结合,各个实施例可以相互参考和引用。下面将参考附图并结合实施例来详细说明本发明。
图1是本发明一实施例的基于输出重定义的柔性机械臂时标分离鲁棒控制方法的示意性流程图。
如图1所示,该方法包括以下步骤:S110,建立柔性机械臂动力学模型;S120,动力学模型输入输出线性化;S130,针对输入输出子系统设计鲁棒控制算法,补偿未知信息;S140,针对内动态子系统设计状态反馈控制算法;S150,两种控制输入结合后传递给动力学模型,实现关节角跟踪控制以及弹性振动抑制。
本发明公开了一种基于输出重定义的柔性机械臂鲁棒控制方法,属于机器人控制领域,用来解决被控对象动力学模型中存在不确定信息时难以精确控制的问题。首先考虑模型动力学方程中存在的非最小相位问题,采用输出重定义对输出进行调整从而使系统零动态稳定;其次,采用输入输出线性化方法使对象模型变为输入输出子系统以及内动态子系统;针对输入输出子系统,考虑控制律设计过程中需要解决的模型参数不确定问题,发明采用标称信息进行算法设计,针对不确定部分,通过估计上界的方式实现补偿控制;最后针对内动态子系统,设计状态反馈控制算法。发明旨在实现机械臂关节角对期望指令的跟踪,同时实现弹性模态的抑制,减小振动。
在一些实施例中,基于输出重定义的柔性机械臂时标分离鲁棒控制方法可以包括以下步骤:
基于拉格朗日方程,搭建柔性机械臂动力学模型;
根据输出重定义的方法,调整柔性机械臂动力学模型输出,得到输入输出子系统和内动态子系统;
针对输入输出子系统,设计鲁棒控制方法;
针对内动态子系统,设计状态反馈控制方法;
根据鲁棒控制方法,得到第一控制输入;
根据状态反馈控制方法,得到第二控制输入;
将第一控制输入和第二控制输入结合,得到结合数据;
将结合数据输入至柔性机械臂动力学模型,得到输出数据;
将输出数据分别与柔性机械臂的关节角的期望数据和弹性振动数据比较,得到比较差值;
当比较差值在比较阈值范围内,输出用于表示控制有效的标识。
在一些实施例中,基于输出重定义的柔性机械臂时标分离鲁棒控制方法的实现方式可以为:
(a)考虑2自由度柔性机械臂动力学模型:
其中M为正定对称惯性矩阵,是与哥氏力和向心力有关的项,D1、D2为阻尼矩阵,K2为刚度矩阵,u为关节输入力矩。是由机械臂关节角和柔性模态组成的广义矢量,其中θi为第i个关节角变量,δi,j是第i个连杆的第j个模态变量。
连杆长度l1=l2=0.5m,连杆质量m1=m2=0.1kg,连杆抗弯刚度EI1=EI2=10N·m2,末端等效质量mp=0.1kg。以此推导出
进一步,针对系统存在的非最小相位特性,进行输出重定义并写成矩阵形式:y=θ+Cδ
其中,uex为输入输出子系统的控制输入,uin为内动态子系统的控制输入。
B(α,θ,δ)=H11+CH21
F(θ,δ)=H21
α=[α1,α2]T=[0.9,0.81]T
输入输出子系统(4)进一步可以写作:
其中,k1∈R2*2为正定对称非奇异矩阵,当机械臂动力学模型在控制输入uex作用下跟踪上期望关节角度时可得最终k1矩阵。
定义e2=μ2-u2d,则e2的误差动力学方程为:
控制器uex设计如下:
其中,k2∈R2*2为正定对称非奇异矩阵,与k1矩阵取值方式一致。
其中,ρ∈R2*2,γ∈R2*2为正定对称非奇异矩阵,与k1矩阵取值方式一致。
(e)根据所得到的控制输入u,返回柔性机械臂模型(1)中,对关节角进行控制使得关节角跟踪上期望指令,同时实现弹性模态抑制,减小弹性振动。
需要说明的是,上述流程操作可以进行不同程度的组合应用,为了简明,不再赘述各种组合的实现方式。本领域的技术人员可以按实际情况将上述的方法的步骤的顺序(或者产品的部件的位置)进行灵活调整,或者组合等操作。
需要说明的是,上述实施例中所示的功能组件的实现方式可以为硬件、软件或者二者的组合。当以硬件方式实现时,其可以使电子电路、专用集成电路(ASIC)、插件、功能卡等。当以软件方式实现时,其可以事被用于执行所需任务的程序或者代码段。程序或者代码段可以出存储在机器或者可读介质中,或者其可以通过载波中所携带的数据信号在传输介质或者通信链路上传送。
最后应该说明的是:以上实施例仅用以说明本发明的技术方案,但本发明的保护范围并不局限于此,任何熟悉本领域的技术人员在本发明揭露的技术范围内,可以轻易想到各种等效的修改或者替换,这些修改或者替换都应该涵盖在本发明的保护范围之内。
Claims (2)
1.一种基于输出重定义的柔性机械臂时标分离鲁棒控制方法,其特征在于,包括以下步骤:
基于拉格朗日方程,搭建柔性机械臂动力学模型;
根据输出重定义的方法,调整柔性机械臂动力学模型输出,得到输入输出子系统和内动态子系统;
针对输入输出子系统,设计鲁棒控制方法;
针对内动态子系统,设计状态反馈控制方法;
根据鲁棒控制方法,得到第一控制输入;
根据状态反馈控制方法,得到第二控制输入;
将第一控制输入和第二控制输入结合,得到结合数据;
将结合数据输入至柔性机械臂动力学模型,得到输出数据;
将输出数据分别与柔性机械臂的关节角的期望数据和弹性振动数据比较,得到比较差值;
当比较差值在比较阈值范围内,输出用于表示控制有效的标识;
其中,柔性机械臂动力学模型为表达式(1):
其中,M为正定对称惯性矩阵,是与哥氏力和向心力有关的项,D1、D2为阻尼矩阵,K2为刚度矩阵,u为关节输入力矩;是由机械臂关节角和柔性模态组成的广义矢量,θi为第i个关节角变量,δi,j是第i个连杆的第j个模态变量;
其中,根据输出重定义的方法,调整柔性机械臂动力学模型输出,得到输入输出子系统和内动态子系统,包括:
针对输入输出子系统和内动态子系统存在的非最小相位特性,进行输出重定义并写成矩阵形式:y=θ+Cδ
B(α,θ,δ)=H11+CH21,
将输入输出子系统(4)转化为表达式(6):
其中,设计鲁棒控制方法,包括:
其中,k1∈Rn*n为正定对称非奇异矩阵;
定义误差信号e2=μ2-u2d,则e2的误差动力学方程为:
设计控制器:
其中,k2∈Rn*n为正定对称非奇异矩阵;ω0为正常数,e2=[e21,e22,…e2n]T,
其中,ρ∈Rn*n,γ∈Rn*n为正定对称非奇异矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811586695.0A CN109514559B (zh) | 2018-12-24 | 2018-12-24 | 基于输出重定义的柔性机械臂时标分离鲁棒控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811586695.0A CN109514559B (zh) | 2018-12-24 | 2018-12-24 | 基于输出重定义的柔性机械臂时标分离鲁棒控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109514559A CN109514559A (zh) | 2019-03-26 |
CN109514559B true CN109514559B (zh) | 2022-02-11 |
Family
ID=65796690
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811586695.0A Active CN109514559B (zh) | 2018-12-24 | 2018-12-24 | 基于输出重定义的柔性机械臂时标分离鲁棒控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109514559B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108388114B (zh) * | 2018-02-07 | 2021-07-09 | 中国航空工业集团公司西安飞机设计研究所 | 一种基于输出重定义的柔性机械臂复合控制方法 |
CN110977969B (zh) * | 2019-11-29 | 2023-01-10 | 东北大学 | 一种基于机械臂位姿变换的柔性负载伺服驱动系统的谐振抑制方法 |
CN110802602B (zh) * | 2019-11-29 | 2023-01-10 | 东北大学 | 一种基于pi控制策略的机械臂柔性关节位姿变换抑振方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4608526A (en) * | 1985-04-19 | 1986-08-26 | The United States Of America As Represented By The United States Department Of Energy | Electromechanical actuator for the tongs of a servomanipulator |
CN106493735A (zh) * | 2016-12-09 | 2017-03-15 | 西北工业大学 | 存在外界扰动的柔性机械臂扰动观测控制方法 |
CN106773684A (zh) * | 2016-12-09 | 2017-05-31 | 西北工业大学 | 基于智能学习评价的柔性机械臂复合控制方法 |
CN108388114A (zh) * | 2018-02-07 | 2018-08-10 | 中国航空工业集团公司西安飞机设计研究所 | 一种基于输出重定义的柔性机械臂复合控制方法 |
-
2018
- 2018-12-24 CN CN201811586695.0A patent/CN109514559B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4608526A (en) * | 1985-04-19 | 1986-08-26 | The United States Of America As Represented By The United States Department Of Energy | Electromechanical actuator for the tongs of a servomanipulator |
CN106493735A (zh) * | 2016-12-09 | 2017-03-15 | 西北工业大学 | 存在外界扰动的柔性机械臂扰动观测控制方法 |
CN106773684A (zh) * | 2016-12-09 | 2017-05-31 | 西北工业大学 | 基于智能学习评价的柔性机械臂复合控制方法 |
CN108388114A (zh) * | 2018-02-07 | 2018-08-10 | 中国航空工业集团公司西安飞机设计研究所 | 一种基于输出重定义的柔性机械臂复合控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109514559A (zh) | 2019-03-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109358506B (zh) | 一种基于干扰观测器的自适应模糊遥操作控制方法 | |
CN109514558B (zh) | 基于奇异摄动的柔性机械臂时标分离鲁棒控制方法 | |
CN108875253B (zh) | 基于干扰观测器的欠驱动吊车系统的终端滑模消摆控制方法及系统 | |
CN106938462B (zh) | 一种基于自适应pd和模糊逻辑的遥操作双边控制方法 | |
CN109240086B (zh) | 一种非线性双边遥操作系统的自适应鲁棒控制方法 | |
CN108388114B (zh) | 一种基于输出重定义的柔性机械臂复合控制方法 | |
CN109514559B (zh) | 基于输出重定义的柔性机械臂时标分离鲁棒控制方法 | |
CN107450326B (zh) | 反步有限时间双边遥操作控制方法及计算机可读存储介质 | |
CN106773684B (zh) | 基于智能学习评价的柔性机械臂复合控制方法 | |
CN106843265A (zh) | 有限时间收敛的三维多导弹协同制导方法与系统 | |
CN109085749B (zh) | 一种基于自适应模糊反演的非线性遥操作双边控制方法 | |
CN112223275B (zh) | 基于有限时间跟踪控制的协作机器人控制方法 | |
CN108155833B (zh) | 考虑电气特性的电机伺服系统渐近稳定控制方法 | |
CN107765548B (zh) | 基于双观测器的发射平台高精度运动控制方法 | |
CN109709807B (zh) | 一种基于摩擦补偿的自适应神经网络控制方法及其装置 | |
Zhong et al. | A sliding mode and non-linear disturbance observer based bilateral control for telerehabilitation systems with flexible manipulators | |
CN109108964B (zh) | 一种基于自适应动态规划Nash博弈的空间机械臂协调控制方法 | |
CN114527664A (zh) | 一种具有非对称时滞的动态不确定性系统的自适应跟踪控制方法 | |
CN117193146B (zh) | 智能体集群的控制方法及相关产品 | |
CN109634118A (zh) | 一种机械臂的鲁棒自适应神经切换控制方法 | |
CN110109357B (zh) | 针对非标准型非线性航空器的半全局自适应控制方法 | |
CN116795124A (zh) | 一种基于动态事件触发的四旋翼无人机姿态控制方法 | |
CN116175588A (zh) | 一种机器人自适应神经滑模控制方法、设备及介质 | |
CN116068893A (zh) | 一种机械臂自适应分数阶滑模控制方法、设备及介质 | |
CN115857329A (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 |