[发明专利]一种捷联惯导初始对准中重力扰动的补偿方法在审
申请号: | 201410542256.5 | 申请日: | 2014-10-15 |
公开(公告)号: | CN104374401A | 公开(公告)日: | 2015-02-25 |
发明(设计)人: | 何昆鹏;王晓雪;王刚;王晨阳;韩继韬;邵玉萍;张兴智;张琳;胡璞;徐旭 | 申请(专利权)人: | 哈尔滨工程大学 |
主分类号: | G01C25/00 | 分类号: | G01C25/00 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 150001 黑龙江省哈尔滨市南岗区*** | 国省代码: | 黑龙江;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 捷联惯导 初始 对准 重力 扰动 补偿 方法 | ||
1.一种捷联惯导初始对准中重力扰动的补偿方法,其特征在于:
(1)采集光纤陀螺仪输出的角速度数据和石英加速度计输出的加速度数据;
(2)通过重力扰动位计算对准地点的重力扰动值,对石英加速度计的输出加速度数据进行补偿;
(3)采用解析法来完成粗对准,通过初始矩阵确定载体的姿态信息即纵摇角、横摇角、航向角,其中b代表载体坐标系,n′代表计算导航坐标系;
(4)选取滤波初始值
其中x0为状态变量的初值,P0为状态变量的初始误差协方差矩阵;
(5)利用无迹卡尔曼滤波方法进行滤波,估计出平台失准角;
(6)利用估计出来的平台失准角修正系统的捷联初始矩阵得到精确的初始捷联矩阵即从而完成精确的初始对准。
2.根据权利要求1所述的一种捷联惯导初始对准中重力扰动的补偿方法,其特征在于:所述的重力扰动位T(ρ,L,λ),
地球平均半径为R,θ=90-L是地心余纬度,位系数Cnm,Snm是已知的重力扰动的系数,可通过EGM2008重力场模型获得,L表示地球纬度,λ为地球经度,ρ为对准地点处的地心向径,GM为地球常系数,Pnm(·)为缔合勒让德多项式:
x为变量,|x|<1;n称为阶,m称为次,N=[(n-m)/2];
重力扰动位的梯度即为重力扰动矢量δgn:
通过重力扰动矢量得到极坐标系下的重力扰动值:
在东北天-ENU地理坐标系上,重力扰动矢量3个轴向的分量为转换到地理坐标系为:
然后对加速度计的输出进行补偿。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工程大学,未经哈尔滨工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201410542256.5/1.html,转载请声明来源钻瓜专利网。