车载升降式光电云台共振抑制方法研究

李绍军，李英杰，李 威，徐 哲，王国右，徐 妍，荆凡胜

车载升降式光电云台共振抑制方法研究

李绍军，李英杰，李 威，徐 哲，王国右，徐 妍，荆凡胜

（北方信息控制研究院集团有限公司，江苏 南京 210000）

为避免视场遮挡，光电云台通常置于升降式桅杆顶端，桅杆的结构刚度将直接影响云台伺服系统的刚度，继而影响云台动态性能。实际使用时发现，由于桅杆刚度不足导致云台在方位向转动过程中极易发生共振，引起云台工作不稳定。针对该问题文中先后引入巴特沃斯低通滤波器、陷波滤波器和线性自抗扰控制方式对升降式光电云台共振现象进行抑制，通过对比三种方式的优缺点发现采用线性自抗扰控制方式具有响应速度快、共振抑制效果好、鲁棒性好的优点，适宜应用于升降式光电云台控制系统。

光电云台；升降式桅杆；巴特沃斯滤波器；陷波滤波器；线性自抗扰控制

0 引言

侦察车辆通常装备有集成高清CCD摄像机、红外热像仪的光电云台，以便于昼夜实时获取侦察车辆周边态势。为了减少观察盲区，获取更远范围的视场，通常将光电云台置于升降式桅杆顶端。受限于重量、成本和技术限制，升降式桅杆一般都为空心结构，这导致桅杆结构刚度明显低于车辆安装基面。光电云台安装于桅杆顶端后，云台方位向的加减速切换以及不同的速度控制方式易使桅杆产生挠曲变形[1]，载体车辆发动机的振动也会传递到桅杆上，这将加剧桅杆振动，导致光电云台视场模糊，严重时甚至导致光电云台转动异常。

通过对光电云台共振原因进行分析，结合观测到的光电云台共振时的速度时域波形，对升降式光电云台的共振现象有了进一步认识。为了解决这一问题，文中分别采用了速度环添加巴特沃斯低通滤波器、速度环添加陷波滤波器、速度环采用自抗扰控制方式来抑制共振。实验结果表明采用自抗扰控制方式可以实现在无需降低光电云台动态性能的前提下，仍能具有良好的共振抑制效果。

1 共振原理分析

光电云台安装于倒伏升降式桅杆顶部，倒伏升降式桅杆基座安装于车辆载体表面，系统安装连接关系示意图如图1所示。

图1 系统安装连接关系示意图

云台方位电机采用了正弦波永磁同步电机，由于云台重心与桅杆轴向不一定完全重合以及桅杆自身结构刚度不足，当云台方位向转动时，桅杆会不可避免地产生柔性形变，此时可将桅杆和光电云台统一视为一个二质量柔性伺服系统进行分析[2]，该简化模型如图2所示。

图2 二质量柔性伺服系统等效示意图

电机和负载侧动力学方程：

式中：e为电机输出转矩；s为连接轴转矩；L为负载扰动转矩；M为电机惯量；L为负载惯量；1为电机转角；s为连接轴转角；2为负载转角；1为电机转速；2为负载转速；1为电机阻尼系数；s为连接轴阻尼系数；2为负载阻尼系数；s为连接轴刚度系数。

忽略电机、负载的阻尼系数以及负载的扰动转矩影响，由式(1)可得到负载转速和电机转矩的传递函数为：

2 共振抑制方式介绍

2.1 速度环添加巴特沃斯滤波器

巴特沃斯滤波器在相同阶数的滤波器中，具有最大斜率的衰减，且在波特图幅频特性中不产生凸峰，因此在控制系统中被经常采用[4]。文中采用阻尼比为0.707的二阶巴特沃斯低通滤波器为：

将巴特沃斯滤波器添加到速度环中，用于对采用M法（即通过在固定时间间隔获得的转角差值求商）取得的电机转速进行滤波，如图3所示。

图3 巴特沃斯滤波器使用原理

Fig.3 Butterworth filter usage principle

2.2 速度环添加陷波滤波器

陷波滤波器是一种带阻滤波器，它可将陷波中心频率附近的频率点的输入幅值衰减到对系统的影响最小，而对陷波频带以外的频率信号基本没有影响[5]。因此是一种得到广泛应用的机械共振抑制方法。一种常用的陷波滤波器传递函数表达式为：

式中：n为陷波频率；为陷波滤波器的陷波带宽；为陷波滤波器的陷波深度。

n的值应根据系统共振频率进行调整，以使得陷波滤波器可以将共振频率抑制住；通过调整陷波带宽值和陷波滤波器深度可以影响陷波滤波器作用频带宽窄和幅频特性下陷深度深浅；应合理设置这3个值，使陷波滤波器既能有效抑制共振频率又能对其他频率不产生影响[6]。

将陷波滤波器串入速度环输出环节如图4所示，以整定速度环输出即电流环的给定输入，实现抑制光电云台机械共振的目的。

图4 陷波滤波器使用原理

