• ISSN 0258-2724
  • CN 51-1277/U
  • EI Compendex
  • Scopus 收录
  • 全国中文核心期刊
  • 中国科技论文统计源期刊
  • 中国科学引文数据库来源期刊

基于粒子滤波联合算法的地磁室内定位

黄鹤 仇凯悦 李维 罗德安

杨荣山, 陈健, 王元浩, 高自远, 李莹, 曹世豪. 无砟轨道层间动水压力试验设计[J]. 西南交通大学学报, 2023, 58(2): 414-420. doi: 10.3969/j.issn.0258-2724.20220342
引用本文: 黄鹤, 仇凯悦, 李维, 罗德安. 基于粒子滤波联合算法的地磁室内定位[J]. 西南交通大学学报, 2019, 54(3): 604-610. doi: 10.3969/j.issn.0258-2724.20170927
YANG Rongshan, CHEN Jian, WANG Yuanhao, GAO Ziyuan, LI Ying, CAO Shihao. Experimental Design of Hydrodynamic Pressure in Ballastless Track Crack[J]. Journal of Southwest Jiaotong University, 2023, 58(2): 414-420. doi: 10.3969/j.issn.0258-2724.20220342
Citation: HUANG He, QIU Kaiyue, LI Wei, LUO Dean. Indoor Geomagnetic Positioning Based on Joint Algorithm of Particle Filter[J]. Journal of Southwest Jiaotong University, 2019, 54(3): 604-610. doi: 10.3969/j.issn.0258-2724.20170927

基于粒子滤波联合算法的地磁室内定位

doi: 10.3969/j.issn.0258-2724.20170927
基金项目: 国家重点研发计划资助项目(2017YFB0503702)
详细信息
    作者简介:

    黄鹤(1977—),男,副教授,研究方向为室内导航定位、智能驾驶高精度导航地图等,E-mail:huanghe@bucea.edu.cn

    通讯作者:

    罗德安(1968—),男,教授,研究方向为GNSS理论及应用、三维激光数据处理理论及应用等,E-mail:luodean@bucea.edu.cn

Indoor Geomagnetic Positioning Based on Joint Algorithm of Particle Filter

