1.基于模糊观测器的柔性关节机械臂指令滤波反步控制方法,其特征在于,包括如下步骤:
步骤1.建立考虑不确定项的柔性关节机械臂动力学系统数学模型;
首先给出柔性关节机械臂的动态方程,如公式(1)所示:其中,q、分别表示连杆的位置、速度和加速度,qm、分别表示电机的转角位置、速度和加速度,M代表连杆的质量,l代表连杆的长度,g为重力加速度,代表摩擦项即未知的干扰项,K表示关节刚度系数,J和B分别表示执行器的惯性和自然阻尼项,u代表电机控制输入,y表示系统的输出;设定和B中包含不确定性;
设状态变量x1=q,x3=qm,将动态方程即公式(1)改写为:为简化动态方程即公式(1),接下来定义如下变量,如公式(3)所示:基于公式(3),进一步将公式(2)改写成:设h2和h4是已知正常数,f2和f4是含有未知项的连续函数,且有连续有界的一阶导数;
步骤2.设计模糊观测器,估计柔性关节机械臂的连杆速度和电机的转角速度;
令公式(4)中进一步得到公式(5):其中,Z1=[x1,x2,x3,x4]T;
由模糊逻辑系统定义得知:
其中,θi是最优参数向量,表示θi的估计,为xi的状态估计值;
表示与θi同为函数变量,表示的估计,表示变量为的函数块,表示的估计;
表示状态变量与θi共同简化成的函数,表示的估计;
针对一个任意给定的正数ε,由模糊自适应逼近定理得到:其中,表示函数中变量为Z1且系数为θiT的函数块,δi(Z1)≤|ε|;
基于公式(5)并综合上式将公式(4)的观测器设计为:式中,表示的估计;定义观测器的误差e=[e1,e2,e3,e4]T,其中,ej表示估计误差,j=1,2,3,4;估计误差D1、D2、D3、D4为待设计的正数;得到其中,表示的估计,表示的估计;
假定一个函数fi(·)满足以下不等式:为正常数,i=2,4;得到其中,表示Z1的估计;
令其中,是不确定正常数;表示的估计;
则得到ε表示一个任意小的正数;
设有一对称矩阵Q=QT>0,那么会有一对称矩阵P=PT>0满足ATP+PA=-Q;
步骤3.根据指令滤波和反步法设计基于模糊观测器的柔性关节机械臂的指令滤波反步控制方法,具体过程如下:定义指令滤波器的公式如下:
其中,zo,1表示指令滤波器的一阶变量,zo,2表示指令滤波器的二阶变量;
xo,c=zo,1和为指令滤波器的两个输出;αo为指令滤波器的输入,αo表示虚拟控制函数;指令滤波器的初始状态αo(0)=zo,1(0),zo,2(0)=0;
当式(4)系统开始运行后,若输入信号满足:则任意μ>0,存在ζ∈(0,1]和ωn≥0,使得|xo,c-αo|≤μ,o=1,2,3,均有界;
ρ1表示虚拟控制函数一阶导的上界,ρ2表示虚拟控制函数二阶导的上界;
由反步法的原理定义误差变量:
其中,zj表示误差变量,j=1,2,3,4;xd为给定的期望信号,xo,c为指令滤波器的输出信号,为速度项的估计值;
定义误差补偿信号为:
其中,ξj表示误差补偿信号,vj表示补偿误差跟踪信号;
步骤4.对基于模糊观测器的柔性关节机械臂指令滤波反步控制方法进行稳定性分析。
2.根据权利要求1所述的基于模糊观测器的柔性关节机械臂指令滤波反步控制方法,其特征在于,所述步骤3中,虚拟控制律和滤波误差补偿信号的具体形式在以下设计过程中给出;
步骤3.1.选取Lyapunov函数为V0=eTPe,求导得:由杨氏不等式得到:
2eTPF≤||e||2+(m22+m42)||P||2||e||2 (11)其中,m2、m4表示任意小的正数;将公式(11)、公式(12)代入公式(10)得:其中,λmin(Q)是Q最小的特征值;
步骤3.2.选取第一个子系统的Lyapunov函数求导得:由于e2未知,由杨氏不等式得到:
设计虚拟控制律α1和补偿信号为:
其中,k1为正常数,将公式(15)、公式(16)代入公式(14)得:步骤3.3.选取Lyapunov函数求导得:其中,为θ2的估计,表示自适应律,λ2为正常数,h2为正常数;由杨氏不等式得到:将公式(19)代入公式(18)得:设计虚拟控制律α2、补偿信号和自适应律为:其中,k2为正常数,n2为正常数,将公式(21)代入公式(20)得:步骤3.4.选取Lyapunov函数求导得:由于e4未知,由杨氏不等式得到:
设计虚拟控制律α3和补偿信号为:
其中,k3为正常数,将公式(24)、公式(25)代入公式(23)得:步骤3.5.选取Lyapunov函数求导得:其中,λ4为正常数;为θ4的估计,表示自适应律;由杨氏不等式得到:将公式(28)代入公式(27)得:设计真实控制律u、补偿信号和自适应律为:其中,k4、n4均为正的常数,将公式(30)代入公式(29)得:
3.根据权利要求2所述的基于模糊观测器的柔性关节机械臂指令滤波反步控制方法,其特征在于,所述步骤4中,稳定性分析过程如下:选取V=V4,由公式(31)得:
由杨氏不等式得:
将公式(13)、公式(33)、公式(34)代入(32)得到:其中,λmin(Q)-3-(m22+m42)||P||2>0,其中,λmax(P)表示向量P的最大特征值;进一步由公式(35)得到:式(36)表明,vj和均属于紧集:因此,机械臂系统的所有信号都有界,滤波器的误差补偿信号ξj满足其中因为z1=v1+ξ1且ξ1有界,跟踪误差z1有界,进而得到:其中,minj(kj)表示kj中的最小值;
通过以上分析得知,vj、ξj、zj都是有界的,因此,在给定参数kj、mi、ni后,保持a不变,选择足够大的λi和足够小的ε,能够保证跟踪误差z1足够小。