[发明专利]微型组合导航系统中的传感器野外标定方法无效

专利信息
申请号: 201210027274.0 申请日: 2012-02-09
公开(公告)号: CN102589573A 公开(公告)日: 2012-07-18
发明(设计)人: 何昆鹏;于玖成;吴国亮;梁文齐;王福超;管练武;郭凯文;詹俊妮;王庭军;韩继涛 申请(专利权)人: 黑龙江省博凯科技开发有限公司
主分类号: G01C25/00 分类号: G01C25/00
代理公司: 暂无信息 代理人: 暂无信息
地址: 150046 黑龙江省哈尔滨市*** 国省代码: 黑龙江;23
权利要求书: 查看更多 说明书: 查看更多
摘要:
搜索关键词: 微型 组合 导航系统 中的 传感器 野外 标定 方法
【权利要求书】:

1.一种微型组合导航系统中的传感器野外标定方法,其特征在于所述野外标定方法步骤是:首先给出组合导航系统中加速度计、地磁传感器和陀螺仪的测量模型,分析野外环境下各传感器的主要误差因素;然后采用一种六位置标定编排方法,通过求解方程组,以得到加速度计、地磁传感器和陀螺仪的标度因数、零偏修正系数;其具体操作如下:

(1)加速度计的野外标定方法

在室内标定时,一般加速度计的测量模型为

ax=(bx+nax+Exynay+Exznaz)/kxay=(by+Eyxnax+nay+Eyznaz)/kyaz=(bz+Ezxnax+Ezynay+naz)/kz---(1)]]>

式中,ax、ay、az分别为X、Y、Z三个轴加速度计的补偿后的加速度,单位为m/s2

nax、nay、naz分别为X、Y、Z三个轴加速度计的未经补偿的测量值,单位为电压伏或脉冲数;

bx、by、bz分别为X、Y、Z加速度计的零偏,单位为电压伏或脉冲数;

kx、ky、kz分别为X、Y、Z加速度计的标度因数,单位是V/(m/s2);

Exy、Exz、Eyx、Eyz、Ezx、Ezy分别为三个轴加速度计的安装误差;

经过速率试验和位置试验,测得加速度计的标度因数、零偏和安装误差等参数;

在野外环境下,当组合导航系统中惯性测量单元静止时,加速度计所敏感的是当地重力加速度G0(≈9.8m/s2),有:

ax2+ay2+az2=G02---(2)]]>

因此,加速度计的修正模型表示为:

Ax=Bx+KxaxAy=By+KyayAz=Bz+Kzaz---(3)]]>

式中,Ax,Ay,Az为野外环境下X、Y、Z加速度计测量的加速度修正后的值,单位是m/s2

Bx、By、Bz分别为野外环境下X、Y、Z加速度计的零偏修正值;

Kx、Ky、Kz分别为野外环境下X、Y、Z加速度计的标度因数修正值;

当惯性测量单元在野外使用时,转动6个不同的方位,静止一段时间后,由(2)、(3)式可以得到六个位置的状态方程:

(Kxax1+Bx)2+(Kyay1+By)2+(Kzaz1+Bz)2=G02---(4)]]>

(Kxax2+Bx)2+(Kyay2+By)2+(Kzaz2+Bz)2=G02---(5)]]>

(Kxax3+Bx)2+(Kyay3+By)2+(Kzaz3+Bz)2=G02---(6)]]>

(Kxax4+Bx)2+(Kyay4+By)2+(Kzaz4+Bz)2=G02---(7)]]>

(Kxax5+Bx)2+(Kyay5+By)2+(Kzaz5+Bz)2=G02---(8)]]>

(Kxax6+Bx)2+(Kyay6+By)2+(Kzaz6+Bz)2=G02---(9)]]>

由公式(5)-(4)、(6)-(5)、(7)-(6)、(8)-(7)、(9)-(8)得:

Kx2(ax22-ax12)+2KxBx+(ax2-ax1)+Ky2(ay22-ay12)+]]>

2KyBy(ay2-ay1)+Kz2(az22-az12)+2KzBz(az2-az1)=0---(10)]]>

Kx2(ax32-ax22)+2KxBx(ax3-ax2)+Ky2(ay32-ay22)+]]>

2KyBy(ay3-ay3)+Kz2(az32-az22)+2KzBz(az3-az2)=0---(11)]]>

Kx2(ax42-ax32)+2KxBx(ax4-ax3)+Ky2(ay42-ay32)+]]>

2KyBy(ay4-ay3)+Kz2(az42-az32)+2KzBz(az4-az3)=0---(12)]]>

