捷联惯导系统性能分析

捷联惯导系统性能分析
捷联惯导系统性能分析

捷联惯导系统性能分析

摘要

本文简要介绍捷联式惯性导航系统的各种分析技术,对捷联惯导系统算法验证的过程进行了讨论。封闭形式分析仿真驱动程序,可以用来锻炼/验证捷联算法方程。分析的精度捷联络筒,划船和分析方法位置融合算法(包括位置算法的折叠效果)函数的算法重复率和系统振动输入。包括的是一个简化的分析模型,该模型描述可用于翻译系统到惯性传感器作为传感器组件的函数的输入的振动安装失衡。捷联系统静态漂移和的旋转测试程序/方程描述捷联式传感器的校准系数确定。该文件概述了卡尔曼滤波器的设计和协方差分析技术,并介绍了验证辅助捷联惯导系统的一般步骤卡尔曼滤波器的配置。最后,论述了系统集成测试的一般过程验证所有的硬件,软件,系统功能操作进行正确和准确和界面元素。

坐标框架

在本文中,使用一个坐标系是一个分析性的抽象定义的三个相互垂直单位矢量。一个坐标系可以看作一组三个相互垂直的线(轴)通过一个共同的点(原点)与来自沿着坐标轴的原点上的单位向量。在本文中,每个坐标系的原点的物理位置是任意的。主坐标帧利用有以下几种:

B帧=“身体”捷联式惯性传感器轴平行的坐标系。

N帧=“导航”的坐标系在当地具有Z轴平行地垂直向上定位。A“漂移方位”N帧有水平的X,Y轴旋转相对于非旋转的惯性空间在本地地球的速度的垂直分量绕Z轴。“自由方位”N帧的转动惯量为零率X,Y轴的Z轴周围。“地理”N帧的X,Y轴绕Z轴旋转,以维持当地的真北Y轴平行。

E型=“地球”的引用与固定角几何相对于地球坐标系。

I帧=“惯性”非旋转坐标系。

符号

V =向量没有特定的坐标系指定。向量是一个有长度的参数和方向。纸中使用的载体,被分类为“免费的矢量”,因此,没有坐标框架中,他们分析描述的理想地点。

V A =列矩阵的元素等于V的坐标系A轴的投影。“

投影V对每个Frame A轴等于与坐标框架的V的点积A轴的单位向量。

V A×=斜对称的(或跨产品)的形式表示的正方形矩阵的V A

0 - VZA VYA

VZA 0 - VXA

- VYA VXA 0

VXA,VYA,VZA是V A的组成部分。“

另一种框架向量V A×矩阵乘积等于跨产品的V A用该载体在A帧。

CA2

A1 =方向余弦矩阵,将一个向量的坐标系A2投影

形成坐标系A1投影形式。

ωA1A2的坐标系相对坐标系A1 A2 =角速率。当A1是非

旋转,ωA1A2是将角速度传感器测量的角速率安装在A2帧。

=

e

DT

=相对于时间的导数。

t =时间。

一、简介

捷联惯性导航系统(INS)的一个重要组成部分,分析处理性能评估特定技术元素。其中最常见的是协方差仿真分析根据统计估计这决定了预期的系统错误。本文讨论性能分析的方法,虽然很少报道,这是一个基本组成部分的设计和精度评估的资助和独立的惯性导航系统惯性的计算算法验证,系统振动影响的分析,系统测试的惯性传感器的校准误差,卡尔曼滤波器验证。

在捷联式惯性导航系统包括集成的主要计算元素计算姿态,速度和位置的导航参数的操作采用捷联式角速率比力加速进行输入。这些操作驻留在系统中的计算机和由计算算法执行所需的数字集成业务。一个的算法设计的重要组成部分,是用来保证的验证过程,所述数字积分操作准确地创建对应的持续集成的态度,速度,位置历史时间率微分方程的导航参数。构建这样的算法确切的封闭形式的解决方案主要是基于微分方程,大大简化了验证过程,允许它执行的封闭形式的精确解参考真相模式,是独立于应用程序。本文提供的例子,这样的真理模型使用验证代表的捷联算法。

结构良好的捷联式计算算法的精确度,最终靠自己的能力有限执行其指定的功能中存在的传感器的振动。算法的重复率是一个在这方面,必须选择足够小,以满足特定的软件精度的决定因素的要求。本文介绍了一些简单的分析技术,预测捷联式惯性传感器的动态运动和角度/线性惯性传感器存在所得算法错误振动。包括描述的一个简单的sensor-assembly/mount的结构动态分析INS输入振动转换成捷联式传感器输入的模型。

惯性传感器校准和捷联式惯性系统的最终组装,系统必须进行测试,以验证适当的性能,并在此过程中,评估的剩余的校准误差,残留在惯性传感器补偿系数。本文介绍两种常用的系统级测试中,捷联的漂移试验(用于测量角速度传感器偏置残差),和捷联旋转测试(用于测量angular-rate-sensor/accelerometer不对/比例因子误差和加速度计偏置)。这两种测试结构的基础上测量一个稳定的“平台”软件操作捷联传感器信号。此方法大大降低了转动的精度要求试验中所用的测试夹具。

卡尔曼滤波已经成为惯性系统导航参数(和更新的标准方法传感器补偿系数)在操作过程中(即惯性导航系统的“辅助”配置)。卡尔曼滤波器是在平行于处理一组复杂的软件操作正常的捷联式惯性导航融合算法。正确操作的辅助惯性导航系统依赖于彻底的验证了卡尔曼滤波器软件。这样的验证过程中描述的纸的基础上的实时卡尔曼滤波的通用模型。包括协方差分析的概述技术评估辅助系统和独立的表现在统计的基础上。

本文的结论进行了一般性讨论系统集成程序,以确保所有的系统硬件,软件和相关的界面元素的正常运作,并准确。这是一个浓缩版的材料,最初出版的两卷的教科书捷联Google Analytics(分析)(参考文献6),它提供了广阔的详细的论述分析方面的捷联惯性导航技术。方程的文件是没有证据的。他们的推导是在整个文件所划定的参考文献6节数(或参考文献的参考文献67,参考文献7中,也引用第6参考其推导的公式编号源)。

二、捷联算法验证

捷联式惯性导航软件的设计过程中的一个重要方面是验证数字集成的算法。在一般的操作集成在一台测试计算机算法他们指定的重复率与惯性传感器输入提供的“真理模型”,具有相应的导航参数配置文件(例如,姿态,速度,位置)。导航参数解决方案捷联算法,根据测试数值进行比较,对相当于真相模式配置文件来验证该算法的参数。成功验证的真相导航参考模型解决方案的准确性取决于伴随着真理模型的轮廓传感器的数据。在理想的情况下,参比溶液,应完全错误的态度,速度,位置参数错误集成的真相模型的惯性传感器信号。此外,参比溶液更新(s)应旨在行使受测试的计算算法的所有元素。在一般情况下,这决定了参考配置文件(S),不能代表正常的导航系统使用中遇到的现实条件。它也通常涉及模拟配置文件,分别采取不同的计算算法分组设计下测试通过。

在一般情况下,两种方法都可以被认为是为真理模型1。数字集成方法其中的道理模型融合

算法更准确比INS积分算法验证,和2。闭合形式的解析方程的惯性传感器的精确的整体解决方案angular-rate/linear-acceleration输入INS融合算法。与方法1的问题方法是两难它提出了在证明一个道理模型的准确性,也包含数字积分算法错误。本节介绍的方法2的方法,并提供了两个示例从参考文献6的封闭形式的解析确切的真理模型,评估古典分组的INS 用于执行基本集成操作的算法:1。在动锥进的姿态更新条件下,2。姿态更新,加速转型,速度/位置更新下划船/滚动动态条件下(包括加速度计尺寸效应分离)- 见参考文献6

第7.1.1.1,7.2.2.2,7.3.3为锥进,划船,滚动定义。这些真理模型(第2.1节和2.2节的遵循)SPIN-CONE和SPIN-ROCK-SIZE表示。

其他封闭形式的解析确切的真相开发的模型参考文献6 SPIN-ACCEL(第11.2.2),用于评估捷联姿态更新,加速转型,速度更新;

下恒定的B帧惯性角速率常数B帧特定的力加速算法,

恒定的N帧的惯性角速率和创捷联姿态评估的资产净值(第11.2.4节)在长期导航的更新,加速转型,速度/位置更新算法一个椭球表面形状模型。SPIN-ACCEL模型可以很容易地扩展,还提供分析的确切位置的解决方案。参考11.2节之前定义的分析程序可以用来验证所有子程序通常采用的捷联惯导姿态,速度,位置更新和相关的系统的输出。

参考第11.1节还说明了如何被设计为专门的仿真器可以验证高速捷联惯导积分算法已设计完全匹配的等效真连续积分在特别是angular-rate/specific-force-acceleration输入条件。这

第2.3节中要遵循的参考锥进,划船,滚动算法的方法。

2.1的SPIN锥真理型号

的的旋转锥真理模型提供准确的封闭形式的态度和相应的连续整合的主体框架为一个旋转的圆锥运动的角速度。之间的差异综合体在连续的捷联软件传感器采样周期模拟输入捷联式角速度传感器所用的更新程序下的软件测试的态度。SPIN-锥和捷联软件计算出的态度解决方案进行比较,以建立捷联软件姿态算法的精确度。

