一种基于组合惯导信息应用的光电转塔视频跟踪前馈补偿方法技术

一种基于组合惯导信息应用的光电转塔视频跟踪前馈补偿方法，前馈补偿以光电转塔载机在地理坐标系下的速度作为信号源，经两次坐标变换，将光电转塔载机在地理坐标系下的速度，转换为光电转塔视轴坐标系下光电转塔的方位角速度和光电转塔的俯仰角速度；将光电转塔的方位角速度和光电转塔的俯仰角速度作为前馈信号输入陀螺速率稳定回路，补偿由载机运动产生的目标相对光电转塔的角速率；由于该方法的前置反馈信号来自于实时采集的光电转塔载机在地理坐标系下的速度，与视频跟踪回路完全脱耦，解决了以往前置反馈信号采自于视频跟踪回路的时滞问题，对改善静止目标视频跟踪滞后作用显著，对高速高机动运动目标的视频跟踪滞后也有明显改善。

A feedforward compensation method for video tracking of photoelectric turret based on the application of combined ins information

【技术实现步骤摘要】
一种基于组合惯导信息应用的光电转塔视频跟踪前馈补偿方法
本专利技术涉及机载光电转塔对地面目标视频跟踪
，具体涉及一种基于组合惯导信息应用的光电转塔视频跟踪前馈补偿方法。
技术介绍
现有的高精度机载光电转塔跟踪照射地面目标时，由于光学成像传感器和跟踪器的延时较大，转塔视频跟踪回路的带宽较低，当目标相对转塔的角加速度加大时，跟踪滞后角亦相应增大，影响转塔激光照射器的照射精度，进而影响激光制导武器的打击精度；为了提高光电转塔的跟踪照射精度，通常依据转塔转速和跟踪滞后角估计目标相对转塔的角速度，并以该角速度作为速度前馈输入，采用前馈+反馈的跟踪策略；但上述方法中估计运动目标的速度需要用到视频跟踪回路的速度或位置反馈参数，前馈输入和反馈回路存在耦合干扰，增加了视频跟踪回路的响应时间，降低了光电转塔跟踪照射操作的响应速度，进而影响到载机在实战时的战斗力。
技术实现思路
本专利技术提供了一种基于组合惯导信息应用的光电转塔视频跟踪前馈补偿方法，以光电转塔载机在地理坐标系下的速度作为跟踪回路的前馈补偿信号源，经两次坐标变换，将光电转塔载机在地理坐标系下的速度转换为在光电转塔视轴坐标系下的目标相对光电转塔的相对速度；将光电转塔视轴坐标系下目标相对光电转塔的相对速度转换为光电转塔的方位角速度和光电转塔的俯仰角速度；将光电转塔的方位角速度和光电转塔的俯仰角速度作为前馈输入陀螺速率稳定回路，补偿由载机运动产生的目标相对光电转塔的角速率；由于该方法的前置反馈信号来自于实时采集的光电转塔载机在地理坐标系下的速度，与视频跟踪回路完全脱耦，解决了以往前置反馈信号采自于视频跟踪回路的时滞问题，对改善静止目标视频跟踪滞后作用显著，对高速高机动运动目标的视频跟踪滞后也有明显改善。为实现上述专利技术目的，本专利技术采用如下技术方案：一种基于组合惯导信息应用的光电转塔视频跟踪前馈补偿方法，其光电转塔视频跟踪回路以目标位置做闭环控制，以陀螺速率稳定回路为内环，外环由视频跟踪比较器给出目标与当前视轴的误差角度，经跟踪回路校正计算获得角速率驱动量，作为内环陀螺速率稳定回路的输入，控制光电转塔视轴指向目标；所述陀螺速率稳定回路的输入端还输入有前馈补偿，前馈补偿以光电转塔载机在地理坐标系下的速度作为信号源，经两次坐标变换，将光电转塔载机在地理坐标系下的速度，转换为光电转塔视轴坐标系下光电转塔的方位角速度和光电转塔的俯仰角速度；第一次转换为：将光电转塔载机在地理坐标系下的速度，转换为在光电转塔视轴坐标系下的目标相对光电转塔的相对速度；第二次转换为：将光电转塔视轴坐标系下目标相对光电转塔的相对速度，转换为光电转塔的方位角速度和光电转塔的俯仰角速度；最后，将光电转塔的方位角速度和光电转塔的俯仰角速度作为前馈信号输入陀螺速率稳定回路，补偿由载机运动产生的目标相对光电转塔的角速率。进一步的，机载计算机通过光电转塔载机的机载惯导组合采集光电转塔载机在地理坐标系下的速度及姿态角α、β、γ数据。进一步的，机载计算机将光电转塔载机在地理坐标系下的速度通过第一次坐标变换，转换为载机机体坐标系下的速度其转换公式为：进一步的，机载计算机通过光电转塔的塔载惯导组合采集光电转塔视轴坐标系下的方位角A和俯仰角B数据。进一步的，机载计算机将已经计算出的载机机体坐标系下的速度通过第二次坐标变换，转换为光电转塔视轴坐标系下的目标相对光电转塔的速度其转换公式为：其中进一步的，机载计算机通过光电转塔的激光测距仪采集目标到光电转塔的直线距离D。进一步的，机载计算机将光电转塔视轴坐标系下的目标相对光电转塔的速度转换为光电转塔的方位角速度ωz、光电转塔的俯仰角速度ωy；其中为目标接近光电转塔的速度，不构成光电转塔的角运动；其转换公式为：进一步的，机载计算机根据光电转塔方位角速度ωz、光电转塔俯仰角速度ωy的前馈信号，及跟踪回路校正、光电转塔姿态的反馈信号，计算出光电转塔伺服电机的控制信号。由于采用如上所述的技术方案，本专利技术具有如下有益效果：本专利技术提供的一种基于组合惯导信息应用的光电转塔视频跟踪前馈补偿方法，以光电转塔载机在地理坐标系下的速度作为跟踪回路的前馈补偿信号源，经两次坐标变换，将光电转塔载机在地理坐标系下的速度转换为在光电转塔视轴坐标系下的目标相对光电转塔的相对速度；将光电转塔视轴坐标系下目标相对光电转塔的相对速度转换为光电转塔的方位角速度和光电转塔的俯仰角速度；将光电转塔的方位角速度和光电转塔的俯仰角速度作为前馈输入陀螺速率稳定回路，补偿由载机运动产生的目标相对光电转塔的角速率；由于该方法的前置反馈信号来自于实时采集的光电转塔载机在地理坐标系下的速度，与视频跟踪回路完全脱耦，解决了以往前置反馈信号采自于视频跟踪回路的时滞问题，对改善静止目标视频跟踪滞后作用显著，对高速高机动运动目标的视频跟踪滞后也有明显改善，因此显著提高了载机在实战时的战斗力。附图说明图1为视频跟踪回路原理框图；图2为前馈补偿角速率计算流程。具体实施方式通过下面的实施例可以更详细的解释本专利技术，公开本专利技术的目的旨在保护本专利技术范围内的一切变化和改进：一种基于组合惯导信息应用的光电转塔视频跟踪前馈补偿方法，其光电转塔视频跟踪回路为目标位置闭环控制，以陀螺速率稳定回路为内环，控制光电转塔转动；外环由视频跟踪比较器给出目标与当前视轴的误差角度，经跟踪回路校正计算获得角速率驱动量，作为内环陀螺速率稳定回路的输入，控制光电转塔视轴指向目标；所述陀螺速率稳定回路的输入端还输入有前馈补偿，前馈补偿以光电转塔载机在地理坐标系下的速度作为信号源，经两次坐标变换，将光电转塔载机在地理坐标系下的速度，转换为光电转塔视轴坐标系下光电转塔的方位角速度和光电转塔的俯仰角速度；将光电转塔的方位角速度和光电转塔的俯仰角速度作为前馈信号输入陀螺速率稳定回路，补偿由载机运动产生的目标相对光电转塔的角速率；其具体过程为：S1：机载计算机通过光电转塔载机的机载惯导组合采集光电转塔载机在地理坐标系下的速度及姿态角α、β、γ数据；S2：机载计算机将光电转塔载机在地理坐标系下的速度通过第一次坐标变换，转换为载机机体坐标系下的速度其转换公式为：S3：机载计算机通过光电转塔的塔载惯导组合采集光电转塔视轴坐标系下的方位角A和俯仰角B数据；S4：机载计算机将已经计算出的载机机体坐标系下的速度通过第二次坐标变换，转换为光电转塔视轴坐标系下的目标相对光电转塔的速度其转换公式为：其中S5：机载计算机通过光电转塔的激光测距仪采集目标到光电转塔的直线距离D；S6：机载计算机将光电转塔视轴坐标系下的目标相对光电转塔的速度转换为光电转塔的方位角速度ωz、光电转塔的俯仰角速度ωy；其转换公式为：S7：机载计算机根据光电转塔方位角速度ωz、光电转塔俯仰角速度ωy的前馈信号，及跟踪回路校正、光电转塔姿态的反馈信号，计算出光电转塔伺服电机的控制信号。以下为本文档来自技高网...

