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

    重庆时时彩龙虎怎么看: 运动姿态数据获取、人体运动姿态追踪方法及相关设备.pdf

    关 键 词:
    运动 姿态 数据 获取 人体 追踪 方法 相关 设备
      专利查询网所有资源均是用户自行上传分享,仅供网友学习交流,未经上传用户书面授权,请勿作他用。
    摘要
    申请专利号:

    CN201110116679.7

    申请日:

    2011.05.06

    公开号:

    CN102252676A

    公开日:

    2011.11.23

    当前法律状态:

    终止

    有效性:

    无权

    法律详情: 未缴年费专利权终止IPC(主分类):G01C 21/08申请日:20110506授权公告日:20140312终止日期:20170506|||专利权的转移IPC(主分类):G01C21/08变更事项:专利权人变更前权利人:微迈森惯性技术开发(北京)有限公司变更后权利人:青岛海蓝康复器械有限公司变更事项:地址变更前权利人:100004 北京市朝阳区建国路15号院甲1号北岸1292三间房创意生活园区2-414变更后权利人:266000 山东省青岛市崂山区沙子口街道汉河社区登记生效日:20150325|||授权|||实质审查的生效IPC(主分类):G01C 21/08申请日:20110506|||公开
    IPC分类号: G01C21/08; G01C21/16 主分类号: G01C21/08
    申请人: 微迈森惯性技术开发(北京)有限公司
    发明人: 赵铁军; 周尤
    地址: 100004 北京市朝阳区建国路15号院甲1号北岸1292三间房创意生活园区2-414
    优先权:
    专利代理机构: 北京集佳知识产权代理有限公司 11227 代理人: 逯长明;王宝筠
    PDF完整版下载: PDF下载
    法律状态
    申请(专利)号:

    CN201110116679.7

    授权公告号:

    ||||||102252676B||||||

    法律状态公告日:

    2018.05.29|||2015.04.15|||2014.03.12|||2012.01.04|||2011.11.23

    法律状态类型:

    专利权的终止|||专利申请权、专利权的转移|||授权|||实质审查的生效|||公开

    摘要

    本发明提供的运动姿态数据的获取方法包括:记录运动物体处于第一测量航向角时的地磁场强度作为第一磁场量;当运动物体运动至第二测量航向角时,将运动物体所在位置的地磁场强度的方向回转第二测量航向角与第一测量航向角差值大小的角度,并记录该位置的地磁场强度作为第二磁场向量;将第一磁场强度与第二磁场强度按照预设规则运算后得到磁场强度观测量;将所述磁场强度观测量与所述运动物体的测量姿态数据进行递归自回归滤波,得到所述运动物体的姿态数据。本发明还提供了一种运动姿态数据的获取装置以及一种人体运动姿态追踪方法与系统。本发明引入地磁场强度,解决了角速度测量时产生的累积误差问题。

    权利要求书

    1.一种运动姿态数据的获取方法,其特征在于,该方法包括:
    记录运动物体处于第一测量航向角时的地磁场强度,该地磁场强度作为
    第一磁场强度,所述第一测量航向角的数值与所述运动物体的真实航向角的
    数值相同;
    当所述运动物体运动至第二测量航向角时,将所述运动物体所在位置对
    应的地磁场强度的方向回转α角度,所述α的数值为第二测量航向角与第一
    测量航向角之差,记录回转α角度后的位置的地磁场强度,该地磁场强度作
    为第二磁场强度;
    将所述第一磁场强度与第二磁场强度按照预设规则运算后得到磁场强度
    观测量;
    将所述磁场强度观测量与所述运动物体的测量姿态数据进行递归自回归
    滤波,得到所述运动物体的姿态数据。
    2.根据权利要求1所述的方法,其特征在于,所述第一测量航向角为零
    度航向角。
    3.根据权利要求1所述的方法,其特征在于,在将所述磁场强度观测量
    与运动物体测量姿态数据进行递归自回归滤波时,所述方法还包括:
    分别统计分析所述磁场强度观测量和测量姿态数据得到数据变化率和超
    量程时间百分比;
    将所述数据变化率与超量程时间百分比相乘分别得到第一动态调整系数
    和第二动态调整系数;
    将所述第一动态调整系数乘以获取所述磁场强度观测量时产生的观测噪
    声协方差得到更新后的观测噪声协方差,并将所述第二动态调整系数乘以所
    述测量姿态数据时产生的激励噪声协方差得到更新后的激励噪声协方差;
    将所述更新后的观测噪声协方差和激励噪声协方差反馈给所述递归自回
    归滤波过程。
    4.根据权利要求1至3中任何一项所述的方法,其特征在于,所述运动
    物体磁场强度观测量与运动物体测量姿态数据的递归自回归滤波为卡尔曼滤
    波。
    5.一种人体运动姿态追踪的方法,其特征在于,该方法包括:
    记录人体运动部位处于第一测量航向角时的地磁场强度,该地磁场强度
    作为第一磁场强度,所述第一测量航向角的数值与所述运动物体的真实航向
    角的数值相同;
    当人体运动部位运动至第二测量航向角时,将所述人体运动部位所在位
    置对应的地磁场强度的方向回转α角度,所述α的数值为第二测量航向角与
    第一测量航向角之差,记录回转α角度后的位置的地磁场强度,该磁场强度
    作为第二磁场强度;
    将所述第一磁场强度与第二磁场强度按照预设规则运算后得到磁场强度
    观测量;
    将所述磁场强度观测量与所述人体运动部位的测量姿态数据进行递归自
    回归滤波,得到所述人体运动部位的姿态数据;
    将所述人体各运动部位的姿态数据传输给姿态数据处理中心,由该处理
    中心使用所述数据驱动人体模型的相应部位运动,并将人体运动姿态虚拟再
    现出来。
    6.根据权利要求5所述的方法,其特征在于,所述将人体各运动部位的
    姿态数据传输给姿态数据处理中心包括无线传输。
    7.一种运动姿态数据的获取装置,其特征在于,该装置包括:测量单元、
    地磁场强度传感单元和递归自回归滤波单元,所述测量单元、地磁场强度传
    感单元分别与递归自回归滤波单元电连接,其中:
    所述测量单元,用于测量运动物体的姿态数据;
    所述地磁场强度传感单元,用于记录运动物体处于第一测量航向角时的
    地磁场强度,该地磁场强度作为第一磁场强度,所述第一测量航向角的数值
    与所述运动物体的真实航向角的数值相同;当运动物体运动至第二测量航向
    角时,将所述运动物体所在位置对应的地磁场强度的方向回转α角度,所述
    α的数值为所述第二测量航向角与第一测量航向角之差,记录返回α角度后
    的位置的地磁场强度,该地磁场强度作为第二磁场强度;将所述第一磁场强
    度与第二磁场强度按照预设规则运算后得到磁场强度观测量;
    所述递归自回归滤波单元,用于将所述磁场强度观测量与所述运动物体
    的测量姿态数据进行递归自回归滤波得到所述运动物体的姿态数据。
    8.根据权利要求7所述的装置,其特征在于,所述第一测量航向角为零
    度航向角。
    9.根据权利要求7所述的装置,其特征在于,所述装置进一步包括动态
    调整单元,用于将所述磁场强度观测量与运动物体测量姿态数据进行递归自
    回归滤波时,分别统计分析所述磁场强度观测量和测量姿态数据得到数据变
    化率和超量程时间百分比;将所述数据变化率与超量程时间百分比相乘分别
    得到第一动态调整系数和第二动态调整系数;将所述第一动态调整系数乘以
    获取所述磁场强度观测量时产生的观测噪声协方差得到更新后的观测噪声协
    方差,并将所述第二动态调整系数乘以所述测量姿态时产生的激励噪声协方
    差得到更新后的激励噪声协方差;将所述更新后的观测噪声协方差和激励噪
    声协方差反馈给所述递归自回归滤波过程。
    10.根据权利要求7至9中任何一项所述的装置,其特征在于,所述递
    归自回归滤波单元为卡尔曼滤波器。
    11.一种人体运动姿态追踪系统,其特征在于,该系统包括:至少一个
    人体运动部位姿态数据获取装置、发送???、接收???、人体姿态重构???br />和人体姿态呈现???,其中:
    所述人体运动部位姿态数据获取装置,用于收集人体运动部位的姿态数
    据后将该数据传输给发送???;该装置包括测量单元、磁场强度传感单元和
    递归自回归滤波单元,所述测量单元、磁场强度传感单元分别与递归自回归
    滤波单元电连接,其中:
    所述测量单元,用于测量人体运动部位的姿态数据;
    所述地磁场强度传感单元,用于记录人体运动部位处于第一航向角时的
    地磁场强度,该地磁场强度作为第一磁场强度,所述第一测量航向角的数值
    与所述运动物体的真实航向角的数值相同;当人体运动部位运动至第二测量
    航向角时,将所述运动物体所在位置对应的地磁场强度的方向回转α角度,
    所述α的数值为第二测量航向角与第一测量航向角之差,记录回转α角度后
    的位置的地磁场强度,该地磁场强度作为第二磁场强度;将所述第一磁场强
    度与第二磁场强度按照预设规则运算后得到磁场强度观测量;
    所述递归自回归滤波单元,用于将所述磁场强度观测量与所述人体运动
    部位的测量姿态数据进行递归自回归滤波,得到所述人体运动部位的姿态数
    据;
    所述发送???,用于将所述人体运动部位姿态数据获取装置获取的人体
    各运动部位的姿态数据发送给所述人体姿态重构???;
    所述接收???,用于接收所述人体运动部位姿态数据获取装置的人体各
    运动部位的姿态数据;
    所述人体姿态重构???,将所述接收??榻邮盏娜颂甯髟硕课坏淖颂?br />数据用于驱动人体模型相应部位运动;
    所述人体姿态呈现???,用于虚拟再现人体的运动。
    12.根据权利要求11所述的系统,其特征在于,该系统进一步包括第一
    无线通信单元和第二无线通信单元,所述发送??橥ü谝晃尴咄ㄐ诺ピ?br />所述人体各运动部位的姿态数据发送给所述人体姿态重构???;所述接收模
    块通过第二无线通信单元接收所述人体运动姿态数据获取装置获取的姿态数
    据。
    13.根据权利要求12所述的系统,其特征在于,所述第一无线通信单元
    集成于所述发送??槟?;所述第二无线通信单元集成于所述接收??槟?。

    说明书

    运动姿态数据获取、人体运动姿态追踪方法及相关设备

    技术领域

    本发明涉及微机械(MEMS)领域,尤其涉及一种运动姿态数据获取、
    人体运动姿态追踪方法及相关设备。

    背景技术

    运动物体的姿态追踪技术,已广泛运用于各领域,尤其在航天航海、天
    线雷达、人体运动姿态建模等领域。近年,随着MEMS的迅速发展,运动姿
    态追踪技术逐渐融合进MEMS的理念,将运动姿态追踪所需的测量部件微型
    化、集成化,形成集微型机构、微型传感器、微型执行器以及信号处理和控
    制电路等于一体的微型运动姿态追踪设备。这些设备具有成本低、体积小、
    重量轻等特点,因而广受人们青睐。

    运动物体的姿态追踪需要首先获得运动物体的姿态数据。现有技术中,
    常用微型运动姿态数据获取设备来收集姿态数据,该设备主要集成有陀螺仪
    器件,将该设备安装于目标物体上后,处于工作状态的陀螺仪传感器将收集
    运动物体的姿态数据(横滚角、俯仰角、航向角)。运动姿态数据获得后即可
    利用该数据对该运动物体的虚拟模型进行驱动,从而实时再现运动物体的运
    动过程,实现追踪。在进行人体运动姿态追踪时,多个集成有陀螺仪器件的
    微型运动姿态数据获取设备绑定在人体的主要关节部位,通过这些器件收集
    人体各运动部位的姿态数据,然后利用这些数据驱动人体模型相应部位运动,
    并用3D画面直观地显示出人体运动过程,从而实现人体运动姿态追踪。

    然而,陀螺仪器件测量的运动物体姿态数据具有误差,必须进行修正后
    才能真实地反应出运动物体的运动姿态。这种误差产生的大致过程是:陀螺
    仪器件直接测量的数据为角速度,该角速度值为瞬间量,大多数情况下不能
    直接使用,而需要对该角速度进行时间积分,得到角度变化量,然后加上初
    始角度作为最后的角度值才是运动物体的姿态数据,这种积分过程积分时间
    (dt)越小,得到的角度值越准确,由于陀螺仪测量基准是其自身而非外在
    的绝对参照物,加之积分时间(dt)不可能无限缩小,积分的累积误差将随
    时间推移迅速增加,进而导致测量的运动姿态数据与实际数据发生偏差。一
    种解决陀螺仪积分累积误差的方法是在运动姿态追踪设备中增加加速度传感
    器,用于测量重力方向的加速度数值,在无外力加速度情况下,可较为准确
    地输出运动物体的横滚角和俯仰角,如果有外力加速作用,通过具有递归自
    回归滤波功能的卡尔曼滤波器进行数据融合,最后得出运动物体的运动姿态
    数据。但是,由于加速度测量的重力方向与航向角正交,无法用加速度传感
    器消除水平方向的陀螺仪累积误差,导致运动姿态的航向角数据与实际值不
    相符合,进而在进行运动物体追踪时不能准确地追踪运动物体。

    发明内容

    有鉴于此,本发明在现有系统中增加地磁场传感器件,通过将该传感器
    件收集到的地磁场数据作为观测值输入递归自回归单元中进行数据融合,利
    用递归自回归单元的递归收敛功能消除角速度仪在水平方向的累积误差,得
    到最优的姿态数据,进而较好地实现运动物体的追踪。

    本发明提供的运动姿态数据的获取方法包括:

    记录运动物体处于第一测量航向角时的地磁场强度,该地磁场强度作为
    第一磁场强度,所述第一测量航向角的数值与所述运动物体的真实航向角的
    数值相同;

    当运动物体运动至第二测量航向角时,将所述运动物体所在位置对应的
    地磁场强度的方向回转α角度,所述α的数值为第二测量航向角与第一测量
    航向角之差,记录回转α角度后的位置的地磁场强度,该地磁场强度作为第
    二磁场强度;

    将所述第一磁场强度与第二磁场强度按照预设规则运算后得到磁场强度
    观测量;

    将所述磁场强度观测量与所述运动物体的测量姿态数据进行递归自回归
    滤波,得到所述运动物体的姿态数据。

    优选地,所述第一测量航向角为零度航向角。

    优选地,在将所述磁场强度观测量与运动物体测量姿态数据进行递归自
    回归滤波时,所述方法还包括:

    分别提取所述磁场强度观测量和测量姿态数据的数据变化率和超量程时
    间百分比;

    将所述数据变化率与超量程时间百分比相乘分别得到第一动态调整系数
    和第二动态调整系数;

    将所述第一动态调整系数乘以获取所述磁场强度观测量时产生的观测噪
    声协方差得到更新后的观测噪声协方差,并将所述第二动态调整系数乘以所
    述测量姿态数据时产生的激励噪声协方差得到更新后的激励噪声协方差;

    将所述更新后的观测噪声协方差和激励噪声协方差反馈给所述递归自回
    归滤波过程。

    优选地,所述运动物体磁场强度观测量与运动物体测量姿态数据的递归
    自回归滤波为卡尔曼滤波。

    本发明提供的一种人体运动姿态追踪方法包括:

    记录人体运动部位处于第一测量航向角时的地磁场强度,该地磁场强度
    作为第一磁场强度,所述第一测量航向角的数值与所述运动物体的真实航向
    角的数值相同;

    当人体运动部位运动至第二测量航向角时,将所述人体运动部位所在位
    置对应的地磁场强度的方向回转α角度,所述α的数值为第二测量航向角与
    第一测量航向角之差,记录回转α角度后的位置的地磁场强度,该地磁场强
    度作为第二磁场强度;

    将所述第一磁场强度与第二磁场强度按照预设规则运算后得到磁场强度
    观测量;

    将所述磁场强度观测量与所述人体运动部位的测量姿态数据进行递归自
    回归滤波得到所述人体运动部位的姿态数据;

    将所述人体各运动部位的姿态数据传输给姿态数据处理中心,由该处理
    中心使用所述数据驱动人体模型的相应部位运动,并将人体运动姿态虚拟再
    现出来。

    优选地,所述将人体各部位的姿态数据传输给姿态数据处理中心包括无
    线传输。

    本发明提供的一种运动姿态数据的获取装置包括:测量单元、地磁场强
    度传感单元和递归自回归滤波单元,所述测量单元、地磁场强度传感单元分
    别与递归自回归滤波单元电连接,其中:

    所述测量单元,用于测量运动物体的姿态数据;

    所述地磁场强度传感单元,用于记录运动物体处于第一测量航向角时的
    地磁场强度,该地磁场强度作为第一磁场强度,所述第一测量航向角的数值
    与所述运动物体的真实航向角的数值相同;当运动物体运动至第二测量航向
    角时,将所述运动物体所在位置对应的地磁场强度的方向回转α角度,所述
    α的数值为所述第二测量航向角与第一测量航向角之差,记录回转α角度后
    的位置的地磁场强度,该地磁场强度作为第二磁场强度;将所述第一磁场强
    度与第二磁场强度按照预设规则运算后得到磁场强度观测量;

    所述递归自回归滤波单元,用于将所述磁场强度观测量与所述运动物体
    的测量姿态数据进行递归自回归滤波得到所述运动物体的姿态数据。

    优选地,所述第一测量航向角为零度航向角。

    优选地,所述装置进一步包括动态调整单元,用于将所述磁场强度观测
    量与运动物体测量姿态数据进行递归自回归滤波时,分别统计分析所述磁场
    强度观测量和测量姿态数据的数据变化率和超量程时间百分比;将所述数据
    变化率与超量程时间百分比相乘分别得到第一动态调整系数和第二动态调整
    系数;将所述第一动态调整系数乘以获取所述磁场强度观测量时产生的观测
    噪声协方差得到更新后的观测噪声协方差;将所述第二动态调整系数乘以所
    述测量姿态时产生的激励噪声协方差得到更新后的激励噪声协方差;将所述
    更新后的观测噪声协方差和激励噪声协方差反馈给所述递归自回归滤波过
    程。

    优选地,所述递归自回归滤波单元为卡尔曼滤波器。

    本发明提供的一种人体运动姿态追踪系统包括:至少一个人体运动部位
    姿态数据获取装置、发送???、接收???、人体姿态重构??楹腿颂遄颂?br />现???,其中:

    所述人体运动部位姿态数据获取装置,用于收集人体各运动部位的姿态
    数据后将该数据传输给发送???;该装置包括测量单元、地磁场强度传感单
    元和递归自回归滤波单元,所述测量单元、地磁场强度传感单元分别与递归
    自回归滤波单元电连接,其中:

    所述测量单元,用于测量人体运动部位的姿态数据;

    所述地磁场强度传感单元,用于记录人体运动部位处于第一航向角时的
    地磁场强度,该磁场强度作为第一磁场强度,所述第一测量航向角的数值与
    所述运动物体的真实航向角的数值相同;当人体运动部位运动至第二测量航
    向角时,将所述运动物体所在位置对应的地磁场强度的方向回转α角度,所
    述α的数值为第二测量航向角与第一测量航向角之差,记录回转α角度后的
    位置的地磁场强度,该地磁场强度作为第二磁场强度;将第一磁场强度与第
    二磁场强度按照预设规则运算后得到磁场强度观测量;

    所述递归自回归滤波单元,用于将所述磁场强度观测量与所述人体运动
    部位的测量姿态数据进行递归自回归滤波得到所述人体运动部位的姿态数
    据;

    所述发送???,用于将所述人体运动姿态数据获取装置获取的人体各运
    动部位的姿态数据发送给所述人体姿态重构???;

    所述接收???,用于接收所述人体运动部位姿态数据获取装置的人体各
    运动部位的姿态数据;

    所述人体姿态重构???,将接收??榻邮盏娜颂甯髟硕课坏淖颂?br />用于驱动人体模型相应部位运动;

    所述人体姿态呈现???,用于虚拟再现人体的运动。

    优选地,该系统进一步包括第一无线通信单元和第二无线通信单元,所
    述发送??橥ü谝晃尴咄ㄐ诺ピ鋈颂甯髟硕课坏淖颂莘⑺透?br />所述人体姿态重构???;所述接收??橥ü诙尴咄ㄐ诺ピ邮账鋈颂?br />运动姿态数据获取装置获取的姿态数据。

    进一步优选地,所述第一无线通信单元集成于所述姿态数据发送??槟?;
    所述第二无线通信单元集成于所述姿态数据接收??槟?。

    本发明在现有技术基础上引入磁场强度,将磁场强度数据作为观测值与
    运动物体姿态的先验估计值进行递归自回归滤波,利用递归自回归滤波过程
    的递归收敛功能消除陀螺仪水平方向的累积误差,由此得到较为准确的航向
    角数据,从而实现运动物体姿态追踪。

    附图说明

    图1为本发明的方法进行运动姿态数据收集采用的坐标系统示意图;

    图2为本发明的方法实施例1的流程图;

    图3为本发明的方法实施例2的卡尔曼滤波过程示意图;

    图4为本发明的方法实施例4递归自回归滤波过程的动态调整示意图;

    图5为本发明的装置实施例5的组成框图;

    图6为本发明的装置实施例6的动态调整单元的组成框图;

    图7为本发明的系统实施例7的组成框图。

    具体实施方式

    本发明的主要思想是:在现有技术基础上收集地磁场强度数据作为观测
    值与运动物体测量姿态数据进行递归自回归滤波,利用递归自回归滤波过程
    的递归收敛功能消除陀螺仪水平方向的累积误差,由此得到较为准确的航向
    角数据,从而实现运动物体姿态追踪。

    磁场强度数据与运动物体测量姿态数据的递归自回归滤波有多种实现方
    式,本发明优选使用具有递归自回归滤波功能的卡尔曼滤波方法进行该处理
    过程。为便于详细阐释本发明的技术方案,先对卡尔曼滤波的工作原理进行
    简要介绍??ǘ瞬ㄊ且恢值莨樽曰毓槭荽硭惴?,它通过反馈控制的
    方法估计过程状态,对每次输出的状态结果进行循环修正,直至得到最优的
    过程状态数据??ǘ瞬煞殖闪礁鲅饭蹋菏奔涓鹿毯筒饬扛?br />过程,前者负责及时向前推算当前状态变量和误差协方差的估计值以构造下
    一个时间状态的先验估计;后者将先验估计和测量变量结合以构造改进的后
    验估计;时间更新过程可视为预估过程,测量更新过程可视为校正过程,整
    个估计算法实质是一种具有数值解的预估-校正算法??ǘ瞬ü炭捎萌?br />下的五个公式表达。

    公式1:由前一时刻系统状态估计现在时刻系统状态

    X(k|k-1)=AX(k-1|k-1)+BU(k)

    式中,X(k|k-1)是利用系统(k-1)时刻的系统状态估计的k时刻的系
    统状态,称为先验估计,X(k-1|k-1)是(k-1)时刻系统的最优状态
    值,U(k)是k时刻的系统控制输入量,A、B是系统参数,分别表示系统
    状态转移矩阵和外部激励输入矩阵。

    公式2:由前一时刻系统误差协方差估计现在时刻的系统误差协方差

    P(k|k-1)=AP(k-1|k-1)AT+Q

    式中,P(k|k-1)是利用系统(k-1)时刻的误差协方差估计的k时刻的
    系统误差协方差,Q是激励噪声协方差。

    根据公式1得到的系统k时刻的先验估计值X(k|k-1),再结合k时
    刻的测量值Z(k)即可推算出k时刻的系统状态最优值X(k|k),推算公
    式为:

    公式3:由先验估计值和测量值推算系统状态最优值

    X(k|k)=X(k|k-1)+K(k)[Z(k)-HX(k|k-1)]

    其中H为矩阵,是系统测量参数,表示状态变量增益,H矩阵把观测变
    量和状态变量关联起来;K(k)为卡尔曼增益,由公式4得到:

    K(k)=P(k|k-1)HT[HP(k|k-1)HT+R]-1

    式中的R为观测噪声协方差。

    公式5:由构造先验估计产生的估计协方差与卡尔曼增益推算将用于k
    +1时刻的误差协方差:

    P(k|k)=[I-K(k)H]P(k|k-1)

    式中,I为矩阵,对于单模型单测量,I=1。

    为使本领域技术人员能进一步了解本发明的特征及技术内容,下面结合
    附图和实施例,对本发明的技术方案进行详细描述。

    实施例一

    实现运动物体追踪需要知道运动物体姿态的参数描述(即运动物体在参
    考空间中的方位)。运动物体姿态通常通过与运动物体相固接的运动参考坐标
    系OXCYCZC与定参考坐标系OXYZ之间的夹角表示。两坐标系的原点均取
    在运动物体质心,定参考坐标系X轴水平指向东,Y轴水平指向北,Z轴垂
    直地面指向天顶;与运动物体相固接的运动参考坐标系的XC垂直运动物体
    运动方向指向右,YC轴沿着运动物体运动方向指向前方,ZC沿运动物体纵
    轴指向上方。定参考坐标系与运动参考坐标系的关系如图1所示。假设运动
    物体坐标系初始时与定参考坐标系原点重合,根据上述定义,运动物体的任
    意姿态均可通过下述三次转动得到:(1)绕Y轴旋转俯仰角θ;(2)绕X轴
    旋转横滚角Ψ;(3)绕Z轴旋转航向角φ。由此,要实现运动物体姿态追踪
    只需获得上述三个数据即可。三轴陀螺仪可用于测量这些数据,但是如前所
    述陀螺仪存在误差问题,测出的运动物体姿态数据(θ、Ψ、φ)会在短时
    间内偏离真实数值。在此基础上加入三轴加速度计可一定程度上消除陀螺仪
    测得的俯仰角θ和横滚角Ψ两个方面的累积误差。上述使用三轴陀螺仪收集
    数据定位运动物体姿态的方法称为“三自由度定位法”,使用三轴陀螺仪和三
    轴加速度计收集数据定位运动物体姿态的方法称为“六自由度定位法”。采用
    “六自由度定位法”尽管可以消除陀螺仪自身旋转带来的部分误差,但消除
    不了水平方向的累积误差,即航向角φ会在运动物体姿态数据测量过程中逐
    渐偏离真实值。本实施例在此基础上引入磁场仪,用于测量地磁场强度,并
    将该磁场强度数据作为观测值输入递归自回归滤波器中修正运动物体的测量
    姿态数据,进而减少和消除陀螺仪的累积误差,得到较为准确的姿态数据,
    实现运动物体的追踪。

    参见附图2,本实施例给出的运动物体姿态数据获取方法包括:

    步骤101:记录运动物体处于第一测量航向角时的地磁场强度,该地磁
    场强度作为第一磁场强度,所述第一测量航向角的数值与所述运动物体的真
    实航向角的数值相同;

    这里的第一测量航向角为基准航向角,在此位置角速度仪积分得出的测
    量姿态数据中的航向角φ与真实的航向角数值不发生偏差;该基准航向角通
    常选用零度航向角,实际上也可以是其他可以预先校准的航向角,只要保证
    角速度传感仪测量的航向角和实际航向角数值一致即可。

    步骤102:当所述运动物体运动至第二测量航向角时,将所述运动物体
    所在位置对应的地磁场的方向回转α角度,所述α的数值为第二测量航向角
    与第一测量航向角之差,记录回转α角度后的位置的地磁场强度,该地磁场
    强度作为第二磁场强度;

    第二测量航向角是角速度传感仪测得的航向角,该航向角由于角速度传
    感仪工作时的积分过程使得该测量航向角的数值与该位置的真实航向角的数
    值发生偏差;磁场传感仪可以客观地记录运动物体所在位置的磁场数据,包
    括该位置磁场强度大小和磁场强度的方向,得到该位置所在地磁场强度的方
    向后将该方向回转一定角度,这个角度是上述两个测量航向角数值之差,由
    于第二测量航向角和实际的航向角有偏差,旋转回去后必定与第一测量航向
    角有偏离,该偏离程度即可反应角速度传感仪积分导致的累积误差。

    步骤103:将所述第一磁场强度与第二磁场强度作差,得到磁场强度观
    测量;

    上述两个磁场强度求差结果可以衡量角速度传感仪水平方向累积误差,
    实际上,除作差方式外,也可以采用其他运算规则进行两个磁场强度数据的
    处理,比如求平方差、均方差等均可实现衡量误差的目的。

    步骤104:将所述磁场强度观测量与所述运动物体的测量姿态数据进行
    递归自回归滤波得到所述运动物体的姿态数据;

    所述运动物体的测量姿态数据是角速度传感仪积分得到的运动物体的姿
    态数据,该数据在进行本实施例所述步骤之前已经由加速度传感仪消除了横
    滚角和俯仰角的误差。

    本发明在现有技术基础上引入磁场强度,以第一测量航向角时的磁场强
    度为基准,将处于第二测量航向角的运动物体所在位置对应的地磁场强度的
    方向旋转回一定角度后记录该位置的磁场强度,然后将上述两个磁场强度求
    差值得到磁场强度观测量,进而使用该磁场强度观测量输入递归自回归滤波
    单元进行数据融合,融合过程修正了角速度传感仪积分得到的运动物体姿态
    数据,消除了水平方向的累积误差。

    实施例二

    上述实施例步骤104中提到递归自回归滤波的数据融合过程,实际上,
    运动物体姿态数据与磁场强度数据之间进行递归自回归滤波的具体实现方式
    有多种,本发明优选采用卡尔曼滤波算法实现该过程。参见附图3,卡尔曼
    滤波方法的数据融合过程为:

    运动物体M,在k-1时刻的姿态参数用四元数表示,四元数是利用一
    种超复数来等效反应向量转动。任何一个向量均可表示为一个实部与复数复
    合的四元数,比如:(其中w为常量),该式子中的参量满足如下
    关系:

    q=[w?x?y?z]2

    |q|2=w2+x2+y2+z2=1

    运动物体姿态的四元数构造基础数据来自于三轴角速度传感仪的测量
    数据。将测量得到的运动物体姿态的三个参数(θ、Ψ、φ)任意一个代入
    如下公式中即可构造一个四元数:

    w=cos(α/2)

    x=sin(α/2)cos(βx)

    y=sin(α/2)cos(βy)

    z=sin(α/2)cos(βz)

    其中:α是运动物体绕坐标轴旋转的角度,cos(βx)、cos(βy)cos(βz)为上述
    姿态参数在各个轴向的分量。运动物体M在k-1时刻的状态用四元数进行
    刻化(q1k-1|k-1,q2k-1|k-1,q3k-1|k-1,q4k-1|k-1)。三轴陀螺仪进行运动姿态数据
    测量时因各种原因存在误差引起测量值偏置,三轴陀螺仪三个测量方向的偏
    置估计为(qbias1k-1|k-1,qbias2k-1|k-1,qbias3k-1|k-1)。由运动物体三维姿态
    数据和对该数据的偏置估计共同构成状态变量,即本实施例中状态向量X(k
    -1|k-1)为七维向量,该状态变量在首次进行卡尔曼滤波时的初始数值
    可任意选取,因为卡尔曼滤波过程具有递归收敛功能,任意选取的初始状态
    对卡尔曼滤波的输出结果并不产生有意义的影响。

    由此,根据卡尔曼滤波的公式1,可以估计出运动物体M在k时刻的状
    态X(k|k-1)=X(k|k-1)=AX(k-1|k-1)+BU(k),即先验
    估计。构造先验估计的过程本身不可能绝对准确,这种不确定性大小一方面
    由于陀螺仪自身的旋转导致的数值偏离和漂移引起,一方面由先验估计中引
    入的激励噪声引起。这些偏差使用误差协方差表示,因此,接下来需要估计
    系统误差协方差以用于计算卡尔曼增益,进而用于更新状态变量。根据卡尔
    曼滤波的公式2,推算出k时刻的系统误差协方差P(k|k-1)=P(k|k
    -1)=AP(k-1|k-1)AT+Q。该误差协方差值在首次进行卡尔曼滤波器
    时可以任意选取,因为卡尔曼滤波递归收敛功能,任意选取的初始状态对卡
    尔曼滤波器的输出结果并不产生有意义的影响。得到k时刻的误差协方差后,
    结合磁传感器数值时的观测噪声误差协方差,根据卡尔曼滤波的公式4可计
    算出卡尔曼增益K(k)=P(k|k-1)HT[HP(k|k-1)HT+R]-1。
    获取k时刻的卡尔曼增益K(k)后,将磁传感器获取的磁场向量的观测值
    Z(k)代入卡尔曼滤波公式3中即可更新状态变量X(k|k)=X(k|k)
    =X(k|k-1)+K(k)[Z(k)-HX(k|k-1)]。到此,已完成卡尔
    曼滤波的一次循环,得到了进过修正的运动物体姿态数据。但是为了进行下
    一个循环,还需要更新系统的误差协方差,即根据卡尔曼滤波的公式5推算
    用于k+1时刻的误差协防差P(k|k)=[I-K(k)H]P(k|k-1)。

    上面的过程不断循环,通过磁场传感仪获得的磁场强度数据不断地对角
    速度传感仪积分输出的运动姿态数据进行反馈修正,由角速度传感仪积分产
    生的水平方向累积误差被消除,运动物体姿态的航向角数与真实值接近。

    实施例三

    上述实施例中,状态变量中的运动物体姿态参数描述使用的是四元数表
    示法。实际上对于运动物体姿态参数可直接使用欧拉角表示,甚至其他表示
    方法,不同的表示方法仅仅是形式上不同,通过数学规则这些表示方法均是
    可以相互转换的。下面给出四元数与欧拉角之间的转换公式。

    四元数到欧拉角的转换公式:


    上式中arctan和arcsin的结果是对于其他角度需要用atan2
    来代替arctan。即用下面的公式实现转换:


    欧拉角到四元数的转换公式:


    因此本发明并不限制运动物体姿态描述的具体数学形式,只要不妨碍本
    发明实现解决现有技术问题的目的即可。

    实施例四

    本发明引入地磁场强度传感仪可以如上述描述的方法解决陀螺仪累积误
    差的问题,但是地磁场强度传感仪具有一定的不稳定性,受外界磁场变化的
    影响较大。比如当外部磁场突然发生较大变化时,磁场传感仪获得的原始数
    据出现很大的变化,滤波器由于不知道这是外部磁场变化导致的结果,会按
    照正常的情况下更新状态方程,导致经过递归自回归后的运动物体姿态数据
    出现误差?;贡热?,磁传感器如果发生超量程时也可能导致获取的运动物体
    姿态数据出现误差。为使递归自回归滤波具有较强的自适应特性,本发明的
    实施例进一步采取动态调整措施,消除上述可能出现的误差。本实施例的递
    归自回归滤波仍然采用卡尔曼滤波。

    参加附图4所示。本实施例的动态调整过程通过更新卡尔曼滤波器的观
    测噪声协方差矩阵R与激励噪声协方差矩阵Q进而调节置信区间度范围的方
    式实现。动态调整的具体过程如下:

    激励噪声协方差矩阵Q与观测噪声协方差矩阵R需在每次循环时分别乘
    以各自的动态调整参数,动态调整参数与传感仪的数据变化率和超过量程时
    间的百分比率的乘积成反比关系。下面用数学式表示该过程:设角速度传感
    仪测量的姿态数据的数据变化率为α1和超量程时间百分比为β1,磁场传感仪
    观测的磁场强度数据的数据变化率为α2,超量程时间百分比为β2,则:

    D1=1/α1β1????D2=1/α2β2

    Q′k=D1Qk??????R′k=D2Rk

    式中,α1、α2通过对所述数据求导得到;β1、β2为预设时间间隔内传感
    仪测量数据达到或者超过量程的时间比率,通过统计预设时间间隔内测量数
    据达到或超过量程的时间占该预设间隔总时间的百分比率得到。

    将上述经过动态调整的激励噪声协方差矩阵Q与观测噪声协方差矩阵R
    代入卡尔曼滤波器,经过卡尔曼滤波器的递归收敛功能即可克服上述技术问
    题。

    实际上,本实施例中传感仪测量数据时遇到的技术问题在运动姿态测量
    系统中加速度传感仪中同样存在:(1)当目标物体运动状态由缓慢变化跳跃
    为快速变化或者相反时,滤波器状态适应性变化滞后,这样运动状态系统的
    直接测量结果误差增大;(2)当目标物体运动姿态处于较大变化范围时,极
    有可能接近甚至超出传感器的最大量程范围,这样传感仪测量的原始数据将
    会偏离真实运动状况,导致测量中断或者测量结果失效。这些技术问题同样
    可以采取本实施例的方法进行解决:以传感仪的数据变化率和达到或超过满
    量程的时间比率为参数对相应传感仪的置信区间[-D,+D]进行反馈控制:
    传感仪数据的变化率越大,置信空间越小,置信度越低;达到或超量程的时
    间越多,置信空间越小,置信度越低。

    实施例五

    附图5是本发明装置500的实施例的组成框图。在本实施例中,运动姿
    态数据获取装置包括测量单元501,该单元包括三轴角速度传感单元5011、
    三轴加速度传感单元5012,三轴地磁场强度传感单元502以及递归自回归滤
    波单元503组成,测量单元501、三轴地磁场强度传感单元502分别与递归
    自回归滤波单元503电连接,测量单元501用于测量运动物体的姿态数据,
    并将这些数据传送给递归自回归单元503,三轴地磁场强度传感单元502用
    于获取磁场强度数据,并将该数据传送给递归自回归单元503。

    本实施例给出的装置500的工作过程如下:预选建立运动物体姿态测量
    的工作坐标系,这样的坐标系如实施例一所述,此处不在赘言。然后对运动
    物体姿态数据的进行收集和转换:在上述坐标系中三轴陀螺仪5011收集运动
    物体XYZ三个轴向的数据,三轴加速度传感单元5012收集运动物体重力方
    向上加速度数据,这六个数据用四元数法转换后作为运动物体姿态的参数描
    述(航向角、俯仰角、滚转角);三轴地磁场强度传感单元502设定第一测量
    航向角时的磁场向量作为参考向量,以此为基准收集磁场强度数据。将处于
    第二测量航向角位置的运动物体对应的地磁场方向旋转两个航向角差值大小
    的角度,并记录该旋转后的位置的磁场强度数据,这两个磁场强度之差反应
    了角速度传感单元5011的可能偏差。接下来将这些数据输入到递归自回归滤
    波单元503中,进行数据融合处理,由于递归自回归滤波单元503具有递归
    收敛功能,输入该单元的数据被逐步优化,最后输出最优的运动物体姿态数
    据。

    本实施例在现有技术基础上引入三轴地磁场强度传感单元,将第一测量
    航向角时运动物体所在位置对应的磁场强度作为基准,将第二测量航向角时
    运动物体所在位置对应的地磁场的方向旋转两个航向角之差的角度大小,记
    录回转后的位置的磁场强度,将该磁场强度相对于基准磁场强度的大小作为
    磁场强度观测值,并将该磁场强度观测值输入递归自回归单元进行数据融合,
    从而消除了角速度传感单元的累积误差,递归自回归单元输出的数据也较为
    真实地反应了运动物体的姿态,进而可以实现运动物体的准确追踪。

    本实施例中的角速度传感单元包括陀螺仪传感器,加速度传感单元包括
    加速度计,地磁场强度传感单元包括磁场计。上述实施例中的递归自回归单
    元可以是一切具有同样滤波功能的电子元件,本发明优选卡尔曼滤波器实现
    该过程??ǘ瞬ü倘缟鲜鍪凳├?所示,这里不在重复叙述。

    实施例六

    如前所述,角速度传感单元和地磁场强度传感单元具有一定的不稳定性,
    受外界磁场变化的影响较大。为使递归自回归滤波单元具有较强的自适应特
    性,本发明的实施例进一步采取动态调整措施。上述实施例中,还可以包括
    动态调整单元604,用于动态调整卡尔曼滤波过程中的观测噪声协方差矩阵
    与激励噪声协方差矩阵,将调整后的协方差矩阵输入递归自回归滤波单元
    603。参见附图6所示,本实施例的动态调整单元604包括数据统计分析单元
    6041、动态系数计算单元6042和协方差变换单元6043,其中:

    数据统计分析单元6041用于分别统计分析所述磁场强度观测量和测量
    姿态数据得到数据变化率和超过量程时间百分比;

    动态系数计算单元6042用于将所述数据变化率与超量程时间百分比相
    乘分别得到第一动态调整系数和第二动态调整系数;

    协方差变换单元6043用于将所述第一动态调整系数乘以获取所述磁场
    强度观测量时产生的观测噪声协方差得到更新后的观测噪声协方差;将所述
    第二动态调整系数乘以所述测量姿态数据时产生的激励噪声协方差得到更新
    后的激励噪声协方差;将所述更新后的观测噪声协方差和激励噪声协方差反
    馈给所述递归自回归过程。

    将上述经过动态调整的激励噪声协方差矩阵Q与观测噪声协方差矩阵R
    代入卡尔曼滤波器,经过数据融合单元的递归收敛功能克服了角速度传感单
    元和磁场传感单元的不稳定性。

    实际上,本实施例中角速度传感单元和磁场传感单元测量数据时遇到的
    技术问题在运动姿态测量系统中加速度传感单元中同样存在,解决的方式与
    上述过程类似,这里不再重复。

    实施例七

    附图7是本发明提供的人体运动姿态追踪系统实施例的组成框图。本实
    施例的系统700包括至少一个人体运动部位姿态数据获取装置701、发送模
    块702、接收???03和人体姿态重构???04和人体姿态呈现???05;其
    中,人体运动部位姿态数据获取装置701如实施例三所述,用于实现人体运
    动部位姿态数据的获??;发送???02与人体运动部位姿态数据获取装置701
    电连接,用于将人体运动姿态数据获取装置701获取的姿态数据通过接收模
    块703发送给人体姿态重构???04;接收???03与人体姿态重构???04
    电连接,用于接收人体运动姿态数据获取装置701通过发送???02发送的
    姿态数据;人体姿态重构???04,将接收的人体各运动部位的姿态数据用
    于驱动人体模型相应部位运动;人体姿态呈现???05,用于虚拟再现人体
    的运动。本系统的工作步骤如下:

    步骤S701:人体运动部位姿态数据获取装置701根据权利要求1所述的
    方法获取人体各运动部位的姿态数据;该装置701至少包括一个,预先固着
    在人体的各个运动部位上,具体固着的部位根据实际需要选择,可以是人体
    主要关节点,这些关节点最能反映出人体的运动姿态;

    步骤S702:将步骤S701获得的人体各运动部位的运动姿态数据通过发
    送???02传输给人体姿态重构???04;

    步骤S703:人体姿态重构???04通过接收单元703接收到所述人体各
    部位运动姿态数据后,驱动人体模型中的各相应部位运动;

    步骤S704:人体运动呈现???05将人体姿态虚拟再现出来。

    本实施例中姿态数据在人体运动姿态数据获取装置701与人体姿态重构
    ??橹浯涑梢允怯邢叻绞酵?,本发明优选无线方式传输。无线传输时
    本实施例的系统进一步包括第一无线通信单元706和第二无线通信单元707,
    由此两个单元来实现数据的无线传输。第一无线通信单元706可以作为单独
    的??橛胱颂莘⑺偷ピ?02电连接,也可以集成在姿态数据发送???02
    内。同样地,本实施例中的第二无线通信单元707可以作为单独的??橛胱?br />态数据接收???03电连接,也可以集成在姿态数据接收???03内,本发
    明提供的实施例对这两个??榈牧臃绞讲蛔飨薅?。至于具体的无线连接的
    实现方式可以采用蓝牙、WIFI或者下一代通信网络LTE等,所使用的传输
    协议可以是基于IEEE802.15.4的上层星型协议,也可以是其他实现无线连接
    方式的传输协议,均不妨碍本实施例发明目的的实现。

    本实施例给出了人体运动姿态追踪的完整系统,该系统采用了实施例三
    所述的装置,解决了陀螺仪累积误差的问题。同时,本实施例通过发送???br />702与接收???03之间的无线连接,实现了运动姿态全方位无限制测量,
    扩大了运动姿态追踪系统的使用范围。

    以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明
    的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在发明
    的?;し段е?。

    关于本文
    本文标题:运动姿态数据获取、人体运动姿态追踪方法及相关设备.pdf
    链接地址://www.4mum.com.cn/p-5878638.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
  • 时时彩下一期计算方法 秒速时时开奖平台 pk10技巧规律 聚富影视软件下载 浙江大乐透基本走势图 飞禽走兽技巧规律 万人棋牌官网下载 什么是飞艇计划 时时缩水软件免费版 七星彩中奖规则 澳门赌城手机投注平台 幸运28全包稳赚 pk10两期计划 夫人猛料六肖中特 一千本金八期倍投方案 重庆时时投注技巧