的的旋转锥真理模型是基于一个封闭的形式解决方案的姿态描述的体在一个固定的幅度旋转速率旋转,其旋转轴是在一个固定的进动角速度旋转。议案描述的几何形状在图1中示出的旋转轴和进动轴分离的角度β。旋转轴的旋转有关的进动轴被定义为一个非旋转的惯性平面垂直。体基准轴的一组在图1中,暗示相对于非旋转坐标系定义的一组。在图1中,

N =非旋转坐标系,被固定到非旋转平面与XN,YN中的轴平面和ZN轴垂直的平面的方向相对的进动速率矢量。

R =身体“参考”的坐标轴沿旋转轴与X轴(XR)固定到主体。的R帧是在一个固定的方向相对于B帧传感器轴。是有区别的之间的B和R的框架,从而使所产生的图1的运动的角速度可以有预测B帧传感器轴测试的普遍反应,捷联姿态算法。

β=角度之间的进动轴和R-帧XR自旋轴(“锥角”)- 认为是恒定的。

量ωs'=惯性旋转速率的身体约XR(“旋转速率”)- 认为是恒定的。

ωC=身体XR轴进动的轴对应于惯性岁差率圆锥条件。

φ,θ,ψ=滚动,俯仰,标题欧拉角相对的N帧的R帧轴。

对应于图1运动的解析解(注释6派别。11.2.1.1和11.2.1.2):

φ0为φ=初始值。假设的ψ的初始值是零。

t =时间从模拟开始。

L =真理模型输出的周期时间指数所对应的最高速度计算重复率下测试的算法。

Δαl=综合B帧ωIB惯性的周期L-1的角速度矢量为l。

CRN(I,J)=第i行第j列的CR?元素。

CBR =常数的方向余弦矩阵B和R帧。

的Δαl输出向量将被用作模拟角速度传感器输入的态度算法根据测试(例如,参考7方程组(8),(12)和(24)与零点设置为N帧的旋转速率,并升对应于高速锥进算法计算周期的索引)。CB N矩阵表示的真理溶液比较,与所产生的等效CB?对应的Δαl历史算法进行测试。进行比较时乘以的算法计算CB N(在左侧)由转真模型CB?(在右边),并比较结果的身份矩阵(正确的产品的价值时,算法的计算CB?没有错误)- 参见参考文献6条11.2.1.4的细节和结果如何,可以看作是相当于正常,正交性和不对错误。

如果被测试的精确的算法,并设置正确的,那样的比较的的旋转锥真理解决方案应该显示相同的零误差。的态度算法文献7方程(8)和(12)是精确零圆锥运动和不施氮帧旋转速率下。因此,精确比较时,应使用SPIN锥锥进速度为零(即设定ωC到零)。随着非零ωC,比较与SPIN锥措施的络筒中的错误被测试的算法运算部(升循环速率的函数)。如果锥进计算算法是一种假定形式的角速率输入更新分析精确解(例如,反射式(24)),第2.3节显示了如何遵循相关的锥进的算法软件,可以完全验证(即,零误差)。

2.2 SPIN-ROCK-SIZE真理型号

的SPIN-ROCK-SIZE真理,模型提供了精确的封闭形式,集成的角速率,集成了线性

加速度,姿态,速度和位置模拟捷联惯性传感器组件进行纺纱/划船/滚动的动态运动与个人加速度计安装在指定的杠杆臂的传感器组件内的位置(即,模拟尺寸效应分离)。集成率和加速度使用作为捷联软件算法的输入被测计算车体姿态,加速度传感器尺寸效应杠杆臂补偿身体导航参考中心,改造补偿比力加速到导航坐标系,并转化加速整合速度和位置。捷联软件算法的精确度进行评估比较SPINROCK-SIZE真相模型计算的等效数据所产生的位置,速度和姿态捷联软件算法进行测试。

的的SPIN-ROCK-SIZE真理模型产生的导航和惯性传感器的输出动态绕任意指定并固定的旋转轴线(图2)。的旋转轴线被定义为非旋转和非加速。动态运动的特点是刚体绕指定位于刚体转动轴与指定的坐标轴。捷联惯性传感器组件被模拟的刚性体,并具有位于其导航参考在指定的杠杆臂的中心从旋转轴线的位置。每个加速度计的传感器组件内位于在任意

选择杠杆臂的位置。加速度计测量的加速度所建立的向心力和切向加速度的影响产生的杠杆臂位移下从旋转轴线刚体动态围绕的旋转轴的角运动。对于这个道理模型,N帧是惯性

非旋转和重力是零。

在图2中,

10 =从旋转轴线到导航中心的位置矢量。

李从航运中心的位置矢量加速度计(加速I)地震中心质量。

UI =加速度计i输入轴。

uγ=角旋转轴的单位矢量沿。

γ=角度旋转uγ的。

A,B,Ω=常数。

对应于图2运动的解析解(注释6派别。11.2.3.1 - 11.2.3.3):

ASFI比力加速的加速度矢量在我的位置。比力加速

速度赋予体相对的瞬时时间的变化率被定义为

它会持续无干扰当地的引力真空的速度

空间。有时被定义为总的速度变化率减去重力。加速度计

测量ASF。

Δυil=集成特定的力的加速度加速度计在我输入轴计算算法高转速l周期的时间间隔为l L-1。Δαl,Δυil输出向量将被用作模拟角速度传感器和加速度计的输入到的态度更新,加速转型,速度更新,位置更新,规模效应被测的补偿算法(例如,参考文献7方程(8),(12),(14),(15),(24),(26),(28),(37)和(39)用的零点设置的N帧的惯性旋转速率和l对应于

高速圆锥/划船/滚动算法的计算周期指数)CB N矩阵的态度真相溶液对应的Δαl历史比较,与所产生的等效CB?算法进行测试。第2.1节中的描述进行比较。Vn矢量是速度

相当于VN集成的算法生成的用于比较对真理的解决方案下测试通过。RN载体就是这个道理模型的位置,用于比较反对相当于RN所产生的集成被测使用算法(例如,求和的ΔRm ?为单位递增,方程(15),参考文献7)。

如果被测试的精确的算法,并设置正确的,那样的比较与的SPIN-ROCK-SIZE真理,解决方案应该显示相同的零误差。的态度算法文献7的式(8),(12)和(24)下是精确的零N 帧的旋转速率和零锥进(圆锥是为零时非旋转角速度矢量- 参考。6宗。7.1.1.1),因此,自SPIN-ROCK-SIZE根据恒定角速度矢量方向,精确的比较的SPIN-ROCK-SIZE解决方案的应获得。的acceleration-transformation/velocity-update/position-update算法文献7方程(14),(15),(26)和(28)下是精确的零N帧的旋转速率和零划船/滚动运动(划船和滚动是零的下角速率常数B帧和具体力加速- 参考。6派别。7.2.2.2.1和7.3.3.1)。常数B帧角速度和比力加速度可以产生与SPIN-ROCK-SIZE由系数B设置为零。在此条件和的零加速度计杆的武器,精确比较的SPIN-ROCK-SIZE态度/速度/位置的解决方案应该得到的。具有非零系数B和模拟加速度计的杠杆臂,SPIN-ROCK-SIZE比较测量中的错误划船/滚动和加速度计的规模效应补偿部分的算法的测试。如果划船和滚动计算算法分析的精确解的假设形式的angular-rate/specific-force-acceleration输入配置文件(例如,参考文献7式(26)和(28)),第2.3节,按照怎么相关的的划船/滚动算法软件可以准确地验证(即,零错误)。

2.3专业模拟器的高速算法验证

高速捷联式惯性数字积分算法的设计是确切的根据假设分析使用专门的模拟器,可以验证他们的惯性传感器输入数字的形式。一般的参考第11.1节中描述的方法。例如,考虑捷联式惯性高高速络筒,划船,滚动集成功能的参考文献6,第7.1.1.1,7.2.2.2,7.3.3

并参考7第3.4条的总结:

M =导航参数(即,态度,速度,位置)更新周期指数。

ASF特定的力的加速度矢量,将测量的捷联加速度计。

βM=锥进的贡献姿态运动周期M-1到m。

ΔvSculm=划船周期时间,m-1的速度运动的贡献为m。

ΔRScrlm=划船定位运动的周期时间,m-1到m的贡献。

参考文献6第7.1.1.1.1,7.2.2.2.2和7.3.3.2,数字集成算法设计

执行前面的操作使用高速升周期运算速度之间的态度,速度,位置m周期更新。的算法(总结在参考文献7中的方程(24),(26)和(28))是根据线性斜坡角速率和特定设计提供准确的解决方案,以上述操作强制升周期的加速度曲线之间。算法的输入集成角速度和比力加速度之间升周期递增,占捷联式角速度传感器的输入信号和加速度。一个简单的方法执行其预先设计的算法是数字验证建立一个专门的仿真器,生成的算法集成惯性传感器的增量输入基于的线性斜坡angular-rate/specific-force-acceleration的个人资料。要验证的算法然后将操作在模拟中使用的模拟传感器的增量输入在其升循环速率,在m个周期时间和评估。正确导出和软件实现的算法,结果应该完全符合真正的线性斜坡下的解析积分方程(12)an gular-rate/specific-

