舰载稳定平台的非奇异终端滑模控制
2018-03-12张华强刘永钦史普帅冷艳礼王学义
张华强,刘永钦,史普帅,冷艳礼,王学义
(1. 哈尔滨工业大学(威海)电气工程系,山东 威海 264209;2. 黄海造船有限公司,山东 荣成 264309)
0 引 言
舰船在航行时,由于风浪或拐弯等因素,船体的姿态时刻发生变化,而测量、目标跟踪等设备需要良好的稳定姿态,因此需要借助舰载稳定平台来维持被控对象的平稳[1–2]。稳定平台的应用十分广泛:汽车上使用稳定平台,可以隔离因道路不平造成对运输物品的摇晃;航拍飞行器上使用稳定平台,可以隔离因气流冲击而造成对相机等设备的影响;舰船上使用稳定平台,能够消除船体在风浪或拐弯航行时受到的扰动,稳定舰船上的手术床、雷达等设备[3–5]。
1 舰载稳定平台的动态结构模型
本文研究的舰载稳定平台为包含航向轴和俯仰轴的双轴转台,使用的是永磁直流力矩电机。永磁直流力矩电机,假设电流连续,则动态电压方程为:
忽略粘性摩擦和弹性转矩,电机轴上的运动方程为:
式中:TL为含空载转矩在内的负载转矩,N·m;GD2为电力拖动装置折算到电机机轴上的飞轮矩,N·m2。
定义电枢回路的电磁时间常数(s):
电力拖动系统的机电时间常数(s):
将式(3)和式(4)代入式(1)和式(2),得
式中,IdL为负载电流,A。
在零初始条件下,对式(5)和式(6)两侧进行拉氏变换,可得电压与电流的传递函数为:
电流与电动势间的传递函数为:
将直流电机用于伺服控制系统,角速度对时间积分后变成位置信号θ(rad),再将位置单位转换为“度”,将角速度转换为转速,即
将式(9)拉氏变换可得:
额定励磁下,由直流力矩电动机组成的舰载稳定平台动态结构模型如图1所示。
2 传统滑模控制
如图1所示,直流电机动态模型的电压与电流关系为:
图 1 舰载稳定平台的动态结构模型Fig. 1 Dynamic structure model of shipborne stable platform
直流力矩电机模型变为如图2所示。
取位置、转速、电流为状态变量,输入电压、负载转矩为输入变量,则图2可转换为状态框图,如图3所示。
图 2 直流电机模型展开图Fig. 2 DC motor model development diagram
图 3 直流电机的状态转换图Fig. 3 State transition diagram of DC motor
由图3可写出状态方程,如式(12)所示。
忽略摩擦阻力和空载转矩时,状态方程如式(13)所示。
该系统的一般形式为:
设滑模切换函数为:
选择指数趋近律[6]:
根据滑模切换函数的定义,得
整理后,控制器表达式:
3 非奇异终端滑模控制
传统的滑模算法会导致控制器输出时,产生高频电流抖动,使转台电机电流在设定值附近有高频振荡,转台的稳定性不好。
给出新的滑模切换函数如下:
设计新的控制器:
式中:T,kT,η为大于0的常数。
根据式(19)和式(20),滑模切换函数改写为:
把式(22)代入式(27),得
把式(23)代入式(28),得
根据式(24)、式(25)和式(26),得
构造李雅普诺夫函数为:
则函数导数为:
将不等式(33)代入式(32),得
由式(34)可知系统满足李雅普诺夫稳定条件,系统可以在有限时间内进入稳定状态[7]。
新的控制方法通过非奇异终端滑模控制,消除了控制器输出的高频电流抖动,克服了传统滑模控制的缺点。
4 仿真分析
4.1 传统滑模控制仿真分析
为了验证算法的有效性,使用Matlab对舰载稳定平台的模型进行传统滑模控制的仿真分析。
舰载稳定平台采用的电机是宇捷直流力矩电机,型号:NH250LYX-M300-E60,其参数如表1所示。
使用极点配置方法设计滑模平面,得到滑模切换函数:
代入数据得到控制器的表达式如下:
表 1 舰载稳定平台NH250LYX-M300-E60型电机参数Tab. 1 Ship-borne stability platform NH250LYX-M300-E60 motor parameters
取k=20时,系统具备良好的趋近速度,由于滑模切换函数使用的是偏差量,整体抖动不大此处取η=5。电力电子变换器的放大倍数为6,故控制器输出应缩小1/6并限幅输出±10 V。用Matlab进行阶跃特性仿真,给定36°时的仿真结果如图4所示。
从图4可以看出,传统滑模控制器可以使位置达到设定目标,并且在稳态值附近只有微幅低频摆动。但是电流波形、切换函数、控制器输出形成了高频抖动,这种高频抖动可能损坏舰载稳定平台的机械结构,大大降低了稳定平台的寿命。
4.2 无抖动滑模控制仿真分析
5 双轴舰载稳定平台试验研究
舰载稳定平台如图6所示,包含航向轴和俯仰轴2个电机。当船体随着波浪或拐弯发生倾斜时,通过调节平台2个轴,维持平台水平和稳定。舰载稳定平台要求伺服系统有较好的快速性和稳定性。平台采用的电机参数如表1所示,平台伺服控制器基于STM32-F407VET6设计,上位机基于Labview平台设计。
由于高频抖动会对舰载稳定平台造成一定程度的损坏,因此,只对无抖动滑模控制进行试验研究。给定转台一个阶跃位置信号,测量得到其响应波形如图 7 所示[8]。
平台旋转一周编码器输出的脉冲数量是80 000,从图7 (a)中可以看出,位置相应可以快速达到给定目标,在给定值附近的抖动不会超过10个脉冲(合0.045°),电流的抖动只有小于0.04 A的低频抖动,对于转台的影响基本可以忽略。
图 4 滑模控制下的转台阶跃特性仿真结果Fig. 4 Simulation results of turntable step characteristic under sliding mode control
海洋波浪的平均周期大约在1~10 s[9],为了模拟舰载平台在波浪中的稳定特性,使平台航向轴和俯仰轴同时在无抖动滑模控制算法下,跟随周期为10 s、幅度为5°的正弦波信号。由于2个轴的试验结果相同,故只给出航向轴的试验结果,如图8所示[8]。
从图8中可以看出,航向轴最大跟随误差约为80(合0.36°),即稳态误差为0.1%。基于非奇异终端的滑模控制具有快速的跟随性能和良好的稳定性能。
图 5 无抖动滑模控制仿真结果Fig. 5 Simulation results of chatting-free sliding mode control
图 6 双轴舰载稳定平台Fig. 6 Biaxial ship-borne stability platform
图 7 转台滑模控制阶跃响应调试结果Fig. 7 Turntable sliding mode control step response debug result
当船舶在海浪中航行时,船体随着波浪摆动,舰载稳定平台通过反向调整,跟随转动,使平台维持水平状态,并且消除了高频抖动,保护了舰载稳定平台的机械结构,增加其寿命。
6 结 语
本文建立了舰载稳定平台的数学模型,基于STM32F407VET6和Labview设计了双轴舰载稳定平台
伺服控制系统,通过仿真验证了非奇异终端滑模控制的理论可行性,通过双轴舰载稳定平台试验研究验证了非奇异终端滑模控制可以解决平台的高频抖动问题,并且具有良好的精度和跟踪性。
图 8 转台滑模控制模拟跟随调试结果Fig. 8 Turntable sliding mode control simulation follow the debugging results
[1]陈松林, 单梅林, 王丽斌. 基于干扰观测器的飞行仿真转台完全跟踪控制[J]. 电机与控制学报, 2015, 19(1): 113–118.
[2]HILKERT J M. Inertially stabilized platform technology concepts and principles[J]. IEEE Control System Magazine, 28,Febrary 2008: 26–46.
[3]李猛. 两轴船载稳定平台控制系统设计与研究[D]. 哈尔滨: 哈尔滨工业大学, 2015: 1–5.
[4]EYYUP S, TUNA B, BULENT E P. Compensation of friction effects in gyro-stabilized motion platforms[C]// American Control Conference. Chicago, IL, 1–3 July. 2015: 3242–3248.
[5]余珊珊, 夏军. 光纤陀螺在机载光电稳定平台中的应用[J]. 电子质量, 2015(5): 30–32.
[6]齐亮. 基于滑模变结构方法的永磁同步电机控制问题研究及应用[D]. 上海: 华东理工大学, 2013: 7–10.
[7]Y FENG, X YU, Z MAN. Nonsingular terminal sliding mode control of rigid manipulators[J]. Automatica, 2002, 38(12):2159–2167.
[8]史普帅. 基于船载稳定平台的伺服控制系统研究[D]. 威海: 哈尔滨工业大学, 2016.
[9]毕凡. 波浪对环流输运影响和涌浪传播耗散特征研究[D]. 青岛: 中国海洋大学, 2013.