CN116079741A - 一种电机驱动单连杆机械臂的自适应控制方法 - Google Patents

一种电机驱动单连杆机械臂的自适应控制方法 Download PDF

Info

Publication number
CN116079741A
CN116079741A CN202310192069.8A CN202310192069A CN116079741A CN 116079741 A CN116079741 A CN 116079741A CN 202310192069 A CN202310192069 A CN 202310192069A CN 116079741 A CN116079741 A CN 116079741A
Authority
CN
China
Prior art keywords
control
time
performance
function
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.)
Granted
Application number
CN202310192069.8A
Other languages
English (en)
Other versions
CN116079741B (zh
Inventor
刘伟
赵建航
钱宗敏
费诗淇
刘滢
余慧
季新然
周杰
张泽林
秦轶
梅哲凡
赵环宇
杜董生
张丽娟
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hefei Wisdom Dragon Machinery Design Co ltd
Original Assignee
Huaiyin Institute of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Huaiyin Institute of Technology filed Critical Huaiyin Institute of Technology
Priority to CN202310192069.8A priority Critical patent/CN116079741B/zh
Publication of CN116079741A publication Critical patent/CN116079741A/zh
Application granted granted Critical
Publication of CN116079741B publication Critical patent/CN116079741B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/163Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明公开了一种电机驱动单连杆机械臂的自适应控制方法,包括:描述机器人单连杆机械臂的动力学方程,根据动力学方程得到具有非匹配干扰的不确定纯反馈非线性系统的状态方程;设计有限时间性能函数来约束系统动态模型的误差变量进而实现系统的跟踪控制满足规定性能的控制目标;基于动态面递推控制方法,结合模糊逼近、非线性干扰观测器的方法设计虚拟控制、实际控制输入和自适应更新律;构造Lyapunov函数V,计算
Figure DDA0004105865950000011
的不等式,验证其是否满足
Figure DDA0004105865950000012
对所设计的有限时间预定性能模糊自适应控制方案进行稳定性证明、性能指标分析。本发明实现了机械臂跟踪控制性能在规定时间内满足规定的性能指标。

Description

一种电机驱动单连杆机械臂的自适应控制方法
技术领域
本发明涉及机械臂自适应控制技术领域,具体涉及一种电机驱动单连杆机械臂的自适应控制方法。
背景技术
近十年来,随着国家科研实力的逐步提升,越来越多的行业纷纷加入智能化的大趋势中,较为明显的变化是各个领域内都渐渐的由人工转为自动化,在这之中,由于机械臂能够广泛的应用于航海、航空、化工生产等方面,因此,机械臂的研究得到了相当大的关注。
机械臂是一个存在高强度非线性和不确定性的模型,因其实际应用的要求,机械臂的运动轨迹往往需要在所参考轨迹附近且误差越小越好,除此之外,机械臂也会受到如设备不确定性、未建模动力学、生产负荷波动等多种形式的干扰,这些因素会很大程度上降低机械臂的性能,所以,研究如何实现机械臂的轨迹跟踪和干扰抑制至关重要。
已有文献中已有涉及非线性的预定性能控制方法,但是很少有文献考虑适合机械臂控制的非线性系统的有限时间预定性能控制方法。若再考虑结合非线性干扰观测器的主动抗干扰技术的方法几乎没有。所以,现有的电机驱动的机械臂,在控制过程中去相应速度慢、无法预先设定性能指标且抗干扰能力差。
因此,亟需设计一种新的控制方法改善上述不足。
发明内容
发明目的:为了克服已有技术性能上的不足,本发明提供一种电机驱动单连杆机械臂的自适应控制方法,结合了复合干扰观测器、预定性能控制、有限时间控制、模糊逼近、动态面递推设计、非线性干扰观测器等,能保证电机驱动单连杆机械臂的跟踪控制轨迹在规定时间内满足预先设定的性能指标,既能保证系统的快速响应,又具有较强的抗干扰能力,为机械臂的高性能控制提供理论依据。
技术方案:本发明公开了一种电机驱动单连杆机械臂的自适应控制方法,包括以下步骤:
步骤1:利用欧拉-拉格朗日动力学模型描述机器人单连杆机械臂的动力学方程,根据动力学方程得到具有非匹配干扰的不确定纯反馈非线性系统的状态方程;
步骤2:设计有限时间性能函数来约束跟踪误差变量进而实现系统的跟踪控制满足规定性能的控制目标;
步骤3:结合模糊逻辑系统的万能逼近原理、动态面控制和非线性干扰观测器的Backstepping方法来设计虚拟控制、实际控制输入、模糊自适应更新律、非线性干扰观测器来满足控制目标;
步骤4:构造合适的Lyapunov函数V,验证所设计的有限时间预定性能模糊自适应控制方法能否在有限时间内使得闭环系统稳定。具体过程为:对V函数进行求导并且代入步骤3所设计的虚拟控制、实际输入、自适应更新律和干扰观测器,计算
Figure BDA00041058659300000212
的导数,验证其是否满足有限时间稳定性判据
Figure BDA0004105865930000021
若满足,则所设计的控制器能够实现系统的有限时间收敛,若不满足,需要调整设计的虚拟控制、实际输入、自适应更新律和干扰观测器,直至不等式
Figure BDA0004105865930000022
成立;
步骤5:依据Lyapunov稳定性理论来对所设计的控制方案进行稳定性分析,证明本发明提出的控制方案能保证所有闭环系统变量在有限时间内稳定,同时跟踪误差能在规定时间内满足预先设定的性能指标。
进一步地,所述步骤1中,具有非匹配干扰的不确定纯反馈非线性系统的状态方程由下式表示:
Figure BDA0004105865930000023
其中,
Figure BDA0004105865930000024
u∈R,y∈R分别为系统的状态向量、控制输入与控制输出,
Figure BDA0004105865930000025
为未知光滑连续函数,
Figure BDA0004105865930000026
为已知光滑函数且满足gi,s≤|gi|≤gi,m,gi,s和gi,m是已知常数,di(t)∈R代表未知外部扰动,i=1,2,...,n。
进一步地,所述步骤2中,构建的有限时间性能函数为:
Figure BDA0004105865930000027
其中,
Figure BDA0004105865930000028
是正参数,初始值为
Figure BDA0004105865930000029
系统的收敛时间表示为
Figure BDA00041058659300000210
进一步地,所述步骤2中得到的新的误差变量具体如下:
根据有限时间性能函数和跟踪误差λ1=y-yd,yd为参考轨迹,新的误差变量
Figure BDA00041058659300000211
被设计为如下形式:
Figure BDA0004105865930000031
由上式可以知道
Figure BDA0004105865930000032
利用arctan函数和有限时间性能函数的性质得到跟踪误差预定义的性能指标-ρ(t)<λ1(t)<ρ(t)。
进一步地,所述步骤3中具体包括:
1)控制目标包括:
目标1:所研究的控制器在外部干扰下使系统输出y在有限时间内遵循参考轨迹yd
目标2:闭环系统是半全局实际有限时间稳定;
目标3:稳态跟踪误差和收敛时间满足预定义的性能指标;
2)设计的变量表示为:
Figure BDA0004105865930000033
ei=xii,
ηi=ψii,
Figure BDA0004105865930000034
其中,ei代表误差变量,ψi和αi分别为滤波器的输出和输入,
Figure BDA0004105865930000035
表示模糊逻辑系统的权值向量,
Figure BDA0004105865930000036
是其估计值,
Figure BDA0004105865930000037
则代表模糊逻辑系统权值的估计误差。
进一步地,所述步骤3中,满足控制目标的虚拟控制、实际输入和自适应更新律包括:
Figure BDA0004105865930000038
Figure BDA0004105865930000039
Figure BDA00041058659300000310
Figure BDA00041058659300000311
Figure BDA00041058659300000312
Figure BDA00041058659300000313
其中,ki,1,ki,a表示设计参数,
Figure BDA00041058659300000415
φi为模糊逻辑系统基函数;
Figure BDA0004105865930000041
是复合干扰的估计值并且由非线性干扰观测器输出。
进一步地,所述步骤4具体包括以下步骤:
步骤41:根据具有非匹配干扰的不确定纯反馈非线性系统的状态方程和
Figure BDA0004105865930000042
对误差变量e1进行求导,计算得到:
Figure BDA0004105865930000043
使用模糊逻辑系统去估计未知非线性函数f1,表示为
Figure BDA0004105865930000044
其中,
Figure BDA0004105865930000045
表示估计值与实际值之间的误差且满足
Figure BDA0004105865930000046
q1,m>0,因此,式(1)可重新写为:
Figure BDA0004105865930000047
其中,
Figure BDA0004105865930000048
是复合干扰且假设其满足
Figure BDA0004105865930000049
d1,1,d1,m是正设计参数;
设计非线性干扰观测器,用于估计未知复合干扰D1,其形式为:
Figure BDA00041058659300000410
定义
Figure BDA00041058659300000411
并且根据式(3),对
Figure BDA00041058659300000412
进行求导,得到:
Figure BDA00041058659300000413
根据虚拟控制和自适应更新律,采用一个时间常数为γ2的一阶滤波器,虚拟控制α2通过滤波器之后可得新的变量ψ2,即:
Figure BDA00041058659300000414
其中,γ2>0;
定义η2=ψ22并且对其取关于时间的导数,得到:
Figure BDA0004105865930000051
其中,
Figure BDA0004105865930000052
是一个连续的函数且满足|ε2|≤p2,p2>0是一个标量,ε2(·)表示为下式:
Figure BDA0004105865930000053
考虑下面的正定Lyapunov函数为
Figure BDA0004105865930000054
对V1求关于时间的导数,可得:
Figure BDA0004105865930000061
根据Young不等式,可以得到:
Figure BDA0004105865930000062
Figure BDA0004105865930000063
Figure BDA0004105865930000064
Figure BDA0004105865930000065
Figure BDA0004105865930000066
Figure BDA0004105865930000067
除此之外,有
Figure BDA0004105865930000071
将式(10)和式(11)代入式(9)中去,进行放缩,得到:
Figure BDA0004105865930000072
步骤42:对Vi求关于时间导数,计算得到
Figure BDA0004105865930000073
表示为:
Figure BDA0004105865930000074
步骤43:对Vn求关于时间导数,计算得到
Figure BDA0004105865930000075
表示为:
Figure BDA0004105865930000076
进一步地,所述步骤5的分析验证过程包括:
整合闭环系统的Lyapunov函数为如下形式:
Figure BDA0004105865930000077
对V求关于时间的导数并且整合计算,可得:
Figure BDA0004105865930000078
定义:
Figure BDA0004105865930000081
因此,式(16)可以转化为:
Figure BDA0004105865930000082
根据以下不等式
Figure BDA0004105865930000083
将式(19)代入到式(18)中,得到:
Figure BDA0004105865930000084
定义:
Figure BDA0004105865930000085
易得:
Figure BDA0004105865930000091
计算化简式(22),可以得到对所有的t≥Ts时,
Figure BDA0004105865930000092
成立,其中,c是一个常数且满足0<c≤1,得到的收敛时间Ts用下式表示:
Figure BDA0004105865930000093
闭环系统的所有信号
Figure BDA0004105865930000094
都是半全局实际有限时间稳定的,跟踪误差停留在由有限时间性能函数ρ预定义的规定区域内,根据有限时间性能函数的定义可知,跟踪误差e1在预定义的时间内收敛到预定义的跟踪误差ρtr里面;通过上述的分析,证实了基于复合干扰观测器的非线性系统预定性能有限时间模糊自适应动态面控制策略达到了目标。
有益效果:
1、本发明提出的控制策略是基于复合干扰观测器的非线性系统预定性能有限时间模糊自适应动态面控制策略,使用有限时间性能函数约束误差变量的轨迹范围来实现闭环系统的有限时间稳定,且跟踪误差在规定时间内满足预先设定的性能指标。本发明提出的控制策略结合了动态面控制技术、有限时间控制、预定性能控制等方法来设计控制器,简化了一般反推方法中的计算复杂度,提升了闭环系统的鲁棒性、收敛快速性,实现机械臂的跟踪控制轨迹能在规定时间内满足预定设定的误差指标,从而实现机械臂控制性能的改善。
2、本发明提出的控制方法中结合了非线性干扰观测器这种主动抗干扰衰减技术,将外部未知干扰、模糊逼近误差设计为复合干扰变量,有利于进一步降低模糊逼近误差,提升控制精度;另一方面,干扰观测器技术是一种前馈控制策略,有利于提升闭环系统系统对外部干扰的响应速度、降低控制输入。本发明提出的控制方法以更一般的非线性系统为研究对象,考虑更复杂的非匹配条件未知干扰,在有限时间预定性能模糊自适应控制的设计框架下,结合干扰观测器技术既提升了闭环系统的抗干扰能力、鲁棒性,对机械臂的预定性能控制方案提供重要的理论依据。
附图说明
图1为本发明实施例所述的机械臂的示意图;
图2为本发明实施例所述的自适应控制策略流程图;
图3为本发明给定的参考轨迹yd与实际轨迹y的曲线;
图4为本发明跟踪误差与预定义性能边界曲线;
图5为控制输入u的曲线;
图6为本发明误差d1及其估计值
Figure BDA0004105865930000101
曲线;
图7为本发明误差d2及其估计值
Figure BDA0004105865930000102
曲线;
图8为本发明误差d3及其估计值
Figure BDA0004105865930000103
曲线。
具体实施方式
下面对本发明技术方案进行详细说明。
本发明公开了一种电机驱动单连杆机械臂的有限时间预定性能模糊自适应控制方法,本实施例中以由电刷直流电机驱动的单连杆机械手系统的欧拉-拉格朗日动力学模型为例,对其进行控制策略设计,该动力学模型的方程为:
Figure BDA0004105865930000104
其中,
Figure BDA0004105865930000105
分别为单连杆机械臂连杆角位置、角速度和角加速度,m,M分别是连杆质量和负载质量,g,B,Kτ,KB分别代表重力系数、粘性摩擦系数、转换系数和反电动势系数,L,R,I,V分别表示电枢电感、电枢电阻、电枢电流和输入电压,J表示转子惯性,d,δ分别代表连杆长度和负载半径。
定义状态变量x1=q,
Figure BDA0004105865930000106
x3=I,u=V,则根据动力学模型方程(1)进行代换可得:
Figure BDA0004105865930000111
其中,非匹配干扰分别为d1=0,
Figure BDA0004105865930000112
u为系统输入,y为系统输出,显然,该状态方程是具有非匹配干扰的不确定纯反馈非线性系统的状态方程。由于机械臂连杆与电机受其物理特性限制以及对机械臂工作质量的要求,其角位置需要在参考轨迹附近且跟踪误差要在规定时间内处于预定义范围内,除此之外,整个闭环系统的所有信号都要实现半全局实际有限时间稳定。
本发明针对的系统为更一般的非线性系统,所以满足具有非匹配干扰的不确定纯反馈非线性系统要求的模型都能够使用该发明提出的基于复合干扰观测器的非线性系统预定性能有限时间模糊自适应动态面控制策略,根据实际生产的需要,该策略能够适用于所需状态参数更广的单连杆机械臂等实际模型。也就是说,系统的状态变量个数能够更一般化,将更一般化的非线性系统为研究对象,设计单连杆机械臂的控制方法。将(2)一般化以后,得到具有非匹配干扰的不确定纯反馈非线性系统的状态方程如下:
Figure BDA0004105865930000113
其中,
Figure BDA0004105865930000114
u∈R,y∈R分别为系统的状态向量、控制输入与控制输出,
Figure BDA0004105865930000115
为未知光滑连续函数,
Figure BDA0004105865930000116
为已知光滑函数且满足gi,s≤|gi|≤gi,m,gi,s和gi,m是已知常数,di(t)∈R代表未知外部扰动,i=1,2,...,n。
显而易见,式(2)所表示的动力学模型是式(3)n=3时的特例,满足状态方程(3)的所有特征。所以,可以使用本发明中的基于复合干扰观测器的预定义性能非线性系统有限时间模糊自适应动态面控制策略来处理由电刷直流电机驱动的单连杆机械手系统的控制问题。
采用本发明所述的控制策略实现具有非匹配干扰的单连杆机械手非线性控制系统的预定性能有限时间模糊自适应控制,详细的步骤如下:
(1)构建有限时间性能函数和预定义误差区域。
设计如下有限时间性能函数:
Figure BDA0004105865930000121
其中,
Figure BDA0004105865930000122
是正参数,初始值为
Figure BDA0004105865930000123
系统的收敛时间表示为
Figure BDA0004105865930000124
根据此有限时间性能函数和跟踪误差λ1=y-yd,yd为参考轨迹,一个新的误差变量
Figure BDA0004105865930000125
被设计为如下形式:
Figure BDA0004105865930000126
由上式可以知道
Figure BDA0004105865930000127
利用arctan函数和有限时间性能函数的性质得到跟踪误差预定义的性能指标-ρ(t)<λ1(t)<ρ(t)。
(2)结合模糊逻辑系统的万能逼近原理、动态面控制和非线性干扰观测器的Backstepping方法来设计虚拟控制、实际控制输入、模糊自适应更新律、非线性干扰观测器来满足控制目标;所设计一系列误差变量表示为:
Figure BDA0004105865930000128
其中,ei代表误差变量,ψi和αi分别为滤波器的输出和输入,
Figure BDA0004105865930000129
表示模糊逻辑系统的权值向量,
Figure BDA00041058659300001210
是其估计值,
Figure BDA00041058659300001211
则代表模糊逻辑系统权值的估计误差。
设计满足控制目标的虚拟控制、实际输入和自适应更新律,包括:
Figure BDA0004105865930000131
其中,ki,1,ki,a表示设计参数,φi为模糊逻辑系统基函数;
Figure BDA0004105865930000132
是复合干扰的估计值并且由非线性干扰观测器输出,非线性干扰观测器的具体形式会在后续步骤给出。
(3)构造合适的Lyapunov函数V,验证上述所设计的有限时间预定性能模糊自适应控制方法能否在有限时间内使得闭环系统稳定。具体过程为:对V函数进行求导并且代入步骤3所设计的虚拟控制、实际输入、自适应更新律和干扰观测器,计算
Figure BDA0004105865930000133
的导数,验证其是否满足有限时间稳定性判据
Figure BDA0004105865930000134
若满足,则所设计的控制器能够实现系统的有限时间收敛,若不满足,需要调整设计的虚拟控制、实际输入、自适应更新律和干扰观测器,直至不等式
Figure BDA0004105865930000135
成立。
本发明提出的控制策略是基于复合干扰观测器的非线性系统预定性能有限时间模糊自适应动态面控制策略,针对具有非匹配干扰的未知纯反馈非线性系统,结合预定义性能控制、有限时间控制、非线性干扰观测器技术、动态面控制技术、Backstepping方法和模糊逼近技术来设计控制策略以实现控制目标。本发明的主要控制目标如下:
目标1:所研究的控制器在外部干扰下使系统输出y在有限时间内遵循参考轨迹yd
目标2:闭环系统是半全局实际有限时间稳定;
目标3:稳态跟踪误差和收敛时间满足预定义的性能指标。
下面将给出基于复合干扰观测器的预定义性能非线性系统有限时间模糊自适应动态面控制策略设计的具体步骤,设计步骤被分为n步。
第1步:根据具有非匹配干扰的不确定纯反馈非线性系统的状态方程(3)和
Figure BDA0004105865930000136
对误差变量e1进行求导,计算得到:
Figure BDA0004105865930000141
使用模糊逻辑系统去估计未知非线性函数f1,表示为
Figure BDA0004105865930000142
其中,
Figure BDA0004105865930000143
表示估计值与实际值之间的误差且满足
Figure BDA0004105865930000144
q1,m>0,因此,式(8)可重新写为:
Figure BDA0004105865930000145
其中,
Figure BDA0004105865930000146
是复合干扰且假设其满足
Figure BDA0004105865930000147
d1,1,d1,m是正设计参数。
为了避免未知干扰的影响,一个非线性干扰观测器被设计出来用于估计未知复合干扰D1,其形式为:
Figure BDA0004105865930000148
定义
Figure BDA0004105865930000149
并且根据式(10),对
Figure BDA00041058659300001410
进行求导,得到:
Figure BDA00041058659300001411
为满足控制需要,设计如下两式的虚拟控制和自适应更新律:
Figure BDA00041058659300001412
Figure BDA00041058659300001413
其中,k1,a和k1,1为待设计的正常数,
Figure BDA00041058659300001414
为了消除Backstepping方法中的重复计算问题,我们采用一个时间常数为γ2的一阶滤波器,虚拟控制α2通过滤波器之后可得新的变量ψ2,即:
Figure BDA00041058659300001415
其中,γ2>0。
定义η2=ψ22并且对其取关于时间的导数,得到:
Figure BDA0004105865930000151
其中,
Figure BDA0004105865930000152
是一个连续的函数且满足|ε2|≤p2,p2>0是一个标量,ε2(·)表示为下式:
Figure BDA0004105865930000153
考虑下面的正定Lyapunov函数为
Figure BDA0004105865930000154
对V1求关于时间的导数,可得:
Figure BDA0004105865930000161
根据Young不等式,可以得到:
Figure BDA0004105865930000162
Figure BDA0004105865930000163
Figure BDA0004105865930000164
Figure BDA0004105865930000165
Figure BDA0004105865930000166
Figure BDA0004105865930000167
除此之外,有
Figure BDA0004105865930000171
将式(19)和式(20)代入式(18)中去,进行放缩,得到:
Figure BDA0004105865930000172
第i步(2≤i≤n-1):根据状态方程(3)与ei=xii,结合模糊逻辑控制技术,计算误差变量ei的关于时间导数,得到:
Figure BDA0004105865930000173
其中,
Figure BDA0004105865930000174
qi,m是正数,
Figure BDA0004105865930000175
代表第i个复合干扰且假设其满足
Figure BDA0004105865930000176
di,1,di,m是正设计参数。
为了获得复合干扰Di的估计值,建立如下形式的干扰观测器:
Figure BDA0004105865930000177
其中,
Figure BDA0004105865930000178
代表Di的估计值并由干扰观测器输出,vi是辅助的中间变量,ki,d>0是设计常数。
结合式(22)和式(23),计算得到干扰估计误差
Figure BDA0004105865930000179
的时间导数为:
Figure BDA00041058659300001710
接着,设计第i个虚拟控制和自适应更新律为:
Figure BDA00041058659300001711
Figure BDA0004105865930000181
其中ki,1,ki,a表示设计参数,φi为模糊逻辑系统基函数。
构造一个时间常数为γi+1的一阶滤波器如下:
Figure BDA0004105865930000182
其中,αi+1和ψi+1分别是该滤波器的输入和输出,因此,定义一个变量ηi+1=ψi+1i+1并且求其时间导数,得到:
Figure BDA0004105865930000183
其中,连续函数
Figure BDA0004105865930000184
满足|εi+1|≤pi+1,pi+1>0是一个标量,εi+1表示为下式:
Figure BDA0004105865930000185
选择第i个Lyapunov函数
Figure BDA0004105865930000186
Figure BDA0004105865930000187
求时间导数并将式(22)、(24)、(25)、(26)、(28)代入可得:
Figure BDA0004105865930000191
结合Young不等式,可以得到:
Figure BDA0004105865930000192
除此之外,有
Figure BDA0004105865930000193
将式(32)和(33)代入(31)中,得到:
Figure BDA0004105865930000194
第n步:根据状态方程(3)以及en=xnn,结合模糊控制技术,计算误差变量en的时间导数,可得:
Figure BDA0004105865930000201
其中,
Figure BDA0004105865930000202
qn,m是正数,
Figure BDA0004105865930000203
代表第n个复合干扰且假设其满足
Figure BDA0004105865930000204
dn,1,dn,m是正设计参数。
与前面步骤相似,设计如下干扰观测器:
Figure BDA0004105865930000205
其中,
Figure BDA0004105865930000206
代表Dn的估计值,vn是辅助中间变量,kn,d>0是设计常数。
根据式(35)和(36),计算干扰估计误差
Figure BDA0004105865930000207
的时间导数并表示为:
Figure BDA0004105865930000208
设计实际的控制器u和自适应更新律为:
Figure BDA0004105865930000209
Figure BDA00041058659300002010
其中,kn,1,kn,a表示设计参数,φn为模糊逻辑系统基函数。
设计第n个候选的Lyapunov函数为:
Figure BDA00041058659300002011
计算Vn关于时间的导数并且将式(35)-(39)代入,可得:
Figure BDA0004105865930000211
结合Young不等式,可得下面的一组不等式
Figure BDA0004105865930000212
除此之外,还有
Figure BDA0004105865930000213
将不等式(42)、(43)代入式(41),可得:
Figure BDA0004105865930000214
(4)依据Lyapunov稳定性理论来对所设计的控制方案进行稳定性分析,证明本发明提出的控制方案能保证所有闭环系统变量在有限时间内稳定,同时跟踪误差能在规定时间内满足预先设定的性能指标。
考虑具有非匹配干扰的未知非线性纯反馈系统(3),将非线性干扰观测器设计为式(10)、(23)、和(36),虚拟控制和实际输入设为式(12)、(25)、(38),自适应更新律设为式(13)、(26)和(39),可以保证以下特性:闭环系统是半全局实际有限时间稳定的;所研究的控制方案在外部干扰下使系统输出在有限时间内遵循参考轨迹且稳态跟踪误差和收敛时间满足预定义的性能指标。
证明:
整合闭环系统的Lyapunov函数为如下形式:
Figure BDA0004105865930000221
对V求关于时间的导数并且整合计算,可得:
Figure BDA0004105865930000222
定义:
Figure BDA0004105865930000223
因此,式(46)可以转化为:
Figure BDA0004105865930000224
根据以下不等式
Figure BDA0004105865930000225
将式(49)代入到式(48)中,得到:
Figure BDA0004105865930000231
定义:
Figure BDA0004105865930000232
易得:
Figure BDA0004105865930000233
计算式(52),可以得到对所有的t≥Ts时,
Figure BDA0004105865930000234
成立,其中,c是一个常数且满足0<c≤1,得到的收敛时间Ts用下式表示:
Figure BDA0004105865930000235
闭环系统的所有信号
Figure BDA0004105865930000236
都是半全局实际有限时间稳定的,跟踪误差停留在由有限时间性能函数ρ预定义的规定区域内,根据有限时间性能函数的定义可知,跟踪误差e1在预定义的时间内收敛到预定义的跟踪误差ρtr里面。通过上述的分析,证实了基于复合干扰观测器的非线性系统预定性能有限时间模糊自适应动态面控制策略达到了目标。
本发明研究了基于复合干扰观测器的预定性能非线性系统有限时间模糊自适应动态面控制,使用有限时间性能函数约束误差变量的轨迹范围来实现闭环系统的有限时间稳定,且跟踪误差在规定时间内满足预先设定的性能指标,将模糊自适应控制与非线性干扰观测器技术相结合,建立了一种有效的复合非线性干扰观测器方案来估计未知的复合干扰,包括未知的外部干扰和模糊逼近误差,这意味着模糊逼近误差可以进一步减小。结果表明,该闭环系统具有半全局实际有限时间稳定性,跟踪误差和收敛时间均满足预定的性能指标。上述从理论角度证明了本发明提出的控制策略的有效性。在单连杆机械臂等实际应用中本发明提出的方法更加易于应用,主要表现在:
(1)可以通过调整有限时间性能函数中的参数来获得实际生产所需的预定义误差范围和规定的有限收敛时间,从而得到更优的控制性能;
(2)针对更为一般的非线性系统,采用主动抗干扰技术,从而扩大了该控制策略的适用范围;
(3)使用Matlab工具将该控制策略应用于单连杆机械臂模型上,仿真结果表明该发明设计的方法能够实现所需控制目标。
状态变量的初值设定为x1(0)=0.2,x2(0)=-0.1,x3(0)=-0.1,设定有限时间性能函数主要参数为ρ0=1,
Figure BDA0004105865930000241
l=0.4,
Figure BDA0004105865930000242
因此得知收敛时间为tr=0.5sec,除此之外,k1,1=0.5,k2,1=2,k3,1=1;k1,a=5,k2,a=5,k3,a=5;k1,d=10,k2,d=10,k3,d=10,滤波器时间常数为γ2=0.05,γ3=0.002,得到的主要仿真结果如图3至图8所示。
上述实施方式只为说明本发明的技术构思及特点,其目的在于让熟悉此项技术的人能够了解本发明的内容并据以实施,并不能以此限制本发明的保护范围。凡根据本发明精神实质所做的等效变换或修饰,都应涵盖在本发明的保护范围之内。

