0.   引言

机载三轴稳定平台广泛应用于遥感成像领域，其主要作用就是隔离载机运动等因素带来的扰动，减小飞行器姿态角带来的变化，保证成像质量^[1]。现需研制一台具有高精度的三轴稳定平台，使搭载在平台上的垂视相机和高光谱相机两种线阵相机工作在稳定的成像环境中，获得高质量的图像数据。

传统的机载三轴平台机械传动往往采用电机直驱或带有减速箱的传动机构。这些方式均不能满足成像载荷质量大，稳定平台质量小于59.8 kg的指标要求。钢丝绳传动具有高精度、低空回、重量轻等特点，所以采用了钢丝绳传动机构。但是钢丝绳传动会带来一定的柔性传动，在线阵相机成像这种高精度的场合往往不能忽略，会带来图像的抖动和畸变。传统的PID（proportion integration differentiation）控制很难满足高成像质量的要求，张洪文针对某遥感扫描组件消旋组件同步提出双电机驱动，采用独立的位置环和速度环控制钢丝绳传动，同步精度达到了0.5 mrad^[3]；谢宏伟在实验中确定了预紧力、负载、绳组数、转速对传动精度的影响^[4]。但是以上稳定平台的成像载荷均比较小，没有明显暴露出钢丝绳传动的缺点，在这次实际工程中，两个成像载荷的重量高达21.3 kg，稳定精度的技术指标为0.35mrad，对控制算法的设计提出更高的要求。

本文主要是为了改善钢丝绳传动的三轴转台非线性干扰，设计出一种模糊自适应和前馈复合控制的策略，最后通过仿真和实验验证该控制策略的有效性。

1.   控制系统的数学模型

1.1   钢丝绳传动系统的建模

本实验的稳定平台都是小幅有限角运动，钢丝绳机构如图 1所示，结构图如图 2所示，采用ROT-LOK型结构^[3-4]。在往复运动中，钢丝绳上不断变化的张力会对传动系统引入传动空回。

图  1  钢丝绳传动示意图

Figure  1.  Wirerope transmission diagram

下载: 全尺寸图片 幻灯片

图  2  钢丝绳传动结构图

Figure  2.  Schematic representation of wirerope transmission

下载: 全尺寸图片 幻灯片

根据结构的空间和刚性选择4组绳组数，被动轮上每组钢丝绳的一端都串联预紧弹簧用以调节钢丝绳的预紧力，可以在实验中精确地调节弹簧的长度来选取合适的预紧力^[5-6]。钢丝绳上的预紧力为F_p，负载力为F_l，钢丝绳的变形量为δ，被动轮与主动轮的半径是R_o, R_i，AE是刚度即横截面积与弹性模量的乘积，μ为摩擦系数，钢丝绳的模型为：

则钢丝绳的传动空回e为：

1.2   直流电机模型

机载三轴稳定平台会涉及到多框架耦合等问题，但本文研究的是钢丝绳传动对伺服造成的影响，所以等效为3个相同的控制系统进行设计，由电机的工作原理可以推出电压平衡方程^[7]：

式中：U_d为电枢两端电压；L、R、I_d分别为电枢回路等效的总电感、电阻、电流；K_i为电流反馈系数；C_e是伺服电机电动势系数；$ {\dot \theta _{\text{m}}} $和θ_m是电机输出轴的转速和转角。

直流伺服电机的动力学方程可以写为：

式中：k_ti为电磁转矩；k_t为电机的转矩系数；电动机输出轴的转动惯量为J_m；电机的粘性阻尼系数为b_m；K_L为电机和框架的耦合刚度系数；$ {\dot \theta _{\text{L}}} $和θ_L为负载的转速和转角。此系统的负载的转动惯量大以及精度要求高，所以将电机和惯性负载视为二质量系统进行建模分析^[8]。设负载的黏性阻尼系数为b_L，T_mL为负载输出力矩，可以得知负载的数学模型如下：

