CN112066980B - 一种基于人体四节点运动约束的行人导航定位方法 - Google Patents
一种基于人体四节点运动约束的行人导航定位方法 Download PDFInfo
- Publication number
- CN112066980B CN112066980B CN202010895771.7A CN202010895771A CN112066980B CN 112066980 B CN112066980 B CN 112066980B CN 202010895771 A CN202010895771 A CN 202010895771A CN 112066980 B CN112066980 B CN 112066980B
- Authority
- CN
- China
- Prior art keywords
- speed
- pedestrian
- zero
- foot
- axis
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 35
- 230000033001 locomotion Effects 0.000 title claims abstract description 27
- 238000001514 detection method Methods 0.000 claims abstract description 28
- 230000005021 gait Effects 0.000 claims abstract description 12
- 238000001914 filtration Methods 0.000 claims abstract description 9
- 238000012937 correction Methods 0.000 claims abstract description 8
- 230000001133 acceleration Effects 0.000 claims description 38
- 239000011159 matrix material Substances 0.000 claims description 27
- 238000004364 calculation method Methods 0.000 claims description 11
- 230000005484 gravity Effects 0.000 claims description 7
- 238000005259 measurement Methods 0.000 claims description 7
- 239000013598 vector Substances 0.000 claims description 7
- 238000007781 pre-processing Methods 0.000 claims description 4
- 230000009466 transformation Effects 0.000 claims description 4
- 230000006798 recombination Effects 0.000 claims description 3
- 238000005215 recombination Methods 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 101150089655 Ins2 gene Proteins 0.000 description 1
- 101100072652 Xenopus laevis ins-b gene Proteins 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
Images
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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于人体四节点运动约束的行人导航定位方法,该方法首先根据采集的行人的IMU数据估计零速检测阈值,再根据预处理后的IMU数据解算行人的姿态、速度、位置信息,建立行人运动步态检测模型,利用估计的零速状态阈值进行零速检测,若处于零速状态,则进行零速修正,得到修正后的位置、速度,而后根据基于双足不等式约束的滤波方法对行人航向进行修正。本发明解决了变速/剧烈/快速运动下零速状态缺失时,导航系统累积误差难以抑制的问题,具有实时性好,运算量小的优势,提高了零速检测精度。
Description
技术领域
本发明涉及一种行人导航定位方法,尤其涉及一种基于人体四节点运动约束的行人导航定位方法。
背景技术
近年来,随着室内定位技术的发展,适用于走路等稳态运动下的室内导航算法已经相对比较成熟。但是在消防救援、井下勘探、单兵作战等任务中,特种行业人员往往需要进行跑步、跨越等剧烈运动,这就对传统的导航方法提出了挑战。同时,在以上行业中要求导航设备便携、可穿戴,能够在复杂的室内环境进行精确定位。传统的基于UWB、WIFI、蓝牙等无线射频设备的室内定位技术,成本高且不便携,无法满足以上导航需求。惯性系统体积小、成本低可用于穿戴式行人导航,但是由于器件存在累积误差,在剧烈运动情况下会导致定位结果发散。
目前,足绑式惯性导航系统往往采用单节点导航模式,其核心算法主要是零速检测和零速修正。但是在快速运动下,单节点的惯性导航系统存在零速检测率低,零速时刻短甚至缺失的问题,难以保证高精度的行人定位导航要求。
发明内容
发明目的:本发明提出一种可以在剧烈运动下定位准确的行人导航定位方法。
技术方案:本发明所述的基于人体四节点运动约束的行人导航定位方法,包括:
(1)采集行人足部IMU数据,利用运动特征概率统计的方法,估计零速检测阈值;
(2)对所述足部IMU数据进行预处理,进行姿态、速度、位置解算;
(3)建立腿部及足部四节点的步态检测模型,利用估计的零速状态阈值进行零速检测;
(4)若处于零速状态,则进行零速修正,得到修正后的位置、速度,否则不修正;
(5)计算双脚的距离,当双足距离大于最大步长时,利用基于双足不等式约束的滤波方法对行人航向进行修正,得到修正后的位置、速度和姿态;否则重复步骤(2)-(5)。
进一步地,所述步骤(1)包括:以各足部安装的惯性传感器的中心为坐标原点O,前向为Y轴,X轴垂直于Y轴指向右侧,Z轴指向上,采集足部两节点惯性传感器输出的数据,根据数据对行人运动特征进行频域统计,取特征值频率最高处为零速状态阈值,其中,所述四节点惯性传感器安装于行人的双足以及双腿上。
进一步地,所述检测阈值包括加速度模值fnorm的阈值THfnorm,加速度标准差σfnorm的阈值THσfnorm,X轴角速度wx的阈值THwx,计算公式如下:
THfnorm=argmax(P(fnorm))
THσfnorm=argmax(P(σfnorm))
THwx=argmax(P(wx))。
本发明通过分析人体运动特征,根据足部零速周期性以及腿部俯仰角周期性显著的特点,从而得到针对不测试者、不同运动速度下的零速阈值,利用动态多阈值进行零速检测,提高了后续零速检测的准确率。
所述步骤(2)包括:
(21)从所述IMU数据中扣除惯性传感器的零偏;
(22)计算初始的姿态角,包括俯仰角θ和滚转角γ:
其中,gx,gy,gz分别为x轴、y轴和z轴的重力加速度,g为当地重力加速度;
(23)实时解算行人的姿态、速度、位置,其中,
当前时刻行人的姿态利用四元数法进行解算,公式如下:
当前时刻行人的速度的解算公式如下:
当前时刻行人的位置的解算公式如下:
其中,Λ是四元数矩阵,ψ是偏航角,θ是俯仰角,γ是滚转角,v是载体的运动速度,是机体系到导航系的转换矩阵,代表比力,为地球自转角速度在导航坐标系下的投影,为导航系相对于地球系下的角速度在导航坐标系下的投影,vE、vN、vU分别是东北天三个方向的速度矢量,L代表经度,λ代表纬度,h表示运动高度,Rm表示子午面内曲率半径,Rn表示卯酉面内曲率半径。
进一步地,所述步骤(3)包括:采集腿部及足部四节点数据,采用检测足部加速度模值、足部加速度标准差、足部X轴角速度、互异腿部滚转角变化作为步态检测条件,结合估计的零速状态阈值,建立腿部及足部四节点的步态检测模型;根据所述腿部及足部四节点的步态检测模型进行零速检测。进一步地,所述腿部及足部四节点的步态检测模型为:
其中,k代表第k时刻,fk,norm、σk,fnorm、wk,x分别代表第k时刻加速度模值和加速度标准差和X轴的角速度,Δφ=φk-φk-1,φk是第k时刻腿部滚转角,THfnorm、THσfnorm、THwx分别为加速度模值fnorm、加速度标准差σfnorm、X轴角速度wx的阈值,S1、S2、S3、S4为标签,当同时满足当S1=1&S2=1&S3=1&S4=1则当前为零速状态。
进一步地,加速度模值、加速度标准差计算公式如下,
加速度模值fk,norm:
加速度标准差σk,fnorm:
进一步地,所述步骤(4)包括:当检测到零速状态时,根据步骤(41)-(44)对行人定位导航过程中的累积误差进行修正,得到修正后的位置、速度,否则不进行修正;
(41)当检测到零速状态时,利用卡尔曼滤波计算进行误差估计,构建9维的卡尔曼滤波器状态量X:
X=[ΦE ΦN ΦU δvE δvN δvU δL δλ δh]T
其中,ΦE,ΦN,ΦU是东北天方向的平台误差角,δvE,δvN,δvU为东北天方向的速度误差,δL,δλ,δh分别为经度,纬度和高度误差;
(42)建立状态方程:
其中,A为状态转移矩阵,G为系统噪声矩阵,是机体系到导航系的转换矩阵,W为白噪声随机误差矢量,W=[wgx wgy wgz]T,wgx,wgy,wgz分别为陀螺X轴、Y轴和Z轴的白噪声,是状态量X的一阶导数;
(43)建立量测方程:
Zzupt=vins-vzupt=HX+V
其中,vins为捷联惯导解算的速度矢量,vzupt理论值为[0 0 0]T,H是观测矩阵,H=I3x3,V为观测噪声矩阵,是零速状态下的速度误差;
(44)根据步骤(42)、(43)求解得到的速度、位置、姿态的误差,即得到状态量X,从步骤(2)得到的位置、速度中去除状态量X,得到修正后的位置、速度。
进一步地,所述步骤(5)包括:计算每一次采样下双足的距离,判断双足距离是否大于最大步长,若是则将最大步长作为当前双足距离,利用伪距离建立量测方程,对姿态、速度、位置误差进行二次修正,否则跳过此步骤。
进一步地,所述利用伪距离建立量测方程包括步骤:
根据步骤(41)的构建方法,建立双足的18维状态模型:
X=[Xl Xr]
建立双足不等式约束方程:
其中,x,y为步骤(4)中得到的修正后的位置;
最优解集合满足以下方程:
其中,Z为观测量,P为误差协方差矩阵,表示如下:
其中,
μ=PκT(κPκT)-1κ
本发明通过所述双足不等式约束对行人航向进行修正,有效弥补了快速运动下零速区间短的问题,有效估计行人导航结果误差与传感器误差,抑制了惯性导航系统的误差发散。
有益效果:本发明解决了剧烈/快速/变速运动下行人导航定位不准的问题,减少行人导航定位的累积误差,提高行人导航定位的精度。
附图说明
图1是本发明方法流程图;
图2是本实施例方法定位结果与传统方法结果对比图。
具体实施方式
下面结合附图和实施例对本发明的技术方案作进一步的说明。
如图1所示,一种基于人体四节点约束的行人导航定位方法包括如下步骤:
步骤1,采集并分析行人运动时的运动特性,行人一步运动周期中,处于零速状态区间概率最大。为此采集足部惯导传感器(IMU)输出的500个数据进行预处理,得到走路/跑步运动下的零速阈值。
步骤2,将加速度计与陀螺仪输出进行预处理,即扣除加速度计与陀螺仪的零偏,并利用四元数方法进行姿态、速度、位置解算。
采用加速度计和陀螺仪进行初始对准,其中,人为设定初始航向角,根据三轴重力计数据[gx,gy,gz]求出俯仰角θ和滚转角γ,其中,g为重力常数:
其中,gx,gy,gz分别为x轴、y轴和z轴的重力加速度,g为当地重力加速度;
再根据姿态、速度、位置微分方程求解当前时刻的位置、速度、姿态,具体公式如下:
姿态解算微分方程:
速度解算微分方程:
位置解算微分方程:
其中,Λ是四元数矩阵,ψ是偏航角,θ是俯仰角,γ是滚转角,v是载体的运动速度,是机体系到导航系的转换矩阵,代表比力,为地球自转角速度在导航坐标系下的投影,为导航系相对于地球系下的角速度在导航坐标系下的投影,实际上低成本的IMU无法敏感到地球自转,所以wen=[0 0 0]T,vE、vN、vU分别是东、北、天三个方向的速度矢量,L代表经度,λ代表纬度,h表示运动高度,Rm表示子午面内曲率半径,Rn表示卯酉面内曲率半径。
步骤3,建立腿部及足部四节点的步态检测模型,首先分别对足部加速度模值、足部加速度标准差进行处理:
然后,用加计算得到的加速度模值、加速度标准差、角速度模值进行零速状态检测:
Δφ=φk-φk-1,φk是第k时刻腿部滚转角,THfnorm、THσfnorm、THwx分别为加速度模值fnorm、加速度标准差σfnorm、X轴角速度wx的阈值;S1、S2、S3、S4为标签。当同时满足当S1=1&S2=1&S3=1&S4=1则当前为零速状态。
步骤4,双足分别进行捷联惯导系统INS解算(如图1所示,左脚解算记为INS1,右脚解算记为INS2),当检测到足部为零速状态时,认为此时行人的运动速度为0,利用卡尔曼滤波计算进行误差估计,并修正行人定位导航过程中的累积误差,得到修正后的位置、速度,否则不进行修正;
41)构建9维的卡尔曼滤波器状态量,具体如下:
X=[ΦE ΦN ΦU δvE δvN δvU δL δλ δh]T
其中,ΦE,ΦN,ΦU是东北天方向的平台误差角,δvE,δvN,δvU为东北天方向的速度误差,δL,δλ,δh分别为经度,纬度和高度误差。
42)建立状态方程:
其中,A为状态转移矩阵,G为系统噪声矩阵,是机体系到导航系的转换矩阵,W为白噪声随机误差矢量,W=[wgx wgy wgz]T,wgx,wgy,wgz分别为陀螺X轴、Y轴和Z轴的白噪声,是状态量的一阶导数;
43)当检测到零速点时,以速度为量测,建立量测方程:
Zzupt=vins-vzupt=HX+V
其中,vins为捷联惯导解算的速度,vzupt理论为[0 0 0]T,H是观测矩阵,H=I3x3,V为观测噪声矩阵,即零速状态下的速度误差;
44)根据步骤42)、43)求解得到的速度、位置、姿态的误差,即得到状态量X,从位置、速度中去除状态量X,得到修正后的位置、速度。
步骤5,如果双足距离大于最大的步长,则认为当前双足距离为最大步长,进行误差估计,否则跳过此步骤。
在步骤4)的基础上构建18维状态模型如下:
X=[Xl Xr]
由于跑步过程中双脚最大距离不超过最大步长,所以存在约束方程如下:
其中,x,y为步骤(4)中得到的修正后的位置。
最优解集合满足以下方程:
其中,Z为观测量,P为误差协方差矩阵,表示如下:
其中
μ=PκT(κPκT)-1κ
如图2所示,实验场景为实验楼内的走廊,路线为长度为56.8米,宽度为47米的矩形,测试者以2.2m/s的跑步运动,利用传统的行人零速修正方法解算出来的结果如图虚线所示,起终点误差大于10米;利用本发明即一种基于人体四节点约束的行人导航定位方法解算出来的结果如图实线所示,起终点位置误差为1.7米,且航向误差大大减小,提升了定位精度。
Claims (9)
1.一种基于人体四节点约束的行人导航定位方法,其特征在于,包括步骤:
(1)采集行人足部IMU数据,利用运动特征概率统计的方法,估计零速检测阈值;
(2)对所述足部IMU数据进行预处理,进行姿态、速度、位置解算;
(3)建立腿部及足部四节点的步态检测模型,利用估计的零速状态阈值进行零速检测;
(4)若处于零速状态,则进行零速修正,得到修正后的位置、速度,否则不修正;
(5)计算双脚的距离,当双足距离大于最大步长时,利用基于双足不等式约束的滤波方法对行人航向进行修正,得到修正后的位置、速度和姿态;否则重复步骤(2)-(5);具体包括:
建立双足的18维状态模型:
X=[Xl Xr]
建立双足不等式约束方程:
其中,x,y为步骤(4)中得到的修正后的位置;
最优解集合满足以下方程:
其中,Z为观测量,P为误差协方差矩阵,表示如下:
其中,
μ=PκT(κPκT)-1κ
2.根据权利要求1所述的基于人体四节点约束的行人导航定位方法,其特征在于,所述步骤(1)包括:以各足部安装的惯性传感器的中心为坐标原点O,前向为Y轴,X轴垂直于Y轴指向右侧,Z轴指向上,采集足部两节点惯性传感器输出的数据,根据数据对行人运动特征进行频域统计,取特征值频率最高处为零速状态阈值;四个惯性传感器分别安装于行人的双足以及双腿上。
3.根据权利要求2所述的基于人体四节点约束的行人导航定位方法,其特征在于:所述检测阈值包括加速度模值fnorm的阈值THfnorm、加速度标准差σfnorm的阈值THσfnorm、X轴角速度wx的阈值THwx,计算公式如下:
THfnorm=argmax(P(fnorm))
THσfnorm=argmax(P(σfnorm))
THwx=argmax(P(wx))。
4.根据权利要求1所述的基于人体四节点约束的行人导航定位方法,其特征在于,所述步骤(2)包括:
(21)从所述IMU数据中扣除惯性传感器的零偏;
(22)计算初始的姿态角,包括俯仰角θ和滚转角γ:
其中,gx,gy,gz分别为x轴、y轴和z轴的重力加速度,g为当地重力加速度;
(23)实时解算行人的姿态、速度、位置,其中,
当前时刻行人的姿态利用四元数法进行解算,公式如下:
当前时刻行人的速度的解算公式如下:
当前时刻行人的位置的解算公式如下:
5.根据权利要求1所述的基于人体四节点约束的行人导航定位方法,其特征在于,所述步骤(3)包括:采集腿部及足部四节点数据,采用检测足部加速度模值、足部加速度标准差、足部X轴角速度、互异腿部滚转角变化作为步态检测条件,结合估计的零速状态阈值,建立腿部及足部四节点的步态检测模型;根据所述腿部及足部四节点的步态检测模型进行零速检测。
8.根据权利要求1所述的基于人体四节点约束的行人导航定位方法,其特征在于,所述步骤(4)包括:当检测到零速状态时,根据步骤(41)-(44)对行人定位导航过程中的累积误差进行修正,得到修正后的位置、速度,否则不进行修正;
(41)当检测到零速状态时,利用卡尔曼滤波计算进行误差估计,构建9维的卡尔曼滤波器状态量X:
X=[ΦE ΦN ΦU δvE δvN δvU δL δλ δh]T
其中,ΦE,ΦN,ΦU是东北天方向的平台误差角,δvE,δvN,δvU为东北天方向的速度误差,δL,δλ,δh分别为经度,纬度和高度误差;
(42)建立状态方程:
(43)建立量测方程:
Zzupt=vins-vzupt=HX+V
其中,vins为捷联惯导解算的速度矢量,vzupt理论值为[0 0 0]T,H是观测矩阵,H=I3x3,V为观测噪声矩阵,是零速状态下的速度误差;
(44)根据步骤(42)、(43)求解得到的速度、位置、姿态的误差,即得到状态量X,从步骤(2)得到的位置、速度中去除状态量X,得到修正后的位置、速度。
9.根据权利要求1所述的基于人体四节点约束的行人导航定位方法,其特征在于,所述步骤(5)包括:计算每一次采样下双足的距离,判断双足距离是否大于最大步长,若是则将最大步长作为当前双足距离,利用伪距离建立量测方程,对姿态、速度、位置误差进行二次修正,否则跳过此步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010895771.7A CN112066980B (zh) | 2020-08-31 | 2020-08-31 | 一种基于人体四节点运动约束的行人导航定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010895771.7A CN112066980B (zh) | 2020-08-31 | 2020-08-31 | 一种基于人体四节点运动约束的行人导航定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112066980A CN112066980A (zh) | 2020-12-11 |
CN112066980B true CN112066980B (zh) | 2022-09-27 |
Family
ID=73664824
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010895771.7A Active CN112066980B (zh) | 2020-08-31 | 2020-08-31 | 一种基于人体四节点运动约束的行人导航定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112066980B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113419265B (zh) * | 2021-06-15 | 2023-04-14 | 湖南北斗微芯产业发展有限公司 | 一种基于多传感器融合的定位方法、装置与电子设备 |
CN114459469B (zh) * | 2022-01-14 | 2023-05-23 | 北京信息科技大学 | 多运动状态导航方法、装置及智能可穿戴设备 |
CN114608571A (zh) * | 2022-02-25 | 2022-06-10 | 南京航空航天大学 | 一种适用于运动平台场景的行人惯性导航方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA2559236A1 (en) * | 2004-03-12 | 2005-09-29 | Vectronix Ag | Apparatus and method of determining 3d pedestrian motion by using projection planes |
CN102445200A (zh) * | 2011-09-30 | 2012-05-09 | 南京理工大学 | 微小型个人组合导航系统及其导航定位方法 |
PL424408A1 (pl) * | 2018-01-29 | 2019-08-12 | Uniwersytet Mikołaja Kopernika W Toruniu | Sposób ustalenia pozycji obiektu, w szczególności człowieka i urządzenie do ustalania pozycji człowieka |
CN110553646A (zh) * | 2019-07-30 | 2019-12-10 | 南京林业大学 | 基于惯性和磁航向及零速修正的行人导航方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018081986A1 (zh) * | 2016-11-03 | 2018-05-11 | 浙江大学 | 一种可穿戴式设备及用于该设备的实时步长测量方法 |
CN109099913B (zh) * | 2018-10-10 | 2023-07-07 | 格物智航(深圳)科技有限公司 | 一种基于mems惯性器件的穿戴式导航装置和方法 |
CN110672095A (zh) * | 2019-10-17 | 2020-01-10 | 北京首贝科技发展有限公司 | 一种基于微惯导的行人室内自主定位算法 |
CN111024126B (zh) * | 2019-12-26 | 2022-03-22 | 北京航天控制仪器研究所 | 一种行人导航定位中的自适应零速修正方法 |
-
2020
- 2020-08-31 CN CN202010895771.7A patent/CN112066980B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA2559236A1 (en) * | 2004-03-12 | 2005-09-29 | Vectronix Ag | Apparatus and method of determining 3d pedestrian motion by using projection planes |
CN102445200A (zh) * | 2011-09-30 | 2012-05-09 | 南京理工大学 | 微小型个人组合导航系统及其导航定位方法 |
PL424408A1 (pl) * | 2018-01-29 | 2019-08-12 | Uniwersytet Mikołaja Kopernika W Toruniu | Sposób ustalenia pozycji obiektu, w szczególności człowieka i urządzenie do ustalania pozycji człowieka |
CN110553646A (zh) * | 2019-07-30 | 2019-12-10 | 南京林业大学 | 基于惯性和磁航向及零速修正的行人导航方法 |
Non-Patent Citations (1)
Title |
---|
多条件约束的行人导航零速区间检测算法;田晓春等;《中国惯性技术学报》;20160215(第01期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN112066980A (zh) | 2020-12-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109827577B (zh) | 基于运动状态检测的高精度惯性导航定位算法 | |
CN112066980B (zh) | 一种基于人体四节点运动约束的行人导航定位方法 | |
US10352959B2 (en) | Method and system for estimating a path of a mobile element or body | |
US12085391B2 (en) | Positioning apparatus, positioning method, and program | |
CN105043385B (zh) | 一种行人自主导航定位的自适应卡尔曼滤波方法 | |
CN104406586B (zh) | 基于惯性传感器的行人导航装置和方法 | |
CN109870173A (zh) | 一种基于校验点的海底管道惯性导航系统的轨迹修正方法 | |
CN109596144B (zh) | Gnss位置辅助sins行进间初始对准方法 | |
CN104613965B (zh) | 一种基于双向滤波平滑技术的步进式行人导航方法 | |
CN109959374B (zh) | 一种行人惯性导航全时全程逆向平滑滤波方法 | |
US7711516B2 (en) | Method for estimating movement of a solid | |
CN111189442A (zh) | 基于cepf的无人机多源导航信息状态预测方法 | |
CN108168548A (zh) | 一种通过机器学习算法与模型辅助的行人惯性导航系统和方法 | |
CN106370178A (zh) | 移动终端设备的姿态测量方法及装置 | |
CN112362057A (zh) | 基于零速修正与姿态自观测的惯性行人导航算法 | |
CN108592907A (zh) | 一种基于双向滤波平滑技术的准实时步进式行人导航方法 | |
CN110672095A (zh) | 一种基于微惯导的行人室内自主定位算法 | |
Lin et al. | Multiple sensors integration for pedestrian indoor navigation | |
JP5821513B2 (ja) | 参照値生成方法及び参照値生成装置 | |
JP2014240266A (ja) | センサドリフト量推定装置及びプログラム | |
CN112325878A (zh) | 基于ukf与空中无人机节点辅助的地面载体组合导航方法 | |
CN116067369A (zh) | 一种基于距离和角度的行人协同导航方法 | |
CN114562995A (zh) | 一种基于Mems惯性传感器的行人轨迹推算方法 | |
Elsabbagh et al. | Precise Orientation Estimation Based on Nonlinear Modeling and Quaternion Transformations for Low Cost Navigation Systems | |
CN107289935B (zh) | 一种适用于可穿戴设备的室内导航算法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |