1. 引言
随着中高精度光学陀螺仪技术趋于成熟,以快速寻北为关键技术,利用单个光纤陀螺仪实现中高精度寻北功能,满足低成本小型化的军用市场需求。本文根据中精度光纤陀螺仪的实际精度指标,智能化寻北仪操作流程,提高寻北仪在战场环境可靠性和适应性,设计一款“用的上、用的起、用的好”的便携式静态寻北系统。同时在设计上预留经纬仪接口和波罗棱镜接口,方便进行功能扩展。
2. 工作原理及流程设计
2.1. 工作原理
单轴旋转光纤陀螺寻北仪利用光纤陀螺测量平面内不同方向地球自转角速率在载体坐标系水平方向上的分量,通过解算得出参考方向与真北方向的夹角。理论上来说,光纤陀螺在单个位置的输出就可以得到寻北结果,但是单位置的结果与陀螺自身的零偏、零偏稳定性、标度因数、随机噪声等参数有直接关系,而参数无法测得确定的结果,因此使用单位置寻北的精度很低 [1]。为了尽量避开光纤陀螺自身参数的影响,提高寻北精度,本文采用多位置寻北方案,其工作原理是将光纤陀螺仪转动固定角度,通过多位置测量消除光纤陀螺的常值漂移和水平姿态传感器偏值的影响,利用光纤陀螺测量地球自转角速率的水平分量来获得地球表面被测点的北向信息,利用水平姿态传感器测量固定陀螺的基座的倾斜角度,对光纤陀螺的输出数据进行补偿。得到载体的纵轴与真北方向的夹角 [2]。
2.2. 工作流程设计
寻北仪设备上电启动后,首先进行故障检测及初始化,当检测到系统各单元正常后,进入寻北准备状态,等待装入初始位置信息,以进行解算参数初始化。接收到寻北命令后,装订初始位置,系统进入粗寻北阶段,根据当前位置进行一个粗定向,判断航向是否在±10˚或180˚ ± 10˚范围内,如果粗定向结果在此范围内,则控制电机旋转45˚,并以此作为第一个位置。当粗定向结果显示航向不在此范围内,则以当前位置作为第一个位置,采集解算板在第一个位置进行陀螺、水平姿态传感器数据采样和预处理,60秒数据采样结束后存储第一个位置的陀螺、水平姿态传感器的处理结果以及当前旋转机构的旋转角度位置;第一个位置采样结束以后,给出驱动信号,驱动电机带动旋转组件转动到第二个位置(第一个位置+180˚),60秒以后存储数据采样的最终结果和转角数据。第二个位置的采样结束后,采集解算板接收到采样完成的信号后,进行寻北计算并将计算结果送到显示面板或通过通讯口发送给外设设备。系统工作顺序示意图如图1所示。
2.3. 两位置寻北设计
当系统处于调平状态时,光纤陀螺在初始测量的位置时的输出值为
;利用伺服电机驱动,使光纤陀螺的敏感轴逆时针转180˚到达反向位置,此时陀螺的输出记为
。
陀螺的两个位置的输出为:
(1)
式中:
、
为陀螺输出的漂移;
寻北时需要提取的有用信号为低频直流分量
,去除了低频周期干扰和噪声的影响后,由式(1)解算出方位角
(2)
通过式(2)处理中消除了陀螺零偏,极大地降低了对陀螺精度的要求;此时陀螺转过的角度就是敏感轴的初始方向与真北的夹角。
2.4. 四位置寻北设计
若选用四位置寻北,则不需要进行粗寻北,单位置停留60秒采集数据完成后由采集解算板进行寻北计算并将计算结果发送到显示面板或上位机等外设。当寻北仪在调平状态下,利用四位置寻北可以忽略当地纬度的输入 [3]。
假设在调平状态下,方位角为k。在间隔90˚的四个位置上分别采样陀螺仪信号,得到
、
、
、
。采集到的陀螺数据信号如式(3)所示:
(3)
式中:
为陀螺常值漂移误差;
、
、
和
分别为采样时刻的陀螺时漂。因寻北时间较短,故可近似认为四个位置上的陀螺时间零偏大小相等。
(4)
则
(5)
(6)
综合(5)和(6)得:
(7)
因此,航向
(8)
四位置寻北的优点在于不仅消除了陀螺漂移的常值误差,在调平状态下无需输入当地纬度
。
3. 基座倾斜对寻北的影响
如果安装陀螺的基座平面与水平面存在较大倾角,则寻北精度会受到较大的影响下面分析当基座平面不水平时,倾角对方位角测量产生的影响。为了达到快速、精确调平的目的,在系统中增加敏感元件加速度计或倾角传感器来检测转台平面相对于水平面的倾斜角。通过运算实现基座的解析调平,对寻北结果进行补偿,以保证寻北精度 [4]。
考虑载体运动时转动顺序为偏航K→纵摇
→横摇
,则可得地理坐标系至载体坐标系的转换矩阵为:
(9)
在静态寻北方案下,每次转动的角度为
,则载体坐标系到陀螺坐标系的转换矩阵为:
(10)
己知地球自转角速率
在地理坐标系的分量为
,则在陀螺坐标系各轴上的分量为:
(11)
因此光纤陀螺在敏感轴OY方向输出为:
(12)
基座平面绕垂直于陀螺轴的倾角对方位角测量的影响
当基座平面倾斜角度与陀螺敏感轴一致时,即陀螺敏感轴相对水平面抬高(或降低)
角时,在式(9)中令横摇
,则陀螺的输出变为:
(13)
因此在两个相差180˚的转位上:
(14)
如果不考虑其它干扰,则式(14)可得:
(15)
俯仰角对方位角的影响函数为:
(16)
因此,基座平面绕垂直于陀螺轴的倾角将直接引起一个同样量级的方位角测量误差,从而在较大程度上影响寻北精度 [5]。
当基座平面倾斜角度与陀螺敏感轴垂直时,此时陀螺的输出等同于基座平面水平时陀螺的输出情况,对方位角测量没有影响。只有当基座平面误差角与陀螺敏感轴一致时,误差角才能对陀螺的输出产生影响。
4. 总体设计
4.1. 基本结构
该光纤陀螺寻北仪总体设计如图2所示,整体结构如图3所示。其内部各元件工作所需电源如图4所示。内部供电分成两个部分,即旋转部分供电和非旋转部分供电。非旋转部分供电固连在机箱内部,负责非旋转元件即解算控制板、旋转编码器、电机、和电子罗盘的供电。旋转部分供电安装在转台上,负责光纤陀螺仪供电 [6] [7]。
Figure 2. General design of FOG north finder
图2. 光纤陀螺寻北仪总体设计示意图
Figure 4. Internal power supply diagram
图4. 内部供电关系示意图
4.2. 线路设计
系统线路设计如图5所示,寻北仪的主体由旋转机构、电子单元、设备壳体组成,其中电子单元包括电源转换、解算控制板组成。解算控制板采集光纤陀螺、倾角传感器、旋转编码器信号,DSP完成数据解算并输出给定参考角度,闭环系统依据参考给定和电机角度反馈输出控制率并驱动电机旋转 [8],实现自主寻北。
线路系统设计包括电源转换板和控制解算板,其中电源转换板为控制解算板、各种传感器(如旋转编码器、陀螺仪、倾角传感器等)、电机等提供电能;控制解算板完成数据采集、算法解算、电机控制解算和对外通讯等功能。
解算控制板完成数据采集、算法解算、电机控制解算、和对外通讯等功能。采集解算板实现如下功能:
1) 数据采集:通过串口采集陀螺仪、倾角传感器
2) 角度解码:对角度传感器输出的正余弦信号进行解码和细分;
3) 寻北算法:依据寻北方案对采集的数据信息进行寻北解算;
4) 电机控制:根据采集到的角度传感器信息,依据位置控制算法进行解算,驱动功率电路进行电机位置控制;
5) 与外部设备通讯。
解算控制板设计采用模块化思想,其原理框图如图6所示。主要模块及功能描述如下:
核心板:已经固化好的DSP+FPGA最小系统,主要完成算法解算(DSP)和接口扩展(FPGA)。
电源接口模块:完成板上电压转换,为其他模块供电。
信号调理电路模块:对旋转编码器输出的模拟信号做滤波、放大、整形等处理,从而获得更高精度和分辨率的角度信息。
功放模块:功率放大,驱动直流电机运动。
串口模块:接收陀螺仪、倾角传感器、电子罗盘设备内部传感器信号,同时用于接收GPS、经纬仪等外部设备数据。
其他接口模块:预留CAN、以太网等模块,做后续功能拓展。
Figure 6. Schematic diagram of control solution board
图6. 控制解算板原理框图
4.3. 仿真测试
利用F120H-M闭环光纤陀螺进行了半实物仿真试验,将设备置于双轴转台上,利用转台设置其纵摇、横摇;利用夹具调整寻北仪的设备方向,实现航向变化,用以验证在不同位置下的寻北精度为主要元件后续指标提供参考。倾斜状态光纤系统的试验数据如表1~3所示。
Table 1. Results of north seeking at 0˚ and 180˚
表1. 在0˚和180˚时的寻北结果
Table 2. Results of north seeking at 45˚ and 225˚
表2. 在45˚和225˚时的寻北结果
Table 3. Results of north seeking at 90˚ and 270˚
表3. 在90˚和270˚时的寻北结果
从仿真测试看,基座倾斜对寻北结果并无明显影响,说明倾斜条件寻北补偿效果明显;从多位置寻北停留的时间看,2分钟的停留时间寻北精度明显优于1分钟,表明2分钟的光纤陀螺噪声处理时间要好于1分钟的情况;从陀螺寻北时初始航向看,在90˚和270˚ (即东西向时)寻北效果不佳,因此在静态寻北时初始时刻应当避免东西方向寻北。
5. 结论
本文设计了一种便携式倾斜应用下的光纤陀螺寻北仪,介绍了基于多位置转位的寻北方案、系统总体设计、线路控制设计,重点分析倾斜条件下寻北精度的影响。在半实物仿真中采用F120H-M光纤陀螺进行系统测试,通过不同倾斜角度、不同寻北时间考核了寻北仪的寻北精度,结果表明其倾斜角度的补偿能够满足系统寻北精度,影响系统寻北精度的主要误差是短时(1 min)的光纤陀螺的随机漂移和输出噪声,后续的设计改进将重点考虑有效抑制光纤陀螺随机漂移和输出噪声的方法。