CN104932271A - 一种机械臂伺服***的神经网络全阶滑模控制方法 - Google Patents

Abstract

一种机械臂伺服***的神经网络全阶滑模控制方法，针对含有动态执行机构的机械臂伺服***，利用全阶滑模控制方法，再结合神经网络，设计一种机械臂伺服***神经网络全阶滑模控制方法。全阶滑模面的设计是为了保证***的有限时间收敛，并且通过在实际的控制系中避免出现微分项来消除抖振以及奇异问题。另外，神经网络是用来逼近***的未知非线性以及内外部扰动的不确定性。本发明提供一种能够消除滑模面的抖振问题以及奇异问题，并且能有效补偿***未知非线性以及内外部扰动的控制方法，实现***的快速稳定控制。

Description

一种机械臂伺服***的神经网络全阶滑模控制方法

技术领域

本发明涉及一种机械臂伺服***的神经网络全阶滑模控制方法，特别是带有动态执行机构以及***未知动态参数的机械臂伺服***控制方法。

背景技术

机械臂伺服***作为一种高度自动化设备，在机器人、航空飞行器等高性能***中得到了广泛的应用，如何实现机械臂伺服***的快速精确控制已经成为了一个热点问题。然而，未知动态参数以及外部干扰广泛存在于机械臂伺服***中，往往会导致控制***的效率降低甚至是失效。针对机械臂伺服***的控制问题，存在很多控制方法，例如PID控制，自适应控制，滑模控制等。

滑模控制在解决***不确定性和外部扰动方面被认为是一个有效的鲁棒控制方法。滑模控制方法具有算法简单、响应速度快、对外界噪声干扰和参数摄动鲁棒性强等优点。因此，滑模控制方法被广泛应用于各个领域。对比传统线性滑模控制,终端滑模控制的优越性在于他的有限时间收。然而，终端滑模控制在本质上的不连续开关特性将会引起***的抖振，成为了终端滑模控制在实际***中应用的障碍。为了解决这一问题，许多改进的方法相继被提出，例如高阶滑模控制方法，观测器控制方法。在这些方法中，滑模面的选取都是根据理想***参数降阶而得到的。最近，一种全阶滑模控制方法被提出，这种方法在***的响应中很好的避免了抖振问题并且使***输入信号更加平滑。

然而，在上述提出的大部分方法中，机械***的动态模型参数都必须提前已知。因此，当***存在不确定因素时，上述提出的方法不能直接应用于对机械臂的控制。众所周知，由于神经网络在一个紧集的任意精度中逼近任何光滑函数的能力，因此它已被广泛应用于处理***未知性以及非线性问题。基于上述原因，许多自适应神经网络控制方法被用来控制高度非线性的机械臂***。

发明内容

为了克服现有的机械臂伺服***存在的未知非线性问题以及滑模控制抖振问题的不足，本发明提供一种含有动态执行机构的机械臂伺服***神经网络全阶滑模控制方法，消除了***的抖振问题以及奇异问题，保证***快速稳定收敛。

为了解决上述技术问题提出的技术方案如下：

一种机械臂伺服***神经网络全阶滑模控制方法，包括以下步骤：

步骤1，建立机械臂伺服***的动态模型，初始化***状态、采样时间以及控制参数，过程如下：

1.1机械臂伺服***的动态模型表达形式为：

$M\left(q\right)\stackrel{\·\·}{q}+C(q,\stackrel{\·}{q})\stackrel{\·}{q}+D\stackrel{\·}{q}+G\left(q\right)=\mathrm{\τ}---\left(1\right)$

其中，q，和分别为机械臂关节的位置，速度和加速度，M(q)，以及D分别表示每个关节的对称正定惯性矩阵，离心科里奥利矩阵以及阻尼摩擦系数的对角正定矩阵；G(q)代表重力项；τ代表了关节的转矩输入矢量；

1.2当考虑动态执行机构时，将式(1)重新表示为：

$M_H\left(q\right)\stackrel{\·\·}{q}+C_H(q,\stackrel{\·}{q})\stackrel{\·}{q}+D_{H}q+G_{H}q=u---\left(2\right)$

其中， $M_H=K_{\mathrm{\τ}}^{-1}(N^{-1}M+{\mathrm{NJ}}_m),C_H=K_{\mathrm{\τ}}^{-1}{N}^{-1}C,D_H=K_{\mathrm{\τ}}^{-1}(N^{-1}D+{\mathrm{ND}}_m),$ $G_H=K_{\mathrm{\τ}}^{-1}{N}^{-1}G;u=K_{\mathrm{\τ}}^{-1}{\mathrm{\τ}}_m$ 是一个电枢电压输入的矢量；代表电磁转矩矢量，其中，J_m和D_m分别表示惯性对角矩阵和扭转阻尼系数；K_τ＝diag(K_τ1,K_τ2,…,K_τn)则是对角矩阵的转矩常数；q_m代表的是电机角位置矢量；τ_L代表的是电机负载转矩的矢量；表示n关节变速器齿轮的对角矩阵；

