基于机载光电成像系统光学铰链离轴的伺服抗扰算法设计

2020-06-06白志刚戴凌冉杨光海

计算机测量与控制 2020年5期

白志刚，戴凌冉，吴晔，钟宁，杨光海

(1.空装驻成都地区第五军事代表室，成都 610041; 2.西南技术物理研究所，成都 610041)

0 引言

机载光电成像系统(以下简称系统)安装于飞机上，用于对地面或空中目标进行搜索、识别、跟踪和指示、侦查、评估、取证等，具有广泛的应用领域，从机载光电成像系统的使用上看，一方面要求系统具有稳定的控制，另一方面也要求具有高精度的跟踪性能。小型化是其未来发展的方向之一，本文所涉及的系统即为一款小型化系统，该系统主要包含光学系统、光电探测器、二轴伺服控制系统等。为减小系统的外形尺寸，采用了光学铰链与伺服框架轴非正交的离轴设计，部分光路既不与框架轴平行，也不与框架轴垂直，给光轴指向控制及卸载飞机扰动的稳定控制带来了一定的困难，本文着重从稳定控制的角度给出抗飞机角运动扰动的算法推导及实验室验证情况。

1 系统概述

1.1 光电成像系统分类

光电成像系统是通过相应光学器件把景物成像于光电接收器上，是一个对整个机载探测系统性能有着极其重要影响的系统。系统按照对应接收光的波长范围可以分为可见光系统、紫外光系统、红外光系统和X光系统；按照光学物镜系统可以分为折射式系统、反射式系统和折反式系统。本文所讨论的光电成像系统采用的是反射式光学系统。

1.2 系统光学铰链离轴特点

在本系统中，入射的近似平行光经二维扫描反射镜(以下简称一反)反射进入固定反射镜(以下简称二反)，光线经二反反射进入光学镜头及光电探测器，再通过伺服控制系统驱动一反运动。该伺服控制系统为航向、俯仰两轴正交结构，航向框架为外框架，俯仰框架为内框架。当伺服框架运动时，带动一反围绕一反镜面中心进行航向、俯仰二自由度转动，从而将外部不同空间角度上的景物经由固定反射镜(二反)反射到光电探测器[1]。本系统安装到载机上后，伺服航向轴与载机航向轴平行，伺服俯仰轴平行于一反镜面且位于镜面内，伺服航向轴处于零位时伺服俯仰轴与载机俯仰轴平行。

通常基于反射式光学系统的伺服平台设计都是一反入射光与内框轴垂直，同时一反出射光与外框轴平行。由于本系统后端长度尺寸受载机结构空间限制，光电成像系统在结构设计上进行了特殊处理，将一反中心与二反中心连线相对伺服航向轴前倾30°，在一反相对载机位置不变的情况下将光学镜头和光电探测器向前布局，适当利用了载机前端富余空间，减小了系统后端长度方向的尺寸，但由此带来伺服航向轴与一反出射光不平行的问题，即所谓的“光学铰链离轴”问题，此时航向、俯仰框架轴的运动形成耦合，不能形成单通道独立控制，相应地，在系统伺服控制上需要进行匹配设计和额外的算法处理。

系统光路及伺服框架轴的关系如图1所示，结构三维模型剖视图如图2所示。

图1 光电成像系统光路与框架轴关系示意图

图2 结构三维模型剖视图

1.3 系统控制回路特点

由于系统的外形尺寸的限制，在光学铰链离轴的条件下，系统控制回路只能采取半捷联设计方案[2-4]，取消了速率陀螺元件，通过对惯导姿态信息进行数学解算达到控制目的，但保留了与陀螺稳定平台相同的伺服框架，其稳定控制回路(单通道)构成如图3所示。与通常陀螺信号反馈的直接稳定回路相比，该回路有两点不同，一是反馈信号使用的是经微分处理后的伺服框架角信号，即框架角速度；二是指令信号中叠加了经抗扰算法处理的飞机载体三轴角速度信号。框架角速度的获取可以采用数字差分方法，也可采用TD跟踪微分算法等其它方法，但需要注意所需信号带宽的截取，同时，由于采用微分处理方式，得到的框架角速度信号在某些固定频率点存在一定的放大，需要数字陷波器对其进行抑制；抗扰算法处理则将当前载体三轴角速度结合伺服框架角解算出卸载载体扰动所需要的框架角速度，并与外回路给定的惯性空间“角速度指令”叠加，共同作为稳定回路的期望值，为了达到良好的稳定精度，需要对微分算法模块输出的框架角速度信号与抗扰算法输出的期望框架角速度信号进行匹配滤波，使两者在幅频、相频特性尽可能逼近。

图3 光电成像系统稳定控制回路图

本文以下介绍的重点内容为图3中“抗扰算法”部分。

2 抗扰算法设计

2.1 坐标系及符号定义

为方便进行运动学分析和抗扰算法推导，对本机载光电成像系统定义如下坐标系：

载体坐标系o1x1y1z1——与载体固联的坐标系，原点o1位于载体质心，o1x1轴与载体纵对称轴一致且指向头部，o1y1轴垂直于o1x1轴且在载体纵对称面内指向上方，o1x1y1z1构成右手正交坐标系；

一反坐标系oTxTyTzT——与一反固联的坐标系，原点oT为一反中心点，oTxT轴与一反法线重合且垂直镜面向外，oTzT轴与俯仰框架轴平行指向右方，oTyT轴平行于镜面向上，oTxTyTzT构成右手正交坐标系。

