全状态约束机械臂的快速有限时间控制器的设计方法与流程

1.本发明涉及机械臂设计技术领域，尤其涉及一种全状态约束机械臂的快速有限时间控制器的设计方法。


背景技术：

2.随着通信、计算机、网络等领域的飞速发展，机械臂的相关课题已经成为自动控制领域的一个新的研究方向。由于机械臂可以参与完成各种复杂环境下的工作，这使得机械臂在工业生产和社会生活中的地位不断提高。因此，为了更好地利用机械臂协助完成各项任务，机械臂的控制问题越来越受到研究者的关注。
3.由于机械臂系统是一个典型的非线性系统，通常此类非线性系统控制器的设计方法是首先通过反馈线性化将机械臂动力学方程化为线性方程，然后利用线性系统的技术设计控制器。但对于机械臂而言，由于反馈线性化方法在控制器设计过程中不能充分获取非线性系统的动力学特性，因此跟踪误差难以消除。为了设计控制器使机械臂精确到达指定位置或者跟踪预定的路径，许多研究者引进了微分几何的方法用于对其进行控制。针对一般的机械臂的控制问题，有些研究者提出了一种基于backstepping设计的自适应输出反馈控制器；还有些学者利用简单的pd控制和h∞控制实现了机械臂的鲁棒控制。然而，这些方法的一个共同特点是控制器一经确定，在控制过程中不能根据非线性系统的输出进行适时调整，也不能充分获取非线性系统的动力学特性，因此必然产生跟踪误差。随着非线性系统控制方法的进一步发展，滑模变结构控制作为一种典型的非线性控制方法被应用于机械臂的控制问题上。它能够使控制系统在发生变化和外部扰动的情形下仍具有很强的鲁棒性。近年来，智能控制的方法得到了进一步的发展，与传统的控制方法相比，神经网络控制以及模糊控制方法也被证明能够很好地处理不确定非线性系统，而且其具有出色的非线性拟合能力和高适应性。因此，机械臂的智能控制方法也在不断涌现，这使得机械臂的控制理论越来越成熟。
4.虽然取得了较多关于机械臂的控制成果，但是在全状态约束机械臂的自适应快速有限时间控制方面还并没有取得相关的研究成果。一方面，在实际应用中，控制系统都会受到来自各方面的约束，比如角度约束、力矩约束等；另一方面，由于工业生产的迅速发展，更高的工业生产指标以及更高的安全要求迫使快速有限时间控制成为了一个必要的考虑因素。虽然有相关研究涉及到全状态约束下机械臂的控制问题，但是并没有相关研究涉及到全状态约束下的自适应快速有限时间控制，这使得机械臂的控制性能存在着部分缺陷。首先，在控制精度方面，已有的控制方法在跟踪控制时存在着较大的跟踪误差，无法保证系统输出精确地跟踪参考信号；其次，在时间方面，已有的控制方法对机械臂的控制时间相对较长，这无法满足更高的控制要求。
5.可见，全状态约束机械臂系统的自适应快速有限时间控制研究仍然面临着众多的挑战，主要存在两个亟待解决的问题：一、对于系统的约束，如何设计满足约束条件的障碍lyapunov函数；二、如何基于未知外部扰动影响的情况下，设计快速有限时间控制器。


技术实现要素：