1.3由于存在测量噪声，负荷变化以及外部干扰的影响，式(2)中的***参数并不能精确的获得；那么，又将实际的***参数改写为：

$M_H\left(q\right)={\hat{M}}_H\left(q\right)+{\mathrm{\ΔM}}_H\left(q\right)$

$C_H(q,\stackrel{\·}{q})={\hat{C}}_H(q,\stackrel{\·}{q})+{\mathrm{\ΔC}}_H(q,\stackrel{\·}{q})$

$D_H={\hat{D}}_H+{\mathrm{\ΔD}}_H$

$G_H\left(q\right)={\hat{G}}_H\left(q\right)+{\mathrm{\ΔG}}_H\left(q\right)---\left(3\right)$

其中，估计值以及代表已知部分；ΔM_H(q)，ΔD_H以及ΔG_H(q)代表***未知项；

步骤2，基于带有未知参数的机械臂伺服***，设计所需的神经网络，过程如下：

定义θ^*为理想权重系数矩阵，那么非线性不确定函数f被逼近为：

f＝θ^*Tφ(x)+ε     (4)

其中，代表输入矢量；φ(x)＝[φ₁(x),φ₂(x),…φ_m(x)]^T是神经网络的基函数；ε代表神经网络的逼近误差且满足||ε||≤ε_N，ε_N则是一个正的常数；φ_i(x)被取为以下高斯函数：

${\mathrm{\φ}}_i\left(x\right)=\exp \[-\frac{\left|\right|x-c_i\left|\right|}{2{\mathrm{\σ}}_i^2}\],i=1,2,...,n---\left(5\right)$

其中，c_i代表高斯函数的核参数；σ_i则表示了高斯函数的宽度；

步骤3，计算控制***跟踪误差，设计全阶滑模面，过程如下：

3.1定义***跟踪误差为：

e＝q_d-q       (6)

其中，q_d为二阶可导期望轨迹；那么式(6)的一阶微分和二阶微分被表示为如下形式：

$\stackrel{\·}{e}={\stackrel{\·}{q}}_d-\stackrel{\·}{q}---\left(7\right)$

$\stackrel{\·\·}{e}={\stackrel{\·\·}{q}}_d-\stackrel{\·\·}{q}---\left(8\right)$

3.2那么全阶滑模面将定义为：

$s=\stackrel{\·\·}{e}+c_{2}sgn\left(\stackrel{\·}{e}\right)|\stackrel{\·}{e}{|}^{{\mathrm{\α}}_2}+c_{1}sgn\left(e\right)|e{|}^{{\mathrm{\α}}_1}---\left(9\right)$

其中，c₁和c₂是一个正的常数，它的选择是保证多项式p²+c₂p+c的全部特征根在复平面的左半部分以保证***稳定；α₁和α₂的选取则是通过以下多项式：

