基于模糊自适应全局滑模的机械臂轨迹跟踪控制方法

摘要

本发明公开了一种基于模糊自适应全局滑模的机械臂轨迹跟踪控制方法，所述方法包括如下步骤：步骤1、设计基于模糊控制的实变参数滑模面结构；步骤2、设计滑模变量s；步骤3、设计模糊控制器的输入为误差q

说明书

技术领域

本发明属于非线性系统控制领域，涉及一种机械臂轨迹跟踪控制算法，具体涉及一种基于模糊自适应全局滑模的机械臂轨迹跟踪控制方法。

背景技术

机械臂是一个高度非线性、难以精确建模的系统，加上机械臂在工作时还存在一些其他的外界未知扰动，这些都给机械臂的轨迹跟踪控制问题带来巨大的困难。

滑模控制被广泛地应用在非线性系统的控制当中。传统的固定参数滑模面结构一经确定，系统在滑模面上的收敛过程为在固定平面上的运动，系统难以保证误差在平面的不同位置、区域都具备较快的收敛速度。

由于考虑到机械臂工作时的模型不确定性和外界干扰这些不确定性，对系统的鲁棒性提高了要求。

发明内容

本发明的目的是提供一种基于模糊自适应全局滑模的机械臂轨迹跟踪控制方法，该方法采用机械臂的拉格朗日动力学模型，考虑机械臂的模型参数不确定性和外部环境干扰，设计一种基于模糊控制的时变参数动态滑模面和积分形式的全局滑模面，进一步设计得出控制律和自适应律，实现机械臂的轨迹跟踪控制。

本发明的目的是通过以下技术方案实现的：

一种基于模糊自适应全局滑模的机械臂轨迹跟踪控制方法，包括如下步骤：

步骤1、针对考虑模型不确定性、外界干扰的刚性机械臂的轨迹跟踪控制问题，设计基于模糊控制的实变参数滑模面结构：

s(t)＝f(x(t),k(t))；

k(t)＝α(t)k；

其中，α(t)为时变系数，k为固定参数；

步骤2、针对步骤1中的时变参数滑模面结构，结合机械臂数学模型，设计滑模变量s，其参数通过模糊控制器的输出自适应调节，具体形式如下所示：

K

K

其中，K

步骤3、设计模糊控制器的输入为误差q

模糊逻辑为：当输入q

步骤4、针对步骤2中设计的滑模变量，设计积分形式的全局滑模变量σ：

其中，K

步骤5、针对步骤2、步骤3和步骤4中设计的滑模变量、模糊控制器、全局滑模变量，设计基于模糊自适应滑模的机械臂轨迹跟踪控制律和自适应律，实现轨迹跟踪控制，其中：

基于模糊自适应滑模的机械臂轨迹跟踪控制律为：

其中，k＞0，q

自适应律为：

其中，λ

相比于现有技术，本发明具有如下优点：

本发明针对机械臂的轨迹跟踪问题设计了一种基于模糊自适应全局滑模的控制器，其控制对象的模型为一考虑模型不确定性和外界干扰的刚性机械臂，采用自适应滑模控制的方法设计控制律和自适应律，实现轨迹跟踪控制。同时引入模糊控制，根据系统的状态变量距离平衡点的距离实时调节滑模参数，使得系统在滑模面上的整个收敛过程都具备较快的收敛速度，并减少力矩浪费，全局滑模提高了系统的鲁棒性，使得系统能够能够有效的克服模型不确定性和外界干扰，同时不需要知道不确定性项的上界具体值，有利于机械臂系统在不同的老化程度下和不同环境下正常工作。

附图说明

图1为基于模糊自适应滑模的机械臂轨迹跟踪控制系统框图；

图2为模糊控制输入的隶属度函数；

图3为模糊控制输出的隶属度函数；

图4为d＝0.1时角位置误差收敛曲线；

图5为d＝0.1时角速度误差收敛曲线；

图6为d＝0.1时力矩曲线；

图7为d＝0.1、d＝0.2时角位置误差收敛曲线；

图8为d＝0.3、d＝0.4时角位置误差收敛曲线；

图9为d＝0.1、d＝0.2时角速度误差收敛曲线；

图10为d＝0.3、d＝0.4时角速度误差收敛曲线；

图11为固定扰动加正弦扰动时的角位置、角速度误差收敛曲线；

图12为固定扰动加白噪声时的角位置、角速度误差收敛曲线；

图13为固定参数滑模结构的角位置、角速度误差收敛曲线；

图14为时变参数滑模结构的角位置、角速度误差收敛曲线；

图15为固定参数(左)和时变参数(右)滑模结构的力矩曲线。

具体实施方式

下面结合附图对本发明的技术方案作进一步的说明，但并不局限于此，凡是对本发明技术方案进行修改或者等同替换，而不脱离本发明技术方案的精神和范围，均应涵盖在本发明的保护范围中。

本发明提供了一种基于模糊自适应全局滑模的机械臂轨迹跟踪控制方法，所述方法包括如下步骤：

步骤1、针对考虑模型不确定性、外界干扰的刚性机械臂的轨迹跟踪控制问题，设计基于模糊控制的实变参数滑模面结构。

在滑模控制中，滑模面的结构将决定系统在滑模面上的运动。对于固定参数滑模面结构的设计，可以写成如下形式：

s(t)＝f(x(t),k)；

其中，s(t)为滑模变量，x(t)为系统的状态，k为滑模面的参数。

当系统状态收敛至滑模面s(t)＝0＝0上时，系统的动力学方程为：

f(x(t),k)＝0。

将在固定的滑模面上收敛至平衡点。传统的固定参数滑模面结构，往往只能保证系统状态在某些范围内具备较快的收敛速度，从而限制了在滑模面上的整体收敛过程。

