专利名称：一种磁阻式电子罗经的制作方法
技术领域：
本实用新型涉及电子罗经，尤其涉及一种磁阻式电子罗经。
背景技术：
传统机械罗盘体积大且造价高，主要应用于飞机、坦克和舰船的方向测量，难以普及应用。
实用新型内容针对上述技术问题，本实用新型提供了一种体积小、成本低、功耗低、安装简易的磁阻式电子罗经，电子罗经终端通过I2C接口与智能设备连接，占用智能设备的CPU资源少，通信效率高。本实用新型提供的技术方案为:一种磁阻式电子罗经，包括:电子罗经终端，其包括有三轴磁场加速度计、陀螺仪以及单片机，所述单片机包括有转速计算模块以及姿态角和航向角计算模块，所述三轴磁场加速度计与所述姿态角和航向角计算模块通信连接，所述陀螺仪与所述转速计算模块通信连接；智能设备，其包括第二通信模块，所述第一通信模块与第二通信模块通信连接。优选的是，所述的磁阻式电子罗经中，所述单片机还包括存储模块，所述转速计算模块以及姿态角和航向角计算模块均与所述存储模块连接，所述存储模块与所述第一通信模块通信连接。优选的是，所述的磁阻式电子罗经中，所述电子罗经终端还包括电源以及电源管理模块，所述电源通过所述电源管理模块向所述电子罗经终端供电。优选的是，所述的磁阻式电子罗经中，所述智能设备为微处理器。 优选的是，所述的磁阻式电子罗经中，所述第一通信模块为第一 I2C接口，所述第二通信模块为第二 I2C接口，所述第一 I2C接口和第二 I2C接口通过线缆连接。优选的是，所述的磁阻式电子罗经中，所述电子罗经终端设置于一防水壳体内，所述线缆延伸出所述防水壳体，在与所述壳体的连接处设置有防水锁头。本实用新型所述的磁阻式电子罗经包括有三轴磁场加速度计、陀螺仪以及单片机，单片机通过I2C接口与智能设备通信连接，实现了对姿态角、航向角以及转速的测量与计算，本实用新型可靠性和通信效率高，占用资源少，体积小，安装简易。
图1为本实用新型所述的磁阻式电子罗经的结构示意图。图2为本实用新型所述的磁阻式电子罗经的硬件电路原理框图。图3为本实用新型所述的磁阻式电子罗经系统程序框图。图4为本实用新型所述的磁阻式电子罗经的姿态计算原理图。[0018]图5为本实用新型所述的磁阻式电子罗经的罗差补偿原理图。
具体实施方式
以下结合附图对本实用新型做进一步的详细说明，以令本领域技术人员参照说明书文字能够据以实施。如图1和图2所示，本实用新型提供一种磁阻式电子罗经，包括:电子罗经终端，其包括有三轴磁场加速度计、陀螺仪以及单片机，所述单片机包括有转速计算模块以及姿态角和航向角计算模块，所述三轴磁场加速度计与所述姿态角和航向角计算模块通信连接，所述陀螺仪与所述转速计算模块通信连接；智能设备，其包括第二通信模块，所述第一通信模块与第二通信模块通信连接。所述的磁阻式电子罗经中，所述单片机还包括存储模块，所述转速计算模块以及姿态角和航向角计算模块均与所述存储模块连接，所述存储模块与所述第一通信模块通信连接。所述的磁阻式电子罗经中，所述电子罗经终端还包括电源以及电源管理模块，所述电源通过所述电源管理模块向所述电子罗经终端供电。所述的磁阻式电子罗经中，所述智能设备为微处理器。所述的磁阻式电子罗经中，所述第一通信模块为第一 I2C接口，所述第二通信模块为第二 I2C接口，所述第一 I2C接口和第二 I2C接口通过线缆连接。所述的磁阻式电子罗经中，所述电子罗经终端设置于一防水壳体4内，所述线缆I延伸出所述防水壳体，在与所述壳体的连接处设置有防水锁头2。防水壳体包括有上下两部分，通过螺钉3拧紧固定。本实用新型中电子罗经终端为从设备，微处理器为主设备。本实用新型包括LSM303三轴磁场加速度计、MPU6050数字陀螺仪和STM32F103单片机，以及电源LM1117稳压模块(即电源管理模块)。LSM303三轴磁场加速度计、MPU6050数字陀螺仪皆通过通用IO模拟I2C通信与STM32F103单片机连接。LSM303三轴磁场加速度计用于采集三轴上的地磁分量和静态加速度分量，通过I2C通讯传给单片机，由单片机计算求解航向角和姿态角。MPU6050数字陀螺仪用于采集三轴上的动态加速度，通过I2C通讯传给单片机积分进行计算，求解三轴上的转速。由图2电子罗经内的单片机STM32F103与LSM303和MPU6050串行连接，通过I2C通讯读取三轴上的地磁分量、静态加速度分量和动态加速度分量，经数字滤波后由单片机函数计算求解转速、姿态角和罗差补偿求解航向角，计算结果存入相应参数寄存器(也就是存储模块)。电子罗经终端作为从设备，经标准I2C通信接口与主机(也就是智能设备)相连，当外部主机需要查询转速、姿态、航向时，电子罗经终端通过I2C通信管理函数，将相应参数值传给主机，从而使主机得到转速、姿态角和航向角数值。参见图3所示程序框图。本实用新型的电子罗经的工作过程如下。首先，电子罗经终端上电进行初始化，确保各模块处于正常的工作状态，并开启LSM303三轴磁场加速度计和MPU6050数字陀螺仪，读取三轴地磁分量、三轴静态加速度分量、三轴动态加速度分量的测量值，并进行数字低通滤波处理；接着，进行陀螺仪零位校正和航向椭圆罗差校正操作，计算求解、更新存储陀螺仪零位补偿系数和罗差补偿系数；然后通过陀螺仪零位补偿算法、姿态解算算法和罗差补偿算法计算求解转速、姿态角和航向角；最后电子罗经终端作为从设备，通过I2C通信管理函数，将相应转速、姿态角、航向角参数值传给主设备。陀螺仪零位校正原理是，令电子罗经终端静止不动，单片机记录此时数字陀螺仪MPU6050所测得的值，即零位偏移值，当陀螺仪随着电子罗经转动时，将其测量值减去该零偏值，实现零位补偿。电子罗经终端姿态解算原理是，当电子罗经终端处于静态时，重力加速度在其加速度计上的三轴分量ax、ay、az不随时间变化，可以根据三角形勾股定理公式，将LSM303测量三轴静态加速度变换为翻滚角0与俯仰角0，即解算出载体的姿态。如下图所示，立体块表示电子罗经终端，坐标系xyz表示罗经坐标，XhYhZh表示空间坐标，则XhYh表示水平面，翻滚角小与俯仰角Q如图4所示。翻滚角是旋转X轴时，产生的y轴和Yh轴的夹角，同理旋转y轴可产生俯仰角
θ。变换公式如下:
权利要求1.一种磁阻式电子罗经，其特征在于，包括: 电子罗经终端，其包括有第一通信模块、三轴磁场加速度计、陀螺仪以及单片机，所述单片机包括有转速计算模块以及姿态角和航向角计算模块，所述三轴磁场加速度计与所述姿态角和航向角计算模块通信连接，所述陀螺仪与所述转速计算模块通信连接，所述单片机与所述第一通信模块通信连接； 智能设备，其包括第二通信模块，所述第一通信模块与第二通信模块通信连接。
2.如权利要求1所述的磁阻式电子罗经，其特征在于，所述单片机还包括存储模块，所述转速计算模块以及姿态角和航向角计算模块均与所述存储模块连接，所述存储模块与所述第一通信模块通信连接。
3.如权利要求1所述的磁阻式电子罗经，其特征在于，所述电子罗经终端还包括电源以及电源管理模块，所述电源通过所述电源管理模块向所述电子罗经终端供电。
4.如权利要求1 3中任一项所述的磁阻式电子罗经，其特征在于，所述智能设备为微处理器。
5.如权利要求1所述的磁阻式电子罗经，其特征在于，所述第一通信模块为第一I2C接口，所述第二通信模块为第二 I2C接口，所述第一 I2C接口和第二 I2C接口通过线缆连接。
6.如权利要求5所述的磁阻式电子罗经，其特征在于，所述电子罗经终端设置于一防水壳体内，所述线缆延伸出所述防水壳体，在与所述壳体的连接处设置有防水锁头。
专利摘要本实用新型公开了一种磁阻式电子罗经，包括电子罗经终端，其包括有三轴磁场加速度计、陀螺仪以及单片机，所述单片机包括有转速计算模块以及姿态角和航向角计算模块，所述三轴磁场加速度计与所述姿态角和航向角计算模块通信连接，所述陀螺仪与所述转速计算模块通信连接；智能设备，其包括第二通信模块，所述第一通信模块与第二通信模块通信连接。本实用新型所述的磁阻式电子罗经包括有三轴磁场加速度计、陀螺仪以及单片机，单片机通过I2C接口与智能设备通信连接，实现了对姿态角、航向角以及转速的测量与计算，本实用新型可靠性和通信效率高，占用资源少，体积小，安装简易。
文档编号G01C17/38GK203011386SQ201220682529
公开日2013年6月19日 申请日期2012年12月12日 优先权日2012年12月12日
发明者黄晓东, 卢一福, 徐红, 刘恒鹏, 方如波, 张嘉林 申请人:南宁睿洋自动化科技有限公司