Claims (8)

1.一种电机驱动单连杆机械臂的自适应控制方法,其特征在于,包括以下步骤:
步骤1:利用欧拉-拉格朗日动力学模型描述机器人单连杆机械臂的动力学方程,根据动力学方程得到具有非匹配干扰的不确定纯反馈非线性系统的状态方程;
步骤2:设计有限时间性能函数来约束跟踪误差变量进而实现系统的跟踪控制满足规定性能的控制目标;
步骤3:结合模糊逻辑系统的万能逼近原理、动态面控制和非线性干扰观测器的Backstepping方法来设计虚拟控制、实际输入、自适应更新律、非线性干扰观测器来满足控制目标;
步骤4:构造合适的Lyapunov函数V,验证所设计的有限时间预定性能模糊自适应控制方法能否在有限时间内使得闭环系统稳定;具体过程为:对V函数进行求导并且代入步骤3所设计的虚拟控制、实际输入、自适应更新律和非线性干扰观测器,计算
Figure FDA0004105865920000011
的导数,验证其是否满足有限时间稳定性判据
Figure FDA0004105865920000012
若满足,则所设计的控制器能够实现系统的有限时间收敛,若不满足,需要调整设计的虚拟控制、实际控制输入、模糊自适应更新律和非线性干扰观测器,直至不等式
Figure FDA0004105865920000013
成立;
步骤5:依据Lyapunov稳定性理论来对上述方法进行稳定性分析,证明该自适应控制方法能保证所有闭环系统变量在有限时间内稳定,同时跟踪误差能在规定时间内满足预先设定的性能指标。
2.根据权利要求1所述的电机驱动单连杆机械臂的自适应控制方法,其特征在于,所述步骤1中,具有非匹配干扰的不确定纯反馈非线性系统的状态方程由下式表示:
Figure FDA0004105865920000014
其中,
Figure FDA0004105865920000015
u∈R,y∈R分别为系统的状态向量、控制输入与控制输出,
Figure FDA0004105865920000016
为未知光滑连续函数,
Figure FDA0004105865920000017
为已知光滑函数且满足gi,s≤|gi|≤gi,m,gi,s和gi,m是已知常数,di(t)∈R代表未知外部扰动,i=1,2,...,n。
3.根据权利要求2所述的电机驱动单连杆机械臂的自适应控制方法,其特征在于,所述步骤2中,构建的有限时间性能函数为:
Figure FDA0004105865920000021
其中,l,
Figure FDA0004105865920000022
是正参数,初始值为
Figure FDA0004105865920000023
系统的收敛时间表示为
Figure FDA0004105865920000024
4.根据权利要求3所述的电机驱动单连杆机械臂的自适应控制方法,其特征在于,所述步骤2中得到的新的误差变量具体如下:
根据有限时间性能函数和跟踪误差λ1=y-yd,yd为参考轨迹,新的误差变量
Figure FDA0004105865920000025
被设计为如下形式:
Figure FDA0004105865920000026
由上式可以知道
Figure FDA0004105865920000027
利用arctan函数和有限时间性能函数的性质得到跟踪误差预定义的性能指标-ρ(t)<λ1(t)<ρ(t)。
5.根据权利要求4所述的电机驱动单连杆机械臂的自适应控制方法,其特征在于,所述步骤3中具体包括:
1)控制目标包括:
目标1:所研究的控制器在外部干扰下使系统输出y在有限时间内遵循参考轨迹yd
目标2:闭环系统是半全局实际有限时间稳定;
目标3:稳态跟踪误差和收敛时间满足预定义的性能指标;
2)设计的变量表示为:
Figure FDA0004105865920000028
ei=xii,
ηi=ψii,
Figure FDA0004105865920000029
其中,ei代表误差变量,ψi和αi分别为滤波器的输出和输入,
Figure FDA00041058659200000210
表示模糊逻辑系统的权值向量,
Figure FDA00041058659200000211
是其估计值,
Figure FDA00041058659200000212
则代表模糊逻辑系统权值的估计误差。
6.根据权利要求5所述的电机驱动单连杆机械臂的有限时间预定性能模糊自适应控制方法,其特征在于,所述步骤3中,满足控制目标的虚拟控制、实际输入和自适应更新律包括:
Figure FDA0004105865920000031
Figure FDA0004105865920000032
Figure FDA0004105865920000033
Figure FDA0004105865920000034
Figure FDA0004105865920000035
Figure FDA0004105865920000036
其中,ki,1,ki,a表示设计参数,
Figure FDA0004105865920000037
φi为模糊逻辑系统基函数;
Figure FDA0004105865920000038
是复合干扰的估计值并且由非线性干扰观测器输出。
7.根据权利要求6所述的电机驱动单连杆机械臂的有限时间预定性能模糊自适应控制方法,其特征在于,所述步骤4具体包括以下步骤:
步骤41:根据具有非匹配干扰的不确定纯反馈非线性系统的状态方程和
Figure FDA0004105865920000039
对误差变量e1进行求导,计算得到:
Figure FDA00041058659200000310
使用模糊逻辑系统去估计未知非线性函数f1,表示为
Figure FDA00041058659200000311
其中,
Figure FDA00041058659200000312
表示估计值与实际值之间的误差且满足
Figure FDA00041058659200000313
q1,m>0,因此,式(1)可重新写为:
Figure FDA00041058659200000314
其中,
Figure FDA00041058659200000315
是复合干扰且假设其满足|D1|<d1,1,
Figure FDA00041058659200000316
d1,1,d1,m是正设计参数;
设计非线性干扰观测器,用于估计未知复合干扰D1,其形式为:
Figure FDA00041058659200000317
定义
Figure FDA0004105865920000041
并且根据式(3),对
Figure FDA0004105865920000042
进行求导,得到:
Figure FDA0004105865920000043
根据虚拟控制和自适应更新律,采用一个时间常数为γ2的一阶滤波器,虚拟控制α2通过滤波器之后可得新的变量ψ2,即:
Figure FDA0004105865920000044
其中,γ2>0;
定义η2=ψ22并且对其取关于时间的导数,得到:
Figure FDA0004105865920000045
其中,
Figure FDA0004105865920000046
是一个连续的函数且满足|ε2|≤p2,p2>0是一个标量,ε2(·)表示为下式:
Figure FDA0004105865920000047
考虑下面的正定Lyapunov函数为
Figure FDA0004105865920000048
对V1求关于时间的导数,可得:
Figure FDA0004105865920000051
根据Young不等式,可以得到:
Figure FDA0004105865920000052
Figure FDA0004105865920000053
Figure FDA0004105865920000054
Figure FDA0004105865920000055
Figure FDA0004105865920000056
Figure FDA0004105865920000057
除此之外,有
Figure FDA0004105865920000061
将式(10)和式(11)代入式(9)中去,进行放缩,得到:
Figure FDA0004105865920000062
步骤42:对Vi求关于时间导数,计算得到
Figure FDA0004105865920000063
表示为:
Figure FDA0004105865920000064
步骤43:对Vn求关于时间导数,计算得到
Figure FDA0004105865920000065
表示为:
Figure FDA0004105865920000066
8.根据权利要求7所述的电机驱动单连杆机械臂的有限时间预定性能模糊自适应控制方法,其特征在于,所述步骤5的分析验证过程包括:
整合闭环系统的Lyapunov函数为如下形式:
Figure FDA0004105865920000067
对V求关于时间的导数并且整合计算,可得:
Figure FDA0004105865920000068
定义:
Figure FDA0004105865920000071
因此,式(16)可以转化为:
Figure FDA0004105865920000072
根据以下不等式
Figure FDA0004105865920000073
将式(19)代入到式(18)中,得到:
Figure FDA0004105865920000074
定义:
Figure FDA0004105865920000075
易得:
Figure FDA0004105865920000081
计算化简式(22),可以得到对所有的t≥Ts时,
Figure FDA0004105865920000082
成立,其中,c是一个常数且满足0<c≤1,得到的收敛时间Ts用下式表示:
Figure FDA0004105865920000083
闭环系统的所有信号e1,...,en,
Figure FDA0004105865920000084
η1,...,ηn都是半全局实际有限时间稳定的,跟踪误差停留在由有限时间性能函数ρ预定义的规定区域内,根据有限时间性能函数的定义可知,跟踪误差e1在预定义的时间内收敛到预定义的跟踪误差
Figure FDA0004105865920000085
里面;通过上述的分析,证实了基于复合干扰观测器的非线性系统预定性能有限时间模糊自适应动态面控制策略达到了目标。
CN202310192069.8A 2023-03-02 2023-03-02 一种电机驱动单连杆机械臂的自适应控制方法 Active CN116079741B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310192069.8A CN116079741B (zh) 2023-03-02 2023-03-02 一种电机驱动单连杆机械臂的自适应控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310192069.8A CN116079741B (zh) 2023-03-02 2023-03-02 一种电机驱动单连杆机械臂的自适应控制方法