在仿真中将脉冲宽度调制（Pulse Width Modulation，PWM）环节近似的等效为一个比例环节，置为k_u；速度环放大系数为k_s；反馈系数为K_v。

1.3   建立摩擦模型

在伺服系统中，摩擦模型的建立相当重要，根据相关文献，仿真建立了较为经典的Lugre模型^[9]。设状态变量z代表接触面鬓毛的平均变形，Lugre的数学模型可由下式表示：

式中：σ₀与σ₁为动态摩擦参数，其中σ₀为刚毛的刚性系数，σ₁为滑动阻尼系数。F_c、F_s、α、v_s为静态摩擦参数，其中F_c为库仑摩擦；F_s为静摩擦；α为粘性摩擦系数；v_s为stribeck特性阶段的动静切换速度，而本文针对项目情形进行了实测，得出相关参数的具体数值。

2.   控制器设计

2.1   模糊自适应控制设计

由于机载平台的特点，传统PID控制难以满足其精度要求，实验设计了模糊自适应PID控制器。其结构如图 3所示。

图  3  模糊控制原理结构图

Figure  3.  Fuzzy control principle structure diagram

下载: 全尺寸图片 幻灯片

从结构图可以看出模糊控制采用两输入三输出二维模糊控制模块，以摆扫速度误差e和误差变化率d_e为输入语言变量，以Δk_p, Δk_i, Δk_d为输出语言变量。对于每个状态的3个参数，有：

输入变量e和d_e的模糊集合可以划分为{NB, NM, NS, Z, PS, PM, PB}，输出变量Δk_p, Δk_i, Δk_d的论域划分和输入变量的划分是一致的。输入输出变量边缘采用高斯隶属函数曲线，其余部分采用三角形隶属函数曲线如式(14)：

e和d_e分别有7个论域，故一共有49条控制规则，可以根据相应领域专家的技术和经验编写控制规则表^[10-12]。

2.2   前馈补偿控制设计

前馈控制的引入就可以直接将干扰引入到控制装置，在控制系统中同时使用前馈控制加反馈控制的方法称为复合控制^[12-14]。

实际钢丝绳传动会引起一定的滞后，前馈补偿基于不变性原理，通过前馈补偿环节把可以测量的扰动误差引入到控制器的设计中，从而能很好地抑制干扰，减小系统的误差，控制模型如图 4所示。

图  4  模糊自适应前馈控制框图

Figure  4.  Block diagram of fuzzy adaptive feedforward control

下载: 全尺寸图片 幻灯片

采用基于输入的自适应前馈补偿来提高伺服系统的性能，可以求得：

式中：G₁为电机机电部分和负载的等效传递函数；G_r为前馈补偿装置的传递函数。

3.   三轴转台模糊自适应前馈控制仿真

3.1   三轴转台的参数分析

在本次实验中，所用电机参数如下：L＝2.2 mH，R＝10 Ω，k_t＝2.1 N·m/A，C_e＝2.1 V/(rad/s)，J_m＝0.0037 kg·m²，J_L＝7.91 kg·m²，b_m＝0.01，b_L＝15.0，K_i＝0.001，K_L＝6.0；摩擦模型参数：σ₀＝2600，σ₁＝25，α＝0.2，F_c＝5.2，F_s＝6.4，v_s＝0.01；钢丝绳选用的是SUS304材质，直径1 mm，它的实际参数是μ＝0.0015，AE＝8×10³；在调试平台时，测得预紧力F_p＝21.3 N效果最好；PWM环节放大倍数k_u＝11，速度环放大倍数k_s＝6，反馈系数K_v＝2；PID控制器3个参数k_p＝100，k_i＝1.0，k_d＝50；根据以上相关参数求出前馈部分传递函数：

前馈控制的输入是根据飞机上的主惯导获得数据，经过控制板处理之后用来补偿飞机姿态，由于条件限制，仿真的时候所用的是以前在飞机下载的惯导数据。基于传统PID控制仿真模型和模糊自适应PID前馈补偿控制仿真模型框图如图 5、图 6所示。

