基于混合型伸缩因子的机械臂控制优化研究

2019-09-16王宏涛蒋汶松

应用科技 2019年5期

王宏涛，蒋汶松

南京航空航天大学机电学院，江苏南京 210016

随着机械臂在工业领域内的应用越来越广泛、发展越来越迅速，机械臂轨迹跟踪的控制方法也层出不穷。机械臂轨迹跟踪的控制方法主要有PID控制、计算力矩控制、反演控制以及变结构控制等[1-4]。PID控制方法简单且易于实现，为了使机械臂的关节轨迹可以快速地跟踪上期望的关节轨迹，在使用PID控制器时通常会将控制器的P参数与D参数设置得比较大，实现快速的轨迹跟踪；计算力矩控制属于一种前馈控制方式，这种控制方式可以根据机械臂关节轨迹的变化实时调整作用给机械臂各关节的力矩；反演控制引入了微分阻尼项，可以大大提高控制系统的动态性能；变结构控制方法会给系统带来“抖振”，即当系统跟踪误差控制在零点附近时，存在很强的抖动现象，使系统不稳定[5-6]。由于机械臂自身的物理参数会受到环境及负载变化的影响，且存在非线性的关系，因此很难建立机械臂的精确数学模型，而PID控制、计算力矩控制以及反演控制均依赖于机械臂的精确数学模型，对于数学模型无法精确得到的机械臂来说，PID控制、计算力矩控制以及反演控制均存在不同程度的精度问题，难以实现机械臂的高精度轨迹跟踪控制。

对精确数学模型难以建立的系统，模糊控制的优势尤其明显，模糊控制方法不依赖被控对象的精确数学模型，但往往由于控制规则有限，存在控制精度低的问题[7]。1995年，李洪兴[8]提出了变论域模糊控制方法，所谓变论域模糊控制，就是在模糊控制的基础上，通过设计合适的伸缩因子，以论域之变应误差之变，使得实际的控制规则大幅度增加，越接近期望控制点，控制器的档级越小，因而获得比较满意的动态性能指标和稳态性能指标，控制精度与伸缩因子的设计有很大关系，设计合适的伸缩因子是变论域模糊控制器设计中的关键环节。万敏[9]教授对输入和输出论域设计了统一的指数型伸缩因子，将变论域模糊控制方法用于两关节机械臂的轨迹跟踪控制。变论域模糊控制方法在车辆工程以及机械制造等领域也获得了较多成功的应用。借助于变论域模糊控制方法，Zhao 等[10]设计了作用于输入论域的指数型伸缩因子，取得了平行二级倒立摆的控制成功。Pang等[11]用积分调节原理设计了作用于输出论域的积分型伸缩因子，实现了车辆半主动悬架控制。龙祖强[12]对输入输出论域设计了统一的指数型伸缩因子，实现了机床定位控制。

本文提出了一种新的混合型伸缩因子，设计了一种以三关节机械臂为被控对象的变论域模糊控制器，并将所设计的变论域模糊控制器应用于三关节机械臂的轨迹跟踪控制。运用MATLAB软件仿真实验验证了所设计的混合型伸缩因子在机械臂轨迹跟踪控制中的有效性，并与文献[9]提出的基于指数型伸缩因子的变论域模糊控制器在机械臂轨迹跟踪中的控制效果进行了进一步对比分析。

1 三关节机械臂动力学分析

对于三关节机械臂，其动力学可以采用牛顿-欧拉方程求出，忽略摩擦力和末端负载，三关节机械臂动力学方程表示如下：

式中：q∈R3×1是机械臂关节角度向量；q˙ ∈R3×1是机械臂关节角速度向量；q¨ ∈R3×1是机械臂关节角加速度向量；M(q)∈R3×3是惯性对称矩阵；B(q)∈R3×3是哥氏力系数矩阵；C(q)∈R3×3是离心力系数矩阵；是重力向量；B(q)、C(q)和G(q)中的元素都是关于机械臂关节角度的函数， τ ∈R3×1是控制力矩向量；是关节速度积向量，即

[q˙2]∈R3×1是关节速度平方向量，即

2 变论域模糊控制方法设计

2.1 机械臂轨迹跟踪的变论域模糊控制方案

机械臂轨迹跟踪主要是通过控制器给机械臂关节施加驱动为矩，使得机械臂关节的角位移跟踪给定的期望关节角度，最终实现机械臂末端平稳地完成用户规定的作业流程。本文针对三关节机械臂的轨迹跟踪控制问题，设计了三关节机械臂轨迹跟踪的变论域模糊控制方案，其控制系统结构如图1所示。

图1 三关节机械臂变论域模糊控制系统结构

图1中，qdn(n=1,2,3)是机械臂3个关节的期望关节角度；qn(n=1,2,3)是3个关节的实际关节角度；en(n=1,2,3)是3个关节的角度误差，即期望关节角度与实际关节角度的差值；ecn(n=1,2,3)是3个关节的角度误差变化率；常数Ken和Kecn(n=1,2,3)分别是误差和误差变化率的量化因子；en和ecn(n=1,2,3)分别是经过量化因子作用后的无量纲的关节角度误差和关节角度误差变化率；常数Kun(n=1,2,3)称为比例因子； τn(n=1,2,3)是控制器作用给机械臂3个关节的力矩。