哪里

A0,A1,B0,B1 =模拟常数。

方程(13)代入(12),并进行积分操作分析产生的真实分析假设线性斜坡剖面相应的解决方案:

哪里

L =高速算法计算周期指数(内的m更新周期)。

TL =升周期之间的时间间隔。

Δαl=集成的角速率传感器输出的增量周期时间L-1至L的总和。

Δυl=集成加速度计输出的增量周期时间L-1至L的总和。

与方程(15)的输入操作参考第7章高速数字积分算法

应提供在m个周期的时间,相同的选择为任何值的方程(14)相匹配的结果

的A0,A1,B0,B1常数。

捷联惯性导航融合算法的设计,准确核算

三维高频角和线性振动的传感器组件。如果没有正确地占

来说,这样的运动可以导致系统的态度/速度/位置误差建立。高速算法

描述在参考文献7方程组(24),(26),和(28)来测量这些效果(即,锥进,划船,

滚动,双集成的传感器输入)是基于近似的形式的角率/力的具体配置文件在高速更新间隔。算法设计的一个重要组成部分,是他们的下虚拟振动暴露在用户的捷联惯导精度评估车辆,这部分的主题。设计/合成算法性能评价结果,迭代的方式,最终选择的算法的顺序和其所需的重复率设置在INS 电脑。

由于传感器组件被动态地耦合到安装的INS通过INS结构(在许多情况下,包括机械隔离器和不平衡),振动输入的INS安装成为动态扭曲,因为他们翻译成惯性传感器输出的导航算法。

本节中的描述包括一个简化的分析模型为特征的动态响应一个INS输入振动和其在系统的性能评价中使用的传感器组件。本节中的所有公式都写在B帧中的坐标,其明确指定删除简单分析。

3.1正弦振动系统响应

在本节中,我们描述的传感器组件的线性和角的正弦振动的影响系统的导航性能。本节分为两个主要的子覆盖的真实态度,速度,位置运动振动响应,和中所用的特定算法的振动响应系统姿态,速度,位置的数字积分程序。该材料是选自第10.1节(及其子段),参考6还包括其他振动引起的影响。的态度响应的讨论是基于下面的B帧输入角振动旨在生产圆锥运动:

θ(t)的= B帧振动作“角”定义为集成的B帧惯性角速度矢量。由于我们正在处理的角振动的影响,在本质上,小振幅,θ(T)大约是旋转矢量与振动的运动相关联,因此,代表

一个实际的物理角度矢量(见参考文献6第3.2.2旋转矢量定义)。

UX,UY = B帧沿X,Y轴的单位向量。

Ω=振动频率。

θ0x,θ0y=正弦振动“角”矢量幅度约B帧的X轴和Y。

φθx,φθy=相角与B帧中的X,Y轴的角振动。

的速度响应的讨论是基于下面的B帧,输入线性和角振动设计,生产划船运动:

aSF0y = B帧Y轴比力加速度振动正弦振动振幅。

φaSFy=相角与B帧Y轴直线振动。

需要注意的是,因为绕一固定轴的角运动,没有在前面的圆锥运动振动曲线。

位置响应的讨论是基于的B帧直线振动可以产生折叠的效果扩增的位置更新算法。这种效果通常是不存在于态度/速度的惯性传感器的算法,因为典型的积分型,提供他们的

在预集成的角速率和特定的力加速度的形式输入到导航计算机增量。的B帧输入振动如下:uVib =直线振动输入轴。

请注意,因为没有在以前的振动的档案中的角运动,有没有锥进,划船或滚动效果的位置响应。

3.1.1真正的系统响应

根据方程(16)振动曲线,下面的真实态度产生运动(注释6宗。10.1.1.1):

T0 =初始时间t。

Φ(T)=旋转矢量描述的B帧由于在时间t的方程(16)振动的态度,相对于在t0的B帧的态度。

的态度响应一阶常数,振荡周围的角振动输入轴,一个二阶周围乌斯(角振动输入轴的轴线垂直的)的角振动,和线性时间建立了长期绕轴UZ代表圆锥效果。的平均斜率。态度的反应是线性项的系数,记为锥进速度(前参考):

V(T)=在时间t在时间t0时刻导向的B帧,由于方程(17)的角度/线性速度

因为时间t0的振动。

速度响应一阶常数,振荡沿直线振动输入轴,二阶常和振荡沿UZ(垂直的轴线线性/对角振动输入轴),和一个线性时间建立任期沿轴线乌斯代表划船效果。平均坡度的速度响应是划船速率(先前的参考)的线性项系数表示为:

R(t)的在时间t0时刻在时间t =位置导向的B帧由于方程(18)的振动,因为时间t0。3.1.2系统算法响应

系统的响应态度,速度,位置的计算算法,以第3.1输入振动取决于使用的特定算法。算法设计的一个重要组成部分是一个分析评估他们的反应比较下的虚拟与真实的运动响应输入运动。对于双速参考文献7中描述的算法中,低速的部分已被旨在分析精确算法错误,使得只产生由高速算法(除了轻微的小梯形积分算法与科氏力,重力,N帧的错误旋转速度计算)。其结果是,在3.1节中输入配置文件,参考7算法响应应符合第3.1节真理的解决方案加上一个额外的高速算法错误。对于文献7(和4)的态度计算,高速算法计算的锥进姿态运动的贡献(参考文献7式(24))的基础上截断二阶泰勒级数展开如:

对于前面的络筒用一个确切的姿态更新算法的算法操作(参考文献4和参考。

式。(8)),振动曲线是根据方程(16)的平均算法的错误响应(注释6宗。

δΦAlgo,δβAlgo的态度和络筒,算法的错误率。

对于文献7(5)的速度计算,高速算法计算划船以光速运动的贡献(参考文献7式(26))的基础上截断二阶泰勒级数展开如:

对于前面的的划船算法运算用一个确切的速度更新算法(参考文献5和参考。

7式。(14)),振动曲线是根据方程(17)的平均算法的错误响应(注释6宗。

10.1.2.2.2):

哪里

δvAlgo,δvScullAlgo=平均的速度更新和划船算法的错误率。

因为没有圆锥运动方程(17)振动的个人主页上,随附的参考7

态度算法的反应是错误的自由。

文献7(和5)的高分辨率位置计算使用一个高速算法来计算

双重一体化加速(参考文献7式(28))的基础上截断二阶泰勒级数展开

哪里

υl先前已定义的方程(27)。

对于前面的双重一体化的加速算法操作的准确位置更新算法(参考文献5和Ref。7式(15)),根据方程(18)的位置误差响应振动个人资料(注释6派别。10.1.3.2.3):

哪里

δRAlgo(T)=的位置算法错误。

δSυm错误,在Sυm加速的双重积分算法。

K =Ω到2π/铊比最近的整数值。

()INTG =()舍入到最接近的整数的值(例如,(0.3)Intgr = 0,(0.5)Intgr = 1,(0.7)Intgr = 1,

(1.3)= 1,(1.5)Intgr Intgr = 2,(1.7)Intgr = 2,等等)。

Ω'=折叠频率。

因为没有的圆锥或划船运动方程(18)振动曲线,随附

参考7高度和速度的算法响应是错误的。

方程(30)表明,该算法计算出的位置误差是相当大的,折叠的频率

Ω'的接近零(即,当Ω是接近2π/铊的的整数倍(1 - 余弦Ω'铊)

趋近于零)。参考6第10.1.3.2.3表明,对于k = 0时,长期关注的

ΩTL罪Ω'TL

这是无限的零折叠频率Ω'。后者对位置误差的影响实际上是一个建立在时间,只有在无限的时间无限(前作为参考)。的效果进行评估的有限的时间内,相等于方程(30)是(注释6。10.1.3.2.4节):方程(31)的定位算法误差是奇异的有限时间t的值的所有值

Ω'(即,包括k> 0的值)。

3.2

第3.1节的结果是基于知识的惯性传感器组件B帧的振动输入幅值和相位,代表预期的系统使用。查找这些值条件可以是一个耗时的计算机辅助软件设计的过程,涉及复杂的机械INS结构建模和机械耦合到用户车辆。由于其复杂性,过程本质上是易发生数据输入错误,歪曲所得结果。为了提供一个合理检查的结果,经常用于简化动态模型比较借给自己封闭形式的解析解。一旦详细的模拟结果相匹配的简化在其近似的不确定性模型,详细的模型被认为是有效使用,估计B 帧响应。

从更广泛的角度来看,我们必须承认,这几乎是不可能建立一个准确的机械INS 在用户车辆由于机械结构性能的变化动态模型INS的一个特定的设计(例如,刚性/阻尼特性的电子中的变化之间的在各自的导游证,在机械外壳的变化,变化中安装的电路板接口等),以及为一个特定的INS的特性随温度和时间的变化。另一方面,性能分析的目的,只有“球公园”精度通常是所需的乙架的振动特性。所有的事情考虑,合理使用简化的为B帧的振动的分析模型,从而消除了需要进行繁琐的计算机化造型。

图3示出了这样的简化的分析模型描绘的INS传感器组件线性和角INS输入的线性振动暴露。

