CN115655272B - Mems加速度计零偏和标度因数的温度补偿方法及系统 - Google Patents
Mems加速度计零偏和标度因数的温度补偿方法及系统 Download PDFInfo
- Publication number
- CN115655272B CN115655272B CN202211691805.6A CN202211691805A CN115655272B CN 115655272 B CN115655272 B CN 115655272B CN 202211691805 A CN202211691805 A CN 202211691805A CN 115655272 B CN115655272 B CN 115655272B
- Authority
- CN
- China
- Prior art keywords
- temperature
- sequence
- matrix
- accelerometer
- value
- 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.)
- Active
Links
Images
Landscapes
- Indication And Recording Devices For Special Purposes And Tariff Metering Devices (AREA)
Abstract
本发明公开了基于MEMS加速度计零偏和标度因数的温度补偿方法及系统,方法包括:计算常温环境下温度均值、零点偏移矩阵、标度因数矩阵、固定交叉耦合系数矩阵;进行两个不同位置的变温试验,得到对应加速度计数值序列和目标区间的温度序列,获取各加速度序列中温度均值对应的加速度计数值;根据标度因数矩阵的逆矩阵、固定交叉耦合系数矩阵、温度均值对应的加速度计数值,计算得到零偏序列和标度因数序列;对温度序列和零偏序列进行曲线拟合得到零点偏移参数,对温度序列和标度因数序列进行曲线拟合得到标度因数参数;获取MEMS加速度计数据输出值,用零点偏移参数和标度因数参数补偿得到真实值。本发明提高了MEMS加速度计测量精度。
Description
技术领域
本发明涉及惯性导航技术领域,尤其涉及一种MEMS加速度计零偏和标度因数的温度补偿方法及系统。
背景技术
微机械电子系统(Micro-Electro-Mechanical System,MEMS),又称为微机电系统,是采用纳米技术加工出的新一代微型机电装置。加速度计是一种微机电系统惯性测量单元(Inertial Measurement Unit,IMU)的核心器件,用于测量载体的加速度,具有体积小、精度高、寿命长等优点,被广泛地应用于惯性导航与定位领域。
在系统工作过程中,由于工作环境或自然升温而引起的温度变化会导致惯性器件有所误差。为了解决这一问题,通常需要对惯性器件做温度补偿。通常加速度计补偿方式为将惯导系统水平放置于温箱中,进行变温试验,通过线性拟合的方式解算出温度补偿系数。然而,在传统加速度计温度补偿方法中,只能对加速度计进行零偏温度补偿,导致测量精度不够,容易出现误差。
发明内容
本发明要解决的技术问题就在于:针对现有技术存在的技术问题,本发明提供一种MEMS加速度计零偏和标度因数的温度补偿方法及系统,对MEMS加速度计在温度变化时造成的零点数据偏移和标度精度的降低进行了有效的补偿,提高了测量精度。
为解决上述技术问题,本发明提出的技术方案为:
一种MEMS加速度计零偏和标度因数的温度补偿方法,包括以下步骤:
S5)获取所述MEMS加速度计数据输出值,用零点偏移参数b p 和标度因数参数K p 对MEMS加速度计数据输出值补偿,得到MEMS加速度计数据真实值。
进一步的,步骤S1)具体包括:
S11)分别获取MEMS加速度计各轴处于第一状态和第二状态时,MEMS加速度计输出的加速度值集合{a}和对应温度值集合{T};
S13)根据MEMS加速度计各轴处于第一状态和第二状态时的加速度均值计算零点偏移矩阵b a 、标度因数矩阵K a ,并计算标度因数矩阵K a 的逆矩阵K inv ,根据标度因数矩阵K a 的逆矩阵K inv 计算固定交叉耦合系数矩阵N a 。
进一步的,步骤S2)具体包括:
S23)将温度值序列T temp1、T temp2以及温度均值进行并运算,截取范围为max(min(T temp1),min(T temp2))至min(max(T temp1),max(T temp2))的温度数据作为温度序列;
进一步的,步骤S21)中,所述MEMS加速度计在第一测试位置时Z轴朝上,所述MEMS加速度计在第二测试位置时Y轴朝上并沿Z轴旋转目标角度。
上式中,N a 为固定交叉耦合系数矩阵,K inv 为标度因数矩阵K a 的逆矩阵,b a 为零点偏移矩阵,为线性插值后的第一测试位置的三轴加速度值序列中温度均值对应的加速度计数值,为线性插值后的第二测试位置的三轴加速度值序列中温度均值对应的加速度计数值。
进一步的,步骤S4)中曲线拟合的类型为多项式、三角函数、高斯函数中的一种。
进一步的,步骤S5)具体包括:
上式中,N a 为固定交叉耦合系数矩阵。
本发明还提出一种MEMS加速度计零偏和标度因数的温度补偿系统,包括:
参数计算单元,用于计算MEMS加速度计常温环境下的温度均值、零点偏移矩阵b a 、标度因数矩阵K a 、固定交叉耦合系数矩阵N a ;还用于根据标度因数矩阵K a 的逆矩阵K inv 、固定交叉耦合系数矩阵N a 、零点偏移矩阵b a 、温度均值对应的加速度计数值,计算得到零偏序列和标度因数序列;还用于对温度序列和零偏序列进行曲线拟合得到零点偏移参数b p ,对温度序列和标度因数序列进行曲线拟合得到标度因数参数K p ;
数据补偿单元,用于获取所述MEMS加速度计数据输出值,用零点偏移参数b p 和标度因数参数K p 对MEMS加速度计数据输出值补偿,得到MEMS加速度计数据真实值。
本发明还提出一种计算机系统,包括计算机,所述计算机被编程或配置以执行任一所述的MEMS加速度计零偏和标度因数的温度补偿方法。
本发明还提出一种计算机可读存储介质,所述计算机可读存储介质存储有被编程或配置以执行任一所述的MEMS加速度计零偏和标度因数的温度补偿方法的计算机程序。
与现有技术相比,本发明的优点在于:
本发明综合考虑温度对零偏和标度因数的影响,将温度对零偏的影响和对标度因数的影响有效分离开来,形成相互独立的数据序列来进行曲线拟合得到标度因数参数和零度偏移参数,并以此修正加速度计数据,提高了测量精度,此外,本发明不限定拟合模型,变温试验对试验位置要求低,只要每轴加速度计在两个位置的倾角不同即可,极大提高了补偿试验的效率。
附图说明
图1为本发明实施例的流程图。
图2为本发明实施例中步骤S2的试验位置示意图。
图3为本发明实施例加速度计X轴数据补偿前后的对比图。
图4为本发明实施例加速度计Y轴数据补偿前后的对比图。
图5为本发明实施例加速度计Z轴数据补偿前后的对比图。
具体实施方式
以下结合说明书附图和具体优选的实施例对本发明作进一步描述,但并不因此而限制本发明的保护范围。
根据加速度计误差补偿模型:,其中为加速度计输出值,b a 为加速度计零偏,K a 为加速度相关误差系数矩阵,a为输入加速度,可知;又因加速度相关误差系数矩阵K a 主要包含标度因数误差和固定交叉耦合误差,即K a =K N ·K S ,其中K N 为固定交叉耦合误差,K S 为标度因数误差。
基于上述分析,本实施例提出一种MEMS加速度计零偏和标度因数的温度补偿方法,对三轴加速度计的零偏和标度因数进行综合温度补偿,如图1所示,包括以下步骤:
S5)获取所述MEMS加速度计数据输出值,用零点偏移参数b p 和标度因数参数K p 对MEMS加速度计数据输出值补偿,得到MEMS加速度计数据真实值。
本实施例通过步骤S1)取得MEMS加速度计在常温下的相关参数用于后续计算,包括以下步骤:
S11)常温环境下,分别获取MEMS加速度计各轴处于第一状态和第二状态时,MEMS加速度计输出的加速度值集合{a}和对应温度值集合{T};
本实施例中,第一状态为MEMS加速度计三个轴分别处于+1g的状态,第二状态为MEMS加速度计三个轴分别处于-1g的状态,MEMS加速度计三个轴在各状态下依次按90°角度旋转4次,测量这24个位置的MEMS加速度计输出的温度值和加速度值,即可得到加速度值集合{a}和对应温度值集合{T};
S12)根据温度值集合{T}计算温度均值,根据加速度值{a}计算MEMS加速度计各轴处于第一状态和第二状态时的加速度均值,具体的,本实施例对MEMS加速度计三个轴在各状态下旋转4次的数据取中间段数据求取平均值,得到前述的数据,将处于+1g状态下的三轴加速度均值表述为的形式,将处于-1g状态下的三轴加速度均值表述为的形式;
S13)根据MEMS加速度计各轴处于第一状态和第二状态时的加速度均值计算零点偏移矩阵b a 、标度因数矩阵K a ,并计算标度因数矩阵K a 的逆矩阵K inv ,根据标度因数矩阵K a 的逆矩阵K inv 计算固定交叉耦合系数矩阵N a ,相关参数表达式如下:
式(1)至(4)中,b a 为零点漂移矩阵,K a 为标度因数矩阵,K inv 为标度因数矩阵K a 的逆矩阵,N a 为固定交叉耦合系数矩阵,、、、、、、、、为常温+1g状态下的三轴加速度平均值,、、、、、、、、为常温-1g状态下的三轴加速度平均值。其中、、表示X轴加速度计在+1g状态下X轴、Y轴和Z轴各自输出的平均值,、、表示X轴加速度计在-1g状态下X轴、Y轴和Z轴各自输出的平均值,其余表示同理。
为了降低变温试验对试验位置的要求,本实施例的步骤S2)包括以下步骤:
本实施例中,变温试验使用高低温测试箱,在两个位置分别施加温度的影响,温度范围-40℃~85℃,温度变化率1℃/min,每次测试均进行全温区测量,本实施例中只要加速度计的轴在两个位置的倾角不同即可完成变温试验。本实施例第一次测试如图2的A部分所示,MEMS加速度计在第一测试位置时Z轴朝上,本实施例的第二次测试如图2的B部分所示,MEMS加速度计在第二测试位置时Y轴朝上并沿Z轴旋转目标角度,本实施例目标角度采用顺时针旋转45°角;
S23)将温度值序列T temp1、T temp2以及温度均值进行并运算,并运算是本领域技术人员熟知的计算方法,本方案未涉及对并运算具体计算过程的改进,在此不再赘述并运算的具体计算过程,截取范围为max(min(T temp1),min(T temp2))(即温度序列T temp1的最小值和温度序列T temp2的最小值之间的较大者)至min(max(T temp1),max(T temp2))(即温度序列T temp1的最大值和温度序列T temp2的最大值之间的较小者)的温度数据作为温度序列;
S24)使用线性插值方法,将三轴加速度值序列a temp1和a temp2中温度数据对应的数据组合成MEMS加速度数据序列,线性插值方法是本领域技术人员熟知的方法,本方案未涉及对线性插值具体过程的改进,在此不再赘述线性插值的具体过程,得到MEMS加速度数据序列之后,从的三轴加速度值序列和中获取温度均值对应的加速度计数值以及。
本实施例的步骤S3)将温度对零偏的影响和对标度因数的影响有效分离开来,形成相互独立的数据序列,以提高最终的补偿结果的准确性,包括以下步骤:
式(5)和(6)中,N a 为固定交叉耦合系数矩阵,K inv 为标度因数矩阵K a 的逆矩阵,b a 为零点偏移矩阵,为线性插值后的第一测试位置的三轴加速度值序列中温度均值对应的加速度计数值,为线性插值后的第二测试位置的三轴加速度值序列中温度均值对应的加速度计数值;
本实施例的步骤S4)中,曲线拟合的类型可以为多项式、三角函数、高斯函数中的一种,可以根据经验或实际情况,对于MEMS加速度计的性能进行评估之后来决定拟合曲线的类型选择,对两个序列进行曲线拟合是本领域技术人员的常用方法,本方案不涉及曲线拟合具体过程的改进,在此不再赘述曲线拟合的具体过程。
本实施例的步骤S5)具体包括:
S51)根据步骤S4)所选择拟合曲线类型,以及标度因数参数K p 、零点偏移参数b p 对应的拟合曲线,计算目标时刻随温度变化的标度因数矩阵和零点偏移矩阵,目标时刻可以为任意时刻,具体的,令X轴加速度计标度因数与温度的拟合关系为,零偏与温度的拟合关系为,在任意时刻,取得加速度计温度数值,则当前时刻X轴加速度计标度因数为,零偏为;
上式中,N a 为固定交叉耦合系数矩阵。
如图3至图5所示,采用步骤S1)至步骤S5)对MEMS加速度计数据输出值进行补偿后,MEMS加速度计各轴的数据均能保持稳定,不会随环境温度变化而发生改变。
本发明还提出一种MEMS加速度计零偏和标度因数的温度补偿系统,包括:
参数计算单元,用于计算MEMS加速度计常温环境下的温度均值、零点偏移矩阵b a 、标度因数矩阵K a 、固定交叉耦合系数矩阵N a ;还用于根据标度因数矩阵K a 的逆矩阵K inv 、固定交叉耦合系数矩阵N a 、零点偏移矩阵b a 、温度均值对应的加速度计数值,计算得到零偏序列和标度因数序列;还用于对温度序列和零偏序列进行曲线拟合得到零点偏移参数b p ,对温度序列和标度因数序列进行曲线拟合得到标度因数参数K p ;
数据补偿单元,用于获取所述MEMS加速度计数据输出值,用零点偏移参数b p 和标度因数参数K p 对MEMS加速度计数据输出值补偿,得到MEMS加速度计数据真实值。
本发明还提出一种计算机系统,包括计算机,所述计算机被编程或配置以执行任一所述的MEMS加速度计零偏和标度因数的温度补偿方法。
本发明还提出一种计算机可读存储介质,所述计算机可读存储介质存储有被编程或配置以执行任一所述的MEMS加速度计零偏和标度因数的温度补偿方法的计算机程序。
上述只是本发明的较佳实施例,并非对本发明作任何形式上的限制。虽然本发明已以较佳实施例揭露如上,然而并非用以限定本发明。因此,凡是未脱离本发明技术方案的内容,依据本发明技术实质对以上实施例所做的任何简单修改、等同变化及修饰,均应落在本发明技术方案保护的范围内。
Claims (9)
1.一种MEMS加速度计零偏和标度因数的温度补偿方法,其特征在于,包括以下步骤:
上式中,N a 为固定交叉耦合系数矩阵,K inv 为标度因数矩阵K a 的逆矩阵,b a 为零点偏移矩阵,为线性插值后的第一测试位置的三轴加速度值序列中温度均值对应的加速度计数值,为线性插值后的第二测试位置的三轴加速度值序列中温度均值对应的加速度计数值;
S5)获取所述MEMS加速度计数据输出值,用零点偏移参数b p 和标度因数参数K p 对MEMS加速度计数据输出值补偿,得到MEMS加速度计数据真实值。
2.根据权利要求1所述的MEMS加速度计零偏和标度因数的温度补偿方法,其特征在于,步骤S1)具体包括:
S11)分别获取MEMS加速度计各轴处于第一状态和第二状态时,MEMS加速度计输出的加速度值集合{a}和对应温度值集合{T};
S13)根据MEMS加速度计各轴处于第一状态和第二状态时的加速度均值计算零点偏移矩阵b a 、标度因数矩阵K a ,并计算标度因数矩阵K a 的逆矩阵K inv ,根据标度因数矩阵K a 的逆矩阵K inv 计算固定交叉耦合系数矩阵N a 。
3.根据权利要求1所述的MEMS加速度计零偏和标度因数的温度补偿方法,其特征在于,步骤S2)具体包括:
S23)将温度值序列T temp1、T temp2以及温度均值进行并运算,截取范围为max(min(T temp1),min(T temp2))至min(max(T temp1),max(T temp2))的温度数据作为温度序列;
4.根据权利要求3所述的MEMS加速度计零偏和标度因数的温度补偿方法,其特征在于,步骤S21)中,所述MEMS加速度计在第一测试位置时Z轴朝上,所述MEMS加速度计在第二测试位置时Y轴朝上并沿Z轴旋转目标角度。
5.根据权利要求1所述的MEMS加速度计零偏和标度因数的温度补偿方法,其特征在于,步骤S4)中曲线拟合的类型为多项式、三角函数、高斯函数中的一种。
7.一种MEMS加速度计零偏和标度因数的温度补偿系统,其特征在于,包括:
参数计算单元,用于计算MEMS加速度计常温环境下的温度均值、零点偏移矩阵b a 、标度因数矩阵K a 、固定交叉耦合系数矩阵N a ;还用于根据标度因数矩阵K a 的逆矩阵K inv 、固定交叉耦合系数矩阵N a 、零点偏移矩阵b a 、温度均值对应的加速度计数值,计算得到零偏序列和标度因数序列;还用于对温度序列和零偏序列进行曲线拟合得到零点偏移参数b p ,对温度序列和标度因数序列进行曲线拟合得到标度因数参数K p ;零偏序列和标度因数序列表达式如下:
上式中,N a 为固定交叉耦合系数矩阵,K inv 为标度因数矩阵K a 的逆矩阵,b a 为零点偏移矩阵,为线性插值后的第一测试位置的三轴加速度值序列中温度均值对应的加速度计数值,为线性插值后的第二测试位置的三轴加速度值序列中温度均值对应的加速度计数值;
数据补偿单元,用于获取所述MEMS加速度计数据输出值,用零点偏移参数b p 和标度因数参数K p 对MEMS加速度计数据输出值补偿,得到MEMS加速度计数据真实值。
8.一种计算机系统,包括计算机,其特征在于,所述计算机被编程或配置以执行权利要求1~6任一所述的MEMS加速度计零偏和标度因数的温度补偿方法。
9.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有被编程或配置以执行权利要求1~6任一所述的MEMS加速度计零偏和标度因数的温度补偿方法的计算机程序。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211691805.6A CN115655272B (zh) | 2022-12-28 | 2022-12-28 | Mems加速度计零偏和标度因数的温度补偿方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211691805.6A CN115655272B (zh) | 2022-12-28 | 2022-12-28 | Mems加速度计零偏和标度因数的温度补偿方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115655272A CN115655272A (zh) | 2023-01-31 |
CN115655272B true CN115655272B (zh) | 2023-03-21 |
Family
ID=85022531
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211691805.6A Active CN115655272B (zh) | 2022-12-28 | 2022-12-28 | Mems加速度计零偏和标度因数的温度补偿方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115655272B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115790401B (zh) * | 2023-02-09 | 2023-06-16 | 西北工业大学 | 一种基于视觉测量的位移测量方法及相关设备 |
CN118275734A (zh) * | 2024-06-03 | 2024-07-02 | 中国船舶集团有限公司第七〇七研究所 | 一种微机电惯性测量单元加速度计温度补偿方法 |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2010119046A2 (en) * | 2009-04-14 | 2010-10-21 | Atlantic Inertial Systems Limited | Accelerometer control systems |
US9594095B2 (en) * | 2012-07-06 | 2017-03-14 | MCube Inc. | Single point offset calibration for inertial sensors |
US20140025330A1 (en) * | 2012-07-11 | 2014-01-23 | Mcube, Inc. | Dynamic temperature calibration |
CN108107233B (zh) * | 2017-12-14 | 2020-01-31 | 中国电子产品可靠性与环境试验研究所 | 加速度计标度因数的连续温度校正方法及系统 |
CN108534800B (zh) * | 2018-03-09 | 2021-10-26 | 中国科学院长春光学精密机械与物理研究所 | 一种mems-imu全温全参数标定补偿方法 |
CN108645427A (zh) * | 2018-04-20 | 2018-10-12 | 北京航天时代激光导航技术有限责任公司 | 基于样条插值迭代修正的激光惯组系统级温度补偿方法 |
CN110879302B (zh) * | 2019-11-26 | 2022-02-22 | 西安石油大学 | 一种石英谐振差动式加速度计温度补偿方法 |
CN110988399A (zh) * | 2019-11-28 | 2020-04-10 | 北京自动化控制设备研究所 | 加速度计补偿方法 |
CN112578148B (zh) * | 2020-12-07 | 2023-03-14 | 北京中弘泰科科技有限公司 | 一种mems加速度计的高精度温度补偿方法 |
CN112762962B (zh) * | 2020-12-29 | 2023-05-02 | 东方红卫星移动通信有限公司 | 基于温度滞后模型的微机电系统加速度计零偏补偿方法 |
CN112697173B (zh) * | 2021-01-31 | 2024-09-10 | 南京理工大学 | Mems惯性器件自动化标定测试系统及方法 |
-
2022
- 2022-12-28 CN CN202211691805.6A patent/CN115655272B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN115655272A (zh) | 2023-01-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115655272B (zh) | Mems加速度计零偏和标度因数的温度补偿方法及系统 | |
CN108507568B (zh) | 补偿温度漂移误差的方法、装置和组合导航系统 | |
CN109297509B (zh) | 一种基于三态理论的激光陀螺零偏漂移误差建模与补偿方法 | |
CN111879339A (zh) | 一种mems陀螺仪温度误差补偿方法 | |
CN102393210B (zh) | 一种激光陀螺惯性测量单元的温度标定方法 | |
CN112762962B (zh) | 基于温度滞后模型的微机电系统加速度计零偏补偿方法 | |
US9146108B2 (en) | Method of aligning an axisymmetric vibrating sensor inertial navigation system and corresponding inertial navigation system | |
CN110879302B (zh) | 一种石英谐振差动式加速度计温度补偿方法 | |
CN107356387B (zh) | 一种模态试验中多传感器附加质量消除方法 | |
CN103954304B (zh) | 一种应用于mems惯组的零偏长短期变化值测试方法 | |
KR101106048B1 (ko) | 센서오차의 작동 중 자동교정 방법과 이를 이용한 관성항법장치 | |
CN104697553B (zh) | 光纤陀螺捷联惯导系统加速度计内杆臂标定方法 | |
CN103983278B (zh) | 一种测量影响卫星姿态确定系统精度的方法 | |
CN113155114A (zh) | Mems惯性测量单元陀螺零位的温度补偿方法及装置 | |
CN111623779A (zh) | 一种适用于噪声特性未知的时变系统自适应级联滤波方法 | |
CN108107233B (zh) | 加速度计标度因数的连续温度校正方法及系统 | |
CN107356786B (zh) | 加速度计的校准方法和装置、计算机可读存储介质 | |
CN115290080A (zh) | 基于无偏有限脉冲响应滤波器的管道机器人定位方法 | |
CN112632454B (zh) | 一种基于自适应卡尔曼滤波算法的mems陀螺滤波方法 | |
CN113790737A (zh) | 一种阵列式传感器的现场快速标定方法 | |
CN110389530B (zh) | 基于数据筛选的mems陀螺仪参数辨识驱动控制方法 | |
CN109633205B (zh) | 一种石英谐振加速度计温度补偿方法 | |
CN116026328A (zh) | 微惯导的零偏滞回效应补偿模型的构建方法和补偿方法 | |
CN108050997B (zh) | 一种基于容积卡尔曼的光纤陀螺滤波方法 | |
CN114858187A (zh) | 一种mems惯导系统标定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |