[发明专利]一种单轴旋转惯导系统惯性器件误差补偿方法有效
申请号: | 201410143285.4 | 申请日: | 2014-04-10 |
公开(公告)号: | CN103940445A | 公开(公告)日: | 2014-07-23 |
发明(设计)人: | 孙云龙;高延滨;管练武;杨淳;李绪友;郭慧;许德新;张庆;胡文彬;张帆 | 申请(专利权)人: | 哈尔滨工程大学 |
主分类号: | G01C25/00 | 分类号: | G01C25/00 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 150001 黑龙江省哈尔滨市南岗区*** | 国省代码: | 黑龙江;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 旋转 系统 惯性 器件 误差 补偿 方法 | ||
1.一种单轴旋转惯导系统惯性器件误差补偿方法,其特征在于,包括以下几个步骤:
步骤一:将惯性器件固联至旋转机构,惯性器件的y轴与天向重合;
步骤二:旋转机构带动惯性器件以角速度ωy绕y轴进行正反转停运动;
惯性器件的一个周期的四个转停次序为:
xs、zs代表惯性坐标系水平轴,A1、A2、B1、B2表示四个停留位置,其中A1、A2位置重合、位于xs的正半轴,B1、B2位置重合、位于xs的负半轴,
次序1,惯导系统从位置A1出发顺时针转动180°,到达位置B1,停位时间长为t,
次序2,惯导系统从位置B1出发逆时针转动180°,到达位置A2,停位时间长为t,
次序3,惯导系统从位置A2出发逆时针转动180°,到达位置B2,停位时间长为t,
次序4,惯导系统从位置B2出发顺时针转动180°,到达位置A1,停位时间长为t;
步骤三:读取x轴陀螺输出值x轴加速度计输出值y轴正半轴陀螺输出值y轴正半轴加速度输出值z轴陀螺输出值z轴加速度计输出值y轴负半轴陀螺输出值y轴负半轴加速度计输出值
惯性器件误差为:
其中:表示导航坐标系下陀螺器件误差,δfn表示导航坐标系下加速度计器件误差,εx、εy、εz分别表示x轴、y轴、z轴陀螺随机常值误差,▽x、▽y、▽z分别为x轴、y轴、z轴加速度计随机常值误差,经单轴旋转调制,与旋转轴垂直的惯性器件误差被调制成正余弦变化的信号,从而在导航解算中消除x轴、z轴的器件误差,同时得到y轴陀螺仪器件误差εy和y轴加速度计器件误差▽y;
步骤四:通过y轴正半轴和y轴负半轴的惯性器件数据解算消除y轴上的器件误差,得到补偿y轴陀螺器件误差后的误差值和补偿y轴加速度计器件误差后的误差值δfny,将补偿y轴陀螺器件误差后的误差值和步骤四中得到的y轴陀螺随机常值误差εy比较,将补偿y轴加速度计器件误差后的误差值δfny和步骤四中的y轴加速度计随机常值误差▽y比较,判断误差是否补偿,如果没有补偿,则重新采集y轴正半轴陀螺输出值y轴正半轴加速度输出值y轴负半轴陀螺输出值y轴负半轴加速度计输出值得到补偿数据,重复步骤三到步骤四,直到误差得到补偿。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工程大学,未经哈尔滨工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201410143285.4/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种自动配碱装置
- 下一篇:矿浆缓冲槽液位自动控制机构