[发明专利]一种惯性稳定控制器

摘要

本发明公开了一种惯性稳定控制器，包括主控模块、方位电机驱动模块、俯仰电机驱动模块、横滚电机驱动模块、速率陀螺采集模块、角位置采集模块、数据存储模块、串口扩展模块、管理控制模块、惯性导航模块和二次电源模块。该惯性稳定控制器集驱动、采集、存储、通讯、同步于一体，大大改善了现有惯性稳定控制器功能单一的问题。本发明能够消除由于载机高、低频扰动对摆扫或跟踪成像等系统的影响，同时适用于单轴、两轴或三轴的惯性稳定平台，应用范围广，已成功应用于多项航空光学遥感器型号上。

主权项

一种惯性稳定控制器，所述惯性稳定控制器搭载在载体上，用于控制载体上惯性平台的稳定；其特征在于：包括主控模块、方位电机驱动模块、俯仰电机驱动模块、横滚电机驱动模块、速率陀螺采集模块、角位置采集模块、数据存储模块、串口扩展模块、管理控制模块、惯性导航模块和二次电源模块；惯性导航模块采集载体相对于惯性空间的航向角，并输出给主控模块；管理控制模块在载体运行之前接收上位机设定的载体航迹角，在载体运行过程中采集载体相对于惯性空间的实际航迹角，并将这两种航迹角均通过串口扩展模块输出给主控模块；角位置采集模块在载体运行过程中分别采集惯性平台方位轴与载体方位轴、惯性平台俯仰轴与载体俯仰轴、惯性平台横滚轴与载体横滚轴之间的夹角，并将采集得到的夹角进行轴角‑数字转换后输出给主控模块；速率陀螺模块在载体运行过程中分别采集惯性平台的方位轴、俯仰轴和横滚轴相对于惯性空间的角速率，并通过串口扩展模块输出给主控模块；数据存储模块用于存储方位电机驱动模块、俯仰电机驱动模块和横滚电机驱动模块的控制参数，供主控模块在系统初始化时读取；主控模块根据载体相对于惯性空间的航向角、航迹角、惯性平台方位轴与载体方位轴之间的夹角、惯性平台俯仰轴与载体俯仰轴之间的夹角以及惯性平台横滚轴与载体横滚轴之间的夹角计算得到惯性平台各个轴相对于惯性空间的位置角度信号，结合速率陀螺模块采集得到的惯性平台各个轴相对于惯性空间的角速率，得到惯性平台方位轴、俯仰轴和横滚轴的脉冲控制信号，并将惯性平台方位轴、俯仰轴和横滚轴的脉冲控制信号以及从数据存储模块读取的控制参数分别输出给方位电机驱动模块、俯仰电机驱动模块和横滚电机驱动模块；所述航迹角为上位机设定的载体航迹角或载体相对于惯性空间的实际航迹角；方位电机驱动模块、俯仰电机驱动模块和横滚电机驱动模块分别根据接收到的脉冲控制信号和控制参数产生方位电机控制指令、俯仰电机控制指令和横滚电机控制指令，用于驱动惯性平台上方位电机、俯仰电机和横滚电机旋转，从而实现对惯性平台的稳定控制；二次电源模块对外部电源提供的电压进行转换，分别为主控模块、速率陀螺采集模块、角位置采集模块、方位电机驱动模块、俯仰电机驱动模块和横滚电机驱动模块供电。