专利名称：捷联惯性导航系统快速阻尼方法
技术领域：
本发明涉及的是ー种捷联惯性导航系统导航误差快速抑制方法。
背景技术：
船舶捷联惯性导航系统要求在长时间工作条件下能够提供高精度的导航信息。通过提高元器件的精度、对元器件误差參数精确标定以及对初始对准方法的改进能够提高惯导系统的精度，而如何在船舶捷联惯性导航系统使用过程中充分利用现有技术条件，采用高效的误差抑制手段，使系统应具有的精度最大限度地发挥，是惯导方案需要深入研究的课题。目前捷联惯性导航系统中常采用引入阻尼的方式，来对振荡性的系统误差进行抑制。对于方位阻尼来说，要阻尼地球周期振荡误差分量，由于地球周期是24小时，所以阻尼过程时间要很长。通常需要ー个半周期才能阻尼下来(即需要36小吋)。要 想阻尼的快，阻尼系数ξ就要选大，而阻尼系数大，系统对船舶加速度的响应就大。由于阻尼过程时间长，故一般情况下，惯导系统不能工作在方位阻尼工作状态。
发明内容
本发明的目的在于提供一种能够实现捷联惯性导航系统系统误差的快速收敛的捷联惯性导航系统快速阻尼方法。本发明的目的是这样实现的步骤ー捷联惯导系统进行预热准备；步骤ニ 捷联惯导系统进行初始对准；步骤三进行正向姿态矩阵更新；步骤四进行正向速度更新；步骤五进行正向位置更新；步骤六对步骤三至步骤五的数据完成存储，进行姿态矩阵、速度、位置的重新初值赋值，进行惯导系统逆向解算；步骤七进行逆向姿态矩阵更新；步骤八进行逆向速度更新；步骤九进行逆向位置更新；步骤十重新对姿态矩阵、速度、位置进行初值赋值，并重复步骤三至步骤九。本发明利用捷联系统数学平台的多祥性，对快速阻尼算法进行研究。假设导航计算机存储容量足够大并且计算能力足够强，则导航计算机可以对SINS的采样数据进行存储，并应用不同的算法对已存储的数据进行反复计算，解算出当前时刻最优的导航結果。而这ー特点在平台惯导系统中是不可能实现的，因为一旦对平台施加了某种控制后，就难以使平台恢复到控制前的状态以便重新实施另外一种控制算法，若将SINS存储的采样数据当作一组时间序列看待，正常情况下对该序列按时间先后从前往后进行分析，达到实现系统阻尼的目的。如果简单地按时间直接将采样数据序列进行分段分配，则越是在前期阶段中被利用的数据信息越少，若在后期阶段中将前期阶段数据丢弃不再利用将造成信息浪费，因此在后期阶段中还应当反过来重新挖掘前期阶段的数据信息，如此反复利用数据，必然能够増加可用信息量，有利于缩短系统阻尼时间。为了解决传统的捷联系统方位阻尼收敛时间长、速度慢的缺点，本发明充分利用捷联惯性导航系统的“数学平台”多祥性的特点，引入可逆算法，提出了ー种快速阻尼方案，最終实现了捷联惯性导航系统系统误差的快速收敛。本发明的方法可用于船用捷联惯导系统的导航误差抑制领域。本发明的优点主要体现在一、本发明在没有使用任何外部辅助信息的基础上，抑制了导航信息的误差，提高了捷联惯性导航系统的精度；ニ、本发明充分利用捷联惯性导航系统的“数学平台”的多祥性，提高了系统阻尼的收敛速度，大大缩短了收敛时间。 三、本发明在没有増大阻尼系数的条件下，缩短了阻尼时间，因此本方案有着较强的运动适应性。
图I为本发明的流程图；图2为本发明的原理图。
具体实施例方式下面举例对本发明做更详细的描述步骤ー捷联惯导系统的预热准备，预热时间约为2个小时；步骤ニ 捷联惯导系统的初始对准；步骤三进行正向姿态矩阵更新；正向姿态矩阵更新计算时，采用的算法模型为Qk=C^iI +AT-Ω^)(I)式中
权利要求
1.一种捷联惯性导航系统快速阻尼方法，其特征是 步骤一捷联惯导系统进行预热准备； 步骤二 捷联惯导系统进行初始对准； 步骤三进行正向姿态矩阵更新； 步骤四进行正向速度更新； 步骤五进行正向位置更新； 步骤六对步骤三至步骤五的数据完成存储，进行姿态矩阵、速度、位置的重新初值赋值，进行惯导系统逆向解算； 步骤七进行逆向姿态矩阵更新； 步骤八进行逆向速度更新； 步骤九进行逆向位置更新； 步骤十重新对姿态矩阵、速度、位置进行初值赋值，并重复步骤三至步骤九。
2.根据权利要求I所述的捷联惯性导航系统快速阻尼方法，其特征是所述正向姿态矩阵更新，采用如下模型Cnbk=Cnbk^I+Μ. Μ), 其中
3.根据权利要求2所述的捷联惯性导航系统快速阻尼方法，其特征是所述正向速度更新，采用如下模型V: = V；, +AT.[Ck_1f1tk-(2aek_1 +Ot +^]， 其中
4.根据权利要求3所述的捷联惯性导航系统快速阻尼方法，其特征是所述正向位置更新，采用如下模型
5.根据权利要求4所述的捷联惯性导航系统快速阻尼方法，其特征是所述进行惯导系统逆向解算的方法为将正向姿态矩阵更新、速度更新、位置更新模型中的陀螺采样和地球自转角速率符号取反，并设置逆向导航算法的初值为
全文摘要
本发明提供的是一种捷联惯性导航系统快速阻尼方法。步骤一捷联惯导系统进行预热准备；步骤二捷联惯导系统进行初始对准；步骤三进行正向姿态矩阵更新；步骤四进行正向速度更新；步骤五进行正向位置更新；步骤六对上述数据完成存储，进行姿态矩阵、速度、位置的重新初值赋值，进行惯导系统逆向解算；步骤七进行逆向姿态矩阵更新；步骤八进行逆向速度更新；步骤九进行逆向位置更新；步骤十重新对姿态矩阵、速度、位置进行初值赋值，并重复步骤三至步骤九。本发明充分利用捷联惯性导航系统的“数学平台”多样性的特点，引入可逆算法，最终实现了捷联惯性导航系统系统误差的快速收敛。本发明的方法可用于船用捷联惯导系统的导航误差抑制领域。
文档编号G01C21/16GK102853833SQ20121011089
公开日2013年1月2日 申请日期2012年4月16日 优先权日2012年4月16日
发明者徐博, 高伟, 周广涛, 奔粤阳, 卢宝峰, 吴磊, 程建华, 陈世同, 于强, 高洪涛 申请人:哈尔滨工程大学
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