2.3 速度环添加自抗扰控制

将速度环控制律由比例积分（proportional integral, PI）控制器方式改为线性自抗扰控制方式（linear active disturbance rejection control, LADRC），光电云台控制原理如图5所示。

LADRC的优势在于它将系统内外部的各种扰动和未知量统一视为一个总扰动，通过一个线性扩张状态观测器去估计该总扰动，并通过控制律实时进行补偿[7-8]。而升降式光电云台的共振扰动可视为一个未知的扰动量，可通过LADRC方式对其进行抑制。

图5 速度环采用LADRC方式原理

式(2)可改写为：

式中：为电机转速2；为电机转矩e；系统为外部扰动量。

式(5)可进一步改写为：

对应可建立系统的扩张状态观测器为：

控制律采用的比例微分控制器为：

3 测试结果

光电云台方位向采用J110LWX004型无刷力矩电机和J90XFS001型双通道旋转变压器，采用的电机和旋转变压器参数见表1。

表1 电机和旋转变压器参数

速度环给定转速*＝5°/s，测试速度环采用PI控制器和负载速度反馈采用250Hz一阶低通滤波器时处于升起状态下光电云台方位向速度响应情况，速度环响应曲线如图6所示。

可见转速达到5°/s后，云台迅速进入了共振状态，已经无法正常工作。

速度环仍采用PI控制器，负载速度反馈采用二阶250Hz巴特沃斯滤波器后，处于升起状态下光电云台方位向速度响应曲线如图7所示。

图6 PI＋一阶250Hz低通滤波器速度响应曲线

图7 PI＋二阶250Hz巴特沃斯滤波器速度响应曲线

可见云台方位速度环共振现象有所减弱，但云台仍处于共振状态不能正常工作。

将巴特沃斯滤波器截止频率设为60Hz后，分别测试云台给定速度为0.5°/s、5°/s、30°/s时云台方位向速度响应曲线，如图8所示。0.5°/s子图中小图为稳态误差段局部放大图。5°/s、30°/s子图中左侧小图为上升时间段局部放大图，右侧小图为稳态误差段局部放大图。

可见此时云台方位向均可以正常工作，阶跃响应超调和稳态误差都较小，但较小的滤波频率会影响云台的动态性能，实际会影响云台方位向刚度。

由图6，通过离线分析，速度环共振频率约为170Hz，设计共振频率点为170Hz，带宽20Hz，深度－60db的陷波滤波器。速度环采用PI控制器和负载速度反馈采用200Hz一阶低通滤波器时，速度环串入该陷波滤波器后，采集处于升起状态下光电云台方位向给定速度分别为0.5°/s、5°/s、30°/s时的速度响应情况，速度环响应曲线如图9所示。5°/s子图中左侧小图为上升时间段局部放大图，右侧小图为稳态误差段局部放大图。

图8 PI＋二阶60Hz巴特沃斯滤波器速度响应曲线

图9 PI＋陷波滤波器速度响应曲线

可见速度环在转速较低时尚能保持正常运行，一旦转速较高受到较强激励时很容易再次发生共振。随着云台方位向的转动，云台方位向运行位置的共振频率点有所变化，使云台难以保持在其他位置也正常运行，单纯的陷波滤波器难以适应该系统的要求。也可通过在方位向多个位置进行共振频率测定方式，标注多个共振频率点，但随着桅杆长时间使用后结构上进一步松动老化，共振频率又会发生变化，难以保证光电云台系统持续运行正常。

可见云台方位向工作正常，没有发生共振现象。

分别对比给定速度为0.5°/s、5°/s、30°/s时，采用LADRC＋一阶250Hz低通滤波器方式、采用PI控制器＋二阶60Hz巴特沃斯滤波器方式、采用PI控制器＋陷波滤波器方式时的速度阶跃响应曲线，对比结果如表2所示。

由于给定速度为0.5°/s时，响应曲线稳态误差较大，因此此时仅对比响应快慢，不给出具体量化结果。由于使用陷波滤波器时，给定速度为30°/s时，系统发生共振，不给出此时的具体量化结果。

速度环采用LADRC控制器和负载速度反馈采用250Hz一阶低通滤波器时，采集处于升起状态下光电云台方位向给定速度分别为0.5°/s、5°/s、30°/s时的速度响应情况，速度环响应曲线如图10所示。5°/s、30°/s子图中左侧小图为上升时间段局部放大图，右侧小图为稳态误差段局部放大图。

可见采用LADRC＋一阶250Hz低通滤波器方式响应速度优于其他两种方式。在稳态误差上采用LADRC＋一阶250Hz低通滤波器方式略大于采用PI控制器＋二阶60Hz巴特沃斯滤波器方式，实际中可以考虑LADRC与二阶巴特沃斯滤波器方式进行结合使用。

表2 不同给定转速阶跃响应情况对照表

