[发明专利]基于扩张状态观测器的电机伺服系统自适应鲁棒位置控制方法

摘要

本发明提供一种基于扩张状态观测器的电机伺服系统自适应鲁棒位置控制方法，包括以下步骤步骤1、建立电机伺服系统数学模型；步骤2、配置自适应律对电机伺服系统中的不确定性参数进行估计；步骤3、配置扩张状态观测器对电机伺服系统的不确定性进行估计；步骤4、配置基于扩张状态观测器的电机伺服系统自适应鲁棒位置控制器；以及步骤5、确定电机伺服系统中相关参数和函数使得电机伺服系统的位置输出准确地渐进跟踪期望的位置指令，并且使电机伺服系统的输入无抖动现象产生。本发明还涉及一种基于扩张状态观测器的电机伺服系统自适应鲁棒位置控制系统。

主权项

一种基于扩张状态观测器的电机伺服系统自适应鲁棒位置控制方法，其特征在于，包括以下步骤：步骤1、建立电机伺服系统数学模型；步骤2、配置自适应律对电机伺服系统中的不确定性参数进行估计；步骤3、配置扩张状态观测器对电机伺服系统的不确定性进行估计；步骤4、配置基于扩张状态观测器的电机伺服系统自适应鲁棒位置控制器；以及步骤5、确定电机伺服系统中相关参数和函数使得电机伺服系统的位置输出准确地渐进跟踪期望的位置指令，并且使电机伺服系统的输入无抖动现象产生；前述方法的实现具体包括：步骤1、建立电机伺服系统数学模型根据牛顿第二定律且简化电机的电气动态为比例环节，建立电机伺服系统的运动方程为：公式(1)中，为m惯性负载参数，y为惯性负载位移，kf为力矩放大系数，u为系统的控制输入，B为粘性摩擦系数，为外干扰值；选取状态矢量为：则电机伺服系统的运动学方程可以转化为如下状态方程形式：对于公式(2)：不确定性参数集θ＝[θ1，θ2]T，其中分别为不确定性参数集θ的估计值及估计误差，为系统的外部干扰值；电机伺服系统由于参数m、kf、B的变化而存在结构不确定性，非结构不 确定性也不能用明确的函数来建模；因此：假设1：系统参考指令信号x1d(t)是二阶连续的，且系统期望位置指令、速度指令及加速度指令都是有界的；假设2：不确定性参数集θ满足：θ∈Ωθ＝{θ:θmin≤θ≤θmax}  (3)公式(3)中，θmin＝[θ1min，θ2min]T,θmax＝[θ1max，θ2max]T均已知；步骤2、配置自适应律对电机伺服系统中的不确定性参数进行估计，其实现包括：定义不连续投影函数为：公式(4)中i＝1,2，·i为矢量·的第i个元素，对于两个矢量之间的运算“＜”为矢量中相应元素之间的运算；采用自适应律为：公式(5)中Γ为对角自适应律矩阵且Γ＞0，σ为自适应函数，对于任意自适应函数σ，运用投影函数(4)能保证：步骤3、配置扩张状态观测器对电机伺服系统的不确定性进行估计，其实现包括：将系统状态方程中的f或扩张为冗余状态x3，此时系统状态矢量x变为x＝[x1,x2,x3]T,其中：1)将x3定义为同时定义假设有界，则扩张后的系统状态方程为：根据扩张后的状态方程(7)，配置扩张状态观测器为：公式(8)中，为对系统状态矢量x的估计，分别是状态x1、x2及冗余状态x3的估计值，ω0是扩张状态观测器的带宽且ω0＞0；定义为扩张状态观测器的估计误差，由公式(7)、(8)可得估计误差的动态方程为：定义ε＝[ε1,ε2,ε3]T，则可以得到缩比后的估计误差的动态方程为：公式(10)中，由矩阵A的定义可知其满足赫尔维茨准则，因而存在一个正定且对称的矩阵 使得ATP+PA＝‑I成立；2)将x3定义为f，同时定义假设有界，则扩张后的系统状态方程为：根据扩张后的状态方程(11)，配置的扩张状态观测器与前述公式(8)相同；定义为扩张状态观测器的估计误差，由公式(8)、(11)可得估计误差的动态方程为：定义ε＝[ε1,ε2,ε3]T，则可以得到缩比后的估计误差的动态方程为：公式(13)中，B2＝[0 1 0]T，若h(t)有界，则系统的状态及干扰的估计误差总是有界的并且存在常数δi＞0以及有限时间T1＞0使得：其中μ为正整数；由式(10)或式(13)可知，通过增加扩张状态观测器的带宽ω0可使估计误差在有限时间内趋于很小的值，因此，在满足δ3＜|x3|，在位置控制器的配置中用估计值来前馈补偿系统的干扰x3，可提高系统的跟踪性能；同时，由(9)式或(12)式及扩张状态观测器的理论可知有界；步骤4、配置基于扩张状态观测器的电机伺服系统自适应鲁棒位置控制器，其实现包括以下步骤：步骤4‑1、定义z1＝x1‑x1d为系统的跟踪误差，x1d是期望跟踪的位置指令，配置控制器的目标是使电机伺服系统的位置输出x1尽可能准确地跟踪期望跟踪的位置指令x1d；步骤4‑2、根据公式(2)中的第一个方程将惯性负载的角速度x2作为虚拟控制量，使方程趋于稳定状态，令x2eq为虚拟控制量的期望值，其与虚拟控制量x2的误差为z2＝x2‑x2eq，对z1求导可得：公式(15)中x2eq为：公式(16)中k1为可调整的增益且k1＞0，把公式(16)代入公式(15)，则：由于G(s)＝z1(s)/z2(s)＝1/(s+k1)是一个稳定的传递函数，控制系统的跟踪误差z1在零附近较小的界内也就是控制z2在零附近较小的界内，因此需要配置控制器使z2在零附近较小的界内；步骤4‑3、配置实际的控制器输入u，使得虚拟控制的期望值与真实状态值之间的误差z2在零附近较小的界内或渐进趋近于零对z2求导可得：公式(18)中根据公式(18)配置电机伺服系统的控制器输入u为：公式(19)中k2为可调整的增益且k2＞0；确定自适应函数步骤5、确定电机伺服系统中相关参数和函数使得电机伺服系统的位置输出准确地渐进跟踪期望的位置指令，并且使电机伺服系统的输入无抖动现象产生确定电机伺服系统中结构不确定性参数集θ的范围即θmin及θmax的值，同时选取对角自适应律矩阵Γ，(Γ＞0)，及的值，并调节参数ω0、k1、k2、c，其中ω0＞0，k1＞0、k2＞0、c＞0，使得电机伺服系统的位置输出x1准确地跟踪期望的位置指令x1d，并且使电机伺服系统的输入u无抖动现象产生。