主权项 |
一种惯性方位保持方法,在该方法中采用惯性方位保持系统,所述惯性方位保持系统包括一个方位环、一个纵摇环、解算器、DA补偿器Ⅰ、DA补偿器Ⅱ、水平电机、方位电机、子系统Ⅰ、子系统Ⅱ和子系统Ⅲ;子系统Ⅰ包括一只陀螺Ⅰ、一只加速度计Ⅰ和AD采集器Ⅰ;子系统Ⅱ包括一只陀螺Ⅱ、一只加速度计Ⅱ和AD采集器Ⅱ;子系统Ⅲ包括角度采集器和固定在载体上的角度传感器组件,角度传感器组件包括旋转变压器、加表传感器和倾角传感器;其特征在于:该方法包括如下步骤:步骤一,加速度计Ⅰ检测陀螺Ⅰ的加速度信号并输出;步骤二,AD采集器Ⅰ采集步骤一的输出信号并转化后输出数字信号Ⅰ到解算器;步骤三,加速度计Ⅱ检测陀螺Ⅱ的加速度信号并输出;步骤四,AD采集器Ⅱ采集步骤三的输出信号并转化后输出数字信号Ⅱ到解算器;步骤五,旋转变压器检测载体纵轴在水平面的投影与地理子午线之间的旋变读角ψ<sub>xb</sub>并输出,加表传感器检测载体纵轴与纵向水平轴之间的俯仰角θ并输出,倾角传感器检测载体纵向对称面与纵向铅垂面之间的横滚角γ并输出;步骤六,角度采集器采集步骤三输出的变读角ψ<sub>xb</sub>、俯仰角θ和横滚角γ的三个角度信号并分别转化,然后将转换后的数字信号Ⅲ输入解算器;步骤七,解算器根据输入的数字信号Ⅰ和数字信号Ⅲ进行解算,然后输出相应的数字信号Ⅳ到DA补偿器Ⅱ;步骤八,DA补偿器Ⅱ根据输入的数字信号Ⅳ产生驱动水平电机的电流,水平电机驱动纵摇环旋转,使得陀螺Ⅰ的旋转轴的轴线始终保持在当地地理坐标系O‑X<sub>o</sub>Y<sub>o</sub>Z<sub>o</sub>的OXoYo水平面;步骤九,解算器根据输入的数字信号Ⅱ和数字信号Ⅲ进行解算,然后输出相应的数字信号Ⅴ到DA补偿器Ⅰ;步骤十,DA补偿器Ⅰ根据输入的数字信号Ⅴ产生驱动方位电机的电流,方位电机驱动方位环旋转,使得陀螺的旋转轴的轴线始终指向地理北向。 |