图3示出了传感器组件,将名义上安装有一个对称的附件在振动源如K1,C1和k2,c2的是名义上等于与实际传感器组件中心质量与标称的质量中心(零ΔL)并置。在这种名义上的“企业管治摩”的条件,输入振动XF产生尖角响应为零θ和与线性X传感器装配体运动响应(注释6。10.5.1节):

哪里

AF(S),A(S)=拉普拉斯变换的的输入振动和传感器组件响应的加速度(二阶导数的XF,X)。

S =拉普拉斯变换变量。

K,C=き,词的标称值。

M =传感器组件的质量。

在非标称的条件下,相同的线性响应的产生,但也是一个尖角响应

产生(前参考):

根据正弦AF(S)激励频率Ω,A(S),θ(S)的反应是正弦幅度等于BA(Ω)(Ω),Bθ

乘以AF(S)的正弦信号输入幅度,频率Ω与一般非零逐步相对于自动对焦(S)的正弦信号(参考文献6第10.5.1还提供了A(S),θ(S)的相位角的响应的函数Ω)。

虽然方程(35)的简化的图3的模型的基础上导出的,它们可以被应用为普遍的简化计算公式的系数和误差项被选中代表实际的sensor-assembly/mount参数,例如,

ΩX,δx=无阻尼自然频率和阻尼比的实际sensor-assembly/mount直线振动运动的动态响应特性。

ωθ,δθ=无阻尼自然频率和阻尼比的实际sensor-assembly/mount

旋振运动的动态响应特性。

L =实际传感器组件的安装点之间的距离。

εk,εC=实际传感器组件安装结构,弹簧,阻尼交叉耦合误差系数。

εL=距离中心的力传感器组件安装的传感器装配中心质量,除以L.的

3.3 在随机系统的振动系统响应

第3.1节描述的解析公式,计算为捷联惯导性能参数线性和角度的正弦振动的传感器组件的功能。第3.2节描述了简化模型的结构动力特性的线性正弦振动输入翻译所得的线性和角度的正弦振动的传感器组件的源代码编译成。一个典型的INS设计规范定义了输入振动源的频率分量在频率作为一个随机混合物依赖的幅度。响应于随机振动的传感器组件是一个复合材料的总和,其响应于每个频率分量。对于第3.1节的性能方程,第3.2节简化的传感器组件动力学模型(解释为围绕两个轴的角度响应垂直于的线性输入振动),而最坏的情况下的传感器的相位响应的近似值组件振动激发,下面可以用来评估系统性能,在随机振动(注释6。10.6.1节):

哪里

E()=期望值算子(即平均统计值)。

ω=输入随机振动频率参数。

ω=ω频率折叠版本的。

GaVib(ω)=输入线性振动功率谱密度。从ω等于GaVib(ω)的积分零到正无穷的随机振动加速度等于预期值输入的平方。

的f1,f2的功能,BA(ω)和Bθ(ω)的方程(32)和(35)中定义的。需要注意的是?δRAlgo 2(t)为的位置误差是根据方程(31)的形式,以避免奇点时的折叠频率ω'是零。

以前的方法,特别是INS的误差特性的随机评估(可以应用于其他INS误差的影响,以及正弦)振动。参考文献6第10.6.1-10.6.3除了前面讨论过的那些,提供几个例子。

4。惯性传感器校准误差的系统测试

INS(或它的传感器组件)后组装和传感器补偿软件系数有被安装(通常基于传感器校准测量),这是经常需要的残余传感器误差参数进行测量,以评估系统级的性能。对于补偿的影响,结果可用于更新的传感器的校准系数。本节介绍了两种INS系统通常在实验室进行的测试测量残余偏差,规模因素和错位的错误:捷联式漂移测试和捷联式旋转试验。捷联漂移测试进行静态测试,高性能传感器组件的态度集成软件,在INS电脑配置约束的平均水平转化的比力加速度为零。几个小时的持续时间,对于一个测试,约束的信号的平均值成为准确地计量水平角速度传感器偏置误差。捷联旋转试验可用于传感器组件的精度等级。它由下暴露在INS一系列旋转,和在静态之间的停留时间旋转,记录其平均的转化比力加速输出。通过处理所记录的数据,可以非常精确的测量的刻度因子误差和所有的传感器组件的惯

性传感器,加速度计偏置误差,和之间的相对错位未对准的传感器组件相对安装夹具的INS。这些测试的细节和其他文献6中描述的第18章。

4.1捷联漂移测试

捷联漂移测试的目的是评估角速度传感器错误处理产生的数据在长时间的自我调整。分析了捷联平台上进行测试正常的自对准的初始化模式的扩展。主要测量的捷联漂移测试是北水平的复合角速率传感器的输出,确定从北组件的捷联式分析平台,以使其固定在倾斜角速率偏差围绕北。减去已知的北方大地率从测量的真值评估南北复合的角速率传感器错误。东和垂直角速率传感器错误通过重复测试与在水平的以前东部和垂直的角速率传感器确定北的方向。

捷联漂移测试中使用的自对准过程创建本地级别的旋转速率稳定的解析“平台”(N个帧),其水平方向(相对于地球)是持续基于上水平的平台加速度测量值(即,垂直于加速度计来自本地重力垂直)。测试测量分析稳定的平台,以保持它的偏率地球的自转的存在下的水平。至于配置方面,仍然角度分析平台稳定的从稳定平台确定存在的B帧,因此,角速率的角速率传感器偏置测量变得不敏感的传感器组件的小的物理角运动期间测试(例如由test-fixture/laboratory微相对于地球或转动的运动引起传感器组件内部安装(INS),在热暴露试验由于热膨胀)。由前面的方法确定的角速率传感器偏置被损坏由角速度传感器规模

因素和不对中补偿误差残留量,一般可以忽略不计的捷联漂移测试环境相比,具有典型的高精确度偏置精度的要求。也包含在偏压测量角速率传感器随机输出噪声的影响被降低到一个允许一个足够长的时间延长自校准测量周期的可接受的水平。如果测试精度要求允许,可以用在测试的一个简化版本的捷联漂移测试测量来自每个传感器的直接积分补偿的角速度减去其接地率分量输入。为了减少地球速率输入失调误差的影响,使用后一种方法,角速率传感器的方向可以是与它的输入轴与地球的极旋转轴对准。更简单的直接的方法是容易在测试过程中的传感器组件相对于地球的角运动测量。

的情况下,偏置率的捷联式分析平台,没有可用的INS输出,INS计算真航向输出(注释6。

18.2.2节)的基础上,可以利用替代程序。在这种情况下东边的角速度传感器错误确定它生成的方位误差的基础上从测试在一个扩展的自对准运行的末尾。为了区分东部角速度传感器错误北地球率的INS标题输出耦合(测试标题错位下),测量两个个人走线。第二取向运行在一个标题是旋转的方向进行从第一个180度。之间的差的平均方位测量如此获得的取消北国大地的速度耦合输入,从而成为东测量角速率传感器错误的决心。北美和垂直角速率传感器错误的反复测试,确定向东方向的水平以前北部和垂直的角速率传感器。

以下操作集成来实现的捷联式平台的功能分析

捷联漂移测试可扩展的校准计算过程(注释6 6.1.2节):

B =角速率传感器和加速度计补偿的输入向量。

H =下标指示的对应的向量(或矩阵)的水平分量(或行)。

文=扩展对齐分析平台级维修系数。

频率ωe=地球转动惯量率的大小。

L =大地纬度。

UUP =单位矢量沿大地测量垂直(即N帧Z轴)。

五,ΔR=在扩展对齐的速度和位置的位移。

北角速率传感器偏差的计算公式为辅助前面的操作(注释6宗。

18.2.1):

φH

?

≡ωINH

?

DT

TSTART

趋向

δωARS/ CnstNorth≈1。

往往- TSTART

φH - 频率ωe余弦升(43)

4 - 20 RTO-EN-SET的-064

捷联惯导系统性能分析

哪里

堵,往往=的捷联漂移测试测量周期的开始和结束的时间。

δωARS/ CnstNorth =北组件的角速率传感器恒定的偏置剩余误差。频率ωe=地球自转速率的大小。

L =测试地点的纬度。

φH=的φH幅度。

捷联惯导系统粗对准方法比较

捷联惯导系统粗对准方法比较 魏春岭 张洪钺 北京航空航天大学自动化科学与电气工程学院 北京 100083 摘 要 通过误差分析对三种捷联惯导系统解析粗对准方法进行了比较。指出在 相同的传感器精度条件下,利用正交向量计算捷联矩阵比传统方法有更高的对准 精度,直接计算法不仅精度高,而且计算简单,更适合工程应用。 主题词 捷联惯导系统 解析粗对准 Comparison of Analytic Coarse Alignment Methods Wei Chunling Zhang Hongyue Beijing University of Aeronautics and Astronautics,Beijing100083 Abstract Three analytic coarse alignment methods to strapdo wn inertial navigation system are com pared via error analysis.The later two are superior to the traditional one because their east level dri f t misalignment angles are not corrupted b y gyro uncertainty.Due to its high ac- curacy and com putation e ff iciency,the direct method is more suitable for practical applica- tions. Subject terms Strapdown inertial navigation systems Analytic coarse alignment 作为一种航迹推算系统,惯性导航系统对初始解算条件有较高要求,初始对准误差会直接影响导航的精度。对于捷联式惯性导航系统,初始对准的目的就是要确定捷联矩阵C n b。解析粗对准就是利用加速度计和陀螺仪对重力加速度和地球自转角速度的测量值估算C n b,为精对准提供初始条件,因此选择算法简单、精度更高的粗对准方法有其实际意义。本文通过误差分析与计算机仿真比较了三种解析粗对准方法,指出直接计算法更适合工程应用。 1 解析粗对准方法 假定当地纬度 已知,地理系采用东北天坐标系,则重力加速度g和地球自转角速度 收稿日期 1999年12月 16

