CN107263483B - 二自由度关节机器人轨迹的协调控制方法 - Google Patents
二自由度关节机器人轨迹的协调控制方法 Download PDFInfo
- Publication number
- CN107263483B CN107263483B CN201710654137.2A CN201710654137A CN107263483B CN 107263483 B CN107263483 B CN 107263483B CN 201710654137 A CN201710654137 A CN 201710654137A CN 107263483 B CN107263483 B CN 107263483B
- Authority
- CN
- China
- Prior art keywords
- control system
- port
- formula
- joint
- controlled hamiltonian
- 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
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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- 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/1607—Calculation of inertia, jacobian matrixes and inverses
Abstract
本发明公开了一种二自由度关节机器人轨迹的协调控制方法,该控制方法将端口受控哈密顿与PD控制相结合,采用指数函数作为两者协调控制函数,通过调节两种控制方法的控制力度,使得PD控制在最初的作用力度较大,使系统具有良好的快速跟踪性能;而端口受控哈密顿控制在稳态时的作用力度较大,使系统具有较好的稳态性能。本发明方法不仅使整个机器人运动系统在动态响应性能方面获得改善,系统能够很快地进入稳态运行,缩短了系统的上升时间与调节时间,也使系统的控制精度得到提高。由于这种协调控制方案使每种控制方法的优点都在相应的时间段内得到最高效的利用,因而具有较好的应用价值。
Description
技术领域
本发明属于机器人控制技术领域,特别涉及一种基于端口受控哈密顿与PD控制的二自由度关节机器人轨迹的协调控制方法。
背景技术
关节机器人,也称关节手臂机器人或关节机械手臂,是当今工业领域中最常见的工业机器人的形态之一,适合用于诸多工业领域的机械自动化作业,比如自动装配、喷漆、搬运、焊接等工作。在对其进行轨迹跟踪系统进行控制时,传统的转矩控制和PD控制等对位置误差信号的处理过于简单,大多数情况下对于系统的建模误差以及干扰信号的扰动其动态响应性能和误差抑制都表现不佳。滑模控制在机器人控制系统中曾被大量使用,优点是实时性好,但也会使系统存在较大的输出抖振现象。模糊控制虽然不需要建立精确的数学模型,但是其控制精度不高,系统存在较大的稳态误差,其稳定性问题还有待解决。神经网络控制算法比较复杂,对于机器人的数学建模以及控制器的求取和实现都增加了相当大的难度。自适应控制响应迅速,但是其参数设置难度较大。近年来,端口受控哈密顿控制越来越受到国内外人们的关注,国内的学者如山东大学的王玉振教授和青岛大学的于海生教授都对其进行了深入且全面的研究。端口受控哈密顿控制的设计较为简单,因其是在能量注入的基础上进行的控制推导,该方法简化了系统的稳定性分析过程,端口受控哈密顿控制虽然在控制精度以及稳定性方面表现良好,但是其动态响应速度较慢,实时性还有待提高。综上,二自由度关节机器人运动系统单独使用一种控制方法难以实现快速高效、高精度的问题。
发明内容
本发明的目的在于提出一种基于端口受控哈密顿与PD控制的二自由度关节机器人轨迹的协调控制方法,以保证二自由度关节机器人运动系统的动态性能与稳态性能优良。
为了实现上述目的,本发明采用如下技术方案:
二自由度关节机器人轨迹的协调控制方法,包括如下步骤:
s1建立二自由度关节机器人的动力学模型
在D-H坐标系中,依据拉格朗日方法推导出二自由度关节机器人的动力学模型为:
其中,τ=[τ1 τ2]T为输入向量,τ1、τ2分别表示关节1、关节2的控制力矩;
q=[q1 q2]T表示关节角位移矢量,q1、q2分别表示关节1、关节2的角位移;
表示关节角速度矢量,分别表示关节1、关节2的角速度;
分别表示关节1、关节2的角加速度;
为机器人惯性矩阵;
为机器人哥氏力与向心力矩阵;
G(q)=[G1(q) G2(q)]T=[50.96cosq1+25.48cos(q1+q2)25.48cos(q1+q2)]T为机器人重力项矩阵;
s2设计二自由度关节机器人的端口受控哈密顿控制器与PD控制器
s2.1设计端口受控哈密顿控制器
s2.1.1能量耗散概念的端口受控哈密顿控制系统模型为:
其中,x、τPCH和y分别表示端口受控哈密顿控制系统的状态向量、输入向量和输出向量;R(x)为半正定对称矩阵,R(x)=RT(x)≥0,它反映了端口受控哈密顿控制系统端口上的附加阻性结构;J(x)为反对称矩阵,J(x)=-JT(x),它反映了端口受控哈密顿控制系统内部的互联结构;H(x)为Hamiltonian函数,它反映了端口受控哈密顿控制系统总的能量存储;g(x)反映了端口受控哈密顿控制系统的端口特性;
s2.1.2建立二自由度关节机器人的端口受控哈密顿控制系统模型
二自由度关节机器人的端口受控哈密顿控制系统的能量函数H(q,p)为:
其中,表示端口受控哈密顿控制系统的动能,U(q)表示端口受控哈密顿控制系统的势能;表示端口受控哈密顿控制系统的广义动量矢量,p1、p2分别表示关节1、关节2的广义动量;
选取端口受控哈密顿控制系统的状态向量为x=[q p]T=[q1 q2 p1 p2]T,将二自由度关节机器人的端口受控哈密顿控制系统模型写为:
其中, 为输入矩阵;
τ1-PCH、τ2-PCH分别表示端口受控哈密顿控制系统对关节1、关节2输出的控制力矩;
s2.1.3设计二自由度关节机器人的端口受控哈密顿控制器
假设端口受控哈密顿控制系统期望的平衡点为xd=[qd pd]T;
其中,qd=[q1d q2d]T表示期望的关节角位移矢量,q1d、q2d分别表示关节1、关节2的期望角位移,分别表示关节1、关节2的期望角速度;pd=[p1d p2d]T=[0 0]T表示期望的广义动量矢量,p1d、p2d分别表示关节1、关节2的期望广义动量;
为将端口受控哈密顿控制系统渐近的稳定在期望的平衡点xd附近,构造一个加入反馈控制后的闭环系统:
其中,Jd(x)为期望的互联矩阵,且Rd(x)为期望的阻尼矩阵,且
该闭环系统在期望的平衡点xd处取极小值;
选取期望的Hamiltonian函数为:
其中,Hd(xd)=0;
为期望惯性矩阵,a1、a2、a3为设计参数;
为比例增益,KP_PCH1和KP_PCH2分别为常数;
配置满足:
其中,为微分系数,KD_PCH1、KD_PCH2为设计参数;
由于公式(2)与公式(5)均是对二自由度关节机器人的端口受控哈密顿控制系统的描述,将公式(2)与公式(5)中的消掉可得:
进一步得到:
解方程可得端口受控哈密顿控制器为:
其中:
s2.2设计PD控制器
设计二自由度关节机器人的PD控制器为:
其中,τPD=[τ1-PD τ2-PD]T为PD控制器对关节1、关节2的控制转矩;
为比例增益矩阵;
为微分增益矩阵;
e=[e1 e2]T=[q1-q1d q2-q2d]T为位置误差矢量;
为速度误差矢量;
s3设计端口受控哈密顿控制系统与PD控制系统的协调控制器
定义c1-PCH,c2-PCH分别为端口受控哈密顿控制系统的协调函数,c1-PD,c2-PD分别为PD控制系统的协调函数;
则端口受控哈密顿控制系统与PD控制系统的协调控制函数能够设计为:
其中,TC为协调时间常数,c1-PCH∈[0,1],c2-PCH∈[0,1],c1-PD∈[0,1],c2-PD∈[0,1];
二自由度关节机器人端口受控哈密顿控制系统与PD控制系统的协调控制器为:
其中,τ1、τ2为协调控制器对关节1、关节2的转矩输出;
s4基于端口受控哈密顿控制器与PD控制器的二自由度关节机器人运动控制系统的稳定性分析
s4.1二自由度关节机器人的端口受控哈密顿控制系统稳定性分析
由公式(6)所描述的期望端口受控哈密顿控制系统的能量函数可知Hd(x)>0;
对公式(6)求导,并将公式(5)代入可得:
由于Jd(x)为反对称矩阵、Rd(x)为半正定矩阵,根据Lasalle定理,若包括在集合中的闭环系统最大不变集为{xd},则端口受控哈密顿控制系统在平衡点xd处是渐进稳定的,其中,Rn表示n维实数向量;
s4.2二自由度关节机器人的PD控制系统稳定性分析
依据PD控制系统的状态变量e=[e1 e2]T,将公式(11)代入到公式(1)中可得:
由公式(15)可得为PD控制系统唯一静态平衡点;
定义李雅普诺夫函数为:
其中,U(qd)表示端口受控哈密顿控制系统在期望平衡点处的势能;
由于:
公式(1)描述的机器人动力学模型,对于任意给定的足够小的正常数a,对角正定比例增益矩阵KP_PD为可使下面二式同时成立:
eTG(q)+eTKP_PDe≥a||e||2 (19)
将公式(17)和公式(18)代入公式(16),可得:
公式(1)描述的机器人动力学模型,惯性矩阵M(q)为对称、正定、有界,选择微分增益矩阵KD_PD足够大,使得:
KD_PD-2M(q)>0 (21)
KD_PD-M(q)-εCMI>0 (22)
其中,ε、CM为正常数,I为单位矩阵;
由公式(20)和公式(21)可得李雅普诺夫函数是正定的;
对公式(16)求导,可得:
由于将由公式(15)求得的代入公式(23)中可得:
公式(1)描述的机器人动力学模型,为反对称矩阵,使得:
公式(24)进一步写为:
假设存在ε>0,使得||e||≤ε,对于公式(1)描述的机器人动力学模型,存在下列关系:
将公式(19)和公式(26)代入公式(25)可得:
由公式(22)和公式(26)可得
正定,半负定,由李雅普诺夫稳定性理论可知二自由度关节机器人的PD控制系统是渐进稳定的;
s4.3整个协调控制系统稳定性分析
二自由度关节机器人整个协调控制系统的李雅普诺夫控制函数可写为:
V=VPCH+VPD (28)
当时间t=0时,c1-PCH(t)=c2-PCH(t)=0,c1-PD(t)=c2-PD(t)=1,只有PD控制系统作用于协调控制系统,V=VPD>0,根据李雅普诺夫稳定性理论可知协调控制系统稳定;
当时间0<t<∞时,c1-PCH,c2-PCH,c1-PD,c2-PD均为大于0小于1的常数,由于时间连续,属于共同控制;由于控制器各变量类型没有发生变化,结合端口受控哈密顿控制系统和PD控制系统稳定性分析可知,V正定,半负定,因此协调控制系统是渐进稳定的;
当时间t→∞时,c1-PCH(t)=c2-PCH(t)=1,c1-PD(t)=c2-PD(t)=0,只有端口受控哈密顿控制系统作用于整个控制系统,V=VPCH>0,协调控制系统稳定;
由以上分析可知,整个协调控制系统是渐进稳定的。
本发明具有如下优点:
本发明针对二自由度关节机器人运动系统单独使用一种控制方法难以实现快速高效、高精度的问题,设计了基于端口受控哈密顿(PCH)与PD控制的协调控制方案,端口受控哈密顿控制用于确保系统的稳定性问题,PD控制用于提高系统响应的快速性问题,采用指数函数作为协调函数以实现协调控制策略,从而适应二自由度机器人的误差扰动。本发明既实现了位置信号的快速跟踪,又使机器人的输出信号控制在较高的误差精度范围内。经仿真验证表明,当机器人的机械系统存在建模误差时,采用端口受控哈密顿与PD算法协调控制的二自由度关节机器人运动系统动态性能与稳态性能优良,且能够快速消除误差。
附图说明
图1为本发明中二自由度关节机器人的三维模型图;
图2为本发明中二自由度关节机器人的连杆坐标系统图;
图3为本发明中基于端口受控哈密顿与PD控制的协调控制系统框图;
图4为本发明中关节1在协调时间常数不同时的轨迹曲线图;
图5为本发明中关节2在协调时间常数不同时的轨迹曲线图;
图6为本发明中关节1在不同控制方法时的轨迹曲线图;
图7为本发明中关节2在不同控制方法时的轨迹曲线图;
图8为本发明中关节1不同控制方法时的轨迹误差曲线图;
图9为本发明中关节2不同控制方法时的轨迹误差曲线图。
具体实施方式
下面结合附图以及具体实施方式对本发明作进一步详细说明:
二自由度关节机器人轨迹的协调控制方法,包括如下步骤:
s1建立二自由度关节机器人的动力学模型,如图1和图2所示:
在D-H坐标系中,依据拉格朗日方法推导出二自由度关节机器人的动力学模型为:
其中,τ=[τ1 τ2]T为输入向量,τ1、τ2分别表示关节1、关节2的控制力矩;
q=[q1 q2]T表示关节角位移矢量,q1、q2分别表示关节1、关节2的角位移;
表示关节角速度矢量,分别表示关节1、关节2的角速度;
分别表示关节1、关节2的角加速度;
为机器人惯性矩阵;
为机器人哥氏力与向心力矩阵;
G(q)=[G1(q) G2(q)]T=[50.96cosq1+25.48cos(q1+q2)25.48cos(q1+q2)]T为机器人重力项矩阵;
s2设计二自由度关节机器人的端口受控哈密顿控制器与PD控制器
s2.1设计端口受控哈密顿控制器
s2.1.1能量耗散概念的端口受控哈密顿控制系统模型为:
其中,x、τPCH和y分别表示端口受控哈密顿控制系统的状态向量、输入向量和输出向量;R(x)为半正定对称矩阵,R(x)=RT(x)≥0,它反映了端口受控哈密顿控制系统端口上的附加阻性结构;J(x)为反对称矩阵,J(x)=-JT(x),它反映了端口受控哈密顿控制系统内部的互联结构;H(x)为Hamiltonian函数,它反映了端口受控哈密顿控制系统总的能量存储;g(x)反映了端口受控哈密顿控制系统的端口特性;
s2.1.2建立二自由度关节机器人的端口受控哈密顿控制系统模型
二自由度关节机器人的端口受控哈密顿控制系统的能量函数H(q,p)为:
其中,表示端口受控哈密顿控制系统的动能,U(q)表示端口受控哈密顿控制系统的势能;表示端口受控哈密顿控制系统的广义动量矢量,p1、p2分别表示关节1、关节2的广义动量;
选取端口受控哈密顿控制系统的状态向量为x=[q p]T=[q1 q2 p1 p2]T,将二自由度关节机器人的端口受控哈密顿控制系统模型写为:
其中, 为输入矩阵;
τ1-PCH、τ2-PCH分别表示端口受控哈密顿控制系统对关节1、关节2输出的控制力矩;
s2.1.3设计二自由度关节机器人的端口受控哈密顿控制器
假设端口受控哈密顿控制系统期望的平衡点为xd=[qd pd]T;
其中,qd=[q1d q2d]T表示期望的关节角位移矢量,q1d、q2d分别表示关节1、关节2的期望角位移,分别表示关节1、关节2的期望角速度;pd=[p1d p2d]T=[0 0]T表示期望的广义动量矢量,p1d、p2d分别表示关节1、关节2的期望广义动量;
为将端口受控哈密顿控制系统渐近的稳定在期望的平衡点xd附近,构造一个加入反馈控制后的闭环系统:
其中,Jd(x)为期望的互联矩阵,且Rd(x)为期望的阻尼矩阵,且
该闭环系统在期望的平衡点xd处取极小值;
选取期望的Hamiltonian函数为:
其中,Hd(xd)=0;
为期望惯性矩阵,a1、a2、a3为设计参数;
为比例增益,KP_PCH1和KP_PCH2分别为常数;
配置满足:
其中,为微分系数,KD_PCH1、KD_PCH2为设计参数;
由于公式(2)与公式(5)均是对二自由度关节机器人的端口受控哈密顿控制系统的描述,将公式(2)与公式(5)中的消掉可得:
进一步得到:
解方程可得端口受控哈密顿控制器为:
其中:
s2.2设计PD控制器
设计二自由度关节机器人的PD控制器为:
其中,τPD=[τ1-PD τ2-PD]T为PD控制器对关节1、关节2的控制转矩;
为比例增益矩阵;
为微分增益矩阵;
e=[e1e2]T=[q1-q1d q2-q2d]T为位置误差矢量;
为速度误差矢量;
s3设计端口受控哈密顿控制系统与PD控制系统的协调控制器,如图3所示:
定义c1-PCH,c2-PCH分别为端口受控哈密顿控制系统的协调函数,c1-PD,c2-PD分别为PD控制系统的协调函数;
则端口受控哈密顿控制系统与PD控制系统的协调控制函数能够设计为:
其中,TC为协调时间常数,c1-PCH∈[0,1],c2-PCH∈[0,1],c1-PD∈[0,1],c2-PD∈[0,1];
二自由度关节机器人端口受控哈密顿控制系统与PD控制系统的协调控制器为:
其中,τ1、τ2为协调控制器对关节1、关节2的转矩输出;
s4基于端口受控哈密顿控制器与PD控制器的二自由度关节机器人运动控制系统的稳定性分析
s4.1二自由度关节机器人的端口受控哈密顿控制系统稳定性分析
由公式(6)所描述的期望端口受控哈密顿控制系统的能量函数可知Hd(x)>0;
对公式(6)求导,并将公式(5)代入可得:
由于Jd(x)为反对称矩阵、Rd(x)为半正定矩阵,根据Lasalle定理,若包括在集合中的闭环系统最大不变集为{xd},则端口受控哈密顿控制系统在平衡点xd处是渐进稳定的,其中,Rn表示n维实数向量;
s4.2二自由度关节机器人的PD控制系统稳定性分析
依据PD控制系统的状态变量e=[e1 e2]T,将公式(11)代入到公式(1)中可得:
由公式(15)可得为PD控制系统唯一静态平衡点;
定义李雅普诺夫函数为:
其中,U(qd)表示端口受控哈密顿控制系统在期望平衡点处的势能;
由于:
公式(1)描述的机器人动力学模型,对于任意给定的足够小的正常数a,对角正定比例增益矩阵KP_PD为可使下面二式同时成立:
eTG(q)+eTKP_PDe≥a||e||2 (19)
将公式(17)和公式(18)代入公式(16),可得:
公式(1)描述的机器人动力学模型,惯性矩阵M(q)为对称、正定、有界,选择微分增益矩阵KD_PD足够大,使得:
KD_PD-2M(q)>0 (21)
KD_PD-M(q)-εCMI>0 (22)
其中,ε、CM为正常数,I为单位矩阵;
由公式(20)和公式(21)可得李雅普诺夫函数是正定的;
对公式(16)求导,可得:
由于将由公式(15)求得的代入公式(23)中可得:
公式(1)描述的机器人动力学模型,为反对称矩阵,使得:
公式(24)进一步写为:
假设存在ε>0,使得||e||≤ε,对于公式(1)描述的机器人动力学模型,存在下列关系:
将公式(19)和公式(26)代入公式(25)可得:
由公式(22)和公式(26)可得
正定,半负定,由李雅普诺夫稳定性理论可知二自由度关节机器人的PD控制系统是渐进稳定的;
s4.3整个协调控制系统稳定性分析
二自由度关节机器人整个协调控制系统的李雅普诺夫控制函数可写为:
V=VPCH+VPD (28)
当时间t=0时,c1-PCH(t)=c2-PCH(t)=0,c1-PD(t)=c2-PD(t)=1,只有PD控制系统作用于协调控制系统,V=VPD>0,根据李雅普诺夫稳定性理论可知协调控制系统稳定;
当时间0<t<∞时,c1-PCH,c2-PCH,c1-PD,c2-PD均为大于0小于1的常数,由于时间连续,属于共同控制;由于控制器各变量类型没有发生变化,结合端口受控哈密顿控制系统和PD控制系统稳定性分析可知,V正定,半负定,因此协调控制系统是渐进稳定的;
当时间t→∞时,c1-PCH(t)=c2-PCH(t)=1,c1-PD(t)=c2-PD(t)=0,只有端口受控哈密顿控制系统作用于整个控制系统,V=VPCH>0,协调控制系统稳定;
由以上分析可知,整个协调控制系统是渐进稳定的。
针对端口受控哈密顿与PD控制的二自由度关节机器人运动系统,采用MATLAB/Simulink进行仿真,以验证该方法对机器人轨迹跟踪的控制性能。
仿真所用参数如下:端口受控哈密顿控制系统中:KP_PCH1=2000,KP_PCH2=2000,KD_PCH1=2000,KD_PCH2=2000,a1=0.05,a2=0.0001,a3=0.0001;PD控制系统中:KP_PD1=280,KP_PD2=280,KD_PD1=280,KD_PD2=280。
给定关节1和关节2的期望位置信号分别为单位阶跃信号。
由图4和图5可知,协调时间常数分别为TC1=0.1,TC2=0.2,TC3=0.6,当TC1=0.1时的响应速度最快,并且控制精度最高,控制效果最好,因此在协调控制仿真实验中取TC1=0.1。
由图6和图7可知,PD控制的响应快速性良好,但是出现了明显的超调量,存在一定的稳态误差;端口受控哈密顿控制轨迹跟踪效果良好,控制精度较好,但是与PD控制相比较,其响应速度有待提高。
对比图8和图9中的四条轨迹曲线可知,协调控制系统在符合判断条件时能及时的投入到系统的协调控制中,保证了系统的动态性能。由图8和图9可知,与端口受控哈密顿和PD控制相比较,协调控制系统的控制精度为10-3,控制精度有明显提高。
经比较可知,该协调控制方法有效的结合了PD控制和端口受控哈密顿控制的优点,系统既能快速的跟踪给定轨迹信号,又有很好的稳态性能,满足设计的要求。
当然,以上说明仅仅为本发明的较佳实施例,本发明并不限于列举上述实施例,应当说明的是,任何熟悉本领域的技术人员在本说明书的教导下,所做出的所有等同替代、明显变形形式,均落在本说明书的实质范围之内,理应受到本发明的保护。
Claims (1)
1.二自由度关节机器人轨迹的协调控制方法,其特征在于,包括如下步骤:
s1建立二自由度关节机器人的动力学模型
在D-H坐标系中,依据拉格朗日方法推导出二自由度关节机器人的动力学模型为:
其中,τ=[τ1 τ2]T为输入向量,τ1、τ2分别表示关节1、关节2的控制力矩;
q=[q1 q2]T表示关节角位移矢量,q1、q2分别表示关节1、关节2的角位移;
表示关节角速度矢量,分别表示关节1、关节2的角速度;
分别表示关节1、关节2的角加速度;
为机器人惯性矩阵;
为机器人哥氏力与向心力矩阵;
G(q)=[G1(q) G2(q)]T=[50.96cosq1+25.48cos(q1+q2) 25.48cos(q1+q2)]T为机器人重力项矩阵;
s2设计二自由度关节机器人的端口受控哈密顿控制器与PD控制器
s2.1设计端口受控哈密顿控制器
s2.1.1能量耗散概念的端口受控哈密顿控制系统模型为:
其中,x、τPCH和y分别表示端口受控哈密顿控制系统的状态向量、输入向量和输出向量;R(x)为半正定对称矩阵,R(x)=RT(x)≥0,它反映了端口受控哈密顿控制系统端口上的附加阻性结构;J(x)为反对称矩阵,J(x)=-JT(x),它反映了端口受控哈密顿控制系统内部的互联结构;H(x)为Hamiltonian函数,它反映了端口受控哈密顿控制系统总的能量存储;g(x)反映了端口受控哈密顿控制系统的端口特性;
s2.1.2建立二自由度关节机器人的端口受控哈密顿控制系统模型
二自由度关节机器人的端口受控哈密顿控制系统的能量函数H(q,p)为:
其中,表示端口受控哈密顿控制系统的动能,U(q)表示端口受控哈密顿控制系统的势能;表示端口受控哈密顿控制系统的广义动量矢量,p1、p2分别表示关节1、关节2的广义动量;
选取端口受控哈密顿控制系统的状态向量为x=[q p]T=[q1 q2 p1 p2]T,将二自由度关节机器人的端口受控哈密顿控制系统模型写为:
其中, 为输入矩阵;
τ1-PCH、τ2-PCH分别表示端口受控哈密顿控制系统对关节1、关节2输出的控制力矩;
s2.1.3设计二自由度关节机器人的端口受控哈密顿控制器
假设端口受控哈密顿控制系统期望的平衡点为xd=[qd pd]T;
其中,qd=[q1d q2d]T表示期望的关节角位移矢量,q1d、q2d分别表示关节1、关节2的期望角位移,分别表示关节1、关节2的期望角速度;pd=[p1d p2d]T=[0 0]T表示期望的广义动量矢量,p1d、p2d分别表示关节1、关节2的期望广义动量;
为将端口受控哈密顿控制系统渐近的稳定在期望的平衡点xd附近,构造一个加入反馈控制后的闭环系统:
其中,Jd(x)为期望的互联矩阵,且Rd(x)为期望的阻尼矩阵,且
该闭环系统在期望的平衡点xd处取极小值;
选取期望的Hamiltonian函数为:
其中,Hd(xd)=0;
为期望惯性矩阵,a1、a2、a3为设计参数;
为比例增益,KP_PCH1和KP_PCH2分别为常数;
配置满足:
其中,为微分系数,KD_PCH1、KD_PCH2为设计参数;
由于公式(2)与公式(5)均是对二自由度关节机器人的端口受控哈密顿控制系统的描述,将公式(2)与公式(5)中的消掉可得:
进一步得到:
解方程可得端口受控哈密顿控制器为:
其中:
s2.2设计PD控制器
设计二自由度关节机器人的PD控制器为:
其中,τPD=[τ1-PD τ2-PD]T为PD控制器对关节1、关节2的控制转矩;
为比例增益矩阵;
为微分增益矩阵;
e=[e1 e2]T=[q1-q1d q2-q2d]T为位置误差矢量;
为速度误差矢量;
s3设计端口受控哈密顿控制系统与PD控制系统的协调控制器
定义c1-PCH,c2-PCH分别为端口受控哈密顿控制系统的协调函数,c1-PD,c2-PD分别为PD控制系统的协调函数;
则端口受控哈密顿控制系统与PD控制系统的协调控制函数能够设计为:
其中,TC为协调时间常数,c1-PCH∈[0,1],c2-PCH∈[0,1],c1-PD∈[0,1],c2-PD∈[0,1];
二自由度关节机器人端口受控哈密顿控制系统与PD控制系统的协调控制器为:
其中,τ1、τ2为协调控制器对关节1、关节2的转矩输出;
s4基于端口受控哈密顿控制器与PD控制器的二自由度关节机器人运动控制系统的稳定性分析
s4.1二自由度关节机器人的端口受控哈密顿控制系统稳定性分析
由公式(6)所描述的期望端口受控哈密顿控制系统的能量函数可知Hd(x)>0;
对公式(6)求导,并将公式(5)代入可得:
由于Jd(x)为反对称矩阵、Rd(x)为半正定矩阵,根据Lasalle定理,若包括在集合中的闭环系统最大不变集为{xd},则端口受控哈密顿控制系统在平衡点xd处是渐进稳定的,其中,Rn表示n维实数向量;
s4.2二自由度关节机器人的PD控制系统稳定性分析
依据PD控制系统的状态变量e=[e1 e2]T,将公式(11)代入到公式(1)中可得:
由公式(15)可得为PD控制系统唯一静态平衡点;
定义李雅普诺夫函数为:
其中,U(qd)表示端口受控哈密顿控制系统在期望平衡点处的势能;
由于:
公式(1)描述的机器人动力学模型,对于任意给定的足够小的正常数a,对角正定比例增益矩阵KP_PD为可使下面二式同时成立:
eTG(q)+eTKP_PDe≥a||e||2 (19)
将公式(17)和公式(18)代入公式(16),可得:
公式(1)描述的机器人动力学模型,惯性矩阵M(q)为对称、正定、有界,选择微分增益矩阵KD_PD足够大,使得:
KD_PD-2M(q)>0 (21)
KD_PD-M(q)-εCMI>0 (22)
其中,ε、CM为正常数,I为单位矩阵;
由公式(20)和公式(21)可得李雅普诺夫函数是正定的;
对公式(16)求导,可得:
由于将由公式(15)求得的代入公式(23)中可得:
公式(1)描述的机器人动力学模型,为反对称矩阵,使得:
公式(24)进一步写为:
假设存在ε>0,使得||e||≤ε,对于公式(1)描述的机器人动力学模型,存在下列关系:
将公式(19)和公式(26)代入公式(25)可得:
由公式(22)和公式(26)可得
正定,半负定,由李雅普诺夫稳定性理论可知二自由度关节机器人的PD控制系统是渐进稳定的;
s4.3整个协调控制系统稳定性分析
二自由度关节机器人整个协调控制系统的李雅普诺夫控制函数可写为:
V=VPCH+VPD (28)
当时间t=0时,c1-PCH(t)=c2-PCH(t)=0,c1-PD(t)=c2-PD(t)=1,只有PD控制系统作用于协调控制系统,V=VPD>0,根据李雅普诺夫稳定性理论可知协调控制系统稳定;
当时间0<t<∞时,c1-PCH,c2-PCH,c1-PD,c2-PD均为大于0小于1的常数,由于时间连续,属于共同控制;由于控制器各变量类型没有发生变化,结合端口受控哈密顿控制系统和PD控制系统稳定性分析可知,V正定,半负定,因此协调控制系统是渐进稳定的;
当时间t→∞时,c1-PCH(t)=c2-PCH(t)=1,c1-PD(t)=c2-PD(t)=0,只有端口受控哈密顿控制系统作用于整个控制系统,V=VPCH>0,协调控制系统稳定;
由以上分析可知,整个协调控制系统是渐进稳定的。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710654137.2A CN107263483B (zh) | 2017-08-03 | 2017-08-03 | 二自由度关节机器人轨迹的协调控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710654137.2A CN107263483B (zh) | 2017-08-03 | 2017-08-03 | 二自由度关节机器人轨迹的协调控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107263483A CN107263483A (zh) | 2017-10-20 |
CN107263483B true CN107263483B (zh) | 2019-09-10 |
Family
ID=60076295
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710654137.2A Active CN107263483B (zh) | 2017-08-03 | 2017-08-03 | 二自由度关节机器人轨迹的协调控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107263483B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108519740B (zh) * | 2018-05-05 | 2020-11-17 | 曲阜师范大学 | 一种全状态约束机械臂轨迹跟踪的协同控制方法 |
CN111203890B (zh) * | 2020-02-28 | 2022-04-19 | 中国科学技术大学 | 一种机器人的位置误差补偿方法 |
CN112180719A (zh) * | 2020-09-01 | 2021-01-05 | 上海大学 | 基于人机协作系统的新型鲁棒有限时间轨迹控制方法 |
CN112731954A (zh) * | 2020-12-25 | 2021-04-30 | 深圳市优必选科技股份有限公司 | 机器人的运动控制方法、装置、机器人及存储介质 |
CN114035435B (zh) * | 2021-11-24 | 2023-08-08 | 青岛大学 | 基于能量成型和阻尼注入的多容液位新型哈密顿控制系统 |
CN114442640B (zh) * | 2022-02-28 | 2022-09-16 | 哈尔滨理工大学 | 一种水面无人艇轨迹跟踪控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH04192008A (ja) * | 1990-11-27 | 1992-07-10 | Pentel Kk | 多関節ロボット旋回制御方式 |
CN102540881A (zh) * | 2012-02-17 | 2012-07-04 | 国电科学技术研究院 | 基于柔性机械臂的偏微分模型的边界控制律的设计方法 |
CN104589344A (zh) * | 2014-11-21 | 2015-05-06 | 电子科技大学 | 一种抑制柔性机械臂振动的边界控制方法 |
CN106078742A (zh) * | 2016-06-29 | 2016-11-09 | 北京科技大学 | 一种针对带有输出约束的柔性机械臂的振动控制方法 |
CN106849797A (zh) * | 2017-04-10 | 2017-06-13 | 福州大学 | 一种双惯性永磁同步电机的电流无源控制方法 |
-
2017
- 2017-08-03 CN CN201710654137.2A patent/CN107263483B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH04192008A (ja) * | 1990-11-27 | 1992-07-10 | Pentel Kk | 多関節ロボット旋回制御方式 |
CN102540881A (zh) * | 2012-02-17 | 2012-07-04 | 国电科学技术研究院 | 基于柔性机械臂的偏微分模型的边界控制律的设计方法 |
CN104589344A (zh) * | 2014-11-21 | 2015-05-06 | 电子科技大学 | 一种抑制柔性机械臂振动的边界控制方法 |
CN106078742A (zh) * | 2016-06-29 | 2016-11-09 | 北京科技大学 | 一种针对带有输出约束的柔性机械臂的振动控制方法 |
CN106849797A (zh) * | 2017-04-10 | 2017-06-13 | 福州大学 | 一种双惯性永磁同步电机的电流无源控制方法 |
Non-Patent Citations (2)
Title |
---|
二自由度机器人模糊滑模控制及仿真;李鹏等;《青岛大学学报(工程技术版)》;20170531;第32卷(第2期);全文 * |
机器人的端口受控哈密顿与自适应混合控制;刘应新等;《青岛大学学报(工程技术版)》;20160930;第31卷(第3期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN107263483A (zh) | 2017-10-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107263483B (zh) | 二自由度关节机器人轨迹的协调控制方法 | |
CN112904728B (zh) | 一种基于改进型趋近律的机械臂滑模控制轨迹跟踪方法 | |
CN105093934B (zh) | 考虑干扰与模型不确定性的多机器人系统分布式有限时间跟踪控制方法 | |
CN110977988B (zh) | 基于有限时间命令滤波的多关节机械臂阻抗控制方法 | |
CN108942924A (zh) | 基于多层神经网络的模型不确定性机械臂运动控制方法 | |
CN110376882A (zh) | 基于有限时间扩张状态观测器的预定性能控制方法 | |
CN107160398B (zh) | 基于确定学习的全状态受限刚性机械臂安全可靠控制方法 | |
CN106681343B (zh) | 一种航天器姿态跟踪低复杂度预设性能控制方法 | |
CN110877333A (zh) | 一种柔性关节机械臂控制方法 | |
CN108181920A (zh) | 基于给定时间的四旋翼无人机高精度姿态跟踪控制方法 | |
CN112207834B (zh) | 一种基于干扰观测器的机器人关节系统控制方法及系统 | |
CN109857100B (zh) | 一种基于反演法和快速终端滑模的复合轨迹跟踪控制算法 | |
CN106406098B (zh) | 一种机器人系统在未知环境下的人机交互控制方法 | |
CN108267952B (zh) | 一种水下机器人自适应有限时间控制方法 | |
CN105652667B (zh) | 一种模型不确定双关节机械手的高精度轨迹跟踪控制方法 | |
CN108089589A (zh) | 一种水下机器人姿态控制方法 | |
CN106406097A (zh) | 多机械臂系统的分布式自适应协调控制方法 | |
CN109828468A (zh) | 一种针对磁滞非线性机器人系统的控制方法 | |
CN107977011A (zh) | 基于分数阶控制算法的四旋翼无人机飞行控制方法 | |
CN114179089B (zh) | 一种机械臂的鲁棒区域跟踪控制方法 | |
CN114942593A (zh) | 一种基于干扰观测器补偿的机械臂自适应滑模控制方法 | |
CN107263455B (zh) | 二自由度scara机器人的位置跟踪控制方法 | |
Chwa et al. | Online trajectory planning of robot arms for interception of fast maneuvering object under torque and velocity constraints | |
CN108326857A (zh) | 基于鲁棒自适应控制算法的书法及雕刻机器人控制方法 | |
CN116068893A (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 |