CN108656111A - 一种基于均值耦合的双机械臂系统有限时间参数辨识与位置同步控制方法 - Google Patents
一种基于均值耦合的双机械臂系统有限时间参数辨识与位置同步控制方法 Download PDFInfo
- Publication number
- CN108656111A CN108656111A CN201810460827.9A CN201810460827A CN108656111A CN 108656111 A CN108656111 A CN 108656111A CN 201810460827 A CN201810460827 A CN 201810460827A CN 108656111 A CN108656111 A CN 108656111A
- Authority
- CN
- China
- Prior art keywords
- formula
- mechanical arms
- double mechanical
- matrix
- error
- 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.)
- Granted
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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
Abstract
一种基于均值耦合的双机械臂系统有限时间参数辨识与位置同步控制方法,包括以下步骤:步骤1,建立双机械臂系统模型;步骤2,定义双机械臂跟踪误差、同步误差及均值耦合误差;步骤3,设计自适应有限时间参数估计律和控制器。本发明所设计的参数辨识和同步控制方案对双机械臂系统具有良好的辨识和控制效果,使双机械臂系统能够实现高精度参数辨识并且具有良好的跟踪性能和同步性能。
Description
技术领域
本发明涉及一种基于均值耦合的双机械臂在线自适应有限时间参数辨识与位置同步控制方法。
背景技术
双机械臂系统是由两个单机械臂组成的控制系统,相比于单机械臂系统,双机械臂系统具有更高的可靠性,更大的灵活性和承载能力,同时能够完成更复杂的任务。由于双机械臂系统很容易受外部扰动,摩擦等因素影响,高精度控制相对困难。因此,对于如何提高双机械臂的参数辨识和同步控制性能是现有工业控制的研究热点。
对于具有未知参数或不可测量参数的控制系统,自适应参数辨识是一种很有效的方法。目前,大多数参数辨识采用离线辨识,这种方法不能够及时的反应参数的变化状态,并可能影响控制性能。因此,提出一种在线自适应辨识系统未知参数,并且能够及时反应参数变化的方法是十分必要的。
对于提高双机械臂的同步控制精度,目前已经提出了多种同步控制策略。若双机械臂同步性能效果差,则会影响生产任务,因此选择一种合适的同步控制策略是双机械臂系统控制中重要的一环。同时,在同步控制的基础上,选择一种合适的控制算法来提高控制精度。在众多控制方法中,滑模控制由于其结构简单,可靠性高等优点而被广泛应用。
发明内容
为了克服现有双机械臂系统的参数辨识精度较低和同步控制性能较差的不足,本发明提供一种基于均值耦合的双机械臂有限时间在线自适应参数辨识算法和有限时间同步控制方法。该方法设计了基于参数误差信息的参数辨识方法,并且设计了基于自适应参数辨识的终端滑模控制器,保证双机械臂系统的高精度控制。
为了解决上述技术问题提出的技术方案如下:
一种基于均值耦合的双机械臂系统有限时间参数辨识与位置同步控制方法,所述控制方法包括以下步骤:
步骤1,建立双机械臂动力学模型;
双机械臂系统包含2个单机械臂,且每个机械臂有2个关节,其模型表示成如下形式:
其中分别为机械臂的关节角位置矢量,速度矢量和加速度矢量,M(q)=diag([M1(q) M2(q)])为机械臂的正定惯性矩阵,表示离心力和哥氏力矩阵,为作用在关节上的重力矢量,为关节控制输入力矩矢量;
步骤2,定义双机械臂跟踪误差、同步误差及均值耦合误差,过程如下:
2.1,定义双机械臂跟踪误差e为:
e=qd-q (2)
其中,为关节角位置误差,为期望的关节角位置矢量;
2.2,定义双机械臂同步误差ε为:
ε=Te (3)
其中I为单位对角阵;
2.3,定义双机械臂均值耦合误差E为:
E=e+βε=Ae (4)
其中A=I+βT是耦合系数矩阵,β=diag([β1 β2])代表同步系数,且为正定矩阵;
步骤3,设计自适应有限时间参数估计律和控制器,过程如下:
3.1,设计终端滑模面为:
其中λ1>0为控制参数,l1=(2-γ)μγ-1,l2=(γ-1)μγ-2,0<γ<1为常数,μ>0是一个小的正数,辅助矩阵和其微分形式的表示形式为:
3.2,定义辅助矩阵回归矩阵如下:
其中是已知的回归矩阵,θ是未知的参数;
由式(1),式(5),式(7)和式(8)得:
其中
由式(8)和式(9)得:
3.3,将回归矩阵进行如下滤波操作:
其中和τf分别是和τ滤波后的变量,k是调节参数;
由式(10)和式(11)得:
其中为滤波后的变量;
3.4,定义两个动态方程P和Q如下:
其中,l是调节参数;P(0)、Q(0)分别是P和Q的初值;
由式(13)得:
3.5,由式(12)和式(14)得到关于参数误差的信息:
Q=Pθ (15)
其中为θ的估计值,为估计误差;
3.6,设计自适应参数估计律为:
其中Γ>0,κ1>0为自适应增益矩阵,0<ρ<1为常数;
3.7,设计自适应控制器为:
其中K11>0,K12>0为控制器参数;
3.8,设计李雅普诺夫函数为:
对V求导得:
将式(9)和式(17)-(18)代入式(20),得到其中λmax(·)和λmin(·)为对应矩阵的最大和最小特征值,由此判定系统是稳定的,并且状态量在有限时间内收敛。
本发明基于均值耦合同步控制策略和参数辨识理论,设计了一种基于均值耦合的双机械臂系统有限时间参数辨识与位置同步控制方法,实现了双机械臂系统未知参数的辨识,同步控制性能和位置跟踪控制。
本发明的技术构思为:针对具有未知参数的双机械臂系统,本发明通过提取参数误差信息设计自适应参数辨识律,并且基于自适应参数辨识设计了终端滑模控制器,保证双机械臂系统的有限时间收敛和高精度控制。
本发明的优点为:保证双机械臂系统的同步性能和跟踪性能,实现对参数有限时间在线辨识,实现双机械臂系统的有限时间收敛。
附图说明
图1为本发明的控制流程图;
图2为参考轨迹为qd=0.5*sin(t)时的跟踪轨迹效果图;
图3为参考轨迹qd=0.5*sin(t)为时的跟踪误差效果图;
图4为参考轨迹qd=0.5*sin(t)为时的同步误差效果图;
图5为参考轨迹qd=0.5*sin(t)为时系统参数辨识关节质量的效果图;
图6为参考轨迹qd=0.5*sin(t)为时系统参数辨识关节转动惯量的效果图;
图7为参考轨迹qd=0.5*sin(t)为时的控制输入τ效果图。
具体实施方式
下面结合附图对本发明做进一步说明。
参照图1-图7,一种基于均值耦合的双机械臂系统有限时间参数辨识与位置同步控制方法,所述控制方法包括以下步骤:
步骤1,建立双机械臂动力学模型;
双机械臂系统包含2个单机械臂,且每个机械臂有2个关节,其模型表示成如下形式:
其中分别为机械臂的关节角位置矢量,速度矢量和加速度矢量,M(q)=diag([M1(q) M2(q)])为机械臂的正定惯性矩阵,表示离心力和哥氏力矩阵,为作用在关节上的重力矢量,为关节控制输入力矩矢量;
步骤2,定义双机械臂跟踪误差、同步误差及均值耦合误差,过程如下:
2.1,定义双机械臂跟踪误差e为:
e=qd-q (2)
其中,为关节角位置误差,为期望的关节角位置矢量;
2.2,定义双机械臂同步误差ε为:
ε=Te (3)
其中I为单位对角阵;
2.3,定义双机械臂均值耦合误差E为:
E=e+βε=Ae (4)
其中A=I+βT是耦合系数矩阵,β=diag([β1 β2])代表同步系数,且为正定矩阵;
步骤3,设计自适应有限时间参数估计律和控制器,过程如下:
3.1,设计终端滑模面为:
其中λ1>0为控制参数,l1=(2-γ)μγ-1,l2=(γ-1)μγ-2,0<γ<1为常数,μ>0是一个小的正数,辅助矩阵和其微分形式的表示形式为:
3.2,定义辅助矩阵回归矩阵如下:
其中是已知的回归矩阵,θ是未知的参数;
由式(1),式(5),式(7)和式(8)得:
其中
由式(8)和式(9)得:
3.3,将回归矩阵进行如下滤波操作:
其中和τf分别是和τ滤波后的变量,k是调节参数;
由式(10)和式(11)得:
其中为滤波后的变量;
3.4,定义两个动态方程P和Q如下:
其中,l是调节参数;P(0)、Q(0)分别是P和Q的初值;
由式(13)得:
3.5,由式(12)和式(14)得到关于参数误差的信息:
Q=Pθ (15)
其中为θ的估计值,为估计误差;
3.6,设计自适应参数估计律为:
其中Γ>0,κ1>0为自适应增益矩阵,0<ρ<1为常数;
3.7,设计自适应控制器为:
其中K11>0,K12>0为控制器参数;
3.8,设计李雅普诺夫函数为:
对V求导得:
将式(9)和式(17)-(18)代入式(20),得到其中λmax(·)和λmin(·)为对应矩阵的最大和最小特征值,由此判定系统是稳定的,并且状态量在有限时间内收敛。
为验证系统参数辨识和同步控制方法的有效性,本发明对其进行了仿真实验。设置实验中的初始条件和控制参数为:系统参数r1=0.2,r2=0.3,m1=0.3,m2=0.5,g=9.81,j1=0.05,j2=0.1;辨识和控制器参数k=0.001,l=1,β=0.8,λ1=diag([2 2 22]),γ=7/9,K11=diag([2 2 2 2]),ρ=9/11,κ1=1,Γ=diag([1 1 1 1 5 5 5 5]),初始条件ΦRf(0)=0,ΦHf(0)=0,ΦFf(0)=0,τ(0)=0,P(0)=0,Q(0)=0,q(0)=[0.1 0.250.1 0.2]T。
图2-图7是基于均值耦合的双机械臂自适应参数辨识和控制仿真效果图。图2、图3和图4分别表示当参考轨迹为qd=0.5*sin(t)时跟踪轨迹、跟踪误差和同步误差,从图3和图4中看出机械臂1和机械臂2的跟踪误差和同步误差可以达到非常小的范围,这两幅图表明所提出的方法可以实现较高的跟踪性能和同步性能。图5和图6表示当参考轨迹为qd=0.5*sin(t)时系统参数辨识结果图。图5是机械臂1和机械臂2的关节质量辨识结果,图6是机械臂1和机械臂2的转动惯量辨识结果,从图中可以看出关节质量和转动惯量可以有效收敛到真值。图7表示当参考轨迹为qd=0.5*sin(t)时的系统输入,从图中可以看出几乎没有抖振。从仿真实验的结果来看,基于均值耦合的双机械臂有限时间参数辨识和位置同步控制能够实现双机械臂系统的在有限时间内高精度参数辨识,高性能的位置跟踪控制和同步控制。
以上阐述的是本发明仿真实验用以表明所设计方法的有效性,但是本发明不限于上述实例在不偏离本发明基本精神及不超出本发明实质内容所涉及范围的前提下对其可作种种变形加以实施。本发明所设计的参数辨识和同步控制方案对双机械臂系统具有良好的辨识和控制效果,使双机械臂系统能够实现高精度参数辨识并且具有良好的跟踪性能和同步性能。
Claims (1)
1.一种基于均值耦合的双机械臂系统有限时间参数辨识与位置同步控制方法,其特征在于,所述控制方法包括以下步骤:
步骤1,建立双机械臂动力学模型;
双机械臂系统包含2个单机械臂,且每个机械臂有2个关节,其模型表示成如下形式:
其中分别为机械臂的关节角位置矢量,速度矢量和加速度矢量,M(q)=diag([M1(q) M2(q)])为机械臂的正定惯性矩阵,表示离心力和哥氏力矩阵,为作用在关节上的重力矢量,为关节控制输入力矩矢量;
步骤2,定义双机械臂跟踪误差、同步误差及均值耦合误差,过程如下:
2.1,定义双机械臂跟踪误差e为:
e=qd-q (2)
其中,为关节角位置误差,为期望的关节角位置矢量;
2.2,定义双机械臂同步误差ε为:
ε=Te (3)
其中I为单位对角阵;
2.3,定义双机械臂均值耦合误差E为:
E=e+βε=Ae (4)
其中A=I+βT是耦合系数矩阵,β=diag([β1 β2])代表同步系数,且为正定矩阵;
步骤3,设计自适应有限时间参数估计律和控制器,过程如下:
3.1,设计终端滑模面为:
其中λ1>0为控制参数,l1=(2-γ)μγ-1,l2=(γ-1)μγ-2,0<γ<1为常数,μ>0是一个小的正数,辅助矩阵和其微分形式的表示形式为:
3.2,定义辅助矩阵回归矩阵如下:
其中是已知的回归矩阵,θ是未知的参数;
由式(1),式(5),式(7)和式(8)得:
其中
由式(8)和式(9)得:
3.3,将回归矩阵进行如下滤波操作:
其中和τf分别是和τ滤波后的变量,k是调节参数;
由式(10)和式(11)得:
其中为滤波后的变量;
3.4,定义两个动态方程P和Q如下:
其中,l是调节参数;P(0)、Q(0)分别是P和Q的初值;
由式(13)得:
3.5,由式(12)和式(14)得到关于参数误差的信息:
Q=Pθ (15)
其中为θ的估计值,为估计误差;
3.6,设计自适应参数估计律为:
其中Γ>0,κ1>0为自适应增益矩阵,0<ρ<1为常数;
3.7,设计自适应控制器为:
其中K11>0,K12>0为控制器参数;
3.8,设计李雅普诺夫函数为:
对V求导得:
将式(9)和式(17)-(18)代入式(20),得到其中λmax(·)和λmin(·)为对应矩阵的最大和最小特征值,由此判定系统是稳定的,并且状态量在有限时间内收敛。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810460827.9A CN108656111B (zh) | 2018-05-15 | 2018-05-15 | 双机械臂系统有限时间参数辨识与位置同步控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810460827.9A CN108656111B (zh) | 2018-05-15 | 2018-05-15 | 双机械臂系统有限时间参数辨识与位置同步控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108656111A true CN108656111A (zh) | 2018-10-16 |
CN108656111B CN108656111B (zh) | 2020-12-01 |
Family
ID=63779570
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810460827.9A Active CN108656111B (zh) | 2018-05-15 | 2018-05-15 | 双机械臂系统有限时间参数辨识与位置同步控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108656111B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110161852A (zh) * | 2019-05-08 | 2019-08-23 | 杭州电子科技大学 | 一种基于二阶滑模算法的移动机械臂运动控制方法 |
CN112959325A (zh) * | 2021-03-23 | 2021-06-15 | 南京航空航天大学 | 一种大场景下的双移动机械臂协同加工高精度控制方法 |
CN113927591A (zh) * | 2021-08-24 | 2022-01-14 | 盐城工学院 | 一种有限时间自适应机器人力位混合控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2105263A2 (en) * | 2008-03-27 | 2009-09-30 | Institutul de Mecanica Solidelor al Academiei Romane | Real time control method and device for robots in virtual projection |
CN101908497A (zh) * | 2010-07-14 | 2010-12-08 | 哈尔滨工业大学 | 一种应用于高洁净度环境下的双臂传输机器人 |
CN105068421A (zh) * | 2015-07-16 | 2015-11-18 | 浙江工业大学 | 多移动机器人的二自由度协同控制方法 |
EP3017918A1 (de) * | 2014-11-10 | 2016-05-11 | KUKA Roboter GmbH | Flexibles taktzeitoptimiertes teilen eines arbeitsraums für roboter |
CN106945043A (zh) * | 2017-04-18 | 2017-07-14 | 中国科学院重庆绿色智能技术研究院 | 一种主从式遥操作手术机器人多臂协同控制系统 |
-
2018
- 2018-05-15 CN CN201810460827.9A patent/CN108656111B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2105263A2 (en) * | 2008-03-27 | 2009-09-30 | Institutul de Mecanica Solidelor al Academiei Romane | Real time control method and device for robots in virtual projection |
CN101908497A (zh) * | 2010-07-14 | 2010-12-08 | 哈尔滨工业大学 | 一种应用于高洁净度环境下的双臂传输机器人 |
EP3017918A1 (de) * | 2014-11-10 | 2016-05-11 | KUKA Roboter GmbH | Flexibles taktzeitoptimiertes teilen eines arbeitsraums für roboter |
CN105068421A (zh) * | 2015-07-16 | 2015-11-18 | 浙江工业大学 | 多移动机器人的二自由度协同控制方法 |
CN106945043A (zh) * | 2017-04-18 | 2017-07-14 | 中国科学院重庆绿色智能技术研究院 | 一种主从式遥操作手术机器人多臂协同控制系统 |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110161852A (zh) * | 2019-05-08 | 2019-08-23 | 杭州电子科技大学 | 一种基于二阶滑模算法的移动机械臂运动控制方法 |
CN110161852B (zh) * | 2019-05-08 | 2022-01-04 | 杭州电子科技大学 | 一种基于二阶滑模算法的移动机械臂运动控制方法 |
CN112959325A (zh) * | 2021-03-23 | 2021-06-15 | 南京航空航天大学 | 一种大场景下的双移动机械臂协同加工高精度控制方法 |
CN113927591A (zh) * | 2021-08-24 | 2022-01-14 | 盐城工学院 | 一种有限时间自适应机器人力位混合控制方法 |
CN113927591B (zh) * | 2021-08-24 | 2023-07-25 | 盐城工学院 | 一种有限时间自适应机器人力位混合控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108656111B (zh) | 2020-12-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106444799B (zh) | 基于模糊扩张状态观测器和自适应滑模的四旋翼无人机控制方法 | |
CN108656111A (zh) | 一种基于均值耦合的双机械臂系统有限时间参数辨识与位置同步控制方法 | |
CN106788044B (zh) | 一种基于干扰观测器的永磁同步电机自适应非奇异终端滑模控制方法 | |
CN108803326B (zh) | 具有干扰和时延的工业机械臂线性自抗扰跟踪控制方法 | |
CN104950678B (zh) | 一种柔性机械臂系统的神经网络反演控制方法 | |
CN108897226B (zh) | 基于干扰观测器的mems陀螺仪预设性能非奇异滑模控制方法 | |
CN106067747A (zh) | 一种用于伺服系统控制的滑模扰动观测器的设计方法 | |
CN108445748A (zh) | 一种基于事件触发机制的自适应航天器姿态跟踪控制方法 | |
CN106406325B (zh) | 基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制方法 | |
CN105159083A (zh) | 一种双框架磁悬浮cmg框架系统的高精度摩擦补偿控制方法 | |
CN107894708A (zh) | 一种环形耦合型多轴机器人系统的同步控制方法 | |
CN108241299A (zh) | 带误差限定的微陀螺自适应滑模控制方法 | |
Ren et al. | Cascade PID controller for quadrotor | |
CN109240321A (zh) | 一种刚性飞行器的非奇异固定时间神经网络控制方法 | |
CN115256386B (zh) | 考虑跟踪误差约束的不确定机械臂神经自适应控制方法 | |
CN108406765A (zh) | 一种开链式多臂机器人阻抗控制方法 | |
CN107977011B (zh) | 基于分数阶控制算法的四旋翼无人机飞行控制方法 | |
CN110109473A (zh) | 可应用于旋转飞行器的非线性滚转稳定控制系统及方法 | |
CN108646563A (zh) | 一种基于均值耦合的多机械臂系统固定时间参数辨识与位置同步控制方法 | |
CN109992003A (zh) | 鲁棒性滚转角速率控制方法及系统 | |
CN108646562A (zh) | 一种基于交叉耦合的多机械臂系统有限时间参数辨识与位置同步控制方法 | |
CN108687772A (zh) | 一种基于均值耦合的双机械臂系统固定时间参数辨识与位置同步控制方法 | |
CN109062239A (zh) | 一种基于神经网络估计的刚性飞行器非奇异固定时间姿态跟踪控制方法 | |
CN108638064A (zh) | 一种基于均值耦合的多机械臂系统自适应参数辨识与位置同步控制方法 | |
CN107263455B (zh) | 二自由度scara机器人的位置跟踪控制方法 |
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 |