本发明涉及电机控制技术领域，特别是一种基于特征模型的伺服系统离散自适应鲁棒滑模控制方法。
背景技术：
随着现代科学技术的飞速发展，高超声速飞机、无人战斗机等各类空中机动目标层出不穷，呈现出速度更快、机动性更强的趋势，这给国土防空带来了巨大的压力。为了对抗这些机动目标，武器装备对其伺服系统的快速性、控制精度、鲁棒性提出了更高的要求。
传统的伺服系统驱动方式是单电机驱动，但是由于体积、工艺、结构等限制，单电机驱动难以满足武器系统大功率的要求。所以多电机驱动的控制方法被提出。但是多电机伺服系统是一个高阶的、强耦合的复杂系统，控制器的设计难度较大。而由吴宏鑫院士等人提出的特征建模理论，不仅可以有效降低多电机伺服系统控制器的设计难度，而且可以提高系统的控制性能。该理论的核心是将复杂高阶系统信息融入到特征模型的时变参数中，即用低阶的时变差分方程来等价系统的动态特性。在实际系统中，测量噪声普遍存在。在特征模型的参数辨识时，如果不对系统中的测量噪声进行处理，往往会造成特征参数收敛缓慢。目前针对系统特征模型含测量噪声问题提出的滤波方法主要为扩展卡尔曼滤波算法。但是扩展卡尔曼滤波算法对于存在模型不确定的系统鲁棒性很差，并且缺少对系统状态突变的快速跟踪能力。离散滑模控制方法在伺服系统控制中得到广泛应用，但传统的离散滑模控制设计方法存在两方面不足：一是由于趋近律自身参数及切换开关的影响造成的系统抖振；二是由于根据不确定性上下界设计控制器使得抖振加剧。
技术实现要素：
本发明的目的在于提供一种适用于多电机伺服系统的离散自适应鲁棒滑模控制方法，提高多电机伺服系统的跟踪精度和动态性能，并改善系统的控制效果。
实现本发明目的的技术方案为：一种基于特征模型的伺服系统离散自适应鲁棒滑模控制方法，包括以下步骤：
步骤1、建立多电机同步驱动伺服系统动力学模型；
步骤2、依据特征建模理论，建立含测量噪声的四电机伺服系统特征模型，并采用递推最小二乘法对特征模型参数进行辨识；
步骤3、构建stf强跟踪滤波器，对测量噪声进行滤波后反馈至位置控制器；
步骤4、采用离散自适应鲁棒滑模控制器作为四电机伺服系统的位置控制器，控制器输出作为伺服系统的控制量。
本发明与现有技术相比，其显著优点为：(1)针对系统中存在测量噪声的情况，设计了stf滤波算法，抑制了测量噪声对系统控制性能的影响，具有更好的滤波效果；(2)设计了离散自适应鲁棒滑模控制方法，削弱了传统离散滑模控制造成的抖振现象，进一步提高了伺服系统的动静态性能。
附图说明
图1为本发明的基于特征模型的离散自适应鲁棒滑模控制系统结构图。
图2为本发明的多电机伺服系统结构框图。
图3为本发明的stf滤波算法流程图。
具体实施方式
结合图1，本发明基于特征模型的伺服系统离散自适应鲁棒滑模控制方法，包括以下步骤：
步骤1、建立多电机同步驱动伺服系统动力学模型；
步骤2、依据特征建模理论，建立含测量噪声的四电机伺服系统特征模型，并采用递推最小二乘法对特征模型参数进行辨识；
步骤3、构建stf强跟踪滤波器，对测量噪声进行滤波后反馈至位置控制器；
步骤4、采用离散自适应鲁棒滑模控制器作为四电机伺服系统的位置控制器，控制器输出作为伺服系统的控制量。
进一步地，结合图2，步骤1建立含齿隙和摩擦非线性因素的多电机同步驱动伺服系统动力学模型，具体为：
步骤1-1、建立单永磁同步电机伺服系统动力学模型：
其中，uq代表电机q轴的等效电压，iq代表电机q轴的等效电流，rq代表q轴的等效电阻，lq代表q轴的等效电感，ce代表电机反电势系数，θm为电机角度；
步骤1-2、利用单电机伺服系统动力学模型构建四电机伺服系统动力学模型为：
其中：j＝1,2,3,4代表电机1、电机2、电机3和电机4；ujq(t)为电机在q轴的等效电压；ijq(t)为电机在q轴的等效电流。
进一步地，步骤2依据特征建模理论，建立含测量噪声的四电机伺服系统特征模型，并采用递推最小二乘法对特征模型参数进行辨识，具体为：
步骤2-1、用一个慢时变的二阶差分方程表示四电机伺服系统的特征模型：
y(k)＝f1(k)y(k-1) f2(k)y(k-2) g0(k)u(k-1)
其中，y(k)为下一时刻多电机伺服系统的位置，y(k-1)为当前时刻多电机伺服系统的位置，y(k-2)为上一时刻多电机伺服系统的位置；u(k)为控制量；f1(k)、f1(k)和g0(k)分别为特征模型的参数。
步骤2-2、考虑系统含有的测量噪声，将多电机伺服系统用含测量噪声的特征模型描述：
其中，v(k)为测量噪声。
步骤2-3、采用递推最小二乘法对特征参数f1(k)、f1(k)和g0(k)进行在线辨识：
其中，k(k)为修正的增益矩阵，λ为遗忘因子，p(k)为k时刻的递推参数矩阵，
进一步地，结合图3，步骤3构建stf强跟踪滤波器，对测量噪声进行滤波后反馈至位置控制器，具体为：
步骤3-1、初始化时刻k、状态变量x、协方差矩阵pr；
步骤3-2、得先验估计值：
步骤3-3、将当前时刻的输出残差r(k)加入滤波器模型，进一步计算输出残差r(k)的协方差矩阵v(k)为：
其中，增加遗忘因子ρ，ρ的取值范围为0≤ρ≤1，一般取ρ＝0.95。
步骤3-4、计算渐消因子λ(k)：
λ(k)＝diag[λ1(k)λ2(k)…λn(k)]
其中，β为弱化因子，β≥1，合理的选择β可以使得到的测量噪声状态估计更加平滑，有效避免过调节。ai为预先确定的常数项，ai较大时，当系统状态xi发生突变，滤波器可以表现出对其较强的跟踪能力。
步骤3-5、计算k时刻先验估计的协方差矩阵，得协方差矩阵pr(k|k-1)：
pr(k|k-1)＝λ(k)φ(k-1)pr(k-1)φt(k-1) q
步骤3-6、更新强跟踪滤波算法的增益矩阵k(k)：
k(k)＝pr(k|k-1)ct(k)[c(k)pr(k|k-1)ct(k) r]-1
步骤3-7、更新后验估计的协方差矩阵pr(k)：
pr(k)＝(i-k(k)c(k))pr(k|k-1)
步骤3-8、得到后验状态估计值：
进一步地，步骤4采用离散自适应鲁棒滑模控制器作为四电机伺服系统的位置控制器，控制器输出作为伺服系统的控制量，具体为：
步骤4-1：建立多电机同步驱动伺服系统的误差特征模型：
其中，
步骤4-2：设计滑模函数为：
s(k)＝e(k) βe(k-1)
步骤4-3：将控制律分为自适应补偿项uα(k)、反馈项us1(k)与鲁棒项us2(k)三项，即
u(k)＝uα(k) us1(k) us2(k)
步骤4-4：定义自适应补偿项为：
步骤4-5：设计反馈项和鲁棒项分别为：
步骤4-6：得到伺服系统离散自适应鲁棒滑模控制律为：
本发明采用基于特征模型的离散自适应鲁棒滑模方法作为多电机伺服系统的位置控制算法，可以提高伺服系统的动静态性能。设计的stf强跟踪滤波器，能够有效抑制测量噪声对系统控制性能的影响。
1.一种基于特征模型的伺服系统离散自适应鲁棒滑模控制方法，其特征在于，包括以下步骤：
步骤1、建立多电机同步驱动伺服系统动力学模型；
步骤2、依据特征建模理论，建立含测量噪声的四电机伺服系统特征模型，并采用递推最小二乘法对特征模型参数进行辨识；
步骤3、构建stf强跟踪滤波器，对测量噪声进行滤波后反馈至位置控制器；
步骤4、采用离散自适应鲁棒滑模控制器作为四电机伺服系统的位置控制器，控制器输出作为伺服系统的控制量。
2.根据权利要求1所述的基于特征模型的伺服系统离散自适应鲁棒滑模控制方法，其特征在于，步骤1所述建立含齿隙和摩擦非线性因素的多电机同步驱动伺服系统动力学模型，具体为：
步骤1-1、建立单永磁同步电机伺服系统动力学模型：
其中，uq代表电机q轴的等效电压，iq代表电机q轴的等效电流，rq代表q轴的等效电阻，lq代表q轴的等效电感，ce代表电机反电势系数，θm为电机角度；
步骤1-2、利用单电机伺服系统动力学模型构建四电机伺服系统动力学模型为：
其中：j＝1,2,3,4代表电机1、电机2、电机3和电机4；ujq(t)为电机在q轴的等效电压；ijq(t)为电机在q轴的等效电流。
3.根据权利要求1所述的基于特征模型的伺服系统离散自适应鲁棒滑模控制方法，其特征在于，步骤2所述依据特征建模理论，建立含测量噪声的四电机伺服系统特征模型，并采用递推最小二乘法对特征模型参数进行辨识，具体为：
步骤2-1、用一个慢时变的二阶差分方程表示四电机伺服系统的特征模型：
y(k)＝f1(k)y(k-1) f2(k)y(k-2) g0(k)u(k-1)
其中，y(k)为下一时刻多电机伺服系统的位置，y(k-1)为当前时刻伺服系统的位置，y(k-2)为上一时刻系统的位置；u(k)为控制量；f1(k)、f2(k)和g0(k)分别为k时刻系统特征模型的三个特征参数；
步骤2-2、考虑系统含有的测量噪声，将多电机伺服系统用含测量噪声的特征模型描述：
其中，v(k)为测量噪声；
步骤2-3、采用递推最小二乘法对特征参数f1(k)、f1(k)和g0(k)进行在线辨识：
其中，k(k)为修正的增益矩阵，λ为遗忘因子，p(k)为k时刻的递推参数矩阵，
4.根据权利要求1所述的基于特征模型的伺服系统离散自适应鲁棒滑模控制方法，其特征在于，步骤3所述的构建stf强跟踪滤波器，对测量噪声进行滤波后反馈至位置控制器，具体为：
步骤3-1、初始化时刻k、状态变量x、协方差矩阵pr；
步骤3-2、得先验估计值：
步骤3-3、将当前时刻的输出残差r(k)加入滤波器模型，进一步计算输出残差r(k)的协方差矩阵v(k)为：
其中，增加遗忘因子ρ，ρ的取值范围为0≤ρ≤1；
步骤3-4、计算渐消因子λ(k)：
λ(k)＝diag[λ1(k)λ2(k)…λn(k)]
其中，β为弱化因子，β≥1；ai为预先确定的常数项；
步骤3-5、计算k时刻先验估计的协方差矩阵，得协方差矩阵pr(k|k-1)：
pr(k|k-1)＝λ(k)φ(k-1)pr(k-1)φt(k-1) q
步骤3-6、更新强跟踪滤波算法的增益矩阵k(k)：
k(k)＝pr(k|k-1)ct(k)[c(k)pr(k|k-1)ct(k) r]-1
步骤3-7、更新后验估计的协方差矩阵pr(k)：
pr(k)＝(i-k(k)c(k))pr(k|k-1)
步骤3-8、得到后验状态估计值：
5.根据权利要求1所述的基于特征模型的伺服系统离散自适应鲁棒滑模控制方法，其特征在于，步骤4所述的采用离散自适应鲁棒滑模控制器作为四电机伺服系统的位置控制器，控制器输出作为伺服系统的控制量，具体为：
步骤4-1：建立多电机同步驱动伺服系统的误差特征模型：
其中，e(k 1)为k 1时刻的系统误差，
步骤4-2：设计滑模函数s(k)为：
s(k)＝e(k) βe(k-1)
步骤4-3：将控制律分为自适应补偿项uα(k)、反馈项us1(k)与鲁棒项us2(k)三项，即
u(k)＝uα(k) us1(k) us2(k)
步骤4-4：定义自适应补偿项uα(k)为：
步骤4-5：设计反馈项和鲁棒项为：
步骤4-6：得到伺服系统离散自适应鲁棒滑模控制律u(k)为：