【技术保护点】
1.一种基于组合惯导信息应用的光电转塔视频跟踪前馈补偿方法，其光电转塔视频跟踪回路以目标位置进行闭环控制，陀螺速率稳定回路为内环，外环由视频跟踪比较器给出目标与当前视轴的误差角度，经跟踪回路校正计算获得角速率驱动量，作为内环陀螺速率稳定回路的输入，控制光电转塔视轴指向目标；其特征是：所述陀螺速率稳定回路的输入端还输入有前馈补偿，前馈补偿以光电转塔载机在地理坐标系下的速度作为信号源，经两次坐标变换，将光电转塔载机在地理坐标系下的速度，转换为光电转塔视轴坐标系下光电转塔的方位角速度和光电转塔的俯仰角速度；将光电转塔的方位角速度和光电转塔的俯仰角速度作为前馈信号输入陀螺速率稳定回路，补偿由载机运动产生的目标相对光电转塔的角速率。/n

【技术特征摘要】
1.一种基于组合惯导信息应用的光电转塔视频跟踪前馈补偿方法，其光电转塔视频跟踪回路以目标位置进行闭环控制，陀螺速率稳定回路为内环，外环由视频跟踪比较器给出目标与当前视轴的误差角度，经跟踪回路校正计算获得角速率驱动量，作为内环陀螺速率稳定回路的输入，控制光电转塔视轴指向目标；其特征是：所述陀螺速率稳定回路的输入端还输入有前馈补偿，前馈补偿以光电转塔载机在地理坐标系下的速度作为信号源，经两次坐标变换，将光电转塔载机在地理坐标系下的速度，转换为光电转塔视轴坐标系下光电转塔的方位角速度和光电转塔的俯仰角速度；将光电转塔的方位角速度和光电转塔的俯仰角速度作为前馈信号输入陀螺速率稳定回路，补偿由载机运动产生的目标相对光电转塔的角速率。


2.根据权利要求1所述的基于组合惯导信息应用的光电转塔视频跟踪前馈补偿方法，其特征是：机载计算机通过光电转塔载机的机载惯导组合采集光电转塔载机在地理坐标系下的速度及姿态角α、β、γ数据。


3.根据权利要求2所述的基于组合惯导信息应用的光电转塔视频跟踪前馈补偿方法，其特征是：机载计算机将光电转塔载机在地理坐标系下的速度通过第一次坐标变换，转换为载机机体坐标系下的速度其转换公式为：


4.根据权利要求1所述的基于...

【专利技术属性】
技术研发人员：渠继峰，吉书鹏，赵冠军，卢丹，张敏，
申请(专利权)人：凯迈洛阳测控有限公司，
类型：发明
国别省市：河南;41