基于模糊观测器的柔性关节机械臂指令滤波反步控制方法技术

本发明专利技术属于柔性关节机械臂位置跟踪控制技术领域，具体公开了一种基于模糊观测器的柔性关节机械臂指令滤波反步控制方法，该方法针对模型参数未知的柔性关节机械臂系统，利用指令滤波及模糊观测器技术提出了指令滤波模糊控制方法，实现了对该系统期望轨迹的跟踪控制。设计模糊观测器来估计柔性机械臂的连杆角速度和电机转角速度；利用模糊自适应技术来解决模型参数不同程度的不确定性；同时，应用指令滤波技术解决了控制器设计过程中的计算复杂性问题；并通过Lyapunov控制原理证明了该柔性关节机械臂控制系统中所有变量的收敛性。本发明专利技术设计的观测器具有良好的观测效果，且解决了控制器设计过程中的计算复杂性问题，轨迹跟踪误差更小，系统鲁棒性更强。系统鲁棒性更强。系统鲁棒性更强。

【技术实现步骤摘要】
基于模糊观测器的柔性关节机械臂指令滤波反步控制方法


[0001]本专利技术属于柔性关节机械臂位置跟踪控制
，特别涉及一种基于模糊观测器的柔性关节机械臂指令滤波反步控制方法。

技术介绍

[0002]近年来，由于机器人技术的迅猛发展，柔性关节机械臂在航空航天、工件装配、国防军工和教育行业等方面广泛应用，结合发展迅速的机器视觉技术，其在制造和医疗等行业均具有较高的研究价值。传统的刚性机械臂难以解决大量繁杂的高精度控制问题，大量研究和实践表明，在设计过程中若忽略机械臂的关节柔性，此机械臂在执行高精度作业时将受到很大的限制。相较于传统的刚性机械臂，柔性机械臂在搭载了谐波减速器的基础上有较为明显的连续性和多自由度数目的特点，其在面对复杂多障碍的环境情况、精细化的操作要求时，动作灵活精准，关节扭转范围宽泛。而柔性机械臂系统是强耦合的高阶非线性系统，这些特点限制了机械臂的控制性能。因此，柔性机械臂的精确控制问题，已是当今机器人领域的研究热点。控制方法包括奇异摄动法、智能控制、变结构控制、反馈线性化法、反步控制等。
[0003]其中反步控制是一种基于递归李雅普诺夫函数的方案，是一个有效的非线性系统控制框架，以此方法为基础在处理非线性控制方面的问题上有独特的优越性，反步控制在柔性机械臂的控制领域应用广泛。然而，在对虚拟控制函数连续求导时，控制器设计过程中所用到的传统反步法会存在“计算爆炸”问题，进而增加了计算量，导致柔性机械臂反步控制策略的应用具有很大的局限性。后来提出了动态面控制方法来解决“计算爆炸”，但是动态面控制存在的滤波误差会影响系统的控制精度。进一步提出了指令滤波技术，并结合误差补偿技术降低了滤波误差对控制精度的干扰。另外在一些控制方法中，要想实现对运行中柔性机械臂系统的更精确控制，需要准确了解运行系统中的各个状态变量，但是有一部分状态变量是不可测的，当想要观测柔性机械臂的速度项时就需要用到传感器，但传感器测量时易受干扰。
[0004]综上，目前柔性关节机械臂系统中存在未知项，连杆速度及电机转角速度状态不可测，关节位置跟踪在反步设计中推导复杂以及误差过大引起安全事故等技术问题。

技术实现思路

