• 四川郎酒股份有限公司获第十二届人民企业社会责任奖年度环保奖 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 金币  

    重庆时时彩彩票秘诀: 一种基于惯性和地磁传感器的目标姿态跟踪方法.pdf

    摘要
    申请专利号:

    重庆时时彩单双窍门 www.4mum.com.cn CN201510196626.9

    申请日:

    2015.04.23

    公开号:

    CN104764451A

    公开日:

    2015.07.08

    当前法律状态:

    撤回

    有效性:

    无权

    法律详情: 发明专利申请公布后的视为撤回IPC(主分类):G01C 21/16申请公布日:20150708|||实质审查的生效IPC(主分类):G01C 21/16申请日:20150423|||公开
    IPC分类号: G01C21/16; G01C21/08 主分类号: G01C21/16
    申请人: 北京理工大学
    发明人: 刘越; 贺长宇; 闫达远; 常军; 翁冬冬
    地址: 100081北京市海淀区中关村南大街5号
    优先权:
    专利代理机构: 北京理工大学专利中心11120 代理人: 李微微; 仇蕾安
    PDF完整版下载: PDF下载
    法律状态
    申请(专利)号:

    CN201510196626.9

    授权公告号:

    ||||||

    法律状态公告日:

    2018.03.09|||2015.08.05|||2015.07.08

    法律状态类型:

    发明专利申请公布后的视为撤回|||实质审查的生效|||公开

    摘要

    本发明公开了一种基于惯性和地磁传感器的目标姿态跟踪方法,无需任何参考标志物和特定跟踪环境即可实现姿态跟踪,方法简单易行;采用陀螺仪、加速度计以及地磁传感器分别采集目标当前姿态所对应的角速度、加速度和磁强度数据在三个敏感轴上的分量,利用加速度计和磁传感器校正陀螺仪的姿态跟踪结果,消除了漂移误差,从而提高跟踪结果的精度;本发明使用高效离线运行的卡尔曼滤波算法,融合了多传感器跟踪结果,实现了实时在线姿态跟踪。

    权利要求书

    权利要求书
    1.  一种基于惯性和地磁传感器的目标姿态跟踪方法,其特征在于,采用陀螺仪、加速度计以及地磁传感器分别采集目标当前姿态所对应的角速度、加速度和磁强度数据在三个敏感轴上的分量,并采用卡尔曼滤波器对上述三个传感器数据进行融合并计算目标的姿态信息,具体方法如下:
    步骤1、通过卡尔曼滤波器对目标姿态信息进行时间更新,具体为:
    S10、在时间更新方程中对目标的状态矢量进行估计:

    其中,A为所述陀螺仪测得的目标在三个敏感轴上角速度测量值构成的滤波器增益矩阵;为当前时刻目标状态矢量估计值,为卡尔曼滤波器上一时刻输出的目标状态矢量;
    S11、对卡尔曼滤波器的传递函数的估计值进行更新:
    pk-=Apk-1AT+Q]]>
    其中,Q值为系统噪声协方差矩阵;AT为增益矩阵A的转置矩阵;Pk-1为卡尔曼滤波器上一时刻输出的传递函数;
    步骤2、通过卡尔曼滤波器对目标姿态信息进行测量更新,具体为:
    S20、基于步骤1中更新得到的传递函数的估计值获得卡尔曼滤波器的测量置信参数Kk:
    Kk=Pk-HT(HRk-HT+R)-1]]>
    其中,H为测量模型与估计模型间转换矩阵:

    [q1 q2 q3 q4]表示组成目标的状态矢量估计值的旋转四元数,即R为测量误差模型:其中ACCx、ACCy和ACCz分别为加速度传感器测得的目标在三个敏感轴上的加速度分量,g为重力 加速度;
    S21、对目标的状态矢量的测量结果进行更新:

    Zk=θγψ]]>表示目标的姿态,其中,θ=arcsin(ACCx)表示目标的俯仰角,表示目标的横滚角,表示目标的航向角,A=MAGxcos(θ)+MAGysin(θ)+MAGzcos(θ)sin(γ),B=MAGycos(γ)+MAGzsin(γ),MAGx、MAGy和MAGz分别表示磁场传感器获得的目标所在位置的地球磁场在体坐标系的三个敏感轴上的分量;
    S22、对传递函数的测量结果Pk进行更新:
    Pk=(1-KlH)Pk-]]>
    步骤3、目标状态矢量的测量结果即为当前目标姿态的跟踪结果,将当前时刻测量结果和传递函数的测量结果Pk输出并作为下一时刻滤波器的输入结果,返回步骤1,进行下一时刻的目标姿态跟踪。

    2.  如权利要求1所述的一种基于惯性和地磁传感器的目标姿态跟踪方法,其特征在于,所述步骤1中系统噪声协方差矩阵Q取值为0.01。

    关 键 词:
    一种 基于 惯性 地磁 传感器 目标 姿态 跟踪 方法
      专利查询网所有资源均是用户自行上传分享,仅供网友学习交流,未经上传用户书面授权,请勿作他用。
    关于本文
    本文标题:一种基于惯性和地磁传感器的目标姿态跟踪方法.pdf
    链接地址://www.4mum.com.cn/p-5894699.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