CN116000919B - 一种带死区的单连杆机械臂系统的全状态约束控制方法 - Google Patents
一种带死区的单连杆机械臂系统的全状态约束控制方法 Download PDFInfo
- Publication number
- CN116000919B CN116000919B CN202211571203.7A CN202211571203A CN116000919B CN 116000919 B CN116000919 B CN 116000919B CN 202211571203 A CN202211571203 A CN 202211571203A CN 116000919 B CN116000919 B CN 116000919B
- Authority
- CN
- China
- Prior art keywords
- neural network
- mechanical arm
- error
- unknown
- adaptive
- 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 26
- 230000003044 adaptive effect Effects 0.000 claims abstract description 46
- 238000013461 design Methods 0.000 claims abstract description 34
- 238000013178 mathematical model Methods 0.000 claims abstract description 26
- 230000007246 mechanism Effects 0.000 claims abstract description 25
- 238000004891 communication Methods 0.000 claims abstract description 14
- 230000004888 barrier function Effects 0.000 claims abstract description 7
- 238000013528 artificial neural network Methods 0.000 claims description 68
- 238000005516 engineering process Methods 0.000 claims description 9
- 230000001133 acceleration Effects 0.000 claims description 8
- 238000006243 chemical reaction Methods 0.000 claims description 8
- 238000013016 damping Methods 0.000 claims description 5
- 230000001960 triggered effect Effects 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 4
- 239000011159 matrix material Substances 0.000 claims description 4
- 238000005259 measurement Methods 0.000 claims description 4
- 230000009466 transformation Effects 0.000 claims description 4
- 238000012545 processing Methods 0.000 claims description 3
- 101100001678 Emericella variicolor andM gene Proteins 0.000 claims 3
- 238000004088 simulation Methods 0.000 description 11
- 238000010586 diagram Methods 0.000 description 6
- 230000005484 gravity Effects 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- 238000010422 painting Methods 0.000 description 2
- 238000003466 welding Methods 0.000 description 2
- 101001121408 Homo sapiens L-amino-acid oxidase Proteins 0.000 description 1
- 102100026388 L-amino-acid oxidase Human genes 0.000 description 1
- 101100012902 Saccharomyces cerevisiae (strain ATCC 204508 / S288c) FIG2 gene Proteins 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000009776 industrial production Methods 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
- 238000012360 testing method Methods 0.000 description 1
Classifications
-
- 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
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明提供了一种带死区的单连杆机械臂系统的全状态约束控制方法,该方法包括以下步骤:S1、对单连杆机械臂系统进行建模,得到单连杆机械臂系统的数学模型;S2、根据单连杆机械臂的结构特性,将得到的单连杆机械臂系统的数学模型转换成状态方程;S3、根据单连杆机械臂系统的系统误差,设计第一虚拟控制律α1、和第一自适应律S4、设计单连杆机械臂系统相对阈值事件触发机制;S5、设计第二虚拟律α2、第二自适应律和在线估计未知系统参数本发明设计自适应事件触发机制对输入死区进行动态补偿,以减少通信资源的占用,并利用障碍李雅普诺夫函数保证系统所有状态不违反预定义的约束区间。
Description
技术领域
本发明属于机械臂技术领域,特别涉及一种带死区的单连杆机械臂系统的全状态约束控制方法。
背景技术
随着机械臂应用范围不断扩大,研究出来的机械臂在不同领域中发挥着重要作用。例如,在焊接喷漆领域,焊接机器人和喷漆机器人已经得到了成功应用。同时机械臂的控制性能和控制精度要求也在不断地应用和改进中得到提高。在许多实际工业生产控制系统中,机械臂执行机构普遍存在输入死区、全状态约束等不可忽视的问题,其对系统的性能造成较大的影响,甚至会导致系统不稳定。而且,实际网络控制系统的通信资源是有限的。
现有技术方案存在的缺点:(1)与快速有限时间控制方法相比,现有的有限时间控制方法的缺点是系统状态收敛的速度慢,跟踪精度较差。(2)现有的处理输入死区和全状态约束的技术方案未考虑系统的通讯资源是有限的,需要占用大量的通讯资源来补偿输入死区。
综上所述,研究如何减少系统通讯资源占用的问题在理论和实践中都具有重要意义。
发明内容
有鉴于现有技术的上述缺陷,本发明的目的在于提供一种带死区的单连杆机械臂系统的全状态约束控制方法,用来解决上述背景技术提出的问题。
本发明提供一种带死区的单连杆机械臂系统的全状态约束控制方法,其特征在于,包括以下步骤:
S1、对单连杆机械臂系统进行建模,得到单连杆机械臂系统的数学模型;
S2、根据单连杆机械臂的结构特性,将得到的单连杆机械臂系统的数学模型转换成状态方程;
S3、根据单连杆机械臂系统的系统误差,设计第一虚拟控制律α1、和第一自适应律
S4、设计单连杆机械臂系统相对阈值事件触发机制;
S5、设计第二虚拟律α2、第二自适应律和在线估计未知系统参数
所述S1中,单连杆机械臂系统的数学模型如下:
其中,J是转动惯量,B是摩擦阻尼系数,m是连杆质量,g是重力加速度,l是连杆长度,u(t)是输入转矩,q(t)是关节角,是关节角速度,是关节角加速度,t表示时刻。
所述S2中,由于机械的结构特性,考虑输入死区的数学模型如下:
D(u)=cu+d (21)
其中,u表示控制输入;c1、c2、d1和d2均为常数,且c1>0和c2>0分别表示所建数学模型形成的曲线在负半轴和正半轴上的未知斜率、d1<0和d2>0,d1和d2均表示未知的转折点。
所述S2中,对单连杆机械臂系统的数学模型(1)进行坐标变换可得到:
其中,x1=q(t),x1和x2均表示系统状态;表示x1的导数;表示x2的导数;y表示系统输出;表示系统不确定部分。
根据自适应反步控制技术,设计了一种快速收敛的自适应神经网络事件触发机制的跟踪控制器,对于神经网络研究:
在紧集Ω∈Rn上定义的任何连续函数φ(X)都可以由神经网络逼近,表达为:
其中,为理想未知权重向量,且m为正整数;表示的转置;为基函数向量,且m为正整数;X表示输入向量,且X=[x1,x2,...,xm]T∈Rm,m为正整数;m为神经网络的节点数,且m>1;f(X)为逼近误差,且满足|f(X)|<μ,μ为大于零的常数;Ri(X)的定义如下:
其中,i=1,2,...,m;(X-νi)T表示(X-νi)的转置;νi和ψi分别为高斯函数Ri(X)的中心和宽度。
所述S3中,单连杆机械臂的系统误差为:
其中,ξ1为跟踪误差,ξ2是虚拟控制误差,α1是第一虚拟控制律,ym为期望信号;
引入一个未知的正参数来估计未知组合部分其中||·||表示二范数;表示ym的一阶导数;X1表示输入向量,且参数θ1通过估计,为参数θ1的估计值,最终估计误差定义为因此,利用神经网络逼近处理φ1(X1)的表达式如下:
其中,为神经网络的理想未知权重向量,且m为正整数;表示的转置;为神经网络的基函数向量,且m为正整数;m为神经网络的节点数,且m>1;f1(X1)表示神经网络的逼近误差,满足|f1(X1)|<μ1,且μ1是大于零的常数。
所述S3中,第一虚拟控制律α1、和第一自适应律设计如下:
其中,表示的转置,J、τ1、h、z1、s1、a1、r1和σ1均为常数,且0<J<1,τ1>0,z1>0,s1>0,a1>0,r1>0,σ1>0;表示转换误差,且o1为大于零的第一设计参数。
所述S4中,对实际控制输入u(t)进行设计,借助相对阈值事件触发机制来减轻系统的通信负担,事件触发机制设计如下:
其中η、ε、λ、均为正的设计参数,且满足η>0、ε>0、0<λ<1、k为整数。inf{·}表示下确界;tk为第k个触发时刻;tk+1为第k+1个触发时刻,且tk>0,tk+1>0,k∈Z+;表示事件触发控制输入;e(t)表示测量误差,且 表示中间控制律;表示转换误差,且o2为大于零的第二设计参数。
所述S5中,引入一个未知的正参数来估计未知组合部分φ2,其中,||·||表示二范数,X2表示输入向量,且参数θ2通过估计,为参数θ2的估计量,最终估计误差定义为因此,利用神经网络逼近处理φ2(X2)的表达式如下:
其中,为神经网络的理想未知权值向量,且m为正整数;表示的转置;为神经网络的基函数向量,且m为正整数;m为神经网络的节点数,且m>1;f2(X2)表示神经网络的逼近误差,满足|f2(X2)|<μ2,且μ2为大于零的常数。
所述S5中,根据第二误差变量ξ2及利用神经网络逼近处理未知不确定部分,通过反步控制技术以及障碍李雅普诺夫函数构造第二虚拟控制律α2,同时生成自适应参数和并根据自适应参数设计自适应律;
其中,第二虚拟控制律α2,中间控制律和自适应参数满足如下计算式:
Ω=[α2,1]T (36)
表示的转置,J、τ2、h、z2、s2、a2、r2、σ2与ζ均为常数,且0<J<1,τ2>0,z2>0,s2>0,a2>0,r2>0,σ2>0,ζ>0;表示的转置,Ω为1*2矩阵;在实际应用中,由于参数难以获取数值,这不易于控制器的设计。为克服上述问题,引入估计参数来估计 表示估计误差,且其中和的估计值分别为和
本发明考虑单连杆机械臂系统中普遍存在输入死区和全状态约束的工况,设计了自适应事件触发机制。实现输入死区动态补偿的同时减少通信资源占用,并引入障碍李雅普诺夫函数保证系统状态不违反预定义的约束区间,在实际工程更具有广泛性。
基于快速有限时间稳定理论,未知增益函数以及非线性特征,提出了快速有限时间自适应神经网络控制方法,利用神经网络逼近处理未知非线性函数,并构造了具有分数指数幂的自适应律,使单连杆机械臂系统满足快速有限时间稳定定理的条件的同时,能够保证闭环系统具有更快的收敛速度和更高的跟踪精度。
附图说明
图1是本发明一种带死区的单连杆机械臂系统的全状态约束控制方法较佳实施例的示意图。
图2是本发明的期望信号ym和系统输出y的轨迹的仿真结果示意图。
图3是本发明的状态x2和约束边界的仿真结果示意图。
图4是本发明一种带死区的单连杆机械臂系统的全状态约束控制方法的跟踪误差ξ1仿真结果示意图。
图5是本发明一种带死区的单连杆机械臂系统的全状态约束控制方法的控制信号仿真结果示意图。
图6是本发明一种带死区的单连杆机械臂系统的全状态约束控制方法的事件触发时间间隔仿真结果示意图。
具体实施方式
下面对本发明的实施例作详细说明,下述的实施例在以本发明技术方案为前提下进行实施,给出了详细的实施方式和具体的操作过程,但本发明的保护范围不限于下述的实施例。
本发明提供一种带死区的单连杆机械臂系统的全状态约束控制方法,其特征在于,包括以下步骤:
S1、对单连杆机械臂系统进行建模,得到单连杆机械臂系统的数学模型;
S2、根据单连杆机械臂的结构特性,将得到的单连杆机械臂系统的数学模型转换成状态方程;
S3、根据单连杆机械臂系统的系统误差,设计第一虚拟控制律α1、和第一自适应律
S4、设计单连杆机械臂系统相对阈值事件触发机制;
S5、设计第二虚拟律α2、第二自适应律和在线估计未知系统参数
所述S1中,单连杆机械臂系统的数学模型如下:
其中,J是转动惯量,B是摩擦阻尼系数,m是连杆质量,g是重力加速度,l是连杆长度,u(t)是输入转矩,q(t)是关节角,是关节角速度,是关节角加速度,t表示时刻。
所述S2中,由于机械的结构特性,考虑输入死区的数学模型如下:
D(u)=cu+d (40)
其中,u表示控制输入;c1、c2、d1和d2均为常数,且c1>0和c2>0分别表示所建数学模型形成的曲线在负半轴和正半轴上的未知斜率、d1<0和d2>0,d1和d2均表示未知的转折点。
所述S2中,对单连杆机械臂系统的数学模型(1)进行坐标变换可得到:
其中,x1=q(t),x1和x2均表示系统状态;表示x1的导数;表示x2的导数;y表示系统输出;表示系统不确定部分。
根据自适应反步控制技术,设计了一种快速收敛的自适应神经网络事件触发机制的跟踪控制器,对于神经网络研究:
在紧集Ω∈Rn上定义的任何连续函数φ(X)都可以由神经网络逼近,表达为:
其中,为理想未知权重向量,且m为正整数;表示的转置;为基函数向量,且m为正整数;X表示输入向量,且X=[x1,x2,...,xm]T∈Rm,m为正整数;m为神经网络的节点数,且m>1;f(X)为逼近误差,且满足|f(X)|<μ,μ为大于零的常数;Ri(X)的定义如下:
其中,i=1,2,...,m;(X-νi)T表示(X-νi)的转置;νi和ψi分别为高斯函数Ri(X)的中心和宽度。
所述S3中,单连杆机械臂的系统误差为:
其中,ξ1为跟踪误差,ξ2是虚拟控制误差,α1是第一虚拟控制律,ym为期望信号;
引入一个未知的正参数来估计未知组合部分其中||·||表示二范数;表示ym的一阶导数;X1表示输入向量,且参数θ1通过估计,为参数θ1的估计值,最终估计误差定义为因此,利用神经网络逼近处理φ1(X1)的表达式如下:
其中,为神经网络的理想未知权重向量,且m为正整数;表示的转置;为神经网络的基函数向量,且m为正整数;m为神经网络的节点数,且m>1;f1(X1)表示神经网络的逼近误差,满足|f1(X1)|<μ1,且μ1是大于零的常数。
所述S3中,第一虚拟控制律α1、和第一自适应律设计如下:
其中,表示的转置,J、τ1、h、z1、s1、a1、r1和σ1均为常数,且0<J<1,τ1>0,z1>0,s1>0,a1>0,r1>0,σ1>0;表示转换误差,且o1为大于零的第一设计参数。
所述S4中,对实际控制输入u(t)进行设计,借助相对阈值事件触发机制来减轻系统的通信负担,事件触发机制设计如下:
其中η、ε、λ、均为正的设计参数,且满足η>0、ε>0、0<λ<1、k为整数。inf{·}表示下确界;tk为第k个触发时刻;tk+1为第k+1个触发时刻,且tk>0,tk+1>0,k∈Z+;表示事件触发控制输入;e(t)表示测量误差,且 表示中间控制律;表示转换误差,且o2为大于零的第二设计参数。
所述S5中,引入一个未知的正参数来估计未知组合部分φ2,其中,||·||表示二范数,X2表示输入向量,且参数θ2通过估计,为参数θ2的估计量,最终估计误差定义为因此,利用神经网络逼近处理φ2(X2)的表达式如下:
其中,为神经网络的理想未知权值向量,且m为正整数;表示的转置;为神经网络的基函数向量,且m为正整数;m为神经网络的节点数,且m>1;f2(X2)表示神经网络的逼近误差,满足|f2(X2)|<μ2,且μ2为大于零的常数。
所述S5中,根据第二误差变量ξ2及利用神经网络逼近处理未知不确定部分,通过反步控制技术以及障碍李雅普诺夫函数构造第二虚拟控制律α2,同时生成自适应参数和并根据自适应参数设计自适应律;
其中,第二虚拟控制律α2,中间控制律和自适应参数满足如下计算式:
Ω=[α2,1]T (55)
表示的转置,J、τ2、h、z2、s2、a2、r2、σ2与ζ均为常数,且0<J<1,τ2>0,z2>0,s2>0,a2>0,r2>0,σ2>0,ζ>0;表示的转置,Ω为1*2矩阵;在实际应用中,由于参数难以获取数值,这不易于控制器的设计。为克服上述问题,引入估计参数来估计 表示估计误差,且其中和的估计值分别为和
本发明提供一种带死区的单连杆机械臂系统的全状态约束控制方法:
首先,将输入死区模型化,建立带输入死区和全状态约束的单连杆机械臂系统模型;
再者,基于自适应反步控制技术,神经网络以及快速有限时间稳定理论,设计了一种快速收敛的自适应神经网络事件触发机制的跟踪控制器;
最后,对所提的上述方法进行仿真。
使得得出的仿真结果表明,所设计的控制器使系统在输入死区和全状态约束的情况下,能够快速地跟踪给定的期望信号且系统所有状态保持在约束区间内,具有良好的控制精度,且减少通信资源的占用。
本发明提供一种带死区的单连杆机械臂系统的全状态约束控制方法,包括以下步骤:
S1、对单连杆机械臂系统进行建模,得到单连杆机械臂系统的数学模型。
单连杆机械臂系统的数学模型如下:
其中,J是转动惯量,B是摩擦阻尼系数,m是连杆质量,g是重力加速度,l是连杆长度,u(t)是输入转矩,q(t)是关节角,是关节角速度,是关节角加速度,t表示时刻。
S2、根据单连杆机械臂的结构特性,将得到的单连杆机械臂系统的数学模型转换成状态方程。
由于机械的结构特性,考虑输入死区的数学模型如下:
D(u)=cu+d (59)
其中,u表示控制输入;c1、c2、d1和d2均为常数,且c1>0和c2>0分别表示所建数学模型形成的曲线在负半轴和正半轴上的未知斜率、d1<0和d2>0,d1和d2均表示未知的转折点。
对单连杆机械臂系统的数学模型(1)进行坐标变换可得到:
其中,x1=q(t),x1和x2均表示系统状态;表示x1的导数;表示x2的导数;y表示系统输出;表示系统不确定部分。
根据自适应反步控制技术,设计了一种快速收敛的自适应神经网络事件触发机制的跟踪控制器,对于神经网络研究:
在紧集Ω∈Rn上定义的任何连续函数φ(X)都可以由神经网络逼近,表达为:
其中,为理想未知权重向量,且m为正整数;表示的转置;为基函数向量,且m为正整数;X表示输入向量,且X=[x1,x2,...,xm]T∈Rm,m为正整数;m为神经网络的节点数,且m>1;f(X)为逼近误差,且满足|f(X)|<μ,μ为大于零的常数;Ri(X)的定义如下:
其中,i=1,2,...,m;(X-νi)T表示(X-νi)的转置;νi和ψi分别为高斯函数Ri(X)的中心和宽度。
S3、根据单连杆机械臂系统的系统误差,设计第一虚拟控制律α1、和第一自适应律
单连杆机械臂的系统误差为:
其中,ξ1为跟踪误差,ξ2是虚拟控制误差,α1是第一虚拟控制律,ym为期望信号;
引入一个未知的正参数来估计未知组合部分其中||·||表示二范数;表示ym的一阶导数;X1表示输入向量,且参数θ1通过估计,为参数θ1的估计值,最终估计误差定义为因此,利用神经网络逼近处理φ1(X1)的表达式如下:
其中,为神经网络的理想未知权重向量,且m为正整数;表示的转置;为神经网络的基函数向量,且m为正整数;m为神经网络的节点数,且m>1;f1(X1)表示神经网络的逼近误差,满足|f1(X1)|<μ1,且μ1是大于零的常数。
所述S3中,第一虚拟控制律α1、和第一自适应律设计如下:
其中,表示的转置,J、τ1、h、z1、s1、a1、r1和σ1均为常数,且0<J<1,τ1>0,z1>0,s1>0,a1>0,r1>0,σ1>0;表示转换误差,且o1为大于零的第一设计参数。
S4、设计单连杆机械臂系统相对阈值事件触发机制。
设计系统相对阈值事件触发机制:
将对实际控制输入u(t)进行设计。借助相对阈值事件触发机制来减轻系统的通信负担。事件触发机制设计如下:
其中η、ε、λ、均为正的设计参数,且满足η>0、ε>0、0<λ<1、k为整数。inf{·}表示下确界;tk为第k个触发时刻;tk+1为第k+1个触发时刻,且tk>0,tk+1>0,k∈Z+;表示事件触发控制输入;e(t)表示测量误差,且 表示中间控制律;表示转换误差,且o2为大于零的第二设计参数。
由于系统模型存在不确定部分,通过神经网络逼近二阶非线性系统模型的不确定部分,得到误差值,然后根据误差值设计虚拟控制律,并确定自适应参数。
S5、设计第二虚拟律α2、第二自适应律和在线估计未知系统参数
具体地,引入一个未知的正参数来估计未知组合部分φ2,其中,||·||表示二范数,X2表示输入向量,且参数θ2通过估计,为参数θ2的估计量,最终估计误差定义为因此,利用神经网络逼近处理φ2(X2)的表达式如下:
其中,为神经网络的理想未知权值向量,且m为正整数;表示的转置;为神经网络的基函数向量,且m为正整数;m为神经网络的节点数,且m>1;f2(X2)表示神经网络的逼近误差,满足|f2(X2)|<μ2,且μ2为大于零的常数。
根据第二误差变量ξ2及利用神经网络逼近处理未知不确定部分,通过反步控制技术以及障碍李雅普诺夫函数构造第二虚拟控制律α2,同时生成自适应参数和并根据自适应参数设计自适应律;
其中,第二虚拟控制律α2,中间控制律和自适应参数满足如下计算式:
Ω=[α2,1]T (74)
表示的转置,J、τ2、h、z2、s2、a2、r2、σ2与ζ均为常数,且0<J<1,τ2>0,z2>0,s2>0,a2>0,r2>0,σ2>0,ζ>0;表示的转置,Ω为1*2矩阵;在实际应用中,由于参数难以获取数值,这不易于控制器的设计。为克服上述问题,引入估计参数来估计 表示估计误差,且其中和的估计值分别为和
根据第二虚拟控制律α2、以及自适应参数和对该控制系统进行系统参数设计,进而对该控制系统的输出信号并进行跟踪控制。
利用仿真软件对上述设计的控制器进行验证本方案的有效性,单连杆机械臂系统在输入死区和全状态约束的影响下,能够很好地跟踪给定的期望信号并保证系统所有状态保持在约束区间,减少通信资源的占用,且所有信号全局一致最终有界,误差信号在有限时间内快速收敛于有界的紧集内;并且可以通过选择适合的参数,调整收敛速度,提高跟踪精度。
S6、利用仿真实验平台,对算法进行仿真实验。
为了验证所提方法的有效性。不失一般性,假设给定的期望信号为ym=sin(2t),系统全状态约束区间为|x1|<1.5,|x2|<3。设系统状态初始值为x1(0)=0.1,x2(0)=0;系统参数的选取:转动惯量J=0.8,摩擦阻尼系数B=1,mgl=10。
利用神经网络逼近处理不确定部分,选取的高斯函数Ri(Xi)表达如下:
其中,i=1,2,...16,高斯函数的中心νi分布区间为[-1,1]。
其余相关设计参数:z1=s1=18,z2=s2=17,o1=0.5,o2=2,a1=a2=0.5,r1=r2=1,ζ=0.5,σ1=σ2=0.3,d1=-1,c1=c2=d2=1,λ=0.02,η=0.5,ε=0.5,K=[1,0;0,1] 及其仿真步长为0.01。
仿真结果如附图2-6所示;
从图2-图6的仿真结果可知,在系统受到输入死区和全状态约束的情况下闭环系统中所有信号都是有界的。
如图2所示,系统输出信号y很好地跟踪期望信号ym。
图3展现了状态x2的曲线,观察到x2有界,结合图2发现,输出信号和状态都不违反预定义的约束区间。
由图4可知,跟踪误差ξ1在0.12s内快速收敛到有界的紧集内。
图5描绘了两条曲线,分别为事件触发控制输入和控制输入u(t),由此可见输入信号都是有界的。
图6为事件触发的时间间隔,观察到在10s内,基于事件触发机制的总触发次数为322次,与传统的时间触发机制相比,事件触发机制可以有效地节省了67.8%的通信资源,且Zeno现象不发生。
本发明考虑单连杆机械臂系统中普遍存在输入死区和全状态约束的工况,设计了自适应事件触发机制。实现输入死区动态补偿的同时减少通信资源占用,并引入障碍李雅普诺夫函数保证系统状态不违反预定义的约束区间,在实际工程更具有广泛性。
基于快速有限时间稳定理论,未知增益函数以及非线性特征,提出了快速有限时间自适应神经网络控制方法,利用神经网络逼近处理未知非线性函数,并构造了具有分数指数幂的自适应律,使单连杆机械臂系统满足快速有限时间稳定定理的条件的同时,能够保证闭环系统具有更快的收敛速度和更高的跟踪精度。
以上详细描述了本发明的较佳具体实施例。应当理解,本领域的普通技术无需创造性劳动就可以根据本发明的构思作出诸多修改和变化。因此,凡本技术领域中技术人员依本发明的构思在现有技术的基础上通过逻辑分析、推理或者有限的试验可以得到的技术方案,皆应在由权利要求书所确定的保护范围内。
Claims (2)
1.一种带死区的单连杆机械臂系统的全状态约束控制方法,其特征在于,包括以下步骤:
S1、对单连杆机械臂系统进行建模,得到单连杆机械臂系统的数学模型;
S2、根据单连杆机械臂的结构特性,将得到的单连杆机械臂系统的数学模型转换成状态方程;
S3、根据单连杆机械臂系统的系统误差,设计第一虚拟控制律α1和第一自适应律
S4、设计单连杆机械臂系统相对阈值事件触发机制;
S5、设计第二虚拟律α2、第二自适应律和在线估计未知系统参数
其中,所述S1中,单连杆机械臂系统的数学模型如下:
其中,J是转动惯量,B是摩擦阻尼系数,m是连杆质量,g是重力加速度,l是连杆长度,u(t)是输入转矩,q(t)是关节角,是关节角速度,是关节角加速度,t表示时刻;
其中,所述S2中,由于机械的结构特性,考虑输入死区的数学模型如下:
D(u)=cu+d
其中,u表示控制输入;c1、c2、d1和d2均为常数,且c1>0和c2>0分别表示所建数学模型形成的曲线在负半轴和正半轴上的未知斜率、d1<0和d2>0,d1和d2均表示未知的转折点;
特别地,所述S2中,对单连杆机械臂系统的数学模型(1)进行坐标变换可得到:
其中,x1=q(t),x1和x2均表示系统状态;表示x1的导数;表示x2的导数;y表示系统输出;表示系统不确定部分;
其中,所述S3中,单连杆机械臂的系统误差为:
其中,ξ1为跟踪误差,ξ2是虚拟控制误差,α1是第一虚拟控制律,ym为期望信号;
引入一个未知的正参数来估计未知组合部分其中||·||表示二范数;表示ym的一阶导数;X1表示输入向量,且参数θ1通过估计,为参数θ1的估计值,最终估计误差定义为因此,利用神经网络逼近处理φ1(X1)的表达式如下:
其中,为神经网络的理想未知权重向量,且m为正整数;表示的转置;为神经网络的基函数向量,且m为正整数;m为神经网络的节点数,且m>1;f1(X1)表示神经网络的逼近误差,满足|f1(X1)|<μ1,且μ1是大于零的常数;
特别地,所述S3中,第一虚拟控制律α1和第一自适应律设计如下:
其中,表示的转置,J、τ1、h、z1、s1、a1、r1和σ1均为常数,且0<J<1,τ1>0,z1>0,s1>0,a1>0,r1>0,σ1>0;表示转换误差,且o1为大于零的第一设计参数;
其中,所述S4中,对实际控制输入u(t)进行设计,借助相对阈值事件触发机制来减轻系统的通信负担,事件触发机制设计如下:
其中η、ε、λ、均为正的设计参数,且满足η>0、ε>0、0<λ<1、k为整数。inf{·}表示下确界;tk为第k个触发时刻;tk+1为第k+1个触发时刻,且tk>0,tk+1>0,k∈Z+;表示事件触发控制输入;e(t)表示测量误差,且 表示中间控制律;表示转换误差,且o2为大于零的第二设计参数;
其中,所述S5中,引入一个未知的正参数来估计未知组合部分φ2(X2),其中,||·||表示二范数,X2表示输入向量,且参数θ2通过估计,为参数θ2的估计量,最终估计误差定义为因此,利用神经网络逼近处理φ2(X2)的表达式如下:
其中,为神经网络的理想未知权值向量,且m为正整数;表示的转置;为神经网络的基函数向量,且m为正整数;m为神经网络的节点数,且m>1;f2(X2)表示神经网络的逼近误差,满足|f2(X2)|<μ2,且μ2为大于零的常数;
特别地,所述S5中,根据第二误差变量ξ2及利用神经网络逼近处理未知不确定部分,通过反步控制技术以及障碍李雅普诺夫函数构造第二虚拟控制律α2,同时生成自适应参数和并根据自适应参数设计自适应律;
其中,第二虚拟控制律α2,中间控制律和自适应参数 满足如下计算式:
Ω=[α2,1]T
表示的转置,J、τ2、h、z2、s2、a2、r2、σ2与ζ均为常数,且0<J<1,τ2>0,z2>0,s2>0,a2>0,r2>0,σ2>0,ζ>0;表示的转置,Ω为1*2矩阵;在实际应用中,由于参数难以获取数值,这不易于控制器的设计;为克服上述问题,引入估计参数来估计表示估计误差,且其中和的估计值分别为和
2.根据权利要求1所述的一种带死区的单连杆机械臂系统的全状态约束控制方法,其特征在于,根据自适应反步控制技术,设计了一种快速收敛的自适应神经网络事件触发机制的跟踪控制器,对于神经网络研究:
在紧集Ω∈Rn上定义的任何连续函数φ(X)都可以由神经网络逼近,表达为:
其中,为理想未知权重向量,且m为正整数;表示的转置;为基函数向量,且m为正整数;X表示输入向量,且X=[x1,x2,...,xm]T∈Rm,m为正整数;m为神经网络的节点数,且m>1;f(X)为逼近误差,且满足|f(X)|<μ,μ为大于零的常数;Ri(X)的定义如下:
其中,i=1,2,...,m;(X-νi)T表示(X-νi)的转置;νi和ψi分别为高斯函数Ri(X)的中心和宽度。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202211571203.7A CN116000919B (zh) | 2022-12-08 | 2022-12-08 | 一种带死区的单连杆机械臂系统的全状态约束控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202211571203.7A CN116000919B (zh) | 2022-12-08 | 2022-12-08 | 一种带死区的单连杆机械臂系统的全状态约束控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN116000919A CN116000919A (zh) | 2023-04-25 |
| CN116000919B true CN116000919B (zh) | 2024-10-18 |
Family
ID=86029099
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202211571203.7A Active CN116000919B (zh) | 2022-12-08 | 2022-12-08 | 一种带死区的单连杆机械臂系统的全状态约束控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN116000919B (zh) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117506939B (zh) * | 2024-01-04 | 2024-03-29 | 华中科技大学 | 基于状态触发自适应梯度神经网络的机械臂运动规划方法 |
| CN119795200B (zh) * | 2025-03-17 | 2025-05-23 | 苏州大学 | 基于事件触发的单连杆机械臂自适应预定义时间控制方法 |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112873207A (zh) * | 2021-01-25 | 2021-06-01 | 浙江工业大学 | 一种基于未知系统动态估计器的柔性关节机械臂预设性能控制方法 |
| CN113534666A (zh) * | 2021-07-29 | 2021-10-22 | 河南科技大学 | 多目标约束下单关节机械臂系统的轨迹跟踪控制方法 |
Family Cites Families (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4860215A (en) * | 1987-04-06 | 1989-08-22 | California Institute Of Technology | Method and apparatus for adaptive force and position control of manipulators |
| US5150026A (en) * | 1990-11-19 | 1992-09-22 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Obstacle avoidance for redundant robots using configuration control |
| JPH10133703A (ja) * | 1996-10-31 | 1998-05-22 | Fujitsu Ltd | 適応的ロバスト制御装置 |
| JP3162000B2 (ja) * | 1997-07-29 | 2001-04-25 | 晴久 川崎 | ロボット制御装置及びその方法 |
| US9327401B2 (en) * | 2012-09-10 | 2016-05-03 | Fanuc America Corporation | Method of controlling a redundant robot |
| CN114706310B (zh) * | 2022-04-14 | 2025-01-10 | 广州大学 | 一种带输入死区的单连杆式机器人固定时间稳定控制方法 |
| CN114851198B (zh) * | 2022-05-17 | 2023-05-16 | 广州大学 | 一种多单连杆式机械臂的一致跟踪固定时间稳定控制方法 |
| CN114952860B (zh) * | 2022-06-22 | 2024-11-26 | 中山大学 | 基于离散时间神经动力学的移动机器人重复运动控制方法及系统 |
| CN115431263B (zh) * | 2022-08-10 | 2025-04-04 | 中国地质大学(武汉) | 一种复杂执行器故障下多冗余机械臂系统协同控制方法 |
-
2022
- 2022-12-08 CN CN202211571203.7A patent/CN116000919B/zh active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112873207A (zh) * | 2021-01-25 | 2021-06-01 | 浙江工业大学 | 一种基于未知系统动态估计器的柔性关节机械臂预设性能控制方法 |
| CN113534666A (zh) * | 2021-07-29 | 2021-10-22 | 河南科技大学 | 多目标约束下单关节机械臂系统的轨迹跟踪控制方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN116000919A (zh) | 2023-04-25 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN114851198B (zh) | 一种多单连杆式机械臂的一致跟踪固定时间稳定控制方法 | |
| CN110275436B (zh) | 一种多单臂机械手的rbf神经网络自适应控制方法 | |
| CN111319036B (zh) | 基于自适应算法的移动机械臂位置/力自抗扰控制方法 | |
| CN110275435B (zh) | 基于观测器的多单臂机械手输出一致自适应命令滤波控制方法 | |
| CN114895564B (zh) | 一种电驱动柔性关节机械臂自适应神经网络控制器设计方法 | |
| CN114952835B (zh) | 一种基于扰动观测器的柔性关节机械臂神经网络积分滑模控制器设计方法 | |
| CN114800489B (zh) | 基于确定学习与复合学习联合的机械臂柔顺控制方法、存储介质及机器人 | |
| CN108942924B (zh) | 基于多层神经网络的模型不确定性机械臂运动控制方法 | |
| CN112276954B (zh) | 基于有限时间输出状态受限的多关节机械臂阻抗控制方法 | |
| CN110977988B (zh) | 基于有限时间命令滤波的多关节机械臂阻抗控制方法 | |
| CN115139301B (zh) | 基于拓扑结构自适应神经网络的机械臂运动规划方法 | |
| CN114942593A (zh) | 一种基于干扰观测器补偿的机械臂自适应滑模控制方法 | |
| CN112817231A (zh) | 一种具有强鲁棒性的机械臂高精度跟踪控制方法 | |
| CN116000919B (zh) | 一种带死区的单连杆机械臂系统的全状态约束控制方法 | |
| CN113814983B (zh) | 一种多单臂机械手系统控制方法及系统 | |
| CN113110059A (zh) | 基于事件触发的单连杆机械臂系统实际跟踪的控制方法 | |
| CN118357919B (zh) | 误差约束下柔性关节机械臂预设时间事件触发控制方法 | |
| CN115464639B (zh) | 一种具有输入死区约束的平面二连杆机械臂控制方法 | |
| CN114750137A (zh) | 一种基于rbf网络的上肢外骨骼机器人运动控制方法 | |
| CN115993780A (zh) | El型非线性集群系统时变编队优化跟踪控制方法及系统 | |
| CN119526389A (zh) | 一种机械臂滑模控制方法 | |
| CN111427264B (zh) | 一种复杂遥操作技术的神经自适应固定时间控制方法 | |
| CN117283566A (zh) | 一种多单臂机械手神经网络自适应脉冲控制方法及系统 | |
| CN114706310B (zh) | 一种带输入死区的单连杆式机器人固定时间稳定控制方法 | |
| CN115582838A (zh) | 基于预设性能的多机械臂预定义时间h∞一致性控制方法 |
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 |