[0005]针对现有技术中存在的上述技术问题，本专利技术提出了一种基于模糊观测器的柔性关节机械臂指令滤波反步控制方法，以便对柔性关节机械臂系统进行精确位置跟踪控制。
[0006]本专利技术为了实现上述目的，采用如下技术方案：
[0007]步骤1.建立考虑不确定性的柔性关节机械臂动力学系统数学模型；
[0008]步骤2.设计模糊观测器估计得到的柔性关节机械臂模型中不可测的连杆速度和电机转角速度，并用模糊逻辑系统处理系统中不同程度的不确定项；
[0009]步骤3.设计指令滤波反步控制器，构建了二阶滤波器和误差补偿信号，用来解决
反步设计中虚拟控制律的计算复杂度问题；
[0010]步骤4.选取Lyapunov函数进行推导，进而证明对由步骤3设计的基于模糊观测器的柔性关节机械臂指令滤波控制方法所控制系统Lyapunov稳定。
[0011]本专利技术具有如下优点：
[0012](1)本专利技术方法设计了观测器估计柔性机械臂的连杆速度和电机转角速度，解决了机械臂速度项不可测问题，提高了系统的可靠性。
[0013](2)本专利技术方法结合了指令滤波技术和误差补偿机制，解决了在控制器设计过程中的计算复杂性问题，消除了滤波误差的影响，不用再考虑期望信号高阶可导的需求，获得了更好的跟踪效果，提高了系统的控制精度。
[0014](3)本专利技术方法考虑了系统中的不确定因素，利用模糊逻辑系统处理柔性机械臂系统的不确定性，提高了系统鲁棒性。
[0015](4)本专利技术方法设计的观测器避免了实际系统中传感器的使用安装且减少了维护要求，解决了速度传感器测量时易受干扰的问题，更有利于实际应用。
附图说明
[0016]图1为本专利技术实施例中系统总体控制器以及系统复合被控对象的整体示意图。
[0017]图2为采用本专利技术方法后关节角位置和期望角位置的跟踪响应曲线图。
[0018]图3为采用本专利技术方法后关节角位置和期望角位置跟踪误差的响应曲线图。
[0019]图4为采用本专利技术方法后模糊观测器估计连杆速度项的跟踪曲线图。
[0020]图5为采用本专利技术方法后模糊观测器估计电机转角速度项的跟踪曲线图。
[0021]图6为采用本专利技术方法后该系统控制输入响应曲线图。
[0022]图7为采用本专利技术方法后应对不同程度不确定性B时位置的跟踪误差响应曲线图。
[0023]图8为采用本专利技术方法后应对不同程度不确定性时位置的跟踪误差响应曲线图。
具体实施方式
[0024]本专利技术实施例述及了一种基于模糊观测器的柔性关节机械臂指令滤波反步控制方法，该方法针对模型参数未知的柔性关节机械臂系统，利用指令滤波及模糊观测器技术，提出了指令滤波模糊控制策略，实现了对该系统期望轨迹的跟踪控制，其包括如下步骤：首先设计模糊观测器来估计柔性机械臂的连杆角速度和电机转角速度；其次利用模糊自适应技术来解决模型参数的不确定性；同时应用指令滤波技术解决了控制器设计过程中的计算复杂性问题；并通过Lyapunov控制原理证明了该柔性关节机械臂控制系统中所有变量的收敛性。
[0025]下面结合附图以及具体实施方式对本专利技术作进一步详细说明：
[0026]图1为系统总体控制器以及柔性关节机械臂系统复合被控对象的整体示意图，其中，图1中涉及到指令滤波反步控制器、模糊观测器部分以及滤波补偿机制。
[0027]本专利技术方法的控制过程如下：对于柔性机械臂系统的关节位置、速度以及电机侧的角位置、速度四个输出量，输入控制器中控制信号；由于速度项不可测，输入到模糊观测器中产生速度项的估计，再将速度项的估计送入到控制器中；与给定目标位置作比较后产
生的差值送入控制器，并将关节角位置与电机转角位置的估计误差送入控制器；将指令滤波反步控制器的控制信号输入到柔性机械臂系统中进而达成对系统的控制。
[0028]基于模糊观测器的柔性关节机械臂指令滤波反步控制方法，具体包括如下步骤：
[0029]步骤1.建立考虑不确定项的柔性关节机械臂动力学系统数学模型。
[0030]首先给出柔性关节机械臂的动态方程，如公式(1)所示：
[0031][0032]其中，q、分别表示连杆的位置、速度和加速度，q
m
、分别表示电机的转角位置、速度和加速度，M代表连杆的质量，l代表连杆的长度，g为重力加速度，代表摩擦项即未知的干扰项，K表示关节刚度系数，J和B分别表示执行器的惯性和自然阻尼项，u代表电机控制输入，y表示系统的输出；设定和B中包含不确定性。
[0033]设状态变量x1＝q,x3＝q
m
,将动态方程即公式(1)改写为：
[0034][0035]为简化动态方程即公式(1)，接下来定义如下变量，如公式(3)所示：
...

