[发明专利]一种基于惯性导航系统的在线自主标定方法有效
申请号: | 201110409988.3 | 申请日: | 2011-12-09 |
公开(公告)号: | CN102564452A | 公开(公告)日: | 2012-07-11 |
发明(设计)人: | 付梦印;邓志红;王博;汪顺亭;周元 | 申请(专利权)人: | 北京理工大学 |
主分类号: | G01C25/00 | 分类号: | G01C25/00;G01C21/18 |
代理公司: | 北京理工大学专利中心 11120 | 代理人: | 李爱英;郭德忠 |
地址: | 100081 *** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 惯性 导航系统 在线 自主 标定 方法 | ||
技术领域
本发明属于自主标定领域,涉及一种基于惯性导航系统的在线自主标定的方法,特别涉及一种基于双轴旋转的光纤陀螺平台捷联混合式系统的在线自主标定方法。
背景技术
对于长航时惯性导航系统,重调周期为几天甚至十几天,因此在线自主标定惯性器件关键参数的方法是十分必要的。实验室标定方法仅能利用已知地点的重力加速度和地球自转角速度进行惯性器件的关键参数检测。
由于双轴旋转调制惯性导航系统俯仰轴与载体固连,使得系统横滚轴与水平面的夹角无法消除;同时双轴旋转调制惯性导航系统的方位轴和横滚轴有全自由度,因此双轴旋转调制惯性导航系统既有平台式惯性导航系统能够隔离载体运动的特点,同时其导航算法与捷联式惯性导航系统又有相似之处,因而在进行自主在线标定时需要对其姿态角进行预先估计。
发明内容
为了解决双轴旋转调制惯性导航系统中系统横滚轴与水平面夹角无法消除的问题,本发明提供了一种基于惯性导航系统的在线自主标定方法,解决了双轴旋转调制惯性导航系统中系统横滚轴与水平面夹角无法消除的问题,为其姿态角的预先估计提供了可靠依据,实现了在线自主标定的目的。
一种基于惯性导航系统的在线自主标定方法,该方法实现的具体步骤如下:
步骤一:惯性导航系统初始对准
对于双轴旋转调制式惯性导航系统,采用捷联算法对其进行初始对准,得到三个轴的初始姿态角;采用角度传感器与转轴上的伺服电机构成的回路控制方位轴的旋转,使北向陀螺的横滚轴在水平面上的投影指向正北;再采用该回路控制横滚轴旋转,使东向陀螺的俯仰轴指向正东;
根据初始姿态角和回路控制的方位轴和横滚轴旋转的角度计算垂向陀螺的坐标与天向的夹角为θ;此时该夹角与载体的实际俯仰角相同,是横滚轴与水平面的夹角;
步骤二:采用地球自转角速度标定陀螺的常值漂移和刻度因数
地球自转角速度北向分量为ωiecosL,天向分量为ωiesinL,其中ωie为地球自转角速率,L为当地纬度;通过惯性导航系统的初始对准,将系统的俯仰轴x、横滚轴y、方位轴z的位置记为位置1;
在系统三轴处于位置1的情况下将系统绕方位轴旋转180°,此时横滚轴在水平面的投影指向正南,将该位置记为位置2;
回路稳定后,根据数据波动情况和噪声水平连续采样一段时间的数据,求取均值,得到:
δωy1=kyωie cosLcosθ+kyωie sinLsinθ+εy (1)
δωz1=-kzωie cosLsinθ+kzωie sinLcosθ+εz (2)
δωy2=-kyωie cosLcosθ-kyωie sinLsinθ+εy (3)
其中,δωy1、δωz1、δωy2分别为y轴陀螺在位置1时的输出数据均值、z轴陀螺在位置1时的输出数据均值和y轴陀螺在位置2时的输出数据均值;
通过方程(1)和(3),求得横滚轴陀螺的常值漂移εy以及刻度因数ky为:
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京理工大学,未经北京理工大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201110409988.3/2.html,转载请声明来源钻瓜专利网。
- 上一篇:一种多模双待终端以及运行该终端的方法
- 下一篇:清洗维护装置和喷墨印刷设备