通过在云台方位轴心20cm处增加一个2kg的配重测试采用LADRC＋一阶250Hz低通滤波器方式时系统的鲁棒性，给定速度为0.5°/s、5°/s、30°/s时，增加配重前后阶跃响应对比情况如图11所示。5°/s、30°/s子图中左侧小图为上升时间段局部放大图，右侧小图为稳态误差段局部放大图。

图10 LADRC＋一阶低通滤波器速度响应曲线

图11 采用LADRC增加配重前后速度响应曲线

在不同的给定速度下，增加配重前后的速度阶跃响应超调有所增加，给定转速为5°/s时超调增加了5%，给定转速为30°/s时，超调增加了2.6%。调节时间和稳态误差基本一致。

通过将给定速度分别置为5°/s、10°/s、－0°/s和－5°/s，观察增加配重前后系统的动态响应情况，如图12所示。

结合图11、图12综合对比，可见采用LADRC方式当系统发生结构变化也能以较好的性能正常工作，具有较好的鲁棒性。

图12 采用LADRC增加配重前后变速响应曲线

4 结束语

文中针对车载升降式光电云台在桅杆升起后云台方位向转动时容易共振的情况，通过对比巴特沃斯滤波器、陷波滤波器和自抗扰控制方式对云台共振的抑制效果，总结出了适用于车载升降式光电云台共振抑制的方法，可在升降式光电云台使用领域得到广泛应用。

[1] 付存银, 丁少华, 王兆基, 等. 堆垛机速度控制与立柱动态挠曲变形分析[J]. 机械设计与制造, 2019(6): 247-251. FU Cunyin, DING Shaohua, WANG Zhaoji, et al. Single mast stacker crane speed control and stand column dynamic flexure deformation analysis[J]., 2019(6): 247-251.

[2] 龚文全, 曾岳南, 黄之锋, 等. 基于改进型陷波器的伺服系统谐振抑制研究[J]. 机电工程, 2018, 37(7): 845-850. GONG Wenquan, ZENG Yuenan, HUANG Zhifeng, et al. Resonance suppression of servo system based on improved notch filter[J]., 2018, 37(7): 845-850.

[3] 龚文全, 罗炳章. 基于自适应陷波滤波器的伺服系统谐振频率估计及抑制[J]. 电机与控制应用, 2019, 46(11): 37-42, 93. GONG Wenquan, LUO Bingzhang. Resonance frequency estimation and suppression of servo system based on adaptive notch filter[J]., 2019, 46(11): 37-42, 93.

[4] 乔治.埃利斯. 控制系统设计指南[M]. 北京: 机械工业出版社, 2016. George Ellis.[M]. Beijing: China Machine Press, 2016.

[5] 郭高洁. 伺服控制系统谐振实时抑制方法探究[D]. 北京: 中国科学院大学, 2018. GUO Gaojie. Online resonance suppression exploration of Servo system[D]. University of Chinese Academy of Sciences, 2018.

[6] 黄正敏. 滚珠丝杠进给系统二阶陷波滤波抑振法研究[D]. 武汉: 华中科技大学, 2019.HUANG Zhengmin. Research on Second-order Notch Filter Vibration Suppression Method of Ball Screw Feeding System[D]. Wuhan: Huazhong University of Science and Technology, 2019.

[7] ZHAO Shen, GAO Zhiqiang. An active disturbance rejection based approach to vibration suppression in two-intertia systems[J]., 2013, 15(2): 350-362.

[8] 李英杰, 李绍军, 蒋鹏, 等. 一种高精度船只目标光电定位系统设计与实现[J]. 红外技术, 2023, 45(10): 1090-1095.LI Yingjie, LI Shaojun, JIANG Peng, et al. Design and implementation of a high-precision ship target photoelectric positioning system[J]., 2023, 45(10): 1090-1095.

Resonance Suppression Method of Vehicle Mounted Lifting Photoelectric Platform

LI Shaojun，LI Yingjie，LI Wei，XU Zhe，WANG Guoyou，XU Yan，JIN Fansheng

(..,210000,)

To avoid obscuring the field of view, a photoelectric platform is usually placed on top of a lifting mast. The structural stiffness of the mast directly affects the stiffness of the photoelectric platform servo system and its dynamic performance. In actual use, it is deduced that an insufficient stiffness of the mast causes the photoelectric platform to resonate easily in the process of azimuthal rotation, causing it to work unstably. To solve this problem, a Butterworth low-pass filter, notch filter, and linear auto disturbance rejection control mode are introduced successively to suppress the resonance phenomenon of the lifting photoelectric pan tilt table. By comparing the advantages and disadvantages of the three methods, it is concluded that the linear ADRC method has the advantages of fast response, good resonance suppression effect, and good robustness, and is suitable for the control system of the lifting photoelectric photoelectric platform.

photoelectric platform, lifting mast, Butterworth filter, notch filter, LADRC

TN06

A

1001-8891(2024)04-0406-07

2022-12-06；

2024-04-06.

李绍军（1989-），男，硕士，从事云台伺服控制技术研究。E-mail：lsj_gdsf@163.com。