《基于红外光轴信息的旋转弹位置姿态解算研究》由会员分享，可在线阅读，更多相关《基于红外光轴信息的旋转弹位置姿态解算研究（11页珍藏版）》请在金锄头文库上搜索。
1、基于红外光轴信息的旋转弹位置姿态解算研究 夏团结 杨大伟 钮赛赛 申涛 刘会文 上海航天控制技术研究所 摘 要： 基于旋转导弹的原设计, 在旋转弹消旋平台上安装两轴框架, 将红外探测光轴固定于框架上, 采用微型惯组固连于红外探测光轴的底端以简化旋转弹导引头结构与多模复合设计, 对基于红外光轴信息的旋转弹位置姿态解算方法进行了研究, 以实现导引头搜索至截获目标期间的姿态和位置的解算。给出了消旋平台和惯组的总体设计, 采用引入框架码盘和消旋平台数据的方法, 正确解算出此阶段导航信息, 确保弹体的平稳准确飞行。建立了引入框架码盘误差后的位置姿态解算模型及流程。理论推导了框架转换定位与姿态及其相应误差
2、。在两轴转台上用实物导引头验证了算法的正确性。对误差补偿设计和惯组精度需求进行了量化分析与验证。结果表明:陀螺漂移量控制在 0.1 () /s 以内, 初始姿态角误差控制在 0.2以内, 探测器指向误差可达到半视场优于 0.2;加速度计误差控制在 0.1m/s2以内, 码盘误差控制在 0.04以内, 惯导定位误差在10s 内可保证小于 10m。该结论对此类旋转弹的后续发展有重要的参考意义。关键词： 旋转弹; 消旋平台; 红外探测; 微型惯组; 框架码盘; 位置姿态; 补偿模型; 误差量化; 作者简介：夏团结 (1989) , 男, 工程师, 主要从事导引头控制系统设计。收稿日期：2017-07
3、-26Research on Position and Attitude Solving of Rolling Airframe Missile Based on Infrared Optical Axis InformationXIA Tuan-jie YANG Da-wei NIU Sai-sai SHEN Tao LIU Hui-wen Shanghai Institute of Spaceflight Control Technology; Abstract： Based on the initial design of some rolling airframe missile, t
4、he two frames were installed on the raceway platform, and infrared detection optical axis was fixed on the frames and miniature inertial units were fixed on the bottom of the optical axis to simplify the seeker structure and multi-mode combined design for rolling missile.The solving method of the po
5、sition and attitude for rolling airframe missile based on the information of infrared optical axis was studied in this paper, which could realize the position and attitude solving during the flying from frame code introduced to target capture.The overall design of raceway platform and miniature iner
6、tia was given.The guidance information would be obtained by introducing frame code and raceway platform data, which could ensure the missile body flying stably.The position and attitude solving model and flowchart were established after the error of frame code introduced.The frame transfer of positi
7、on and attitude and relative errors were derived theoretically.The correctness of the algorithm was proved using real seeker on the two-axis turntable.The quantization of the error compensation design and miniature inertia accuracy were analyzed and approved.The results showed that the direction err
8、or would be smaller than 0.2in half view of sight when the gyro shift was smaller than 0.1 () /s and initial attitude error was smaller than 0.2, and the inertial positioning error would be smaller than 10 min 10 seconds when the accelerometer error was smaller than 0.1 m/s2 and frame code error was
9、 smaller than 0.04.The conclusion has great value for the development of rolling airframe missile.Keyword： rolling airframe missile; raceway platform; infrared detection; miniature inertia; frame code; position posture; compensation model; error quantification; Received： 2017-07-260 引言旋转导弹的发展已日趋成熟,
10、简化结构设计和采用多模复合设计, 对导弹武器系统保持良好的特性有重要的意义和价值1。基于旋转导弹的原设计方案, 尽量简化设计结构、降低成本、提高器件利用效率, 在单红外旋转弹的平台上安装可扩大视场的两轴框架, 将红外光轴固定于内框轴上, 微型小惯组固连于红外探测光轴的底端, 这样既能最大限度地利用导引头空间, 又可在导弹发射前期应用惯组增大导弹的作用距离, 大幅提升导引头在复杂战场环境中的适应能力2。与双框架平台相比, 这种安装方式无须在平台上安装惯组, 不仅节省了导引头空间, 而且成本也相对较低;与半捷联相比, 其框架上不安装陀螺, 稳定回路只能将码盘微分作为速度反馈, 影响回路的快速性和稳
11、定性;结合了红外框架的优点, 且在不增加导引头空间的条件下复合利用惯组信息。其中:微型小惯组包括正交的三轴陀螺和三轴加速度计, 分别敏感光轴坐标系的三轴方向。利用安装于红外光轴底部的惯组计算弹体的姿态位置, 是前期弹体导航最重要的前提, 需要将光轴敏感出的信息通过坐标转换, 转换到消旋平台坐标系中, 结合目标信息即可提取出相对平台的目标视线角速度, 再利用弹旋调制, 就可输出舵机所需的控制信息, 在陀螺和加速度计零位有所限定时, 用四元数法完成姿态矩阵计算, 姿态矩阵结合加速度信息完成位置信息解算, 码盘所测量的转换框架角度需达到一定的精度, 才能满足所需的定位精度, 因此在现有条件下, 保证
12、正交安装精度和确定码盘测角精度, 对实时计算姿态矩阵、解算位置信息至关重要。为此, 本文研究了基于红外光轴信息的旋转弹位置姿态解算, 推导了框架转换姿态和定位并讨论了工程中两者的误差量化。1 旋转弹消旋平台与光轴总体设计旋转弹消旋平台与光轴的总体设计如图 1 所示。导引头中的陀螺和加速度计以惯组形式固连在光轴底部, 安装在位标器的内框上, 而位标器固定于消旋平台上。控制系统利用基座陀螺测定实时数值, 在弹体高速旋转时保证消旋平台相对惯性空间稳定, 其中磁码盘分别安装在内外框轴上。光轴在惯性空间寻找目标时, 内框码盘测量光轴内框方向相对弹体的转角, 外框码盘测量光轴外框方向相对弹体的转角3。图
13、1 消旋平台与惯组总体设计 Fig.1 Overall design of race and platform 下载原图图 1 中:g 表示框架坐标系;p 表示平台坐标系;i 表示惯性坐标系;f ip为平台系中的加速度信息; ip为平台相对惯性坐标系的角速度 在惯性坐标系中的投影。其中:框架加速度计结合码盘数据经框架转换到消旋平台上, 基座陀螺数据用于消旋稳定控制;框架上的陀螺信息通过内外框码盘转换到平台系中, 解算平台相对惯性系的姿态信息, 结合转换的三轴加速度计对弹体定位, 通过弹体姿态和位置, 解算弹体和目标夹角, 控制两轴框架使光轴实时指向目标。为验证此设计方案和控制算法的正确定性,
14、设计以下实验。a) 使导引头作俯仰偏航运动, 应用惯导时, 在模拟导弹发射前将光轴解锁, 同时解锁码盘, 在导引头跟踪上目标后高速起旋, 稳定后给出转台指令, 使导引头按预定轨迹运动同时锁定目标。结合码盘数据验证在跟踪状态下姿态解算的推理, 并将此推理用于导引头寻找目标, 正确解算出弹体姿态信息。b) 将在导引头寻找目标过程中解算出的正确姿态信息用于该过程的弹体位置计算, 利用这些数据建立准确的角速度关系, 更新四元数位置转换矩阵, 结合加速度计的输出, 得到位置信息并与光测信息进行比对, 验证导弹在寻找目标过程中姿态位置解算的正确性。c) 在姿态位置解算设计中引入误差模型, 对惯组精度进行量
15、化分析。在姿态位置解算设计中, 主要涉及框架坐标系、平台坐标系和惯性坐标系间的信息转换。框架坐标系建立在导引头前端两轴框架上, 用于带动红外探测器实时指向目标;惯组模式下, 需获知平台和目标相对惯性空间的位置信息, 平台坐标系建立在消旋平台上, 初始平台电锁, 弹体坐标系与平台坐标系重合, 控制弹旋角度调制, 即可将调制后的惯性视线角速度信息转换为弹体系相对惯性系的控制指令。1.1 惯组姿态解算设四元数式中:i, j, k 为三轴单位矢量。一个坐标系相对另一个坐标系的相对转动可用四元数唯一性表示。设平台系 O-xpypzp相对惯性系 O-xiyizi的三个旋转角度表征飞行器姿态的三个姿态角为滚
16、转角 、俯仰角 和偏航角 4。将地理坐标系依次沿 z、x、y 轴旋转相应的偏航角、滚转角和俯仰角可得机体坐标系, 两者的方向余弦矩阵可表示为式中:用四元数描述 p 系相对 i 系的转动时, 可得姿态矩阵为式中:对比式 (2) 、 (3) , 可得四元数和欧拉角的关系为四元数微分方程为式中: ip为 p 系相对 i 系的转动角速度在 p 系中的投影, 可由三轴角速率陀螺得到, 且 ip=0+ ipxi+ ipyj+ ipzk。此处: ipx, ipy, ipz分别为测量的三轴角速率陀螺 x、y、z 轴分量。展开式 (5) , 可得其矩阵形式为式中:设采样时间为 t, 在单位步长内系统角速率保持不变, 对上述微分方程进行差分可得其矩阵表达式为式中:上述方程即四元数更新方程。利用上述四元数和欧拉角的关系, 可求得每个时刻的欧拉角 (实时更新的姿态角) 5。1.2 惯组位置解算导弹发射前, 导引头电锁, 码盘机械锁死, 码盘无数据输出, 当光轴寻找目标时, 利用码盘