第六章 捷联惯导

第六章捷联惯导

6-1捷联惯导的原理?捷联惯导系统概述 ?捷联惯性技术的发展过程 ?捷联惯导系统与平台惯导系统的对比 ?捷联惯导系统的基本力学编排方程?捷联惯导系统的算法概述 ?捷联惯导系统原理框图的说明 ?姿态方程的解算 (1)姿态和航向角的计算 (2)姿态矩阵的微分方程 (3)四元数的运动学微分方程 (4)等效旋转矢量法及其微分方程 (5)位移角速率方程 (6)速度方程

?导航位置方程 (1)游动方位系与地球系之间的方向余弦矩阵 (2)载体位置计算 (3)方向余弦矩阵计算 ?垂直通道阻尼 ?捷联惯性器件的余度技术?单自由度陀螺仪的配置方案 (1)四陀螺仪配置方案 (2)六陀螺仪系统 ?二自由度陀螺仪的配置方案

?捷联惯导的数值计算方法?数值积分法 (1)欧拉法 (2)四阶龙格-库塔法 ?角速率信息的提取

“ 捷联(Strapdown)”这一术语的英文原义就是“捆绑”的意思。因此,所谓捷联惯性系统也就是将惯性敏感元件(陀螺与加速度计)直接“捆绑”在载体上,从而完成制导和导航任务的系统。 V-2导弹 “阿波罗-13”宇宙飞船 “海盗”火星降落器

从捷联技术的发展过程中我们已经看到捷联系统的优越性已越来越突出的显示出来,并在许多方面已日渐代替平台系统。为什么会出现这种情况呢?为了回答这一问题,这里从生产与使用的角度将捷联系统与平台系统做一对比。 (1)硬件和软件的复杂程度 由于捷联系统没有平台框架及相连的伺服装置,因而简化了硬件;代价是增加了计算机的负担,需要一个比较复杂的实时程序。 (2)可靠性 捷联系统的可靠性要比平台系统高,其原因是它的机械构件少,加之容易采用多敏感元件配置,实现余度技术。 (3)成本与可维护性 由于平台系统在机械结构上要复杂得多,而对于捷联系统只是算法复杂些,因而从制造成本上看捷联系统的成本要比平台系统低。从市场供应的情况来看,数字计算机的价格一直在下降,而平台系统的价格一直在上升。 此外,捷联系统比平台系统具有较长的平均故障间隔时间,加之模块设计简化了维修,从而捷联系统的可维护性比平台系统大为提高了。

捷联式惯性导航系统

1 绪论 随着计算机和微电子技术的迅猛发展,利用计算机的强大解算和控制功能代替机电稳定系统成为可能。于是,一种新型惯导系统--捷联惯导系统从20世纪60年代初开始发展起来,尤其在1969年,捷联惯导系统作为"阿波罗"-13号登月飞船的应急备份装置,在其服务舱发生爆炸时将飞船成功地引导到返回地球的轨道上时起到了决定性作用,成为捷联式惯导系统发展中的一个里程碑。 捷联式惯性导航(strap-down inertial navigation),捷联(strap-down)的英语原义是“捆绑”的意思。因此捷联式惯性导航也就是将惯性测量元件(陀螺仪和加速度计)直接装在飞行器、舰艇、导弹等需要诸如姿态、速度、航向等导航信息的主体上,用计算机把测量信号变换为导航参数的一种导航技术。现代电子计算机技术的迅速发展为捷联式惯性导航系统创造了条件。惯性导航系统是利用惯性敏感器、基准方向及最初的位置信息来确定运载体的方位、位置和速度的自主式航位推算导航系统。在工作时不依赖外界信息,也不向外界辐射能量,不易受到干扰破坏。它完全是依靠载体自身设备独立自主地进行导航,它与外界不发生任何光、声、磁、电的联系,从而实现了与外界条件隔绝的假想的“封闭”空间内实现精确导航。所以它具有隐蔽性好,工作不受气象条件和人为的外界干扰等一系列的优点,这些优点使得惯性导航在航天、航空、航海和测量上都得到了广泛的运用[1] 1.1 捷联惯导系统工作原理及特点 惯导系统主要分为平台式惯导系统和捷联式惯导系统两大类。惯导系统(INS)是一种不依赖于任何外部信息、也不向外部辐射能量的自主式导航系统,具有隐蔽性好,可在空中、地面、水下等各种复杂环境下工作的特点。 捷联惯导系统(SINS)是在平台式惯导系统基础上发展而来的,它是一种无框架系统,由三个速率陀螺、三个线加速度计和微型计算机组成。平台式惯导系统和捷联式惯导系统的主要区别是:前者有实体的物理平台,陀螺和加速度计置于陀螺稳定的平台上,该平台跟踪导航坐标系,以实现速度和位置解算,姿态数据直接取自于平台的环架;后者的陀螺和加速度计直接固连在载体上作

车载捷联惯导系统基本原理

车载捷联惯导系统基本原理 一、捷联惯导系统基本原理 捷联惯导系统基本原理如图2-1所示: 图中陀螺和加速度计直接与载体系b固联,用来测量载体的角运动信息和线运动信息。导航解算的本质是根据初值进行积分的过程,通过求解姿态微分方程完成对姿态和航向角的积分,通过求解比力微分方程完成对速度的积分,通过求解位置微分方程实现对位置的积分。捷联惯导的姿态矩阵C n 相当于“数学平台”,取代了平台惯导中的实体平台,而ω?相当于对数学平台“施矩”的指令角速率。

二、捷联惯导微分方程 (一)姿态微分方程 在捷联惯导系统中,导航坐标系n 和载体坐标系b 之间的角位置关系通常用姿态矩阵、四元数和欧拉角表示,相应也存在姿态矩阵微分方程、四元数微分方程和欧拉角微分方程三种形式。 姿态矩阵微分方程的表达式为:

在欧拉角微分方程式(2.2-7)中,当俯仰角θ趋于90o时,cosθ趋于0,tanθ趋于无穷,方程存在奇异性,所以这种方法不能在全姿态范围内正常工作;姿态矩阵微分方程式(2.2-1)可全姿态工作,但姿态矩阵更新相当于求解包含9个未知量的线性微分方程组,计算量大;四元数微分方程式(2.2-6)同样可以全姿态工作,且更新算法只需求解4个未知量的线性微分方程组,计算量小,算法简单,是较实用的工程算法。 (二)速度微分方程 速度微分方程即比力方程,是惯性导航解算的基本关系式: 三、捷联惯性导航算法 捷联惯导解算的目的是根据惯性器件输出求解载体姿

态、速度和位置等导航信息,实际上就是求解三个微分方程的过程,相应存在姿态更新算法、速度更新算法和位置更新算法。 (一)姿态更新算法 求解微分方程式(2.2-6)可得四元数姿态更新算法为:

捷联式惯导系统误差解析解研究

