CN102538824A - 一种适用于mems imu重复多次标定的方法 - Google Patents
一种适用于mems imu重复多次标定的方法 Download PDFInfo
- Publication number
- CN102538824A CN102538824A CN2011104608417A CN201110460841A CN102538824A CN 102538824 A CN102538824 A CN 102538824A CN 2011104608417 A CN2011104608417 A CN 2011104608417A CN 201110460841 A CN201110460841 A CN 201110460841A CN 102538824 A CN102538824 A CN 102538824A
- Authority
- CN
- China
- Prior art keywords
- correction factor
- receive
- mems imu
- new
- upgrading
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Gyroscopes (AREA)
Abstract
一种适用于MEMS IMU重复多次标定的方法,包括以下步骤:(1)升级原始修正系数:将MEMS IMU恢复到出厂设置;(2)MEMS IMU重复标定:对陀螺和加速度计分别进行重新标定;(3)获得新的修正系数:计算出对陀螺和加速度计标定参数进行修正的新系数,将新系数写入二进制文件;(4)升级新的修正系数:MEMS IMU升级包含新系数的二进制文件,将新系数二进制文件写入闪存;(5)MEMS IMU上电后,读取闪存中的新修正系数,修正各项标定参数,获得更准确的角速度和加速度输出。本发明解决传统方法中进行重复标定前需要修改嵌入式软件的问题,减少对软件的依赖,简单便捷,适用于批量MEMS IMU产品的重复标定。
Description
技术领域
本发明涉及一种适用于MEMS IMU重复多次标定的方法,特别是一种使MEMS IMU无需更改软件便可多次重复标定的方法。
背景技术
MEMS IMU作为一种由微传感器(微机械陀螺和加速度计)、微执行器(单片机或DSP)和电路集成的惯性测量装置,能实时提供载体的角速度与线加速度,目前在战术武器、汽车、工业控制等领域已获得广泛应用。
MEMS IMU通过采集电路对微传感器(微机械陀螺和加速度计)的电信号进行采集,然后通过标度因数转换将电信号转换成角速度和加速度单位输出。标度因数转换所需的参数已经通过初始标定试验计算获得并存入闪存。由于环境因素的影响,MEMS IMU标度因数转换所需的参数会发生变化,需要进行重复标定,通常重复标定前需要更改DSP软件,使MEMS IMU恢复电信号输出,然后进行标定试验,重新计算参数并更改DSP软件中相应值,最后将软件更改为标定后输出的状态,获得角速度和加速度信号。每一次重复标定都需要这个“改软件--重新标定--计算参数--改软件”过程。
因此,上述MEMS IMU重复多次标定的方法在实际应用中存在的难点:(1)如何减少重新标定时对软件的依赖,避免多次改软件引入错误风险;(2)如何设计重复标定的方法,使重复标定简单便捷,适用于批量产品。
发明内容
本发明的技术解决问题:克服现有技术的不足,提供了一种可靠性和效率更高的MEMS IMU多次标定方法,解决传统方法中进行重复标定前需要修改嵌入式软件的问题,减少对软件的依赖,能够有效防止更改软件引入错误风险,简单便捷,适用于批量MEMS IMU产品的重复标定。
本发明的技术解决方案:一种适用于MEMS IMU重复多次标定的方法,其特征在于通过重复标定获得对原始标定参数的修正系数,包括以下步骤:
(1)升级原始修正系数:将MEMS IMU恢复到出厂设置;
(2)MEMS IMU重复标定:对陀螺和加速度计分别进行重新标定;
(3)获得新的修正系数:计算出对陀螺和加速度计标定参数进行修正的新系数,将新系数写入二进制文件;
(4)升级新的修正系数:MEMS IMU升级包含新系数的二进制文件,将新系数二进制文件写入闪存;
(5)MEMS IMU上电后,读取闪存中的新修正系数,修正各项标定参数,获得更准确的角速度和加速度输出。
所述步骤(1)升级原始修正系数的实现步骤如下:
a、MEMS IMU加电后,接收上位机发送的升级指令,如果接收到升级指令则进入步骤b,如果没有接收到升级指令则进入正常工作流程;
b、MEMS IMU响应升级指令,进入升级状态,接收升级系数;
c、判断升级系数是否接收完整,没有接收完整则继续接收,接收完整则转入下一步;
d、MEMS IMU将接收到的原始修正系数进行校验后,将原始修正系数写入闪存。
所述步骤(4)升级新的修正系数的实现步骤如下:
a、MEMS IMU加电后,接收上位机发送的升级指令,如果接收到升级指令则进入步骤b,如果没有接收到升级指令则进入正常工作流程;
b、MEMS IMU响应升级指令,进入升级状态,接收升级系数;
c、判断升级系数是否接收完整,没有接收完整则继续接收,接收完整则转入下一步;
d、MEMS IMU将接收到的新的修正系数进行校验后,将新的修正系数写入闪存。
本发明与现有技术相比的优点在于:
(1)MEMS IMU重复多次标定时只需先升级固定的原始修正系数二进制文件,然后直接进行标定试验,无需修改嵌入式软件使其恢复到原始值输出。降低了对软件的依赖程度,避免了修改软件引起的错误风险,提高了现有技术的安全性。
(2)使用外部指令来控制MEMS IMU进行新修正系数升级,与外部总线输入输出数据的接口与MEMS IMU实现其正常功能的接口通用,简单便捷,适用于批量MEMS IMU产品的重复标定和修正系数升级,提高了现有技术的效率。
(3)在MEMS IMU进行修正系数升级过程中出现任何问题,升级将停止。可以将MEMS IMU上电复位后重新开始升级流程,升级未成功不会对升级流程产生影响,提高了现有技术的可靠性。
附图说明
图1为本发明的MEMS IMU重复多次标定方法流程图;
图2为重复标定时升级修正系数主函数流程图;
图3为重复标定时升级修正系数控制函数流程图。
具体实施方式
适用于MEMS IMU多次标定的方法用于对MEMS IMU进行重复、多次的标定,其目的是可靠、高效地对MEMS IMU进行重复标定。本发明的特点在于:1、可多次对MEMS IMU进行重复标定,计算出标定参数的修正系数,而无需对软件进行更改;2、根据外部指令来控制MEMS IMU进行修正系数升级,与外部总线输入输出数据的接口与MEMS IMU实现其正常功能的接口通用,简单便捷,适用于批量MEMS IMU产品的重复标定和系数升级。3、在MEMSIMU进行系数升级过程中出现任何问题,升级将停止。可以将MEMS IMU上电复位后重新开始升级流程。
如图1所示,为本发明的适用于MEMS IMU多次标定的方法,包括下列步骤:
1、升级原始修正系数文件:主要是为将MEMS IMU恢复到出厂设置。通过外部指令控制MEMS IMU升级原始修正系数的参数文件,将包含原始修正系数的二进制文件写入闪存。所述的原始系数文件为一固定的二进制文件,MEMS IMU出厂时由厂家提供。
如图2所示,MEMS IMU上电后,进行原始修正系数升级,升级过程如下:
a、MEMS IMU加电后,接收上位机发送的升级指令,如果接收到升级指令则进入步骤b,如果没有接收到升级指令则进入正常工作流程;
b、MEMS IMU响应升级指令,进入升级状态,接收升级系数;
c、判断升级系数是否接收完整,没有接收完整则继续接收,接收完整则转入下一步;
d、MEMS IMU将接收到的原始修正系数进行校验后,将原始修正系数写入闪存。
按所述步骤进行升级时,如果升级失败,需将MEMS IMU重新上电,然后按所述步骤重新开始升级流程。
上位机对MEMS IMU的控制流程如图3所示。
以微机械陀螺为例,出厂时MEMS IMU的陀螺的原始修正系数为K1,b1(K1=1,b1=0),假设此时陀螺输入为ωi,ωi经过前期各项标定试验计算出的标定参数转换后输出ωa,ωa为未经过原始修正系数计算的值。陀螺的输出值ωo为ωa经过原始修正系数计算后输出:
ωo=K1ωa+b1..............................(1)
如果陀螺标定参数准确,则ωo=ωa≈ωi,以一组试验数据为例,
ωi={-200,-100,-50,0,50,100,200},
ωa={-200.11,-100.06,-50.01,-0.006,50.02,100.06,200.08}
ωo={-200.11,-100.06,-50.01,-0.006,50.02,100.06,200.08},
输出误差小于1‰。如果陀螺参数发生了变化,ωi和ωa有较大误差,而此时ωo=ωa。以一组试验数据为例,
ωi={-200,-100,-50,0,50,100,200},
ωa={-200.5,-100.3,-50.18,0.1,50.16,100.32,200.62}
ωo={-200.5,-100.3,-50.18,0.1,50.16,100.32,200.62}
则公式1中的K1,b1参数已经不能准确修正陀螺输出;
2、MEMS IMU重新标定:对MEMS IMU中陀螺仪与加速度计进行重复标定。标定方法有很多,例如静态多位置试验方法、角速率试验方法和分度头试验方法。针对不同量程和要求的MEMS IMU可以选择适合的标定试验方法。
以微机械陀螺重新标定为例,采用角速率试验方法,利用转台给MEMS IMU输入一系列标称的角速度ωi(i=1,2,…,n),将获得一系列相应的MEMS IMU输出值ωo(i=1,2,…,n)。以一组试验数据为例,
ωi={-200,-100,-50,0,50,100,200},
ωa={-200.5,-100.3,-50.18,0.1,50.16,100.32,200.62}
ωo={-200.5,-100.3,-50.18,0.1,50.16,100.32,200.62}
3、获得新的修正系数:计算出对陀螺和加表标定参数进行修正的新系数,将新系数写入二进制文件。
下面以上述陀螺重新标定的数据为例计算陀螺的标定参数修正系数。计算的目的是使得ωo≈ωi,提高MEMS IMU的测量精度。
将ωa看做输入,ωo看做输出,通过Kω和bω的修正使得ωo≈ωi。可以按下式计算:
ωo=Kω·ωa+bω.......................................(2)
式中,ωo--对应转台给定每一标称输入时的陀螺输出,°/s;
Kω--陀螺标度因数修正系数,无量纲;
ωa--未经过Kω和bω修正系数计算的输出,°/s;
bω--陀螺标定零位修正系数,°/s。
由下式计算各个系数:
式中,ωai--第i校准点对应的未修正输出量,°/s;
ωoi--第i校准点陀螺仪输出角速率,°/s。
将步骤(2)中的数据代入公式(3)和(4)中,令ωa={-200.5,-100.3,-50.18,0.1,50.16,100.32,200.62}
ωo=ωi={-200,-100,-50,0,50,100,200}
可计算得到:
Kω=0.99712246,bω=-0.0313381。
令ωo=Kω·ωa+bω,则ωa经过新修正系数计算得到
ωo={-199.954 -100.0427 -50.0669 0.0683 49.9843 100 200.0114};
此时经过修正系数校正的输出值ωo≈ωi,实现了二次标定的目的。
通过上述方法可获得陀螺两项标定参数(标度因数和标定零位)的修正系数,采用分度头试验方法和静态多位置试验方法,可获得陀螺其他标定参数(如安装误差)和加表各项标定参数的修正系数。
通常情况下,MEMS IMU中陀螺仪和加速度计的标定参数均为标度因数、标定零位和安装误差。根据上述步骤(2)中的试验数据和新的标度因数和标定零位,也可以获得安装误差的新修正系数。一般情况下陀螺安装误差原始修正系数为A1, 假设此时陀螺输入为ωi,ωi经过前期各项标定试验计算出的标定参数转换后输出ωa,而ωo为ωa经过ωo=Kω·ωa+bω校正后的输出。假 设ωot为ωo经过A1计算后得到的角速度输出值:
ωot=A1×ωo..............................(5)
其中
如上所述,步骤(2)中的试验数据经过标度因数修正系数Kω、零位修正系数bω和原始修正系数A1的修正计算,可获得一系列相应的MEMS IMU输出值ωot。假设对X轴进行试验时,X轴的转速最大时X轴陀螺的输出为ωxot,此时Y、Z轴的输出分别为ωyot、ωzot。则通过公式(6)可得到X轴对Y轴的安装误差修正系数θXY、X轴对Z轴的安装误差修正系数θXZ。
θXY=ωyot/ωxot
..............................(6)
θXZ=ωzot/ωxot
同理,对Y轴进行试验时,Y轴转速最大时Y轴陀螺的输出为ωyot,此时X、Z轴的输出分别为ωxot、ωzot。则通过公式(7)可得到Y轴对X轴的安装误差修正系数θXY、Y轴对Z轴的安装误差修正系数θXZ。
θYX=ωxot/ωyot
..............................(7)
θXZ=ωzot/ωyot
同理,对Z轴进行试验时,Z轴转速最大时Y轴陀螺的输出为ωzot,此时X、Y轴的输出分别为ωxot、ωyot。则通过公式(8)可得到Z轴对X轴的安装误差修正系数θZX、Z轴对Y轴的安装误差修正系数θXZ。
θZX=ωxot/ωzot
..............................(8)
θZY=ωyot/ωzot
令新的安装误差修正系数为
通过上述数学计算方法可获得安装误差修正系数。
获得所需的各项修正系数后,根据MEMS IMU输入输出数据格式的要求,将其生成二进制文件。
4、升级新的修正系数:通过外部指令控制MEMS IMU升级包含新系数的二进制文件,将新系数写入闪存。
MEMS IMU上电后,进行新的修正系数升级,如图2所示,升级过程如下:
a、MEMS IMU加电后,接收上位机发送的升级指令,如果接收到升级指令则进入步骤b,如果没有接收到升级指令则进入正常工作流程;
b、MEMS IMU响应升级指令,进入升级状态,接收升级系数;
c、判断升级系数是否接收完整,没有接收完整则继续接收,接收完整则转入下一步;
d、MEMS IMU将接收到的新的修正系数进行校验后,修正系数写入闪存。
按所述步骤进行升级时,如果升级失败,需将MEMS IMU重新上电,然后按所述步骤重新开始升级流程。
5、MEMS IMU上电后,读取闪存中的新修正系数。通过数学计算方法来修正各项标定参数,获得更准确的角速度和加速度输出。
MEMS IMU上电后,读取闪存中的新修正系数,通过计算方法ωo=Kω·ωa+bω来修正由于标定参数不准确而造成的陀螺和或加表输出,同时通过ωot=Aωωo来消除安装误差的影响,获得更准确的角速度和加速度输出。
本说明书未尽事宜属于本领域技术人员公知技术。
Claims (3)
1.一种适用于MEMS IMU重复多次标定的方法,其特征在于通过重复标定获得对原始标定参数的修正系数,包括以下步骤:
(1)升级原始修正系数:将MEMS IMU恢复到出厂设置;
(2)MEMS IMU重复标定:对陀螺和加速度计分别进行重新标定;
(3)获得新的修正系数:计算出对陀螺和加速度计标定参数进行修正的新系数,将新系数写入二进制文件;
(4)升级新的修正系数:MEMS IMU升级包含新系数的二进制文件,将新系数二进制文件写入闪存;
(5)MEMS IMU上电后,读取闪存中的新修正系数,修正各项标定参数,获得更准确的角速度和加速度输出。
2.根据权利要求1所述的一种适用于MEMS IMU重复多次标定的方法,其特征在于所述步骤(1)升级原始修正系数的实现步骤如下:
a、MEMS IMU加电后,接收上位机发送的升级指令,如果接收到升级指令则进入步骤b,如果没有接收到升级指令则进入正常工作流程;
b、MEMS IMU响应升级指令,进入升级状态,接收升级系数;
c、判断升级系数是否接收完整,没有接收完整则继续接收,接收完整则转入下一步;
d、MEMS IMU将接收到的原始修正系数进行校验后,将原始修正系数写入闪存。
3.根据权利要求1所述的一种适用于MEMS IMU重复多次标定的方法,其特征在于所述步骤(4)升级新的修正系数的实现步骤如下:
a、MEMS IMU加电后,接收上位机发送的升级指令,如果接收到升级指令则进入步骤b,如果没有接收到升级指令则进入正常工作流程;
b、MEMS IMU响应升级指令,进入升级状态,接收升级系数;
c、判断升级系数是否接收完整,没有接收完整则继续接收,接收完整则转入下一步;
d、MEMS IMU将接收到的新的修正系数进行校验后,将新的修正系数写入闪存。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110460841.7A CN102538824B (zh) | 2011-12-29 | 2011-12-29 | 一种适用于mems imu重复多次标定的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110460841.7A CN102538824B (zh) | 2011-12-29 | 2011-12-29 | 一种适用于mems imu重复多次标定的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102538824A true CN102538824A (zh) | 2012-07-04 |
CN102538824B CN102538824B (zh) | 2015-07-08 |
Family
ID=46346306
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110460841.7A Active CN102538824B (zh) | 2011-12-29 | 2011-12-29 | 一种适用于mems imu重复多次标定的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102538824B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104063242A (zh) * | 2014-06-10 | 2014-09-24 | 北京遥测技术研究所 | 一种适用于惯性测量单元全生产过程参数升级的方法 |
CN109001662A (zh) * | 2018-06-08 | 2018-12-14 | 中国电子科技集团公司第四十研究所 | 一种自动恢复电子校准件定标数据的装置和方法 |
CN114322973A (zh) * | 2022-01-10 | 2022-04-12 | 北京自动化控制设备研究所 | 一种mems哥氏力陀螺asic最优控制参数获取方法 |
CN116481570A (zh) * | 2023-05-24 | 2023-07-25 | 无锡凌思科技有限公司 | 一种多mems陀螺仪协同误差修正方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6968281B2 (en) * | 2001-11-06 | 2005-11-22 | Honeywell International, Inc. | Method for calibrating an inertial measurement unit |
CN1811340A (zh) * | 2006-02-24 | 2006-08-02 | 北京航空航天大学 | 一种微小飞行器自动驾驶用双捷联解算组合导航方法 |
CN101135972A (zh) * | 2006-08-29 | 2008-03-05 | 中兴通讯股份有限公司 | 一种对终端Flash软件进行升级的方法 |
CN101950254A (zh) * | 2010-09-16 | 2011-01-19 | 新邮通信设备有限公司 | 一种软件更新方法和*** |
CN102183253A (zh) * | 2010-12-31 | 2011-09-14 | 北京航空航天大学 | 一种位置和姿态测量***的软件时间同步方法 |
CN102222010A (zh) * | 2011-06-21 | 2011-10-19 | 中兴通讯股份有限公司 | 一种移动终端版本升级的方法及实现*** |
US20110301902A1 (en) * | 2010-06-04 | 2011-12-08 | Apple Inc. | Inertial measurement unit calibration system |
-
2011
- 2011-12-29 CN CN201110460841.7A patent/CN102538824B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6968281B2 (en) * | 2001-11-06 | 2005-11-22 | Honeywell International, Inc. | Method for calibrating an inertial measurement unit |
CN1811340A (zh) * | 2006-02-24 | 2006-08-02 | 北京航空航天大学 | 一种微小飞行器自动驾驶用双捷联解算组合导航方法 |
CN101135972A (zh) * | 2006-08-29 | 2008-03-05 | 中兴通讯股份有限公司 | 一种对终端Flash软件进行升级的方法 |
US20110301902A1 (en) * | 2010-06-04 | 2011-12-08 | Apple Inc. | Inertial measurement unit calibration system |
CN101950254A (zh) * | 2010-09-16 | 2011-01-19 | 新邮通信设备有限公司 | 一种软件更新方法和*** |
CN102183253A (zh) * | 2010-12-31 | 2011-09-14 | 北京航空航天大学 | 一种位置和姿态测量***的软件时间同步方法 |
CN102222010A (zh) * | 2011-06-21 | 2011-10-19 | 中兴通讯股份有限公司 | 一种移动终端版本升级的方法及实现*** |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104063242A (zh) * | 2014-06-10 | 2014-09-24 | 北京遥测技术研究所 | 一种适用于惯性测量单元全生产过程参数升级的方法 |
CN104063242B (zh) * | 2014-06-10 | 2017-07-07 | 北京遥测技术研究所 | 一种适用于惯性测量单元全生产过程参数升级的方法 |
CN109001662A (zh) * | 2018-06-08 | 2018-12-14 | 中国电子科技集团公司第四十研究所 | 一种自动恢复电子校准件定标数据的装置和方法 |
CN109001662B (zh) * | 2018-06-08 | 2020-07-03 | 中国电子科技集团公司第四十一研究所 | 一种自动恢复电子校准件定标数据的装置和方法 |
CN114322973A (zh) * | 2022-01-10 | 2022-04-12 | 北京自动化控制设备研究所 | 一种mems哥氏力陀螺asic最优控制参数获取方法 |
CN116481570A (zh) * | 2023-05-24 | 2023-07-25 | 无锡凌思科技有限公司 | 一种多mems陀螺仪协同误差修正方法 |
CN116481570B (zh) * | 2023-05-24 | 2023-10-20 | 无锡凌思科技有限公司 | 一种多mems陀螺仪协同误差修正方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102538824B (zh) | 2015-07-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108562288B (zh) | 一种激光捷联惯组***级在线自标定***及方法 | |
US10632615B2 (en) | Servo driving method, apparatus, and robot thereof | |
CN105387859B (zh) | Mems传感器组合温度漂移误差补偿方法 | |
CN100559189C (zh) | 一种惯性测量单元的无定向多位置高精度标定方法 | |
CN102538824B (zh) | 一种适用于mems imu重复多次标定的方法 | |
US10417360B2 (en) | True hardware in the loop SPI emulation | |
CN104063242A (zh) | 一种适用于惯性测量单元全生产过程参数升级的方法 | |
WO2024125071A1 (zh) | Gnss/ins冗余组合导航方法、模组、***及介质 | |
CN102607591B (zh) | 一种用于捷联惯导软件测试的轨迹数据生成方法 | |
CN114026572A (zh) | 模拟神经网络中的误差补偿 | |
CN104122936A (zh) | 一种mcu芯片分频时钟校正装置及方法 | |
CN103616037A (zh) | 一种imu标定***的自检自校方法 | |
Brembeck | A physical model-based observer framework for nonlinear constrained state estimation applied to battery state estimation | |
CN103323031B (zh) | 一种基于星敏的地平仪***误差在线补偿的方法 | |
CN104121930A (zh) | 一种基于加表耦合的mems陀螺漂移误差的补偿方法 | |
CN105277210A (zh) | 一种任意安装多轴陀螺组合标定方法 | |
CN103743411A (zh) | 一种捷联惯性导航***标定的方法 | |
CN110940336B (zh) | 捷联惯导仿真定位解算方法、装置及终端设备 | |
US11526580B2 (en) | Data correction method and apparatus, electronic device and computer-readable storage medium | |
CN101324453A (zh) | 一种仪表校准方法及其校准装置 | |
CN109582334A (zh) | 可编程逻辑器件的升级方法及装置 | |
CN104029643B (zh) | 一种重力传感器温度偏差动态补偿*** | |
CN106895832A (zh) | 一种陀螺组合的角速度信号模拟方法 | |
CN112286039A (zh) | 钟表校准方法、装置及可读存储介质 | |
CN103631152A (zh) | 发动机控制器硬件在环仿真扭矩/转速复合信号模拟方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |