基于地标点匹配的高精度室内定位算法.pdf

第32卷第2期 中国惯性技术学报 Vol.32 No.2 2024 年 02 月 Journal of Chinese Inertial Technology Feb.2024 收稿日期：收稿日期：2023-06-01；修回日期：修回日期：2023-11-12 基金项目：基金项目：高新工程重大专项（5140501B0203）作者简介：作者简介：周凌柯（1973），女，副教授，硕士生导师，主要从事故障监控、数据协调、室内定位的研究。文章编号：文章编号：1005-6734(2024)02-0132-07 doi.10.13695/ki.12-1222/o3.2024.02.004 基于地标点匹配的高精度室内定位算法 基于地标点匹配的高精度室内定位算法 周凌柯，鲜 委，龚文龙，李 胜（南京理工大学 自动化学院，南京 210094）摘要：摘要：针对基于惯导的行人室内定位算法定位误差大的问题，提出了一种基于地标点匹配的行人高精度三维室内定位算法。该算法仅使用惯性测量单元（IMU）这一单一传感器，包含速度约束、航向角约束、水平位置约束和高度约束四个模块。水平位置约束模块可根据航向角变化实时检测并建立地标点，并设计了一种地标点匹配度函数，提高了地标匹配的准确度。多楼层行走实验表明所提算法能够提升行人室内定位精度，其终点误差为 0.3421 m，相较于 ZUPT 算法和 ZUPT+HDE 算法分别减小了82.6%和 68.3%，具有一定的工程应用价值。关 键 词：关 键 词：室内定位；卡尔曼滤波；航向角约束；地标点 中图分类号：中图分类号：TP212.9 文献标志码：文献标志码：A High-precision indoor positioning algorithm based on landmark matching ZHOU Lingke,XIAN Wei,GONG Wenlong,LI Sheng(School of automation,Nanjing University of Science and Technology,Nanjing 210094,China)Abstract:Aiming at the problem of large positioning error of inertial navigation system based pedestrian indoor positioning algorithm,a high-precision three-dimensional indoor pedestrian location algorithm based on landmark matching is proposed.The algorithm only uses the inertial measurement unit(IMU)as a single sensor and includes four modules of speed constraint,heading constraint,horizontal position constraint and height constraint.The horizontal position constraint module can detect and establish landmark points in real-time according to the changes of heading angle,and a landmark matching degree function is designed to improve the accuracy of landmark matching.The multi-floor walking experiment shows that the proposed algorithm can improve the accuracy of pedestrian indoor positioning.Compared to the ZUPT algorithm and the ZUPT+HDE algorithm,the terminal point error of the proposed algorithm is only 0.3421 m,which is reduced by 82.6%and 68.3%respectively,and has certain engineering application value.Key words:indoor positioning;Kalman filtering;heading constraint;landmark 行人导航系统又称单兵导航系统，用于实时提供行人的速度、位置等导航信息1，是单兵数字化系统的重要组成部分。全球定位系统（Global Positioning System,GPS）在室外定位中具有广泛的应用，但是在室内环境下，卫星信号会由于遮挡和多路径效应而不可用，这就使得行人室内定位具有挑战性。基于微机电系统（Micro-Electro-Mechanical System,MEMS）的惯性测量单元（Inertial Measurement Unit,IMU）具备自主性好、体积小、质量小、便于携带等特点2，因此被广泛应用于行人导航系统。基于 IMU 的行人的室内定位广泛使用零速检测（Zero Velocity Update,ZUPT）与行人航迹推算（Pedestrian Dead Reckoning,PDR）算法，但这些定位算法只能得到行人的相对位置与相对航向，并且定位误差会随着时间而累积，导致定位效果变差3。为了抑制行人室内定位中航向角漂移的问题，第 2 期 周凌柯等：基于地标点匹配的高精度室内定位算法 133 Borenstein 提出了启发式航向角削减（Heuristic Drift Elimination,HDE）算法。基于建筑多为矩形这一事实，将建筑方向定义为主方向，通过主方向来约束航向角4；Jimenez 则对 HDE 算法进行改进，只有检测到行人正在直行时才会执行 HDE 算法，从而减小行人在非主方向上行走时 HDE 的过度修正5；针对 HDE方法中判断直行需要设定阈值的问题，Muhammad 提出了一种无阈值的转弯检测技术6。然而传统的 HDE方法只是将航向角的主方向在 360 内等间隔地分割为 4 个或 8 个，若行人在非预设的主方向上直行，则HDE 方法无法起到修正作用。HDE 方法仅能对行人的航向角进行约束，可以增添超宽带7、蓝牙8、WIFI9、音频10等外接设备来辅助定位，但这些额外设备的部署与维护进一步增加了人力与财力的消耗。使用地标点辅助定位则具备成本低的优势，在室内定位领域，传感器输出呈现规律性变化的位置点被称为地标点11。Jimenez 将建筑物中出现的斜坡作为地标，事先建立包含斜坡位置信息的数据库，若检测到斜坡则对行人位置进行修正12。胡倩针对不同类型的地标点设定了置信度的计算公式，提高了匹配的准确率13。然而传统的地标点辅助定位需要事先将地标与位置相关联，并不适用于未知环境。考虑到纯惯导解算时高度通道并不稳定，因此需要额外的信息源去约束高度信息，通常使用气压计进行约束。Zhao 将气压计和 PDR 方法融合，通过气压计来计算垂直位移，解决了 PDR 只能实现平面二维定位的问题14；Jao 提出了一种结合气压计和超声波的混合高度计，并在楼梯、坡道等常见室内地形进行实验。在该高度计的辅助下，ZUPT 的导航精度相较于无辅助时提升 91%15，但是气压计解算的高度在温度、气压变化的情况下会急剧恶化。在分析上面所提问题的基础上，本文研究了行人室内行走时的特点，提出了一种基于地标点匹配的高精度室内定位算法。该算法使用 IMU 这一单一传感器，包含速度约束、航向角约束、水平位置约束和高度约束四个模块，其中零速检测算法用来约束速度；增强型启发式偏移消除（Enhanced Heuristic Drift Elimination,eHDE）算法实时检测和建立主方向以约束航向角；实时建立地标点约束水平位置，并设计匹配度的计算公式以区分不同的地标点；基于阶梯高度的高度约束算法约束高度，实现了行人室内的高精度定位。1 融合滤波器设计 1 融合滤波器设计 本文采用卡尔曼滤波算法融合四个模块，该滤波器的框架如图 1 所示。图 1 融合滤波器架构 Fig.1 The structure of fusion filter 陀螺仪和加速度计的测量值被用来进行捷联惯导解算。由于惯性传感器的误差会随着时间迅速增长，为了更好地描述惯导误差的传播规律，建立 15 维误差状态向量模型kX。TnnbbkkkkkkXvpa (1)其中，k 为k时刻的三个姿态角误差；nk v为东向、北向、天向的速度误差；nkp 为东向、北向、天向的位置误差；bk 为陀螺仪零偏向量；bka 为加速度计零偏向量。将惯导的解算结果当做预测量，不同的运动约束算法将会提供相应误差值的虚拟观测量，将预测量与观测量融合以对行人运动时的导航信息进行约束。2 模块设计 2 模块设计 2.1 速度约束 在足绑式行人惯性导航系统中，零速状态时支撑脚相对于地面是静止的，支撑脚上的速度应该为 0，但是由于传感器本身以及惯导算法所带来的误差影响，导致此时的速度并不为 0，可以使用零速检测算法检测零速状态以对速度误差进行修正。本文使用文献16的姿态假设最优检测（Stance Hypothesis Optimal Detection,SHOE）算法进行零速检测，关于该算法本文不再赘述。若检测到当前时刻为零速状态，可得速度的虚拟观测量为：000nnnnENUvvvv (2)为了获得更完整的零速区间，对零速检测结果进行二进制均值滤波。图1中的“零速点”对应每个零速区间的第一个采样点，当前时刻为零速点是进行航向角约束、地标点约束以及高度约束的前提。2.2 航向角约束 2.2.1 传统的HDE HDE算法需事先计算零速点时刻的步幅航向，设134 中国惯性技术学报 第 32 卷 第m个零速点在所有采样点中的序列号为 s m，s m时刻惯导解算的东向、北向位移分别为 x s m和 y s m，则第m步的步幅航向 sm可由相邻两个零速点的东向、北向位移表示1m：1arctan21sx s mx s mmy s my s m (3)该步的对应步长 SL m可以表示为：221+1SL mx s mx s my s my s m(4)由“静止”向“运动”过渡可能会出现伪零速点，这些伪零速点的特征是计算的步长过小。设定步长阈值0.15mSLth，筛除步长小于该阈值的零速点。使用主方向的前提是当前时刻为直行状态，设定直行标识符为 SLP m，角度阈值18th，由相邻四个步幅航向判断当前是否为直行状态3m：11maxmean 3:0otherwisessjjthSLP mfor jmm(5)取走廊方向为主方向，直行标识符为“1”时进行主方向匹配。设与步幅航向最接近的主方向为 1bm，角度阈值28th，满足 12abssbmmth时匹配成功，此时HDE算法提供的虚拟观测量为：1sbmm (6)2.2.2 改进的HDE算法 传统的HDE算法只能在预定义的直线路径上生效，而本文eHDE算法无需预设主方向，能够在行走过程中实时建立主方向，新的主方向new可由相邻四步的步幅航向确定3m：34msj mnewj (7)检测到行人正在直行，则遍历主方向数据库。如果主方向数量为0，则直接建立新的主方向new。如果主方向的数量不为0，则搜索与当前步幅航向最接近的主方向为 1bm，满足 12abssbmmth时用 1bm对航向角进行修正。如果不满足修正条件，则搜索与new最接近的主方向为 2bm，满足 22abs2newbmth时建立新的主方向new，否则不建立新的主方向。为了减小行人在非主方向上直行造成的误修正影响，使用自适应量测噪声进行航向角误差的量测更新，该量测噪声的标准差如式(8)所示。eHDE=exp()(8)其中，eHDE0.013；7。的绝对值越小，卡尔曼滤波对该观测量的置信度越高，即当前的步幅航向与主方向越接近，eHDE的修正作用越明显。eHDE算法的流程图如图2所示。图 2 eHDE 算法流程图 Fig.2 The algorithm flow chart of eHDE 2.3 地标点约束 2.3.1 改进的地标点算法 行人在室内建筑物行走时，在某些特定的区域传感器输出会出现规律性的变化。例如在两条直型走廊相交的拐角处航向角会出现90 左右的变化，而在两个楼梯梯段交接处的平台会出现180 左右的变化，可以把这些位置点视为地标点，对行人导航的位置信息进行修正。经过对建筑结构的分析，本文设定90 与180 这两种类型的地标点。相较于传统的地标点约束算法，本文的地标点约束算法包含两个改进。一是基于航向角的变化实时检测并建立地标点，无需预知地标点的位置。检测到的地标点可以分为初次访问和重复访问两种情况：将初次访问的地标点纳入地标点数据库，与IMU解算的位置进行关联；重复访问时则用已有的地标点信息进行位置修正。虽然IMU解算的位置存在误差，但是该位置由先前时刻的惯导数据解算，其不确定程度小于重复访问时刻，因此基于该信息进行位置修正可以提高定位精度。第二个改进则是设计了一种地标点匹配函数，检测到地标点后取匹配度最高者进行位置修正，避免了单纯以位置区分地标点造成的区分度低、误匹配率高的问题，提高了地标匹配的准确率。考虑到建筑物的结构在不同的楼层上存在强对称性，本文的地标点仅关注东向、北向这二维位置信息，第 2 期 周凌柯等：基于地标点匹配的高精度室内定位算法 135 行走过程中高度方向的位移则通过其他算法进行约束。2.3.2 角度条件 本文的地标点约束算法通过角度条件去检测地标点。地标点检测需要分析相邻两个零速点步幅航向的角度增量，已知第m步与第1m步的步幅航向分别为 sm与1sm，则 第m步 的步 幅航 向增 量 sm可以表示为：1sssmmm (9)假设在地标点处经历的步数为N，事先进行的拐角实验表明该步数满足4,5,3,6,2N。易得地标点处的运动满足两个条件，一是对应N步的步幅航向增量具有相同的符号，逆时针经过拐角时，N步步幅航向增量的符号均为正，顺时针则均为负。设条件一的标识符为 1LF m，则 1LF m可以表示为：111sign0otherwisemsj m NjNLF m (10)二是对应N步的步幅航向增量的总和应该接近特定的角度sum，本文sum为 90 或 180。设定条件二的角度阈值为3=8th，则条件二的标识符 2LFm可以表示为：sum3121abs0otherwisemsj m NjthLFm(11)第m步是否满足地标点检测的角度条件标识符为 LF m，只有条件一与条件二均满足时 LF m才为 1。12&LF mLF mLFm (12)由于角度条件是根据步幅航向是否变化特定的度数来检测地标点，故检测到地标点的时刻滞后于到达地标点的时刻，所以纳入数据库的地标点不能与检测到地标点时输出的位置信息进行关联。设转向中途点 h为N步中满足 sum1abs2msj m Nm的第一个零 速点，则新纳入的地标点应该与h时刻输出的位置相关联。2.3.2 地标点匹配度计算 为了进一步提高地标点匹配的准确度，在角度条件的基础上，引入匹配度的概念。纳入新地标点时不仅会存储位置信息,llx y，也会存储初始步幅航向smN、末尾步幅航向 sm、地标点类型LT以及转向中途点h时刻卡尔曼滤波器输出的东向、北向位置误差的噪声方差2x和2y、以及该条地标点信息入库时的序列号ID。初始和末尾步幅航向将会用来进行匹配度计算，而噪声方差2x和2y将会在重复访问地标点进行位置修正时作为东向、北向位置误差的量测噪声。设第m个零速点满足角度条件，此时遍历地标点数据库。如果此时数据库为空，该地标点肯定是初次访问；如果非空，遍历所有地标点信息，对于数据库中的第 c 个地标点，可得转向中途点h与其位置的欧式距离为cd。若起始航向角偏差为START，末尾航向角偏差为END，第c条地标点信息的类型为cLT，则可根据式(13)计算第c个地标点的匹配度cm。1START2END1cos1cos0otherwisedcccwwdLT mLTmw(13)其中，dw表示距离因素在匹配度中的权重系数；1w和2w表示方向因素所占的权重系数，并且满足121dwww。本文取1/2dw，121/4ww。式(13)表明匹配的前提是地标点类型相同。设定匹配度阈值0.65mth，若数据库中的最大匹配度maxm大于该阈值，表明匹配成功，可用相应位置信息进行修正；反之则为初次访问，需建立新的地标点。地标点匹配成功时，地标点约束算法输出的虚拟观测量可表示为：llxyx s hy s hxy (14)此时地标点约束算法的流程图如图 3 所示。图 3 地标点约束算法流程图 Fig.3 The algorithm flow chart of landmark constraint algorithm 2.4 高度约束 当行人仅通过楼梯实现高度变化时，只会包含平地走、上楼梯和下楼梯这三种运动状态，由于每一级阶梯的高度固定，相邻两个零速点的高度增量应该接近阶梯高度的某个整数倍。本文关注相对高度，引入累积阶梯变化级数totaln，totaln表示当前时刻相对于初136 中国惯性技术学报 第 32 卷 始时刻阶梯变化级数的总和，初始值为 0。在零速点时刻计算高度观测量，设定每一级阶梯的固定高度为stair=0.15 mz，高度约束的阈值=0.05mzth，每一步对应的阶梯变化级数为k，则高度误差的观测量z的求解过程可以用表 1 的伪代码实现。表 1 高度约束算法流程 Tab.1 The process of height constraint algorithm 算法算法 1 高度约束算法 输入：输入：相邻两个零速点惯导输出的高度信息为 z s m和1z s m，上一个零速点时刻的累积阶梯变化级数为total1nm 输出输出：第m个零速点的高度虚拟观测量z 1)1zz s mz s m 2)0z 3)for 0k to 3 do 4)if stairzabs abs zkzth then 5)totaltotal1sign nmnmzk 6)totalstairzz s mnmz 7)break 8)end if 9)end for 3 融合滤波更新 3 融合滤波更新 卡尔曼滤波的状态方程与量测方程分别为：/111kk kkkXXW (15)1kkkkZH XV (16)其中，/1k k为系统的状态转移矩阵；1kW为1k 时刻的系统白噪声；kZ为观测量；kH为k时刻系统的量测矩阵；kV为k时刻的量测噪声。根据惯导的机械编排可以得到系统的状态转移矩阵/1k k为：/1nbnbnbkbk kttttCC aCI0000000II00000I00000I(17)其中，t为采样间隔；nbC为载体坐标系到导航坐标系的坐标转换矩阵；nbbka C为加速度计在导航坐标系上的反对称矩阵；I为3 3的单位阵；0为3 3的零阵。惯导的每个采样时刻均会进行时间更新，若当前时刻运动约束算法生效，则进一步进行量测更新，此时量测矩阵kH由当前虚拟观测量的组合情况决定。4 实验与分析 4 实验与分析 4.1 实验场景介绍 开展多楼层行走实验来验证本文高精度三维室内定位算法，该实验路径的起点位于自动化学院的六楼，实验人员在六楼按照L1-L2-L3-L4-L5的顺序行走，通过楼梯依次进入五楼和四楼，并在五楼和四楼的走廊各行走一周，整个实验历时448 s，起点与终点的水平位置相同，实验人员在六楼的轨迹示意图如图4所示。图 4 六楼行走轨迹示意图 Fig.4 Schematic diagram of walking trajectory on the sixth floor 实验使用荷兰Xsens公司生产的MTI-300传感器采集加速度计以及陀螺仪数据，采集数据期间将该传感器固定于人右脚的脚面上，并利用USB口将数据传输到电脑中，采样频率为100 Hz。该传感器的性能参数如表2所示。表 2 MTI-300 性能参数 Tab.2 The performance parameters of MTI-300 参数 加速度计 陀螺仪 满量程 20 g 450/s 偏置稳定性15g 10/h 噪声密度 60 /Hzg 0.01/s/Hz 4.2 水平定位结果分析 通过水平定位效果分析各种算法对航向角的约束作用。ZUPT和ZUPT+HDE算法的二维轨迹如图5所示，本文算法的二维轨迹如图6所示，其中起点位置记为(0,0)，墙面信息事先通过激光测距仪获得。图 5 ZUPT 和 ZUPT+HDE 算法的多楼层行走实验的二维轨迹 Fig.5 The 2D trajectories of ZUPT and ZUPT+HDE algorithm obtained from the multi-floor walking experiment 第 2 期 周凌柯等：基于地标点匹配的高精度室内定位算法 137 图 6 本文算法多楼层行走实验的二维轨迹 Fig.6 The 2D trajectory of the proposed algorithm obtained from the multi-floor walking experiment 本文算法、ZUPT算法和ZUPT+HDE算法得到的终点误差分别为0.2548 m、1.4186 m和3.4772 m。根据实验的实际情况可知，行走轨迹应该被约束在两侧墙壁之间，但是传统的ZUPT算法航向角发散严重，导致出现了很多轨迹穿墙的情况，而HDE算法能够抑制航向角漂移，减少轨迹穿墙的情况，降低了水平定位的终点误差。由图6可知，相较于ZUPT+HDE算法，本文算法中的地标点约束算法产生了作用，进一步减少了轨迹穿墙的情况，水平定位的定位误差也随之降低。4.3 地标点约束算法验证 为了验证实时建立地标点的可行性，用黑色的五角星标记初次访问的地标点，蓝色的圆圈标记重复访问的地标点，同时在初次访问的地标点旁用数字标记其建立的先后顺序，本文算法多楼层行走实验的三维轨迹图如图7所示。图 7 本文算法多楼层行走实验的三维轨迹 Fig.7 The 3D trajectory of the proposed algorithm obtained from the multi-floor walking experiment 根据实验结果可知，整个实验过程共建立了9个不同的地标点，初次访问的地标点均被正确地建立，而重复访问的地标点也能被正确地检测。为了更好地分析实验结果，地标点约束算法建立的地标点数据库如表3所示，一部分地标点的实际环境图如图8所示。在环境图中用箭头表示对应地标点步幅航向的变化情况，地标点数据库中的序号与环境图中的序号均代表该地标点的建立次序。表 3 多楼层行走实验建立的地标点数据库 Tab.3 The landmark database established in the multi-floor walking experiment ID/mlx/mly初始航向/rad 末尾航向/rad类型 1 5.35 43.443.09 1.64 1 2 37.34 40.191.53 0.01 1 3 33.90 2.02 0.04 1.52 1 4 0.77 0.851.66 3.06 1 5 0.47 9.612.99 1.68 1 6 4.3510.431.65 3.07 1 7 2.6714.133.10 0.08 2 8 1.589.630.03 1.43 1 9 1.49 10.161.44 3.03 1 图 8 部分地标点的实际环境图 Fig.8 Actual environmental map of some landmarks 本文根据航向角的变化情况设定了两种类型的地标点，航向角变化接近90 的地标点为类型1，航向角变化接近180 的地标点为类型2。由数据库信息可知，仅有地标点7为类型2，这与规划的路径相符。虽然地标点5和9、6和8的地标点类型相同，水平位置也非常接近，但是仍被划分为不同的地标点，这是因为匹配度计算时不仅会考虑水平位置因素，而且也会考虑转向初始和末尾的角度因素，由于地标点5和9、6和8的初始角度和末尾角度均相异，因此被划分为不同的地标点，表明匹配度公式发挥了正确的区分作用。138 中国惯性技术学报 第 32 卷 4.4 高度约束效果分析 为了验证高度约束算法的优越性，本文算法解算高度与ZUPT解算高度的对比结果如图9所示。图 9 本文算法与 ZUPT 算法解算的高度对比 Fig.9 Comparison between the proposed algorithm and ZUPT algorithm in height calculation 由图9可知，ZUPT算法解算的高度发散明显，而高度约束算法即使没有气压计的辅助，也能准确反应行走过程中的高度变化情况。通过终点位置的高度误差评判高度估计的准确度，ZUPT算法的终点高度误差为0.5773 m，而本文算法的终点高度误差为0.0174 m，算法性能提高了96.98%。4.5 误差分析 由于终点位置已知，可以计算不同算法的终点误差，结果如表4所示。由表4可知，相较于ZUPT算法和ZUPT+HDE算法，本文算法的终点误差分别减小了82.6%和68.3%，验证了本文算法的有效性。表 4 多楼层行走实验不同算法的终点误差 Tab.4 Terminal point error of different algorithms in the multi-floor walking experiment 定位方法 ZUPT ZUPT+HDE 本文算法 终点误差/m 1.9675 1.0811 0.3421 5 总 结 5 总 结 针对室内行人导航系统定位误差大的问题，本文提出了一种基于地标点匹配的行人高精度三维室内定位算法。该算法仅使用IMU这一单一传感器，其滤波框架包含速度约束、航向角约束、水平位置约束和高度约束四个模块。多楼层行走实验表明该算法能够提高行人室内定位精度，满足室内定位的需求。参考文献（参考文献（References）：）：1 杜小菁，陈洪，王欣，等.基于 SINS 解算的行人导航技术发展综述J.战术导弹技术，2020(1):113-120.Du X,Chen H,Wang X,et al.A survey of pedestrian navigation technology based on SINS algorithmJ.Tactical Missile Technology,2020(1):113-120.2 李浩，闫国栋，尹业成，等.一种基于改进 DTW 的人体运动模式感知算法J.中国惯性技术学报，2022,30(05):582-588.Li H,Yan G,Yin Y,et al.An algorithm of human movement pattern recognition based on improved DTWJ.Journal of Chinese Inertial Technology,2022,30(05):582-588.3 陈泽，潘献飞，陈昶昊，等.一种用于足绑式行人惯性导航的区间搜索零速检测器J.中国惯性技术学报，2020,28(06):709-715.Chen Z,Pan X,Chen C,et al.An interval search zero-speed detector for foot-tied pedestrian inertial navigationJ.Journal of Chinese Inertial Technology,2020,28(06):709-715.4 Borenstein J,Ojeda L.Heuristic drift elimination for personnel tracking systemsJ.Journal of Navigation,2010,63(4):591-606.5 Jimenez A R,Seco F,Zampella F,et al.Improved heuristic drift elimination(iHDE)for pedestrian navigation in complex buildingsC/2011 International Conference on Indoor Positioning and Indoor Navigation.Guimaraes,Portugal,September 21-23,2011:1-8.6 Muhammad M N,Salcic Z,Wang K I-K.Detecting turns and correcting headings using low-cost INSJ.Journal of Navigation,2018,71(1):189-207.7 李旭，孔鑫，刘锡祥，等.基于交互多模型距离平滑的 UWB/IMU 因子图组合导航方法J.中国惯性技术学报，2022,30(03):322-327.Li X,Kong X,Liu X,et al.UWB/IMU factor graph integrated navigation method based on interactive multi-model distance smoothingJ.Journal of Chinese Inertial Technology,2022,30(03):322-327.8 Bai L,Ciravegna F,Bond R,et al.A low cost indoor positioning system using bluetooth low energyJ.IEEE Access,2020,8:136858-136871.9 Zhang L,Chen Z,Cui W,et al.Wifi-based indoor robot positioning using deep fuzzy forestsJ.IEEE Internet of Things Journal,2020,7(11):10773-10781.10 Thio V,Aparicio J,nonsen K B,et al.Experimental evaluation of the forkbeard ultrasonic indoor positioning systemJ.IEEE Transactions on Instrumentation and Measurement,2021,71:1-13.11 Gu F,Valaee S,Khoshelham K,et al.Landmark graph-based indoor localizationJ.IEEE Internet of Things Journal,2020,7(9):8343-8355.12 Jimnez A R,Seco F,Zampella F,et al.PDR with a foot-mounted IMU and ramp detectionJ.Sensors,2011,11(10):9393-9410.13 胡倩，张文超，魏东岩，等.地图辅助行人航迹推算技术的室内定位方法J.导航定位与授时，2021,8(6):104-111.Hu Q,Zhang W,Wei D,et al.Indoor location method based on map-assisted pedestrian dead reckoningJ.Navigation Positioning and Timing,2021,8(6):104-111.14 Zhao H,Cheng W,Yang N,et al.Smartphone-based 3D indoor pedestrian positioning through multi-modal data fusionJ.Sensors,2019,19(20):4554.15 Jao C S,Wang Y,Lin Y W,et al.A hybrid barometric/ultrasonic altimeter for aiding ZUPT-based inertial pedestrian navigation systemsC/Proceedings of the 33rd International Technical Meeting of the Satellite Division of The Institute of Navigation(ION GNSS+2020).Miami,USA,September 21-25,2020:2500-2517.16 雷明，李擎，朱希安，等.多步态 SVM 分类且自适应阈值的行人定位方法J.传感技术学报，2021,34(07):911-918.Lei M,Li Q,Zhu X,et al.A pedestrian navigation method with multi-gait SVM classification and adaptive thresholdJ.Chinese Journal of Sensors and Actuators,2021,34(07):911-918.050100150200250300350400t-8-7-6-5-4-3-2-1012本文算法的高度变化曲线ZUPT的高度变化曲线/s