一种惯性测量单元基于单轴转台的温补方法与流程
本发明涉及惯性传感器标定与补偿,具体涉及一种惯性测量单元基于单轴转台的温补方法。
背景技术:
1、惯性测量单元是一种惯性传感器集合,其内部集成三轴陀螺仪和三轴加速度计,是惯性导航、姿态控制、制导技术、平台控制等系统的核心部件。惯性测量单元作为核心传感部件,其误差是影响各个系统的主要误差源。在实际工程使用过程中,一般对惯性测量单元的误差进行补偿,使其对系统的误差影响较小,进而提高系统的使用精度。
2、惯性测量单元包括三轴测量角速度和加速度的传感器,其误差主要是传感器的零偏误差、标度因数误差和不正角误差,其中零偏误差和标度因数误差由传感器自身特性带来,而不正角误差主要由结构平面度、垂直度及各轴的装配带来。根据陀螺和加计传感器特性的研究,零偏误差和标度因数误差在使用过程中会随着温度的变化产生漂移误差,且和温度成一定的相关性,工程应用中,通常会对惯性测量单元的零偏和标度因数进行温度补偿。目前,常用的方案是采用带多轴转台的温箱,或者带单轴转台的温箱进行多次翻面来完成,前者温补效率较高,每个温度点下可以把零偏和标度因数误差数据全部采集,但带多轴转台的温箱价格昂贵,体积较大;后者因为要对产品按轴向进行至少6次的翻转,需要增加更多的时间,且人员操作较为复杂,但是单轴转台的温箱价格和体积更具有优势。
技术实现思路
1、针对现有技术中的上述不足,本发明提供了一种惯性测量单元基于单轴转台的温补方法。
2、为了达到上述发明目的,本发明采用的技术方案为:
3、一种惯性测量单元基于单轴转台的温补方法, 包括如下步骤:
4、s1、在常温环境下,采用常规标定方案对惯性测量单元进行标定,得到其陀螺和加计的零偏、标度因数及不正角误差并进行补偿,以消除不正角误差对后续标定的影响;
5、s2、对惯性测量单元的原始标定坐标系进行旋转,得到一个新的坐标系;
6、s3、确定在新坐标系下的标定方案及标定位置,推导出新坐标系下各轴向误差的换算关系式,并基于此通过至少六个位置标定出陀螺和加计各轴的零偏与标度因数;
7、s4、在惯性测量单元的工作温度范围内,设置多个温度点,采集各温度点下步骤s3所述标定位置的数据,计算得到各温度下的零偏和标度因数误差值,并与温度进行相关性拟合得到温补参数,写入惯性测量单元完成补偿。
8、进一步的,所述s1中常规标定方案为18位置或33位置标定法;
9、所述误差模型的数学表达式为:
10、陀螺误差模型为:
11、
12、加计误差模型为:
13、
14、式中:、、为陀螺输入,、、为陀螺输出,、、、、、为陀螺不正角,、、为陀螺标度因数,、、为陀螺零偏,、、为加计输入,、、为加计输出,、、、、、表示加计失准角,、、为加计标度因数,、、表示加计零偏。
15、进一步的,所述s2中,坐标系旋转的具体方式为:将原始标定坐标系记为a系,首先绕a系的x轴旋转,得到中间坐标系;然后绕所述中间坐标系的y轴旋转,得到新的坐标系记为b系;从a系到b系的坐标转换矩阵表示为:
16、
17、式中,分别为坐a系坐标和b系坐标中的三轴分量。
18、进一步的,所述s3中,标定陀螺标度因数的具体方式为:在b系下,将惯性测量单元安装在单轴转台上,控制转台以恒定角速度ω分别进行正向和反向的整圈旋转,采集陀螺输出u+和u,通过计算差值消除地球自转角速度的影响,得到各轴陀螺输出与转台转速的换算关系,从而计算出标度因数误差;其中,x、y、z轴陀螺输出差值与转台转速ω的换算关系分别为:
19、
20、
21、
22、式中,分别为陀螺输出u+和u的三轴分量。
23、进一步的,所述s3中,标定陀螺零偏的具体方式为:在b系下,将惯性测量单元正向和反向分别置于单轴转台的0°和180°位置,采集各位置下陀螺的输出,其中下标表示x、y、z轴,上标+、-分别表示惯性测量单元相对于转台的天向和地向安装,通过将四个位置的输出相加并取平均,计算得到各轴陀螺的零偏,计算公式为:
24、。
25、进一步的,标定加计标度因数与零偏的具体方式为:在b系下,将惯性测量单元正向和反向分别置于单轴转台的0°和180°位置,采集各位置下加计的输出,其中表示x、y、z轴,通过计算特定组合值得到各轴加计的标度因数相关量和零偏,计算公式分别为:
26、
27、
28、
29、
30、式中,为置于正向转台0°和180°时加计各个轴向的输出,为置于反向转台0°和180°时加计各个轴向的输出,g为当地重力加速度,为加计各个轴向的零偏。
31、进一步的,所述s3中,标定方案所需的六个位置依次为:
32、位置1,天向,转台位置0°,静态测试;
33、位置2,天向,转台位置180°,静态测试;
34、位置3,天向,转台以+20°/s恒速旋转5圈;
35、位置4,天向,转台以-20°/s恒速旋转5圈;
36、位置5,地向,转台位置0°,静态测试;
37、位置6,地向,转台位置180°,静态测试。
38、进一步的,所述s4的具体方式为:在惯性测量单元的工作温度范围内设置6至9个温度点,待每个温度点稳定后,按照步骤s3的标定方案采集数据,计算得到各温度点下陀螺和加计共计12个零偏与标度因数参数值;采用分段线性拟合法,将各参数值与温度进行拟合,得到各温度段的补偿系数和,其中区分陀螺与加计,区分x、y、z轴,区分不同温度段,具体补偿为:
39、零偏温度补偿:;
40、标度因数温度补偿:;
41、式中,为补偿前传感器的零偏输出,t为温度值,为常温传感器的零偏值;为补偿前传感器的标度因数值,为常温传感器的标度因数值。
42、本发明具有以下有益效果:
43、本发明专利实现了惯性测量单元基于单轴转台的快速温补方法,借助坐标系转换原理,使得惯性测量单元在转台在一个位置上,可同时测得传感器三个轴向的标度因数和零偏误差值,将传统标定法的18位置,缩减至6位置,以达到快速完成温补测试的流程。采用该方法后,操作简化,基本达到多轴转台标定时长,因其位置减少,较于多轴转台的标定方法更简洁,且采用单轴转台的温箱即可实现,大大降低了设备成本,在工程应用上,具有很重要的意义。
1.一种惯性测量单元基于单轴转台的温补方法,其特征在于,包括如下步骤:
2.根据权利要求1所述的一种惯性测量单元基于单轴转台的温补方法,其特征在于,所述s1中常规标定方案为18位置或33位置标定法;
3.根据权利要求1所述的一种惯性测量单元基于单轴转台的温补方法,其特征在于,所述s2中,坐标系旋转的具体方式为:将原始标定坐标系记为a系,首先绕a系的x轴旋转,得到中间坐标系;然后绕所述中间坐标系的y轴旋转,得到新的坐标系记为b系;从a系到b系的坐标转换矩阵表示为:
4.根据权利要求3所述的一种惯性测量单元基于单轴转台的温补方法,其特征在于,所述s3中,标定陀螺标度因数的具体方式为:在b系下,将惯性测量单元安装在单轴转台上,控制转台以恒定角速度ω分别进行正向和反向的整圈旋转,采集陀螺输出u+和u,通过计算差值消除地球自转角速度的影响,得到各轴陀螺输出与转台转速的换算关系,从而计算出标度因数误差;其中,x、y、z轴陀螺输出差值与转台转速ω的换算关系分别为:
5.根据权利要求3所述的一种惯性测量单元基于单轴转台的温补方法,其特征在于,所述s3中,标定陀螺零偏的具体方式为:在b系下,将惯性测量单元正向和反向分别置于单轴转台的0°和180°位置,采集各位置下陀螺的输出,其中下标表示x、y、z轴,上标+、-分别表示惯性测量单元相对于转台的天向和地向安装,通过将四个位置的输出相加并取平均,计算得到各轴陀螺的零偏,计算公式为:
6.根据权利要求3所述的惯性测量单元基于单轴转台的温补方法,其特征在于,所述s3中,标定加计标度因数与零偏的具体方式为:在b系下,将惯性测量单元正向和反向分别置于单轴转台的0°和180°位置,采集各位置下加计的输出,其中表示x、y、z轴,通过计算特定组合值得到各轴加计的标度因数相关量和零偏,计算公式分别为:
7.根据权利要求3、4、5、6中任一项所述的惯性测量单元基于单轴转台的温补方法,其特征在于,所述s3中,标定方案所需的六个位置依次为:
8.根据权利要求1中任一项所述的惯性测量单元基于单轴转台的温补方法,其特征在于,所述s4的具体方式为:在惯性测量单元的工作温度范围内设置6至9个温度点,待每个温度点稳定后,按照步骤s3的标定方案采集数据,计算得到各温度点下陀螺和加计共计12个零偏与标度因数参数值;采用分段线性拟合法,将各参数值与温度进行拟合,得到各温度段的补偿系数和,其中区分陀螺与加计,区分x、y、z轴,区分不同温度段,具体补偿为:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com