[发明专利]数字式液浮磁罗盘及其测量姿态角的方法

说明书

技术领域

本发明涉及一种液浮磁罗盘。

背景技术

磁罗盘是个人导航、定位仪器中最重要的传感器，目前主流的磁罗盘传感器是基于磁阻原理的固体传感器，通过mems工艺集成在微硅芯片上。由于mems工艺3D加工能力有限，无法在垂直方向制作高精度的磁传感器，所以三维微硅磁罗盘传感器在俯仰角和偏航角大于30°以后，测量分辨率和精度下降迅速。液浮磁罗盘，内嵌一个装有磁针的浮球，浮球与外壳通过一层液膜隔离，根据地磁原理，磁针始终与地磁矢量保持一致。由于液膜可以隔离外壳的干扰力矩，外壳处于任何状态都不会影响浮球的运动，也不会降低罗盘的指向性和精度，相对微硅磁罗盘传感器具有更强的环境适应性和精度。随着数字光电技术的发展，液浮磁罗盘信息的有效便捷采集，对扩展液浮磁罗盘应用领域，提高个人导航、定位系统的精度及环境适应性具有非常重要的意义。

发明内容

本发明目的是提供一种数字式液浮磁罗盘，其解决了微硅磁罗盘在大俯仰角和大偏航角下分辨率和精度下降的缺点。

本发明的技术解决方案是：

一种数字液浮磁罗盘，其特殊之处在于：包括解算单元、台体1、设置在台体内的浮球2、设置在浮球2内部已磁化的磁针3、设置在浮球内部且位于磁针3下方的配重块5、固定在台体上且正对浮球球心的C摄像头6、B摄像头7、A摄像头9；所述浮球与台体间设置一层非导电液膜；所述浮球表面配重块重心定义为南极，磁针与南极所处球面节圆定义为本初子午线8，正交节圆定义为赤道4，所述浮球表面南北纬30°内喷涂均匀分布的不同颜色的色块，每个色块通过色度和灰度定义标记自身所处位置的经纬度信息；所述C摄像头6、B摄像头7、A摄像头9以间隔纬度60度安放在台体横剖面上，并与浮球外壳的子午面重合，纬度分别为-60°，0°，60°；所述C摄像头6、B摄像头7、A摄像头9摄像头分别采集外壳本初子午线上-60°，0°，60°所对应浮球的色块图像，所述C摄像头6、B摄像头7、A摄像头9分别与解算单元连接。

一种数字液浮磁罗盘，其特殊之处在于：包括解算单元、台体1、设置在台体内的浮球2、设置在浮球2内部已磁化的磁针3、设置在浮球内部且位于磁针3下方的配重块5、固定在台体上且正对浮球球心的B摄像头7；所述浮球与台体间设置一层非导电液膜；所述浮球表面配重块重心定义为南极，磁针与南极所处球面节圆定义为本初子午线8，正交节圆定义为赤道4，所述浮球表面南北纬30°内喷涂均匀分布的不同颜色的色块，每个色块通过色度和灰度定义标记自身所处位置的经纬度信息；所述B摄像头安放在台体横剖面上且位于浮球外壳的子午面上，纬度为0°；B摄像头采集外壳本初子午线上0°所对应浮球的色块图像；，所述B摄像头7与解算单元连接。

数字液浮磁罗盘测量姿态角的方法，其特殊之处在于：包括以下步骤：

1】利用台体和浮球间的液膜隔离外壳的干扰力矩，利用浮球表面配重块重心定义为南极，将磁针与南极所处球面节圆定义为本初子午线8，正交节圆定义为赤道4；将浮球表面南北纬30°内喷涂均匀分布的不同颜色的色块，每个色块通过色度和灰度定义标记自身所处位置的经纬度信息；

2】应用安放在台体横剖面上且位于浮球外壳的子午面上的摄像头，通过采集浮球上的色块信息，计算浮球的偏航角、俯仰角、横滚角：

2.1】偏航角γ测量：当台体水平旋转时，浮球在磁针的带动下沿着赤道逆向旋转，最终使磁针指向地磁北。同时，台体上的摄像头B绕浮球表面的赤道色带旋转，在摄像头B内显示的图像为经线在x轴上横移。读取零点赤道上的经度信息，即为偏航角γ；

2.2】俯仰角α测量：当台体纵向旋转时，浮球在磁针和配重块作用下最终指向重力方向，台体绕稳定浮球带动摄像头B沿Y轴逆向旋转，。同时，浮球表面的赤道随之转动，在摄像头B内显示的图像为赤道以原点为中心转动。计算过原点的纬线与y轴夹角，即为俯仰角α；

2.3】横滚角β测量：当台体绕X轴旋转时，浮球在磁针和配重块作用下最终指向重力方向，台体绕稳定浮球带动摄像头B沿Y轴逆向旋转。，在摄像头B内显示的图像为经线在y轴上平移。读取与零点重合的经线内所对应的维度信息，即为横滚角β。

上述步骤2中还可在子午面±60°纬度上添加2个摄像头，捕捉浮球横滚角超过±30°时的色块信息，计算浮球姿态角，并通过框架角坐标变换矩阵换算成赤道摄像头对应坐标系下的姿态角：