一种基于MEMS的高精度三维姿态惯性测量系统以及测量方法，涉及一种基于MEMS的高精度三维姿态惯性测量方法。本发明专利技术是为了解决现有的三维姿态惯性测量设备采用传感器成本高、精度低的问题。三轴陀螺仪计传感器用于将测量的角速度数据发送给ARM处理器，三轴加速度计传感器用于将测量的加速度数据发送给ARM处理器，三轴磁强计传感器用于将测量的磁强数据发送给ARM处理器，温度传感器用于测量将获得的三轴陀螺仪计传感器温漂数据发送给ARM处理器，ARM处理器用来对接收到的数据分别进行前置低通数字滤波、前端数据处理和拓展卡尔曼滤波处理，获得欧拉角三维姿态惯性数据或者四元数三维姿态惯性数据。它可用于导航控制领域。
【技术实现步骤摘要】
【专利摘要】一种基于MEMS的高精度三维姿态惯性测量系统以及测量方法，涉及一种基于MEMS的高精度三维姿态惯性测量方法。本专利技术是为了解决现有的三维姿态惯性测量设备采用传感器成本高、精度低的问题。三轴陀螺仪计传感器用于将测量的角速度数据发送给ARM处理器，三轴加速度计传感器用于将测量的加速度数据发送给ARM处理器，三轴磁强计传感器用于将测量的磁强数据发送给ARM处理器，温度传感器用于测量将获得的三轴陀螺仪计传感器温漂数据发送给ARM处理器，ARM处理器用来对接收到的数据分别进行前置低通数字滤波、前端数据处理和拓展卡尔曼滤波处理，获得欧拉角三维姿态惯性数据或者四元数三维姿态惯性数据。它可用于导航控制领域。【专利说明】一种基于MEMS的高精度三维姿态惯性测量系统以及测量方法
本专利技术涉及一种空间三维姿态测量方法，特别是涉及一种基于MEMS的高精度三维姿态惯性测量方法。
技术介绍
无人机、机器人、机械云台、车辆船舶、虚拟现实、人体运动分析等在近年都取得了迅猛的发展。而在这些应用中，三维姿态与方位的自主测量显得极为重要。现有的三维姿态与方位传感器中，MEMS传感器成本低廉，但是测量数据由于存在较大的零偏、温漂等误差较大不能满足以上应用对于精度的要求；而一些MU模块，在精度上能满足要求，但是成本高昂，限制了在实际中的应用。
技术实现思路
本专利技术是为了解决现有的三维姿态惯性测量设备采用传感器成本高、精度低的问题。现提供一种基于MEMS的高精度三维姿态惯性测量系统以及该测量方法。一种基于MEMS的高精度三维姿态惯性测量系统，它包括微机电式惯性测量器件，它还包括ARM处理器和温度传感器，所述的微机电式惯性测量器件包括三轴陀螺仪计传感器、三轴加速度计传感器和三轴磁强计传感器，三轴陀螺仪计传感器，用于测量获得角速度，并将测量获得的角速度数据发送给ARM处理器，三轴加速度计传感器，用于测量获得加速度，并将测量获得的加速度数据发送给ARM处理器，三轴磁强计传感器，用于测量获得磁强，并将测量获得的磁强数据发送给ARM处理器，温度传感器，用于测量获得三轴陀螺仪计传感器的温漂，并将测量获得的温漂数据发送给ARM处理器，ARM处理器，用来对接收到的角速度数据、加速度数据、磁强数据和温度传感器数据分别进行前置低通数字滤波、前端数据处理和拓展卡尔曼滤波处理，还用于对滤除外界高频干扰的所有数据进行数据融合，获得欧拉角三维姿态惯性数据或者四元数三维姿态惯性数据。该系统采用一个ARM处理器采集三轴陀螺仪计传感器、三轴加速度计传感器和三轴磁强计传感器的测量数据及采集温度传感器获得三轴陀螺仪计传感器的温漂，再通过对测量的数据进行前置低通数字滤波与前端数据处理和进行拓展卡尔曼滤波，滤除外界高频干扰并进行数据融合，对外实时输出四元数或欧拉角三维姿态方位数据，该设备采用一个ARM处理器，集合一个三轴陀螺仪计传感器、一个三轴加速度计传感器和一个三轴磁强计传感器并装载一个温度传感器，其测量精度同比现有的采用方位传感器要提高2倍以上，并且该系统采用三轴陀螺仪计传感器、三轴加速度计传感器和三轴磁强计传感器同比现有的采用方位传感器的成本低。它可用于导航控制领域。【专利附图】【附图说明】图1为【具体实施方式】一所述的一种基于MEMS的高精度三维姿态惯性测量系统的原理示框图；图2为【具体实施方式】五所述的一种基于MEMS的高精度三维姿态惯性测量系统的测量方法的流程图。【具体实施方式】【具体实施方式】一:参照图1具体说明本实施方式，本实施方式所述的一种基于MEMS的高精度三维姿态惯性测量系统，它包括微机电式惯性测量器件，它还包括ARM处理器4和温度传感器5，所述的微机电式惯性测量器件包括三轴陀螺仪计传感器1、三轴加速度计传感器2和三轴磁强计传感器3，三轴陀螺仪计传感器1，用于测量获得角速度，并将测量获得的角速度数据发送给ARM处理器4，三轴加速度计传感器2，用于测量获得加速度，并将测量获得的加速度数据发送给ARM处理器4，三轴磁强计传感器3，用于测量获得磁强，并将测量获得的磁强数据发送给ARM处理器4，温度传感器5，用于测量获得三轴陀螺仪计传感器I的温漂，并将测量获得的温漂数据发送给ARM处理器4，ARM处理器4，用来对接收到的角速度数据、加速度数据、磁强数据和温漂数据分别进行前置低通数字滤波、前端数据处理和拓展卡尔曼滤波处理，还用于对滤除外界高频干扰的所有数据进行数据融合，获得欧拉角三维姿态惯性数据输出或者四元数三维姿态惯性数据输出。【具体实施方式】二:本实施方式与【具体实施方式】一所述的一种基于MEMS的高精度三维姿态惯性测量系统的不同点在于，ARM处理器4采用型号为STM32F405实现。【具体实施方式】三:本实施方式与【具体实施方式】一所述的一种基于MEMS的高精度三维姿态惯性测量系统的不同点在于，三轴陀螺仪计传感器I采用型号为MPU6050实现。【具体实施方式】四:本实施方式与【具体实施方式】一所述的一种基于MEMS的高精度三维姿态惯性测量系统的不同点在于，三轴加速度计传感器2和三轴磁强计传感器3采用型号为AK8975实现。【具体实施方式】五:米用【具体实施方式】一所述的一种基于MEMS的高精度三维姿态惯性测量系统实现三维姿态惯性的测量方法，它包括以下步骤:步骤一、将三轴陀螺仪计传感器1、三轴加速度计传感器2和三轴磁强计传感器3水平固定在转台上，使三轴陀螺仪计传感器I的敏感轴X、三轴加速度计传感器2的敏感轴X和三轴磁强计传感器3的敏感轴X相互平行,三轴陀螺仪计传感器I的敏感轴y、三轴加速度计传感器2的敏感轴y和三轴磁强计传感器3的敏感轴y相互平行，三轴陀螺仪计传感器I的敏感轴z、三轴加速度计传感器2的敏感轴z和三轴磁强计传感器3的敏感轴z相互平行，分别对三轴陀螺仪计传感器1、三轴加速度计传感器2和三轴磁强计传感器3进行标定，获取硬件平台的校准参数；步骤二、系统进行初始化对准，ARM处理器4周期性读取三轴陀螺仪计传感器I敏感轴X、y、z轴的数据gx, gy, gz、三轴加速度计传感器2敏感轴X、y、z轴的数据ax, ay, az和三轴磁强计传感器3敏感轴X、y、z轴的数据mx, my, mz和温度传感器的数据T ；步骤三、利用读到的三轴加速度计传感器2敏感轴的数据和三轴磁强计传感器3敏感轴的数据以及利用俯仰角公式【权利要求】1.一种基于MEMS的高精度三维姿态惯性测量系统，它包括微机电式惯性测量器件，其特征在于，它还包括ARM处理器(4 )和温度传感器(5 )， 所述的微机电式惯性测量器件包括三轴陀螺仪计传感器(I)、三轴加速度计传感器(2)和三轴磁强计传感器(3)， 三轴陀螺仪计传感器(1)，用于测量获得角速度，并将测量获得的角速度数据发送给ARM处理器(4)， 三轴加速度计传感器(2)，用于测量获得加速度，并将测量获得的加速度数据发送给ARM处理器(4)， 三轴磁强计传感器(3)，用于测量获得磁强，并将测量获得的磁强数据发送给ARM处理器⑷， 温度传感器(5)，用于测量获得三轴陀螺仪计传感器(I)的温漂，并将测量获得的温漂数据发送给ARM处理器(4)， ARM处理器(4)，用来对接收到的角速度数据、加速度数据、磁强数据和温漂数本文档来自技高网...
【技术保护点】
一种基于MEMS的高精度三维姿态惯性测量系统，它包括微机电式惯性测量器件，其特征在于，它还包括ARM处理器（4）和温度传感器（5），所述的微机电式惯性测量器件包括三轴陀螺仪计传感器（1）、三轴加速度计传感器（2）和三轴磁强计传感器（3），三轴陀螺仪计传感器（1），用于测量获得角速度，并将测量获得的角速度数据发送给ARM处理器（4），三轴加速度计传感器（2），用于测量获得加速度，并将测量获得的加速度数据发送给ARM处理器（4），三轴磁强计传感器（3），用于测量获得磁强，并将测量获得的磁强数据发送给ARM处理器（4），温度传感器（5），用于测量获得三轴陀螺仪计传感器（1）的温漂，并将测量获得的温漂数据发送给ARM处理器（4），ARM处理器（4），用来对接收到的角速度数据、加速度数据、磁强数据和温漂数据分别进行前置低通数字滤波、前端数据处理和拓展卡尔曼滤波处理，还用于对滤除外界高频干扰的所有数据进行数据融合，获得欧拉角三维姿态惯性数据输出或者四元数三维姿态惯性数据输出。
【技术特征摘要】
【专利技术属性】
技术研发人员：胡庆雷，肖冰，陈卓，
申请(专利权)人：哈尔滨工业大学，
类型：发明
国别省市：黑龙江;23
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。