将滑模面的固定参数时变化，滑模面的结构变为：

s(t)＝f(x(t),k(t))；

k(t)＝α(t)k；

其中，α(t)为时变系数，k为固定参数。滑模面结构随着系统的收敛而不断改变，从而起到加快收敛速度的作用。时变系数α(t)由模糊控制器输出。

步骤2、针对步骤1中的时变参数滑模面结构，结合机械臂数学模型，设计具体的滑模面。

设计滑模变量s，其形式如下所示：

K

K

其中，K

当系统处于滑模面s＝0上，系统状态动力学方程如下式所示：

当系统误差q

步骤3、针对步骤2中的时变参数，设计模糊控制器。

在步骤2中，系统在滑模面上的收敛主导项受误差q

输入的隶属度函数：

输出的隶属度函数：

其中，i＝1,2。

模糊控制器的模糊逻辑为：

当输入q

上述模糊控制器起到进一步加强主导项、减弱非主导项的作用，使得系统的收敛速度加快。同时由于各参数影响控制力矩的输出，也能减小力矩的浪费。

步骤4、针对步骤2中设计的时变参数滑模面结构，设计全局滑模变量。

在滑模控制系统中，系统收敛过程分为两个阶段，一个是到达段，即系统从初始位置到达滑模面上的阶段；第二个是滑动阶段，即系统处于滑模面上，收敛只受滑模面本身限制，沿着滑模面收敛至平衡点。全局滑模使得系统从一开始就在滑模面上，使原来的到达段也具备滑模控制所具有的强鲁棒性。

设计全局滑模变量：

其中，K

同时，由于引进了积分器，滑模变量σ的变化比变量s更加平缓，将其作为控制量时能够减小控制力矩的抖振。

步骤5、针对步骤2、步骤3和步骤4中设计的滑模变量、模糊控制器，设计机械臂轨迹跟踪控制律和自适应律。

设计基于模糊自适应滑模的机械臂轨迹跟踪控制律为：

其中，k＞0，q

设计自适应律为：

其中，λ

实施例：

对于一个一般的刚性机械臂，其拉格朗日动力学模型可以由以下二阶非线性微分方程表示：

其中，

将上述方程写成误差的形式：

其中，q

考虑机械臂的模型不确定性，在方程中表示为参数的不确定。考虑机械臂的外加扰动和摩擦力矩，设为τ

其中，M

进一步化简为：

其中，ρ

考虑摩擦转矩使得下式成立：

其中，γ

最后写成误差的形式为：

设计滑模变量s，其形式如下所示：

其中，K

当系统处于滑模面s＝0上，系统状态动力学方程如下式所示：

当系统误差q

根据上述主导控制的逻辑思路，将系统状态误差的二范数||q

模糊控制输入||q

表1模糊规则

注：S、B、M是模糊集，代表小、大、中。

通过模糊自适应控制，使得滑模面参数在系统的收敛过程中，根据距离平衡点的位置自适应调节。当系统离平衡点较远时，||q

为了进一步提高系统的鲁棒性、减小控制力矩的抖振，设计全局滑模变量：

其中，K

由于积分器的引入，系统从一开始就处于滑模面σ＝0上，通过设计控制律，使得系统一直处于σ＝0上(附近)，从而使滑模变量s按照下式规律运动：

其中，||ε||有限且非常小。

根据上述方法，可设计得到的控制律：

其中，k＞0，

设计自适应律为：

其中，λ

下面对所设计的控制律和自适应律进行稳定性分析：

由式(7)可得：

将式(11)、(12)带入式(6)中可得变量s的动力学方程为：

由式(9)可得：

将式(16)带入式(15)中可得变量σ的动力学方程为：

考虑Lyapunov函数V，其形式如下：

对其求导可得：

将(17)带入(19)中可得：

由机械臂的性质中

综上所述，所设计的基于模糊自适应全局滑模的控制律能够使得系统一直处于滑模面σ＝0上，从而系统状态误差在滑模面上运动收敛至平衡点。

选取二自由度刚性机械臂仿真，数学模型如式(21)所示：

其中，各矩阵的形式为：

系数矩阵中各参数表达式如下：

考虑d倍的模型不确定性参数，即：m

机械臂各物理量参数如下：

质量：m

长度：l

转动惯量：J

重力加速度：g＝9.8N/kg。

设置期望轨迹：

设置式(4)中的不确定性干扰为：τ

设置式(7)、(9)中滑模变量的参数为：K

设置式(11)、(12)所示的控制律和自适应律参数为：k＝5，λ

d取值0.1的仿真结果如图4～6所示。从图4～6中可以看出，所设计的控制器能够使系统在较短时间内收敛至平衡点，同时控制力矩的大小在合适的范围内。为了进一步说明本发明的优越性，进行了以下对比仿真实验。

不同程度不确定性下的收敛曲线如图7～10所示，从图7～10中可以看出，随着不确定性程度增大，角位置、角速度误差的收敛曲线并无明显变化，收敛速度基本不变，验证了系统对模型不确定性的强鲁棒性。

重新将模型不确定性系数设为0.1，对不同类型环境干扰进行仿真实验，结果如下：

外界扰动设置为以下形式：τ

外界扰动设置为以下形式：τ

重新将外界扰动设置为固定扰动和正弦扰动叠加的形式，并将模糊控制器的输出设置为：α

收敛速度的快慢直接受控制力矩的大小影响，在考虑收敛速度的同时，对比力矩曲线如图15所示。从图15中的收敛曲线可以直接看出，时变参数滑模结构下的收敛速度较固定参数滑模结构快，力矩的大小无法直接从曲线当中得出。定义收敛过程t时间内的平均力矩指标为：

其中，I(τ)∈R

固定参数滑模结构下各关节的平均力矩指标为：