Publications (2)

Publication Number Publication Date
CN116079741A true CN116079741A (zh) 2023-05-09
CN116079741B CN116079741B (zh) 2023-12-01

Family

ID=86187024

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310192069.8A Active CN116079741B (zh) 2023-03-02 2023-03-02 一种电机驱动单连杆机械臂的自适应控制方法

Country Status (1)

Country Link
CN (1) CN116079741B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117359645A (zh) * 2023-12-04 2024-01-09 青岛理工大学 一种单连杆机械臂的自适应预定义时间控制方法

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112276954A (zh) * 2020-10-29 2021-01-29 青岛大学 基于有限时间输出状态受限的多关节机械臂阻抗控制方法
CN113814983A (zh) * 2021-10-18 2021-12-21 广东工业大学 一种多单臂机械手系统控制方法及系统
GB2597380A (en) * 2021-05-13 2022-01-26 Univ Guizhou Adaptive event-triggered control method for permanent magnet synchronous generator coupled chaotic network system
CN114509949A (zh) * 2022-02-21 2022-05-17 淮阴工学院 一种机器人预定性能的控制方法
CN114839880A (zh) * 2022-06-02 2022-08-02 淮阴工学院 一种基于柔性关节机械臂的自适应控制方法
US20220281123A1 (en) * 2021-03-02 2022-09-08 The Regents Of The University Of California Soft-rigid robotic joints controlled by deep reinforcement-learning
WO2022219314A2 (en) * 2021-04-14 2022-10-20 Precision Robotics Limited An apparatus, computer-implemented method and computer program
CN115720061A (zh) * 2022-11-28 2023-02-28 苏州科技大学 基于有限时间的机电伺服系统模糊自适应反步控制方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112276954A (zh) * 2020-10-29 2021-01-29 青岛大学 基于有限时间输出状态受限的多关节机械臂阻抗控制方法
US20220281123A1 (en) * 2021-03-02 2022-09-08 The Regents Of The University Of California Soft-rigid robotic joints controlled by deep reinforcement-learning
WO2022219314A2 (en) * 2021-04-14 2022-10-20 Precision Robotics Limited An apparatus, computer-implemented method and computer program
GB2597380A (en) * 2021-05-13 2022-01-26 Univ Guizhou Adaptive event-triggered control method for permanent magnet synchronous generator coupled chaotic network system
CN113814983A (zh) * 2021-10-18 2021-12-21 广东工业大学 一种多单臂机械手系统控制方法及系统
CN114509949A (zh) * 2022-02-21 2022-05-17 淮阴工学院 一种机器人预定性能的控制方法
CN114839880A (zh) * 2022-06-02 2022-08-02 淮阴工学院 一种基于柔性关节机械臂的自适应控制方法
CN115720061A (zh) * 2022-11-28 2023-02-28 苏州科技大学 基于有限时间的机电伺服系统模糊自适应反步控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
周红标等: "基于自适应模糊神经网络的非线性系统模型预测控制", 化工学报, vol. 71, no. 7, pages 3201 - 3212 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117359645A (zh) * 2023-12-04 2024-01-09 青岛理工大学 一种单连杆机械臂的自适应预定义时间控制方法
CN117359645B (zh) * 2023-12-04 2024-02-23 青岛理工大学 一种单连杆机械臂的自适应预定义时间控制方法