第22卷 第11期计 算 机 仿 真2005年11月 文章编号:1006-9348(2005)11-0042-04 捷联式惯导系统误差解析解研究 张宾,刘藻珍 (北京理工大学机电工程学院,北京100081) 摘要:该文在一定的假设条件下利用捷联惯导系统的三维误差状态模型求解出了单通道误差状态方程的解析解,列表给出 了各误差源对于某一特定误差状态的动态影响。然后利用某型导弹的弹道数据通过对两种误差模型在同一条件下进行仿 真的方法验证了单通道误差状态方程解析解的正确性。单通道误差模型对分析各种误差源对系统的影响,确定在满足系统 精度要求的条件下主要误差源的选择范围,进行系统精度分配提供了十分方便直观的方法。 关键词:捷联;误差模型;误差分析 中图分类号:V249.32 文献标识码:A Research on the Error Ana lyti c Soluti on of Strapdown I nerti a l Nav i ga ti on System ZHANG B in,L I U Zao-zhen (School of Mechanical Electr onic Engineering,Beijing I nstitute of Technol ogy,Beijing100081,China) ABSTRACT:I n this paper,err or state model of strapdown inertial navigati on syste m(SI N S)is educed and analytic s oluti on t o monochannel err or state equati on is worked out under the conditi on of certain hypotheses.The lists of the effect of each err or s ource t o a given err or status are p r ovided when SI N S is in the state of moving.The correctness of analytic s oluti on t o monochannel err or state equati on is validated by the means of t w o err or models’si m ulati on excer p2 ting the same actual traject ory data of a certain type m issile.Monochannel err or model gives a convenient and intu2 iti onistic way t o analyze the effect of all kinds of err or s ources t o the system,deli m it the selective range of main err or s ource which can meet the requirement of the syste m accuracy and all ot syste m accuracy. KE YWO RD S:Strapdown;Err or model;Err or analysis 1 引言 在导航过程中,希望惯导系统能准确地提供各种导航信 息。但各种误差源的存在,使导航信息具有一定的误差。本 文在一定的假设条件下利用捷联惯导系统的三维误差状态 模型求解出了单通道误差状态方程的解析解,列表给出了各 误差源对于某一特定误差状态的动态影响。然后利用某型 导弹的弹道数据通过对两种误差模型在同一条件下进行仿 真的方法验证了单通道误差状态方程解析解的正确性。 单通道误差模型对分析各种误差源对系统的影响,确定 在满足系统精度要求的条件下主要误差源的选择范围,进行 系统精度分配提供了十分方便直观的方法。 2 捷联惯导误差模型 当地水平坐标系(L)中,捷联惯导系统力学编排方程计 算输出的状态变量包括:大地坐标(φ,λ,h),运动速度(V e , V n,V u)及姿态信息(r,p,y)等量。此时相应的误差状态向量 δX(t)=[

捷联惯导详细讲解

捷联惯导系统从20世纪60年代初开始发展起来,在1969年,捷联惯导系统作为"阿波罗"-13号登月飞船的应急备份装臵,在其服务舱发生爆炸时将飞船成功地引导到返回地球的轨道上时起到了决定性作用,成为捷联式惯导系统发展中的一个里程碑。 捷联式惯性导航(strap-downinertialnavigation),捷联(strap-down)的英语原义是“捆绑”的意思。因此捷联式惯性导航也就是将惯性测量元件(陀螺仪和加速度计)直接装在导弹需要诸如姿态、速度、航向等导航信息的主体上,用计算机把测量信号变换为导航参数的一种导航技术。 一、捷联惯导系统工作原理及特点 惯导系统基本工作原理是以牛顿力学定律为基础,通过测量载体在惯性参考系的加速度,将它对时间进行积分,之后将其变换到导航坐标系,得到在导航坐标系中的速度、偏航角和位臵信息等。 捷联惯导系统(SINS)是一种无框架系统,由三个速率陀螺、三个线加速度计和微型计算机组成。由于惯性元器件有固定漂移率,会造成导航误差,因此导弹通常采用指令、GPS或其组合等方式对惯导进行定时修正,以获取持续准确的位臵参数。如采用指令+捷联式惯导 捷联惯导系统能精确提供载体的姿态、地速、经纬度等导航参数,是利用惯性敏感器、基准方向及最初的位臵信息

来确定运载体的方位、位臵和速度的自主式航位推算导航系统。在工作时不依赖外界信息,也不向外界辐射能量,不易受到干扰破坏。它完全是依靠载体自身设备独立自主地进行导航,它与外界不发生任何光、声、磁、电的联系,从而实现了与外界条件隔绝的假想的“封闭”空间内实现精确导航。所以它具有隐蔽性好,工作不受气象条件和人为的外界干扰等一系列的优点。 除此以外捷联惯导系统的最大特点是没有实体平台,即将陀螺仪和加速度计直接安装在机动载体上,在计算机中实时的计算姿态矩阵,通过姿态矩阵把导航加速度计测量的载体沿机体坐标系轴向的加速度信息变换到导航坐标系,然后进行导航计算。同时,从姿态矩阵的元素中提取姿态和航向信息.由此可见,在捷联惯导系统中平台的作用已由计算机及其软件的作用代替了,捷联式惯导系统采用的是数学平台。力学编排就是按照合适的数学模型由观测量计算出导航定位参数。具体地讲,利用陀螺仪测得的载体相对于惯性参照系的旋转角速度,计算出载体坐标系至导航计算坐标系之问的坐标转换矩阵;将测量的比力(加速度计测量载体相对于惯性空间的线加速度)变换至导航坐标系,并经过两次积分得到所需的速度位臵信息。 二、捷联惯导系统有以下独特优点: (1)去掉了复杂的平台机械系统,系统结构极为简单,

车载捷联惯导系统定位测姿算法研究

第15卷第l期2007年2月 中国惯性技术学报 JoumalofChineseInertialTcchnology Vbl.15No.1 Feb.2007 文章编号:1005-6734(2007)01一0024-04 车载捷联惯导系统定位测姿算法研究 陈允芳1,叶泽田2,钟若飞3 (1.山东科技大学地球信息科学与工程学院,青岛266510;2.中国测绘科学研究院,北京100039; 3.首都师范大学,北京100037) 摘要:GPs/INs组合精确测定平台的位置和姿态是移动测图系统中的重要模块。对陀螺仪和加速度计所测角速度和比力进行两次积分得载体姿态、速度和位置即sINs力学机械编排。目前该过程大多在地理坐标系进行。 这里详细推导了地球坐标系中完整的解算过程,以四元数姿态矩阵更新及重力计算为核心,由IMu原始观测值解算出了载体位置、速度和姿态等参数,可快速高效与GPs输出的位置速度信息进行组合滤波处理,可据此编程进行工程应用数据处理。 关键词:捷联惯导系统;姿态矩阵;坐标转换;力学编排;四元数 中图分类号:u666.1文献标识码:A PositioningandorientationcomputationonVehicle-borne SINSanddiscussofcalculationerror cHENYun.‰91,YEze-tian2,zHONGRuo.fei3 (1.Geo?info衄ationScience&EngineeringCollege,ShandongUniverSi哆ofScienceaIldTbchnology,Qingdao 266510,China;2.SurveyingaTldMappingScienceResearchInStituteofChina,Beijing100039,China;3.C印ital NomlalUniverSi劬Beijing100037,China) Abstract:GPSandINSintegratedtoaccuratelydeteminingpositionaIldattitudeofnatI‘oofisVitalmoduleinmobilemappingSystem.Specincforcc行omspeedometer蚰d舭glerate矗om留roareinte铲atedtwicerespectiVelytoachievean沁de,veloc时aIldpositionn锄elySINSmechaIlization.Currentlythistookplacedingeogr印hiccoordinate,whiIeheredemonstratedindetailmewholemechaJlizationineanll-centclrcdearth-fixedcoordinate,mostlyquatemiona钍itudematrixupdating锄dgravit)rcaIculation.Ultimatelyvehiclenavigationpar锄eterssuchaSattitude,veIocity锄dpositionwercgahed丘omIMUorigin“0bservations.Mathematicsplatfo眦isfomlcdinSrNStocarryoutsuⅣeyingaJldcalculatingpreciselythenavigationmoVement par锄cterS.Theresultsarcpronetointe黟atewitllsimilarpammeters疔omGPStofilterprocessing.Pro可锄minghercbyc锄pmcessdatainengineeringapplication Keywords:SINS;attitudematrix;coordinatetransfomation;mechanization;quatemion 随着惯性技术与卫星导航定位技术的发展,由GPS/INs不同程度组合而成的定位定姿传感器已成为移动测图系统中确定载体轨迹和平台姿态的重要工具,其中GPs多用于定位而INS则用于测姿。捷联惯导系统(sINs)是将惯性仪表直接固联在载体上而无须采用机械陀螺稳定平台,通过导航计算机中相应程序建立“数学的”陀螺稳定平台,即计算机处理测量值得到载体位置、速度和运动方向估计值以实现导航平台功能。尽管sINS于20世纪50年代即在美国获得专利,但因受限于惯性设备和计算机技术的发展而一直未能实用。近年来,电子和高速计算机技术的发展使得捷联技术得以实现和充分发展,这是惯性技术在近20年内发展的一个重要的标志。 INS的核心部件是惯性测量单元(IMU),按照其陀螺仪和加速计等元件的精度,可将惯导分为不同等级:战略级(<0.000l(o)/}l,l岖)、导航级(0:000l~0.015)(o)/Il,5~100嵋)、低成本((1~10(。冲,(0.1~1)n培)。考虑到惯性设备出口管制政策及需求与成本等问题,民用INs精度范围一般为低成本级别。 收稿日期:2006—06—16;修回日期:2006—12—22 基金项目:国家863基金课题(2006AAl22324);教育部三维信息获取与应用重点实验室开放基金 作者简介:陈允芳(1977一),女,博士生,讲师,主要从事移动测图与组合导航。

捷联惯性技术的发展及与平台惯导系统的对比

捷联惯性技术的发展及与平台惯导系统的对比 [2009-06-20] 作者:admin 来源: 1.惯性技术与惯性导航的概述 惯性技术是惯性导航技术、惯性制导技术、惯性仪表技术、惯性测量技术以及惯性测试设备和装置技术的统称。它已有四十多年的发展历史了。由于惯性技术的自主性等特点,它不需要引人外界信息便可实现制导于导航。所以,它在国防科技中占有非常重要的地位,广泛的运用于航天、航空、航海等军事领域;随着惯性技术和计算机技术的不断发展以及成本降低,许多国家将其应用领域扩大到现代化交通运输、海洋开发、大地测量与勘探、石油钻井、矿井、隧道的掘进与贯通、机器人控制、现代化医疗器械、摄影技术以及森林防护、农业播种、施肥等民用领域。 惯性导航系统(Inertial Navigation System),简称惯导,是利用惯性敏感元件、基准方向及最初的位置信息来确定运载体的方位、姿态和速度的自主式航位推算系统。惯性导航系统可以分为平台式惯导系统和捷联式惯导系统两大类:平台式惯导系统是将陀螺仪和加速计安装在一个稳定平台上,以平台坐标系为基准,测量运载体运动参数的惯性导航系统;捷联式惯导系统(Strapdown Inertial Navigation System , SI )是将惯性敏感元件(陀螺仪和加速计)直接安装在运载体上,是一种不再需要稳定平台或常平架系统的惯性导航系统。 导航的目的就是为了得到运载体的实时的方位、姿态和速度。在工程运用中,能够测定物体运动参数的方法很多:如测量位移可以用里程计,还可以用无线电定位技术、天文定位技术和卫星定位技术等;要测速度可以用测速计;要测转角可用角位置传感器(电位计、光电码盘等等);要测角速度可以用转速表、测速电机等等。但是,以上各种测量手段还没有一种能够在同一时刻单独实时而又高精度地测量运载体的线运动和角运动,而惯性技术恰是测量这些运动参数的最理想的手段。

捷联惯导作业

一、原理分析: 捷联式惯导系统是将惯性器件(陀螺仪和加速度计)直接固连在载体上的系统。图1为捷联式惯导系统的原理图,陀螺仪和加速度计输出分别送入姿态矩阵计算和由载体坐标系至平台坐标系的方向余弦矩阵的计算。有了姿态矩阵,其一可以实现把载体坐标系轴向加速度信息变换到导航坐标系轴,进而可以进行所需的导航参数计算,其二利用姿态矩阵的元素,提取方位和姿态信息。 图1. 捷联式惯导系统的原理图 姿态速率微分方程为: 12b tb ωΛ=Λ (1) 其中; () b b b t t tb ib t ie et C ωωωω=-- (2) b ib ω为陀螺仪测量经补偿后的值;

0cos sin t iex t t ie iey ie t ie iez L L ωωωωωω?? ? ????? ??==???????????? ,为地球自转角速率; tan t ety t yt etx t t t etx et ety xt t etz t etx xt V R V R V L R ωωωω??-?? ? ???? ????? ??==?????????????????? ,为地理坐标系相对地球坐标系的转动角速率; 导航坐标系到载体坐标系的姿态矩阵为: cos cos sin sin sin sin cos cos sin sin cos sin sin cos cos cos sin cos sin sin sin cos sin sin cos sin cos cos cos t t C ψ?ψθ? ψ?ψθ? θ?ψθ ψθ θ ψ?ψθ? ψ?ψθ? θ?-+-?? ?? =-?? ??+-?? (3) 对应的四元素初值为: 0123cos cos cos sin sin sin 2 2 2 22 2 cos sin cos sin cos sin 2 2 2 2 2 2 cos cos sin sin sin cos 2 2 2 2 2 2 cos sin sin sin cos cos 2 2 2 2 2 2ψ θ ? ψ θ ? λψ θ ? ψθ ? λψ θ ? ψ θ ? λψ θ ? ψ θ ? λ? =-???=-???=+???=+? (4) 四元素姿态矩阵为: 22220123120313022 2 2 2 12030123 230122221302230101232() 2()2() 2()2() 2() b t C λλλλλλλλλλλλλλλλλλλλλλλλλλλλλλλλλλλλ?? +++++?? =--+-+????----+? ? (5) 将姿态速率微分方程展开成矩阵形式: 0112233001020b b b tbx tby tbx b b b tbx tbz tby b b b tby tbz tbx b b b tbz tby tbx λλωωωλλωωωωωωλλωωωλλ???? ??---??????-??????=??????-??????-???????????? (6)

捷联惯导详细讲解

捷联惯导系统从20 世纪60 年代初开始发展起来,在1969年,捷联惯导系统作为"阿波罗"-13 号登月飞船的应急备份装臵,在其服务舱发生爆炸时将飞船成功地引导到返回地球的轨道上时起到了决定性作用,成为捷联式惯导系统发展中的一个里程碑。 捷联式惯性导航(strap-downinertialnavigation) ,捷联( strap-down )的英语原义是“捆绑”的意思。因此捷联式惯性导航也就是将惯性测量元件(陀螺仪和加速度计)直接装在导弹需要诸如姿态、速度、航向等导航信息的主体上,用计算机把测量信号变换为导航参数的一种导航技术。 一、捷联惯导系统工作原理及特点惯导系统基本工作原理是以牛顿力学定律为基础,通过测量载体在惯性参考系的加速度,将它对时间进行积分,之后将其变换到导航坐标系,得到在导航坐标系中的速度、偏航角和位臵信息等。 捷联惯导系统(SINS)是一种无框架系统,由三个速率陀螺、三个线加速度计和微型计算机组成。由于惯性元器件有固定漂移率,会造成导航误差,因此导弹通常采用指令、GPS或其组合等方式对惯导进行定时修正,以获取持续准确的位臵参数。如采用指令+捷联式惯导 捷联惯导系统能精确提供载体的姿态、地速、经纬度等导航参数,是利用惯性敏感器、基准方向及最初的位臵信息来确定运载体的方位、位臵和速度的自主式航位推算导航系统。在工作时不依赖外界信息,也不向外界辐射能量,不易受到干扰破坏。它完全是依靠载体

自身设备独立自主地进行导航,它与外界不发生任何光、声、磁、电的联系,从而实现了与外界条件隔绝的假想的“封闭” 空间内实现精确导航。所以它具有隐蔽性好,工作不受气象条件和人为的外界干扰等一系列的优点。 除此以外捷联惯导系统的最大特点是没有实体平台,即将陀螺仪和加速度计直接安装在机动载体上,在计算机中实时的计算姿态矩阵,通过姿态矩阵把导航加速度计测量的载体沿机体坐标系轴向的加速度信息变换到导航坐标系,然后进行导航计算。同时,从姿态矩阵的元素中提取姿态和航向信息.由此可见,在捷联惯导系统中平台的作用已由计算机及其软件的作用代替了,捷联式惯导系统采用的是数学平台。力学编排就是按照合适的数学模型由观测量计算出导航定位参数。具体地讲,利用陀螺仪测得的载体相对于惯性参照系的旋转角速度,计算出载体坐标系至导航计算坐标系之问的坐标转换矩阵;将测量的比力(加速度计测量载体相对于惯性空间的线加速度)变换至导航坐标系,并经过两次积分得到所需的速度位臵信息。 二、捷联惯导系统有以下独特优点: (1)去掉了复杂的平台机械系统,系统结构极为简单,减小了系统的体积和重量,同时降低了成本,简化了维修,提高了可靠性。 (2)无常用的机械平台,缩短了整个系统的启动准备时间,也消除了与平台系统有关的误差。 (3)无框架锁定系统,允许全方位(全姿态)工作。 (4)除能提供平台式系统所能提供的所有参数外,还可以提供

导航原理_捷联惯导系统

导航原理作业(惯性导航部分)

一枚导弹采用捷联惯性导航系统,三个速率陀螺仪Gx, Gy, Gz 和三个加速度计Ax, Ay, Az 的敏感轴分别沿着着 弹体坐标系的Xb, Yb, Zb轴。初始时刻该导弹处在北纬 45.75度,东经126.63度。 第一种情形:正对导弹进行地面静态测试(导弹质心相对地面静止)。 初始时刻弹体坐标系和地理坐标系重合,如图所示,弹体的Xb轴指东,Yb轴指北,Zb轴指天。此后弹体坐标系Xb-Yb-Zb 相对地理坐标系的转动如下: 首先,弹体绕Zb(方位轴)转过-10 度; 接着,弹体绕Xb(俯仰轴)转过15 度; 然后,弹体绕Yb(滚动轴)转过20 度; 最后弹体相对地面停止旋转。 请分别用方向余弦矩阵和四元数两种方法计算:弹体经过三次旋转并停止之后,弹体上三个加速度计Ax, Ay, Az的输出。取重力加速度的大小g = 9.8m/s2。 第二种情形:导弹正在飞行中。 初始时刻弹体坐标系仍和地理坐标系重合;且导弹初始高度200m,初始北向速度1800 m/s,初始东向速度和垂直速度都为零。 陀螺仪和加速度计的输出都为脉冲数形式,陀螺输出的每个脉冲代表0.00001弧度的角增量。加速度计输出的每个脉冲代表1μg,1g = 9.8m/s2。陀螺仪和加速度计输出的采样频率都为10Hz,在200秒内三个陀螺仪和三个加速度计的输出存在了数据文件gaout.mat中,内含一矩阵变量ga,有2000行,6列。每一行中的数据代表每个采样时刻三个陀螺Gx, Gy, Gz和三个加速度计Ax, Ay, Az 的输出的脉冲数。格式如下表(前10行)

将地球视为理想的球体,半径6371.00公里,且不考虑仪表误差,也不考虑弹体高度对重力加速度的影响。选取弹体的姿态计算周期为0.1秒,速度和位置的计算周期为1秒。 (1)请计算200秒后弹体到达的经纬度和高度,东向和北向速度; (2)请计算200秒后弹体相对当地地理坐标系的姿态四元数; (3)请绘制出200秒内导弹的经、纬度变化曲线(以经度为横轴,纬度为纵轴); (4)请绘制出200秒内导弹的高度变化曲线(以时间为横轴,高度为纵轴)。 二、程序设计说明及代码 1.第一种情形 (1)方向余弦矩阵法 1)程序代码 clear;clc; thetax=15*pi/180;thetay=20*pi/180;thetaz=(-10)*pi/180; A0=[0;0;-9.8]; Theta=[0,-thetaz,thetay;thetaz,0,-thetax;-thetay,thetax,0]; theta0=sqrt(thetax^2+thetay^2+thetaz^2); S=(sin(theta0))/theta0;C=(1-cos(theta0))/theta0^2; CT=eye(3)+S*Theta+C*(Theta^2); CTN=inv(CT); A1=CTN*A0 2)输出结果 (2)四元数法 1)程序代码

