[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

CN106679612B - 一种基于惯性测量匹配的非线性挠曲变形估计方法 - Google Patents

一种基于惯性测量匹配的非线性挠曲变形估计方法 Download PDF

Info

Publication number
CN106679612B
CN106679612B CN201710074005.2A CN201710074005A CN106679612B CN 106679612 B CN106679612 B CN 106679612B CN 201710074005 A CN201710074005 A CN 201710074005A CN 106679612 B CN106679612 B CN 106679612B
Authority
CN
China
Prior art keywords
mrow
msub
theta
mtd
msubsup
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201710074005.2A
Other languages
English (en)
Other versions
CN106679612A (zh
Inventor
房建成
卢兆兴
李建利
刘刚
李奕其
曹全
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beihang University
Original Assignee
Beihang University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beihang University filed Critical Beihang University
Priority to CN201710074005.2A priority Critical patent/CN106679612B/zh
Publication of CN106679612A publication Critical patent/CN106679612A/zh
Application granted granted Critical
Publication of CN106679612B publication Critical patent/CN106679612B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
    • G01B21/32—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring the deformation in a solid

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Other Investigation Or Analysis Of Materials By Electrical Means (AREA)
  • Gyroscopes (AREA)

Abstract

本发明公开了一种基于惯性测量匹配的非线性挠曲变形估计方法。首先，建立包括安装误差角、挠曲变形、挠曲变形一阶导、挠曲变形角、挠曲变形角一阶导、加速度计常值和随机偏置以及陀螺仪常值和随机漂移的非线性系统状态方程；其次，将主、子节点的加速度计测量值之差和陀螺仪测量值之差作为量测，建立系统的非线性系统测量方程；最后，采用非线性滤波方法——中心差分卡尔曼滤波(Central Difference Kalman Filter，CDKF)估计方法，估计出每个时刻子节点处的挠曲变形和挠曲变形角。本发明具有计算精度高、易于实现的特点，提高了挠曲变形的估计精度。

Description

一种基于惯性测量匹配的非线性挠曲变形估计方法
技术领域
本发明涉及一种基于惯性测量匹配的非线性挠曲变形估计方法，可用于飞机、舰船以及车辆的挠曲变形测量及挠曲变形角测量。
背景技术
船体、机体的挠曲变形使得各个节点处的运动参数存在较大差异，如不对挠曲变形进行测量和补偿，这种差异将严重影响各个节点处运动参数的测量精度。因此要实现多个节点处运动参数的高精度测量，必须对挠曲变形进行测量和补偿。
挠曲变形的测量方法主要有两类，一类是基于光学传感器的光学测量法，另一类是基于分布式位置姿态测量系统(Position and Orientation System,POS)的测量法。光学测量法系统安装复杂，且要求光束收发无阻断，容易受天气等外部因素影响。分布式POS由一个主POS和多个惯性测量单元(Inertial Measurement Unit，IMU)(子IMU)组成，主POS的GPS天线和主IMU通过滤波的方法实现惯性/卫星组合导航，子IMU通过与主POS进行传递对准测量子节点运动参数。基于分布式POS的测量法需要建立包含主、子系统姿态误差、速度误差、位置误差、惯性器件误差、安装误差、挠曲变形等多种误差方程，并进行包含主子系统捷联解算、主系统惯性/卫星组合导航、子系统传递对准等多种复杂运算，且需要引入GPS，增加了变形测量系统的成本。
发明内容
本发明要解决的技术的问题是：针对现有技术的不足，提供了一种基于惯性测量匹配的非线性挠曲变形估计方法，在充分利用惯性测量数据的同时，既降低了测量系统成本，又减小了运算量。
本发明解决上述技术问题采用的技术方案为：一种基于惯性测量匹配的非线性挠曲变形估计方法，具体步骤如下：
步骤(1)、建立包括安装误差角、挠曲变形、挠曲变形一阶导、挠曲变形角、挠曲变形角一阶导、加速度计常值和随机偏置以及陀螺仪常值和随机漂移的非线性系统状态方程；
步骤(2)、将主、子节点的加速度计测量值之差和陀螺仪测量值之差作为量测，建立系统的非线性系统测量方程；
步骤(3)、采用非线性滤波方法——中心差分卡尔曼滤波估计方法，估计出tk时刻子节点处的挠曲变形和挠曲变形角，k＝1,2,…,N，不断重复本步骤，直至主子节点惯性测量数据结束。
本发明的原理：在船体、机体、船体等的各测量节点处安装IMU，利用挠曲变形引起的各节点处惯性测量量的差异，建立包括子节点安装误差角、挠曲变形、挠曲变形角、主子节点加速度计常值和随机偏置以及主子节点陀螺仪常值和随机漂移的非线性系统状态方程，以及包含主、子节点加速度计测量值之差和陀螺仪测量值之差的非线性量测方程，最后通过非线性滤波方法估计挠曲变形和挠曲变形角。
本发明与现有技术相比的优点在于：本发明弥补了基于分布式POS的测量法模型复杂、运算量大以及成本高的不足，利用各节点处IMU测量量即可实现挠曲变形测量，且建立的系统非线性状态方程和量测方程准确，计算精度高。
附图说明
图1为基于惯性测量匹配的非线性挠曲变形估计方法流程图；
图2为挠曲变形示意图，其中，地球惯性坐标系为Oixiyizi，主IMU坐标系为Omxmymzm，初始时刻子IMU坐标系为Os0xs0ys0zs0，主子节点之间杆臂r0，动态过程中子IMU坐标系为Osxsyszs，主子节点之间杆臂为r，对应的挠曲变形为△r，挠曲变形角为θ，Rm和Rs分别表示动态过程中Oixiyizi坐标系下主子节点的位置矢量；
图3为x轴方向的挠曲角以及y轴方向的初始杆臂引起的挠曲变形示意图，其中，θx为x轴方向挠曲角，线段OmA表示初始时刻主IMU坐标系下y轴方向的杆臂分量，杆臂经过挠曲变形后为圆弧OmA′。
具体实施方式
下面结合附图以及具体实施方式进一步说明本发明。
如说明书附图1所示，本发明的具体实施包括以下步骤：
1、建立包括安装误差角、挠曲变形、挠曲变形一阶导、挠曲变形角、挠曲变形角一阶导、加速度计常值和随机偏置以及陀螺仪常值和随机漂移的非线性系统状态方程，具体为：
(1)建立固定安装误差角数学模型
如附图1系统挠曲变形示意图中所示，相关坐标系包括：地球惯性坐标系Oixiyizi；主节点处惯性测量单元(Inertial Measurement Unit,IMU)坐标系Omxmymzm；子节点处IMU坐标系Osxsyszs。
子节点固定安装误差角在系统安装之后就已确定且为常值，其数学模型为：
其中，μ＝[μx μy μz]T为子节点相对主节点的固定安装误差角，μx、μy和μz表示子IMU坐标系Osxsyszs的x轴、y轴和z轴的安装误差角；
(2)弹性变形角数学模型
子节点处的弹性变形角θ的变化符合二阶马尔科夫过程，其微分方程为：
式中，θ＝[θx θy θz]T，θi表示子IMU坐标系Osxsyszs的i轴方向的弹性变形角，βi＝2.146/τi，τi为二阶马尔科夫过程相关时间，ηi为白噪声，其方差满足其中为弹性变形角θi的方差，βi和为描述弹性变形角的二阶马尔科夫过程参数；
(3)弹性变形数学模型
如附图1系统挠曲变形示意图中所示，相关坐标系包括：地球惯性坐标系Oixiyizi；主节点处惯性测量单元(Inertial Measurement Unit,IMU)坐标系Omxmymzm；子节点处IMU坐标系Osxsyszs。初始时刻主子节点之间杆臂在主IMU坐标系Omxmymzm表示为挠曲角为θ0＝03×1，挠曲变形动态过程中，主子节点之间杆臂为r，对应的挠曲变形为△r，挠曲变形角为θ。附图2为x轴方向的挠曲角分量θx以及y轴方向的初始杆臂值分量ry0引起的挠曲变形示意图。线段OmA表示初始时刻主IMU坐标系下y轴方向的杆臂分量，挠曲变形后为圆弧OmA′，且圆弧OmA′和线段OmA的长度均为ry0。由此线段AB即为y轴方向挠曲变形量线段OmC即为z轴方向挠曲变形量其表达式为：
同理可得θx和rz0引起y轴方向挠曲变形量和z轴方向的挠曲变形量的表达式为：
则θx引起的y轴方向的挠曲变形和z轴方向的挠曲变形表达式为：
同理可得，θy引起的x轴方向的挠曲变形和z轴方向的挠曲变形θz引起的x轴方向的挠曲变形和y轴方向的挠曲变形
最终得到挠曲变形的表达式为：
对上式进行求导即可得到表达式：
对上式再进行求导，并将挠曲角的二阶表达式带入其中即可得到挠曲变形的二阶导数的表达式：
(4)加速度计常值和随机偏置数学模型
由于主系统的惯性器件精度要高于子系统，因此在建立状态方程式不考虑主系统的加速度计误差，则子IMU加速度计常值偏置微分方程为：
式中为子节点加速度计常值偏置，分别为子IMU坐标系下的分量。
子IMU加速度计随机偏置由一阶马尔科夫过程表示：
式中，为一阶马尔科夫过程参数，γsi为白噪声。
(5)陀螺仪常值和随机漂移数学模型
子IMU陀螺仪常值漂移微分方程为：
式中εs＝[εsx εsy εsz]T为子节点陀螺仪常值漂移，εsx，εsy，εmz分别为子IMU坐标系下的分量。
子IMU陀螺仪随机漂移由一阶马尔科夫过程表示：
式中，κsi为一阶马尔科夫过程参数，λsi为白噪声。
(6)非线性系统状态方程建立
系统的状态量为X＝[X1 X2 X3 X4]T，其中包括9维安装误差角和挠曲变形角6维挠曲变形量6维子系统加速度计误差变量以及6维子系统陀螺仪误差变量X4＝[εsx εsy εsz ε′sx ε′sy ε′sz]T。
系统状态方程的表达形式如下：
式中，X(t)＝[X1(t) X2(t) X3(t) X4(t)]T为系统状态量；为系统噪声，非线性函数F[X(t),t]的表达式可根据(1)-(5)得到。G表达式如下：
2、将主、子节点的加速度计测量值之差和陀螺仪测量值之差作为量测，建立系统的非线性系统测量方程，具体过程如下：
(1)陀螺仪输出匹配量测方程
主IMU陀螺仪输出值和子IMU陀螺仪输出值之间的非线性关系可以表示为：
式中，分别为主子IMU的陀螺漂移，包括常值漂移和随机漂移两部分。为挠曲角变化率，为主IMU与子IMU之间的坐标转换矩阵，其表达式可以表示为：
由此得到陀螺仪输出匹配的非线性量测方程：
(2)加速度计输出匹配量测方程
挠曲杆臂产生的加速度表达式为：
式中，为主系统陀螺仪输出角速度，rm、和分别为主IMU坐标系下挠曲杆臂及其一阶导数和二阶导数，表达式已经在步骤2中给出。
主IMU加速度计输出值和子IMU加速度计输出值之间的非线性关系可以表示为：
由此得到加速度计输出匹配的非线性量测方程：
(3)非线性系统量测方程建立
系统的量测量为Z＝[ZΩ Zf]T，其中包括3维主、子节点陀螺仪输出匹配量ZΩ和3维主、子节点加速度计输出匹配量Zf。
系统量测方程的表达形式如下：
Z(t)＝H(X,t)+v(t)
式中为量测噪声，其中为加速度计量测噪声，为陀螺仪量测噪声，非线性函数H(X,t)的表达式可根据(1)-(2)得到。

Claims (2)

1.一种基于惯性测量匹配的非线性挠曲变形估计方法，其特征在于，包括以下步骤：
步骤(1)、建立包括安装误差角、挠曲变形、挠曲变形一阶导、挠曲变形角、挠曲变形角一阶导、加速度计常值和随机偏置以及陀螺仪常值和随机漂移的非线性系统状态方程；
步骤(2)、将主、子节点的加速度计测量值之差和陀螺仪测量值之差作为量测，建立系统的非线性系统测量方程；
步骤(3)、采用非线性滤波方法——中心差分卡尔曼滤波估计方法，估计出tk时刻子节点处的挠曲变形和挠曲变形角，k＝1,2,…,N，不断重复本步骤，直至主子节点惯性测量数据结束；
步骤(1)中非线性系统状态方程包括安装误差角、挠曲变形、挠曲变形一阶导、挠曲变形角、挠曲变形角一阶导、加速度计常值和随机偏置以及陀螺仪常值和随机漂移的数学模型，具体为：
(11)建立固定安装误差角数学模型
相关坐标系包括：地球惯性坐标系Oixiyizi；主节点处惯性测量单元(InertialMeasurement Unit,IMU)坐标系Omxmymzm；子节点处IMU坐标系Osxsyszs；
子节点固定安装误差角在系统安装之后就已确定且为常值，其数学模型为：
<mrow> <mover> <mi>&amp;mu;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mn>0</mn> </mrow>
其中，μ＝[μx μy μz]T为子节点相对主节点的固定安装误差角，μx、μy和μz表示子IMU坐标系Osxsyszs的x轴、y轴和z轴的安装误差角；
(12)弹性变形角数学模型
子节点处的弹性变形角θ的变化符合二阶马尔科夫过程，其微分方程为：
<mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>i</mi> </msub> <mo>+</mo> <mn>2</mn> <msub> <mi>&amp;beta;</mi> <mi>i</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>i</mi> </msub> <mo>+</mo> <msubsup> <mi>&amp;beta;</mi> <mi>i</mi> <mn>2</mn> </msubsup> <msub> <mi>&amp;theta;</mi> <mi>i</mi> </msub> <mo>=</mo> <msub> <mi>&amp;eta;</mi> <mi>i</mi> </msub> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mi>x</mi> <mo>,</mo> <mi>y</mi> <mo>,</mo> <mi>z</mi> </mrow>
式中，θ＝[θx θy θz]T，θi表示子IMU坐标系Osxsyszs的i轴方向的弹性变形角，βi＝2.146/τi，τi为二阶马尔科夫过程相关时间，ηi为白噪声，其方差满足其中为弹性变形角θi的方差，βi和为描述弹性变形角的二阶马尔科夫过程参数；
(13)弹性变形数学模型
初始时刻主子节点之间杆臂在主IMU坐标系Omxmymzm表示为挠曲角为θ0＝03×1，挠曲变形动态过程中，主子节点之间杆臂为r，对应的挠曲变形为Δr，挠曲变形角为θ；主IMU坐标系下x轴方向的挠曲角分量为θx，y轴方向的初始杆臂值分量为ry0，线段OmA表示初始时刻主IMU坐标系下y轴方向的杆臂分量，挠曲变形后为圆弧OmA′，且圆弧OmA′和线段OmA的长度均为ry0，因此线段AB即为y轴方向挠曲变形量线段OmC即为z轴方向挠曲变形量其表达式为：
<mrow> <msubsup> <mi>&amp;Delta;r</mi> <mi>y</mi> <mi>m</mi> </msubsup> <mrow> <mo>(</mo> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <mo>,</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> </mfrac> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> </mrow>
<mrow> <msubsup> <mi>&amp;Delta;r</mi> <mi>z</mi> <mi>m</mi> </msubsup> <mrow> <mo>(</mo> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <mo>,</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <mn>1</mn> <mo>-</mo> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> </mrow>
同理可得θx和z轴方向的初始杆臂值分量rz0引起y轴方向挠曲变形量和z轴方向的挠曲变形量的表达式为：
<mrow> <msubsup> <mi>&amp;Delta;r</mi> <mi>y</mi> <mi>m</mi> </msubsup> <mrow> <mo>(</mo> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <mo>,</mo> <msub> <mi>r</mi> <mrow> <mi>z</mi> <mn>0</mn> </mrow> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <mn>1</mn> <mo>-</mo> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>z</mi> <mn>0</mn> </mrow> </msub> </mrow>
<mrow> <msubsup> <mi>&amp;Delta;r</mi> <mi>z</mi> <mi>m</mi> </msubsup> <mrow> <mo>(</mo> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <mo>,</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> </mfrac> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>z</mi> <mn>0</mn> </mrow> </msub> </mrow>
则θx引起的y轴方向的挠曲变形和z轴方向的挠曲变形表达式为：
<mrow> <msubsup> <mi>&amp;Delta;r</mi> <mi>y</mi> <mi>m</mi> </msubsup> <mrow> <mo>(</mo> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <msubsup> <mi>&amp;Delta;r</mi> <mi>y</mi> <mi>m</mi> </msubsup> <mrow> <mo>(</mo> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <mo>,</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mi>&amp;Delta;r</mi> <mi>y</mi> <mi>m</mi> </msubsup> <mrow> <mo>(</mo> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <mo>,</mo> <msub> <mi>r</mi> <mrow> <mi>z</mi> <mn>0</mn> </mrow> </msub> <mo>)</mo> </mrow> </mrow>
<mrow> <msubsup> <mi>&amp;Delta;r</mi> <mi>z</mi> <mi>m</mi> </msubsup> <mrow> <mo>(</mo> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <msubsup> <mi>&amp;Delta;r</mi> <mi>z</mi> <mi>m</mi> </msubsup> <mrow> <mo>(</mo> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <mo>,</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mi>&amp;Delta;r</mi> <mi>z</mi> <mi>m</mi> </msubsup> <mrow> <mo>(</mo> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <mo>,</mo> <msub> <mi>r</mi> <mrow> <mi>z</mi> <mn>0</mn> </mrow> </msub> <mo>)</mo> </mrow> </mrow>
同理可得，y轴方向的挠曲角分量θy引起的x轴方向的挠曲变形和z轴方向的挠曲变形z轴方向的挠曲角分量为θz引起的x轴方向的挠曲变形和y轴方向的挠曲变形
最终得到挠曲变形的表达式为：
<mrow> <msubsup> <mi>&amp;Delta;r</mi> <mi>x</mi> <mi>m</mi> </msubsup> <mo>=</mo> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> </mfrac> <mo>-</mo> <mn>2</mn> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>x</mi> <mn>0</mn> </mrow> </msub> <mo>+</mo> <mfrac> <mrow> <mn>1</mn> <mo>-</mo> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>z</mi> <mn>0</mn> </mrow> </msub> <mo>-</mo> <mfrac> <mrow> <mn>1</mn> <mo>-</mo> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> </mrow>
<mrow> <msubsup> <mi>&amp;Delta;r</mi> <mi>y</mi> <mi>m</mi> </msubsup> <mo>=</mo> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> </mfrac> <mo>-</mo> <mn>2</mn> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> <mo>+</mo> <mfrac> <mrow> <mn>1</mn> <mo>-</mo> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>x</mi> <mn>0</mn> </mrow> </msub> <mo>-</mo> <mfrac> <mrow> <mn>1</mn> <mo>-</mo> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>z</mi> <mn>0</mn> </mrow> </msub> </mrow>
<mrow> <msubsup> <mi>&amp;Delta;r</mi> <mi>z</mi> <mi>m</mi> </msubsup> <mo>=</mo> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> </mfrac> <mo>-</mo> <mn>2</mn> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>z</mi> <mn>0</mn> </mrow> </msub> <mo>+</mo> <mfrac> <mrow> <mn>1</mn> <mo>-</mo> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> <mo>-</mo> <mfrac> <mrow> <mn>1</mn> <mo>-</mo> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> </mrow> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>x</mi> <mn>0</mn> </mrow> </msub> </mrow>
对上式进行求导即可得到表达式：
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>&amp;Delta;</mi> <msubsup> <mover> <mi>r</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>x</mi> <mi>m</mi> </msubsup> <mo>=</mo> <mrow> <mo>(</mo> <mrow> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>y</mi> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> </mfrac> </mrow> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>x</mi> <mn>0</mn> </mrow> </msub> <mo>+</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>y</mi> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> <mo>+</mo> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> <mo>-</mo> <mn>1</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>z</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> <mo>+</mo> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> <mo>-</mo> <mn>1</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced>
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>&amp;Delta;</mi> <msubsup> <mover> <mi>r</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>y</mi> <mi>m</mi> </msubsup> <mo>=</mo> <mrow> <mo>(</mo> <mrow> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>x</mi> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> </mfrac> </mrow> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> <mo>+</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> <mo>+</mo> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> <mo>-</mo> <mn>1</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>x</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>x</mi> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> <mo>+</mo> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> <mo>-</mo> <mn>1</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>z</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced>
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>&amp;Delta;</mi> <msubsup> <mover> <mi>r</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>z</mi> <mi>m</mi> </msubsup> <mo>=</mo> <mrow> <mo>(</mo> <mrow> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>x</mi> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>y</mi> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> </mfrac> </mrow> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>z</mi> <mn>0</mn> </mrow> </msub> <mo>+</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>x</mi> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> <mo>+</mo> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> <mo>-</mo> <mn>1</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>y</mi> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> <mo>+</mo> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> <mo>-</mo> <mn>1</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>x</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced>
对上式再进行求导，并将挠曲角的二阶表达式带入其中即可得到挠曲变形的二阶导数的表达式：
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>&amp;Delta;</mi> <msubsup> <mover> <mi>r</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>x</mi> <mi>m</mi> </msubsup> <mo>=</mo> <mo>(</mo> <mfrac> <mrow> <mrow> <mo>(</mo> <mrow> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;beta;</mi> <mi>y</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>y</mi> </msub> <mo>-</mo> <msubsup> <mi>&amp;beta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> </mfrac> <mo>-</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>y</mi> </msub> <mrow> <mo>(</mo> <mrow> <mn>2</mn> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> <mo>+</mo> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>3</mn> </msubsup> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <mfrac> <mrow> <mrow> <mo>(</mo> <mrow> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;beta;</mi> <mi>z</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>z</mi> </msub> <mo>-</mo> <msubsup> <mi>&amp;beta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> </mfrac> <mo>-</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mrow> <mn>2</mn> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> <mo>+</mo> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>3</mn> </msubsup> </mfrac> <mo>)</mo> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>x</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <mfrac> <mrow> <mrow> <mo>(</mo> <mrow> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;beta;</mi> <mi>y</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>y</mi> </msub> <mo>-</mo> <msubsup> <mi>&amp;beta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> <mo>+</mo> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> <mo>-</mo> <mn>1</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>y</mi> </msub> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> <mo>+</mo> <mn>2</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>3</mn> </msubsup> </mfrac> </mrow> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>z</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <mfrac> <mrow> <mrow> <mo>(</mo> <mrow> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;beta;</mi> <mi>z</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>z</mi> </msub> <mo>-</mo> <msubsup> <mi>&amp;beta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> <mo>+</mo> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> <mo>-</mo> <mn>1</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> <mo>+</mo> <mn>2</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>3</mn> </msubsup> </mfrac> </mrow> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced>
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>&amp;Delta;</mi> <msubsup> <mover> <mi>r</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>y</mi> <mi>m</mi> </msubsup> <mo>=</mo> <mo>(</mo> <mfrac> <mrow> <mrow> <mo>(</mo> <mrow> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;beta;</mi> <mi>x</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>x</mi> </msub> <mo>-</mo> <msubsup> <mi>&amp;beta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> </mfrac> <mo>-</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>x</mi> </msub> <mrow> <mo>(</mo> <mrow> <mn>2</mn> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> <mo>+</mo> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>3</mn> </msubsup> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <mfrac> <mrow> <mrow> <mo>(</mo> <mrow> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;beta;</mi> <mi>z</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>z</mi> </msub> <mo>-</mo> <msubsup> <mi>&amp;beta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> </mfrac> <mo>-</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mrow> <mn>2</mn> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> <mo>+</mo> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>3</mn> </msubsup> </mfrac> <mo>)</mo> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <mfrac> <mrow> <mrow> <mo>(</mo> <mrow> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;beta;</mi> <mi>z</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>z</mi> </msub> <mo>-</mo> <msubsup> <mi>&amp;beta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> <mo>+</mo> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> <mo>-</mo> <mn>1</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>2</mn> </msubsup> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> <mo>+</mo> <mn>2</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>z</mi> <mn>3</mn> </msubsup> </mfrac> </mrow> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>x</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <mfrac> <mrow> <mrow> <mo>(</mo> <mrow> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;beta;</mi> <mi>x</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>x</mi> </msub> <mo>-</mo> <msubsup> <mi>&amp;beta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> <mo>+</mo> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> <mo>-</mo> <mn>1</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>x</mi> </msub> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> <mo>+</mo> <mn>2</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>3</mn> </msubsup> </mfrac> </mrow> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>z</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced>
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>&amp;Delta;</mi> <msubsup> <mover> <mi>r</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>z</mi> <mi>m</mi> </msubsup> <mo>=</mo> <mo>(</mo> <mfrac> <mrow> <mrow> <mo>(</mo> <mrow> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;beta;</mi> <mi>x</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>x</mi> </msub> <mo>-</mo> <msubsup> <mi>&amp;beta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> </mfrac> <mo>-</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>x</mi> </msub> <mrow> <mo>(</mo> <mrow> <mn>2</mn> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> <mo>+</mo> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>3</mn> </msubsup> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <mfrac> <mrow> <mrow> <mo>(</mo> <mrow> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;beta;</mi> <mi>y</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>y</mi> </msub> <mo>-</mo> <msubsup> <mi>&amp;beta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> </mfrac> <mo>-</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>y</mi> </msub> <mrow> <mo>(</mo> <mrow> <mn>2</mn> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> <mo>+</mo> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>3</mn> </msubsup> </mfrac> <mo>)</mo> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>z</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <mfrac> <mrow> <mrow> <mo>(</mo> <mrow> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;beta;</mi> <mi>x</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>x</mi> </msub> <mo>-</mo> <msubsup> <mi>&amp;beta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> <mo>+</mo> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> <mo>-</mo> <mn>1</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>x</mi> </msub> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>2</mn> </msubsup> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> <mo>+</mo> <mn>2</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>x</mi> <mn>3</mn> </msubsup> </mfrac> </mrow> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>y</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <mrow> <mfrac> <mrow> <mrow> <mo>(</mo> <mrow> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;beta;</mi> <mi>y</mi> </msub> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>y</mi> </msub> <mo>-</mo> <msubsup> <mi>&amp;beta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> </mrow> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mrow> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> <mo>+</mo> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> <mo>-</mo> <mn>1</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> </mfrac> <mo>+</mo> <mfrac> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>y</mi> </msub> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>2</mn> </msubsup> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> <mo>-</mo> <mn>2</mn> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> <mo>+</mo> <mn>2</mn> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;theta;</mi> <mi>y</mi> <mn>3</mn> </msubsup> </mfrac> </mrow> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <msub> <mi>r</mi> <mrow> <mi>x</mi> <mn>0</mn> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced>
(14)加速度计常值和随机偏置数学模型
由于主系统的惯性器件精度要高于子系统，因此在建立状态方程式不考虑主系统的加速度计误差，则子IMU加速度计常值偏置微分方程为：
<mrow> <msub> <mover> <mo>&amp;dtri;</mo> <mo>&amp;CenterDot;</mo> </mover> <mi>s</mi> </msub> <mo>=</mo> <mn>0</mn> </mrow>
式中为子节点加速度计常值偏置，分别为子IMU坐标系下的分量；
子IMU加速度计随机偏置由一阶马尔科夫过程表示：
式中，为一阶马尔科夫过程参数，γsi为白噪声；
(15)陀螺仪常值和随机漂移数学模型
子IMU陀螺仪常值漂移微分方程为：
<mrow> <msub> <mover> <mi>&amp;epsiv;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>s</mi> </msub> <mo>=</mo> <mn>0</mn> </mrow>
式中εs＝[εsx εsy εsz]T为子节点陀螺仪常值漂移，εsx，εsy，εmz分别为子IMU坐标系下的分量；
子IMU陀螺仪随机漂移由一阶马尔科夫过程表示：
<mrow> <msubsup> <mover> <mi>&amp;epsiv;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>s</mi> <mi>i</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> <mo>+</mo> <msub> <mi>&amp;kappa;</mi> <mrow> <mi>s</mi> <mi>i</mi> </mrow> </msub> <msubsup> <mi>&amp;epsiv;</mi> <mrow> <mi>s</mi> <mi>i</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <msub> <mi>&amp;lambda;</mi> <mrow> <mi>s</mi> <mi>i</mi> </mrow> </msub> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mi>x</mi> <mo>,</mo> <mi>y</mi> <mo>,</mo> <mi>z</mi> </mrow>
式中，κsi为一阶马尔科夫过程参数，λsi为白噪声；
(16)非线性系统状态方程建立
系统的状态量为X＝[X1 X2 X3 X4]T，其中包括9维安装误差角和挠曲变形角6维挠曲变形量6维子系统加速度计误差变量以及6维子系统陀螺仪误差变量X4＝[εsx εsy εsz ε′sx ε′sy ε′sz]T；
系统状态方程的表达形式如下：
<mrow> <mover> <mi>X</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>F</mi> <mo>&amp;lsqb;</mo> <mi>X</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <mi>t</mi> <mo>&amp;rsqb;</mo> <mo>+</mo> <mi>G</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mi>w</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow>
式中，X(t)＝[X1(t) X2(t) X3(t) X4(t)]T为系统状态量；w(t)＝[hx hy hz Vsx Vsy Vszksx ksy ksz]T为系统噪声，非线性函数F[X(t),t]的表达式可根据(11)-(15)得到，G表达式如下：
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>G</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>I</mi> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>D</mi> <mn>1</mn> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>3</mn> <mo>&amp;times;</mo> <mn>3</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>D</mi> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> <mtd> <mrow> <msub> <mi>D</mi> <mn>1</mn> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>&amp;gamma;</mi> <mrow> <mi>s</mi> <mi>x</mi> </mrow> </msub> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>&amp;gamma;</mi> <mrow> <mi>s</mi> <mi>y</mi> </mrow> </msub> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>&amp;gamma;</mi> <mrow> <mi>s</mi> <mi>z</mi> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>D</mi> <mn>2</mn> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>&amp;lambda;</mi> <mrow> <mi>s</mi> <mi>x</mi> </mrow> </msub> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>&amp;lambda;</mi> <mrow> <mi>s</mi> <mi>y</mi> </mrow> </msub> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>&amp;lambda;</mi> <mrow> <mi>s</mi> <mi>z</mi> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>.</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>
2.根据权利要求1所述的一种基于惯性测量匹配的非线性挠曲变形估计方法，其特征在于步骤(2)中的非线性系统量测方程将主、子节点的加速度计测量值之差和陀螺仪测量值之差均作为量测，具体建立步骤为：
(21)陀螺仪输出匹配量测方程
主IMU陀螺仪输出值和子IMU陀螺仪输出值之间的非线性关系可以表示为：
<mrow> <msup> <mi>&amp;Omega;</mi> <msub> <mi>b</mi> <mi>s</mi> </msub> </msup> <mo>-</mo> <msub> <mi>&amp;epsiv;</mi> <mi>s</mi> </msub> <mo>-</mo> <msubsup> <mi>&amp;epsiv;</mi> <mi>s</mi> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <msubsup> <mi>C</mi> <mi>m</mi> <mi>s</mi> </msubsup> <mrow> <mo>(</mo> <msup> <mi>&amp;Omega;</mi> <msub> <mi>b</mi> <mi>m</mi> </msub> </msup> <mo>+</mo> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>)</mo> </mrow> </mrow>
式中，分别为主子IMU的陀螺漂移，包括常值漂移和随机漂移两部分，为挠曲角变化率，为主IMU与子IMU之间的坐标转换矩阵，其表达式可以表示为：
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msubsup> <mi>C</mi> <mi>m</mi> <mi>s</mi> </msubsup> <mo>=</mo> <mi>C</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;theta;</mi> <mi>x</mi> </msub> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <mi>C</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;theta;</mi> <mi>y</mi> </msub> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <mi>C</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;theta;</mi> <mi>z</mi> </msub> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <mi>C</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;mu;</mi> <mi>x</mi> </msub> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <mi>C</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;mu;</mi> <mi>y</mi> </msub> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <mi>C</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;mu;</mi> <mi>z</mi> </msub> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>x</mi> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>cos&amp;theta;</mi> <mi>x</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>&amp;CenterDot;</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>sin&amp;theta;</mi> <mi>y</mi> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msub> <mi>cos&amp;theta;</mi> <mi>y</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>&amp;CenterDot;</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <msub> <mi>sin&amp;theta;</mi> <mi>z</mi> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>cos&amp;theta;</mi> <mi>z</mi> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>&amp;CenterDot;</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msub> <mi>cos&amp;mu;</mi> <mi>x</mi> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>sin&amp;mu;</mi> <mi>x</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>sin&amp;mu;</mi> <mi>x</mi> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>cos&amp;mu;</mi> <mi>x</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>&amp;CenterDot;</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msub> <mi>cos&amp;mu;</mi> <mi>y</mi> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>sin&amp;mu;</mi> <mi>y</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>sin&amp;mu;</mi> <mi>y</mi> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msub> <mi>cos&amp;mu;</mi> <mi>y</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>&amp;CenterDot;</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msub> <mi>cos&amp;mu;</mi> <mi>z</mi> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>sin&amp;mu;</mi> <mi>z</mi> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <msub> <mi>sin&amp;mu;</mi> <mi>z</mi> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>cos&amp;mu;</mi> <mi>z</mi> </msub> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> </mtable> </mfenced>
由此得到陀螺仪输出匹配的非线性量测方程：
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>Z</mi> <mi>&amp;Omega;</mi> </msub> <mo>=</mo> <msub> <mi>&amp;Omega;</mi> <msub> <mi>b</mi> <mi>s</mi> </msub> </msub> <mo>-</mo> <msub> <mi>&amp;Omega;</mi> <msub> <mi>b</mi> <mi>m</mi> </msub> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>C</mi> <mi>m</mi> <mi>s</mi> </msubsup> <mo>-</mo> <msub> <mi>I</mi> <mn>3</mn> </msub> </mrow> <mo>)</mo> </mrow> <msub> <mi>&amp;Omega;</mi> <msub> <mi>b</mi> <mi>m</mi> </msub> </msub> <mo>+</mo> <msubsup> <mi>C</mi> <mi>m</mi> <mi>s</mi> </msubsup> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <msub> <mi>&amp;epsiv;</mi> <mi>s</mi> </msub> <mo>+</mo> <msubsup> <mi>&amp;epsiv;</mi> <mi>s</mi> <mo>&amp;prime;</mo> </msubsup> </mrow> </mtd> </mtr> </mtable> </mfenced>
(22)加速度计输出匹配量测方程
挠曲杆臂产生的加速度表达式为：
<mrow> <msubsup> <mi>a</mi> <mi>r</mi> <mi>m</mi> </msubsup> <mo>=</mo> <msup> <mover> <mi>r</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>m</mi> </msup> <mo>+</mo> <mn>2</mn> <mrow> <mo>(</mo> <msubsup> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>m</mi> </mrow> <mi>m</mi> </msubsup> <mo>&amp;times;</mo> <msup> <mover> <mi>r</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>m</mi> </msup> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mover> <mi>&amp;omega;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>i</mi> <mi>m</mi> </mrow> <mi>m</mi> </msubsup> <mo>&amp;times;</mo> <msup> <mi>r</mi> <mi>m</mi> </msup> <mo>+</mo> <msubsup> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>m</mi> </mrow> <mi>m</mi> </msubsup> <mo>&amp;times;</mo> <mrow> <mo>(</mo> <msubsup> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>m</mi> </mrow> <mi>m</mi> </msubsup> <mo>&amp;times;</mo> <msup> <mi>r</mi> <mi>m</mi> </msup> <mo>)</mo> </mrow> </mrow>
式中，为主系统陀螺仪输出角速度，rm、和分别为主IMU坐标系下挠曲杆臂及其一阶导数和二阶导数；
主IMU加速度计输出值和子IMU加速度计输出值之间的非线性关系可以表示为：
<mrow> <msup> <mi>f</mi> <msub> <mi>b</mi> <mi>s</mi> </msub> </msup> <mo>-</mo> <msub> <mo>&amp;dtri;</mo> <mi>s</mi> </msub> <mo>-</mo> <msubsup> <mo>&amp;dtri;</mo> <mi>s</mi> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <msubsup> <mi>C</mi> <mi>m</mi> <mi>s</mi> </msubsup> <mrow> <mo>(</mo> <msup> <mi>f</mi> <msub> <mi>b</mi> <mi>m</mi> </msub> </msup> <mo>+</mo> <msubsup> <mi>a</mi> <mi>r</mi> <mi>m</mi> </msubsup> <mo>)</mo> </mrow> </mrow>
由此得到加速度计输出匹配的非线性量测方程：
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>Z</mi> <mi>f</mi> </msub> <mo>=</mo> <msup> <mi>f</mi> <msub> <mi>b</mi> <mi>s</mi> </msub> </msup> <mo>-</mo> <msup> <mi>f</mi> <msub> <mi>b</mi> <mi>m</mi> </msub> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>C</mi> <mi>m</mi> <mi>s</mi> </msubsup> <mo>-</mo> <msub> <mi>I</mi> <mn>3</mn> </msub> </mrow> <mo>)</mo> </mrow> <msup> <mi>f</mi> <msub> <mi>b</mi> <mi>m</mi> </msub> </msup> <mo>+</mo> <msub> <mo>&amp;dtri;</mo> <mi>s</mi> </msub> <mo>+</mo> <msubsup> <mo>&amp;dtri;</mo> <mi>s</mi> <mo>&amp;prime;</mo> </msubsup> <mo>+</mo> <msubsup> <mi>C</mi> <mi>m</mi> <mi>s</mi> </msubsup> <mrow> <mo>&amp;lsqb;</mo> <mrow> <msup> <mover> <mi>r</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mi>m</mi> </msup> <mo>+</mo> <mn>2</mn> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>m</mi> </mrow> <mi>m</mi> </msubsup> <mo>&amp;times;</mo> <msup> <mover> <mi>r</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>m</mi> </msup> </mrow> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mover> <mi>&amp;omega;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>i</mi> <mi>m</mi> </mrow> <mi>m</mi> </msubsup> <mo>&amp;times;</mo> <msup> <mi>r</mi> <mi>m</mi> </msup> <mo>+</mo> <msubsup> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>m</mi> </mrow> <mi>m</mi> </msubsup> <mo>&amp;times;</mo> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>m</mi> </mrow> <mi>m</mi> </msubsup> <mo>&amp;times;</mo> <msup> <mi>r</mi> <mi>m</mi> </msup> </mrow> <mo>)</mo> </mrow> </mrow> <mo>&amp;rsqb;</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced>
(3)非线性系统量测方程建立
系统的量测量为Z＝[ZΩ Zf]T，其中包括3维主、子节点陀螺仪输出匹配量ZΩ和3维主、子节点加速度计输出匹配量Zf；
系统量测方程的表达形式如下：
Z(t)＝H(X,t)+v(t)
式中为量测噪声，其中为加速度计量测噪声，为陀螺仪量测噪声，非线性函数H(X,t)的表达式可根据(21)-(22)得到。
CN201710074005.2A 2017-02-10 2017-02-10 一种基于惯性测量匹配的非线性挠曲变形估计方法 Active CN106679612B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710074005.2A CN106679612B (zh) 2017-02-10 2017-02-10 一种基于惯性测量匹配的非线性挠曲变形估计方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710074005.2A CN106679612B (zh) 2017-02-10 2017-02-10 一种基于惯性测量匹配的非线性挠曲变形估计方法

Publications (2)

Publication Number Publication Date
CN106679612A CN106679612A (zh) 2017-05-17
CN106679612B true CN106679612B (zh) 2017-12-22

Family

ID=58860848

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710074005.2A Active CN106679612B (zh) 2017-02-10 2017-02-10 一种基于惯性测量匹配的非线性挠曲变形估计方法

Country Status (1)

Country Link
CN (1) CN106679612B (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107765244B (zh) * 2017-09-18 2020-10-27 北京航空航天大学 基于机载双天线InSAR基线测量方法和装置
CN110736459B (zh) * 2019-10-25 2021-08-17 中国人民解放军国防科技大学 惯性量匹配对准的角形变测量误差评估方法
CN112649022B (zh) * 2021-01-08 2022-05-27 哈尔滨工业大学 一种考虑挠曲变形和杆臂效应的大失准角传递对准方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103335650A (zh) * 2013-05-29 2013-10-02 哈尔滨工程大学 一种基于惯性测量单元的坐标失配测量方法
CN104165640A (zh) * 2014-08-11 2014-11-26 东南大学 基于星敏感器的近空间弹载捷联惯导系统传递对准方法
CN104655132A (zh) * 2015-02-11 2015-05-27 北京航空航天大学 一种基于加速度计的机体弹性变形角估计方法
CN105300382A (zh) * 2015-10-30 2016-02-03 哈尔滨工程大学 一种基于惯性测量单元的大角度船体变形测量方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5337656B2 (ja) * 2009-10-01 2013-11-06 株式会社トプコン 測定方法及び測定装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103335650A (zh) * 2013-05-29 2013-10-02 哈尔滨工程大学 一种基于惯性测量单元的坐标失配测量方法
CN104165640A (zh) * 2014-08-11 2014-11-26 东南大学 基于星敏感器的近空间弹载捷联惯导系统传递对准方法
CN104655132A (zh) * 2015-02-11 2015-05-27 北京航空航天大学 一种基于加速度计的机体弹性变形角估计方法
CN105300382A (zh) * 2015-10-30 2016-02-03 哈尔滨工程大学 一种基于惯性测量单元的大角度船体变形测量方法

Also Published As

Publication number Publication date
CN106679612A (zh) 2017-05-17

Similar Documents

Publication Publication Date Title
CN111678538B (zh) 一种基于速度匹配的动态水平仪误差补偿方法
CN106289246B (zh) 一种基于位置和姿态测量系统的柔性杆臂测量方法
CN101706281B (zh) 惯性/天文/卫星高精度组合导航系统及其导航方法
CN102486377B (zh) 一种光纤陀螺捷联惯导系统初始航向的姿态获取方法
CN102980577B (zh) 一种微型捷联航姿系统及其工作方法
CN112595350B (zh) 一种惯导系统自动标定方法及终端
CN102621565B (zh) 一种机载分布式pos的传递对准方法
CN101706284B (zh) 提高船用光纤陀螺捷联惯导系统定位精度的方法
CN101881619B (zh) 基于姿态测量的船用捷联惯导与天文定位方法
EP2557394A1 (en) Method and system for processing pulse signals within an interital navigation system
CN108387227B (zh) 机载分布式pos的多节点信息融合方法及系统
CN103076025B (zh) 一种基于双解算程序的光纤陀螺常值误差标定方法
CN101571394A (zh) 基于旋转机构的光纤捷联惯性导航系统初始姿态确定方法
CN202974288U (zh) 一种微型捷联航姿系统
CN107764261B (zh) 一种分布式pos传递对准用模拟数据生成方法和系统
CN105157724B (zh) 一种基于速度加姿态匹配的传递对准时间延迟估计与补偿方法
CN102116628A (zh) 一种着陆或附着深空天体探测器的高精度导航方法
CN104215244B (zh) 基于发射惯性坐标系的空天飞行器组合导航鲁棒滤波方法
CN106679612B (zh) 一种基于惯性测量匹配的非线性挠曲变形估计方法
CN109489661B (zh) 一种卫星初始入轨时陀螺组合常值漂移估计方法
CN111812737B (zh) 水下导航与重力测量一体化系统
CN113029197B (zh) 一种针对柔性杆臂的传递对准方法
CN107764268B (zh) 一种机载分布式pos传递对准的方法和装置
CN108387246B (zh) 多节点分布式时空基准方法和装置
CN107655494A (zh) 一种摇摆基座条件下惯导系统粗对准方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant