一种基于自主量测信息的静基座动态快速精确对准方法
【专利摘要】一种基于自主量测信息的静基座动态快速精确对准方法，包括如下技术步骤设计：子惯导初始化、动态起竖子惯导、自主获取位置和速度量测信息、子惯导进行精对准；基于子惯导捷联解算结果和获取的位置量测信息与速度量测信息利用卡尔曼滤波方法估计子惯导随机误差，通过反馈校正减小航向和水平姿态误差，获取高精度的子惯导对准结果，本发明针对多级动态杆臂连接的主/子惯导系统，通过静基座起竖环境下动态杆臂补偿方法自主获取位置和速度量测信息，获得高精度动态惯导系统对准结果，从而提高子惯导系统对准的快速性和准确性。
【专利说明】
一种基于自主量测信息的静基座动态快速精确对准方法
技术领域
[0001] 本发明专利涉及一种测量校准方法的技术领域，尤其是一种基于自主量测信息的 静基座动态快速精确对准方法，该方法可以应用于静基座动态惯导系统对准，设计优化，安 全可靠，该发明可以应用于INS(Inertial Navigation System，惯性导航系统）/GPS (Global Position System,全球定位系统)等组合导航系统的数据处理与导航计算，大大 提高了导航解算的精度。
【背景技术】
[0002] 惯性导航系统是根据惯性测量单元的实时测量数据，通过捷联解算实时获取载体 位置、速度以及姿态信息的导航系统，在进入正常工作状态之前惯性导航系统必须进行初 始对准，初始对准主要是获取INS初始位置、速度及姿态等信息，这是导航系统进行高精度 导航的重要保证;对准速度和对准精度是初始对准的两大指标要求，故快速精确对准是进 行高精度导航的前提条件;在双惯导系统甚至多惯导系统中，传递对准是广泛采用的对准 方法;所谓传递对准是指当载体航行时，将已对准好的主惯导系统信息进行杆臂补偿，并作 为量测信息传递给需要对准的子惯导系统，结合子惯导系统信息，估计出子惯导的失准角 并进行反馈校正来完成初始对准，此技术适用于刚性杆臂连接的主/子惯导系统传递对准； 而在多级动态杆臂连接的主/子惯导系统机动情况下进行初始对准时，主惯导导航信息不 能通过刚性杆臂补偿为子惯导组合滤波精对准提供量测信息;这就迫切需要一种在机动过 程中不依靠外界信息的自对准方法；
【发明内容】
[0003] 本发明的目的是，提供一种基于自主量测信息的静基座动态快速精确对准方法， 克服现有技术中，在对多级动态杆臂连接的主/子惯导系统在机动情况下，无法进行精确对 准的不足，提高了惯导对准的快速性和准确性，弥补了初始对准方法的不足；
[0004] -种基于自主量测信息的静基座动态快速精确对准方法，在子惯导系统机动过程 中进行初始对准，提高了子惯导对准的快速性和准确性，利用主惯导的导航信息对子惯导 进行初始化操作;使子惯导进行横滚轴向机动起竖，在起竖过程中，一方面根据子惯导实时 数据以及一级、二级杆臂矢量信息，采用静基座起竖环境下动态杆臂补偿方法自主获取位 置和速度量测信息;通过子惯导进行捷联解算;利用卡尔曼滤波将自主获取的位置、速度量 测信息和捷联解算结果进行组合，估计子惯导的位置、速度、姿态以及惯性器件误差，将位 置、速度以及姿态误差进行反馈校正，减小航向及水平姿态误差，快速获得高精度子惯导对 准结果，从而提高子惯导系统对准的快速性和准确性；
[0005] 为了更好的说明本发明一种基于自主量测信息的静基座动态快速精确对准方法 的设计及工作原理，现介绍本发明具体包括如下技术步骤：
[0006] 1、子惯导初始化：
[0007]主惯导系统一直处于工作状态，实时的进行捷联解算，以主惯导上一时刻的位置、 速度和姿态信息作为当前捷联解算的初始值，结合当前时刻的主惯导数据，获得当前时刻 的导航结果，并通过和GNSS导航结果进行组合导航，获得高精度主惯导导航结果；
[0008] 在所述机动起竖前，根据静止状态下主惯导的位置和姿态€、主惯导和子惯导 的初始姿态偏差、一级杆臂矢量和二级杆臂矢量/<，采用姿态转移及静态杆臂补偿方法 获取子惯导初始位置#(約和初始姿态多】(〇)，由于子惯导机动起竖前保持水平静止，故速 度信息为零，从而获得子惯导系统初始信息；
[0009] 所采用的姿态转移及静态杆臂补偿方法:根据主惯导和子惯导之间的初始姿态偏 差求取姿态转移矩阵Ct.(0)，然后通过姿态转移矩阵G(0)叉乘主惯导姿态乾计算得出子惯 导的初始姿态《(的,将主惯导姿态信息转化为子惯导姿态信息，具体计算公式如下：
[0012] 式中纥为主惯导姿态，武'=|>〃纩，航向角Ψ、俯仰角Θ、横滚角γ)， 旁冰)为子惯导初始姿态，武(^={以妒
[0013] 在子惯导初始位置求取过程中，首先根据主惯导姿态奪求取姿态转移矩阵，通 过姿态转移矩阵c?叉乘一级杆臂矢量可求得一级杆臂位置矢量差然后主惯导位 置/T加上一级杆臂位置矢量差计算出旋转中心位置矢量厂。具体求解公式如下：
[0016] 式中G为主惯导位置，G=|^, % %,为主惯导坐标系下一级杆臂矢 量，<=[尤r; 为旋转中心位置矢量，\
[0017] 在获取旋转中心位置矢量的基础上根据子惯导初始姿态旁求得的姿态转移 矩阵c：(〇h通过姿态转移矩阵c：(〇).叉乘二级杆臂矢量求得二级杆臂位置矢量差 」和丨(0),最后利用旋转中心位置矢量巧加上二级杆臂位置矢量差计算求取子惯导 初始位置。具体求解公式如下：
[0020] 式中g为旋转中心位置矢量，G =:μ,,八i?af …为求得的子惯导初始位 置，Ρ;(")=['人//J，cr为子惯导坐标系到导航坐标系的姿态转移矩阵，<为子惯 导坐标系下二级杆臂矢量，及乙zj"。初始时刻固定于起竖机构上的子惯导保持 静止状态，故子惯导的初始速度为零。
[0021] 2、动态起竖子惯导：
[0022]起竖机构通过旋转轴与运载体固联，并可以沿着旋转轴进行旋转；设置子惯导坐 标系0sXsYsZs中的Ys轴与起竖机构的旋转轴重合，初始时刻固定于起竖机构上的子惯导保持 水平静止状态，水平姿态误差角< 0.01°，起竖机构沿着旋转轴以0.5° /s-1.5° /s之间的角 速率旋转，旋转角为90°，旋转角误差< 0.05°，使子惯导机动起竖至竖直状态。
[0023] 3、自主获取位置和速度量测信息：
[0024] 子惯导初始化完成后，根据子惯导捷联解算结果以及二级杆臂矢量，采用静基 座起竖环境下动态杆臂补偿方法实时自主获取子惯导的位置量测信息与速度量测信 息，具体求取方法如下：
[0025] 位置量测信息€(0的求取：首先利用子惯导捷联解算结果中实时姿态信息求取 姿态转移矩阵GW，然后姿态转移矩阵叉乘二级杆臂矢量尤求得动态二级杆臂位 置矢量差最后由旋转中心位置矢量加上动态二级杆臂位置矢量差实时 计算出子惯导位置量测信息€(0,具体求解公式如下：
[0028] 式中6(0为子惯导位置量测信息，/^(〇 = μ,;八/Λ；Γ 为旋转中心位置矢 量，G =μ,; & 为子惯导坐标系到导航坐标系的姿态转移矩阵，碎为子惯导坐 标系下二级杆臂矢量，/<;=!；I ζ
[0029] 速度量测信息的求取:首先通过子惯导捷联解算求得载体系相对于导航系 的角速率??】6(〇,然后载体系相对于导航系的角速率叉乘二级杆臂矢量求得杆臂 速度矢量差利用姿态转移矩阵C7(i)叉乘杆臂速度矢量差求得导航系下杆 臂速度矢量差，最后旋转中心的速度F CH加上杆臂速度矢量差JFgW实时计算出子 惯导速度量测信息G⑴，具体计算公式如下：
[0032]式中为子惯导速度量测信息，F/(〇 = [>S 为子惯导坐标系 下二级杆臂矢量，冗=[;写為f 为载体系相对于导航系在载体系下的角速率， G为旋转中心的速度信息，由于在静基座情况下开始动态起竖的，起竖机构旋转中心的速 度G理想值为G = [() 0 0]1,故计算公式可以变为：
[0034] 4、子惯导进行精对准:基于子惯导捷联解算结果和获取的位置量测信息朽*?与 速度量测信息匕"(0,利用卡尔曼滤波方法估计子惯导位置、速度、姿态和惯性器件误差，并 将估计出的误差进行反馈校正，减小航向和水平姿态误差，获取高精度的子惯导对准结果； [0035]为了方便技术理解，现将本发明采用的姿态转移及静态杆臂补偿方法中，应用到 的设计原理简要叙述如下：
[0036]首先，根据几何矢量坐标转换原理将主惯导姿态进行转移求取子惯导初始姿态； [0037]其次，依据平行四边形法则，通过旋转中心位置矢量加上二级杆臂位置矢量差求 取子惯导初始位置；
[0038]再次，静基座起竖环境下动态杆臂补偿方法中，根据角速率乘以半径得出切向速 度的原理自主获取子惯导速度量测信息，通过旋转中心位置矢量加上动态二级杆臂位置矢 量差获得子惯导位置量测信息；而卡尔曼滤波方法则是利用递推最小方差估计的原理，从 量测信息中消除高斯白噪声，估计出子惯导系统随机误差，进而修正航向及水平姿态角； [0039]最后，通过该发明之技术设计，最终提高了子惯导的对准精度；
[0040] 本发明的有益效果：
[0041] 1、本发明针对多级动态杆臂连接的主/子惯导系统，提出了一种基于自主量测信 息的静基座动态快速精确对准方法不同于一级刚性杆臂连接的主/子惯导系统，通过多级 杆臂连接的主/子惯导系统仅利用主惯导系统信息对子惯导进行初始化，机动起竖对准过 程中不需要主惯导系统实时向子惯导系统传递导航信息，子惯导系统在机动起竖过程中进 行自对准；
[0042] 2、本发明在机动起竖对准过程中，通过静基座起竖环境下动态杆臂补偿方法自主 获取位置和速度量测信息，利用卡尔曼滤波估计子惯导的位置、速度、姿态以及惯性器件误 差，将位置、速度以及姿态误差进行反馈校正，逐步减小航向及水平姿态误差，获得高精度 动态惯导系统对准结果，从而提高子惯导系统对准的快速性和准确性。
【附图说明】
[0043] 图1是本发明一种基于自主量测信息的静基座动态快速精确对准方法之流程示意 图
[0044] 图2是本发明一种基于自主量测信息的静基座动态快速精确对准方法之主/子惯 导安装示意图
[0045] 图3本发明一种基于自主量测信息的静基座动态快速精确对准方法之捷联解算流 程图
【具体实施方式】
[0046] 下面结合附图对本发明的优选实施例进行详细说明；
[0047] 参照图1至图3所示，一种基于自主量测信息的静基座动态快速精确对准方法，在 子惯导系统机动过程中进行初始对准，提高了子惯导对准的快速性和准确性，利用主惯导 的导航信息对子惯导进行初始化操作;使子惯导进行横滚轴向机动起竖，在起竖过程中，一 方面根据子惯导实时数据以及一级、二级杆臂矢量信息，采用静基座起竖环境下动态杆臂 补偿方法自主获取位置和速度量测信息;通过子惯导进行捷联解算;利用卡尔曼滤波将自 主获取的位置、速度量测信息和捷联解算结果进行组合，估计子惯导的位置、速度、姿态以 及惯性器件误差，将位置、速度以及姿态误差进行反馈校正，减小航向及水平姿态误差，快 速获得高精度子惯导对准结果，从而提高子惯导系统对准的快速性和准确性;具体技术包 括如下：
[0048] 1、子惯导初始化:主惯导系统一直处于工作状态，实时的进行捷联解算，以主惯导 上一时刻的位置、速度和姿态信息作为当前捷联解算的初始值，结合当前时刻的主惯导数 据，获得当前时刻的导航结果，并通过和GNSS导航结果进行组合导航，获得高精度主惯导导 航结果。在机动起竖前根据静止状态下主惯导的位置G和姿态主惯导和子惯导的初始 、 姿态偏差、一级杆臂矢量和二级杆臂矢量^^/，采用姿态转移及静态杆臂补偿方法获取 子惯导初始位置if议)和初始姿态湾(0)，由于子惯导机动起竖前保持水平静止，故速度信 息为零，从而获得子惯导系统初始信息。
[0049]所采用的姿态转移及静态杆臂补偿方法:根据主惯导和子惯导之间的初始姿态偏 差求取姿态转移矩阵0(0)，然后通过姿态转移矩阵0(的叉乘主惯导姿态€乂十算得出子 惯导的初始姿态巧:(()），将主惯导姿态信息转化为子惯导姿态信息，具体计算公式如下：
[0052] 式中C为主惯导姿态，穴'=[_' W /了（航向角Ψ、俯仰角Θ、横滚角γ)， (0)为子惯导初始姿态，二
[0053] 在子惯导初始位置求取过程中，首先根据主惯导姿态€求取姿态转移矩阵，通 过姿态转移矩阵叉乘一级杆臂矢量可求得一级杆臂位置矢量差」然后主惯导位 置#加上一级杆臂位置矢量差 ZU?；1计算出旋转中心位置矢量/?、具体求解公式如下：
[0056] 式中iT为主惯导位置，Κ=|Λ.. 4,仏況；为主惯导坐标系下一级杆臂矢 量，矽4尤Κ 为旋转中心位置矢量，ρ〇Β=ΙΛ 4沒J。
[0057] 在获取旋转中心位置矢量的基础上根据子惯导初始姿态巧Χ?))求得的姿态转移 矩阵q(o)，通过姿态转移矩阵c：(o)叉乘二级杆臂矢量求得二级杆臂位置矢量差 ,最后利用旋转中心位置矢量#加上二级杆臂位置矢量差仍计算求取子惯导 初始位置。具体求解公式如下：
[0060]式中巧为旋转中心位置矢量，〇μ" 1我,f 乂'(《)为求得的子惯导初始位 置，€(0) = μ, 2, f ,(:Γ为子惯导坐标系到导航坐标系的姿态转移矩阵，为子惯导 坐标系下二级杆臂矢量，處.? z2f。初始时刻固定于起竖机构上的子惯导保持静 止状态，故子惯导的初始速度为零。
[0061 ] 2、动态起竖子惯导;起竖机构通过旋转轴与运载体固联，并可以沿着旋转轴进行 旋转，设置子惯导坐标系OsXsYsZs中的Ys轴与起竖机构的旋转轴重合，初始时刻固定于起竖 机构上的子惯导保持水平静止状态，水平姿态误差角<〇.〇1°，起竖机构沿着旋转轴以 0.5° /s-l. 5° /s之间的角速率旋转，旋转角为90°，旋转角误差< 0.05°，使子惯导机动起竖 至竖直状态。
[0062] 3、自主获取位置和速度量测信息;子惯导初始化完成后，根据子惯导捷联解算结 果以及二级杆臂矢量，采用静基座起竖环境下动态杆臂补偿方法实时自主获取子惯导 的位置量测信息/〗"(〇与速度量测信息G⑴，具体求取方法如下：
[0063] 位置量测信息6(0的求取:首先利用子惯导捷联解算结果中实时姿态信息求取 姿态转移矩阵然后姿态转移矩阵叉乘二级杆臂矢量母求得动态二级杆臂位 置矢量差』/?)》(/)，最后由旋转中心位置矢量#加上动态二级杆臂位置矢量差:实时 计算出子惯导位置量测信息do，具体求解公式如下：
[0066]式中f⑴，为子惯导位置量测信息，Κ⑴Λ &f,#'为旋转中心位置矢 量，为子惯导坐标系到导航坐标系的姿态转移矩阵，/?为子惯导坐 标系下二级杆臂矢r2 z、y,;
[0067]速度量测信息匕《(〇的求取:首先通过子惯导捷联解算求得载体系相对于导航系 的角速率《4(?),然后载体系相对于导航系的角速率<(〇叉乘二级杆臂矢量 < 求得杆臂 速度矢量差,利用姿态转移矩阵(67(0叉乘杆臂速度矢量差⑴求得导航系下杆 臂速度矢量差最后旋转中心的速度匕"加上杆臂速度矢量差⑴实时计算出子 惯导速度量测信息.，具体计算公式如下：
[0070]式中G⑴.为子惯导速度量测信息，= % ，硿为子惯导坐标 系下二级杆臂矢量，为载体系相对于导航系在载体系下的角速率， 为旋转中心的速度信息，由于在静基座情况下开始动态起竖的，起竖机构旋转中心的速 度％理想值为G = [() β of,故计算公式可以变为：
[0072] 4、子惯导进行精对准;子惯导精对准过程包括捷联解算和卡尔曼滤波误差估计两 个部分：
[0073] (1)在捷联解算阶段，以上一时刻子惯导的位置、速度和姿态信息作为当前捷联解 算的初始值，结合当前时刻的子惯导数据，获得当前时刻的惯性导航结果。捷联解算流程如 图2所示，包括初始化、姿态矩阵更新、姿态计算、速度计算、位置矩阵更新和位置计算等步 骤，具体说明如下：
[0074] (a)姿态矩阵更新
[0075]捷联解算模块采用四元数法来更新姿态矩阵CJ，其表达式见下式：
[0077]初始四元数计算公式为：
[0079]离散化四阶计算公式为：
[0082] 式中狀。2 +Δ考.，Dqx、Dqy、Dqz为姿态速率β^b在载体系的三个分量 ;β^b. 表示载体系相对导航系的旋转角速度在b系上的投影。上式中的的计算公式为：
[0083] ~ω?
[0084] 式中为陀螺输出角速率;以表示载体系相对惯性系的旋转角速度在载体系上 的投影表示地球自转角速率ω1(3在导航坐标系中的投影，< 表示导 航坐标系相对于地球坐标系的角速率，二者的计算式分别为：
[0086]式中L为当地炜度;Η为高度;Ve、Vn、Vu为导航坐标系东向、北向和天向的三个速度 分量;R"和RN分别为沿子午圈和卯酉圈的主曲率半径；
[0087]得到四元数更新值q(n+l)后，由下式进行姿态矩阵更新：
[0089] (b)姿态计算
[0090]载体的姿态计量方式和有效范围定义如下:航向角Φ为载体坐标系y轴在导航坐标 系的投影与导航坐标系y轴的夹角，从导航坐标系y轴起算，逆时针为正，有效范围为[0°， 360° ];俯仰角q为载体坐标系y轴与其在导航坐标系的投影间的夹角，以载体抬头为正，即 向上为正，向下为负，有效范围为[-90°，90° ];横滚角γ为载体坐标系x轴与其在导航坐标 系的投影间的夹角，以载体右倾为正(从载体正前朝后看），左倾为负，有效范围为[-180°， 180° ]。在姿态矩阵更新以后，可由以下公式计算更新后的姿态角：
[0092] (c)速度计算
[0093]由下列速度方程进行速度的更新：
[0095] 式中C、$、七分别为导航坐标系下载体沿X轴、y轴、ζ轴三个方向上的速度增 量，<x、< y、分别为导航坐标系下载体相对惯性空间的加速度沿X轴、y轴、z轴三个方 向上的投影，<、^4、6心分别为导航坐标系下地球自转角速度沿X轴、y轴、z轴三个方向 上的投影，由上式求出加速度P，则叹+Π =厂⑴+丨:/(Π ;
[0096] (d)位置矩阵更新与位置计算
[0097] 由下列微分方程进行位置矩阵更新：
[0099] 式中，叫：分别为导航坐标系下导航坐标系相对于地球坐标系的转动 角速率沿X轴、y轴、z轴三个方向上的投影，采用一阶欧拉法进行位置矩阵更新，算法表达式 为：
[0100] C：(t + T) = C：{t) + TC：(t)Q：n{t)
[0101] 式中T为惯性导航系统采样周期。完成位置矩阵更新后，即可计算出导航位置参 数。记c = c=(c：)T,有：
[0103]关于高度Η的计算，由于单纯惯性导航系统的高度计算通道是发散的，要使用外界 高度信息对捷联算法的高度通道进行阻尼；
[0104] (2)采用基于自主量测信息的卡尔曼滤波方法完成子惯导系统起竖对准，通过估 计子惯导位置、速度、姿态和惯性器件误差，并将估计出的误差进行反馈校正，得到高精度 的子惯导对准结果；卡尔曼滤波模型中的状态变量X共有15维，包括东、北、天向的失准角 、办、你，东、北、天向的速度误差δν Ε、δνΝ、δνυ，炜度、经度、高度误差δ!^、δλ、δΗ，χ、7、ζ 轴向的陀螺仪常值漂移误差^、4、％，1、7、2轴向加速度计常值漂移误差1、￥^、1;卡尔 曼滤波模型中的量测量Z是惯性导航结果和自主递推导航结果的速度误差和位置误差，起 竖对准具体步骤如下：
[0105] (a)系统状态方程的建立
[0106]系统状态方程为：
[0107] X = FX+W
[0108] 式中 Z = A #u 紅拟 ~％ % Vv Vf]r，X 为15维状态变量，包括3个姿态误差、3个速度误差、3个位置误差、3个陀螺仪偏置、3个加速 度计偏置，F为状态转移矩阵;W为系统噪声，并假设其为零均值高斯白噪声;F的表达式：
[0116] 式中RM和RN分别为沿子午圈和卯酉圈的主曲率半径，Η为载体高度，L为当地炜度， ? ie3为地球自转角速度，Vx、Vy和Vz分别为X向速度、y向速度和z向速度。f x、fy和fz分别为X向 比力、y向比力和z向比力，q为载体系到当地地理系的姿态转换矩阵；
[0117] (b)量测方程的建立
[0118] 量测量Z为是惯性导航结果和自主递推导航结果的速度误差和位置误差，量测矩 阵Η为：
[0119] Η=[Ην Ηρ]τ
[0120] Hp=[03X6 diag(RM+H，（RN+H)cosL，l) 03χ6]
[0121] Hv=[03X3 diag(l，l，l) 03X9]
[0122] (c)卡尔曼滤波器设计
[0123] 利用标准卡尔曼滤波的五个公式进行滤波，可以得到估计的15个系统误差变量， 利用卡尔曼滤波估计的结果对系统状态变量进行反馈校正，得到更加准确的子惯导实时对 准结果；
[0124] 以上所述的仅为本发明的优选实施例，所应理解的是，以上实施例的说明只是用 于帮助理解本发明的方法及其核心思想，并不用于限定本发明的保护范围，凡在本发明的 思想和原则之内所做的任何修改、等同替换等等，均应包含在本发明的保护范围之内。
【主权项】
1. 一种基于自主量测信息的静基座动态快速精确对准方法，其特征在于，包括如下技 术步骤设计： ⑴子惯导初始化:根据静止状态下主惯导的位置G和姿态 <、主惯导和子惯导的初 始姿态偏差、一级杆臂矢量和二级杆臂矢量采用姿态转移及静态杆臂补偿方法获 取子惯导初始位置巧切)和初始姿态巧：(〇,并将速度置为零； (2) 动态起竖子惯导：起竖机构通过旋转轴与运载体固联，并可以沿着旋转轴进行旋 转；固定于起竖机构的子惯导采用静基座横滚轴向机动起竖方法进行快速起竖，由水平状 态旋转至竖直状态，提高组合滤波中系统状态量可观测度； (3) 自主获取位置和速度量测信息:子惯导初始化完成后，根据子惯导捷联解算结果以 及二级杆臂矢景，采用静基座起竖环境下动态杆臂补偿方法实时自主获取子惯导的位 置量测信息与速度量测信息C(0 ; (4) 子惯导进行精对准:基于子惯导捷联解算结果和获取的位置量测信息/V⑴与速度 量测信息^办），利用卡尔曼滤波方法估计子惯导随机误差，通过反馈校正减小航向和水平 姿态误差，获取高精度的子惯导对准结果。2. 根据权利要求书1所述的一种基于自主量测信息的静基座动态快速精确对准方法， 其特征在于所述步骤（1)所述的姿态转移及静态杆臂补偿方法中，根据主惯导和子惯导之 间的初始姿态偏差求取姿态转移矩阵<(0),然后通过姿态转移矩阵C〗(0)叉乘主惯导姿态 考；计算得出子惯导的初始姿态與(〇);在静态杆臂补偿方法中，首先根据主惯导姿态考；'求 取姿态转移矩阵0，利用姿态转移矩阵叉乘一级杆臂矢量求得一级杆臂位置矢量差 ，然后主惯导位置C加上一级杆臂位置矢量差计算出旋转中心位置矢量G ;在此 基础上根据子惯导初始姿态劣(0)求得的姿态转移矩阵c：(0)，通过姿态转移矩阵?'(〇)叉乘 二级杆臂矢量求得二级杆臂位置矢量差最后利用旋转中心位置矢量€加上二 级杆臂位置矢量差仍计算出子惯导初始位置p/作)，完成姿态转移和静态杆臂补偿。3. 根据权利要求书1所述的一种基于自主量测信息的静基座动态快速精确对准方法， 其特征在于所述步骤（2)所述的静基座横滚轴向机动起竖方法中，设置子惯导坐标系 OsXsYsZs中的Ys轴与起竖机构的旋转轴重合，初始时刻固定于起竖机构上的子惯导保持水平 静止状态，水平姿态误差角< 0.01°，起竖机构沿着旋转轴以0.5° /s-1.5° /s之间的角速率 旋转，旋转角为90°，旋转角误差< 0.05°，使子惯导机动起竖至竖直状态。4. 根据权利要求书1所述的一种基于自主量测信息的静基座动态快速精确对准方法， 其特征在于:步骤(3)所述的静基座起竖环境下动态杆臂补偿方法中，首先利用子惯导捷联 解算结果中实时姿态信息求取姿态转移矩阵然后姿态转移矩阵叉乘二级杆臂 矢量求得动态二级杆臂位置矢量差最后由旋转中心位置矢量.? 1加上动态二级 杆臂位置矢量差，实时计算出子惯导位置量测信息;在求取子惯导速度量测信 息过程中，通过子惯导捷联解算求得载体系相对于导航系的角速率《^(/)，然后利用载体系 相对于导航系的角速率< ⑴叉乘二级杆臂矢量求取动态二级杆臂速度矢量差 利用姿态转移矩阵c〖(〇叉乘动态二级杆臂速度矢量差ζ?κ?求得导航系下动态 二级杆臂速度矢量差最后旋转中心的速度G加上动态二级杆臂速度矢量差 ⑴实时计算出子惯导速度量测信息。
【文档编号】G01C21/18GK105865488SQ201610334839
【公开日】2016年8月17日
【申请日】2016年5月19日
【发明人】李建利, 白立建, 房建成, 刘刚, 李奕其, 卢兆兴, 党鹏飞
【申请人】北京航空航天大学