捷联惯导系统快速罗经初始对准方法研究

捷联惯导系统快速罗经初始对准方法研究1 严恭敏1,严卫生1,2,徐德民1,2 1西北工业大学航海学院,西安(710072) 2水下信息处理与控制国家级重点实验室,西安(710072) E-mail:yangongmin@https://www.360docs.net/doc/dd1568830.html, 摘要:在分析平台罗经初始对准原理基础上,提出了捷联罗经初始对准的原理并推导了适合于软件编程的算法。将捷联罗经对准的具体实现划分为四个阶段:方位角未知情况下的水平对准、粗略方位自对准、重新水平对准和罗经方位对准,通过对大方位误差角捷联惯导非线性误差方程的简化,推导了粗略方位自对准的算法公式。如果导航计算机存储容量足够大并且计算能力足够强,根据捷联惯导系统数学平台多样性和可进行逆向姿态控制的特点,设计了一种用于缩短捷联罗经初始对准时间的具体步骤。最后,试验表明快速捷联罗经对准方案是有效的。 关键词:捷联惯导系统,罗经效应,初始对准,逆向控制 中图分类号:V249.3 1. 引言 平台惯导系统罗经初始对准过程通常可分为两步,先是水平调平,然后是方位对准。方位对准在水平调平的基础上进行,一般采样罗经方位对准方法。方位罗经对准利用的是罗经效应,也就是,在正确的平台跟踪当地地理坐标系的角速率控制指令下,如果平台存在方位轴向的偏差角,平台将产生绕东向轴的倾斜,该倾斜能由北向加速度计感测到,利用北向加速度计的输出并设计适当的控制规律,控制平台方位轴朝减小方位偏差方向转动,实现平台自动寻北。捷联惯导系统初始对准通常可分为粗对准和精对准两个阶段:在粗对准阶段,利用地球自转角速度和重力加速度作为参考量,通过惯性器件的测量输出建立粗略的导航计算坐标系;在精对准阶段,通过现代控制理论最优估计方法估计出失准角,获得准确的姿态矩阵[1,2]。 捷联惯导系统经典解析式粗对准方法难以适应晃动干扰环境,有不少文献研究了晃动基座下的初始对准问题并且也出现一些应用实例,激光陀螺和光纤陀螺的发展和不断成熟为捷联罗经的研究注入了新的活力[3-6]。从本质上说,捷联惯导系统与平台惯导系统是相同的,前者以数学平台(利用姿态矩阵、四元数或欧拉角等数学工具)模拟后者的实体平台,描述捷联惯导系统相对于参考坐标系的空间方位。平台惯导系统中实体平台具有隔离外界干扰的作用,因而平台罗经能够实现晃动基座下的初始对准,同理,在捷联惯导系统初始对准中也可以根据平台罗经初始对准的特点,建立相应的数学平台隔离晃动影响。经典控制理论与现代最优估计方法相比,前者的优点之一是勿需精确的数学模型与噪声模型,应用经典控制理论进行罗经对准的设计方法已经非常成熟,为捷联罗经对准方案设计提供了大量的参考,然而初始对准时间长是平台罗经的一大缺点。快速初始对准是国内在捷联罗经对准方法研究中亟待解决的一个主要问题,该问题在某些西方国家已得到较好解决,例如法国iXSea公司的OctansIII型光纤陀螺罗经在动态环境下,能在3min内完成初始对准,达到0.2o×sec(L)的精度[5],成为捷联罗经研究与应用中的佼佼者,它为我们的研究和工程开发目标提供了参考。 本文从分析平台罗经初始对准的原理出发,提出了捷联罗经初始对准的原理并推导了便于软件编程的算法,通过对大方位误差角捷联惯导非线性误差方程的简化,推导了粗略方位 1本课题得到水下信息处理与控制国家级重点实验室基金(9140C230206070C2306)的资助。

