IMU(陀螺仪、加速度计)Magnetometer(磁力计)校准方法和流程
一、何为校准:
校准的目的是因为厂商在生产器件时,由于工艺、技术等原因,致使器件存在缺陷,导致实际应用时,存在误差!
一般器件在出厂时,都会做一些校准处理,比如以Sensonor公司的Stim300为例:
一般用户采购IMU器件后,仍会对IMU进行校准,参数如下:零偏稳定性、比例因子(温度)、非正交性等。 批量使用和单个试验样机的校准方式和校准参数多少有不同;下面就以单个IMU(加速度计、陀螺仪)的参数进行校准:
假定:
- 导航坐标系:东-北-天
- 载体坐标系:右-前-上
重力矢量和地球自转角速度在地理坐标系下:
速度微分方程为:
如上,速度微分方程,等号左边为0.右边第二项为0,只剩下右边第一项和第三项,其中要保证Cnb为已之值。
校准条件:首先是静止,保持水平面;既可以标定出零偏和比例因子;
如果还需要标定非正交性参数,需要将将载体坐标系三轴(右前上)分别与导航坐标系(东北天)平行,以保证Cnb为单位矩阵;这样能够保证比力fb=fn;
二、IMU校准
1、加速度计:
六位置校准:只能校准X、Y、Z轴的零偏(Bias)和比例因子(Scale Factor Error),共6个参数!
如下分别求:Z、X、Y轴的零偏和比例因子:
比如以下:(注意如果载体系为前右上时,(1+s)*g 前面的符号是反的),
2、陀螺仪:
三、磁力计校准
地球磁场:地球的磁场象一个条形磁体一样由磁南极指向磁北极。在磁极点处磁场和当地的水平面垂直,在赤道磁场和当地的水平面平行,所以在北半球磁场方向倾斜指向地面。用来衡量磁感应强度大小的单位是Tesla或者Gauss(1Tesla=10000Gauss)。随着地理位置的不同,通常地磁场的强度是0.4-0.6Gauss。需要注意的是,磁北极和地理上的北极并不重合,通常他们之间有11.5度左右的夹角。
(1) 地球磁场分布图:
(2) 地磁要素图:
设观测点在O处,并以O点为原点建立地理坐标系OXYZ,X轴指向北,Y轴指向东,Z轴垂直指向地。
地磁场强度T在X轴上的投影Bn称为地磁场的北向分量;T在Y轴上的投影Be称为东向分量;T在Z轴上的投影Bz称为地磁场的垂向分量。T在水平面O-XY的投影Bh称为地磁场的水平分量。地磁水平分量Bh和垂向分量Bz所在平面称为磁子午面,磁子午面和地理子午面O-XZ平面的夹角称为磁偏角,用D表示,并规定其东偏为正,西偏为负。地磁场强度T与水平面O-XY的夹角称为磁倾角,用I表示。上述,T、Bh、Bn、Be、Bz、D、I统称为地磁场七要素,可作为定位定向的参考量。七要素只要知道三个独立的要素,就可以求其余的要素,常用的是磁倾角、磁偏角和水平分量。七要素间有如下关系:
(3) 中国地磁要素变化:
中国的地磁要素大致分布情况:国境内地磁强度总量范围0.41~0.60Gauss(1 Gauss = 10^-4T);水平分量Bh由南至北从0.4降至0.21;垂直分量Bz由南至北从-0.1增至0.56;磁倾角I由南至北从-10°增至70°;磁偏角D由东向西从-11°增至5°,零偏线在中国中部偏西处,由北向南经过甘肃的安西以及西藏的得宋。
(4) 地磁场的一级近似:
对地磁场的一种近似,如下图所示:
不考虑地磁轴与地球自转轴的偏离问题,地磁强度分量可用以下解析式来描述:
其中,东向地磁分量为0;在实际运算中,将磁力计在水平面X、Y轴的测量值,全部投影到北向,并将东向置零。
在加速度计/磁力计标定中,一般采用十二位置标定法,其中十二位置法,包含了了36个轴向,以前上右为载体坐标系;北天东为导航坐标系
1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 | 9 | 10 | 11 | 12 |
---|---|---|---|---|---|---|---|---|---|---|---|
北 | 南 | 南 | 北 | 天 | 天 | 地 | 地 | 北 | 南 | 北 | 南 |
天 | 天 | 地 | 地 | 南 | 北 | 北 | 南 | 西 | 东 | 东 | 西 |
东 | 西 | 东 | 西 | 东 | 西 | 东 | 西 | 天 | 天 | 地 | 地 |
以上12位置实验,可以看出:X、Y、Z三轴在每一个方向都存在6次。
北 | 4 | 2 | 0 | 6 |
南 | 4 | 2 | 0 | 6 |
地 | 2 | 2 | 2 | 6 |
天 | 2 | 2 | 2 | 6 |
西 | 0 | 2 | 4 | 6 |
东 | 0 | 2 | 4 | 6 |
参考:
《自主定位定向技术》
《Applications of Magnetoresistive Sensors in Navigation Systems》
《三轴磁阻式传感器标定方法研究》
《一种十二位置不对北的磁罗盘标定方法》
《基于WMM 2005的地磁计算》
ST集成传感器方案实现电子罗盘功能
ST集成传感器方案实现电子罗盘功能
地磁导航的应用风口来了?
以IndoorAtlas为基础,百度地图将深度整合地磁定位技术
高三物理复习微专题1---《地磁场》
椭球面
IMU(陀螺仪、加速度计)Magnetometer(磁力计)校准方法和流程相关推荐
- 陀螺仪加速度计磁罗盘的校准
一.校准加速度计 加速度计有零偏和尺度误差.还有其他误差,这里只讨论这两种误差. 六面校准法:目的是让输出的数据在9.8mss左右(可以将Xmax = 9.44, Xmin = -10.24代进去感受 ...
- Raspberry Pi和Python校准惯性测量单元-陀螺仪-加速度计-磁力计
惯性测量单元校准 惯性测量单元(IMU)可以由单个传感器或传感器集合组成,这些传感器或传感器集合捕获旨在测量给定参考系中的惯性运动的数据. 加速度,旋转速度和磁场强度是IMU中包含的传感器的示例. I ...
- IMU之磁力计校准地磁场计算磁航向
背景知识: 导航坐标系:东-北-天 载体坐标系:右-前-上 欧拉角定义:3-1-2旋转,(航向角-俯仰角-滚转角): 航向角北偏西为正,范围[-pi pi]: 俯仰角, 运载体抬头时角度定义为正,角度 ...
- 一文看懂机器人使用的惯性测量/IMU中常见的名词:陀螺仪/ 加速度计/ 磁力计/MEMS/ IMU/ AHRS/ 6轴(6DOF) /9轴(9DOF)/ 欧拉角/四元数
在接触惯性测量单元(IMU)中,通常会涉及到很多专业名词,其中包括以下物理量.工艺方法.数学表达等,下文中会涉及到以下名词的解释,以下解释仅作为个人理解,不作为权威名词解释,如果错误或片面,请不吝啬指 ...
- UAV021(三):九轴传感器(加速度计、陀螺仪和磁力计)校准方法
目录 序 一. 加速度计简单校准 二.陀螺仪简单校准 三.磁力计简单校准 序 UAV021(二)中使用STM32F4通过IIC协议实现了读取加速度.角速度以及Yaw角.然而,原始数据是不能用的,校准是 ...
- 陀螺仪加速度计MPU6050程序与校准方法
文章目录 前言 一.陀螺仪与加速度计简介 二.程序使用 1.初始化 2.读取数据 三.误差校准 1.陀螺仪校准 2.加速度计校准 3.校准后的输出 四.源码获取 前言 本文将介绍陀螺仪和加速度计的使用 ...
- imu和mems的差别_MEMS加速度计,磁力计和定向角
imu和mems的差别 When it's necessary to evaluate the orientation angles of an object you may have the que ...
- 基于四旋翼飞行器的陀螺仪、加速度计、磁力计传感器说明
一 什么是磁力计.加速度计和陀螺仪以及他们之间的区别 1.什么是陀螺仪.加速度计和磁力计? (1)陀螺仪(Gyroscope.GYRO-Sensor)也叫地感器,三轴陀螺仪的工作原理是通过测量三维坐标 ...
- 九轴陀螺仪ICM20948磁力计校准
九轴陀螺仪ICM20948磁力计校准 ICM20948九轴传感器目前应用广泛,是非常适合用于智能手机,平板电脑,可穿戴式传感器,物联网和应 用的全球功耗最低的9轴MotionTracking设备.其融 ...
最新文章
- 初学者 | 一文读懂命名实体识别
- 结合typedef更为直观的应用函数指针
- linux下能ping ip不能ping域名详解
- Devuan Jessie beta 释出
- 【Java】深入探讨Java数值舍入问题
- Java static用法代码讲解
- linux下无法删除文件夹,linux服务器下完美解决无法删除虚拟主机文件或文件夹...
- ssh 两个mysql数据库_SSH下,关于多数据库的两个问题
- 5G无线技术基础自学系列 | 5G NR和LTE信道结构比较
- SpringCloud五大核心组件
- python node.js ruby_Python/Ruby/Node.js/Perl - 随笔分类 - bluefrog - 博客园
- args在python中什么意思_Python中*args、**args到底是什么、有啥区别、怎么用
- Java并发原理解析!docker命令
- dell蓝牙图标消失,不能用
- Resource Acquisition Is Initialization
- 最新行业薪资排行榜:IT行业超13万,稳居第一!
- 中秋未到却卖到断货的月饼,究竟有多好吃?
- python多线程url采集器 + github_利用Python3.5多线程抓取妹子图
- ⭐算法入门⭐《前缀和》中等02 —— LeetCode 974. 和可被 K 整除的子数组
- 中国拟薄水铝石市场产销情况及投资前景预测报告2022-2027年