[发明专利]一种高速旋转平台的视线稳定控制方法

说明书

技术领域

本发明属于光电稳定跟踪平台技术领域，具体涉及一种高速旋转平台的视线稳定控制方法。

背景技术

传统光电稳定平台一般采取直接稳定或捷联稳定方式，对于高速旋转的运动载体，受惯性器件性能的影响，测量量程和测量带宽均达不到稳定高速旋转平台的要求，传统稳定平台的控制方法不能有效隔离载体运动。

发明内容

本发明的目的在于提供一种高速旋转平台的视线稳定控制方法，具体为一种旋转稳定+视线稳定的双稳定环方法，将高速旋转平台的视线稳定方法分成旋转稳定和直接视线稳定两类控制回路，各回路采取独立的控制器设计，有效分离了高速旋转对视线稳定的影响，提高了视轴稳定精度，克服了现有光电稳定平台在高速旋转状态下稳定精度差的缺点，解决了光电平台，特别是凝视型红外导引头系统的高稳定度和高精度问题。

为达到上述目的，本发明所采取的技术方案为：

一种高速旋转平台的视线稳定控制方法，包括以下步骤：

所述高速旋转平台包括基座、滚转轴固定部分、滚转轴转动部分、滚转单轴速率陀螺、俯仰支架、俯仰轴固定部分、俯仰轴转动部分、俯仰双轴速率陀螺和俯仰包；其中基座处于高速旋转状态，基座与滚转轴固定部分通过机械固定连接，滚转单轴速率陀螺通过螺钉连接固定于滚转轴转动部分上，俯仰支架与俯仰轴固定部分通过机械固定连接，滚转轴转动部分与俯仰支架通过机械固定连接，滚转轴转动部分与俯仰包通过机械固定连接，俯仰双轴速率陀螺通过螺钉连接固定于俯仰包中；

步骤一：建立坐标系，包括基座坐标系、外框坐标系、内框坐标系；

步骤二：基于步骤一建立的坐标系，建立框架动力学关系；

步骤三：基于步骤二建立的动力学关系，对高速旋转平台进行双稳定环串级控制。

所述步骤一建立的坐标系如下：Bx，By，Bz为基座坐标系，基座滚转运动表示为Bz轴，基座俯仰运动表示为By轴，基座偏航运动表示为Bx轴，Ox，Oy，Oz为外框坐标系，滚转轴转动部分滚转运动与Bz方向一致表示为Oz轴，滚转轴转动部分俯仰运动表示为Oy轴，滚转轴转动部分偏航运动表达为Ox轴，Ix，Iy，Iz为内框坐标系，俯仰包的视轴表示为Ix轴，俯仰包的俯仰轴运动表示为Iy轴，俯仰包的滚转运动表示为Iz轴；滚转单轴速率陀螺敏感Oz轴的惯性速度，俯仰双轴速率陀螺分别敏感Iy和Iz轴的惯性速度。

所述步骤二建立的框架动力学关系如下：