[发明专利]一种自动惯导系统标定方法、装置及系统有效
申请号: | 201511005156.X | 申请日: | 2015-12-29 |
公开(公告)号: | CN105651309B | 公开(公告)日: | 2018-11-16 |
发明(设计)人: | 田雨农;梁越;安玉良;王君宽;赵彦安;张晓伟;夏阳;李刚 | 申请(专利权)人: | 北京贞正物联网技术有限公司 |
主分类号: | G01C25/00 | 分类号: | G01C25/00 |
代理公司: | 大连智高专利事务所(特殊普通合伙) 21235 | 代理人: | 胡景波 |
地址: | 116023 辽宁省大连*** | 国省代码: | 辽宁;21 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明涉及一种自动惯导系统标定方法、装置及系统,属于测量仪器技术领域。所述方法包括:将初始转台平面调至完全水平;给系统上电初始化;按下连接键连接待标定产品;连接成功后按下标定键标定待标定产品。本发明具有提高标定精度、优化操作方式以及提升标定速率的优点。 | ||
搜索关键词: | 一种 自动 系统 标定 方法 装置 | ||
【主权项】:
1.一种自动惯导系统标定方法,其特征在于,该方法包括步骤:S1.将初始转台平面调至完全水平;S2.给系统上电初始化;S3.按下连接键连接待标定产品;S4.连接成功后按下标定键标定待标定产品;步骤S4具体包括S4.1在标定产品的过程中,内旋框和外旋框控制待标定产品沿三个敏感轴正向转动和反向转动,对待标定产品进行速率标定;所述内旋框和所述外旋框控制待标定产品沿三个敏感轴方向的其中一个轴向垂直于水平面向上或向下静止若干秒钟,以当前重力加速度为参考对待标定产品进行静止标定;速率标定的计算方法如下:速率标定下各个流程的陀螺仪读数如下:
标度因数的计算公式为:
安装误差项计算公式为:![]()
加速度计的矫正模型如下:Ax=ax/Kax‑Kax0;Ay=ay/Kay‑Kay0;Az=az/Kaz‑Kaz0;Ax=Ax‑Ayx*Ay‑Azx*Az;Ay=Ay‑Axy*Ax‑Azy*Az;Az=Az‑Axz*Ax‑Ayz*Ay;其中,ax,ay,az是加速度计的原始数据,Ax,Ay,Az是校正后的读数,Kax,Kay,Kaz是当量,Kax0,Kay0,Kaz0是零偏,Axy,Ayx,Axz,Azx,Ayz,Azy是安装误差;陀螺仪的矫正模型如下:Wx=gx/Kgx‑Dgx0/Kgx;Wy=gy/Kgy‑Dgy0/Kgy;Wx=gz/Kgz‑Dgz0/Kgz;Wx=Wx‑Eyx*Wy‑Ezx*Wz;Wy=Wy‑Exy*Wx‑Ezy*Wz;Wz=Wz‑Exz*Wx‑Eyz*Wy;其中,gx,gy,gz是陀螺仪的原始数据,Wx,Wy,Wz是校正后的数据,Kgx,Kgy,Kgz是当量,Dgx0,Dgy0,Dgz0是零偏,Exy,Eyx,Exz,Ezx,Eyz,Ezy是安装误差。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京贞正物联网技术有限公司,未经北京贞正物联网技术有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201511005156.X/,转载请声明来源钻瓜专利网。
- 上一篇:一种新型测绘仪倾斜量修正方法
- 下一篇:电子装置、电子装置的控制方法