CN115256386B - 考虑跟踪误差约束的不确定机械臂神经自适应控制方法 - Google Patents
考虑跟踪误差约束的不确定机械臂神经自适应控制方法 Download PDFInfo
- Publication number
- CN115256386B CN115256386B CN202210886681.0A CN202210886681A CN115256386B CN 115256386 B CN115256386 B CN 115256386B CN 202210886681 A CN202210886681 A CN 202210886681A CN 115256386 B CN115256386 B CN 115256386B
- Authority
- CN
- China
- Prior art keywords
- tracking error
- mechanical arm
- vector
- control method
- uncertain
- 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 50
- 230000001537 neural effect Effects 0.000 title claims abstract description 16
- 239000011159 matrix material Substances 0.000 claims abstract description 34
- 238000013528 artificial neural network Methods 0.000 claims abstract description 21
- 238000005312 nonlinear dynamic Methods 0.000 claims abstract description 15
- 230000009466 transformation Effects 0.000 claims abstract description 6
- 230000003044 adaptive effect Effects 0.000 claims description 21
- 238000013461 design Methods 0.000 claims description 18
- 230000005484 gravity Effects 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000005284 excitation Effects 0.000 claims description 3
- 230000006978 adaptation Effects 0.000 claims description 2
- 210000004204 blood vessel Anatomy 0.000 claims 1
- 241000252229 Carassius auratus Species 0.000 abstract description 5
- 230000001052 transient effect Effects 0.000 abstract description 5
- 238000010586 diagram Methods 0.000 description 4
- 238000011160 research Methods 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process 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
-
- 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Feedback Control In General (AREA)
Abstract
本发明涉及一种考虑跟踪误差约束的不确定机械臂神经自适应控制方法,该方法建立多关节机械臂非线性动态模型;针对多关节机械臂非线性动态模型产生的跟踪误差,设计约束条件限制其运动轨迹;结合移位函数,利用非线性变换将受限的跟踪误差转换为非受限的变量;采用RBF神经网络逼近多关节机械臂非线性动态模型中的未建模动态,得到未建模动态的估计模型;结合虚拟参数和动态面技术,设计基于神经网络的自适应跟踪控制器。本发明解决未知初始跟踪误差的难点,不需要利用惯性矩阵与离心力和哥氏力矩阵的斜对称特性,实现机械臂的轨迹跟踪误差在约束范围内,提高控制***的暂态性能和稳态性能,并且控制器结构简单、易于实现。
Description
技术领域
本发明属于机械臂自适应控制领域,尤其涉及一种考虑跟踪误差约束的不确定机械臂神经自适应控制方法。
背景技术
随着科技进步,机械臂在国防、医疗以及工业等领域获得了广泛应用,提高机械臂控制***的轨迹跟踪精度和暂态性能是现阶段研究的热点。机械臂动态模型属于欧拉-拉格朗日型非线性机械***,在实际运行中往往存在不确定的模型参数和外部干扰,这会影响轨迹跟踪性能,甚至造成控制***不稳定。因此针对机械臂轨迹跟踪***,如何设计不依赖模型参数并且跟踪误差在约束条件范围内的智能控制方法是现阶段的研究难点。
针对模型参数不确定问题,可以采用神经网络的万能逼近特性进行处理。现有基于神经网络的机械臂控制方法,需要利用惯性矩阵与离心力和哥氏力矩阵的斜对称特性来处理不确定的惯性矩阵,具有一定的保守性。并且,随着神经网络的层数增加,权重参数调整需要耗费大量计算资源,不利于控制律的在线使用。
现有针对轨迹跟踪误差约束的控制有许多研究成果,例如一种基于神经网络的机械臂***预设性能控制方法、一种多输入多输出机械***自适应容错预设性能控制方法、一种基于未知***动态估计器的柔性关节机械臂预设性能控制方法等。现有成果的基本思想是利用预设性能函数限制跟踪误差的运动轨迹,将受限的跟踪误差转换成非受限的形式。然而上述方法事先需要初始跟踪误差的信息,即初始跟踪误差必须在受限的范围内才能有效,具有局限性。
发明内容
本发明提出一种考虑跟踪误差约束的不确定机械臂神经自适应控制方法,其目的在于该方法可以解决未知初始跟踪误差的难点,不需要利用惯性矩阵与离心力和哥氏力矩阵的斜对称特性,实现机械臂的轨迹跟踪误差在约束范围内,提高控制***的暂态性能和稳态性能,并且控制器结构简单、易于实现。
本发明为了实现上述目的,采用如下技术方案:
一种考虑跟踪误差约束的不确定机械臂神经自适应控制方法,包括如下步骤:
步骤1.考虑多关节机械臂的外部环境扰动和关节之间摩擦的情况,建立多关节机械臂非线性动态模型;
步骤2.针对多关节机械臂非线性动态模型产生的跟踪误差z1,设计约束条件限制其运动轨迹;
步骤3.结合移位函数,利用非线性变换将受限的跟踪误差z1转换为非受限的变量η;
步骤4.采用RBF神经网络逼近多关节机械臂非线性动态模型中的未建模动态,得到未建模动态的估计模型;
进一步的,步骤1中多关节机械臂非线性动态模型为:
其中,q∈Rn表示关节角位置状态矢量,表示关节角速度状态矢量,表示关节角加速度状态矢量,M(q)∈Rn×n为对称正定惯性矩阵,为离心力和哥氏力矩阵,Gg(q)∈Rn为重力矢量,为外部不确定性扰动和关节之间摩擦的矢量。
进一步的,步骤2中跟踪误差为:
z1=q-qd
其中,z1=[z11,...,z1n]T,qd=[qd1,...,qdn]T为期望的关节角位置矢量;
约束条件为:
其中,Ωck表示对应跟踪误差z1k的约束限制,Ωck0、Ωck∞、κk分别表示限制条件Ωck的初始值、稳态值和收敛速度。
进一步的,在步骤3中跟踪误差z1非受限的形式为:
η=[η1,...,ηn]T
其中,η中的元素表示为:
其中,Tk>0表示时间参数。
进一步的,在步骤4中,未建模动态的估计模型为:
其中,高斯基函数的表达式为
进一步的,在步骤5中,动态面技术的表达式为:
其中,设计参数ad为正常数,α为虚拟控制函数,虚拟控制函数的表达式为:
其中,αf是由动态面技术产生的滤波信号。
一种考虑跟踪误差约束的不确定机械臂神经自适应控制方法的稳定性证明方法,该证明方法为:
对V3取时间导数得
其中,β2为正常数。
根据杨氏不等式得
将式子(34)代入(33)得
本发明与现有技术相比,具有如下优点和有益效果:
1、本发明通过构造新颖的移位函数,解决误差约束控制中未知初始跟踪误差的难点;
2、本发明利用杨氏不等式和李雅普诺夫函数,不需要应用动态模型中惯性矩阵与离心力和哥氏力矩阵的斜对称特性,控制律几乎不依赖模型的参数,具有较强的鲁棒性;
3、本发明应用虚拟参数技术压缩自适应律中的更新参数,设计动态面避免对虚拟控制律取时间导数,使得控制器结构简单、易于实现;
4、本发明实现机械臂的轨迹跟踪误差在约束范围内,提高控制***的暂态性能和稳态性能。
基于上述理由本发明可在机械臂自适应控制领域广泛推广。
附图说明
图1为本发明的技术路线图;
图2为本发明实施例中二自由度机械臂的模型示意图;
图3为采用不同控制方法后关节1角位置轨迹跟踪效果对比图;
图4为采用不同控制方法后关节2角位置轨迹跟踪效果对比图;
图5为采用不同控制方法后关节1角位置跟踪误差对比图;
图6为采用不同控制方法后关节2角位置跟踪误差对比图;
图7为本发明控制方法的控制力矩图;
图8为本发明控制方法的自适应参数轨迹图。
具体实施方式
下面结合附图以及具体实施方式对本发明作进一步详细说明。
本发明方法针对误差受限的不确定机械臂轨迹跟踪问题,设计约束条件限制跟踪误差的运动轨迹,构造新颖的移位函数处理未知的初始跟踪误差,利用非线性变换将受限的跟踪误差转换为非受限的形式,采用RBF神经网络逼近***中的未建模动态,解决动态***中参数不确定问题,同时应用虚拟参数技术压缩自适应律中的更新参数,设计动态面避免对虚拟控制律取时间导数,进而提出基于神经网络的自适应跟踪控制方法。
如图1所示,本发明提供了一种考虑跟踪误差约束的不确定机械臂神经自适应控制方法,包括如下步骤:
步骤1.考虑多关节机械臂的外部环境扰动和关节之间摩擦的情况,建立多关节机械臂非线性动态模型;
所建立带有环境干扰和参数不确定的多关节机械臂非线性动态模型为:
其中,q∈Rn表示关节角位置状态矢量,表示关节角速度状态矢量,表示关节角加速度状态矢量,M(q)∈Rn×n为对称正定惯性矩阵,为离心力和哥氏力矩阵,Gg(q)∈Rn为重力矢量,为外部环境扰动和关节之间摩擦的矢量,u为作用于关节上的控制力矩。
步骤2.针对多关节机械臂非线性动态模型产生的跟踪误差z1,设计约束条件限制其运动轨迹;
定义跟踪误差为:
z1=q-qd (8)
其中,z1=[z11,...,z1n]T,qd=[qd1,...,qdn]T为期望的关节角位置矢量。设计约束条件为:
其中,Ωck表示对应跟踪误差z1k的约束限制,Ωck0、Ωck∞、κk分别表示限制条件Ωck的初始值、稳态值和收敛速度。
步骤3.结合移位函数,利用非线性变换将受限的跟踪误差z1转换为非受限的变量η;
为处理未知的初始跟踪误差z1(0),构造如下移位函数:
其中,k=1,...n,Tk>0表示时间参数。从式子(10)可以发现,μk(0)=0和对于t≥Tk,μk(t)=1。将任何有界的信号与μk(t)相乘,在t=0时,其结果都为零;在t≥Tk时,其结果恢复到原信号。故结合位移函数,利用非线性变换将受限的跟踪误差z1=[z11,...,z1n]T变换为不受限的形式η=[η1,...,ηn]T:
其中,变量χk=μkz1k。
步骤4.采用RBF神经网络逼近多关节机械臂非线性动态模型中的未建模动态,得到未建模动态的估计模型;
根据RBF神经网络万能逼近特性,未建模动态可通过RBF神经网络来估计,
未建模动态的估计模型为:
其中,高斯基函数的表达式为
定义速度误差变量
其中,αf是由动态面技术产生的滤波信号,动态面的表达式为
其中,设计参数ad为正常数,α为接下来需要设计的虚拟控制函数。对η取时间导数得
其中,滤波误差变量y2=αf-α。根据杨氏不等式得
设计虚拟控制函数α为
其中,设计参数c1为正常数。将虚拟控制函数α代入式(21)得
对y2取时间导数并考虑(16)得
将式子(25)代入(23)得
本发明不需要利用惯性矩阵与离心力和哥氏力矩阵的斜对称特性,即
将式子(30)代入(27)得
根据杨氏不等式得
将式子(34)代入(33)得
其中,由上式可知,η,z2,y2,是有界的,即闭环控制***是稳定的。由于η是有界的,故当t≥max{T1,...,Tn}时,跟踪误差信号z1满足约束条件|z1k|<Ωck,其中,k=1,2,...,n。
在虚拟环境下对所设计的考虑跟踪误差约束的不确定机械臂神经自适应控制方法进行对比仿真实验,以验证所提方法的可行性。
控制律和自适应律参数设定为c1=2,c2=30,ad=0.005,τ1=0.1,τ2=1,T1=T2=2,s=6,rΘ=0.8,σΘ=2,神经网络中心矢量的每一个元素均匀分布在[-1,1]范围内,高斯基宽度为2.2。
跟踪误差的约束特性由用户根据实际情况设定,在本实施例中,Ωc10=Ωc20=0.51,Ωc1∞=Ωc2∞=0.01,κ1=κ2=1。由此可知,初始跟踪误差不在约束范围内,即|z11(0)|>Ωc10,|z12(0)|>Ωc20,传统的预设性能控制方法不能应对此种情况。本发明所设计的控制方法同样可适用于多关节机械臂的轨迹跟踪控制。
图3和图4分别为双关节轨迹跟踪对比图,图5和图6分别为双关节轨迹跟踪误差对比图。
由图3-6可知,在初始跟踪误差不在约束范围内的情况下,传统的控制方法(无移位函数)不能实现有效的跟踪控制,并且与传统的控制方法(无约束限制)相比,本发明的控制方法可以迫使跟踪误差在约束范围内,具有较高的跟踪精度。
图7为采用本发明控制方法产生的控制力矩曲线图,从该图可知,控制力矩曲线稳定在有界区域内。
图8为本发明控制方法的自适应参数随时间变化曲线,从该图可知,本发明控制方法只有一个需要调整的参数,并且该参数曲线稳定在有界区域内。
上述仿真实验结果表明,本发明控制方法克服了参数不确定及外界扰动的影响,在未知初始跟踪误差以及不需要利用惯性矩阵与离心力和哥氏力矩阵的斜对称特性的情况下,实现机械臂的轨迹跟踪误差在约束范围内,提高控制***的暂态性能和稳态性能。
当然,以上说明仅仅为本发明的较佳实施例,本发明并不限于列举上述实施例,应当说明的是,任何熟悉本领域的技术人员在本说明书的教导下,所做出的所有等同替代、明显变形形式,均落在本说明书的实质范围之内,理应受到本发明的保护。
Claims (7)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210886681.0A CN115256386B (zh) | 2022-07-26 | 2022-07-26 | 考虑跟踪误差约束的不确定机械臂神经自适应控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210886681.0A CN115256386B (zh) | 2022-07-26 | 2022-07-26 | 考虑跟踪误差约束的不确定机械臂神经自适应控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115256386A CN115256386A (zh) | 2022-11-01 |
CN115256386B true CN115256386B (zh) | 2023-03-07 |
Family
ID=83768778
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210886681.0A Active CN115256386B (zh) | 2022-07-26 | 2022-07-26 | 考虑跟踪误差约束的不确定机械臂神经自适应控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115256386B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115502986B (zh) * | 2022-11-15 | 2023-02-17 | 沈阳工业大学 | 基于状态观测器的多关节机械臂事件驱动控制方法 |
CN115857334B (zh) * | 2022-11-22 | 2023-06-16 | 沈阳工业大学 | 动态阈值事件驱动的多关节机械臂神经网络控制方法 |
CN115741629A (zh) * | 2022-11-23 | 2023-03-07 | 武汉纺织大学 | 基于跟踪误差模型的移动纺织机械臂控制方法和装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102289204A (zh) * | 2011-06-03 | 2011-12-21 | 华南理工大学 | 基于确定学习理论的机械臂通用控制方法 |
CN109176525A (zh) * | 2018-09-30 | 2019-01-11 | 上海神添实业有限公司 | 一种基于rbf的移动机械手自适应控制方法 |
CN110275436A (zh) * | 2019-05-31 | 2019-09-24 | 广东工业大学 | 一种多单臂机械手的rbf神经网络自适应控制方法 |
CN111736600A (zh) * | 2020-06-10 | 2020-10-02 | 哈尔滨工程大学 | 一种时滞非对称时变全状态约束下的水面无人艇轨迹跟踪控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102114068B1 (ko) * | 2018-04-19 | 2020-05-25 | 한국과학기술연구원 | 계산 토크 방식 제어기, 이의 파라미터 결정 및 성능 평가 방법 |
-
2022
- 2022-07-26 CN CN202210886681.0A patent/CN115256386B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102289204A (zh) * | 2011-06-03 | 2011-12-21 | 华南理工大学 | 基于确定学习理论的机械臂通用控制方法 |
CN109176525A (zh) * | 2018-09-30 | 2019-01-11 | 上海神添实业有限公司 | 一种基于rbf的移动机械手自适应控制方法 |
CN110275436A (zh) * | 2019-05-31 | 2019-09-24 | 广东工业大学 | 一种多单臂机械手的rbf神经网络自适应控制方法 |
CN111736600A (zh) * | 2020-06-10 | 2020-10-02 | 哈尔滨工程大学 | 一种时滞非对称时变全状态约束下的水面无人艇轨迹跟踪控制方法 |
Non-Patent Citations (1)
Title |
---|
基于径向基函数神经网络控制的机械臂轨迹误差研究;刘益标等;《机床与液压》(第15期);第105-108页 * |
Also Published As
Publication number | Publication date |
---|---|
CN115256386A (zh) | 2022-11-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115256386B (zh) | 考虑跟踪误差约束的不确定机械臂神经自适应控制方法 | |
CN111618858B (zh) | 一种基于自适应模糊滑模的机械手鲁棒跟踪控制算法 | |
CN112904728B (zh) | 一种基于改进型趋近律的机械臂滑模控制轨迹跟踪方法 | |
CN112817231B (zh) | 一种具有强鲁棒性的机械臂高精度跟踪控制方法 | |
CN110977988B (zh) | 基于有限时间命令滤波的多关节机械臂阻抗控制方法 | |
CN110687870B (zh) | 基于非线性扩张状态观测器的机械臂跟踪控制器及*** | |
CN110434858B (zh) | 一种基于命令滤波的多机械臂***的力/位混合控制方法 | |
CN107263483B (zh) | 二自由度关节机器人轨迹的协调控制方法 | |
CN110181510B (zh) | 一种基于时延估计与模糊逻辑的机械臂轨迹跟踪控制方法 | |
CN113183154B (zh) | 一种柔性关节机械臂的自适应反演控制方法 | |
Nguyen et al. | Adaptive chattering free neural network based sliding mode control for trajectory tracking of redundant parallel manipulators | |
CN113589689B (zh) | 一种基于多参数自适应神经网络的滑模控制器设计方法 | |
CN110673472A (zh) | 基于神经网络补偿死区反演误差的自适应鲁棒控制方法 | |
CN111496796B (zh) | 基于指令滤波器的机械臂轨迹跟踪控制方法及装置 | |
CN115502986B (zh) | 基于状态观测器的多关节机械臂事件驱动控制方法 | |
CN110456641B (zh) | 一种固定时预定性能循环神经网络机械臂控制方法 | |
CN112338912A (zh) | 一种柔性单链机械臂的有限时间稳定控制方法及*** | |
CN114750137A (zh) | 一种基于rbf网络的上肢外骨骼机器人运动控制方法 | |
CN109062240A (zh) | 一种基于神经网络估计的刚性飞行器固定时间自适应姿态跟踪控制方法 | |
CN110488854A (zh) | 一种基于神经网络估计的刚性飞行器固定时间姿态跟踪控制方法 | |
CN113219825B (zh) | 一种四足机器人单腿轨迹跟踪控制方法及*** | |
CN107263455B (zh) | 二自由度scara机器人的位置跟踪控制方法 | |
CN109176529B (zh) | 一种空间机器人协调运动的自适应模糊控制方法 | |
CN111590561A (zh) | 一种分布式机械臂***鲁棒预设性能控制方法 | |
CN115963819A (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 |