Kx2(ax52-ax42)+2KxBx(ax5-ax4)+Ky2(ay52-ay42)+]]>

2KyBy(ay5-ay4)+Kz2(az52-az42)+2KzBz(az5-az4)=0---(13)]]>

Kx2(ax62-ax52)+2KxBx(ax6-ax5)+Ky2(ay62-ay52)+]]>

2KyBy(ay6-ay5)+Kz2(az62-az52)+2KzBz(az6-az5)=0---(14)]]>

将等式左边第一项移至右边,并同时除以得:

2KxBx(ax2-ax1)/Kx2+Ky2(ay22-ay12)/Kx2+2KyBy(ay2-ay1)/Kx2+]]>

Kz2(az22-az12)/Kx2+2KzBz(az2-az1)/Kx2=ax12-ax22---(15)]]>

2KxBx(ax3-ax2)/Kx2+Ky2(ay32-ay22)/Kx2+2KyBy(ay3-ay3)/Kx2+]]>

Kz2(az32-az22)/Kx2+2KzBz(az3-az2)/Kx2=ax22-ax32---(16)]]>

2KxBx(ax4-ax3)/Kx2+Ky2(ay42-ay32)/Kx2+2KyBy(ay4-ay3)/Kx2+]]>

Kz2(az42-az32)/Kx2+2KzBz(az4-az3)/Kx2=ax32-ax42---(17)]]>

2KxBx(ax5-ax4)/Kx2+Ky2(ay52-ay42)/Kx2+2KyBy(ay5-ay4)/Kx2+]]>

Kz2(az52-az42)/Kx2+2KzBz(az5-az4)/Kx2=ax42-ax52---(18)]]>

2KxBx(ax6-ax5)/Kx2+Ky2(ay62-ay52)/Kx2+2KyBy(ay6-ay5)/Kx2+]]>

Kz2(az62-az52)/Kx2+2KzBz(az6-az5)/Kx2=ax52-ax62---(19)]]>

将其改写为矩阵形式为:

将其表示为:

M×C=F    (21)

上式中,矩阵M为已知值,由6个位置的加速度计的测量值组成,C=[C1,C2,C3,C4,C5]为待求参数,F也是已知值,因此,C=M-1F,这样,

KxBx/Kx2=C1Ky2/Kx2=C2KyBy/Kx2=C3Kz2/Kx2=C4KzBz/Kx2=C5---(22)]]>

由(22)可知:

Bx=C1KxKy=C2Kx2By=C3Kx2/C2Kx2Kz=C4Kx2Bz=C5Kx2/C4Kx2---(23)]]>

将式(23)回代入式(4)中可得:

(KxAx1+C1Kx)2+(Ay1C2Kx2+C3Kx2/C2Kx2)2+(Az1C4Kx2+C5Kx2/C4Kx2)2=G02---(24)]]>

由此可得:

Kx=G0/Ax12+2C1Ax1+C12+C2Ay12+2C3Ay1+C32/C2+C4Az12+C52/C4+2C5Az1---(25)]]>

将式(25)代入式(23),可依次求出Ky、Kz、Bx、By、Bz的值,完成加速度计的零偏和标度因数野外标定;

(2)地磁传感器的野外标定方法

地磁传感器在野外环境下标定原理和模型与加速度计相同,标定方法同上述加速度计的野外标定方法;

(3)陀螺仪野外标定方法

陀螺仪敏感不到地球自转角速度(ωie=15.0411°/h),其输出约为零,采用六位置标定编排,位置1时陀螺仪的输出即可看作是其零偏,同理,位置2、位置3、位置4、位置5、位置6时陀螺仪的输出值均可看作是其零偏;为进一步精确,可以将6个位置的陀螺仪的输出取平均值作为其零偏。

下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。

该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于黑龙江省博凯科技开发有限公司,未经黑龙江省博凯科技开发有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服

本文链接:http://www.vipzhuanli.com/pat/books/201210027274.0/1.html,转载请声明来源钻瓜专利网。

×

专利文献下载

说明:

1、专利原文基于中国国家知识产权局专利说明书;

2、支持发明专利 、实用新型专利、外观设计专利(升级中);

3、专利数据每周两次同步更新,支持Adobe PDF格式;

4、内容包括专利技术的结构示意图流程工艺图技术构造图

5、已全新升级为极速版,下载速度显著提升!欢迎使用!

请您登陆后,进行下载,点击【登陆】 【注册】

关于我们 寻求报道 投稿须知 广告合作 版权声明 网站地图 友情链接 企业标识 联系我们

钻瓜专利网在线咨询

周一至周五 9:00-18:00

咨询在线客服咨询在线客服
tel code back_top