一种基于可达集估计的柔性机械臂目标追踪控制方法与流程

本发明涉及机器人领域，特别是一种基于可达集估计的柔性机械臂目标追踪控制方法。

背景技术：

机器人可代替或协助人类完成各种艰苦或危险的工作，对其研发就显得非常重要。仿人机械臂是实现机器人抓取的关键，对其末端的定位与稳定工作的要求极高。然而，传动的控制方法忽略了臂杆传动的柔性会导致机械臂末端定位的困难，并极易引发系统工作不稳定。

技术实现要素：

有鉴于此，本发明的目的是提出一种基于可达集估计的柔性机械臂目标追踪控制方法，使得仿人机械臂的目标追踪误差可以被控制在允许的误差范围内。

本发明采用以下方案实现：一种基于可达集估计的柔性机械臂目标追踪控制方法，具体包括以下步骤：

步骤s1：搭建仿人机械臂柔性运动系统；其中，所述仿人机械臂柔性运动系统包括机械臂驱动电机、机械臂目标负载、机械臂目标输出轴、阻尼组件、齿轮传动组件、刚性组件、驱动输出轴、以及基体；

步骤s2：根据物理学原理以及中立ii型t-s模糊模型的表达方法，建立柔性仿人机械臂的非线性动态系统；

步骤s3：考虑到中立ii型t-s模糊系统的模糊隶属度函数难以准确获得，取模糊系统的模糊隶属度函数上下界的中间值作为控制器模糊隶属度函数；基于可达集估计的方法，设计中立ii型模糊控制器，使得仿人机械臂的目标追踪误差可以被控制在允许的误差范围内。

进一步地，步骤s2具体包括以下步骤：

步骤s21：根据搭建的仿人机械臂柔性运动系统，分成输入传动系统、中间传动系统、以及输出传动系统；其中，输入传动系统模型如公式(1)所示：

其中jin表示输入端的转动惯量，θin，分别是输入轴的转角、角速度和角加速度，fin是输入端摩擦力力矩，tin是电机驱动力矩，τin(t)是中间传动系统输入端扭转力矩；

步骤s22：考虑到中间传动系统存在齿轮传动组件，存在间隙非线性死区模型如下：

其中是δθ的导数，δθ＝θin-θout，表示等效的关节阻尼系数，k表示等效的关节刚度系数；

考虑输出传动系统模型如下：

式中，jout表示输出端的转动惯量，θout，分别是输出轴的转角、角速度和角加速度，fout是输出端摩擦力力矩，τout(t)是中间传动系统输出端扭转力矩；

步骤s23：定义∈out＝θout-θref，其中θref假定为常数，则基于系统存在间隙非线性死区情形，得到如下的三个切换子系统：

和

和

式中，φout表示输出轴的角速度，ζout表示输出轴的角加速度；

步骤s24：假定系统存在未知的有界扰动其中i表示为第i个切换系统，表示未知的扰动上界，将具有三个情形的切换系统改写作为状态空间表达式，得到：

其中i∈[1，2，3]，初始值是0，并且

步骤s25：选取θin、ζout、δθ、φout、∈out作为模糊前件变量，使用ii型模糊集建模方法，那么将非线性切换系统表达如下的模糊模型：

其中是非线性函数ai(t)线性化后的结果，而是非线性函数bi(μi)线性化后的结果；是中立ii型的模糊集；ri表示模糊的规则数量。

进一步地，步骤s3具体包括以下步骤：

步骤s31：考虑到中立ii型t-s模糊系统的模糊隶属度函数难以准确获得，取模糊系统的模糊隶属度函数上下界的中间值作为控制器模糊隶属度函数，定义

其中表示设计的控制器增益；因为模型系统的高低界隶属度函数和是已知的，取中间值的好处是使得模糊系统(9)的隶属度函数与控制器(10)的隶属度函数的差值具有最小的边界，即：

式中，表示一个有界的标量；

步骤s32：建立如下的李雅普诺夫函数：

其中p是正定对称的矩阵；

定义一个性能指标得到：

式中，a表示一个给定标量满足0＜a＜1，μi表示系统的归一化的模糊隶属度函数集合，表示控制器的归一化的模糊隶属度函数集合，并且定义

式中，sym(*)表示sym(*)＝*^t+*，*表示矩阵的对称转置，

令得到：

对公式(15)两端乘以e^at，得到：

步骤s33：对公式(16)进行积分后，得到：

因此得到：vi(t)＜1，那么进一步定义矩阵那么有即这里已经得到仿人机械臂的跟踪误差范围；

步骤s34：将非线性矩阵不等式在公式(14)进行线性化处理；首先定义具有适当维数的对称矩阵那么抽取公式的模糊隶属度函数后得到：

式中，表示系统的归一化的模糊隶属度函数，表示一个有界的标量；

由于抽出模糊隶属度函数，得到

步骤s35：对公式(19)进行左乘右乘其中p^-1＝x，得到：

其中

并且根据公式(19)和公式(20)，得到：

步骤s36：求解公式(21)得到控制器的增益那么这一系列设计步骤所设计的中立ii型模糊控制器，使得仿人机械臂的目标追踪误差能够被控制在允许的误差范围内。

与现有技术相比，本发明有以下有益效果：本发明设计的中立ii型模糊控制器可以使仿人柔性机械臂的目标追踪误差控制在允许的范围内，具有广阔的市场应用前景。

