CN108646561B - 一种基于交叉耦合的多机械臂系统固定时间参数辨识与位置同步控制方法 - Google Patents
一种基于交叉耦合的多机械臂系统固定时间参数辨识与位置同步控制方法 Download PDFInfo
- Publication number
- CN108646561B CN108646561B CN201810460548.2A CN201810460548A CN108646561B CN 108646561 B CN108646561 B CN 108646561B CN 201810460548 A CN201810460548 A CN 201810460548A CN 108646561 B CN108646561 B CN 108646561B
- Authority
- CN
- China
- Prior art keywords
- matrix
- parameter
- fixed time
- formula
- mechanical arm
- 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 24
- 238000006880 cross-coupling reaction Methods 0.000 title claims abstract description 20
- 230000001360 synchronised effect Effects 0.000 claims abstract description 18
- 239000011159 matrix material Substances 0.000 claims description 36
- 230000003044 adaptive effect Effects 0.000 claims description 14
- 230000008878 coupling Effects 0.000 claims description 5
- 238000010168 coupling process Methods 0.000 claims description 5
- 238000005859 coupling reaction Methods 0.000 claims description 5
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000001914 filtration Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 230000008569 process Effects 0.000 claims description 3
- 239000000126 substance Substances 0.000 claims description 3
- 238000006467 substitution reaction Methods 0.000 claims 1
- 230000000694 effects Effects 0.000 abstract description 10
- 238000011217 control strategy Methods 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Abstract
一种基于交叉耦合的多机械臂系统固定时间参数辨识与位置同步控制方法,包括以下步骤:步骤1,建立多机械臂系统模型;步骤2,定义多机械臂跟踪误差、同步误差及交叉耦合误差;步骤3,设计自适应固定时间参数估计律和控制器。本发明所设计的参数辨识和同步控制方案对多机械臂系统具有良好的辨识和控制效果,使多机械臂系统能够实现高精度参数辨识并且具有良好的跟踪性能和同步性能。
Description
技术领域
本发明涉及一种基于交叉耦合的多机械臂在线自适应固定时间参数辨识与位置同步控制方法。
背景技术
随着现代化技术的快速发展和工业自动化程度的不断提高,多机械臂系统在扮演着越来越重要的角色。相比于单机械臂系统,多机械臂系统具有更高的可靠性,更大的灵活性和承载能力,同时能够完成更复杂的任务。由于多机械臂系统很容易受外部扰动,摩擦等因素影响,高精度控制相对困难。因此,对于如何提高多机械臂的参数辨识和同步控制性能是现有工业控制的研究热点。
对于具有未知参数或不可测量参数的控制系统,自适应参数辨识是一种很有效的方法。目前,大多数参数辨识采用离线辨识,这种方法不能够及时的反应参数的变化状态,并可能影响控制性能。因此,提出一种在线自适应辨识系统未知参数,并且能够及时反应参数变化的方法是十分必要的。
对于提高多机械臂的同步控制精度,目前已经提出了多种同步控制策略,如偏差耦合控制,交叉耦合控制,环形耦合控制等。若多机械臂同步性能效果差,则会影响生产任务,因此选择一种合适的同步控制策略是多机械臂系统控制中重要的一环。同时,在同步控制的基础上,选择一种合适的控制算法来提高控制精度。在众多控制方法中,滑模控制由于其结构简单,可靠性高等优点而被广泛应用。
发明内容
为了克服现有多机械臂系统参数辨识精度较低和同步控制性能较差的不足,本发明提供一种基于交叉耦合的多机械臂固定时间在线自适应参数辨识算法和固定时间同步控制方法。该方法设计了基于参数误差信息的参数辨识方法,并且设计了基于自适应参数辨识的固定时间滑模控制器,保证多机械臂系统的高精度控制。
为了解决上述技术问题提出的技术方案如下:
一种基于交叉耦合的多机械臂系统固定时间参数辨识与位置同步控制方法,所述控制方法包括以下步骤:
步骤1,建立多机械臂动力学模型;
一个由n个m关节的多机械臂动力学系统模型表示成如下形式:
其中n为机械臂的数量,m为每个机械臂的关节数量, 分别为机械臂的关节角位置矢量,速度矢量和加速度矢量,M(q)=diag([M1(q) … Mn(q)])为机械臂的正定惯性矩阵,表示离心力和哥氏力矩阵,为作用在关节上的重力矢量,为关节控制输入力矩矢量;
步骤2,定义多机械臂跟踪误差、同步误差及交叉耦合误差,过程如下:
2.1,定义多机械臂跟踪误差e为:
e=qd-q (2)
2.2,定义多机械臂同步误差ε为:
ε=Te (3)
2.3,定义多机械臂交叉耦合误差E为:
E=e+βε=Ae (4)
步骤3,设计自适应固定时间参数估计律和控制器,过程如下:
3.1,设计固定时间滑模面为:
由式(1),式(5),式(7)和式(8)得:
由式(8)和式(9)得:
由式(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,κ2>0为自适应增益矩阵,ρ1>1,0<ρ2<1为常数;
3.7,设计自适应控制器为:
其中K11>0,K12>0为控制器参数;
3.8,设计李雅普诺夫函数为:
对V求导得:
本发明基于交叉耦合同步控制策略和参数辨识理论,设计了一种基于交叉耦合的多机械臂系统固定时间参数辨识与位置同步控制方法,实现了多机械臂系统未知参数的辨识,同步控制性能和位置跟踪控制。
本发明的技术构思为:针对具有未知参数的多机械臂系统,本发明通过提取参数误差信息设计自适应参数辨识律,并且基于自适应参数辨识设计了固定时间滑模控制器,保证多机械臂系统的固定时间收敛和高精度控制。
本发明的优点为:保证多机械臂系统的同步性能和跟踪性能,实现对参数固定时间在线辨识,实现多机械臂系统的固定时间收敛。
附图说明
图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,建立多机械臂动力学模型;
一个由n个m关节的多机械臂动力学系统模型表示成如下形式:
其中n为机械臂的数量,m为每个机械臂的关节数量, 分别为机械臂的关节角位置矢量,速度矢量和加速度矢量,M(q)=diag([M1(q)…Mn(q)])为机械臂的正定惯性矩阵,表示离心力和哥氏力矩阵,为作用在关节上的重力矢量,为关节控制输入力矩矢量;
步骤2,定义多机械臂跟踪误差、同步误差及交叉耦合误差,过程如下:
2.1,定义多机械臂跟踪误差e为:
e=qd-q (2)
2.2,定义多机械臂同步误差ε为:
ε=Te (3)
2.3,定义多机械臂交叉耦合误差E为:
E=e+βε=Ae (4)
步骤3,设计自适应固定时间参数估计律和控制器,过程如下:
3.1,设计固定时间滑模面为:
由式(1),式(5),式(7)和式(8)得:
由式(8)和式(9)得:
由式(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,κ2>0为自适应增益矩阵,ρ1>1,0<ρ2<1为常数;
3.7,设计自适应控制器为:
其中K11>0,K12>0为控制器参数;
3.8,设计李雅普诺夫函数为:
对V求导得:
为验证系统参数辨识和同步控制方法的有效性,本发明对其进行了仿真实验。设置实验中的初始条件和控制参数为:系统参数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([3 3 3 3 33 3 3]),λ2=diag([2 2 2 2 2 2 2 2]),γ1=9/7,γ2=7/9,K11=diag([3 3 3 3 3 3 33]),K12=diag([2 2 2 2 2 2 2 2]),ρ1=9/7,ρ2=9/11,κ1=1,κ2=1,Γ=diag([1 1 1 11 1 1 1 5 5 5 5 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.3 0.2 0.2 0.1 0.3 0.2 0.2]T。
图2-图7是基于交叉耦合的多机械臂自适应参数辨识和控制仿真效果图。图2、图3和图4分别表示当参考轨迹为qd=0.5*sin(t)时跟踪轨迹、跟踪误差和同步误差,从图3和图4中看出机械臂1-机械臂4的跟踪误差和同步误差可以达到非常小的范围,这两幅图表明所提出的方法可以实现较高的跟踪性能和同步性能。图5和图6表示当参考轨迹为qd=0.5*sin(t)时系统参数辨识结果图。图5是机械臂1-机械臂4的关节质量辨识结果,图6是机械臂1-机械臂4的转动惯量辨识结果,从图中可以看出关节质量和转动惯量可以有效收敛到真值。图7表示当参考轨迹为qd=0.5*sin(t)时的系统输入,从图中可以看出几乎没有抖振。从仿真实验的结果来看,基于交叉耦合的多机械臂固定时间参数辨识和位置同步控制能够实现多机械臂系统的在固定时间内高精度参数辨识,高性能的位置跟踪控制和同步控制。
以上阐述的是本发明仿真实验用以表明所设计方法的有效性,但是本发明不限于上述实例在不偏离本发明基本精神及不超出本发明实质内容所涉及范围的前提下对其可作种种变形加以实施。本发明所设计的参数辨识和同步控制方案对多机械臂系统具有良好的辨识和控制效果,使多机械臂系统能够实现高精度参数辨识并且具有良好的跟踪性能和同步性能。
Claims (1)
1.一种基于交叉耦合的多机械臂系统固定时间参数辨识与位置同步控制方法,其特征在于:所述控制方法包括以下步骤:
步骤1,建立多机械臂动力学模型;
一个由n个m关节的多机械臂动力学系统模型表示成如下形式:
其中n为机械臂的数量,m为每个机械臂的关节数量, 分别为机械臂的关节角位置矢量,速度矢量和加速度矢量,M(q)=diag([M1(q) … Mn(q)])为机械臂的正定惯性矩阵,表示离心力和哥氏力矩阵,为作用在关节上的重力矢量,为关节控制输入力矩矢量;
步骤2,定义多机械臂跟踪误差、同步误差及交叉耦合误差,过程如下:
2.1,定义多机械臂跟踪误差e为:
e=qd-q (2)
2.2,定义多机械臂同步误差ε为:
ε=Te (3)
2.3,定义多机械臂交叉耦合误差E为:
E=e+βε=Ae (4)
步骤3,设计自适应固定时间参数估计律和控制器,过程如下:
3.1,设计固定时间滑模面为:
由式(1),式(5),式(7)和式(8)得:
由式(8)和式(9)得:
由式(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,κ2>0为自适应增益矩阵,ρ1>1,0<ρ2<1为常数;
3.7,设计自适应控制器为:
其中K11>0,K12>0为控制器参数;
3.8,设计李雅普诺夫函数为:
对V求导得:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810460548.2A CN108646561B (zh) | 2018-05-15 | 2018-05-15 | 一种基于交叉耦合的多机械臂系统固定时间参数辨识与位置同步控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810460548.2A CN108646561B (zh) | 2018-05-15 | 2018-05-15 | 一种基于交叉耦合的多机械臂系统固定时间参数辨识与位置同步控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108646561A CN108646561A (zh) | 2018-10-12 |
CN108646561B true CN108646561B (zh) | 2021-05-18 |
Family
ID=63755490
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810460548.2A Active CN108646561B (zh) | 2018-05-15 | 2018-05-15 | 一种基于交叉耦合的多机械臂系统固定时间参数辨识与位置同步控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108646561B (zh) |
Family Cites Families (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102401841A (zh) * | 2011-08-31 | 2012-04-04 | 华东光电集成器件研究所 | 一种多悬臂梁加速度传感器 |
JP5966372B2 (ja) * | 2012-01-17 | 2016-08-10 | セイコーエプソン株式会社 | ロボット制御装置、ロボットシステム、ロボット制御方法及びロボット |
CN103395065B (zh) * | 2013-08-07 | 2015-05-13 | 长春工业大学 | 基于双参数奇异摄动的液压刚柔机械臂控制方法 |
ES2530315B1 (es) * | 2013-08-27 | 2016-01-13 | Inveral, S.A. | Travesaño de soporte de una plataforma de trabajo. |
CN103728972B (zh) * | 2014-01-06 | 2014-10-15 | 中国石油大学(华东) | 多机械臂同步控制实验平台及实验方法 |
US9524257B2 (en) * | 2014-06-27 | 2016-12-20 | International Business Machines Corporation | Transactional execution enabled supervisor call interruption while in TX mode |
CN104723341A (zh) * | 2015-03-07 | 2015-06-24 | 哈尔滨工业大学 | 基于连接和阻尼配置的柔性关节机械臂的位置控制方法 |
CN105319972B (zh) * | 2015-11-27 | 2018-06-08 | 燕山大学 | 基于快速终端滑模的遥操作机器人固定时间控制方法 |
CN105867136A (zh) * | 2016-05-16 | 2016-08-17 | 北京理工大学 | 基于参数辨识的多电机伺服系统同步与跟踪控制方法 |
CN107045557B (zh) * | 2016-11-01 | 2020-05-12 | 长春工业大学 | 面向约束的可重构机械臂非奇异终端滑模力位置控制方法 |
CN106406097B (zh) * | 2016-11-08 | 2019-05-14 | 长春工业大学 | 多机械臂系统的分布式自适应协调控制方法 |
CN106493735B (zh) * | 2016-12-09 | 2018-08-17 | 西北工业大学 | 存在外界扰动的柔性机械臂扰动观测控制方法 |
CN107169196B (zh) * | 2017-05-11 | 2020-12-18 | 西北工业大学 | 空间机器人由末端执行器向基座的动力学建模方法 |
CN107662208B (zh) * | 2017-08-24 | 2020-07-31 | 浙江工业大学 | 一种基于神经网络的柔性关节机械臂有限时间自适应反步控制方法 |
CN107932504B (zh) * | 2017-11-13 | 2020-11-13 | 浙江工业大学 | 基于PyQt的机械臂运行控制系统 |
CN107942684B (zh) * | 2017-12-26 | 2020-03-24 | 电子科技大学 | 基于分数阶自适应非奇异终端滑模的机械臂轨迹跟踪方法 |
-
2018
- 2018-05-15 CN CN201810460548.2A patent/CN108646561B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN108646561A (zh) | 2018-10-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109927032B (zh) | 一种基于高阶滑模观测器的机械臂轨迹跟踪控制方法 | |
CN107491081B (zh) | 一种抗干扰四旋翼无人机姿态控制方法 | |
WO2018023201A1 (zh) | 一种自适应终端滑模控制方法 | |
CN108942924A (zh) | 基于多层神经网络的模型不确定性机械臂运动控制方法 | |
CN108656111B (zh) | 双机械臂系统有限时间参数辨识与位置同步控制方法 | |
CN107263481B (zh) | 一种多自由度机器人的类脑学习控制方法 | |
CN106113040B (zh) | 基于串并联估计模型的柔性机械臂系统模糊控制方法 | |
CN111258216A (zh) | 一种适用于四旋翼飞行器的滑模重复控制器 | |
CN108646563B (zh) | 一种基于均值耦合的多机械臂系统固定时间参数辨识与位置同步控制方法 | |
CN108469730B (zh) | 一种基于均值耦合的多电机固定时间自适应滑模控制方法 | |
CN113589689A (zh) | 一种基于多参数自适应神经网络的滑模控制器设计方法 | |
Sun et al. | Practical solution to attitude control within wide envelope | |
CN115202216A (zh) | 考虑输入约束的机械臂抗干扰有限时间控制方法 | |
CN108646562B (zh) | 一种基于交叉耦合的多机械臂系统有限时间参数辨识与位置同步控制方法 | |
CN115981162A (zh) | 一种基于新型扰动观测器的机器人系统滑模控制轨迹跟踪方法 | |
CN108638064B (zh) | 一种基于均值耦合的多机械臂系统自适应参数辨识与位置同步控制方法 | |
CN113297798B (zh) | 一种基于人工神经网络的机器人外界接触力估计方法 | |
CN109062039B (zh) | 一种三自由度Delta并联机器人的自适应鲁棒控制方法 | |
CN112650217B (zh) | 一种基于评估函数的机器人轨迹跟踪策略动态优化方法 | |
CN108448993B (zh) | 一种基于相邻交叉耦合的多电机固定时间自适应滑模控制方法 | |
CN108646561B (zh) | 一种基于交叉耦合的多机械臂系统固定时间参数辨识与位置同步控制方法 | |
CN108681252B (zh) | 一种多机械臂系统有限时间参数辨识与位置同步控制方法 | |
CN107807516A (zh) | 一种基于模糊自适应pid控制的模拟转台控制系统 | |
CN108687772B (zh) | 一种基于均值耦合的双机械臂系统固定时间参数辨识与位置同步控制方法 | |
CN111872933B (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 |