2.2 变论域模糊控制器的设计

2.2.1 伸缩因子的设计

变论域模糊控制器的论域随着误差的变小而收缩，随着误差的增大而膨胀。局部上看，论域收缩相当于增加规则，从插值的角度来说，规则越多，精度越高[13]。伸缩因子的选取作为变论域模糊控制器设计中的关键环节，不同类型、不同参数的伸缩因子所产生的效果大相径庭。一般地，伸缩因子满足避零性、单调性、协调性、正规性，本文提出的混合型伸缩因子满足这些特性。考虑到积分型伸缩因子会增大计算量，容易削弱实时性，同时考虑误差和误差变化率之间的相关性对精度的影响，本文将误差变化率的伸缩因子取为误差及其变化率的二元函数，动态权值wk是一个以关节角度误差为自变量且包含可调参数p的指数函数，通过动态权值wk的作用，可以实时调节误差和误差变化率对误差变化率伸缩因子的影响程度。由上述对伸缩因子的分析，将关节角度误差的伸缩因子关节角度误差变化率的伸缩因子以及输出力矩的伸缩因子β(yk)分别设计为如下形式：

式中：k为时间序列；u、uc为输入变量的初始论域；V为输出变量的初始论域；动态权值wk=参数p称为带宽；为充分小的正数。

2.2.2 输入输出变量的模糊化

对关节角度误差、关节角度误差变化率以及输出力矩采用区间变换的方法使其归属到无量纲的标准论域，均为 [- 7,7]。关节角度误差en和误差变化率的模糊集取为{FD，FX，L，ZX，ZD}，即{负大，负中，零，正中，正大}；输出控制量的模糊集取为{FD，FZ，FX，L，ZX，ZZ，ZD}，即{负大，负中，负小，零，正小，正中，正大}。输入输出语言变量的隶属函数取三角形隶属函数。

2.2.3 模糊规则的制定

根据机械臂轨迹跟踪控制的经验，当关节角度误差大或较大时，选择控制量以尽快消除误差为主；而当关节角度误差较小时，选择控制量要注意防止超调，以系统稳定性为主要出发点。可设计出如表1所示的具有25条控制规则的变论域模糊控制器规则表。

表1 变论域模糊控制器规则表

2.2.4 模糊推理与逆模糊化

模糊推理与逆模糊化过程多种多样，比较典型的有重心法、中心平均法、取中位数法以及最大隶属度法等[14]。在上述多种方法中，简化计算量与保留更多有用信息是一对矛盾。本文采用将2个输入变量属于同一模糊子集的隶属度相乘之后再进行中心平均逆模糊的方法，设计出的模糊表达式如下所示：

式中：k为时间序列；为模糊集；为对应模糊集上的隶属度函数；为输出论域模糊子集的中心。

3 仿真与结果分析

本文在MATLAB里搭建出的三关节机械臂变论域模糊控制系统仿真框图如图2所示，将3个关节的控制器封装为一个模块。控制的目标是使机械臂的各关节角度输出以尽可能高的精度快速地跟踪事先给定的参考关节角度输入。

图2 三关节机械臂变论域模糊控制系统仿真框图

运用上述设计的三关节机械臂变论域模糊控制系统进行轨迹跟踪控制仿真,需要先获得各关节期望角度。本文采用基于相平面的离线时间最优轨迹规划方法获得期望关节角度[15]，选择如式(1)所示的笛卡尔空间轨迹，取自身弧长s为参数，可以建立如式(2)所示的弧长参数方程。由此，利用机械臂运动学，可以建立变量s与机械臂关节坐标的映射关系，再引入每个关节的力矩约束，运用线性规划的数学方法，以机械臂末端走完式(1)轨迹所花时间最短为优化目标，最终得出三关节机械臂各个关节的轨迹。

由于所获得的3个关节的轨迹均是无法显式表达的非线性函数，所以可根据得出的各个关节的轨迹获取时间-关节角度序列，选取0.02 s的时间间隔进行一次采样，则每一个采样时间对应一个关节角度值。将采样出的关节角度值作为机械臂变论域模糊控制的参考关节角度输入，即期望关节角度，如图3所示。

图3 期望关节角度

量化因子Ke=Kec=2.2，比例因子Ku=10，混合型伸缩因子相关参数值分别取τ=0.98、δ=0.002、ρ=1，设置仿真步长t=0.02 s，仿真总时长T=0.4 s，机械臂各个关节均可获取20个采样时间-关节角度值序列。

为验证提出的混合型伸缩因子的变论域模糊控制器的控制效果，本文以文献[9]中提出的指数型伸缩因子的变论域模糊控制器在三关节机械臂轨迹跟踪中的控制效果作为对比，通过Simulink中的Scope模块得到如图4～6所示的3个关节角度输出响应曲线。图4是关节1的使用指数型伸缩因子的变论域模糊控制器与本文提出的混合型伸缩因子的变论域模糊控制器分别跟踪机械臂期望关节轨迹所得出的关节角度输出对比图。