6.有鉴于此，本发明提供了一种全状态约束机械臂的快速有限时间控制器的设计方法。
7.本发明提供一种全状态约束机械臂的快速有限时间控制器的设计方法，包括以下步骤：
8.s1，设计观测器，具体为：建立机械臂系统动力学方程；建立机械臂系统初始状态方程；设计有限时间扰动观测器；建立机械臂系统状态方程；
9.s2，基于反步法设计机械臂控制器。
10.进一步地，步骤s1中，设计观测器的具体步骤为：
11.s1.1，建立机械臂系统动力学方程：
[0012][0013]
其中，q是角位置，是角加速度，m是转动惯量，m是连杆质量，g是重力加速度，f是作用力，l是连杆长度；
[0014]
s1.2，建立机械臂系统初始状态方程：
[0015]
定义机械臂系统状态变量、控制输入量如下：
[0016][0017]
其中，x1、x2为机械臂系统的状态变量，u为机械臂系统的控制输入量，为角速度；
[0018]
则机械臂系统动力学方程(1)表达为：
[0019][0020]
其中，d1和d2分别为外部扰动，假设外部扰动d
i
(i＝1,2)有界，且其导数均有界；φ1＝0,φ2(x1)＝
‑
0.5mglsin(x1)；
[0021]
s1.3，设计有限时间扰动观测器：
[0022][0023]
其中，v
0i
，v
1i
，v
2i
分别是中间变量，l1、l2、l3为观测系数，λ0,λ1,λ2分别是有限时间扰动观测器的参数，σ
0i
,σ
1i
,σ
2i
分别是的观测值；最终可以实现σ
1i
＝d
i
，从而可以实现对外部扰动的观测；机械臂系统会受到未知的外部扰动，这使得系统模型含有不确定项，从而影响了其控制性能，扰动观测器能够很好地观测外部扰动，能够更好地削弱外部扰动
对机械臂系统的影响，使得机械臂系统的控制性能得以提升；
[0024]
s1.4,建立机械臂系统状态方程：
[0025]
定义d
i
的观测值为则机械臂系统初始状态方程(3)表达为：
[0026][0027]
进一步地，步骤s2中，基于反步法设计机械臂控制器的具体步骤为：
[0028]
s2.1，基于障碍加幂积分技术，选取满足约束条件的lyapunov函数v1：
[0029][0030]
其中，ξ1是跟踪误差，ξ1＝x1－y
d
，y
d
是参考信号，η1(t)是对称时变约束函数，η
11
,η
12
分别表示常数，t表示时间，τ1是时间常数；lyapunov函数可以保证机械臂系统状态在整个过程中不违背约束条件；约束条件根据实际需要进行设置；
[0031]
s2.2，对lyapunov函数v1求一阶导数，并化简，选取合适的虚拟控制律α1：
[0032][0033]
其中，ι1,ι2,r2为选取的常数，r2＝δ，δ为分子和分母都是奇数的分数且1/2<δ<1；为d1的观测值；虚拟控制律α1能够使机械臂系统的状态变量x1满足快速有限时间跟踪参考信号；
[0034]
s2.3,结合以上虚拟控制律的设计，可保证lyapunov函数v1的导数其中a,b分别表示常数，a＞0,b＞0；
[0035]
s2.4，引入坐标变换：
[0036][0037]
s2.5，选取适当的lyapunov函数v2：
[0038][0039]
其中，s为函数υ(s)的自变量，η2(t)是时变约束函数，η
21
,η
22
分别表示常数，t表示时间，τ2是时间常数；
[0040]
s2.6，对lyapunov函数v2求导并化简，在设计过程中，选择模糊逻辑对未知的非线性函数进行近似估计，非线性函数的表达式为：
[0041][0042]
其中，θ＝[θ1,θ2…
,θ
n
]
t
是权重向量，s(x)＝[s1(x),s2(x),
…
s
n
(x)]
t
,且
l＝1,2,
…
,n；其中，k＝1,2,
…
,n，j＝1,2,
…
,n，n和n均为大于1的自然数，一般选择为高斯关系函数；
[0043]
s2.7，对非线性函数进行恒等变化，得到表达式：
[0044]
y(x)＝θ
*t
s(x) ε(x)
ꢀꢀ
(12)
[0045]
其中，θ
*
和ε(x)分别是理想的最优权重和该最优权重下的逼近误差；
[0046]
s2.8，利用表达式(11)和表达式(12)在设计过程中使用模糊逻辑对非线性函数进行逼近处理，从而设计出机械臂系统的控制输入量u,即模糊虚拟控制律：
[0047][0048]
其中，ι3,ι4,r3,k为选取的常数；为d2的观测值；
[0049]
s2.9，由以上模糊虚拟控制律的设计可保证lyapunov函数v2的导数其中c,d分别表示常数，c＞0,d＞0。
[0050]
本发明还提供一种机械臂系统，所述机械臂系统包括控制器，所述控制器利用上述设计方法设计获得。
[0051]
本发明提供的设计方法针对含未知扰动的全状态约束机械臂系统，基于加幂积分技术保证不违背约束条件，通过引入有限时间扰动观测器对其外部扰动进行观测补偿，采用了backstepping设计方法以及模糊逻辑对非线性项进行逼近拟合，从而设计了模糊快速有限时间控制器实现了机械臂系统对参考信号的精确跟踪，并保证了整个闭环系统的稳定。因此，本发明提供的设计方法既能够保证全状态约束机械臂系统的精确跟踪控制，还能够缩短控制时间并提高系统的响应速率。
[0052]
利用本发明提供的方法设计的控制器能够使得机械臂系统快速有限时间稳定，机械臂系统的输出能够很好地跟随给定信号的变化，该控制器很好地解决了机械臂系统在满足约束条件下的快速有限时间跟踪控制问题。
附图说明
[0053]
图1是一种全状态约束机械臂的快速有限时间控制器的设计方法的流程示意图。
[0054]
图2是本发明实施例1设计的扰动观测器的仿真图。
[0055]
图3是本发明实施例1控制器的控制律的仿真图。
[0056]
图4是本发明实施例1的机械臂系统的跟踪误差仿真图。
[0057]
图5是本发明实施例1的机械臂系统的状态仿真图。
具体实施方式
[0058]
为使本发明的目的、技术方案和优点更加清楚，下面将结合附图对本发明实施方式作进一步地描述。
[0059]
实施例1：
[0060]
请参考图1，本发明的实施例1提供了一种全状态约束机械臂的快速有限时间控制器的设计方法，包括以下步骤：
[0061]
步骤s1，设计观测器，具体为：
[0062]
s1.1，建立机械臂系统动力学方程：
[0063][0064]
其中，q是角位置，是角加速度，m是转动惯量，m是连杆质量，g是重力加速度，f是作用力，l是连杆长度；
[0065]
s1.2，建立机械臂系统初始状态方程：
[0066]
定义机械臂系统状态变量、控制输入量如下：
[0067][0068]
其中，x1、x2为机械臂系统的状态变量，u为机械臂系统的控制输入量，为角速度；
[0069]
则机械臂系统动力学方程(1)表达为：
[0070][0071]
其中，d1和d2分别为外部扰动，假设外部扰动d
i
(i＝1,2)有界，且其导数均有界；φ1＝0,φ2(x1)＝
‑
0.5mglsin(x1)；
[0072]
s1.3，设计有限时间扰动观测器：
[0073][0074]
其中，v
0i
，v
1i
，v
2i
分别是中间变量，λ0,λ1,λ2分别是有限时间扰动观测器的参数，σ
0i
,σ
1i
,σ
2i
分别是x
i
,d
i
,的观测值；l1、l2、l3为观测系数；
[0075]
s1.4,建立机械臂系统状态方程：
[0076]
定义外部扰动d
i
的观测值为则机械臂系统初始状态方程(3)表达为：
[0077][0078]
步骤s2，基于反步法设计机械臂控制器，具体为：
[0079]
s2.1，基于障碍加幂积分技术，选取满足约束条件的lyapunov函数v1：
[0080][0081]
其中，ξ1为跟踪误差，ξ1＝x1‑
y
d
，y
d
是参考信号，η1(t)是对称时变约束函数，η
11
,η
12
分别表示常数，τ1是时间常数，t表示时间；lyapunov函数可以保证机械臂系统状态在整个过程中不违背约束条件；
[0082]
s2.2，对lyapunov函数v1求一阶导数，并化简，选取合适的虚拟控制律α1：
[0083][0084]
其中，ι1,ι2,r2为选取的常数，r2＝δ，δ为分子和分母都是奇数的分数且1/2<δ<1；为d1的观测值；虚拟控制量α1能够使机械臂系统的状态x1满足快速有限时间跟踪参考信号；
[0085]
s2.3,结合以上虚拟控制律的设计，可保证lyapunov函数v1的导数其中a,b分别表示常数，a＞0,b＞0；
[0086]
s2.4，引入坐标变换：
[0087][0088]
s2.5，选取适当的lyapunov函数v2：
[0089][0090]
其中，s为函数υ(s)的自变量，η2(t)是时变约束函数，η
21
,η
22
分别表示常数，t表示时间，τ2是时间常数；
[0091]
s2.6，对lyapunov函数v2求导并化简，在设计过程中，选择模糊逻辑对未知的非线性函数进行近似估计，非线性函数的表达式为：
[0092][0093]
其中，θ＝[θ1,θ2…
,θ
n
]
t
是权重向量，s(x)＝[s1(x),s2(x),
…
s
n
(x)]
t
,且l＝1,2,
…
,n；其中，k＝1,2,
…
,n，j＝1,2,
…
,n，n和n均为大于1的自然数，一般选择为高斯关系函数；
[0094]
s2.7，对非线性函数进行恒等变化，得到表达式：
[0095]
y(x)＝θ
*t
s(x) ε(x)
ꢀꢀ
(12)
[0096]
其中，θ
*
和ε(x)分别是理想的最优权重和该最优权重下的逼近误差；
[0097]
s2.8，利用表达式(11)和表达式(12)在设计过程中使用模糊逻辑对非线性函数进行逼近处理，从而设计出机械臂系统控制输入量u，即模糊虚拟控制律：
[0098][0099]
其中，ι3,ι4,r3,k为选取的常数；为d2的观测值；
[0100]
s2.9，由以上模糊虚拟控制律的设计可保证lyapunov函数v2的导数其中c,d分别表示常数，c＞0,d＞0。
[0101]
实施例1还提供了一种机械臂系统，该机械臂系统包括利用上述设计方法设计的控制器。
[0102]
为了验证设计的控制器使机械臂系统在满足对称时变全状态约束条件下，其各状态跟随给定的参考信号y
d
＝sin(t)变化，实施例1选取以下参数m＝1kg,m＝1kg,l＝1m，d1＝sin(t),d2＝2cos(t)；δ＝77/79，lyapunov函数v1的约束条件设置为：η1(t)＝3e
‑
0.5t
0.5；lyapunov函数v2的约束条件设置为η2(t)＝3e
‑
0.5t
0.5；机械臂系统的初始状态设置为：x1(0)＝0.8,x2(0)＝0.6，有限时间扰动观测器的参数设置为：λ0＝3,λ1＝1.5,λ2＝1.1，l1＝l2＝l3＝3；模糊逻辑中的高斯关系函数选择为：k＝1,2,
…
5，其中x
i
表示输入向量；模糊虚拟控制律u和控制器的相关参数设置为：ι1＝3，ι2＝2，ι3＝5,ι4＝4，k＝3，||θ||＝1；根据设置的参数、约束条件和初始状态进行matlab仿真，扰动观测器的仿真图如图2所示，控制律u的仿真图如图3所示，从图2可以看出，有限时间扰动观测器可以很好地观测机械臂系统所受到的外部扰动。
[0103]
机械臂系统的跟踪误差仿真图如图4所示，从图4可以看出机械臂系统的跟踪误差都限制在对称的时变约束范围内，从而确保机械臂系统全状态在整个过程中都不违背约束条件。
[0104]
机械臂系统的状态仿真图如图5所示，从图5可以看出机械臂系统输出能够快速且精确地跟踪参考信号。
[0105]
实施例2:
[0106]
本实施例2的目的是提供一种计算装置，包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序，处理器执行程序时实现以下步骤，包括：
[0107]
步骤s1，设计观测器，具体为：建立机械臂系统动力学方程；建立机械臂系统初始状态方程；设计有限时间扰动观测器；建立机械臂系统状态方程；
[0108]
步骤s2，基于反步法设计机械臂控制器。
[0109]
实施例3：
[0110]
本实施例3的目的是提供一种计算机可读存储介质，其上存储有计算机程序，该程序被处理器执行时执行以下步骤：
[0111]
步骤s1，设计观测器，具体为：建立机械臂系统动力学方程；建立机械臂系统初始状态方程；设计有限时间扰动观测器；建立机械臂系统状态方程；
[0112]
步骤s2，基于反步法设计机械臂控制器。
[0113]
以上实施例的装置中涉及的各步骤与方法与实施例1相对应，具体实施方式可参见实施例1的相关说明部分。术语“计算机可读存储介质”应该理解为包括一个或多个指令
集的单个介质或多个介质：还应当被理解为包括任何介质，所述任何介质能够存储、编码或承载用于由处理器执行的指令集并使处理器执行本发明中的任一方法。
[0114]
在不冲突的情况下，本文中上述实施例及实施例中的特征可以相互结合。
[0115]
以上所述仅为本发明的较佳实施例，并不用以限制本发明，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