$\left\{\begin{array}{c}{\mathrm{\α}}_1=\mathrm{\α},n=1\\ {\mathrm{\α}}_{i-1}=\frac{{\mathrm{\α}}_i{\mathrm{\α}}_{i+1}}{2{\mathrm{\α}}_{i+1}-{\mathrm{\α}}_i},i=2,...,n,\∀n\≥2\end{array}\right.---\left(10\right)$

其中，α_n+1＝1，α_n＝α，α∈(1-ε,1)以及ε∈(0,1)；

步骤4，基于含有动态执行机构的机械臂***，根据全阶滑模以及神经网络理论，设计神经网络全阶滑模控制器，过程如下：

4.1考虑式(2),神经网络全阶滑模控制器被设计为：

$\begin{array}{c}u={\hat{M}}_H\left(q\right)({\stackrel{\·\·}{q}}_d+c_2\mathrm{sgn}(\stackrel{\·}{e})|\stackrel{\·}{e}{|}^{{\mathrm{\α}}_2}+c_1\mathrm{sgn}\left(e\right)|e{|}^{{\mathrm{\α}}_1}+u_0)\\ +{\hat{C}}_H(q,\stackrel{\·}{q})\stackrel{\·}{q}+{\hat{D}}_H\stackrel{\·}{q}+{\hat{G}}_H\left(q\right)\end{array}---\left(11\right)$

$u_0={\widehat{\mathrm{\θ}}}^T\mathrm{\φ}\left(x\right)-{{\hat{M}}_H}^{-1}\left(q\right)u_n---\left(12\right)$

${\stackrel{\·}{u}}_n+{\mathrm{Tu}}_n=v---\left(13\right)$

v＝-(k_d+k_T+η)sgn(s)        (14)

其中，c_i和α_i是常数，i＝1,2，已在式(9)中被定义；k_d，k_T和η都是常数；

4.2设计神经网络权重系数矩阵的调节规律：

$\stackrel{\·}{\widehat{\mathrm{\θ}}}=\mathrm{\Γ}\mathrm{\φ}\left(x\right)s^T---\left(15\right)$

其中，Γ是一个正定的对角矩阵；

4.3将式(11)带入式(2)中得到如下等式：

$s={\mathrm{\θ}}^{{*}^T}\mathrm{\φ}\left(x\right)+\mathrm{\ϵ}-{\widehat{\mathrm{\θ}}}^T\mathrm{\φ}\left(x\right)+u_n={\widetilde{\mathrm{\θ}}}^T\mathrm{\φ}\left(x\right)+\mathrm{\ϵ}+u_n=d(q,t)+u_n---\left(16\right)$

其中，代表神经网络的权重估计误差；代表***扰动项，并且是有界的，那么假定d(q,t)≤l_d并且其中l_d是一个有界的常数；K_T的选取是在K＞0时满足k_T≥Tl_d；

4.4通过式(2)，式(9)，式(11)-(14)以及式(16)，全阶滑模面被写成如下等式：

s＝d(q,t)+u_n      (17)

4.5将式(14)带入式(13)中得到：

$\begin{array}{c}{u}_n\left(t\right)=\left(u_n\right(t_0)+(1/T)(k_d+k_T+\mathrm{\η})\mathrm{sgn}\left(s\right))e^{t-t_0}\\ -(1/T)(k_d+k_T+\mathrm{\η})\mathrm{sgn}\left(s\right)\end{array}---\left(18\right)$

在u_n(0)＝0的情况下，得到如下等式：

k_T≥Tl_d≥T|u_n(t)|_max≥T|u_n(t)|      (19)

4.6设计李雅普诺夫函数：

$V=\frac{1}{2}{s}^{T}s---\left(20\right)$

对式(9)进行求导得：

$\stackrel{\·}{s}=\stackrel{\·}{d}(q,t)+{\stackrel{\·}{u}}_n=\stackrel{\·}{d}(q,t)+{\stackrel{\·}{u}}_n+{\mathrm{Tu}}_n-{\mathrm{Tu}}_n=\stackrel{\·}{d}(q,t)+v-{\mathrm{Tu}}_n---\left(21\right)$

将式(13)带入式(21)中得到：

$\stackrel{\·}{s}=\stackrel{\·}{d}(q,t)-(k_d+k_T+\mathrm{\η})\mathrm{sgn}\left(s\right)-{\mathrm{Tu}}_n---\left(22\right)$

对式(20)进行微分得到：

$\stackrel{\·}{V}=s^T\stackrel{\·}{s}=\stackrel{\·}{d}(q,t)s^T-(k_d+k_T+\mathrm{\η})s^T\mathrm{sgn}\left(s\right)-{\mathrm{Tu}}_n{s}^T---\left(23\right)$

将式(19)带入式(23)中，如果则判定***是稳定的。

本发明基于未知非线性因素，全阶滑模和神经网络，设计机械臂伺服***的神经网络全阶滑模控制方法，实现***稳定控制，消除滑模控制的抖振，保证***快速稳定收敛。

本发明的技术构思为：针对含有动态执行机构的机械臂伺服***，利用全阶滑模控制方法，再结合神经网络，设计一种机械臂伺服***神经网络全阶滑模控制方法。全阶滑模面的设计是为了保证***的快速稳定收敛，并且通过在实际的控制系中避免出现微分项来消除抖振以及奇异问题。另外，神经网络是用来逼近***的未知非线性以及内外部扰动的不确定性。本发明提供一种能够消除滑模面的抖振问题以及奇异问题，并且能有效补偿***未知动态参数以及内外部扰动的控制方法，实现***的快速稳定控制。

本发明的优点为：消除抖振，补偿***未动态参数以及内外部不确定扰动项，实现快速稳定收敛。

附图说明

图1为本发明k＝10时的位置跟踪效果示意图，其中，(a)表示关节1，(b)表示关节2。

图2为本发明k＝10时的位置跟踪误差示意图，其中，(a)表示关节1，(b)表示关节2。

图3为本发明k＝10时的速度跟踪示意图，其中，(a)表示关节1，(b)表示关节2。

图4为本发明k＝10时的控制器输入示意图，其中，(a)表示关节1，(b)表示关节2。

图5为本发明k＝40时的位置跟踪效果示意图，其中，(a)表示关节1，(b)表示关节2。

图6为本发明k＝40时的位置跟踪误差示意图，其中，(a)表示关节1，(b)表示关节2。

图7为本发明k＝40时的速度跟踪示意图，其中，(a)表示关节1，(b)表示关节2。

图8为本发明k＝40时的控制器输入示意图，其中，(a)表示关节1，(b)表示关节2。

图9为本发明的控制流程示意图。

具体实施方式

下面结合附图对本发明做进一步说明。

参照图1-图9，一种机械臂伺服***的神经网络全阶滑模控制方法，包括以下步骤：

步骤1，建立机械臂伺服***的动态模型，初始化***状态、采样时间以及控制参数，过程如下：

1.1机械臂伺服***的动态模型表达形式为：

$M\left(q\right)\stackrel{\·\·}{q}+C(q,\stackrel{\·}{q})\stackrel{\·}{q}+D\stackrel{\·}{q}+G\left(q\right)=\mathrm{\τ}---\left(1\right)$

其中q，和分别为机械臂关节的位置，速度和加速度，M(q)，以及D分别表示每个关节的对称正定惯性矩阵，离心科里奥利矩阵以及阻尼摩擦系数的对角正定矩阵；G(q)代表重力项；τ代表了关节的转矩输入矢量；

1.2当考虑动态执行机构时，将式(1)重新表示为：

$M_H\left(q\right)\stackrel{\·\·}{q}+C_H(q,\stackrel{\·}{q})\stackrel{\·}{q}+D_{H}q+G_{H}q=u---\left(2\right)$

其中， $M_H=K_{\mathrm{\τ}}^{-1}(N^{-1}M+{\mathrm{NJ}}_m),C_H=K_{\mathrm{\τ}}^{-1}{N}^{-1}C,D_H=K_{\mathrm{\τ}}^{-1}(N^{-1}D+{\mathrm{ND}}_m),$ $G_H=K_{\mathrm{\τ}}^{-1}{N}^{-1}G;u=K_{\mathrm{\τ}}^{-1}{\mathrm{\τ}}_m$ 是一个电枢电压输入的矢量；代表电磁转矩矢量，其中，J_m和D_m分别表示惯性对角矩阵和扭转阻尼系数；K_τ＝diag(K_τ1,K_τ2,…,K_τn)则是对角矩阵的转矩常数；q_m代表的是电机角位置矢量；τ_L代表的是电机负载转矩的矢量；表示n关节变速器齿轮的对角矩阵；

1.3由于存在测量噪声，负荷变化以及外部干扰的影响，式(2)中的***参数并不能精确的获得；那么，又将实际的***参数改写为：

$M_H\left(q\right)={\hat{M}}_H\left(q\right)+{\mathrm{\ΔM}}_H\left(q\right)$

$C_H(q,\stackrel{\·}{q})={\hat{C}}_H(q,\stackrel{\·}{q})+{\mathrm{\ΔC}}_H(q,\stackrel{\·}{q})$

$D_H={\hat{D}}_H+{\mathrm{\ΔD}}_H$

$G_H\left(q\right)={\hat{G}}_H\left(q\right)+{\mathrm{\ΔG}}_H\left(q\right)---\left(3\right)$

其中，估计值以及代表已知部分；ΔM_H(q)，ΔD_H以及ΔG_H(q)代表***未知项；

步骤2，基于带有未知参数的机械臂伺服***，设计所需的神经网络，过程如下：

2.1定义θ^*为理想权重系数矩阵，那么非线性不确定函数f被逼近为：

f＝θ^*Tφ(x)+ε      (4)

其中，代表输入矢量；φ(x)＝[φ₁(x),φ₂(x),…φ_m(x)]^T是神经网络的基函数；ε代表神经网络的逼近误差且满足||ε||≤ε_N，ε_N则是一个正的常数；φ_i(x)通常被取为以下高斯函数：

${\mathrm{\φ}}_i\left(x\right)=\exp \[-\frac{\left|\right|x-c_i\left|\right|}{2{\mathrm{\σ}}_i^2}\],i=1,2,\mathrm{...},n---\left(5\right)$

其中，c_i代表高斯函数的核参数；σ_i则表示了高斯函数的宽度；

步骤3，计算控制***跟踪误差，设计全阶滑模面；

3.1定义***跟踪误差为：

e＝q_d-q     (6)

其中，q_d为二阶可导期望轨迹；那么式(6)的一阶微分和二阶微分被表示为如下形式：

$\stackrel{\·}{e}={\stackrel{\·}{q}}_d-\stackrel{\·}{q}---\left(7\right)$

$\stackrel{\·\·}{e}={\stackrel{\·\·}{q}}_d-\stackrel{\·\·}{q}---\left(8\right)$

3.2那么全阶滑模面将定义为：

$s=\stackrel{\·\·}{e}+c_{2}sgn\left(\stackrel{\·}{e}\right)|\stackrel{\·}{e}{|}^{{\mathrm{\α}}_2}+c_{1}sgn\left(e\right)|e{|}^{{\mathrm{\α}}_1}---\left(9\right)$

其中，c₁和c₂是一个正的常数，它的选择是保证多项式p²+c₂p+c的全部特征根在复平面的左半部分以保证***稳定；α₁和α₂的选取则是通过以下多项式：

$\left\{\begin{array}{c}{\mathrm{\α}}_1=\mathrm{\α},n=1\\ {\mathrm{\α}}_{i-1}=\frac{{\mathrm{\α}}_i{\mathrm{\α}}_{i+1}}{2{\mathrm{\α}}_{i+1}-{\mathrm{\α}}_i},i=2,\mathrm{...},n,\∀n\≥2\end{array}\right.---\left(10\right)$

其中，α_n+1＝1，α_n＝α，α∈(1-ε,1)以及ε∈(0,1)；

步骤4，基于含有动态执行机构的机械臂伺服***，根据全阶滑模以及神经网络理论，设计神经网络全阶滑模控制器，过程如下：

4.1考虑式(2),神经网络全阶滑模控制器被设计为：

$\begin{array}{c}u={\hat{M}}_H\left(q\right)({\stackrel{\·\·}{q}}_d+c_2\mathrm{sgn}(\stackrel{\·}{e})|\stackrel{\·}{e}{|}^{{\mathrm{\α}}_2}+c_1\mathrm{sgn}\left(e\right)|e{|}^{{\mathrm{\α}}_1}+u_0)\\ +{\hat{C}}_H(q,\stackrel{\·}{q})\stackrel{\·}{q}+{\hat{D}}_H\stackrel{\·}{q}+{\hat{G}}_H\left(q\right)\end{array}---\left(11\right)$

$u_0={\widehat{\mathrm{\θ}}}^T\mathrm{\φ}\left(x\right)-{{\hat{M}}_H}^{-1}\left(q\right)u_n---\left(12\right)$

${\stackrel{\·}{u}}_n+{\mathrm{Tu}}_n=v---\left(13\right)$

v＝-(k_d+k_T+η)sgn(s)      (14)

其中，c_i和α_i(i＝1,2)是常数，已在式(9)中被定义；k_d，k_T和η都是常数，并且将在之后给予说明；

4.2设计神经网络权重系数矩阵的调节规律：

$\stackrel{\·}{\widehat{\mathrm{\θ}}}=\mathrm{\Γ}\mathrm{\φ}\left(x\right)s^T---\left(15\right)$

其中，Γ是一个正定的对角矩阵；

4.3将式(11)带入式(2)中得到如下等式：

$s={\mathrm{\θ}}^{{*}^T}\mathrm{\φ}\left(x\right)+\mathrm{\ϵ}-{\widehat{\mathrm{\θ}}}^T\mathrm{\φ}\left(x\right)+u_n={\widetilde{\mathrm{\θ}}}^T\mathrm{\φ}\left(x\right)+\mathrm{\ϵ}+u_n=d(q,t)+u_n---\left(16\right)$

其中，代表神经网络的权重估计误差；代表***扰动项，并且是有界的，那么我们假定d(q,t)≤l_d并且其中l_d是一个有界的常数；K_T的选取是在K＞0时满足k_T≥Tl_d；

4.4通过式(2)，式(9)，式(11)-(14)以及式(16)，全阶滑模面被写成如下等式：

s＝d(q,t)+u_n       (17)

4.5将式(14)带入式(13)中得到：

$\begin{array}{c}{u}_n\left(t\right)=\left(u_n\right(t_0)+(1/T)(k_d+k_T+\mathrm{\η})\mathrm{sgn}\left(s\right))e^{t-t_0}\\ -(1/T)(k_d+k_T+\mathrm{\η})\mathrm{sgn}\left(s\right)\end{array}---\left(18\right)$

在u_n(0)＝0的情况下，得到如下等式：

k_T≥Tl_d≥T|u_n(t)|_max≥T|u_n(t)|      (19)

4.6设计李雅普诺夫函数：

$V=\frac{1}{2}{s}^{T}s---\left(20\right)$

对式(9)进行求导得：

$\stackrel{\·}{s}=\stackrel{\·}{d}(q,t)+{\stackrel{\·}{u}}_n=\stackrel{\·}{d}(q,t)+{\stackrel{\·}{u}}_n+{\mathrm{Tu}}_n-{\mathrm{Tu}}_n=\stackrel{\·}{d}(q,t)+v-{\mathrm{Tu}}_n---\left(21\right)$

将式(13)带入式(21)中得到：

$\stackrel{\·}{s}=\stackrel{\·}{d}(q,t)-(k_d+k_T+\mathrm{\η})\mathrm{sgn}\left(s\right)-{\mathrm{Tu}}_n---\left(22\right)$

对式(20)进行微分得到：

$\stackrel{\·}{V}=s^T\stackrel{\·}{s}=\stackrel{\·}{d}(q,t)s^T-(k_d+k_T+\mathrm{\η})s^T\mathrm{sgn}\left(s\right)-{\mathrm{Tu}}_n{s}^T---\left(23\right)$

将式(19)带入式(23)中，如果则判定***是稳定的。

为了得到式(2)中的相应***参数值，我们给出如下两个关节的机械臂伺服***表达式：

$\left[\begin{array}{cc}{a}_{11}& a_{12}\\ a_{12}& a_{22}\end{array}\right]\left[\begin{array}{c}{\stackrel{\·\·}{q}}_1\\ {\stackrel{\·\·}{q}}_2\end{array}\right]+\left[\begin{array}{cc}-b_{12}{\stackrel{\·}{q}}_1& -2b_{12}{\stackrel{\·}{q}}_2\\ 0& b_{12}{\stackrel{\·}{q}}_2\end{array}\right]\left[\begin{array}{c}{\stackrel{\·}{q}}_1\\ {\stackrel{\·}{q}}_2\end{array}\right]+\left[\begin{array}{c}{c}_{1}g\\ c_{2}g\end{array}\right]=\left[\begin{array}{c}{\mathrm{\τ}}_1\\ {\mathrm{\τ}}_2\end{array}\right]+\left[\begin{array}{c}{\mathrm{\τ}}_{d_1}\\ {\mathrm{\τ}}_{d_2}\end{array}\right]---\left(24\right)$

其中， $a_{11}=(m_1+m_2)r_1^2+m_2{r}_2^2+2m_2{r}_1{r}_{2}cos\left(q_2\right)+J,$ a₁₂＝m₂r₂+m₂r₁r₂cos(q₂)，b₁₂＝m₂r₁r₂sin(q₂)，c₁＝(m₁+m₂)r₁cos(q₂)+m₂r₂cos(q₁+q₂)，c₂＝m₂r₂cos(q₁+q₂)， ${\mathrm{\τ}}_d=\left[\begin{array}{c}{\mathrm{\τ}}_{d_1}\\ {\mathrm{\τ}}_{d_2}\end{array}\right].$

为验证所提方法的有效性，本发明给出了神经网络有限时间控制(Neuralnetwork-based finite time control,NNFTC)方法和神经网络全阶滑模控制(Chattering-free neural sliding mode control,CFNSMC)方法的对比：

为了更有效的进行对比，***所有参数都是一致的，即：q₁(0)＝0.5，q₂(0)＝0.5，J_m＝diag(0.67×10^-4,0.42×10^-4)，D_m＝diag(0.21,0.15)，N＝diag(9,1)，并且给定***扰动为：***控制信号参数为：K_τ＝diag(19/40,19/80)，Γ＝diag(50,50)，α₁＝13/27，α₂＝13/27，c₁＝100，c₂＝40，T＝1；机械臂实际参数为：r₁＝0.2，r₂＝0.18，m₁＝2.3，m₂＝0.6，J₁＝0.02，J₂＝0.003，g＝9.8。此外，我们令k＝k_d+k_T+η，并且分别在两种不同k值情况下对两种控制方法进行对比。

情况一：k＝10

由于我们跟踪的机械臂***是两个关节，所以我们跟踪q_d1＝sin(2πt)以及q_d2＝sin(2πt)。从图1和图2我们看出，CFNSMC方法和NNFTC方法在跟踪关节一时拥有近似的跟踪效果；然而CFNSMC方法比NNFTC方法拥有更好的跟踪效果当跟踪关节2。从图3跟踪速度示意图中能明显看出，CFNSMC方法的跟踪速度曲线比NNFTC方法得到的曲线更加平滑。此外在图4中，NNFTC方法有明显的抖振现象，然而CFNSMC方法则消除了这一抖振现象。

情况二：k＝40

从图5和图6中，我们看出NNFTC方法甚至比CFNSMC方法拥有更好的跟踪效果在跟踪关节1时；然而，在跟踪关节2时，却不如CFNSMC方法。除此之外，从图6和图7中我们得到，在控制输入信号以及跟踪速度曲线上，CFNSMC方法比NNFTC方法都要平滑许多。并且，对比图1和图5，我们很明显看出在面对不同的增益k上，CFNSMC方法比NNFTC方法拥有更强的鲁棒性。

综上所述，对比NNFTC方法，CFNSMC方法对不同的控制增益k更不敏感，即拥有更强鲁棒性；并且在控制信号以及速度跟踪信号上拥有更好的消除抖振的能力。

以上阐述的是本发明给出的一个实施例表现出的优良优化效果，显然本发明不只是限于上述实施例，在不偏离本发明基本精神及不超出本发明实质内容所涉及范围的前提下对其可作种种变形加以实施。

Claims (1)

1.一种机械臂伺服***神经网络全阶滑模控制方法，其特征在于：所述控制方法包括以下步骤：

步骤1，建立机械臂伺服***的动态模型，初始化***状态、采样时间以及控制参数，过程如下：

1.1机械臂伺服***的动态模型表达形式为：

$M\left(q\right)\stackrel{\·\·}{q}+C(q,\stackrel{\·}{q})\stackrel{\·}{q}+D\stackrel{\·}{q}+G\left(q\right)=\mathrm{\τ}---\left(1\right)$

其中，q，和分别为机械臂关节的位置，速度和加速度，M(q)，以及D分别表示每个关节的对称正定惯性矩阵，离心科里奥利矩阵以及阻尼摩擦系数的对角正定矩阵；G(q)代表重力项；τ代表了关节的转矩输入矢量；

1.2当考虑动态执行机构时，将式(1)重新表示为：

$M_H\left(q\right)\stackrel{\·\·}{q}+C_H(q,\stackrel{\·}{q})\stackrel{\·}{q}+D_{H}q+G_{H}q=u---\left(2\right)$

其中， $M_H=K_{\mathrm{\τ}}^{-1}(N^{-1}M+{\mathrm{NJ}}_m),C_H=K_{\mathrm{\τ}}^{-1}{N}^{-1}C,D_H=K_{\mathrm{\τ}}^{-1}(N^{-1}D+{\mathrm{ND}}_m),$ 是一个电枢电压输入的矢量；代表电磁转矩矢量，其中，J_m和D_m分别表示惯性对角矩阵和扭转阻尼系数；K_τ＝diag(K_τ1,K_τ2,...,K_τn)则是对角矩阵的转矩常数；q_m代表的是电机角位置矢量；τ_L代表的是电机负载转矩的矢量；表示n关节变速器齿轮的对角矩阵；

1.3由于存在测量噪声，负荷变化以及外部干扰的影响，式(2)中的***参数并不能精确的获得；那么，又将实际的***参数改写为：

$M_H\left(q\right)={\hat{M}}_H\left(q\right)+{\mathrm{\ΔM}}_H\left(q\right)$

$C_H(q,\stackrel{\·}{q})={\hat{C}}_H(q,\stackrel{\·}{q})+{\mathrm{\ΔC}}_H(q,\stackrel{\·}{q})$

$D_H={\hat{D}}_H+{\mathrm{\ΔD}}_H$

$G_H\left(q\right)={\hat{G}}_H\left(q\right)+{\mathrm{\ΔG}}_H\left(q\right)---\left(3\right)$

其中，估计值以及代表已知部分；ΔM_H(q)，ΔD_H以及ΔG_H(q)代表***未知项；

步骤2，基于带有未知参数的机械臂伺服***，设计所需的神经网络，过程如下：

定义θ^*为理想权重系数矩阵，那么非线性不确定函数f被逼近为：

f＝θ^*Tφ(x)+ε               (4)

其中，代表输入矢量；φ(x)＝[φ₁(x),φ₂(x),…φ_m(x)]^T是神经网络的基函数；ε代表神经网络的逼近误差且满足||ε||≤ε_N，ε_N则是一个正的常数；φ_i(x)被取为以下高斯函数：

${\mathrm{\φ}}_i\left(x\right)=\exp \[-\frac{||x-c_i||}{2{\mathrm{\σ}}_i^2}\],i=1,2,...,n---\left(5\right)$

其中，c_i代表高斯函数的核参数；σ_i则表示了高斯函数的宽度；

步骤3，计算控制***跟踪误差，设计全阶滑模面，过程如下：

3.1定义***跟踪误差为：

e＝q_d-q                   (6)

其中，q_d为二阶可导期望轨迹；那么式(6)的一阶微分和二阶微分被表示为如下形式：

$\stackrel{\·}{e}={\stackrel{\·}{q}}_d-\stackrel{\·}{q}---\left(7\right)$

$\stackrel{\·\·}{e}={\stackrel{\·\·}{q}}_d-\stackrel{\·\·}{q}--\left(8\right)$

3.2那么全阶滑模面将定义为：

$s=\stackrel{\·\·}{e}+c_{2}sgn\left(\stackrel{\·}{e}\right){\left|\stackrel{\·}{e}\right|}^{{\mathrm{\α}}_2}+c_{1}sgn\left(e\right){\left|e\right|}^{{\mathrm{\α}}_1}---\left(9\right)$

其中，c₁和c₂是一个正的常数，它的选择是保证多项式p²+c₂p+c的全部特征根在复平面的左半部分以保证***稳定；α₁和α₂的选取则是通过以下多项式：

$\left\{\begin{array}{c}{\mathrm{\α}}_1=\mathrm{\α},n=1\\ {\mathrm{\α}}_{i-1}=\frac{{\mathrm{\α}}_i{\mathrm{\α}}_{i+1}}{2{\mathrm{\α}}_{i+1}-{\mathrm{\α}}_i},i=2,...,n,\∀n\≥2\end{array}\right.---\left(10\right)$

其中，α_n+1＝1，α_n＝α，α∈(1-ε,1)以及ε∈(0,1)；

步骤4，基于含有动态执行机构的机械臂***，根据全阶滑模以及神经网络理论，设计神经网络全阶滑模控制器，过程如下：

4.1考虑式(2),神经网络全阶滑模控制器被设计为：

$\begin{array}{c}u={\hat{M}}_H\left(q\right)\left({\stackrel{\·\·}{q}}_d+c_2\mathrm{sgn}\left(\stackrel{\·}{e}\right){\left|\stackrel{\·}{e}\right|}^{{\mathrm{\α}}_2}+c_1\mathrm{sgn}\left(e\right){\left|e\right|}^{{\mathrm{\α}}_1}+u_0\right)\\ +{\hat{C}}_H\left(q,\stackrel{\·}{q}\right)\stackrel{\·}{q}+{\hat{D}}_H\stackrel{\·}{q}+{\hat{G}}_H\left(q\right)\end{array}---\left(11\right)$

$u_0={\widehat{\mathrm{\θ}}}^T\mathrm{\φ}\left(x\right)-{{\hat{M}}_H}^{-1}\left(q\right)u_n---\left(12\right)$

${\stackrel{\·}{u}}_n+{\mathrm{Tu}}_n=v---\left(13\right)$

v＝-(k_d+k_T+η)sgn(s)             (14)

其中，c_i和α_i是常数，i＝1,2，已在式(9)中被定义；k_d，k_T和η都是常数；

4.2设计神经网络权重系数矩阵的调节规律：

$\stackrel{\·}{\widehat{\mathrm{\θ}}}=\mathrm{\Γ}\mathrm{\φ}\left(x\right)s^T---\left(15\right)$

其中，Γ是一个正定的对角矩阵；

4.3将式(11)带入式(2)中得到如下等式：

$s={\mathrm{\θ}}^{{*}^T}\mathrm{\φ}\left(x\right)+\mathrm{\ϵ}-{\widehat{\mathrm{\θ}}}^T\mathrm{\φ}\left(x\right)+u_n={\widetilde{\mathrm{\θ}}}^T\mathrm{\φ}\left(x\right)+\mathrm{\ϵ}+u_n=d(q,t)+u_n---\left(16\right)$

其中，代表神经网络的权重估计误差；代表***扰动项，并且是有界的，那么假定d(q,t)≤l_d并且其中l_d是一个有界的常数；K_T的选取是在K＞0时满足k_T≥Tl_d；

4.4通过式(2)，式(9)，式(11)-(14)以及式(16)，全阶滑模面被写成如下等式：

s＝d(q,t)+u_n                   (17)

4.5将式(14)带入式(13)中得到：

$\begin{array}{c}{u}_n\left(t\right)=\left(u_n\right(t_0)+(1/T)(k_d+k_T+\mathrm{\η})\mathrm{sgn}\left(s\right))e^{t-t_0}\\ -\left(1/T\right)\left(k_d+k_T+\mathrm{\η}\right)\mathrm{sgn}\left(s\right)\end{array}---\left(18\right)$

在u_n(0)＝0的情况下，得到如下等式：

k_T≥Tl_d≥T|u_n(t)|_max≥T|u_n(t)|              (19)

4.6设计李雅普诺夫函数：

$V=\frac{1}{2}{s}^{T}s---\left(20\right)$

对式(9)进行求导得：

$\stackrel{\·}{s}=\stackrel{\·}{d}(q,t)+{\stackrel{\·}{u}}_n=\stackrel{\·}{d}(q,t)+{\stackrel{\·}{u}}_n+{\mathrm{Tu}}_n-{\mathrm{Tu}}_n=\stackrel{\·}{d}(q,t)+v-{\mathrm{Tu}}_n---\left(21\right)$

将式(13)带入式(21)中得到：

$\stackrel{\·}{s}=\stackrel{\·}{d}(q,t)-(k_d+k_T+\mathrm{\η})\mathrm{sgn}\left(s\right)-{\mathrm{Tu}}_n---\left(22\right)$

对式(20)进行微分得到：

$\stackrel{\·}{V}=s^T\stackrel{\·}{s}=\stackrel{\·}{d}(q,t)s^T-(k_d+k_T+\mathrm{\η})s^T\mathrm{sgn}\left(s\right)-{\mathrm{Tu}}_n{s}^T---\left(23\right)$

将式(19)带入式(23)中，如果则判定***是稳定的。