【技术保护点】

【技术特征摘要】
1.基于模糊观测器的柔性关节机械臂指令滤波反步控制方法，其特征在于，包括如下步骤：步骤1.建立考虑不确定项的柔性关节机械臂动力学系统数学模型；首先给出柔性关节机械臂的动态方程，如公式(1)所示：其中，q、分别表示连杆的位置、速度和加速度，q
m
、分别表示电机的转角位置、速度和加速度，M代表连杆的质量，l代表连杆的长度，g为重力加速度，代表摩擦项即未知的干扰项，K表示关节刚度系数，J和B分别表示执行器的惯性和自然阻尼项，u代表电机控制输入，y表示系统的输出；设定和B中包含不确定性；设状态变量x1＝q,x3＝q
m
,将动态方程即公式(1)改写为：为简化动态方程即公式(1)，接下来定义如下变量，如公式(3)所示：基于公式(3)，进一步将公式(2)改写成：设h2和h4是已知正常数，f2和f4是含有未知项的连续函数，且有连续有界的一阶导数；步骤2.设计模糊观测器，估计柔性关节机械臂的连杆速度和电机的转角速度；令公式(4)中进一步得到公式(5)：
其中，Z1＝[x1,x2,x3,x4]
T
；由模糊逻辑系统定义得知：其中，θ
i
是最优参数向量，表示θ
i
的估计，为x
i
的状态估计值；表示与θ
i
同为函数变量，表示的估计，表示变量为的函数块，表示的估计；的估计；表示状态变量与θ
i
共同简化成的函数，表示的估计；针对一个任意给定的正数ε，由模糊自适应逼近定理得到：其中，表示函数中变量为Z1且系数为θ
iT
的函数块，δ
i
(Z1)≤|ε|；基于公式(5)并综合上式将公式(4)的观测器设计为：式中，式中，表示的估计；定义观测器的误差e＝[e1,e2,e3,e4]
T
，其中，e
j
表示估计误差，j＝1,2,3,4；估计误差D1、D2、D3、D4为待设计的正数；得到为待设计的正数；得到其中，表示的估计，表示的估计；
假定一个函数f
i
(
·
)满足以下不等式：)满足以下不等式：为正常数，i＝2,4；得到其中，表示Z1的估计；令其中，是不确定正常数；表示的估计；则得到ε表示一个任意小的正数；设有一对称矩阵Q＝Q
T
＞0，那么会有一对称矩阵P＝P
T
＞0满足A
T
P+PA＝
‑
Q；步骤3.根据指令滤波和反步法设计基于模糊观测器的柔性关节机械臂的指令滤波反步控制方法，具体过程如下：定义指令滤波器的公式如下：其中，z
o,1
表示指令滤波器的一阶变量，z
o,2
表示指令滤波器的二阶变量；x
o,c
＝z
o,1
和为指令滤波器的两个输出；α
o
为指令滤波器的输入，α
o
表示虚拟控制函数；指令滤波器的初始状态α
o
(0)＝z
o,1
(0)，z
o,2
(0)＝0；当式(4)系统开始运行后，若输入信号满足：则任意μ＞0，存在ζ∈(0,1]和ω
n
≥0，使得|x<...

【专利技术属性】
技术研发人员：于金鹏，刘占杰，宿俊浩，徐庆龙，孙吉华，于慧慧，刘加朋，王保防，马玉梅，周忠凯，林文娟，
申请(专利权)人：青岛大学，
类型：发明
国别省市：