技术特征：
1.一种全状态约束机械臂的快速有限时间控制器的设计方法，其特征在于，包括以下步骤：s1，设计观测器，具体为：建立机械臂系统动力学方程；建立机械臂系统初始状态方程；设计有限时间扰动观测器；建立机械臂系统状态方程；s2，基于反步法设计机械臂控制器。2.根据权利要求1所述的全状态约束机械臂的快速有限时间控制器的设计方法，其特征在于，步骤s1中，设计观测器的具体步骤为：s1.1，建立机械臂系统动力学方程：其中，q是角位置，是角加速度，m是转动惯量，m是连杆质量，g是重力加速度，f是作用力，l是连杆长度；s1.2，建立机械臂系统初始状态方程：定义机械臂系统状态变量、控制输入量如下：其中，x1、x2为机械臂系统的状态变量，u为机械臂系统的控制输入量，为角速度；则机械臂系统动力学方程(1)表达为：其中，d1和d2分别为外部扰动；φ1＝0,φ2(x1)＝
‑
0.5mgl sin(x1)；s1.3，设计有限时间扰动观测器：其中，v
0i
，v
1i
，v
2i
分别是中间变量，λ0,λ1,λ2分别是有限时间扰动观测器的参数，σ
0i
,σ
1i
,σ
2i
分别是x
i
,d
i
,的观测值，l1、l2、l3为观测系数；s1.4,建立机械臂系统状态方程：定义外部扰动d
i
的观测值为则机械臂系统初始状态方程(3)表达为：
3.根据权利要求2所述的全状态约束机械臂的快速有限时间控制器的设计方法，其特征在于，步骤s2中，基于反步法设计机械臂控制器的具体步骤为：s2.1，基于障碍加幂积分技术，选取满足约束条件的lyapunov函数v1：其中，ξ1是跟踪误差，ξ1＝x1‑
y
d
，y
d
是参考信号，η1(t)是对称时变约束函数，η
11
＞η
12
＞0，η
11
,η
12
分别表示常数，t表示时间，τ1是时间常数；s2.2，对lyapunov函数v1求一阶导数，并化简，选取合适的虚拟控制律α1：其中，r2为选取的常数，r2＝δ，δ为分子和分母都是奇数的分数且1/2<δ<1；为d1的观测值；s2.3,结合以上虚拟控制律的设计，可保证lyapunov函数v1的导数其中，a,b分别表示常数，a＞0,b＞0；s2.4，引入坐标变换：s2.5，选取适当的lyapunov函数v2：其中，η2(t)是时变约束函数，η
21
＞η
22
＞0，η
21
,η
22
分别表示常数，t表示时间，τ2是时间常数；s2.6，对lyapunov函数v2求导并化简，选择模糊逻辑对未知的非线性函数进行近似估计，非线性函数的表达式为：其中，θ＝[θ1,θ2…
,θ
n
]
t
是权重向量，s(x)＝[s1(x),s2(x),
…
s
n
(x)]
t
,且其中，k＝1,2,
…
,n，j＝1,2,
…
,n，n和n均为大于1的自然数，为高斯关系函数；s2.7，对非线性函数进行恒等变化，得到表达式：
y(x)＝θ
*t
s(x)＋ε(x)
ꢀꢀꢀ
(12)其中，θ
*
和ε(x)分别是理想的最优权重和该最优权重下的逼近误差；s2.8，利用表达式(11)和表达式(12)在设计过程中使用模糊逻辑对非线性函数进行逼近处理，从而设计出模糊虚拟控制律u：其中，r3,k为选取的常数；为d2的观测值；s2.9，由以上模糊虚拟控制律的设计可保证lyapunov函数v2的导数其中c,d分别表示常数，c＞0,d＞0。4.一种机械臂系统，包括控制器，其特征在于，所述控制器利用权利要求1
‑
3任一项所述的设计方法设计获得。5.一种计算装置，包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序，其特征在于，所述处理器执行程序时实现以下步骤，包括：s1，设计观测器，具体为：建立机械臂系统动力学方程；建立机械臂系统初始状态方程；设计有限时间扰动观测器；建立机械臂系统状态方程；s2，基于反步法设计机械臂控制器。6.一种计算机可读存储介质，其上存储有计算机程序，其特征在于，所述程序被处理器执行时执行以下步骤：s1，设计观测器，具体为：建立机械臂系统动力学方程；建立机械臂系统初始状态方程；设计有限时间扰动观测器；建立机械臂系统状态方程；s2，基于反步法设计机械臂控制器。
技术总结
本发明提供一种全状态约束机械臂的快速有限时间控制器的设计方法，包括以下步骤：设计观测器，具体为：建立机械臂系统动力学方程；建立机械臂系统初始状态方程；设计有限时间扰动观测器；建立机械臂系统状态方程；基于反步法设计机械臂控制器。利用本发明提供的方法设计的控制器能够使得机械臂系统快速有限时间稳定，机械臂系统的输出能够很好地跟随给定信号的变化，该控制器很好的解决了机械臂系统在满足约束条件下的快速有限时间跟踪控制问题。满足约束条件下的快速有限时间跟踪控制问题。满足约束条件下的快速有限时间跟踪控制问题。


技术研发人员：陈响 郑世祺 陈扬孜
受保护的技术使用者：中国地质大学（武汉）
技术研发日：2021.02.26
技术公布日：2021/6/29