[发明专利]一种载体角速度检测用微惯性测量单元的布设方法有效
申请号: | 201910387114.9 | 申请日: | 2019-05-10 |
公开(公告)号: | CN110057357B | 公开(公告)日: | 2020-01-17 |
发明(设计)人: | 袁丁;沈晓卫;伍宗伟;张峰干 | 申请(专利权)人: | 中国人民解放军火箭军工程大学 |
主分类号: | G01C21/18 | 分类号: | G01C21/18;G01C21/20 |
代理公司: | 61213 西安创知专利事务所 | 代理人: | 谭文琰 |
地址: | 710025 陕西*** | 国省代码: | 陕西;61 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 微机械陀螺 布设 微惯性测量单元 角速度检测 有效地减少 测量单元 检测轴 敏感轴 振动轴 输出 | ||
1.一种载体角速度检测用微惯性测量单元的布设方法,其特征在于,该方法包括以下步骤:
步骤一、单个微机械陀螺的检测轴、振动轴和敏感轴的确定:
步骤101、数据处理器(13)根据公式得到在东北天坐标系下载体所在地沿天向方向的地球自转角速度分量ωtd;其中,L表示载体所在地的纬度;
步骤102、将单个微机械陀螺(9)水平放置在水平平台(12)上,且单个微机械陀螺(9)的敏感轴向上;然后以单个微机械陀螺(9)的顶面中心为原点O,过原点O与单个微机械陀螺(9)的敏感轴方向重合为单个微机械陀螺(9)的Z轴,过原点O且与单个微机械陀螺(9)的纵轴重合为单个微机械陀螺(9)的Y轴,过原点O与单个微机械陀螺(9)的横轴重合且与单个微机械陀螺(9)的Y轴和单个微机械陀螺(9)的Z轴均垂直为单个微机械陀螺(9)的X轴;其中,所述单个微机械陀螺(9)的Z轴、单个微机械陀螺(9)的Y轴和单个微机械陀螺(9)的X轴符合右手直角坐标系,所述单个微机械陀螺(9)的第一引脚位于由所述单个微机械陀螺(9)的X轴和所述单个微机械陀螺(9)的Y轴组成的坐标系中的第二象限;
步骤103、将单个微机械陀螺(9)静止放置于水平平台(12)上,使单个微机械陀螺(9)的Y轴的正向指向正南,单个微机械陀螺(9)的Z轴的正向指向正东,单个微机械陀螺(9)的X轴的正向指向正上,则单个微机械陀螺(9)的X轴感知到1g加速度,且g=9.8m/s2;
数据处理器(13)对单个微机械陀螺(9)输出的第一角速度进行采集,并将数据处理器(13)第i1次采集到的第一角速度记作ω1(i1);数据处理器(13)根据公式得到单个微机械陀螺(9)输出的第一零偏估计值其中,N表示采集总次数,i1和N均为正整数,且i1的取值范围为1~N;
步骤104、将单个微机械陀螺(9)静止放置于水平平台(12)上,使单个微机械陀螺(9)的Y轴的正向指向正南,单个微机械陀螺(9)的Z轴的正向指向正西,单个微机械陀螺(9)的X轴的正向指向正下,则单个微机械陀螺(9)的X轴感知到-1g加速度;
数据处理器(13)对单个微机械陀螺(9)输出的第二角速度进行采集,并将数据处理器(13)第i2次采集到的第二角速度记作ω2(i2);数据处理器(13)根据公式得到单个微机械陀螺(9)输出的第二零偏估计值其中,i2为正整数,且i2的取值范围为1~N;
步骤105、将单个微机械陀螺(9)静止放置于载体的水平平台(12)上,使单个微机械陀螺(9)的X轴的正向指向正南,单个微机械陀螺(9)的Z轴的正向指向正西,单个微机械陀螺(9)的Y轴的正向指向正上,则单个微机械陀螺(9)的Y轴感知到1g加速度;
数据处理器(13)对单个微机械陀螺(9)输出的第三角速度进行采集,并将数据处理器(13)第i3次采集到的第三角速度记作ω3(i3);数据处理器(13)根据公式得到单个微机械陀螺(9)输出的第三零偏估计值其中,i3为正整数,且i3的取值范围为1~N;
步骤106、将单个微机械陀螺(9)静止放置于水平平台(12)上,使单个微机械陀螺(9)的X轴的正向指向正南,单个微机械陀螺(9)的Z轴的正向指向正东,单个微机械陀螺(9)的Y轴的正向指向正下,则单个微机械陀螺(9)的Y轴感知到-1g加速度;
数据处理器(13)对单个微机械陀螺(9)输出的第四角速度进行采集,并将数据处理器(13)第i4次采集到的第四角速度记作ω4(i4);数据处理器(13)根据公式得到单个微机械陀螺(9)输出的第四零偏估计值其中,i4为正整数,且i4的取值范围为1~N;
步骤107、将单个微机械陀螺(9)静止放置于水平平台(12)上,使单个微机械陀螺(9)的Y轴的正向指向正南,单个微机械陀螺(9)的X轴的正向指向正西,单个微机械陀螺(9)的Z轴的正向指向正上,则单个微机械陀螺(9)的Z轴感知到1g加速度;
数据处理器(13)对单个微机械陀螺(9)输出的第五角速度进行采集,并将数据处理器(13)第i5次采集到的第五角速度记作ω5(i5);数据处理器(13)根据公式得到单个微机械陀螺(9)输出的第五零偏估计值其中,i5为正整数,且i5的取值范围为1~N;
步骤108、数据处理器(13)根据公式得到单个微机械陀螺(9)输出的第五零偏修正值
步骤109、将单个微机械陀螺(9)静止放置于水平平台(12)上,使单个微机械陀螺(9)的Y轴的正向指向正南,单个微机械陀螺(9)的X轴的正向指向正东,单个微机械陀螺(9)的Z轴的正向指向正下,则单个微机械陀螺(9)的Z轴感知到-1g加速度;
数据处理器(13)对单个微机械陀螺(9)输出的第六角速度进行采集,并将数据处理器(13)第i6次采集到单个微机械陀螺(9)输出的第六角速度记作ω6(i6);数据处理器(13)根据公式得到单个微机械陀螺(9)输出的第六零偏估计值其中,i6为正整数,且i6的取值范围为1~N;
步骤1010、数据处理器(13)根据公式得到单个微机械陀螺(9)输出的第六零偏修正值
步骤1011、数据处理器(13)根据公式和得到单个微机械陀螺(9)在X轴方向受到重力加速度时的加速度敏感零偏值ωxG、单个微机械陀螺(9)在Y轴方向受到重力加速度时的加速度敏感零偏值ωyG和单个微机械陀螺(9)在Z轴方向受到重力加速度时的加速度敏感零偏值ωzG;
步骤1012、数据处理器(13)对单个微机械陀螺(9)在X轴方向受到重力加速度时的角速度敏感零偏值ωxG、单个微机械陀螺(9)在Y轴方向受到重力加速度时的角速度敏感零偏值ωyG和单个微机械陀螺(9)在Z轴方向受到重力加速度时的角速度敏感零偏值ωzG进行判断,并得到最大角速度敏感零偏值;其中,最大角速度敏感零偏值所对应的轴为单个微机械陀螺(9)的检测轴,由于单个微机械陀螺(9)的敏感轴为Z轴,则得到单个微机械陀螺(9)的振动轴;
步骤二、微机械陀螺单元的安装布设:
步骤201、首先在安装板(11)一侧上安装第一微机械陀螺(1);其中,第一微机械陀螺(1)的表面中心为原点os,过原点os且与第一微机械陀螺(1)的敏感轴方向重合为第一微机械陀螺(1)的Zs轴,过原点o1且与第一微机械陀螺(1)的振动轴方向重合为第一微机械陀螺(1)的Xs轴,过原点os与第一微机械陀螺(1)的检测轴重合为第一微机械陀螺(1)的Ys轴,所述第一微机械陀螺(1)的第一引脚位于由所述第一微机械陀螺(1)的Xs轴和第一微机械陀螺(1)的Ys轴组成的坐标系中的第二象限,所述第一微机械陀螺(1)的Zs轴、第一微机械陀螺(1)的Xs轴和第一微机械陀螺(1)的Ys轴符合右手直角坐标系;
然后,在安装板(11)一侧上依次安装第二微机械陀螺(2)、第三微机械陀螺(3)和第四微机械陀螺(4);其中,第二微机械陀螺(2)相对于第一微机械陀螺(1)绕第一微机械陀螺(1)的Zs轴沿逆时针方向旋转90°,第三微机械陀螺(3)相对第一微机械陀螺(1)绕第一微机械陀螺(1)的Zs轴沿逆时针方向旋转180°,第四微机械陀螺(4)相对第一微机械陀螺(1)绕第一微机械陀螺(1)的Zs轴沿逆时针方向旋转270°;
步骤202、在安装板(11)另一侧上安装第五微机械陀螺(5);其中,第五微机械陀螺(5)相对第一微机械陀螺(1)绕第一微机械陀螺(1)的Xs轴沿逆时针方向旋转180°;
然后,在安装板(11)另一侧上依次安装第六微机械陀螺(6)、第七微机械陀螺(7)和第八微机械陀螺(8),完成一个微机械陀螺单元的安装布设;其中,第六微机械陀螺(6)相对于第五微机械陀螺(5)绕第五微机械陀螺(5)的Zs轴沿逆时针方向旋转90°,第七微机械陀螺(7)相对第五微机械陀螺(5)绕第五微机械陀螺(5)的Zs轴沿逆时针方向旋转180°,第八微机械陀螺(8)相对第五微机械陀螺(5)绕第五微机械陀螺(5)的Zs轴沿逆时针方向旋转270°;
步骤三、微机械陀螺阵列的安装布设:
步骤301、建立坐标系:以载体的质心为原点ob,obyb轴与所述载体的纵轴重合且指向所述载体前进方向,obxb轴与所述载体的横轴重合且指向所述载体前进方向的右侧,obzb轴垂直于所述obxb轴和所述obyb轴形成的平面obxbyb且指向所述载体上方,建立载体坐标系obxbybzb;
步骤302、多次重复步骤201至202,完成三个微机械陀螺单元的安装,三个微机械陀螺单元分别记作第一微机械陀螺单元(10)、第二微机械陀螺单元(20)和第三微机械陀螺单元(30);
步骤303、将第一微机械陀螺单元(10)、第二微机械陀螺单元(20)和第三微机械陀螺单元(30)均安装在载体平台(14)上;其中,第一微机械陀螺单元(10)中安装板(11)与载体平台(14)呈平行布设,第二微机械陀螺单元(20)中安装板(11)和第三微机械陀螺单元(30)中安装板(11)均与载体平台(14)呈垂直布设,且第二微机械陀螺单元(20)中安装板(11)和第三微机械陀螺单元(30)中安装板(11)呈垂直布设,所述第一微机械陀螺单元(10)中第一微机械陀螺(1)的Zs轴与obzb轴呈平行布设,所述第二微机械陀螺单元(20)中第一微机械陀螺(1)的Zs轴与obyb轴呈平行布设,所述第三微机械陀螺单元(30)中第一微机械陀螺(1)的Zs轴与obxb轴呈平行布设,实现对载体沿obzb轴、obxb轴和obzb轴的角速度的检测。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国人民解放军火箭军工程大学,未经中国人民解放军火箭军工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910387114.9/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种隧道内车辆定位方法及装置
- 下一篇:一种导航方法和系统