视线坐标系OXLYLZL——与一反入射光固联的坐标系，由载体坐标系o1x1y1z1依次旋转航向视线角αL和俯仰视线角φL得到，原点O为一反中心点，OXL轴与一反入射光重合且指向外，OZL轴在所在平面内指向右方，OYL轴指向上方，OXLYLZL构成右手正交坐标系。

定义如下符号及矩阵：

(1)

Tα为载体坐标系到视线坐标系的方位旋转矩阵；

(2)

(3)

(4)

2.2 算法设计原理及推导思路

1)将光路中所有光线矢量统一到视线坐标系OXLYLZL下，该坐标系由载体坐标系绕OYL轴旋转航向视线角αL后再绕OZL轴旋转俯仰视线角φL得到，其OXL轴与一反入射光平行，指向前方；

2)分别考虑一反法线绕航向框架轴转动微量角度△α和绕俯仰框架轴转动微量角度△φ，将方位、俯仰框架轴的2次转动进行合成(由于是微量转动，所以不考虑转序的影响，进而直接将2次转动进行线性叠加)，合成的结果除以△t并取极限，得到光轴角度变化速度[5]；

3)伺服系统控制光轴稳定的目标是将视线坐标系OXLYLZL下的载体角速度OYL轴分量和OZL轴分量分别与一反出射光角速度沿OYL轴和OZL轴的分量大小相等，方向相反，即令两者矢量和为零，因此，在构成控制回路时，以前者为期望值，以后者为反馈值，形成负反馈控制回路，回路采用合适的校正环节将两者之间的误差控制到最小；

4)所有矢量按照单位矢量考虑，且因为矢量是有方向性的，所以，后续推导得到的光轴角度变化速度必须用初始矢量叉乘才是最终的光轴转动角速度。

5)推导过程中应用的主要公式为矢量绕定轴微量转动公式和反射定律矢量表达式：

矢量绕定轴微量转动公式如下:

(5)

反射定律矢量表达式如下:

(6)

2.3 抗扰算法推导

2.3.1 将矢量统一到视线坐标系下

(7)

(8)

(9)

(10)

(11)

2.3.2 推导过程

(12)

(13)

(14)

再次应用反射定律矢量表达式，求得一反法线经微量转动后形成的一反入射光新的矢量分别为:

(15)

(16)

(17)

略去二阶小量，得到:

(18)

同理可得，一反法线绕轴旋转角形成的新一反出射光矢量相对于初始矢量变化为:

(19)

两次转动(微量转动可忽略转序)形成的矢量增量为:

(20)

已知条件中均为单位矢量，则可以用如下叉乘运算来求取入射光角速度矢量:

(21)

展开如下:

(22)

(23)

定义如下变量，以简化角速度表达式:

(24)

(25)

(26)

(27)

(28)

简化角速度表达式如下:

(29)

进一步定义变量:

(30)

(31)

角速度表达式进一步简化为:

(32)

(33)

从而，解得:

(34)

进一步简化，令:

C=VφyVαz-VφzVαy

(35)

得到伺服抗载体角运动扰动的框架角速度期望值:

(36)

2.3.3 推导结果小节

经过以上推导，给出了实现本系统半捷联稳定所需要的角速度(ωφ、ωα)与载体角速度(ωdx,ωdy,ωdz)、伺服框架角(α、φ)和框架角速度(ωα、ωφ)的关系式(36)，在略去了高阶分量后，表达式形式上为一线性表达式，式中各项系数均可以通过简单的乘加运算得出，所需步骤也不多，移植到DSP上进行处理后运行速度和效率均较高，能够满足工程应用。

3 验证与评估

将上述算法实现到实际的机载光电成像系统样机上后，将系统装夹到五轴转台进行稳定精度测试，系统工作于半捷联稳定回路闭环状态，令转台航向、俯仰轴同时施加1°、2 Hz正弦复合扰动，系统航向、俯仰通道输出的空间角误差如图4～图5所示，光电成像系统航向、俯仰两通道的稳定精度均在0.02°以内，对比相似结构采用陀螺信号反馈的直接稳定控制回路方案，具有相当的精度。

图5 光电成像系统俯仰稳定精度测试曲线

该测试结果表明，系统稳定控制回路设计、抗扰算法设计和实现正确，系统达到了良好的稳定精度。

将系统装夹到振动台进行振动环境适应性测试，施加图6所示随机振动谱，系统通电工作正常。进一步提高振动量级，系统出现功耗增大现象，大小与振动量级呈正相关。经分析，由于系统与振动台之间通过减振器非刚性连接，振动台的线运动受系统质心偏离支点影响对系统产生附加的高频、微量角扰动，被载体三轴陀螺所敏感，并通过抗扰算法转换为稳定回路的期望角速度，稳定回路以其为指令控制伺服框架抑制振动台施加的附加角扰动，但由于光学铰链离轴设计，控制过程中光轴旋转的角度与伺服框架旋转的角度不等，在振动过程中电机必须输出力矩以维持光轴的空间指向，而稳定回路带宽和谐振峰较高(-3 dB带宽达到约60 Hz，谐振峰7 dB)，由此产生一定的谐振[6-10]，造成系统功耗增大。经调整稳定回路校正参数降低回路谐振峰后，再次进行振动试验，同量级下功耗增加明显减小。