[发明专利]一种虚拟旋转地理坐标系下解算速度的捷联惯性导航方法无效
申请号: | 201310244636.6 | 申请日: | 2013-06-20 |
公开(公告)号: | CN103292811A | 公开(公告)日: | 2013-09-11 |
发明(设计)人: | 奔粤阳;杨晓龙;高伟;李倩;郭妍;阮双双;李敬春;赵维珩 | 申请(专利权)人: | 哈尔滨工程大学 |
主分类号: | G01C21/16 | 分类号: | G01C21/16;G01C21/20 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 150001 黑龙江*** | 国省代码: | 黑龙江;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明公开了一种虚拟旋转地理坐标系下解算速度的捷联惯性导航方法,在系统初始化完毕开始正常的导航解算工作后,首先在地理坐标系下解算姿态,然后将加速度计、陀螺输出等信息转换到建立的虚拟旋转地理坐标系下进行速度解算,最后将解算的速度信息再转换到地理坐标系下进行位置解算,从而达到将系统中各个误差源进行旋转调制,以提高系统的精度的目的。 | ||
搜索关键词: | 一种 虚拟 旋转 地理 坐标系 下解算 速度 惯性 导航 方法 | ||
【主权项】:
1.一种虚拟旋转地理坐标系下解算速度的捷联惯性导航方法,其特征在于,包括下列步骤:步骤一:启动舰船上的捷联惯性导航系统,并且对系统进行初始对准;步骤二:在地理坐标系即n系上进行一次姿态解算得到捷联惯性导航系统的姿态矩阵步骤三:在得到捷联惯性导航系统的姿态矩阵之后,在虚拟旋转地理坐标系即nr上建立捷联惯性导航系统的速度方程:v · n r = f n r - ( 2 ω ie n r + ω enr n r ) × v n r + g n r ]]> 其中虚拟旋转地理坐标系是在初始时刻与地理坐标系重合,绕着虚拟旋转地理坐标系的z轴以恒定角速率旋转的坐标系;为舰船速度在虚拟旋转地理坐标系上的投影f n r = C n n r C b n f b , ]]> fb为加速度计输出的比力信息;为捷联惯性导航系统的姿态矩阵;为由地理坐标系到虚拟旋转地理坐标系的转换矩阵,即:C n n r = cos ω n t sin ω n t 0 - sin ω n t cos ω n t 0 0 0 1 , ]]> ωn为虚拟旋转地理坐标系绕着其z轴的旋转角速率,为ωn=2*π/Tn,Tn为虚拟旋转地理坐标系的旋转周期,也即是每次捷联惯性导航解算过程中的速度解算周期,t取0~Tn,即为每个旋转周期内的旋转时间;ω ie n r = C n n r ω ie n , ]]> 为地球坐标系相对于惯性坐标系的角速率在地理系上的投影;ω en r n r = ω en n r + ω nn r n r = C n n r ω en n + 0 0 ω n T , ]]> 为地理坐标系相对于地球坐标系的角速率在地理坐标系上的投影;g n r = C n n r g n , ]]> gn为重力加速度在地理坐标系下的投影;步骤四:每次在虚拟旋转地理坐标系上解算速度时,由导航计算机进行一个旋转周期的解算;将虚拟旋转地理坐标系的旋转周期Tn分成n段小的时间段,即:0~ΔT,ΔT~2ΔT,…,(n-1)ΔT~Tn,其中ΔT=Tn/n;并在每个小的时间段内对速度进行积分运算,得到:Δ v n r ( k , i ) = ∫ ( i - 1 ) ΔT iΔT ( f n r - ( 2 ω ie n r + ω enr n r ) × v n r ( k , i - 1 ) + g n r ) dt ]]> 其中v n r ( k , i - 1 ) = v n r ( k - 1 ) + Σ j = 0 i - 1 Δ v n r ( k , j ) , i = 1,2 , · · · , n , ]]> 为上次导航解算得到的速度;则得到该次导航解算的速度为:v n r ( k ) = v n r ( k , n ) = v n r ( k - 1 ) + Σ i = 1 n Δ v n r ( k , i ) ; ]]> 步骤五:由步骤四得到的速度也即是地理坐标系坐标系下的速度,即:对得到的导航速度信息进行积分便可以得到系统的位置信息。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工程大学,未经哈尔滨工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201310244636.6/,转载请声明来源钻瓜专利网。