CN104613963B - 基于人体运动学模型的行人导航系统与导航定位方法 - Google Patents
基于人体运动学模型的行人导航系统与导航定位方法 Download PDFInfo
- Publication number
- CN104613963B CN104613963B CN201510037160.8A CN201510037160A CN104613963B CN 104613963 B CN104613963 B CN 104613963B CN 201510037160 A CN201510037160 A CN 201510037160A CN 104613963 B CN104613963 B CN 104613963B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mover
- munderover
- centerdot
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 35
- 210000003141 lower extremity Anatomy 0.000 claims abstract description 58
- 230000033001 locomotion Effects 0.000 claims abstract description 36
- 238000004364 calculation method Methods 0.000 claims abstract description 17
- 210000000689 upper leg Anatomy 0.000 claims abstract description 8
- 210000002683 foot Anatomy 0.000 claims description 33
- 230000000694 effects Effects 0.000 claims description 25
- 238000005259 measurement Methods 0.000 claims description 24
- 238000012937 correction Methods 0.000 claims description 21
- 210000002414 leg Anatomy 0.000 claims description 19
- 210000001624 hip Anatomy 0.000 claims description 17
- 230000003068 static effect Effects 0.000 claims description 16
- 230000000712 assembly Effects 0.000 claims description 14
- 238000000429 assembly Methods 0.000 claims description 14
- 210000003414 extremity Anatomy 0.000 claims description 14
- 230000001133 acceleration Effects 0.000 claims description 12
- 239000013598 vector Substances 0.000 claims description 12
- 239000011159 matrix material Substances 0.000 claims description 10
- 210000003423 ankle Anatomy 0.000 claims description 8
- 238000006243 chemical reaction Methods 0.000 claims description 7
- 238000004891 communication Methods 0.000 claims description 7
- 230000005484 gravity Effects 0.000 claims description 7
- 210000004394 hip joint Anatomy 0.000 claims description 7
- 210000003127 knee Anatomy 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 6
- 238000012546 transfer Methods 0.000 claims description 6
- 230000005540 biological transmission Effects 0.000 claims description 5
- 210000001503 joint Anatomy 0.000 claims description 5
- 210000003205 muscle Anatomy 0.000 claims description 5
- 238000004422 calculation algorithm Methods 0.000 claims description 4
- 210000000544 articulatio talocruralis Anatomy 0.000 claims description 3
- 210000000629 knee joint Anatomy 0.000 claims description 3
- 238000007619 statistical method Methods 0.000 claims description 3
- 210000002303 tibia Anatomy 0.000 claims description 3
- 238000005516 engineering process Methods 0.000 abstract description 4
- 238000009434 installation Methods 0.000 description 6
- 210000001699 lower leg Anatomy 0.000 description 3
- 238000005070 sampling Methods 0.000 description 3
- 230000007704 transition Effects 0.000 description 3
- 238000010276 construction Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 230000005021 gait Effects 0.000 description 2
- 230000005389 magnetism Effects 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 210000000988 bone and bone Anatomy 0.000 description 1
- 244000309466 calf Species 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- YHXISWVBGDMDLQ-UHFFFAOYSA-N moclobemide Chemical compound C1=CC(Cl)=CC=C1C(=O)NCCN1CCOCC1 YHXISWVBGDMDLQ-UHFFFAOYSA-N 0.000 description 1
- 238000010606 normalization Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 210000002027 skeletal muscle Anatomy 0.000 description 1
- 239000002344 surface layer Substances 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/08—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Navigation (AREA)
- Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)
Abstract
本发明公开了一种基于人体运动学模型的行人导航系统与导航定位方法，属于生物动力学与惯性导航技术相结合的领域。本发明利用人体运动中下肢(包括足部、小腿、大腿，髋部)以及连接它们的各个关节之间的运动学规律构建虚拟惯性传感器组件，并实时修正该虚拟惯性传感器组件以及行人导航系统的各项误差，能实现人体运动中的精确导航定位。本发明方法在人体高过载运动中，可有效克服测量信息超量程、冲击信号等对导航解算的影响，具有较高的实时定位性能。
Description
技术领域
本发明涉及一种基于人体运动学模型的行人导航系统与导航定位方法，属于生物动力学与惯性导航技术领域。
背景技术
行人导航是导航定位领域中的一个重要分支。行人导航系统可实时确定并监测个人的位置以及人体的运动状态，从而有效地提高军事作战人员、抢险搜救人员的快速反应能力，以及提供民用背景下行人实时、精确的定位信息，具有广阔的军事与民用应用前景。
基于惯性技术的行人导航技术始于上世纪九十年代，主要应用于美国等发达国家的未来士兵系统，该类技术中行人导航系统通常采用基于微惯性/地磁测量组件足部安装的系统结构，系统经无干扰磁环境中磁传感器误差标定与补偿后进行初始对准，之后导航系统进入导航工作状态，通过人体步态相位检测对导航系统进行间断性的零速修正，估计导航系统级误差以及陀螺仪与加速度计的部分漂移误差，但该方法无法有效地估计与修正航向误差，因此磁航向的精度对于行人导航系统的性能具有至关重要的作用。在上述研究中发现，人体运动中足部在常规动作中的加速度与角速度是人体躯干的3-5倍，在剧烈运动中甚至可达10倍。目前的中低精度惯性传感器件无法兼顾测量精度与量程间的矛盾，而这两个因素都是决定行人导航系统性能的重要因素，人体运动状态下的实时定位对惯性传感器量程与精度的综合性能提出了很高的要求。
发明内容
为了克服现有技术的缺点，本发明提供了一种基于人体运动学模型的行人导航系统与导航定位方法，将惯性传感组件分布式地安装于人体髋部与下肢，在人体高过载运动中可有效克服测量信息超量程、冲击信号等对导航解算的影响，具有较高的实时定位性能。
本发明解决其技术问题所采用的技术方案是：
基于人体运动学模型的行人导航系统，所述行人导航系统包括惯性传感组件和微型导航计算机，所述惯性传感组件包括惯性与地磁测量单元以及惯性测量单元，其中，一组惯性与地磁测量单元安装于人体躯干髋部，多组惯性测量单元分别安装于双腿，微型导航计算机安装在人体躯干上，所述微型导航计算机与惯性传感组件之间通过电缆或无线通讯完成数据传输。
利用所述的基于人体运动学模型的行人导航系统的导航定位方法：躯干的惯性与地磁测量单元以及下肢的惯性测量单元通过确定足部零力矩点实现下肢各级杆臂效应补偿，并结合关节坐标系的肌肉骨骼间附着点坐标转换实现陀螺仪所测量的角速度的转换，从而构成足部虚拟惯性传感组件，通过该虚拟惯性传感组件完成行人导航过程。其具体步骤如下：
(一)惯性传感组件的信号采集：
同步采集各组惯性传感组件的输出信号，得到各组角速度、比力和磁场强度，并将信号传输给微型导航计算机；
(二)惯性传感组件的随机误差的实时建模与校正：
首先对零位偏置的特性进行统计分析，分别建立符合陀螺仪与加速度计的零位偏置趋势项，在陀螺仪与加速度计的信号输出端加入零位偏置趋势项校正；分别建立陀螺仪与加速度计的随机误差模型，将经过零位偏置趋势项建模与校正步骤后的陀螺仪与加速度计输出作为观测量，将陀螺仪与加速度计的理论输出估计值作为状态量，建立基于随机误差模型的卡尔曼滤波器，分别实时估计陀螺仪与加速度计的理论输出估计值；
(三)惯性传感组件的初始对准：
该步骤同步应用于每组惯性传感组件，在微型导航计算机中进行；系统启动后在静态条件下，利用步骤(二)中加速度计的理论输出估计值，在微型导航计算机中通过水平自对准得到惯性传感组件初始横滚角与俯仰角，并将磁强计的信号输出通过通讯模块传送至微型导航计算机，得到惯性传感组件的初始航向角，水平自对准的公式为：
其中，θ为俯仰角，γ为横滚角，g为重力加速度，与分别为加速度计理论输出估计值在载体坐标系中投影的x与y轴分量；
(四)人体下肢零力矩点位置的确定：
为实现下肢杆臂效应动态补偿，首先须得到人体运动中位于足底的下肢零力矩点；人体运动中支撑腿可视为动态杆臂，以下肢零力矩点为原点进行转动来实现人体质心的移动，下肢零力矩点关于下肢质心位置、各关节的角度、角速度和角加速度的表达式：
式中，qi为连杆i与z方向的夹角，li、di分别为连杆i的长度及其质心到关节的距离，G为人体所受重力；从该公式可知，下肢零力矩点的位置由各关节的角度qi、角速度和角加速度的函数，这些物理量均可通过安装于下肢的惯性测量单元测量与计算得到；
(五)虚拟惯性传感组件的构建与杆臂效应动态补偿：
基于步骤(四)的原理，可在人体运动中实时计算支撑腿上零力矩点的精确位置，结合下肢各肢节的惯性参数，即可实时补偿足部至髋关节的杆臂效应；而支撑腿的零力矩点位置可视为一个静态的虚拟惯性传感器组件，该组件在足部静止相位中的速度与角速度均为0，其器件误差也可视为0，暂忽略人体运动中下肢肌肉与脂肪等所引起的肢体变形，各关节处的杆臂效应补偿公式如下：
fn＝fn-1-ωn-1×(ωn-1×Rn-1),n＝1,2,3,4
其中，踝关节处比力f1由零力矩点位置比力f0结合足部运动角速度ω0与零力矩点位置距踝关节的距离R0进行补偿；膝关节处的比力f2由踝关节处比力f1结合踝关节运动角速度ω1与胫骨长度R1进行补偿；髋关节处的比力f3由膝关节处比力f2结合膝关节运动角速度ω2与股骨长度R2进行补偿；躯干部位的比力f4由髋关节处比力f3结合髋关节运动角速度ω3与惯性测量组件和髋关节之间的位置矢量R3补偿；若要在腿部任意位置的惯性测量组件之间进行杆臂效应的补偿，可将R1、R2与R3替代成惯性测量组件与相应关节之间的距离即可；
(六)虚拟捷联惯性导航系统的惯性导航解算：
该步骤应用于虚拟惯性传感组件所构成的虚拟捷联惯性导航系统，虚拟捷联惯性导航系统的惯性导航解算步骤分为姿态解算与速度、位置解算；
(七)虚拟捷联惯性导航系统的零速修正：
该步骤应用于虚拟捷联惯性导航系统，在微型导航计算机中进行，求解加速度计输出经步骤(二)中建模与校正后的理论输出估计值的三轴矢量和，通过判断该值是否接近重力来检测人体足部是否处于着地时间段，并利用着地时间段相对地面静止的特点进行间断式的零速修正，即根据虚拟捷联惯性导航系统误差与虚拟惯性传感组件误差建立系统状态方程与观测方程，实现人体行走中的零速修正，实时修正虚拟捷联惯性导航系统的误差与虚拟惯性传感组件误差。
所述步骤(六)的具体步骤为：
(1)虚拟惯性导航系统的姿态解算：基于虚拟惯性传感器组件中的三轴陀螺仪，采用四元数法进行姿态解算；
(2)虚拟惯性导航系统的速度、位置解算：把虚拟惯性传感器组件中的三轴加速度计原始输出通过姿态转移矩阵转换到导航坐标系中，记为 从而可以解算出人体足部在地理系中的速度，其微分方程为：其中，fn为加速度计理论输出估计值在导航坐标系中的投影，为地球自转角速度在导航坐标系中的投影，为导航坐标系相对于地球坐标系的角速度在导航坐标系中的投影，可通过行进中的速度在导航坐标系中的投影求得，将上式移项并展开得：
式中，分别是在东向、北向和地向的投影分量，Ve、Vn、Vd分别是东向、北向和地向的速度分量，λ、L分别为当地的经度与纬度，g为当地重力加速度；
利用Ve、Vn、Vd并结合上个时刻人体的纬度、经度、高度与速度，求解当前时刻导航坐标系相对于惯性坐标系的角速度在导航坐标系中的投影以及当前时刻载体的纬度L、经度λ、高度h，完成整个虚拟捷联惯性导航系统的算法流程。
本发明利用人体运动中下肢(包括足部、小腿、大腿，髋部)以及连接它们的各个关节之间的运动学规律构建虚拟惯性传感器组件，并实时修正该虚拟惯性传感器组件以及行人导航系统的各项误差，能实现人体运动中的精确导航定位。本发明方法解决了在快速步态下由于人体下肢的运动会超出传感器组件的量程，以及肢体出现冲击、振动等现象时，现有行人导航系统无法有效实现导航定位的问题，并且在人体高过载行进中可有效克服测量信息超量程、冲击信号等对导航解算的影响，具有较高的实时定位性能。
附图说明
图1为行人导航系统惯性传感组件安装位置示意图；1-惯性传感组件安装位置(躯干与右腿)，2-惯性传感组件安装位置(左腿)。
图2为行人导航系统原理与流程图，其中，IMMU为惯性与地磁测量单元，IMU为惯性测量单元；
图3为人体下肢运动学模型在人体侧平面的投影图。
具体实施方式
下面结合附图对本发明进一步说明。
如图1所示，基于惯性传感组件分布式安装的的行人导航系统：惯性传感组件(包括惯性与地磁测量单元以及惯性测量单元)在人体躯干与下肢的分布式安装，其中，一组惯性与地磁测量单元安装于人体躯干髋部位置，实际应用中可都采用中低精度的惯性与地磁测量单元，如MPU-6050型传感组件等；四组惯性测量单元分别安装于双腿的大腿与小腿质心位置附近，也可进一步在人体双脚分别安装一组惯性传感组件；微型导航计算机可安装于人体躯干，与上述传感器组件之间通过电缆连接，或采用无线通讯完成数据传输。
此外，人体下肢骨肌系统模型中骨骼附近的点表示接近肢体质心的肌肉表层，即惯性测量组件的安装位置；而微型导航计算机安装于躯干时其位置无特定要求。
如图2所示，基于人体下肢运动学机理的行人导航方法：其中，IMMU为惯性与地磁测量单元，IMU为惯性测量单元，躯干的惯性与地磁测量单元与下肢的惯性测量单元通过确定足部零力矩点实现下肢各级杆臂效应补偿，并结合关节坐标系的肌肉骨骼间附着点坐标转换实现陀螺仪所测量的角速度的转换，从而构成足部虚拟惯性传感组件，通过该虚拟惯性传感组件完成行人导航过程，具体步骤如下：
1)确定人体运动中的下肢零力矩点：人体运动中支撑腿可视为动态杆臂，该杆臂以下肢零力矩点为原点进行转动来实现人体质心的移动。由于常规运动中人体下肢运动中围绕各关节进行较低速的转动，可忽略各肢节转动惯量的影响。在此前提下，可根据人体下肢运动学方程得到足部零力矩点关于下肢质心位置与加速度、各关节的角度、角速度以及角加速度的表达式，通过分布式安装于人体躯干与下肢的惯性传感组件的输出，确定人体运动中的下肢零力矩点。
2)基于多级杆臂效应动态补偿方法的虚拟惯性传感组件构建机理：支撑腿的下肢零力矩点位置可视为安装了一个静态的虚拟惯性传感器组件，该组件在足部静止相位中的速度与角速度均为0。本发明中暂忽略人体运动中下肢肌肉与脂肪等所引起的肢体变形，利用下肢各肢节的惯性参数，通过多级传递对准基本原理可实现对髋部惯性传感组件的杆臂效应补偿，从而得到虚拟惯性传感器组件的实时输出。
3)基于虚拟惯性传感组件实现行人导航定位：对分布式结构的导航系统中的各惯性传感组件进行误差在线标定、初始对准，在人体步行运动中通过人体下肢运动检测方法来判断足部虚拟惯性传感组件是否处于静止相位，并在静止相位中通过零速修正技术实时修正其导航定位与虚拟惯性传感器的误差，从而完成行人导航定位功能。
本实施例导航定位方法的具体步骤如下：
1、惯性传感组件的信号采集：
同步采集各组惯性传感组件中陀螺仪、加速度计及磁传感器的输出信号，得到各组角速度、比力和磁场强度，并将信号通过通信电缆传输给安装于躯干的以DSP为处理器的微型导航计算机。
2、惯性传感组件的随机误差的实时建模与校正：
对于每组惯性传感组件，在陀螺仪与加速度计的零位偏置随时间变化较明显的情况下，首先均对零位偏置的特性进行统计分析，分别建立符合陀螺仪与加速度计的零位偏置趋势项，确定陀螺仪与加速度计的零偏趋势项模型后，在陀螺仪与加速度计的信号输出端加入零偏趋势项校正，对数据的零偏趋势项进行实时校正。
对校正趋势项后的陀螺仪与加速度计分别建立随机误差模型(如求和自回归滑动平均模型ARIMA模型)，将经过零偏趋势项建模与校正步骤后的陀螺仪与加速度计输出作为观测量，将陀螺仪与加速度计的理想输出估计值作为状态量，建立基于随机误差模型的卡尔曼滤波器，分别实时估计陀螺仪与加速度计的理论输出。
将惯性传感组件的理论输出估计值作为初始对准、捷联惯性导航、多级杆臂效应补偿以及虚拟惯性传感组件零速修正等步骤的数据来源。
3、惯性传感组件的初始对准：
该步骤同步应用于每组惯性传感组件，在微型导航计算机中进行，系统启动后在静态条件下，利用步骤2中加速度计的理论输出估计值，在微型导航计算机中通过水平自对准得到惯性传感组件初始横滚角与俯仰角，并将磁强计的信号输出通过通讯模块传送至微型导航计算机，得到惯性传感组件的初始航向角，水平自对准的公式为：
其中，θ为俯仰角，γ为横滚角，g为重力加速度，与分别为加速度计理论输出估计值在载体坐标系中投影的x与y轴分量。
4、人体下肢零力矩点位置的确定：
为实现下肢杆臂效应动态补偿，首先须得到人体运动中位于足底的下肢零力矩点，该位置决定了杆臂效应补偿的起始点。人体运动中支撑腿可视为动态杆臂，该杆臂以下肢零力矩点为原点进行转动来实现人体质心的移动。由于常规运动中人体下肢运动中围绕各关节进行较低速的转动，可忽略各肢节转动惯量的影响。人体下肢(包括足部、小腿、大腿，髋部)以及连接它们的各个关节的运动学模型在人体侧平面的投影如图3所示。
在此前提下，根据生物动力学领域通用的人体运动学方程，下肢零力矩点关于下肢质心位置、各关节的角度、角速度和角加速度的表达式：
式中，qi为连杆i与z方向的夹角，li、di分别为连杆i的长度及其质心到关节的距离，G为人体所受重力。从该公式可知，下肢零力矩点的位置由各关节的角度qi、角速度和角加速度的函数等决定，这些物理量均可通过安装于下肢的微惯性测量组件测量和计算得到。
5、虚拟惯性传感组件的构建与杆臂效应动态补偿
基于步骤4中确定下肢零力矩点位置的基本原理，可在人体运动中实时计算支撑腿上零力矩点的精确位置，结合下肢各肢节的惯性参数，即可实时补偿足部至髋关节的杆臂效应；而支撑腿的零力矩点位置可视为一个静态的虚拟惯性传感器组件，该组件在足部静止相位中的速度与角速度均为0，为简化计算过程其器件误差也可视为0。利用该位置的虚拟惯性传感组件与下肢的运动学信息，可通过传递对准基本原理实现对髋关节位置惯性系统的杆臂效应补偿，并实现对系统误差的实时修正。本研究中暂忽略人体运动中下肢肌肉与脂肪等所引起的肢体变形，各关节处的杆臂效应补偿公式如下：
fn＝fn-1-ωn-1×(ωn-1×Rn-1),n＝1,2,3,4 (4)
其中，踝关节处比力f1由零力矩点位置比力f0结合足部运动角速度ω0与零力矩点位置距踝关节的距离R0进行补偿；膝关节处的比力f2由踝关节处比力f1结合踝关节运动角速度ω1与胫骨长度R1进行补偿；髋关节处的比力f3由膝关节处比力f2结合膝关节运动角速度ω2与股骨长度R2进行补偿；躯干部位的比力f4由髋关节处比力f3结合髋关节运动角速度ω3与惯性测量组件和髋关节之间的位置矢量R3补偿。若要在腿部任意位置的惯性测量组件之间进行杆臂效应的补偿，可将R1、R2与R3替代成组件与相应关节之间的距离即可。
6、虚拟捷联惯性导航系统的惯性导航解算
该步骤应用于虚拟惯性传感组件所构成的虚拟捷联惯性导航系统。虚拟捷联惯性导航系统的惯性导航解算步骤分为姿态解算和速度、位置解算。
(1)姿态解算
虚拟捷联惯性导航系统的姿态解算有欧拉角法、方向余弦法和四元数法，而四元数法具有可以全姿态工作、计算工作量小等特点，故本发明采用四元数法进行姿态解算，主要步骤如下：
1)载体相对导航坐标系角速度的计算：
其中，为MEMS陀螺仪输出的理论估计值，可通过行进速度在导航坐标系中的投影、地球自转角速度ωie以及上个周期的姿态转移矩阵求得。
2)四元数微分方程的求解：
四元数微分方程的离散化形式，即四元数迭代计算公式如下：
其中，为规范化后的四元数，为相互正交的单位矢量；l为四元数算法计算的单位时间间隔；ω1、ω2、ω3分别为在一次姿态解算周期内对MEMS陀螺仪输出角速度的3次采样值，即采用3子样采样方法补偿陀螺非定轴转动时角速度矢量积分产生的计算误差，MEMS陀螺仪采样周期为h。
上式中，[]表示向量的矩阵扩展，ΔΦ0 2＝ΔΦx 2+ΔΦy 2+ΔΦz 2。
3)四元数规范化：
姿态解算中计算误差的存在使得计算的变换四元数的范数不再等于1，即计算的四元数失去规范性，因此对计算的四元数必须周期性地进行规范化处理。设为直接由四元数微分方程计算得到的四元数，而设规范化后的四元数为其中为相互正交的单位矢量，利用最小二乘判据可以求得最优规范化的变换四元数,公式如下：
4)由四元数计算姿态转移矩阵
依据四元数表示的固定矢量之间的变换关系，可获得四元数与方向余弦矩阵的关系为：
5)由姿态转移矩阵提取姿态角：
其中，θ、γ、φ分别为捷联惯性导航系统的俯仰角、横滚角和航向角；c'11、c'12、c'13、c'21、c'22、c'23、c'31、c'32、c'33分别为姿态转移矩阵对应行列位置的各元素，即c11'＝cosγcosφ+sinγsinθsinφ、c12'＝cosθsinφ、c13'＝-sinγcosφ-cosγsinθsinφ、c21'＝-cosγsinφ+sinγsinθcosφ、c22'＝cosθcosφ、c23'＝-sinγsinφ-cosγsinθcosφ、c31'＝-sinγcosθ、c32'＝sinθ、c33'＝cosγcosθ。
(2)速度、位置解算：
虚拟捷联惯性导航系统的速度解算中，由于加速度计固连在MEMS惯性测量组件上，它的输出是载体相对于惯性空间的比力在载体坐标系中的投影，因此需要把加速度计原始输出通过姿态转移矩阵转换到导航坐标系中，记为即
从而可以解算出载体在地理系中的速度，其微分方程为：
其中，fn为MEMS加速度计理论输出估计值在导航坐标系中的投影，为地球自转角速度在导航坐标系中的投影，为导航坐标系相对于地球坐标系的角速度在导航坐标系中的投影，可通过行进中的速度在导航坐标系中的投影求得。将上式移项并展开得：
式中，分别是在东向、北向和地向的投影分量，Ve、Vn、Vd分别是东向、北向和地向的速度分量，λ、L分别为当地的经度与纬度，g为当地重力加速度。
利用Ve、Vn、Vd并结合上个时刻载体的纬度、经度、高度与速度，求解当前时刻导航坐标系相对于惯性坐标系的角速度在导航坐标系中的投影以及当前时刻载体的纬度L、经度λ、高度h，完成整个MEMS捷联惯性导航系统的算法流程。
7、虚拟捷联惯性导航系统的零速修正：
该步骤应用于虚拟捷联惯性导航系统，在微型导航计算机中进行，求解加速度计输出经步骤2误差建模与校正后的估计值的三轴矢量和，通过判断该值是否接近重力来检测人体足部是否处于着地时间段，并利用着地时间段相对地面静止的特点进行间断式的零速修正，即根据惯性导航系统误差与惯性器件误差特性误差建立状态方程：
式中，误差状态量其中δVN、δVE为水平速度误差沿北、东方向的分量，φN、φE、φD为平台误差角在北、东、地方向的分量；分别为加速度计的常值零偏在载体坐标系中x、y方向的分量；εx、εy、εz分别为陀螺零位常值漂移在载体坐标系中x、y、z方向的分量；状态转移矩阵其中，ΩD,ΩN为地球自转角速度在地向与北向的分量，c11'～c33'分别为惯性导航系统姿态转移矩阵中的对应行列位置上的各元素，定义同上；g为当地重力加速度；W＝[w1 w2 w3 w4 w5]，式中w1、w2为等效北向、东向的加速度计输出白噪声分量，w3、w4、w5为等效北向、东向、地向的陀螺仪输出白噪声分量。以足部着地点MEMS惯性导航系统的水平速度输出作为观测量，建立系统的观测方程：
式中，δVN、δVE分别为水平速度误差沿北、东方向的分量，X定义同上；V为观测噪声矢量。
运用最优滤波方法实时估计惯性导航系统的初始平台误差角，陀螺仪随机常值误差以及加速度计随机常值误差，并以反馈校正的方式提高虚拟捷联惯性导航系统的水平姿态精度与虚拟惯性器件精度。
Claims (3)
1.基于人体运动学模型的行人导航系统，其特征在于，所述行人导航系统包括惯性传感组件和微型导航计算机，所述惯性传感组件包括惯性与地磁测量单元以及惯性测量单元，其中，一组惯性与地磁测量单元安装于人体躯干髋部，多组惯性测量单元分别安装于双腿，微型导航计算机安装在人体躯干上，所述微型导航计算机与惯性传感组件之间通过电缆或无线通讯完成数据传输；其中，躯干的惯性与地磁测量单元以及下肢的惯性测量单元通过确定足部零力矩点实现下肢各级杆臂效应补偿，并结合关节坐标系的肌肉骨骼间附着点坐标转换实现陀螺仪所测量的角速度的转换，从而构成足部虚拟惯性传感组件，通过该虚拟惯性传感组件完成行人导航过程。
2.利用如权利要求1所述基于人体运动学模型的行人导航系统的导航定位方法，其特征在于，其具体步骤如下：
(一)惯性传感组件的信号采集：
同步采集各组惯性传感组件的输出信号，得到各组角速度、比力和磁场强度，并将信号传输给微型导航计算机；
(二)惯性传感组件的随机误差的实时建模与校正：
首先对零位偏置的特性进行统计分析，分别建立符合陀螺仪与加速度计的零位偏置趋势项，在陀螺仪与加速度计的信号输出端加入零位偏置趋势项校正；分别建立陀螺仪与加速度计的随机误差模型，将经过零位偏置趋势项建模与校正步骤后的陀螺仪与加速度计输出作为观测量，将陀螺仪与加速度计的理论输出估计值作为状态量，建立基于随机误差模型的卡尔曼滤波器，分别实时估计陀螺仪与加速度计的理论输出估计值；
(三)惯性传感组件的初始对准：
该步骤同步应用于每组惯性传感组件，在微型导航计算机中进行；系统启动后在静态条件下，利用步骤(二)中加速度计的理论输出估计值，在微型导航计算机中通过水平自对准得到惯性传感组件初始横滚角与俯仰角，并将磁强计的信号输出通过通讯模块传送至微型导航计算机，得到惯性传感组件的初始航向角，水平自对准的公式为：
<mrow>
<mi>&theta;</mi>
<mo>=</mo>
<mi>arcsin</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>f</mi>
<mi>y</mi>
<mi>b</mi>
</msubsup>
<mo>/</mo>
<mi>g</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>&gamma;</mi>
<mo>=</mo>
<mi>arcsin</mi>
<mrow>
<mo>(</mo>
<mo>-</mo>
<msubsup>
<mi>f</mi>
<mi>x</mi>
<mi>b</mi>
</msubsup>
<mo>/</mo>
<mo>(</mo>
<mrow>
<mi>g</mi>
<mo>*</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
其中，θ为俯仰角，γ为横滚角，g为重力加速度，与分别为加速度计理论输出估计值在载体坐标系中投影的x与y轴分量；
(四)人体下肢零力矩点位置的确定：
为实现下肢杆臂效应动态补偿，首先须得到人体运动中位于足底的下肢零力矩点；人体运动中支撑腿可视为动态杆臂，以下肢零力矩点为原点进行转动来实现人体质心的移动，下肢零力矩点关于下肢质心位置、各关节的角度、角速度和角加速度的表达式：
<mrow>
<msub>
<mi>x</mi>
<mrow>
<mi>Z</mi>
<mi>M</mi>
<mi>P</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mn>6</mn>
</munderover>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>k</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msub>
<mi>l</mi>
<mi>k</mi>
</msub>
<msub>
<mi>l</mi>
<mi>j</mi>
</msub>
<msubsup>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>j</mi>
<mn>2</mn>
</msubsup>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>q</mi>
<mi>j</mi>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mi>k</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mo>-</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>k</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msub>
<mi>l</mi>
<mi>k</mi>
</msub>
<msub>
<mi>l</mi>
<mi>j</mi>
</msub>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>j</mi>
</msub>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>q</mi>
<mi>j</mi>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mi>k</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mo>+</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>d</mi>
<mi>i</mi>
</msub>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msub>
<mi>l</mi>
<mi>j</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<msup>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>j</mi>
</msub>
<mn>2</mn>
</msup>
<mo>-</mo>
<msup>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
<mo>)</mo>
</mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>q</mi>
<mi>j</mi>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mi>i</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mo>-</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>d</mi>
<mi>i</mi>
</msub>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msub>
<mi>l</mi>
<mi>j</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>j</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>q</mi>
<mi>j</mi>
</msub>
<mo>-</mo>
<msub>
<mi>q</mi>
<mi>i</mi>
</msub>
</mrow>
<mo>)</mo>
</mrow>
<mo>-</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>d</mi>
<mi>i</mi>
</msub>
<mn>2</mn>
</msup>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>+</mo>
<msub>
<mi>l</mi>
<mi>o</mi>
</msub>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msub>
<mi>l</mi>
<mi>j</mi>
</msub>
<msubsup>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>j</mi>
<mn>2</mn>
</msubsup>
<mi>sin</mi>
<mi> </mi>
<msub>
<mi>q</mi>
<mi>j</mi>
</msub>
<mo>-</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>l</mi>
<mi>o</mi>
</msub>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msub>
<mi>l</mi>
<mi>j</mi>
</msub>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>j</mi>
</msub>
<mi>cos</mi>
<mi> </mi>
<msub>
<mi>q</mi>
<mi>j</mi>
</msub>
<mo>+</mo>
<msub>
<mi>l</mi>
<mi>o</mi>
</msub>
<msub>
<mi>d</mi>
<mi>i</mi>
</msub>
<msup>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mn>2</mn>
</msup>
<mi>sin</mi>
<mi> </mi>
<msub>
<mi>q</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>l</mi>
<mi>o</mi>
</msub>
<msub>
<mi>d</mi>
<mi>i</mi>
</msub>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mi>cos</mi>
<mi> </mi>
<msub>
<mi>q</mi>
<mi>i</mi>
</msub>
<mo>+</mo>
<mi>g</mi>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msub>
<mi>l</mi>
<mi>j</mi>
</msub>
<mi>sin</mi>
<mi> </mi>
<msub>
<mi>q</mi>
<mi>j</mi>
</msub>
<mo>+</mo>
<msub>
<mi>gd</mi>
<mi>i</mi>
</msub>
<mi>sin</mi>
<mi> </mi>
<msub>
<mi>q</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<mi>G</mi>
<mo>-</mo>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mn>6</mn>
</munderover>
<msub>
<mi>m</mi>
<mi>i</mi>
</msub>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msub>
<mi>l</mi>
<mi>j</mi>
</msub>
<msubsup>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>j</mi>
<mn>2</mn>
</msubsup>
<mi>cos</mi>
<mi> </mi>
<msub>
<mi>q</mi>
<mi>j</mi>
</msub>
<mo>+</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msub>
<mi>l</mi>
<mi>j</mi>
</msub>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>j</mi>
</msub>
<mi>sin</mi>
<mi> </mi>
<msub>
<mi>q</mi>
<mi>j</mi>
</msub>
<mo>+</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>d</mi>
<mi>i</mi>
</msub>
<msubsup>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>i</mi>
<mn>2</mn>
</msubsup>
<mi>cos</mi>
<mi> </mi>
<msub>
<mi>q</mi>
<mi>i</mi>
</msub>
<mo>+</mo>
<msub>
<mi>d</mi>
<mi>i</mi>
</msub>
<msub>
<mover>
<mi>q</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mi>sin</mi>
<mi> </mi>
<msub>
<mi>q</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
</mfrac>
</mrow>
式中，qi为连杆i与z方向的夹角，li、di分别为连杆i的长度及其质心到关节的距离，G为人体所受重力；从该公式可知，下肢零力矩点的位置由各关节的角度qi、角速度和角加速度的函数，这些物理量均可通过安装于下肢的惯性测量单元测量与计算得到；
(五)虚拟惯性传感组件的构建与杆臂效应动态补偿：
基于步骤(四)的原理，可在人体运动中实时计算支撑腿上零力矩点的精确位置，结合下肢各肢节的惯性参数，即可实时补偿足部至髋关节的杆臂效应；而支撑腿的零力矩点位置可视为一个静态的虚拟惯性传感器组件，该组件在足部静止相位中的速度与角速度均为0，其器件误差也可视为0，暂忽略人体运动中下肢肌肉与脂肪等所引起的肢体变形，各关节处的杆臂效应补偿公式如下：
fn＝fn-1-ωn-1×(ωn-1×Rn-1),n＝1,2,3,4
其中，踝关节处比力f1由零力矩点位置比力f0结合足部运动角速度ω0与零力矩点位置距踝关节的距离R0进行补偿；膝关节处的比力f2由踝关节处比力f1结合踝关节运动角速度ω1与胫骨长度R1进行补偿；髋关节处的比力f3由膝关节处比力f2结合膝关节运动角速度ω2与股骨长度R2进行补偿；躯干部位的比力f4由髋关节处比力f3结合髋关节运动角速度ω3与惯性测量组件和髋关节之间的位置矢量R3补偿；若要在腿部任意位置的惯性测量组件之间进行杆臂效应的补偿，可将R1、R2与R3替代成惯性测量组件与相应关节之间的距离即可；
(六)虚拟捷联惯性导航系统的惯性导航解算：
该步骤应用于虚拟惯性传感组件所构成的虚拟捷联惯性导航系统，虚拟捷联惯性导航系统的惯性导航解算步骤分为姿态解算与速度、位置解算；
(七)虚拟捷联惯性导航系统的零速修正：
该步骤应用于虚拟捷联惯性导航系统，在微型导航计算机中进行，求解加速度计输出经步骤(二)中建模与校正后的理论输出估计值的三轴矢量和，通过判断该值是否接近重力来检测人体足部是否处于着地时间段，并利用着地时间段相对地面静止的特点进行间断式的零速修正，即根据虚拟捷联惯性导航系统误差与虚拟惯性传感组件误差建立系统状态方程与观测方程，实现人体行走中的零速修正，实时修正虚拟捷联惯性导航系统的误差与虚拟惯性传感组件误差。
3.如权利要求2所述的导航定位方法，其特征在于，所述步骤(六)的具体步骤为：
(一)虚拟惯性导航系统的姿态解算：基于虚拟惯性传感器组件中的三轴陀螺仪，采用四元数法进行姿态解算；
(二)虚拟惯性导航系统的速度、位置解算：把虚拟惯性传感器组件中的三轴加速度计原始输出通过姿态转移矩阵转换到导航坐标系中，解算出人体足部在地理系中的速度，并结合上个时刻人体的纬度、经度、高度与速度，求解当前时刻载体的纬度、经度与高度，从而完成整个虚拟捷联惯性导航系统的算法流程。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510037160.8A CN104613963B (zh) | 2015-01-23 | 2015-01-23 | 基于人体运动学模型的行人导航系统与导航定位方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510037160.8A CN104613963B (zh) | 2015-01-23 | 2015-01-23 | 基于人体运动学模型的行人导航系统与导航定位方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN104613963A CN104613963A (zh) | 2015-05-13 |
| CN104613963B true CN104613963B (zh) | 2017-10-10 |
Family
ID=53148522
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201510037160.8A Expired - Fee Related CN104613963B (zh) | 2015-01-23 | 2015-01-23 | 基于人体运动学模型的行人导航系统与导航定位方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN104613963B (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2021010832A1 (en) * | 2019-07-15 | 2021-01-21 | Universiteit Twente | A method, a system and a computer program product for estimating positions of a subject's feet and centre of mass relative to each other |
Families Citing this family (21)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106017454B (zh) * | 2016-06-16 | 2018-12-14 | 东南大学 | 一种基于多传感器融合技术的行人导航装置和方法 |
| CN107782302B (zh) * | 2016-08-26 | 2023-08-18 | 深迪半导体(绍兴)有限公司 | 一种基于下肢运动实现定位的方法、装置及系统 |
| CN106595653A (zh) * | 2016-12-08 | 2017-04-26 | 南京航空航天大学 | 一种穿戴式行人自主导航系统及其导航方法 |
| CN106821391B (zh) * | 2017-03-23 | 2020-03-24 | 北京精密机电控制设备研究所 | 基于惯性传感器信息融合的人体步态采集分析系统及方法 |
| CN107218938A (zh) * | 2017-05-22 | 2017-09-29 | 南京航空航天大学 | 基于人体运动模型辅助的穿戴式行人导航定位方法和设备 |
| US11392668B2 (en) | 2017-09-30 | 2022-07-19 | Huawei Technologies Co., Ltd. | Attitude matrix calculation method and device |
| CN107928678B (zh) * | 2017-12-06 | 2020-08-28 | 中北大学 | 基于微惯性测量阵列的可穿戴髌骨不稳定测试装置及方法 |
| CN108168548B (zh) * | 2018-02-13 | 2022-03-15 | 南京师范大学 | 一种通过机器学习算法与模型辅助的行人惯性导航系统和方法 |
| CN109059910B (zh) * | 2018-07-25 | 2021-05-18 | 南京师范大学 | 基于惯性和肌电信息并结合机器学习的行人导航系统和方法 |
| CN109374001B (zh) * | 2018-11-20 | 2020-06-30 | 中国电子科技集团公司第五十四研究所 | 一种结合行人运动场景约束的方位角校准算法 |
| CN110763229B (zh) * | 2019-11-12 | 2022-04-15 | 武汉大学 | 一种便携式惯性导航定位杆及其定位定姿方法 |
| EP4075162A4 (en) * | 2019-12-09 | 2023-12-27 | Kyocera Corporation | ELECTRONIC DEVICE, ELECTRONIC DEVICE CONTROL METHOD AND PROGRAM |
| CN111895997B (zh) * | 2020-02-25 | 2022-10-25 | 哈尔滨工业大学 | 一种无需标准矫正姿势的基于惯性传感器的人体动作采集方法 |
| CN113587920B (zh) * | 2020-04-30 | 2024-02-20 | 阿里巴巴集团控股有限公司 | 运动测量方法、装置、电子设备及计算机可读存储介质 |
| WO2021258333A1 (zh) * | 2020-06-24 | 2021-12-30 | 中国科学院深圳先进技术研究院 | 一种步态异常早期识别与风险预警方法和装置 |
| CN111700620B (zh) * | 2020-06-24 | 2022-08-05 | 中国科学院深圳先进技术研究院 | 一种步态异常早期识别与风险预警方法和装置 |
| CN113143256B (zh) * | 2021-01-28 | 2023-09-26 | 上海电气集团股份有限公司 | 步态特征提取方法、下肢评估、控制方法、设备及介质 |
| CN113171077A (zh) * | 2021-03-11 | 2021-07-27 | 爱乔（上海）医疗科技有限公司 | 一种用于全髋关节置换术中的下肢长度测量装置和方法 |
| CN114529452A (zh) * | 2022-02-08 | 2022-05-24 | 北京有竹居网络技术有限公司 | 用于显示图像的方法、装置和电子设备 |
| CN114440883B (zh) * | 2022-04-08 | 2022-06-17 | 南京师范大学 | 一种基于脚部和腿部微惯性测量单元的行人定位方法 |
| CN115112292B (zh) * | 2022-06-27 | 2024-03-05 | 合肥工业大学 | 一种动支撑情况下力传感器的组合式动态补偿方法 |
Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102261915A (zh) * | 2011-04-27 | 2011-11-30 | 浙江大学 | 行人惯性导航装置和方法 |
| CN102445200A (zh) * | 2011-09-30 | 2012-05-09 | 南京理工大学 | 微小型个人组合导航系统及其导航定位方法 |
| CN101579238B (zh) * | 2009-06-15 | 2012-12-19 | 吴健康 | 人体运动捕获三维再现系统及其方法 |
| CN103076619A (zh) * | 2012-12-27 | 2013-05-01 | 山东大学 | 一种消防员室内外3d无缝定位及姿态检测系统及方法 |
| CN103759730A (zh) * | 2014-01-16 | 2014-04-30 | 南京师范大学 | 一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法 |
| GB2510548A (en) * | 2012-02-08 | 2014-08-13 | Ian Pratt | Personal navigation system |
| CN104007460A (zh) * | 2014-05-30 | 2014-08-27 | 北京中电华远科技有限公司 | 一种消防员单兵定位导航装置 |
| CN104019828A (zh) * | 2014-05-12 | 2014-09-03 | 南京航空航天大学 | 高动态环境下惯性导航系统杆臂效应误差在线标定方法 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US7561960B2 (en) * | 2006-04-20 | 2009-07-14 | Honeywell International Inc. | Motion classification methods for personal navigation |
-
2015
- 2015-01-23 CN CN201510037160.8A patent/CN104613963B/zh not_active Expired - Fee Related
Patent Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101579238B (zh) * | 2009-06-15 | 2012-12-19 | 吴健康 | 人体运动捕获三维再现系统及其方法 |
| CN102261915A (zh) * | 2011-04-27 | 2011-11-30 | 浙江大学 | 行人惯性导航装置和方法 |
| CN102445200A (zh) * | 2011-09-30 | 2012-05-09 | 南京理工大学 | 微小型个人组合导航系统及其导航定位方法 |
| GB2510548A (en) * | 2012-02-08 | 2014-08-13 | Ian Pratt | Personal navigation system |
| CN103076619A (zh) * | 2012-12-27 | 2013-05-01 | 山东大学 | 一种消防员室内外3d无缝定位及姿态检测系统及方法 |
| CN103759730A (zh) * | 2014-01-16 | 2014-04-30 | 南京师范大学 | 一种基于导航信息双向融合的行人与智能移动载体的协同导航系统及其导航方法 |
| CN104019828A (zh) * | 2014-05-12 | 2014-09-03 | 南京航空航天大学 | 高动态环境下惯性导航系统杆臂效应误差在线标定方法 |
| CN104007460A (zh) * | 2014-05-30 | 2014-08-27 | 北京中电华远科技有限公司 | 一种消防员单兵定位导航装置 |
Non-Patent Citations (2)
| Title |
|---|
| 基于ZMP误差校正的仿人机器人步行控制;付根平 等;《机器人》;20130131;第35卷(第1期);第39-44页 * |
| 基于足部微惯性/地磁测量组件的个人导航方法;钱伟行 等;《中国惯性技术学报》;20121031;第20卷(第5期);第567-572页 * |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2021010832A1 (en) * | 2019-07-15 | 2021-01-21 | Universiteit Twente | A method, a system and a computer program product for estimating positions of a subject's feet and centre of mass relative to each other |
Also Published As
| Publication number | Publication date |
|---|---|
| CN104613963A (zh) | 2015-05-13 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104613963B (zh) | 基于人体运动学模型的行人导航系统与导航定位方法 | |
| CN108168548B (zh) | 一种通过机器学习算法与模型辅助的行人惯性导航系统和方法 | |
| US10352959B2 (en) | Method and system for estimating a path of a mobile element or body | |
| Bebek et al. | Personal navigation via high-resolution gait-corrected inertial measurement units | |
| US9357948B2 (en) | Method and system for determining the values of parameters representative of a movement of at least two limbs of an entity represented in the form of an articulated line | |
| CN103196448B (zh) | 一种机载分布式惯性测姿系统及其传递对准方法 | |
| CN102445200B (zh) | 微小型个人组合导航系统及其导航定位方法 | |
| CN106289246B (zh) | 一种基于位置和姿态测量系统的柔性杆臂测量方法 | |
| Cavallo et al. | A step toward GPS/INS personal navigation systems: real-time assessment of gait by foot inertial sensing | |
| CN104698486B (zh) | 一种分布式pos用数据处理计算机系统实时导航方法 | |
| CN106767797B (zh) | 一种基于对偶四元数的惯性/gps组合导航方法 | |
| CN111024070A (zh) | 一种基于航向自观测的惯性足绑式行人定位方法 | |
| JP2011503571A (ja) | 物体の方位測定 | |
| Fourati et al. | Position estimation approach by complementary filter-aided IMU for indoor environment | |
| CN106989761B (zh) | 一种基于自适应滤波的空间飞行器制导工具在轨标定方法 | |
| JP2018536869A (ja) | 歩行者の動きを推定する方法 | |
| CN104964686A (zh) | 一种基于动作捕捉的室内定位装置及其方法 | |
| CN112325886A (zh) | 一种基于重力梯度仪和陀螺仪组合的航天器自主定姿系统 | |
| CN107728182A (zh) | 基于相机辅助的柔性多基线测量方法和装置 | |
| CN102679977A (zh) | 基于惯性网络的分布式导航装置及其信息融合方法 | |
| CN114623826A (zh) | 一种基于人体下肢dh模型的行人惯性导航定位方法 | |
| CN110595503A (zh) | 基于李群最优估计的sins捷联惯性导航系统晃动基座自对准方法 | |
| CN109000633A (zh) | 基于异构数据融合的人体姿态动作捕捉算法设计 | |
| CN107764261A (zh) | 一种分布式pos传递对准用模拟数据生成方法和系统 | |
| Jeon et al. | IMU-based joint angle estimation under various walking and running conditions |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20171010 Termination date: 20220123 |