[发明专利]车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法有效
申请号: | 201210011114.7 | 申请日: | 2012-01-14 |
公开(公告)号: | CN102589568A | 公开(公告)日: | 2012-07-18 |
发明(设计)人: | 奔粤阳;吴晓;李倩;高伟;于飞;王秋滢;盛宏媛;刘彬;张磊;南兆君 | 申请(专利权)人: | 哈尔滨工程大学 |
主分类号: | G01C25/00 | 分类号: | G01C25/00 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 150001 黑龙江省哈尔滨市南岗区*** | 国省代码: | 黑龙江;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: |
本发明的目的在于提供车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法,包括以下步骤:确定车辆的初始位置,采集陀螺和加速度计输出的数据;进行解析式粗对准;使车辆捷联惯性导航系统的水平回路工作在二阶水平对准过程,方位回路工作在罗经对准过程中,采集车辆捷联惯性导航系统测量的导航坐标系下速度,上一步结束时刻车辆捷联惯性导航系统测量得到的捷联姿态矩阵T1,得到测量中间量 |
||
搜索关键词: | 车辆 惯性 导航系统 陀螺 漂移 快速 测量方法 | ||
【主权项】:
1.车辆捷联惯性导航系统的三轴陀螺常值漂移快速测量方法,其特征是:(1)熄灭车辆发动机,保持车辆静止状态;(2)通过外部设备确定车辆的初始位置包括经度和纬度,将它们装订至车辆捷联惯性导航系统的导航计算机中;(3)车辆捷联惯性导航系统进行预热,采集陀螺和加速度计输出的数据;(4)进行解析式粗对准;(5)使车辆捷联惯性导航系统的水平回路工作在二阶水平对准过程,方位回路工作在罗经对准过程中,采集车辆捷联惯性导航系统测量的导航坐标系下速度:V n ( k ) = V E n ( k ) V N n ( k ) V U n ( k ) , ]]> 其中上角标表示导航坐标系n系,下角标E、N、U分别表示导航坐标系的东向轴、北向轴和天向轴,并且有k=1,2,·,M,
h为车辆捷联惯性导航系统的采样周期;(6)步骤(5)结束时刻,车辆捷联惯性导航系统测量得到的捷联姿态矩阵T1:T 1 = T 1 ( 11 ) T 1 ( 12 ) T 1 ( 13 ) T 1 ( 21 ) T 1 ( 22 ) T 1 ( 23 ) T 1 ( 31 ) T 1 ( 32 ) T 1 ( 33 ) , ]]> 其中T1(ij)表示T1的第i行、第j列元素;(7)利用步骤(5)采集到的
和
得到测量中间量Δ1和Δ2:Δ 1 = ( K 2 + 1 ) Σ k = 1 M V N n ( k ) 6378393 , ]]>Δ 2 = K z Σ k = 1 M V U n ( k ) 465.1198 cos L , ]]> 其中L为车辆所在位置的纬度值,参数设置为K2=153.5,Kz=0.009446;(8)启动车辆并操纵车辆转弯,制动车辆,熄灭车辆发动机,保持车辆静止状态;(9)重复步骤(5)的过程;(10)步骤9结束时刻,车辆捷联惯性导航系统测量得到的捷联姿态矩阵T2:T 2 = T 2 ( 11 ) T 2 ( 12 ) T 2 ( 13 ) T 2 ( 21 ) T 2 ( 22 ) T 2 ( 23 ) T 2 ( 31 ) T 2 ( 32 ) T 2 ( 33 ) , ]]> 其中T2(ij)表示T2的第i行、第j列元素;(11)利用步骤(9)采集到的
得到测量中间量Δ3:Δ 3 = ( K 2 + 1 ) Σ k = 1 M V N n ( k ) 6378393 ; ]]> (12)利用步骤(6)、步骤(7)、步骤(10)、步骤(11)得到三轴陀螺常值漂移的测量值:x轴陀螺常值漂移的测量值:ϵ x = T 1 ( 22 ) T 1 ( 33 ) Δ 3 - T 1 ( 22 ) T 2 ( 23 ) Δ 2 + T 1 ( 23 ) T 2 ( 22 ) Δ 2 - T 1 ( 23 ) T 1 ( 32 ) Δ 3 - T 1 ( 33 ) T 2 ( 22 ) Δ 1 + T 1 ( 32 ) T 2 ( 23 ) Δ 1 D ]]> y轴陀螺常值漂移的测量值:ϵ y = - T 1 ( 21 ) T 1 ( 33 ) Δ 3 - T 1 ( 21 ) T 2 ( 23 ) Δ 2 - T 1 ( 33 ) T 2 ( 21 ) Δ 1 + T 1 ( 31 ) T 2 ( 23 ) Δ 1 - T 1 ( 23 ) T 1 ( 31 ) Δ 3 + T 1 ( 23 ) T 2 ( 21 ) Δ 2 D ]]> z轴陀螺常值漂移的测量值:ϵ z = T 1 ( 31 ) T 2 ( 22 ) Δ 1 - T 1 ( 21 ) T 2 ( 22 ) Δ 2 + T 1 ( 22 ) T 2 ( 21 ) Δ 2 - T 1 ( 32 ) T 2 ( 21 ) Δ 1 + T 1 ( 21 ) T 1 ( 32 ) Δ 3 - T 1 ( 22 ) T 2 ( 31 ) Δ 3 D ]]> 其中D=T1(21)T2(23)T1(32)-T1(21)T1(33)T2(22)+T1(33)T1(22)T2(21)-T2(23)T1(22)T1(31)-T1(23)T2(21)T1(32)+T1(23)T1(31)T2(22)。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工程大学,未经哈尔滨工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201210011114.7/,转载请声明来源钻瓜专利网。