捷联式惯导系统初始对准

捷联式惯导系统初始对准 惯性技术是惯导(惯性导航与惯性制导)技术、惯性仪表技术、惯性测量技术以及有关设备和装置技术的统称。惯性导航与惯性制导是当今非常重要的综合技术之一,它广泛用于航空、航海、航天及陆地各领域。惯性导航系统是和用陀螺与加速度计通过最初的方向基准和位置信息来确定运载体在一特定坐标系内的姿态、位置、速度和加速度的自主式导航系统。惯性制导系统是利用运载体内部的陀螺、加速度计测量其运动参数,经过计算机发出控制指令,从而把运载体按照预定的路线准确地引导到目的地的制导系统。自主性是惯性系统最重要的特点。确定运动对象导航参数的方法和仪器有许多,例如磁、天文、无线电、水声、全球卫星定位系统等等,然而它们都有一个致命的弱点,即不是自主的,不是要向外界发出信息,就是要依赖对外观测信息,而惯性系统与上述诸方法的基本区别就在于是完全自主的,即导弹、潜艇、飞船等可以在一个完全与外界条件以及电磁波隔绝的假想“封闭”空间内实现精确导航。因此,惯导系统具有隐蔽性好、抗干扰、不受任何气象条件限制的优点,且数据更新速率高,可以提供连续实时的导航参数。 惯性系统在国防科学技术中占有非常重要的地位,因而是世界各工业强国重点发展的技术领域之一。随着惯性技术的不断发展,许多国家已将其应用领域扩大到现代化交通运输,海洋开发,大地测量与勘探,石油钻井,矿井、隧道的掘进与贯通,机器人控制,现代化医疗器械,摄影技术以及森林防护,农业播种、施肥等民用领域。惯性技术的发展表明:从传统的机械转子型陀螺向固态陀螺仪(激光、光纤陀螺仪)转移,并进一步向以半导体硅为基本材料的微机械振动陀螺发展;从框架式平台系统向捷联系统转移,从纯惯性捷联系统向以惯性系统为基础的多体制组合导航系统发展,成为今后惯性技术发展的总趋势。 捷联式惯性导航系统,导航用的加速度计是直接捆绑在运载体上,它测量的是运载体坐标系轴向比力,只要把这个比力转换到惯性坐标系上,则其他计算就和空间稳定的平台式惯性导航系统一样,而比力转换的关键就是要实时地进行姿态基准计算来提供数学平台,即实时更新姿态矩阵b C,有些资料上称姿态矩阵 g 为捷联矩阵或方向余弦矩阵b C。一般选择地理坐标系为导航坐标系,那么捷联 g 矩阵也可表示为i C,其导航原理图如下所示: g

2捷联惯性导航系统初始对准原理

第二章 捷联惯导系统的初试对准 2.1引言 惯导系统是一种自主式导航系统。它不需要任何人为的外部信息,只要给定导航的初始条件(例如初始速度、位置等),便可根据系统中的惯性敏感元件测量的比力和角速率通过计算机实时地计算出各种导航参数。由于“平台”是测量比力的基准,因此“平台”的初始对准就非常重要。对于平台惯导系统,初试对准的任务就是要将平台调整在给定的导航坐标系的方向上。若采用游动方位系统,则需要将平台调水平---称为水平对准,并将平台的方位角调至某个方位角处---称为方位对准。对于捷联惯导系统,由于捷联矩阵T 起到了平台的作用,因此导航工作一开始就需要获得捷联矩阵T 的初始值,以便完成导航的任务。显然捷联惯导系统的初始对准就是确定捷联矩阵的初始值。在静基座条件下,捷联惯导系统的加速度计的输入量为---b g ,陀螺的输入量为地球自转角速率b ie ω。因此b g 与 b ie ω就成为初始对准的基准。将陀螺与加速度计的输入引出计算机,通过计算机 就可以计算出捷联矩阵T 的初始值。 由以上的分析可以看出,陀螺与加速度计的误差会导致对准误差;对准飞行器的干扰运动也是产生对准误差的重要因素。因此滤波技术对捷联系统尤其重要。由于初始对准的误差将会对捷联惯导系统的工作造成难以消除的影响,因此研究初始对准的误差传播方程也是非常必要的。 2.2 捷联惯导系统的基本工作原理 捷联式惯性导航系统,陀螺仪和加速度计直接与载体固联,加速度计测量是载体坐标系轴向比力,只要把这个比力转换到导航坐标系上,则其它计算就与平台式惯性导航系统一样,而比力转换的关键就是要实时地进行姿态基准计算来提供数学平台,即实时更新姿态矩阵n b C ,姿态矩阵也称为捷联矩阵。一般选择地理坐标系为导航坐标系,那么捷联矩阵n b C 也可表示为t b C , 其导航原理图如图2.1所示。

相关文档
最新文档