Funds: National Key Research and Development Program of China,No.2017YFB0503702
  • 摘要: 室内地磁场受钢结构与其它铁磁材料的影响,造成磁场区域局部异常,使室内地磁场具有特异性. 受益于此种现象,室内地磁定位技术得以实现. 然而在大型建筑中地磁场的特异性会减弱,这导致定位结果出现模糊现象. 针对这一现象,文中提出了基于路径匹配的室内地磁定位技术,通过增加匹配特征数量来解决此问题. 使用基于动态时间规整(dynamic time warp,DTW)算法与粒子滤波(particle filter,PF)算法的新型联合算法,并以路径匹配的模式对目标进行追踪. 在匹配过程中又通过计算斯皮尔曼等级(Spearman)相关系数确定路径之间的相似度,使之作为辅助定位. 最后用装载了磁传感器的测量机器人进行实验验证,结果表明:路径匹配具有足够的地磁特征数量,能够解决特异性减弱情况下定位结果模糊现象,且定位精度优于1 m.

     

  • 目前,无砟轨道是高速铁路和城市轨道交通的主要轨道结构形式[1]. 无砟轨道作为一种多层薄板体系,层间界面为结构薄弱环节,在列车荷载和环境共同作用下,结构层间易产生离缝[2-4]. 现场调研发现,在多雨地区或排水不良地段,水容易进入轨道结构层间,形成离缝冒浆等病害,加速无砟轨道结构劣化[5-8]. 因此,研究列车荷载与水耦合作用下无砟轨道水致损伤,首要的是明确结构层间水流特性.

    列车荷载作用下无砟轨道层间离缝内水流特性问题,实质上是多层薄板体系内层间裂缝内水流特性问题. 调研发现,无砟轨道层间脱空病害主要发生在板边,实际无砟轨道层间脱空区域是不规则的形状,为方便分析计算,将层间脱空区域简化为矩形等规则形状. 基于此简化模型,相关学者设计了不同层间脱空状态的混凝土试件,结合现有的加载装置开展动水压力试验. 徐桂弘等[9]设计了与原型相似的几何模型试件,离缝位于试件板边中部,离缝尺寸为300 mm × 500 mm × 3 mm (深度 × 宽度 × 开口量). 试验过程中,施加的荷载为(60±35) kN,分析不同荷载频率下层间离缝内动水压力的变化. 发现荷载频率为15 Hz时,层间离缝动水压力最大,最大值为4.968 kPa. 该试验将混凝土层间脱空试件直接放置到水箱中,由于缺乏必要的防振动措施,试件在加载过程中会发生较为明显的振动甚至跳动,使试验测试结果与理论计算结果存在较大差异. 曹世豪等[10]在原试验装置上增设了必要的防振动措施,设计的裂缝尺寸为250 mm × 600 mm × 3 mm(深度 × 宽度 × 开口量),试验荷载为(25±10) kN,最大荷载频率为5 Hz,测得层间离缝最大动水压力为0.177 kPa,与理论计算结果较为接近. 但列车荷载具有频率高的特点,我国高速铁路设计时速在250~350 km/h,以时速250 km为例,一个转向架相邻轮载作用间隔时间为0.04 s,即荷载频率为25 Hz.

    以上试验研究一方面受试验加载设备的限制,采用的荷载条件难以反映列车荷载频率高的特点,另一方面,由于设计的试件尺寸较大,在荷载作用下混凝土层间脱空区域的变形量很小,不能较好地模拟实际列车荷载作用下板边脱空区域的变形行为,也不能很好地反映实际列车荷载作用下无砟轨道层间动水压力变化. 因此,有必要基于无砟轨道层间脱空变形特性,设计能够有效模拟高频荷载作用下无砟轨道层间裂缝内水流运动的试验装置,为进一步分析列车荷载与水耦合作用下无砟轨道层间裂缝内水流特性提供试验基础.

    采用ANSYS Workbench建立无砟轨道层间离缝冒浆平面简化模型,网格划分如图1所示,对结构进行谐响应分析,荷载平均施加在承轨台上,荷载幅值取为钢轨支点力(扣件对轨道的作用力)的幅值[11],荷载频率取25 Hz;在不考虑弹性基础的影响下,支承层底部采取全约束. 各部件计算参数如表1所示. 在此基础上,在脱空区域的最内侧(尖端)、中点、边缘处分别设置测点1、2、3,监测不同测点处的垂向相对位移(脱空区域道床板底面与支承层表面垂向位移差值),分析不同脱空深度和开口量对无砟轨道层间脱空区域变形特性的影响.

    图  1  无砟轨道层间脱空网格划分
    Figure  1.  Meshing for interlayer debonding in ballastless track
    表  1  材料参数
    Table  1.  Material parameters
    部件强度弹性模量/GPa泊松比密度/(kg·m−3
    轨枕C6035.50.202500
    道床板C4032.50.202450
    支承层C1522.00.182400
    下载: 导出CSV 
    | 显示表格

    由于层间脱空区域扩展到承轨台下方时,会导致结构受力状态的改变,故首先分析不同脱空深度下脱空区域的变形行为. 当脱空深度L分别为0.10、0.15、0.20、0.25、0.30、0.35 m和0.40 m[10],开口量h=8 mm时,提取不同监测点垂向相对位移,负值表示向下运动,如图2所示. 由图可知:随着脱空深度的增大,脱空区域不同位置垂向相对位移近似线性增大,在测点1处变化幅度很小,垂向相对位移接近于0;在测点3处变化幅度最大,脱空深度增大4倍,垂向相对位移增大4倍~5倍;在不同脱空深度下,脱空区域垂向相对位移在最内侧最小,在边缘处最大,脱空区域垂向相对位移沿脱空边缘方向近似线性增大.

    图  2  不同脱空深度下脱空区域变形特性
    Figure  2.  Deformation characteristic under different debonding depths

    L = 0.30 m,分析开口量对脱空区域变形行为的影响,h = 2,4,6,8,10 mm[12],计算结果如图3所示. 由图3可知:随着开口量增大,脱空区域不同测点垂向相对位移近似相等,表明开口量的变化对脱空区域的变形行为影响很小;在不同开口量下,脱空区域垂向相对位移在最内侧最小,在边缘处最大,最大垂向相对位移均在0.220 mm内. 综合1.1、1.2节计算分析发现,当L = 0.30 m时,脱空区域最大垂向相对位移为0.201 mm,与文献[13]现场测试结果接近.

    图  3  不同开口量下脱空区域变形特性
    Figure  3.  Deformation characteristic under different crack openings

    本文对轨道结构进行简化,将无砟轨道简化为道床板与支承层结构. 实际无砟轨道层间离缝形状是不规则的,假定离缝为规则的形状. 基于列车荷载作用下无砟轨道层间脱空区域的变形特性,结合课题组研制的高频加载装置,设计出如图4所示的模拟装置. 模拟装置由装配式钢板工装、预制水槽、高频加载装置、螺栓、混凝土板等构成,混凝土上、下板之间的空隙作为层间脱空区域. 模拟原理:装配式钢板工装的上板可视为悬臂结构,在高频荷载作用下,上板边缘垂向位移最大. 装配式钢板工装上下板通过螺栓与混凝土板联结,当钢板上板受力变形时,混凝土上板随之产生相同的位移,且保证混凝土边缘处的垂向位移最大,层间脱空区域垂向相对位移沿脱空边缘方向近似线性增大,符合列车荷载作用下脱空区域的变形特性.

    图  4  层间脱空模拟装置示意
    Figure  4.  Schematic of the interlayer debonding simulation device

    根据第1节的计算分析,为模拟现场实际荷载作用下脱空区域的变形特征,设计层间脱空离缝深度为300 mm,宽度为200 mm,开口量在0~15 mm内调节. 混凝土上板尺寸为300 mm × 200 mm × 50 mm,混凝土下板尺寸为350 mm × 200 mm × 50 mm. 混凝土上、下板试件的强度等级为C40,试件内预埋螺栓与装配式钢板工装连接. 装配式钢板工装由10 mm的钢板焊接制作. 预制水槽尺寸为1600 mm × 800 mm × 150 mm. 水槽底面预埋6个螺栓,通过螺栓与装配式钢板工装连接,以固定结构,减少试验过程中结构振动对试验结果的影响. 高频加载装置放置到加载装置安置板上,荷载形式为正弦曲线,荷载频率可达50 Hz.

    利用ANSYS Workbench对钢板工装进行谐响应分析,计算不同荷载作用下结构上板的垂向相对位移,与现场测试结果对比,确定试验实际加载值. 装置材料选用结构钢,弹性模量为 210.0 GPa,泊松比为 0.30. 装置底部设置为全约束,侧面约束纵向和横向位移. 当荷载频率为25 Hz,不同荷载幅值作用下结构上板边缘垂向相对位移如图5所示. 由图5可知,在荷载0.5~1.5 kN下,随着荷载增加,结构上板边缘位移近似线性增大,垂向相对位移值均在现场实测结果之内. 当荷载幅值为1.1 kN时,结构上板边缘垂向相对位移为0.220 mm,较为接近L = 0.30 m,h = 8 mm的工况下脱空区域边缘的垂向相对位移.

    图  5  不同荷载作用下结构上板垂向相对位移
    Figure  5.  Vertical relative displacements of the upper plate under different loads

    组装试验装置,在荷载幅值为1.1 kN、荷载频率为25 Hz的条件下,采用高精度接触式位移计测试板端位移,对比试验与理论计算结果,如图6所示. 在高频加载装置作用下,试验测试板端最大垂向相对位移约为0.20 mm,与理论计算结果0.22 mm接近,表明设计的层间脱空模拟装置可以用于模拟测试高频荷载作用下无砟轨道层间脱空区域的变形行为.

    图  6  试验结果与理论计算结果对比
    Figure  6.  Comparison of results between experimental and theoretical calculation

    结合前文设计的层间脱空装置,开展无砟轨道层间离缝动水压力试验. 向预制水槽中注入20 ℃的自来水,保证水位高于离缝上表面. 层间脱空区域后部及两侧利用防水胶黏接,保证离缝内的水仅沿着出口方向流动. 压力传感器测试端通过软管连接皮托管深入离缝内部,另一端与采集软件Smart Sensor连接,实时监测测点水压力. 各个测点等间距分布,相邻测点间距为50 mm,测点 ① 位于层间离缝最内侧,测点 ⑦ 位于离缝开口处,具体测量位置如图7所示. 由于脱空区域变形特征与脱空深度有关,而且为了方便测试,适应压力传感器尺寸,试验时开口量取为8、14 mm. 按照表2的4种设计工况进行试验.

    图  7  测点位置分布示意
    Figure  7.  Location schematic of measuring points
    表  2  试验工况
    Table  2.  Test working conditions
    试验工况开口量/mm加载频率/Hz目的
    1815加载频率对动水压力的影响
    2825
    3825开口量对动水压力的影响
    41425
    下载: 导出CSV 
    | 显示表格
    3.2.1   动水压力时间分布特性

    在加载频率25 Hz、层间离缝开口量8 mm的工况,提取加载后的试验数据,分析不同监测点的动水压力时程分布规律,如图8所示. 在高频荷载作用下,不同测点动水压力变化趋势总体呈现正弦形式,其值正负交替变化,随着荷载达到最大值后达到峰值. 加载时,由于道床板混凝土底面靠近支承层混凝土表面,使得层间脱空区域内水被排出,此时脱空区域内产生正压力;卸载时,由于道床板混凝土底面远离支承层混凝土表面,使得层间脱空区域外水被吸回脱空区域内,此时脱空区域内产生负压力. 以测点 ①为例,最大正压为15.794 kPa,最大负压为−16.766 kPa,压力差为32.560 kPa.

    图  8  不同测点动水压力时程曲线
    Figure  8.  Time history curves of hydrodynamic pressure at different measuring points
    3.2.2   动水压力空间分布特性

    在加载频率25 Hz、层间离缝开口量8 mm的条件下,提取不同测点动水压力的最大正压和最大负压,如图9所示. 动水压力沿离缝长度方向近似线性分布,在测点 ① 处动水压力最大,监测点越靠近离缝出口,动水压力越小.

    图  9  不同测点处动水压力最值
    Figure  9.  Maximum values of hydrodynamic pressure at different measuring points
    3.2.3   加载频率对动水压力的影响

    在离缝为8 mm的条件下改变加载频率大小,对比不同荷载频率下测点 ① 的动水压力时程曲线,如图10所示,当荷载频率为25 Hz时,该测点的最大动水压力约为15.794 kPa;当加载频率为15 Hz时,该处的最大动水压力约为1.646 kPa,频率增大10 Hz,最大动水压力增大接近10倍,说明荷载频率是无砟轨道层间离缝水压力的重要影响因素之一. 测得不同监测点动水压力沿离缝分布,如图11所示,随着加载频率增大,动水压力会大幅度增大. 在不同频率下,离缝内动水压力均在离缝深处最大,沿离缝出口方向减小.

    图  10  不同加载频率下测点 ① 的动水压力时程曲线
    Figure  10.  Time history curves of hydrodynamic pressure at measuring point ① with different loading frequencies
    图  11  加载频率对动水压力的影响
    Figure  11.  Influence of loading frequency on hydrodynamic pressure
    3.2.4   离缝开口量对动水压力的影响

    在加载频率为25 Hz时,对比不同离缝开口量下测点 ① 的动水压力时程曲线,如图12所示. 在开口量为8 mm时,测点 ① 的水压力为15.794 kPa;开口量为14 mm时,该处的水压力为8.320 kPa,说明离缝开口量是无砟轨道层间离缝水压力的重要影响因素之一. 测得不同监测点动水压力沿离缝分布如图13所示. 由图可知:随着离缝开口量的增大,动水压力会减小;在不同开口量下,离缝内动水压力均在离缝深处最大,沿离缝出口方向减小.

    图  12  不同开口量下测点 ① 的动水压力时程曲线
    Figure  12.  Time history curves of hydrodynamic pressure at measuring point ① with different crack openings
    图  13  离缝开口量对动水压力的影响
    Figure  13.  Influence of crack opening on hydrodynamic pressure

    根据图4试验模型,利用ANSYS Workbench与CFX建立双向瞬态流固耦合模型,将层间脱空模拟装置和混凝土试件设置为固体域;混凝土层间脱空区域设为流体域,并假定水流状态为层流;将混凝土试件层间离缝上下表面设置为流固耦合面,便于固体域与流体域进行数据传递. 根据表1设置材料参数,计算相同荷载条件下(25 Hz)层间裂纹不同测点处的动水压力. 不同测点动水压力理论计算结果与试验结果对比如图14所示. 试验结果与理论计算结果存在一定误差,可能原因是试验过程存在局部水压力损失,但二者整体趋势接近,表明试验模型具有一定的有效性.

    图  14  不同测点动水压力理论计算结果与试验结果对比
    Figure  14.  Comparison of results between theoretical calculation and experiment of hydrodynamic pressure at different measuring points

    1) 随着脱空深度L的增大,脱空区域垂向相对位移显著增大,但开口量h对脱空区域垂向相对位移影响很小. 当L = 0.3 m时,脱空区域最大垂向相对位移为0.201 mm与现场测试结果接近. 脱空深度L是影响脱空区域垂向相对位移的主要因素.

    2) 当荷载频率为25 Hz,幅值为1.1 kN时,设计的层间脱空模拟装置板端最大垂向相对位移为0.220 mm,与现场测试结果接近,表明可以利用该装置模拟实际列车荷载作用下无砟轨道层间脱空区域水流特性.

    3) 在高频荷载作用下,无砟轨道混凝土层间离缝内动水压力整体变化趋势呈现正弦形式,当荷载值达到最大时,离缝内部水压力达到峰值;相同条件下,离缝内动水压力在离缝深处最大,沿离缝出口方向减小. 当荷载频率为25、15 Hz时,层间离缝内最大动水压力分别为15.794、1.646 kPa,随着荷载频率增大,动水压力增大. 当离缝开口量为8、14 mm时,层间离缝内最大动水压力分别为15.794、8.320 kPa,随着开口量增大,动水压力减小.

    致谢:西南交通大学原创性科研仪器项目(XJ2021KJZK035)的资助.

  • 图 1  定位流程框架

    Figure 1.  Framework of the positioning process

    图 2  联合算法流程

    Figure 2.  Process flow of the joint algorithm

    图 3  走廊平面图以及地磁参考图

    Figure 3.  Corridor plan and geomagnetic reference map

    图 4  测量机器人结构

    Figure 4.  Structure of a measurement robot

    图 5  点位与路径长度关系

    Figure 5.  Relationship between points and path length

    图 6  不同粒子数随着路径增加的定位结果

    注:图中的数字编号代表粒子数,即1表示N = 100粒子

    Figure 6.  Positioning results of different particle numbers increasing with path

    图 7  误差占比(e < 1 m)

    Figure 7.  Proportion of error(e < 1 m)

    图 8  同一路径基于粒子滤波器单点定位结果(N = 400)

    Figure 8.  Positioning results of single point for the same path based on particle filter (N = 400)

    图 9  粒子滤波器基于单点匹配和联合算法基于路径匹配的误差占比以及匹配时间

    Figure 9.  Error ratio and matching time of the particle filter based on single point matching and joint algorithm based on path matching

    图 10  定位结果对比(N = 400)

    Figure 10.  Comparison of positioning results (N = 400)

    图 11  不同路径定位误差比较

    Figure 11.  Comparison of positioning errors for different paths

    表  1  不同粒子数匹配时间

    Table  1.   Time required to match different particle counts

    N100200300400500600
    时间/s1.922.963.844.735.726.71
    下载: 导出CSV
  • VALVERDE T G, SOLA A G, HAGRAS H, et al. A fuzzy logic-based system for indoor localization using WiFi in ambient intelligent environments[J]. IEEE Transactions on Fuzzy Systems, 2013, 21(4): 702-718.
    LUOH L. ZigBee-based intelligent indoor positioning system soft computing[J]. Soft Comput., 2013, 18: 443-456.
    NI L M, LIU Yunhao, LAU Y C, et al. LANDMARC: indoor location sensing using active RFID[C]//Proceedings of the First IEEE International Conference on Pervasive Computing and Communications, 2003, Fort Worth: [s.n.], 2003: 407-415
    SKVORTZOV V Y, LEE H K, BANG S, et al. Application of electronic compass for mobile robot in an indoor environment[C]//IEEE International Conference on Robotics and Automation. [S.l.]: IEEE, 2007: 2963-2970
    LI B, GALLAGHER T, DEMPSTER A G, et al, How feasible is the use of magnetic field alone for indoor positioning?[C]//2012 International Conference on Indoor Positioning and Indoor Navigation (IPIN). Sydney: [s.n.], 2012: 1-9
    SUKSAKULCHAI S, THONGCHAI S, WILKES D M, et al. Mobile robot localization using an electronic compass for corridor environment[C/OL]//2000 IEEE International Conference on Systems, Man, and Cybernetics. Nashville: IEEE, 2000, 5: 3354-3359
    SIIKSAKULCHAI S, THONGCHAI S, WILKES D M, et al. Mobile robot localization using an electronic compass for corridor environment[C/OL]//IEEE International Conference on Systems, 2000[2017-12-12]. http://www8.cs.umu.se/research/ifor/dl/LOCALIZATION-NAVIGATION/Mobile%20Robot%20Localization%20using%20an%20Electronic%20Compass%20for%20Corridor.pdf
    Kim S E, Kim Y, Yoon J, et al. Indoor positioning system using geomagnetic anomalies for smartphones[C/OL]//2012 International Conference on Indoor Positioning and Indoor Navigation. Sydney: University of New South Wales, 2012[2017-10-22]. https://ieeexplore.ieee.org/abstract/document/6418947
    FRASSL M, ANGERMANN M, LICHTENSTERN M, et al. Magnetic maps of indoor environments for precise localization of legged and non-legged locomotion[C]//IEEE International Conference on Intelligent Robots and Systems. [S.l.]: IEEE, 2013: 913-920
    PUTTA R, MISRA M, KAPOOR D. Smartphone based indoor tracking using magnetic and indoor maps[C]//2015 IEEE Tenth International Conference on Intelligent Sensors, Sensor Networks and Information Processing. Singapore: IEEE, 2015: 7-9
    LI B, GALLAGHER T, RIZOS C, et al. Using geomagnetic field for indoor positioning[J]. J. Appl. Geod., 2013, 7: 299-308.
    RIEHLE T H, ANDERSON S M, LICHTER P A, et al. Indoor waypoint navigation via magnetic anomalies[C]//2011 Annual International Conference of the IEEE Engineering in Medicine and Biology Society. Boston: IEEE, 2011: 5315-5318
    黄鹤,赵焰,王春来,等. 地磁室内定位基准图数据采集系统设计[J]. 测绘通报,2017(2): 54-59.

    HUANG He, ZHAO Yan, WANG Chunlai, et al. Design of the acquisition system of indoor positioning reference map based on magnetic field data[J]. Bulletin of Surveying and Mapping, 2017(2): 54-59.
  • 加载中
图(11) / 表(1)
计量
  • 文章访问数:  433
  • HTML全文浏览量:  342
  • PDF下载量:  35
  • 被引次数: 0
出版历程
  • 收稿日期:  2018-01-09
  • 修回日期:  2018-05-14
  • 网络出版日期:  2018-05-30
  • 刊出日期:  2019-06-01

目录

/

返回文章
返回