附图说明

图1为本发明实施例的柔性机械臂传动系统示意图。

图2为本发明实施例的方法流程示意图。

具体实施方式

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

应该指出，以下详细说明都是示例性的，旨在对本申请提供进一步的说明。除非另有指明，本文使用的所有技术和科学术语具有与本申请所属技术领域的普通技术人员通常理解的相同含义。

需要注意的是，这里所使用的术语仅是为了描述具体实施方式，而非意图限制根据本申请的示例性实施方式。如在这里所使用的，除非上下文另外明确指出，否则单数形式也意图包括复数形式，此外，还应当理解的是，当在本说明书中使用术语“包含”和/或“包括”时，其指明存在特征、步骤、操作、器件、组件和/或它们的组合。

如图1以及图2所示，本实施例提供了一种基于可达集估计的柔性机械臂目标追踪控制方法，具体包括以下步骤：

步骤s1：搭建仿人机械臂柔性运动系统；其中，所述仿人机械臂柔性运动系统包括机械臂驱动电机、机械臂目标负载、机械臂目标输出轴、阻尼组件、齿轮传动组件、刚性组件、驱动输出轴、以及基体；

步骤s2：根据物理学原理以及中立ii型t-s模糊模型的表达方法，建立柔性仿人机械臂的非线性动态系统；

步骤s3：考虑到中立ii型t-s模糊系统的模糊隶属度函数难以准确获得，取模糊系统的模糊隶属度函数上下界的中间值作为控制器模糊隶属度函数；基于可达集估计的方法，设计中立ii型模糊控制器，使得仿人机械臂的目标追踪误差可以被控制在允许的误差范围内。

在本实施例中，步骤s2具体包括以下步骤：

步骤s21：根据搭建的仿人机械臂柔性运动系统，分成输入传动系统、中间传动系统、以及输出传动系统；其中，输入传动系统模型如公式(1)所示：

其中jin表示输入端的转动惯量，θin，分别是输入轴的转角、角速度和角加速度，fin是输入端摩擦力力矩，tin是电机驱动力矩，τin(t)是中间传动系统输入端扭转力矩；

步骤s22：考虑到中间传动系统存在齿轮传动组件，存在间隙非线性死区模型如下：

其中是δθ的导数，δθ＝θin-θout，表示等效的关节阻尼系数，k表示等效的关节刚度系数；

考虑输出传动系统模型如下：

式中，jout表示输出端的转动惯量，θout，分别是输出轴的转角、角速度和角加速度，fout是输出端摩擦力力矩，τout(t)是中间传动系统输出端扭转力矩；

步骤s23：定义∈out＝θout-θref，其中θref假定为常数，则基于系统存在间隙非线性死区情形，得到如下的三个切换子系统：

和

和

式中，φout表示输出轴的角速度，ζout表示输出轴的角加速度；

步骤s24：假定系统存在未知的有界扰动其中i表示为第i个切换系统，表示未知的扰动上界，将具有三个情形的切换系统改写作为状态空间表达式，得到：

其中i∈[1，2，3]，初始值是0，并且

步骤s25：选取θin、ζout、δθ、φout、∈out作为模糊前件变量，使用ii型模糊集建模方法，那么将非线性切换系统表达如下的模糊模型：

其中是非线性函数ai(t)线性化后的结果，而是非线性函数bi(μi)线性化后的结果；是中立ii型的模糊集；ri表示模糊的规则数量。

在本实施例中，步骤s3具体包括以下步骤：

步骤s31：考虑到中立ii型t-s模糊系统的模糊隶属度函数难以准确获得，取模糊系统的模糊隶属度函数上下界的中间值作为控制器模糊隶属度函数，定义

其中表示设计的控制器增益；因为模型系统的高低界隶属度函数和是已知的，取中间值的好处是使得模糊系统(9)的隶属度函数与控制器(10)的隶属度函数的差值具有最小的边界，即：

式中，表示一个有界的标量；

步骤s32：建立如下的李雅普诺夫函数：

其中p是正定对称的矩阵；

定义一个性能指标得到：

式中，a表示一个给定标量满足0＜a＜1，μi表示系统的归一化的模糊隶属度函数集合，表示控制器的归一化的模糊隶属度函数集合，并且定义

式中，sym(*)表示sym(*)＝*^t+*，*表示矩阵的对称转置，

令得到：

对公式(15)两端乘以e^at，得到：

步骤s33：对公式(16)进行积分后，得到：

因此得到：vi(t)＜1，那么进一步定义矩阵那么有即这里已经得到仿人机械臂的跟踪误差范围；

步骤s34：将非线性矩阵不等式在公式(14)进行线性化处理；首先定义具有适当维数的对称矩阵那么抽取公式的模糊隶属度函数后得到：

式中，表示系统的归一化的模糊隶属度函数，表示一个有界的标量；

由于抽出模糊隶属度函数，得到

步骤s35：对公式(19)进行左乘右乘其中p^-1＝x，得到：

其中

并且根据公式(19)和公式(20)，得到：

步骤s36：求解公式(21)得到控制器的增益那么这一系列设计步骤所设计的中立ii型模糊控制器，使得仿人机械臂的目标追踪误差能够被控制在允许的误差范围内。

以上所述仅为本发明的较佳实施例，凡依本发明申请专利范围所做的均等变化与修饰，皆应属本发明的涵盖范围。