• 四川郎酒股份有限公司获第十二届人民企业社会责任奖年度环保奖 2019-05-13
  • 银保监会新规剑指大企业多头融资和过度融资 2019-05-12
  • 韩国再提4国联合申办世界杯 中国网友无视:我们自己来 2019-05-11
  • 中国人为什么一定要买房? 2019-05-11
  • 十九大精神进校园:风正扬帆当有为 勇做时代弄潮儿 2019-05-10
  • 粽叶飘香幸福邻里——廊坊市举办“我们的节日·端午”主题活动 2019-05-09
  • 太原设禁鸣路段 设备在测试中 2019-05-09
  • 拜耳医药保健有限公司获第十二届人民企业社会责任奖年度企业奖 2019-05-08
  • “港独”没出路!“梁天琦们”该醒醒了 2019-05-07
  • 陈卫平:中国文化内涵包含三方面 文化复兴表现在其中 2019-05-06
  • 人民日报客户端辟谣:“合成军装照”产品请放心使用 2019-05-05
  • 【十九大·理论新视野】为什么要“建设现代化经济体系”?   2019-05-04
  • 聚焦2017年乌鲁木齐市老城区改造提升工程 2019-05-04
  • 【专家谈】上合组织——构建区域命运共同体的有力实践者 2019-05-03
  • 【华商侃车NO.192】 亲!楼市火爆,别忘了买车位啊! 2019-05-03
    • / 9
    • 下载费用:30 金币  

    重庆时时彩五星后一技: 一种基于单目视觉传感器的硅MEMS陀螺误差估计与校正方法.pdf

    关 键 词:
    一种 基于 目视 传感器 MEMS 陀螺 误差 估计 校正 方法
      专利查询网所有资源均是用户自行上传分享,仅供网友学习交流,未经上传用户书面授权,请勿作他用。
    摘要
    申请专利号:

    CN201610740714.5

    申请日:

    2016.08.26

    公开号:

    CN106352897A

    公开日:

    2017.01.25

    当前法律状态:

    授权

    有效性:

    有权

    法律详情: 授权|||实质审查的生效IPC(主分类):G01C 25/00申请日:20160826|||公开
    IPC分类号: G01C25/00; G06T7/33(2017.01)I 主分类号: G01C25/00
    申请人: 杨百川
    发明人: 杨百川; 盛蔚; 杨睿
    地址: 100088 北京市海淀区知春路罗庄西里13号楼东达商务楼212室
    优先权:
    专利代理机构: 北京科迪生专利代理有限责任公司 11251 代理人: 成金玉;卢纪
    PDF完整版下载: PDF下载
    法律状态
    申请(专利)号:

    CN201610740714.5

    授权公告号:

    ||||||

    法律状态公告日:

    2018.06.15|||2017.03.01|||2017.01.25

    法律状态类型:

    授权|||实质审查的生效|||公开

    摘要

    本发明涉及一种基于单目视觉传感器的硅MEMS陀螺误差估计与校正方法,一种无人机在航路任意位置、无需已知图形、利用单目视觉传感器图像信息实时估计与校正硅MEMS陀螺误差的方法;在每个计算周期,单目视觉传感器获取的图像信息通过与上一帧图像信息的特征匹配,获取机体坐标系下无人机的姿态变化率;再采用硅MEMS陀螺三轴测量数据与通过图像信息获得的姿态变化率作为观测值进行Kalman滤波;依据Kalman滤波结果校正硅MEMS陀螺误差,更新导航数据和滤波器参数;进入下一计算周期。本发明可用于任何包含单目视觉传感器和硅MEMS陀螺的无人机导航系统中。

    权利要求书

    1.一种基于单目视觉传感器的硅MEMS陀螺误差估计与校正方法,其特征在于:以单目
    视觉传感器和低成本硅MEMS陀螺作为测量传感器;在将单目视觉传感器实时获取的当前帧
    图像与上一帧图像进行特征点匹配,将匹配成功的特征点组成特征点组,利用匹配成功的
    特征点组计算相邻时刻的姿态转换矩阵,从而获取机体坐标系下相邻时刻无人机姿态转换
    矩阵;通过硅MEMS陀螺的测量值计算相邻时刻的姿态转换矩阵,将通过MEMS陀螺计算得到
    的姿态转换矩阵与通过单目视觉传感器实时获取的姿态转换矩阵分别作为观测值进行
    Kalman滤波,估计硅MEMS陀螺误差;根据Kalman滤波结果校正硅MEMS陀螺误差,更新导航数
    据和滤波器参数;进行下一个重复计算周期。
    2.根据权利要求1所述一种基于单目视觉传感器的硅MEMS陀螺误差估计与校正方法,
    其特征在于:所述单目视觉传感器实时获取的当前帧图像与上一帧图像进行特征点匹配
    时,匹配过程为:
    分别提取两张图像的特征点(μ,ν)t-1,(μ,ν)((μ,ν)t-1为上一时刻特征点在图像坐标系
    下的坐标值,(μ,ν)t为当前时刻特征点在图像坐标系下的坐标值),利用RANSAC算法剔除误
    匹配点后,将匹配成功的特征点组成特征点组;如果匹配上的特征点组的个数大于等于3,
    则认为该次匹配成功,否则认为匹配失败。
    3.根据权利要求1所述一种基于单目视觉传感器的硅MEMS陀螺误差估计与校正方法,
    其特征在于:所述方法并不依赖于利用已知图形作为地标,且在特定地标上空确定无人机
    姿态,而是利用普通单目视觉传感器获取的当前帧图像,与上一帧图像进行特征匹配,可以
    在任意时刻、在航路任意位置利用图像信息实时估计并校正硅MEMS陀螺误差,提高全飞行
    过程中惯性导航和飞行控制系统的精度。
    4.根据权利要求1所述一种基于单目视觉传感器的硅MEMS陀螺误差估计与校正方法,
    其特征在于:通过硅MEMS陀螺测量值时,在每个计算周期内,利用硅MEMS陀螺提供的三维正
    交角速度测量数据,将上一时刻方向余弦矩阵定义为经过捷联导航算法更新得
    当前时刻方向余弦矩阵计算出相邻时刻的姿态转换矩阵
    5.根据权利要求1所述一种基于单目视觉传感器的硅MEMS陀螺误差估计与校正方法,
    其特征在于:所述Kalman滤波时,构建九维观测量Kalman滤波器模型,其中Z=[Z1 Z2 Z3 Z4
    Z5 Z6 Z7 Z8 Z9]T,表示惯导解算得来的阵,表示利用
    图像特征匹配计算得来的阵,九维观测量由与相减获得。
    6.根据权利要求1所述一种基于单目视觉传感器的硅MEMS陀螺误差估计与校正方法,
    其特征在于:所述方法在飞行过程期间始终迭代重复计算。
    7.根据权利要求1所述一种基于单目视觉传感器的硅MEMS陀螺误差估计与校正方法,
    其特征在于:以低成本、硅MEMS工艺陀螺和低成本单目视觉传感器为测量设备,满足无人机
    机载电子设备低功耗、小体积、轻质量的限制。

    说明书

    一种基于单目视觉传感器的硅MEMS陀螺误差估计与校正方法

    技术领域

    本发明涉及一种基于单目视觉传感器的硅MEMS陀螺误差估计与校正方法,可用于
    任何包含单目视觉传感器和硅MEMS陀螺的无人机导航系统中。

    背景技术

    MEMS陀螺仪是一类应用MEMS(Micro Electro-Mechanical System)技术制成的测
    量运动物体角速率的惯性测量单元,因其具有体积小、重量轻、成本低以及可靠性高等优
    点,从而推动捷联惯导系统的迅速发展,在无人机领域获得广泛的研究。但这类MEMS陀螺仪
    容易受自身材料、制造水平以及工作环境等一系列因素的影响,性能普遍不高。一般来讲,
    陀螺的误差主要分为确定性误差及随机误差,前者主要指由扰动(敏感物理模型中的参数
    变化)和环境敏感(敏感环境的干扰)引起的误差,后者主要指由不确定因素引起的随机漂
    移,其中确定性误差是捷联惯导系统最主要的误差源。因此捷联惯导在使用之前必须通过
    标定实验确定出MEMS陀螺仪的各项误差系数,以在捷联惯导系统中对其进行补偿。

    现阶段视觉导航是无人机导航的一种热门研究方向。部分无人机上安装有小型图
    像传感器,利用获取的图像信息计算无人机的速度信息或辅助旋翼自主悬停与降落。但是
    现阶段在无已知地标的情况下,关于利用机载图像传感器辅助计算无人机姿态信息的研究
    仍很少见。

    发明内容

    本发明的技术解决问题是:克服现有技术的不足,提供一种基于单目视觉传感器
    的硅MEMS陀螺误差估计与校正方法。该方法以低成本硅MEMS陀螺和单目视觉传感器为测量
    器件,采用Kalman滤波信息融合的思路,实时估计校正硅MEMS陀螺误差,以提高全飞行过程
    中惯性导航和飞行控制系统的精度。本发明可用于任何包含单目视觉传感器和硅MEMS陀螺
    的无人机导航系统中。

    本发明的技术解决方案为:一种基于单目视觉传感器的硅MEMS陀螺误差估计与校
    正方法,以单目视觉传感器和低成本硅MEMS陀螺作为测量传感器;在将单目视觉传感器实
    时获取的当前帧图像与上一帧图像进行特征点匹配,将匹配成功的特征点组成特征点组,
    利用匹配成功的特征点组计算相邻时刻的姿态转换矩阵,从而获取机体坐标系下相邻时刻
    无人机姿态转换矩阵;通过硅MEMS陀螺的测量值计算相邻时刻的姿态转换矩阵,将通过
    MEMS陀螺计算得到的姿态转换矩阵与通过单目视觉传感器实时获取的姿态转换矩阵分别
    作为观测值进行Kalman滤波,估计硅MEMS陀螺误差;根据Kalman滤波结果校正硅MEMS陀螺
    误差,更新导航数据和滤波器参数;进行下一个重复计算周期。

    所述单目视觉传感器实时获取的当前帧图像与上一帧图像进行特征点匹配时,匹
    配过程为:

    分别提取两张图像的特征点(μ,ν)t-1,((μ,ν)t-1为上一时刻特征点在图像坐
    标系下的坐标值,(μ,ν)t为当前时刻特征点在图像坐标系下的坐标值),利用RANSAC算法剔
    除误匹配点后,将匹配成功的特征点组成特征点组;如果匹配上的特征点组的个数大于等
    于3,则认为该次匹配成功,否则认为匹配失败。

    所述方法并不依赖于利用已知图形作为地标,且在特定地标上空确定无人机姿
    态,而是利用普通单目视觉传感器获取的当前帧图像,与上一帧图像进行特征匹配,可以在
    任意时刻、在航路任意位置利用图像信息实时估计并校正硅MEMS陀螺误差,提高全飞行过
    程中惯性导航和飞行控制系统的精度。

    通过硅MEMS陀螺测量值时,在每个计算周期内,利用硅MEMS陀螺提供的三维正交
    角速度测量数据,将上一时刻方向余弦矩阵定义为经过捷联导航算法更新得当
    前时刻方向余弦矩阵计算出相邻时刻的姿态转换矩阵

    所述Kalman滤波时,构建九维观测量Kalman滤波器模型,其中Z=[Z1 Z2 Z3 Z4 Z5
    Z6 Z7 Z8 Z9]T,表示惯导解算得来的阵,表示利用图像
    特征匹配计算得来的阵,九维观测量由与相减获得。

    所述方法在飞行过程期间始终迭代重复计算。

    以低成本、硅MEMS工艺陀螺和低成本单目视觉传感器为测量设备,满足无人机机
    载电子设备低功耗、小体积、轻质量的限制。

    本发明的原理是:硅MEMS陀螺在惯性测量单元独立工作,误差随时间快速积累,无
    法提供可信的航向姿态信息。本发明利用了单目视觉传感器实时解算姿态信息作为观测
    量,通过信息融合滤波器为惯性测量单元提供了误差抑制的途径。依据Kalman滤波结果校
    正惯性测量单元误差,更新导航数据和滤波器参数,提供无人机飞行过程中高精度导航信
    息。

    本发明与现有技术相比的优点在于:以低成本、硅MEMS工艺陀螺和低成本单目视
    觉传感器作为测量传感器,满足无人机机载电子设备低功耗、小体积、轻质量的限制。利用
    单目视觉图像信息实时估计校正陀螺误差,无需外界提供地标或已知图形等模板信息,摆
    脱了飞行时间与地点的限制。在飞行的过程中利用Kalman滤波器,在每个迭代计算步骤中
    估计陀螺误差,提高了单目视觉传感器和硅MEMS陀螺信息融合的精度,为无人机提供了可
    信有效的定姿信息,以提高全飞行过程中惯性导航和飞行控制系统的精度。本发明可用于
    任何包含单目视觉传感器和硅MEMS陀螺的无人机导航系统中。

    附图说明

    图1为本发明的基于单目视觉传感器的硅MEMS陀螺误差估计与校正方法流程图。

    具体实施方式

    如图1所示,本发明的具体方法如下:

    一种基于单目视觉传感器的硅MEMS陀螺误差估计与校正方法,以普通单目视觉传
    感器和低成本硅MEMS陀螺作为测量传感器;在每个计算周期,硅MEMS陀螺经过捷联导航算
    法,参与更新当前无人机姿态和其他导航数据;根据单目视觉传感器实时获取的图像信息
    实时估计与校正陀螺误差的方法:将单目视觉传感器实时获取的当前帧图像与上一帧图像
    进行特征点匹配,获取机体坐标系下相邻时刻无人机姿态转换矩阵;通过硅MEMS陀螺的测
    量值计算相邻时刻的姿态转换矩阵,将通过陀螺与图像获取的姿态转换矩阵作为观测值进
    行Kalman滤波,估计硅MEMS陀螺误差;根据Kalman滤波结果校正硅MEMS陀螺误差,更新导航
    数据和滤波器参数;进行下一个重复计算周期。

    本发明所用到的坐标系有:

    机体坐标系(Σb)

    机体坐标系Ob-XbYbZb原点位于无人机质量中心,ObXb轴位于无人机参考平面内平
    行于机身轴线并指向无人机右方,ObYb轴垂直于无人机参考面并指向无人机前方,ObZb轴在
    参考面内垂直于XOY平面,指向无人机上方。

    图像坐标系(u,v)

    图像坐标系(u,v)原点为摄像机光心(投影中心),x,y坐标(u,v)以像素为单位。

    摄像机坐标系(Σc)

    计算机坐标系Oc-XcYcZc原点为摄像机光心(投影中心),OcXc轴和OcYc轴与成像平面
    坐标系的X轴和Y轴平行,OcZc轴为摄像机的光轴,和图像平面垂直。

    地理坐标系(∑n)

    地理坐标系On-XnYnZn OnXn轴当地指东,OnYn轴当地指北,OnZn轴指天。

    具体包括以下步骤:

    (1)利用单目视觉传感器获取的当前帧图像与上一帧图像进行特征点匹配,获取
    机体坐标系下无人机在两个时刻间的姿态转换矩阵。

    (2)利用硅MEMS陀螺获取三维角速度信息,经过捷联导航算法,实时获取机体坐标
    系下无人机在两个时刻间的姿态转换矩阵。

    (3)在每个计算周期,首先利用惯性测量单元提供的三维正交角速度和加速度测
    量数据,经过捷联导航算法,实时更新当前无人机姿态。

    (4)以图像测量信息与硅MEMS陀螺测量信息为观测量,构建九维观测量Kalman滤
    波器模型。

    (5)用Kalman滤波器状态变量估计值校正硅MEMS陀螺误差,提高导航精度。

    (6)上述步骤迭代重复计算。

    下面进行详细说明。

    1、无人机机载单目视觉传感器接收到新一帧图像信息,并与前一帧图像进行特征
    点匹配:

    分别提取两张图像的特征点(μ,ν)t-1,((μ,ν)t-1为上一时刻特征点在图像坐
    标系下的坐标值,(μ,ν)t为当前时刻特征点在图像坐标系下的坐标值),利用RANSAC算法剔
    除误匹配点后,将匹配成功的特征点组成特征点组;如果匹配上的特征点组的个数大于等
    于3,则认为该次匹配成功,否则认为匹配失败。

    2、利用匹配成功的图像特征点组计算姿态转换矩阵:

    可以假设两张图片上匹配成功的特征点在地理坐标系下坐标相同,即:

    <mrow> <msub> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>X</mi> <mi>n</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Y</mi> <mi>n</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Z</mi> <mi>n</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mi>t</mi> </msub> <mo>=</mo> <msub> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>X</mi> <mi>n</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Y</mi> <mi>n</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Z</mi> <mi>n</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> </mrow>

    根据坐标系转换关系:

    其中,u,v表示特征点在图像坐标系下的坐标,Xc,Yc,Zc表示特征点在摄像机坐标
    系下坐标,Xn,Yn,Zn表示特征点在地理坐标系下坐标,f表示摄像机焦距。

    设姿态转换矩阵将特征点在地理坐标系下坐标投影到图像
    坐标系下,即可得到:

    <mrow> <msub> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>u</mi> </mtd> </mtr> <mtr> <mtd> <mi>v</mi> </mtd> </mtr> </mtable> </mfenced> <mi>t</mi> </msub> <mo>=</mo> <mi>k</mi> <mo>*</mo> <msub> <mi>R</mi> <mrow> <mn>2</mn> <mo>&times;</mo> <mn>2</mn> </mrow> </msub> <msub> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>u</mi> </mtd> </mtr> <mtr> <mtd> <mi>v</mi> </mtd> </mtr> </mtable> </mfenced> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>t</mi> <mrow> <mn>2</mn> <mo>&times;</mo> <mn>1</mn> </mrow> </msub> </mrow>

    其中,

    由于姿态转换矩阵为单位正交矩阵,通过约束条件:

    <mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mo>|</mo> <msub> <mi>C</mi> <mn>1</mn> </msub> <mo>|</mo> <mo>=</mo> <mo>|</mo> <msub> <mi>C</mi> <mn>2</mn> </msub> <mo>|</mo> <mo>=</mo> <mo>|</mo> <msub> <mi>C</mi> <mn>3</mn> </msub> <mo>|</mo> <mo>=</mo> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>C</mi> <mn>1</mn> </msub> <mo>*</mo> <msub> <mi>C</mi> <mn>2</mn> </msub> <mo>=</mo> <msub> <mi>C</mi> <mn>1</mn> </msub> <mo>*</mo> <msub> <mi>C</mi> <mn>3</mn> </msub> <mo>=</mo> <msub> <mi>C</mi> <mn>2</mn> </msub> <mo>*</mo> <msub> <mi>C</mi> <mn>3</mn> </msub> <mo>=</mo> <mn>0</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>t</mi> </msubsup> <mo>=</mo> <mfenced open = "(" close = ")"> <mtable> <mtr> <mtd> <msub> <mi>C</mi> <mn>1</mn> </msub> </mtd> <mtd> <msub> <mi>C</mi> <mn>2</mn> </msub> </mtd> <mtd> <msub> <mi>C</mi> <mn>3</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>)</mo> </mrow> </mrow>

    即可通过R2×2算出表示利用图像特征匹配计算得来的阵。

    3、利用硅MEMS陀螺提供的三维正交角速度测量数据,经过标准捷联惯性导航算
    法,实时更新当前固定翼无人机航向姿态信息,同时更新姿态对应的方向余弦矩阵
    根据当前时刻的与上一时刻的更新硅MEMS陀螺对应的姿态转换矩阵
    表示惯导解算得来的阵。

    4、设定Kalman滤波器状态变量为X=[φe φn φu εbx εby εbz]T,其中εx,εy,εz表
    示机体坐标系三个方向的陀螺零偏。滤波器的状态方程为:X=FX+GW,W=W[3×1]为系统噪
    声,状态转移矩阵F=F6×6和系统噪声系数阵G=G[6×3]中除了以下元素外均为零元素:

    F12=ωiesin(L)+VEtan(L)/(Rn+h) F13=-ωiecos(L)-VE/(Rn+h)

    F21=-F12 F23=-VN/(Rm+h)

    F31=-F13 F32=-F23

    <mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>F</mi> <mn>14</mn> </msub> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>F</mi> <mn>15</mn> </msub> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>

    <mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>F</mi> <mn>16</mn> </msub> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>F</mi> <mn>24</mn> </msub> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>

    <mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>F</mi> <mn>25</mn> </msub> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>F</mi> <mn>26</mn> </msub> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>

    <mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>F</mi> <mn>34</mn> </msub> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>F</mi> <mn>35</mn> </msub> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>

    <mrow> <msub> <mi>F</mi> <mn>36</mn> </msub> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> </mrow>

    <mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>G</mi> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow> </mtd> <mtd> <mrow> <mi>G</mi> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>

    <mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>G</mi> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> </mrow> </mtd> <mtd> <mrow> <mi>G</mi> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>

    <mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>G</mi> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow> </mtd> <mtd> <mrow> <mi>G</mi> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>

    <mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>G</mi> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow> </mtd> <mtd> <mrow> <mi>G</mi> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>

    <mrow> <mi>G</mi> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> </mrow>

    其中,ωie表示地球的自转角速度,L表示无人机所在点的纬度,VE和VN表示无人机
    的东向和北向水平速度分量,Rm为无人机所在点处子午圈的曲率半径,Rn为无人机所在点处
    卯酉圈的曲率半径,h表示无人机据当地地面的高度,表示当前时刻惯导解算获取的
    阵。

    5、滤波器观测方程为:Z=HX+V。其中
    表示惯导解算得来的阵,表示利用图像特征匹配计算
    得来的阵,九维观测量由与相减获得。

    观测矩阵H中除了以下元素外均为零元素::

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>+</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>+</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>+</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>4</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>4</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>+</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>4</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>5</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>5</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>+</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>5</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>6</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>6</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>+</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>6</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>7</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>7</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>+</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>7</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>8</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>8</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>+</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>8</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>9</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>9</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>1</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>+</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>1</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> </mrow>

    <mrow> <mi>H</mi> <mo>&lsqb;</mo> <mn>9</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>=</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>-</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mi>t</mi> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>2</mn> <mo>&rsqb;</mo> <mo>*</mo> <msub> <mrow> <mo>(</mo> <msubsup> <mi>C</mi> <mi>b</mi> <mi>n</mi> </msubsup> <mo>)</mo> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>&lsqb;</mo> <mn>3</mn> <mo>,</mo> <mn>3</mn> <mo>&rsqb;</mo> <mo>.</mo> </mrow>

    其中,表示当前时刻惯导解算获取的阵,表示上一时刻惯导解算获
    取的阵

    6、基于图像与硅MEMS陀螺的解算结果,滤波器的观测量为:Z=[Z1 Z2 Z3 Z4 Z5 Z6
    Z7 Z8 Z9]T,其中,表示惯导解算获取的阵,表示利用
    图像特征匹配计算获取的阵,九维观测量由与相减获得。

    7、滤波器采用标准卡尔曼滤波器估计状态变量X,获得无人机误差角和陀螺零偏;

    8、在飞行过程中迭代重复上述过程。

    本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。

    提供以上实施例仅仅是为了描述本发明的目的,而并非要限制本发明的范围。本
    发明的范围由所附权利要求限定。不脱离本发明的精神和原理而做出的各种等同替换和修
    改,均应涵盖在本发明的范围之内。

    关于本文
    本文标题:一种基于单目视觉传感器的硅MEMS陀螺误差估计与校正方法.pdf
    链接地址://www.4mum.com.cn/p-6014133.html
    关于我们 - 网站声明 - 网站地图 - 资源地图 - 友情链接 - 网站客服 - 联系我们

    [email protected] 2017-2018 www.4mum.com.cn网站版权所有
    经营许可证编号:粤ICP备17046363号-1 
     


    收起
    展开
  • 四川郎酒股份有限公司获第十二届人民企业社会责任奖年度环保奖 2019-05-13
  • 银保监会新规剑指大企业多头融资和过度融资 2019-05-12
  • 韩国再提4国联合申办世界杯 中国网友无视:我们自己来 2019-05-11
  • 中国人为什么一定要买房? 2019-05-11
  • 十九大精神进校园:风正扬帆当有为 勇做时代弄潮儿 2019-05-10
  • 粽叶飘香幸福邻里——廊坊市举办“我们的节日·端午”主题活动 2019-05-09
  • 太原设禁鸣路段 设备在测试中 2019-05-09
  • 拜耳医药保健有限公司获第十二届人民企业社会责任奖年度企业奖 2019-05-08
  • “港独”没出路!“梁天琦们”该醒醒了 2019-05-07
  • 陈卫平:中国文化内涵包含三方面 文化复兴表现在其中 2019-05-06
  • 人民日报客户端辟谣:“合成军装照”产品请放心使用 2019-05-05
  • 【十九大·理论新视野】为什么要“建设现代化经济体系”?   2019-05-04
  • 聚焦2017年乌鲁木齐市老城区改造提升工程 2019-05-04
  • 【专家谈】上合组织——构建区域命运共同体的有力实践者 2019-05-03
  • 【华商侃车NO.192】 亲!楼市火爆,别忘了买车位啊! 2019-05-03
  • 快乐扑克三豹子走势图 彩票开奖25选5 赛车北京pk10是什么 天吉3d彩票论坛 技巧打牌 河南22选5杀号方法 河北十一选五任四奖金 赛马会论坛414148cm 679彩票苹果 甘肃快3走走势图 查看河北福彩二十选五 开元棋牌官网下载 排五对奖规则 海南特区七星彩 快乐10分复式3任选兑奖多少倍 棋牌app带控出租