CN105043385B - 一种行人自主导航定位的自适应卡尔曼滤波方法 - Google Patents
一种行人自主导航定位的自适应卡尔曼滤波方法 Download PDFInfo
- Publication number
- CN105043385B CN105043385B CN201510300546.3A CN201510300546A CN105043385B CN 105043385 B CN105043385 B CN 105043385B CN 201510300546 A CN201510300546 A CN 201510300546A CN 105043385 B CN105043385 B CN 105043385B
- Authority
- CN
- China
- Prior art keywords
- error
- pedestrian
- noise
- matrix
- time
- 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
- 238000001914 filtration Methods 0.000 title claims abstract description 45
- 238000000034 method Methods 0.000 title claims abstract description 44
- 230000003044 adaptive effect Effects 0.000 title claims abstract description 30
- 230000033001 locomotion Effects 0.000 claims abstract description 21
- 238000012937 correction Methods 0.000 claims abstract description 10
- 230000008569 process Effects 0.000 claims abstract description 6
- 230000004927 fusion Effects 0.000 claims abstract description 3
- 239000011159 matrix material Substances 0.000 claims description 31
- 230000001133 acceleration Effects 0.000 claims description 17
- 230000009897 systematic effect Effects 0.000 claims description 10
- 230000015572 biosynthetic process Effects 0.000 claims description 6
- 230000005484 gravity Effects 0.000 claims description 6
- 238000003786 synthesis reaction Methods 0.000 claims description 6
- 239000003607 modifier Substances 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 2
- 238000005070 sampling Methods 0.000 claims description 2
- 230000001360 synchronised effect Effects 0.000 claims description 2
- 230000007704 transition Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 230000000052 comparative effect Effects 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 241001269238 Data Species 0.000 description 1
- 238000009825 accumulation Methods 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 239000000969 carrier Substances 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000001186 cumulative effect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- VIKNJXKGJWUCNN-XGXHKTLJSA-N norethisterone Chemical compound O=C1CC[C@@H]2[C@H]3CC[C@](C)([C@](CC4)(O)C#C)[C@@H]4[C@@H]3CCC2=C1 VIKNJXKGJWUCNN-XGXHKTLJSA-N 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000033764 rhythmic process Effects 0.000 description 1
- 238000013456 study Methods 0.000 description 1
- 230000001052 transient effect Effects 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
-
- 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
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种行人自主导航定位的自适应卡尔曼滤波方法,包括:将一个集成了加速度计、陀螺仪、磁力计的MEMS‑IMU系统连接于人体,在行人运动过程中进行IMU数据采集;建立包含18维状态量、9维观测量的自适应滤波模型,在同时满足“四条件”时进行递推滤波,其间通过时变噪声统计估计器实时估计和修正系统噪声以及观测噪声的统计特性;本发明在使用零速校正作为误差补偿修正算法的基础上,设计融合人体运动特征的自适应滤波方法,实时处理人体晃动带入的噪声干扰信号,有效提高了行人自主导航定位的精度。本发明方法稳定性强、实时性好,并且不增加任何额外硬件成本。
Description
技术领域
本发明属于导航定位技术领域,尤其涉及一种行人自主导航定位的自适应卡尔曼滤波方法。
背景技术
近些年来导航定位技术依然在迅猛发展,而其中多数是基于卫星的导航系统,并且只适用于室外的环境,如应用最广泛的GPS,在城市楼群、山区、森林和地下建筑等遮挡环境下,其信号弱,可用性差。
随着人们生活节奏的加快,行人自主导航定位的需求也显得越发迫切。尤其是室内环境下,如火灾、楼宇坍塌等紧急环境的救援、商场内需要寻人或某个地方等。很多人采用地图信息匹配的方法进行行人导航,如国外专利CN1705861A《Walker navigationdevice and program》,其利用存储在地图数据库中的地图信息来计算当前位置并显示。这种方法需要先验的预知信息,对于火灾救援等临时突发紧急情况难以达到良好的处理效果。本发明中应用MEMS-IMU固连于人体对行人进行室内实时定位,不需要依赖任何外部的信息,可以实现全自主定位,并且价格便宜,体积小,容易实现可穿戴。利用惯性传感器实现行人定位的经典方法是行人航位推算(PDR),其中大体可分为两类:一种是通过一步计数和步长估计来实现定位,通常用陀螺仪/罗盘来增强航向信息。如专利CN201310388466.9《行人步长估计及航位推算方法》中所述,利用步数、步长、方向进行测量和计算。 但是此种方式往往只适用于特定的用户,在不寻常的行走模式,包括拥挤环境、上坡/下坡等环境中,步行统计假设条件会被破坏,因此容易失败。另一种方法是采用直接积分策略,但是随着行人移动距离和航向角的增加,惯性器件累计误差会越来越大,导致其定位精度不理想。在考虑系统实时性及计算复杂度的前提下,通常采用卡尔曼滤波来消除漂移误差。
现有的用于行人导航系统的滤波方法主要采用零速修正的方法,而后续跟进的滤波一般均采取基础的经典卡尔曼滤波或扩展卡尔曼滤波。如国内编号为CN201310566710的专利《基于捷联惯导解算和零速校正的自主导航系统定位方法》中所用的是经典卡尔曼滤波,其通过判断人脚处于运动还是静止状态来区分更新选项。当检测为运动时,只启动时间更新;当检测为静止时,则同时启动时间更新和量测更新。经典卡尔曼滤波是将系统默认为线性系统来进行更新处理,而人体运动必然会伴有摆动等干扰因素,显然是非线性系统,所以若应用经典卡尔曼滤波进行估计,修正效果并不理想。再如专利CN201310520233《一种基于双MEMS-IMU的行人自主导航解算算法》中以双脚解算距离超过双脚间最大步长为触发点,利用EKF完成估计修正,即用导航解算的协方差阵来更新卡尔曼滤波的协方差阵。此方法是将系统局部线性化,比起经典卡尔曼滤波的方法更符合行人运动的实际情况,因此定位精度有所提升,但仍然没解决噪声实时变化的影响问题,并且其每次更新都必须通过计算雅可比矩阵才能完成,实时性变差。
综上所述,在某种程度上本发明从成本、可靠性、复杂性以及精确性等角度都表现出了其它相关研究不具备或不同时具备的新颖性和先进性。
发明内容
本发明所要解决的技术问题在于克服现有技术的不足,提供一种行人自主导航定位的自适应卡尔曼滤波方法,该方法简单、稳定性强,在不增加任何额外硬件成本的情况下,有效提高了行人导航定位的精度。
本发明采用以下技术方案:
一种行人自主导航定位的自适应卡尔曼滤波方法,包括以下步骤:
步骤(1),将MEMS-IMU系统固定连接于人体,IMU初始对准后,行人开始运动,运动过程中采集IMU数据;
步骤(2),合理选取观测量建立融合人体运动特征的自适应卡尔曼滤波模型;
步骤(3),同时满足“四条件”时进行自适应卡尔曼滤波,同步修正晃动噪声干扰,完成各状态量的估计。
步骤(4),利用估计误差修正运动人体信息。
进一步的,在步骤(1)中,IMU输出数据是通过固连于人体上的测量传感器件测量所得;测量传感器件包括三轴加速度计、三轴陀螺仪和三轴磁力计。
进一步的,在步骤(1)中的初始对准选取北东地为导航坐标系, 俯仰角θ和滚转角γ由经过补偿后的加速度计输出值计算获得,偏航角由磁场强度B、俯仰角θ和滚转角γ计算获得。计算公式为:
其中,k代表k时刻,b代表载体(行人)坐标系,n代表导航坐标系,表示k时刻载体坐标系下行人的加速度,表示k时刻导航坐标系下的磁场强度。
进一步的,在步骤(2)中,滤波模型为包括3个位置误差、3个姿态角误差(俯仰角θ、滚转角γ和偏航角)、3个速度误差、3个重力不确定误差、三轴陀螺仪零偏误差和三轴加速度计零偏误差,共计18维的状态空间方程。
W(t)为系统过程噪声矩阵,其表达式为: G(t)为对
应的噪声矩阵系数;F(t)为系统状态矩阵;Z(t)为观测量;H(t)为观测矩阵;V(t)为观测噪
声矩阵。
被估计状态向量为:
其中,δr为位置误差,δv为速度误差,δψ为姿态角误差,为加速度计零偏误差,εb为陀螺仪零偏误差,δg为重力不确定误差。
观测向量和观测矩阵为:
Zk=[Δvk Δωk Δψk]T
其中,Δψk包括磁力计计算的航向角与捷联解算出的航向角作差获得的航向角误差,利用加速度计计算出的俯仰角和横滚角与捷联解算出的姿态角作差获得的俯仰角和横滚角误差。
进一步的,所述的步骤(3)中的“四条件”包括:
(1)三轴加速度计合成的加速度幅值输出量满足阈值条件;
(2)加速度计z轴加速度输出量满足阈值条件;
(3)三轴陀螺仪合成的角速度幅值输出量满足阈值条件;
(4)陀螺仪y轴角速度输出量满足阈值条件;
当上述四项条件同时满足时,进行自适应滤波。
其中,条件(1)中三轴加速度计合成的加速度幅值表示为 定义给定的阈值条件为thamin=9m/s2<|ak|<thamax=
11m/s2。条件(3)中三轴陀螺仪合成的角速度幅值表示为
定义给定的阈值条件为|ωk|<thωmax=50°/s。
在行人运动过程中,z轴加速度和y轴角速度变化最明显,由于安装偏差、行走晃动等影响,IMU会有所倾斜。因此在静止时刻y轴角速度不是完全零值,z轴加速度也不是完全g值,但都不会大于所设定阈值。条件(2)和条件(4)中的阈值在初始静止阶段分别以取加速度计输出的平均值和陀螺仪输出的平均值而设定。
进一步的,在步骤(3)中,采用自适应卡尔曼滤波进行误差估 计,利用观测数据进行递推滤波的同时,通过时变噪声统计估计器实时估计和修正系统噪声以及观测噪声的统计特性,从而降低模型误差、抑制滤波发散,提高滤波精度。选取遗忘因子b=0.98。
进一步的,在步骤(4)中,通过公式和 反馈修正行人速度、位置和姿态信息。
本发明比现有技术具有以下有益效果及优点:
(1)本发明可穿戴,不需要预设节点,比其它需要预先知道室内布局环境的定位方法更方便,适用性更广。另外,相比于其它基于WiFi、Zigbee等无线网络的室内定位技术,本发明稳定性更高。
(2)本发明针对人体运动特性,采用的“四条件”识别方法简单,实时性高,起到良好的触发作用。比应用步长限制条件判断零瞬态的方法应用范围更广,不针对指定用户。
(3)在不增加任何额外硬件成本的情况下,利用自适应卡尔曼滤波器解决惯性器件长时间工作产生的累积漂移影响定位精度的问题。自适应体现在利用观测数据进行递推滤波的同时,用时变噪声统计估计器实时估计和修正系统噪声以及观测噪声的统计特性,从而降低模型误差、抑制滤波发散,提高滤波精度。此方法针对行人运动这种噪声实时变换的情况有良好的效果。
附图说明
图1为本发明的流程图
图2为本发明的工作原理图;
图3为自适应卡尔曼滤波框图;
图4为行人自主导航定位的自适应卡尔曼滤波方法实施例结果对比图。
具体实施方式
下面结合附图和具体实施方式对本发明作进一步描述:
图1是本发明的流程图,其中,数据采集的IMU模块(1-1)包括加速度计、陀螺仪和磁力计。将数据进行捷联惯性导航解算(1-2),之后选取合适观测量得到滤波模型(1-3),随后用“四条件”触发AKF模块(1-4)进行滤波。人体在正常运动过程中,与地面接触时间为毫秒级或更长,其中某一时刻人体与地面接触会达到瞬间静止状态,当同时满足所述“四条件”时即为瞬间静止状态。AKF指自适应卡尔曼滤波,AKF模块实现对系统噪声以及观测噪声统计特性的实时估计,从而降低模型误差、抑制滤波发散,提高滤波精度。最后,用估计量完成定位信息的校正(1-5)。
图2是本发明的工作原理图。其中,MEMS-IMU(2-1)包括三轴加速度计、三轴陀螺仪和三轴磁力计。加速度计输出加速度信息(2-2),陀螺仪输出角速度信息(2-3),将以上两种直接输出信息进行捷联惯性导航解算(2-4),可得到位置、速度、姿态信息(2-5)。当检测到行人处于瞬间静止状态(2-7),即触发滤波器,以零速度修正量(2-8)、零角速度修正量(2-9)、姿态角修正量(2-6)同时成为观测量,利用自适应卡尔曼滤波器(2-10)进行估计,随后进行反馈修正(2-11),得到最终输出的位置、速度、姿态信息(2-12)。
一种行人自主导航定位的自适应卡尔曼滤波方法,它包括如下步 骤:
步骤(1):将包括三轴加速度计、三轴陀螺仪和三轴磁力计的MEMS-IMU固定连接于人体,选取北东地为导航坐标系,由经过补偿后的加速度计输出值计算获得俯仰角θ和滚转角γ,由磁场强度B、俯仰角θ和滚转角γ计算获得偏航角完成初始对准。对准后,在行人运动过程中采集IMU数据。
步骤(2),根据硬件结构及人体运动特征,建立包括3个位置误差、3个姿态角误差(俯仰角θ、滚转角γ和偏航角)、3个速度误差、3个重力不确定误差三轴陀螺仪零偏误差和三轴加速度计零偏误差,共计18维的状态空间方程,即滤波模型。
W(t)为系统过程噪声矩阵,其表达式为 其中为
行人坐标系(b系)到导航坐标系(n系)的方向余弦矩阵,ωb为行人角速度,ab为行人加速度;
G(t)为对应的噪声矩阵系数;F(t)为系统状态矩阵;Z(t)为观测量;H(t)为观测矩阵;V(t)
为观测噪声矩阵。
被估计状态向量为:
其中,δr为位置误差,δv为速度误差,δψ为姿态角误差,为加速度计零偏误差,εb为陀螺仪零偏误差,δg为重力不确定误差。
人体在正常运动过程中,与地面接触时间为毫秒级或更长,当检测到人体与地面接触达到瞬间静止时,其输出速度、角速度为零,但这只是理论上。由于传感器的测量误差、噪声以及算法误差等原因, 此时速度、角速度计算值并不为零。因此选取瞬间静止时刻速度计算值的误差和陀螺仪的角速度输出误差作为观测量。为了增加可观性,同时将磁力计计算的航向角与捷联解算出的航向角作差获得的航向角误差,利用加速度计计算出的俯仰角和横滚角与捷联解算出的姿态角作差获得的俯仰角误差和横滚角误差同样作为观测量。
观测向量和观测矩阵为:
Zk=[Δvk Δωk Δψk]T
步骤(3),同时满足“四条件”时进行自适应卡尔曼滤波,完成各状态量的估计。
进一步的,“四条件”具体为:
(1)三轴加速度计合成的加速度幅值输出量满足阈值条件;
(2)加速度计z轴加速度输出量满足阈值条件;
(3)三轴陀螺仪合成的角速度幅值输出量满足阈值条件;
(4)陀螺仪y轴角速度输出量满足阈值条件;
当上述四项条件同时满足时,进行自适应滤波。
其中,条件(1)中三轴加速度计合成的加速度幅值表示为 定义给定的阈值条件为thamin=9m/s2<|ak|<thamax=
11m/s2。条件(3)中三轴陀螺仪合成的角速度幅值表示为
定义给定的阈值条件为|ωk|<thωmax=50°/s。
在行人运动过程中,z轴加速度和y轴角速度变化最明显,由于安装偏差、行走晃动等影响,IMU会有所倾斜。因此在静止时刻y轴角速度不是完全零值,z轴加速度也不是完全g值,但都不会大于所设定阈值。条件(2)和条件(4)中的阈值在初始静止阶段分别以取加速度计输出的平均值和陀螺仪输出的平均值而设定。
进一步的,如图3自适应卡尔曼滤波框图所示。其中包括捷联惯性导航信息(3-1)、磁力计的地磁信息(3-2)、时变噪声统计估计器(3-3)和滤波增益(3-4)。自适应卡尔曼滤波是利用观测数据进行递推滤波的同时,通过时变噪声统计估计器实时估计和修正系统噪声以及观测噪声的统计特性,从而降低模型误差、抑制滤波发散,提高滤波精度。
自适应滤波的算法描述为:
上式中,分别是k时刻系统状态Xk的当前和预测线性最小方差估计值,是k-1时刻的系统状态Xk-1的当前线性最小方差估计值;Φk,k-1是状态过渡矩阵,是Φk,k-1的转置矩阵;Hk是观测矩阵,Zk是观测量,是观测量估计误差;Kk是滤波增益;Pk、Pk/k-1分别是Xk和Xk/k-1对应的状态估计协方差阵;分别是系 统过程噪声和观测噪声的时变均值,分别是系统过程噪声和观测噪声的时变协方差阵。
其中,由时变噪声统计估值器递推获得:
式中,0<b<1为遗忘因子,针对本方法取b=0.98。
此处分母中的bk+1表示b的(k+1)次幂。k为离散时间点,k=1,2,3…N,N为采样次数。
步骤(4),通过公式和反馈修正行人速
度、位置和姿态信息。
如图4为行人自主导航定位的自适应卡尔曼滤波方法的实施例结果对比图:
实验中,将自研的集成三轴加速度计、陀螺仪和磁力计的MEMS-IMU固定于人体脚部,其中各传感器参数如表1所示。
表1传感器参数
实验中,行人绕某花坛外侧行走一圈,约230m。图4给出了利用本发明行人自主导航定位的自适应卡尔曼滤波方法进行行人导航 的结果,并与只有纯惯导时的轨迹结果图作比较。其中左侧为纯惯性导航时的轨迹,可看出轨迹发散情况严重。右侧为应用自适应卡尔曼滤波后的轨迹图,可以看出此方法的收敛效果极好,最终得到了较为平滑并且始末点重复性较高的行进轨迹图。经过多个人多种运动速度试验,此发明的水平定位误差为1.35%(3σ)。此实施例表明本发明行人自主导航定位的自适应卡尔曼滤波方法可显著提高行人导航定位的精度。
Claims (1)
1.一种行人自主导航定位的自适应卡尔曼滤波方法,其特征在于:包括以下步骤:
步骤(1),将MEMS-IMU系统固定连接于人体,IMU初始对准后,行人开始运动,运动过程中采集IMU数据;
其中所述的初始对准选取北东地为导航坐标系,俯仰角θ和滚转角γ由经过补偿后的三轴加速度计输出值计算获得,偏航角由磁场强度B、俯仰角θ和滚转角γ计算获得;
步骤(2),合理选取观测量建立融合人体运动特征的自适应卡尔曼滤波模型;
其中,自适应卡尔曼滤波模型为包括3个位置误差、3个姿态角误差、3个重力不确定误差、三轴陀螺仪零偏误差和三轴加速度计零偏误差,共计18维的状态空间方程;所述3个姿态角为:俯仰角θ、滚转角γ和偏航角
W(t)为系统过程噪声矩阵,其表达式为:其中为行人坐标系b系到导航坐标系n系的方向余弦矩阵,ωb为行人角速度,ab为行人加速度;G(t)为对应的噪声矩阵系数;F(t)为系统状态矩阵;Z(t)为观测量;H(t)为观测矩阵;V(t)为观测噪声矩阵;
被估计状态向量为:
其中,δr为位置误差,δv为速度误差,δψ为姿态角误差,为三轴加速度计零偏误差,εb为三轴陀螺仪零偏误差,δg为重力不确定误差;
观测向量和观测矩阵为:
Zk=[Δvk Δωk Δψk]T
其中,Δvk为选取的瞬间静止时刻速度计算值的误差,Δωk为选取的瞬间静止时刻三轴陀螺仪的角速度输出误差;Δψk包括磁力计计算的偏航角与捷联解算出的偏航角作差获得的偏航角误差,利用三轴加速度计计算出的俯仰角θ和滚转角γ与捷联解算出的姿态角作差获得的俯仰角和滚转角误差;
步骤(3),同时满足“四条件”时进行自适应卡尔曼滤波,同步修正晃动噪声干扰,完成各状态量的估计;
其中,“四条件”包括:
(1)三轴加速度计合成的加速度幅值输出量满足阈值条件;
(2)三轴加速度计z轴加速度输出量满足阈值条件;
(3)三轴陀螺仪合成的角速度幅值输出量满足阈值条件;
(4)三轴陀螺仪y轴角速度输出量满足阈值条件;
其中条件(2)和条件(4)中的阈值在初始静止阶段分别以取三轴加速度计输出的平均值和三轴陀螺仪输出的平均值而设定;
其中的自适应卡尔曼滤波是利用观测数据进行递推滤波的同时,通过时变噪声统计估计器实时估计和修正系统噪声以及观测噪声的统计特性,从而降低模型误差、抑制滤波发散,提高滤波精度;
自适应卡尔曼滤波的算法描述为:
上式中,分别是k时刻系统状态Xk的当前和预测线性最小方差估计值,是k-1时刻的系统状态Xk-1的当前线性最小方差估计值;Φk,k-1是状态过渡矩阵,是Φk,k-1的转置矩阵;Hk是观测矩阵,Zk是观测量,是观测量估计误差;Kk是滤波增益;Pk、Pk/k-1分别是Xk和Xk/k-1对应的状态估计协方差阵;分别是系统过程噪声和观测噪声的时变均值,分别是系统过程噪声和观测噪声的时变协方差阵;
其中,由时变噪声统计估值器递推获得:
式中,0<b<1为遗忘因子,针对本方法取b=0.98;
此处分母中的bk+1表示b的(k+1)次幂;k为离散时间点,k=1,2,3…N,N为采样次数;
步骤(4),利用估计误差修正运动人体信息;
其中,通过公式和反馈修正行人速度、位置和姿态信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510300546.3A CN105043385B (zh) | 2015-06-05 | 2015-06-05 | 一种行人自主导航定位的自适应卡尔曼滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510300546.3A CN105043385B (zh) | 2015-06-05 | 2015-06-05 | 一种行人自主导航定位的自适应卡尔曼滤波方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105043385A CN105043385A (zh) | 2015-11-11 |
CN105043385B true CN105043385B (zh) | 2018-10-26 |
Family
ID=54450119
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510300546.3A Expired - Fee Related CN105043385B (zh) | 2015-06-05 | 2015-06-05 | 一种行人自主导航定位的自适应卡尔曼滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105043385B (zh) |
Families Citing this family (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105607104B (zh) * | 2016-01-28 | 2018-04-10 | 成都佰纳瑞信息技术有限公司 | 一种基于gnss与ins的自适应导航定位系统及方法 |
CN106017461B (zh) * | 2016-05-19 | 2018-11-06 | 北京理工大学 | 基于人体/环境约束的行人导航系统三维空间定位方法 |
CN106108909A (zh) * | 2016-06-14 | 2016-11-16 | 夏烬楚 | 一种人体姿态检测穿戴设备、系统及控制方法 |
CN106123900B (zh) * | 2016-06-20 | 2019-05-31 | 南京航空航天大学 | 基于改进型互补滤波的室内行人导航磁航向解算方法 |
CN107272713A (zh) * | 2016-10-20 | 2017-10-20 | 天津科技大学 | 一种水下机器人不确定流场环境自适应控制系统 |
CN106500693B (zh) * | 2016-12-07 | 2019-06-28 | 中国电子科技集团公司第五十四研究所 | 一种基于自适应扩展卡尔曼滤波的ahrs算法 |
CN107014388B (zh) * | 2016-12-22 | 2020-08-07 | 威海北洋电气集团股份有限公司 | 一种基于磁干扰检测的步行者轨迹推算方法及装置 |
CN106500695B (zh) * | 2017-01-05 | 2019-02-01 | 大连理工大学 | 一种基于自适应扩展卡尔曼滤波的人体姿态识别方法 |
CN106767789B (zh) * | 2017-01-12 | 2019-12-24 | 南京航空航天大学 | 一种基于自适应卡尔曼滤波的行人航向最优融合方法 |
CN106908759A (zh) * | 2017-01-23 | 2017-06-30 | 南京航空航天大学 | 一种基于uwb技术的室内行人导航方法 |
CN106908060A (zh) * | 2017-02-15 | 2017-06-30 | 东南大学 | 一种基于mems惯性传感器的高精度室内定位方法 |
CN107084718A (zh) * | 2017-04-14 | 2017-08-22 | 桂林电子科技大学 | 基于行人航迹推算的室内定位方法 |
CN107289933B (zh) * | 2017-06-28 | 2019-08-20 | 东南大学 | 基于mems传感器和vlc定位融合的双卡尔曼滤波导航装置和方法 |
CN107677267A (zh) * | 2017-08-22 | 2018-02-09 | 重庆邮电大学 | 基于mems‑imu的室内行人导航航向反馈修正方法 |
CN108318033A (zh) * | 2017-12-28 | 2018-07-24 | 和芯星通(上海)科技有限公司 | 行人导航方法和系统、电子设备及存储介质 |
CN108680189B (zh) * | 2018-07-09 | 2024-04-12 | 无锡凌思科技有限公司 | 一种基于卡尔曼滤波的mems陀螺仪z轴零偏动态补偿方法 |
CN109129482B (zh) * | 2018-08-29 | 2021-05-25 | 武汉理工大学 | 一种动态补偿机器人直线导轨运动误差的方法 |
CN109284006B (zh) * | 2018-11-09 | 2024-01-16 | 中科数字健康科学研究院(南京)有限公司 | 一种人体运动捕获装置和方法 |
CN109470613B (zh) * | 2018-11-12 | 2020-07-03 | 湖南电气职业技术学院 | 一种基于互补滤波姿态融合算法的无人机pm2.5检测装置 |
CN109855620B (zh) * | 2018-12-26 | 2020-10-09 | 北京壹氢科技有限公司 | 一种基于自回溯算法的室内行人导航方法 |
CN110132271B (zh) * | 2019-01-02 | 2022-04-12 | 中国船舶重工集团公司第七0七研究所 | 一种自适应卡尔曼滤波姿态估计算法 |
CN110208740A (zh) * | 2019-07-09 | 2019-09-06 | 北京智芯微电子科技有限公司 | Tdoa-imu数据自适应融合定位装置及方法 |
CN110702104B (zh) * | 2019-09-27 | 2023-09-26 | 同济大学 | 一种基于车辆零速检测的惯性导航误差修正方法 |
CN110672095A (zh) * | 2019-10-17 | 2020-01-10 | 北京首贝科技发展有限公司 | 一种基于微惯导的行人室内自主定位算法 |
CN110887481B (zh) * | 2019-12-11 | 2020-07-24 | 中国空气动力研究与发展中心低速空气动力研究所 | 基于mems惯性传感器的载体动态姿态估计方法 |
CN111189443B (zh) * | 2020-01-14 | 2022-11-11 | 电子科技大学 | 一种在线校准步长、修正运动偏差角和自适应能量管理的行人导航方法 |
CN111982106A (zh) * | 2020-08-28 | 2020-11-24 | 北京信息科技大学 | 导航方法、装置、存储介质及电子装置 |
CN113432612B (zh) * | 2021-06-21 | 2022-10-14 | 北京信息科技大学 | 飞行体的导航方法、装置及系统 |
CN113671997A (zh) * | 2021-08-17 | 2021-11-19 | 深圳市火乐科技发展有限公司 | 投影设备控制方法、校正方法、遥控装置以及投影设备 |
CN113465632B (zh) * | 2021-09-03 | 2024-06-18 | 北京亮亮视野科技有限公司 | 传感器的校准方法、装置、设备和介质 |
CN116659487A (zh) * | 2022-11-02 | 2023-08-29 | 丰疆智能(深圳)有限公司 | 位姿调整方法、位姿调整装置、电子设备及可读存储介质 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104422948A (zh) * | 2013-09-11 | 2015-03-18 | 南京理工大学 | 一种嵌入式组合导航系统及其方法 |
CN103968827B (zh) * | 2014-04-09 | 2017-11-28 | 北京信息科技大学 | 一种可穿戴式人体步态检测的自主定位方法 |
CN103954285B (zh) * | 2014-05-13 | 2018-06-22 | 北京信息科技大学 | 一种室内自主三维空间定位信息融合方法 |
-
2015
- 2015-06-05 CN CN201510300546.3A patent/CN105043385B/zh not_active Expired - Fee Related
Non-Patent Citations (2)
Title |
---|
基于MEMS惯性器件的徒步个人导航仪设计与实现;庞晗;《中国优秀硕士学位论文全文数据库 信息科技辑》;20130116(第2期);论文正文第8页 * |
基于MEMS行人惯性导航的零速度修正技术研究;李辰祥;《中国优秀硕士学位论文全文数据库 信息科技辑》;20140716(第8期);论文正文第22-23页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105043385A (zh) | 2015-11-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105043385B (zh) | 一种行人自主导航定位的自适应卡尔曼滤波方法 | |
US10352959B2 (en) | Method and system for estimating a path of a mobile element or body | |
CN106225784B (zh) | 基于低成本多传感器融合行人航位推算方法 | |
Jiménez et al. | Indoor pedestrian navigation using an INS/EKF framework for yaw drift reduction and a foot-mounted IMU | |
Fourati | Heterogeneous data fusion algorithm for pedestrian navigation via foot-mounted inertial measurement unit and complementary filter | |
Zhang et al. | Inertial sensor based indoor localization and monitoring system for emergency responders | |
CN110553646B (zh) | 基于惯性和磁航向及零速修正的行人导航方法 | |
JP3602095B2 (ja) | 地形を進む有脚動物のための地形ナビゲーション装置 | |
KR20170104621A (ko) | 9축 mems 센서에 기반하여 농기계의 전-자세 각도를 갱신하는 방법 | |
CN106996780B (zh) | 一种航向误差修正方法与装置及磁场检测方法与装置 | |
US20130204572A1 (en) | State detection device, electronic apparatus, and program | |
CN110398245A (zh) | 基于脚戴式惯性测量单元的室内行人导航姿态估计方法 | |
CN109579836A (zh) | 一种基于mems惯性导航的室内行人方位校准方法 | |
Chen et al. | IMU/GPS based pedestrian localization | |
Woyano et al. | Evaluation and comparison of performance analysis of indoor inertial navigation system based on foot mounted IMU | |
CN108007477A (zh) | 一种基于正反向滤波的惯性行人定位系统误差抑制方法 | |
KR101642286B1 (ko) | 보행특성을 이용한 실내에서의 보행자 이동방향 추정 방법 | |
CN112066980B (zh) | 一种基于人体四节点运动约束的行人导航定位方法 | |
CN104897155B (zh) | 一种个人携行式多源定位信息辅助修正方法 | |
CN110672095A (zh) | 一种基于微惯导的行人室内自主定位算法 | |
CN112362057A (zh) | 基于零速修正与姿态自观测的惯性行人导航算法 | |
CN106643713B (zh) | 对阈值平滑自适应调整的零速修正步行者轨迹的推算方法及装置 | |
Khedr et al. | SBAUPT: Azimuth SBUPT for frequent full attitude correction of smartphone-based PDR | |
Kim et al. | Performance improvement and height estimation of pedestrian dead-reckoning system using a low cost MEMS sensor | |
Luna et al. | An indoor pedestrian positioning system based on inertial measurement unit and wireless local area network |
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 |
Granted publication date: 20181026 |