Also Published As

Publication number Publication date
CN116079741B (zh) 2023-12-01

Similar Documents

Publication Publication Date Title
CN109465825B (zh) 机械臂柔性关节的rbf神经网络自适应动态面控制方法
CN110877333B (zh) 一种柔性关节机械臂控制方法
CN108527372B (zh) 一种变刚度串联弹性驱动器的机器人关节自适应控制方法
CN112817231B (zh) 一种具有强鲁棒性的机械臂高精度跟踪控制方法
CN113183154B (zh) 一种柔性关节机械臂的自适应反演控制方法
CN112987567B (zh) 非线性系统的固定时间自适应神经网络滑模控制方法
CN111596545A (zh) 一种多输入多输出机械系统自适应容错预设性能控制方法
CN111142404A (zh) 一种基于压电陶瓷驱动的微定位平台及其建模与控制方法
CN115157238B (zh) 一种多自由度机器人动力学建模和轨迹跟踪方法
CN116079741B (zh) 一种电机驱动单连杆机械臂的自适应控制方法
CN114509949A (zh) 一种机器人预定性能的控制方法
CN111716360A (zh) 一种基于模糊逻辑的柔性关节机械臂采样控制方法及装置
CN110362110A (zh) 一种固定时自适应神经网络无人机航迹角控制方法
CN114578697B (zh) 一种电机驱动机械手的多约束自适应控制方法
Zhou et al. Trajectory tracking control for electro-optical tracking system using ESO based fractional-order sliding mode control
CN116991068A (zh) 基于分布式预设时间梯度下降法的电机控制方法及系统
CN115981162A (zh) 一种基于新型扰动观测器的机器人系统滑模控制轨迹跟踪方法
CN117193001B (zh) 一种基于积分强化学习的双曲趋近律滑模控制方法
CN113377006A (zh) 一种基于不变流形观测器的全局快速终端滑模控制方法
CN109884881A (zh) 一种基于非线性pid控制技术的稳瞄伺服控制器的设计
CN112936277A (zh) 一种水下机器人-机械手系统固定时间轨迹跟踪方法
Huber et al. Online trajectory optimization for nonlinear systems by the concept of a model control loop—Applied to the reaction wheel pendulum
CN116068901A (zh) 一种基于自适应有限时间扰动观测器的柔性连杆机械臂控制方法
CN110389525A (zh) 基于极限学习机的混联机构自适应反步控制方法
CN114147713B (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
TR01 Transfer of patent right

Effective date of registration: 20240621

Address after: 230000 b-1018, Woye Garden commercial office building, 81 Ganquan Road, Shushan District, Hefei City, Anhui Province

Patentee after: HEFEI WISDOM DRAGON MACHINERY DESIGN Co.,Ltd.

Country or region after: China

Address before: 223400 8th floor, Anton building, 10 Haian Road, Lianshui, Huaian, Jiangsu

Patentee before: HUAIYIN INSTITUTE OF TECHNOLOGY

Country or region before: China