图  5  传统PID控制仿真模型

Figure  5.  Traditional PID control simulation model

下载: 全尺寸图片 幻灯片

图  6  模糊自适应PID前馈补偿控制仿真模型

Figure  6.  Fuzzy adaptive PID feedforward compensation control simulation model

下载: 全尺寸图片 幻灯片

3.2   三轴转台仿真结果分析

运行仿真得到的仿真曲线如图 7，采用传统PID控制，在速度过零点时，波形明显发生畸变，出现位置跟踪“平定”现象和速度跟踪“死区”现象，位置跟踪出现很大的滞后。而采用了模糊控制PID控制器和前馈控制符合的控制算法，消除了“平定”和“死区”现象，对系统滞后明显改善，响应速度更快。

图  7  仿真结果图

Figure  7.  Simulation result graph

下载: 全尺寸图片 幻灯片

4.   实验

4.1   摇摆台抗干扰实验

钢丝绳传动误差是制约伺服性能的关键，传动误差是指当输入轴单向转动时，输出轴的实际值对理想值的误差，在摇摆台实验室，模拟飞机环境对稳定平台进行实验测量，图 8是平台测试情况，在稳定平台横滚框架安装平面反射镜，横滚框架位于零位，反射镜与地面平行，在反射镜正下方放置自准直仪，自准直仪精度设置为1 μrad，俯仰轴以0.3°，0.5 Hz摆动。用传统PID控制和模糊自适应前馈控制算法分别测试曲线如图 9。从输出曲线可以看出，传统PID存在很大的抖动，传动精度在1mrad，而模糊自适应前馈控制传动精度达到了0.2 mrad，很大地改善了钢丝绳对系统带来的抖动，能达到指标要求。

图  8  摇摆台实验设备示意图

Figure  8.  Schematic diagram of swing table experimental equipment

下载: 全尺寸图片 幻灯片

图  9  自准直仪输出曲线

Figure  9.  Autocollimator output curves

下载: 全尺寸图片 幻灯片

4.2   速度稳定性实验

用平行光管模拟无穷远处，设备摆放如图 10，稳定平台俯仰框架以固定速度摆扫，相机通过反射镜对靶标进行成像，平行光管采用模块化光电测试系统METS L19型号，分辨率靶标选择使用美军标USAF1951分辨率靶。拍出的靶标如图 11所示。图 11(a)采用传统PID控制拍出来的靶标，存在抖动弯曲的现象，用Matlab查看每行相差两个像素，相机角分辨率为10 μrad，而图 11(b)采用模糊自适应前馈控制算法拍出来的靶标用Matlab查看靶标每行像素是基本一致的，满足指标要求。

图  10  平行光管实验

Figure  10.  Schematic diagram of collimator experiment

下载: 全尺寸图片 幻灯片

图  11  靶标对比图

Figure  11.  Target comparison chart

下载: 全尺寸图片 幻灯片

4.3   实验结果分析

在摇摆台模拟飞机环境做的抗干扰实验，将控制系统的稳定精度从1 mrad改善到0.2 mrad，在速度平稳性实验中，采用平行光管测靶标成像的方式，采用复合控制的算法能较好地改善钢丝绳带来的速度抖动性，以上实验与仿真结果也相吻合，仿真和实验都说明了采用复合控制策略较传统PID对控制精度带来了大幅的改善，可以为以后类似的工程提供参考。

5.   结论

本文针对采用钢丝绳传动的大质量线阵相机的伺服控制精度，提出模糊自适应PID前馈补偿的复合控制策略，将按输入设计的前馈控制方法与模糊自适应控制结合起来，通过仿真和实验证明，该策略能够有效地消减钢丝绳传动误差，平台稳定精度从1 mrad提高到0.2 mrad，满足了成像的指标要求。