-
摘要: 全球离散格网系统是数字化的多分辨率地球参考模型,在结构上支持多源位置相关信息的融合处理。基于正二十面体剖分的六边形全球离散格网系统具有较好的几何属性,相关研究已引起学术界的广泛关注,如何建立封闭球面上的六边形格网系统编码运算方案是当前的研究难点。研究表明,基于正多面体剖分的全球离散格网系统与正多面体格网系统拓扑等价,两者的编码运算结果也完全相同。根据这一原理,结合四孔六边形格网系统在正二十面体表面的分布特点,基于六边形格点四叉树定义顶点瓦片与面瓦片结构,提出了正二十面体四孔六边形格网系统编码运算方案。该方案通过高效编码运算实现了格网单元跨面操作,克服了现有成果需借助低效浮点数运算实现相同操作的缺陷。对比实验表明,该方案的跨面邻近单元搜索效率约是六边形四元平衡结构方案的19.6倍。Abstract: Discrete global grid systems(DGGS) are digital reference models with multi-resolution for earth and its structure supports the fusion processing of multi-source geospatial information. The icosahedral DGGS have aroused wide attention for their excellent geometric properties and the research difficulty is the code operation scheme for the spherical hexagonal grid system currently. It is proved that DGGS based on the regular polyhedrons are topologically equivalent to the relative regular polyhedral grid systems and their schemes for code operation are topologically equivalent as well. According to this, combining the characteristics of the aperture 4 hexagonal grid system on the surface of the icosahedron, this paper defines vertex tile and face tile based on hexagon lattice quad tree and proposes the code operation scheme for the icosahedral aperture 4 hexagonal grid system. This scheme realizes the cross-face operation of cells using code operation with high efficiency and overcomes the drawback of existing schemes brought by the use of floating numbers for cross-face operation with low efficiency. In addition, the search efficiency for cross-face adjacent cells is about 19.6 times that of hexagonal quad balanced structure.
-
Keywords:
- discrete global grid system /
- regular icosohedron /
- hexagon /
- code operation
-
目前,室内定位技术的研究主要集中在利用Zigbee[1]、RFID[2](radio frequency identification,RFID)和WiFi[3](wireless fidelity,WiFi)等载波或射频进行定位,其中WiFi和Zigbee利用接收信号强度对目标进行测距定位,但室内密闭的环境极易产生电磁干扰和多路径效应,对场强信息干扰比较大;RFID可以进行区域定位,准确性无法得到保障。国内外的一些学者[1-3]针对室内人员定位进行了研究,提出了一种利用步长-步数模型结合行人航向信息来对室内人员进行定位的方案,在短时间内可以取得较高的定位精度[4-6]。基于此背景,本文利用微机电机械系统(micro electro mechanical system,MEMS)惯性测量元件(inertial measurement unit,IMU)对人员运动进行检测,设计了一种基于零速检测的加速度量测幅值计步算法,将输出的加速度信息用作零速检测,识别行人运动姿态,并对处理过程中可能出现的伪零速现象进行剔除,得到了可靠的计步效果。
1 行人运动模型研究
行人行走是左右腿周期性交替摆动的过程,如图 1所示。行人的步态周期可以分为脚部着地阶段和跨步摆动阶段。着地阶段从行人脚跟着地开始,到脚尖离地结束;跨步摆动阶段从脚尖离地开始到脚跟着地结束,如此双腿不断交替运动[7]。
1.1 运动参数分析
从运动参数角度,行人肢体周期性地运动会导致运动参数如速度、加速度和旋转角速度等发生周期性的变化。行人正常行走进入跨步摆动阶段,脚尖离地后,加速度为正值(以行人行走方向为正),速度增大,腿部加速摆动,随后加速度减小直至为零,速度达到最大值,腿部抬至最高点;加速度继续减小为负值,速度开始减小,腿部经历减速过程直至脚部着地,此时速度和加速度都近似为零,进入脚部着地阶段。行人运动过程与运动参数对应关系如图 2所示。
根据加速度和速度的上述对应关系,可以利用加速度的变化推理速度的变化。跨步时脚尖离地后加速度为正值速度逐渐增大,至加速度减小为零速度达到最大值;加速度为负值的时候速度减小,至脚着地时加速度为零,速度也减小为零。根据这些变化特征,可以判别行人是处于脚部着地阶段还是处于跨步摆动阶段,实现行人姿态的判断,完成行走步数的统计。
1.2 行人步数统计
常见的利用加速度进行计步的算法有波峰检测法[8]、相关性分析法[9]和零速检测法。
波峰检测法是通过检测信号波形的峰值,根据运动特征判断有效步伐,统计步数。这种检测方法通过检测加速度曲线的极值,而加速度曲线并不是严格的正弦或余弦曲线,在判别过程中由于伪波峰和伪波谷的干扰使得判别结果往往不准确(图 3)。
自相关判别法是利用当前跨步周期和上一跨步周期的加速度值的相关性来判别行人的运动状态。这种方法依赖于严格的加速度值之间的相关性,对算法要求较高。
零速检测常用来处理惯性导航系统(inertial navigation system,INS)中累计误差问题,它的原理是载体在停止运动时速度和加速度均为零,而实际上系统仍然有输出值,将输出值当做零速误差作为外部测量值修正INS,达到控制累积误差的目的。作者正是利用零速检测来判断行人行走过程中脚部着地阶段,作为判断行人前进一步的依据,实现步数的统计。
2 基于零速检测计步算法设计
行人运动是在地理坐标下的运动,而IMU输出的加速度是载体坐标系下的数值,为便于阈值的选取和方便判别的实施,需要进行坐标转换,将载体坐标系下的加速度值转换到地理坐标系下;为充分利用加速度值,避免单一参数出现的模糊判别现象,将三轴加速度的模‖a‖作为考察指标进行零速检测;针对加速度为零的现象也可能出现在跨步摆动阶段从而导致步数误判的伪零速点进行剔除,保证了计步的准确性和可靠性。
2.1 坐标转换
MEMS输出的运动参数数据是在载体坐标系下的数据,而行人航位推算所在的坐标系是地理坐标系,因此需要将载体坐标系下的加速度、角速度等数据转换到地理坐标系下。
(1) 载体坐标系
载体坐标系O -xbybzb的原点与载体的质心重合,x轴沿载体横轴指右,y轴沿载体纵向指前,z轴沿载体竖轴向并与x轴和y轴构成右手坐标系。但是载体坐标系的坐标轴朝向并不唯一,有的载体坐标系的x轴沿载体纵轴向前,y轴沿载体横轴向右,z轴沿载体竖向与x轴和y轴成右手坐标系,如图 4所示。
(2) 地理坐标系
地理坐标系用坐标O -xtytzt表示,使用三维球面来定义地球表面位置, 通过经纬度对地球表面点位引用,本文选取东北天坐标系为导航坐标系,其原点在载体的质心,x轴沿纬线指东,y轴沿经线指北,z轴沿地球切面垂线指天,与x轴和y轴构成右手坐标系,其中x轴和y轴构成的平面平行于当地水平面。
载体坐标系到地理坐标系的转换可以通过载体姿态角依次绕相应的坐标轴三次旋转完成。设载体的航向角为ψ、俯仰角为θ、横滚角为γ,从载体坐标系转换到地理坐标系的步骤如下:
$O-{{x}_{b}}{{y}_{b}}{{z}_{b}}\xrightarrow[旋转\gamma ]{绕{{Y}_{b}}轴}O-{{x}_{2}}{{y}_{2}}{{z}_{2}}\xrightarrow[旋转\theta ]{绕{{X}_{2}}轴}O-{{x}_{1}}{{y}_{1}}{{z}_{1}}\xrightarrow[旋转\psi ]{绕{{Z}_{1}}轴}O-{{x}_{t}}{{y}_{t}}{{z}_{t}}$ (其中O-x2y2z2和O-x1y1z1为过渡坐标系)从线性代数的角度,每一次旋转都可以用基本旋转矩阵表示,变换矩阵Cbt等于基本旋转矩阵的连乘[10],连乘顺序依基本旋转的先后顺序由右向左排列。
$$\begin{align} & \mathit{\boldsymbol{C}}_{b}^{t}=\mathit{\boldsymbol{C}}_{b}^{1}\mathit{\boldsymbol{C}}_{1}^{2}\mathit{\boldsymbol{C}}_{2}^{n}=\left[ \begin{matrix} \rm{cos}\psi & \rm{sin}\psi & 0 \\ -\rm{sin}\psi & \rm{cos}\psi & 0 \\ 0 & 0 & 1 \\ \end{matrix} \right]\left[ \begin{matrix} 1 & 0 & 0 \\ 0 & \rm{cos}\theta & \rm{sin}\theta \\ 0 & -\rm{sin}\theta & \rm{cos}\theta \\ \end{matrix} \right]\left[ \begin{matrix} \rm{cos}\gamma & 0 & \rm{sin}\gamma \\ 0 & 1 & 0 \\ -\rm{sin}\gamma & 0 & \rm{cos}\gamma \\ \end{matrix} \right]= \\ & \quad \quad \quad \left[ \begin{array}{*{35}{r}} \rm{cos}\psi \rm{cos}\gamma -\rm{sin}\psi \rm{sin}\theta \rm{sin}\gamma & \rm{sin}\psi \rm{cos}\theta & \rm{cos}\psi \rm{sin}\gamma +\rm{sin}\psi sin\theta cos\gamma \\ -\rm{cos}\psi \rm{sin}\theta \rm{sin}\psi & \rm{cos}\psi \rm{cos}\theta & \rm{cos}\psi \rm{sin}\theta \rm{cos}\gamma \\ -\rm{cos}\theta \rm{sin}\gamma & -\rm{sin}\theta & \rm{cos}\theta \rm{cos}\gamma \\ \end{array} \right] \\ \end{align}$$ (1) 载体坐标系的数据向量(xb, yb, zb)T经过坐标转换后为地理坐标系的(xt, yt, zt)T:
$$\left( \begin{matrix} {{x}_{t}} \\ {{y}_{t}} \\ {{z}_{t}} \\ \end{matrix} \right)=\mathit{\boldsymbol{C}}_{b}^{t}\left( \begin{matrix} {{x}_{b}} \\ {{y}_{b}} \\ {{z}_{b}} \\ \end{matrix} \right)$$ (2) 图 5为IMU三轴加速度由载体坐标系转换到地理坐标系。可以看出,在载体坐标系下,由于载体朝向和重力加速度在三轴上均有分量,导致行人脚步着地时x、y、z三轴的加速度不为零,为零速检测带来了困难,经过坐标转换后,行人脚步着地时三轴加速度线型水平且均为零,转换后的加速度曲线便于正确统计行人前进步数。
2.2 加速度量测幅值法零速检测
行人运动时,三轴加速度值都发生周期性变化,但变化的程度和方向各不相同。如果仅利用单轴加速度作为判别行人步行姿态往往不准确,因此可以融合三轴加速度数值,将融合加速度的幅值‖a‖作为判别指标进行零速检测,步骤如下。
(1) 三轴加速度转换为地理坐标系下的加速度序列$\left\{ a_{t}^{x}\left( 1 \right),\text{ }a_{t}^{x}\left( 2 \right),\cdots ,\text{ }a_{t}^{x}\left( n \right) \right\},\left\{ a_{t}^{y}\left( 1 \right),\text{ }a_{t}^{y}\left( 2 \right),\cdots ,\text{ }a_{t}^{y}\left( n \right) \right\},\left\{ a_{t}^{z}\left( 1 \right),\text{ }a_{t}^{z}\left( 2 \right),\cdots ,\text{ }a_{t}^{z}\left( n \right) \right\}$,其合加速度为:
$$\|{{a}_{t}}\left( k \right)\|=\sqrt{a_{t}^{x}{{\left( k \right)}^{2}}+a_{t}^{y}{{\left( k \right)}^{2}}+a_{t}^{z}{{\left( k \right)}^{2}}}$$ 式中,k=1, 2, …n为采样点次序;atx,aty,atz分别为x轴、y轴和z轴加速度。
(2) 设置阈值区间T=[tmin, tmax],则:
$$C\left( k \right)=\left\{ \begin{array}{*{35}{l}} 1,&{{t}_{\text{min}}}<\|{{a}_{t}}\left( k \right)\|<{{t}_{\text{max}}} \\ 0,&否则 \\ \end{array} \right.$$ (3) 式中, C(k)为1代表零速检测成功,即此采样点上行人速度为零,反之C(k)为0。
(3) 经过上述步骤的处理,得到一个n维的0、1向量(n代表采样点个数),计算向量中连续出现1的次数,连续出现说明并不是由于加速度值的噪声导致的偶然为零,而是由于行人在这段时间内脚部处于着地状态,速度一直是零,从而完成了步数的初步统计。
(4) 伪零速点剔除。步骤(3) 初步得到计步结果,但是其中会有干扰步数的出现。由物理学知识,脚着地静止阶段,加速度与速度均为零,而当测得加速度为零时,速度却并不一定为零,加速度为零的情况也可能出现在跨步摆动阶段加速度由正值变为负值的过程中,因此为得到准确的计步结果,必须剔除伪零速点。根据行人运动特点,脚部着地阶段大致占整个行走周期的40%左右,而跨步中间加速度为零的时间极短,一般不会超过整个跨步周期的10%,跨步中间加速度为零的采样点出现的次数与采样的频率有关,因此可以将加速度为零的采样点连续出现个数小于采样频率的10%的情况认为是出现在跨步过程中,不作为计步依据,应当予以剔除。
根据上述步骤,可以得到行人行走过程中脚部着地阶段的次数,作为最终步数输出。整个算法流程图 6所示。
3 实验与分析
实验所采用的硬件产品和元件佩戴方式如图 7所示。该硬件产品是美国Microstrain公司生产的3DM-GX3-25微型航向参考系统,同时集成了三轴加速度计、三轴陀螺仪和三轴磁力计,所有的参数输出都经过温度补偿,保证了元件工作过程中的稳定性。3DM-GX3-25的数据输出频率从1 Hz到1 000 Hz,适用于各种运动姿态的检测,实验中使用USB接口实现3DM-GX3-25与计算机进行数据传输。
将中国矿业大学环境与测绘学院A栋3楼走廊作为实验场地,实验时利用胶带将测量元件固定在脚面上方,数据采集频率为50 Hz;算法采用MATLAB编程实现。为了验证计步算法的准确性以及对不同运动状态的适应性,开展三种不同的实验:第一种是行人沿走廊直线行走;第二种是行人行走过程中经过两个拐角;第三种是行人行走过程中经过楼梯,利用上述计步算法分别测试3种实验场景中的计步效果(试验场景如图 8所示)。
图 9显示了3种不同运动状态下加速度波形的相应变化,可以看出不同运动状态下的加速度曲线各不相同。直线行走状态由于运动状态比较稳定,加速度呈现出明显的周期性,并且曲线变化比较稳定;行走过程中遇到拐角时,由于脚踝和腿部的旋转,三轴加速度会产生变化,波形也表现出相应的变化;而在行人上下楼梯中加速度变化比较明显,特别是竖轴加速度,如图 9所示。
三种状态分别做5次实验,每次实验行走100步,具体的实验结果如表 1所示。
表 1 计步实验结果Table 1. Step Counting Result状态 实验次数 实际步数 实验步数 误差步数 直线行走状态 1 100 100 0 2 100 100 0 3 100 101 1 4 100 100 0 5 100 100 0 经拐角行走状态 1 100 100 0 2 100 99 -1 3 100 100 0 4 100 101 1 5 100 100 0 经过楼梯行走状态 1 100 99 -1 2 100 98 -2 3 100 100 0 4 100 100 0 5 100 101 1 虽然三种运动状态差异较大,相应的加速度曲线也各不相同,但是利用加速度量测幅值零速检测进行计步的算法仍然可以准确的统计出行人行走的步数。直线行走状态下几乎可以完全统计出行人行走的步数,计步正确率达到99%以上,经过拐角和楼梯的运动状态也具有较为准确的统计结果,达到了98%以上,实验结果表明该计步算法具有良好的准确性和稳定性。
4 结语
目前, 人员定位技术中利用传统的载波或脉冲信号定位会受到室内环境的影响,导致定位结果不尽人意。本文利用自包含的MEMS惯性测量元件采集加速度信息,设计了基于加速度量测幅值法零速检测的计步算法,并对行人运动状态发生改变时的效果进行实验测试。测试结果表明,该计步算法简单有效,对不同的运动状态具有良好的适应性和稳定性,为人员定位提供了可靠的辅助信息。
-
表 1 加法运算查找表
Table 1 Addition Table of Seven Code Cells
相加码元 相加码元 0 1 2 3 4 5 6 10 20 30 40 50 60 100 200 300 400 500 600 0 0 1 2 3 4 5 6 10 20 30 40 50 60 100 200 300 400 500 600 1 1 100 20 2 0 6 10 106 102 200 3 5 600 201 30 4 60 601 2 2 20 200 30 3 0 1 100 201 203 300 4 6 102 302 40 5 10 3 3 2 30 300 40 4 0 1 200 302 304 400 5 20 203 403 50 6 4 4 0 3 40 400 50 5 6 2 300 403 405 500 1 30 304 504 60 5 5 6 0 4 50 500 60 600 1 3 400 504 506 10 2 40 405 605 6 6 10 1 0 5 60 600 601 100 2 4 500 605 106 20 3 50 506 表 2 邻近单元搜索对比实验结果
Table 2 Comparative Result of Search for Adjacent Cell
层次 单元个数 HQBS效率 本文方案效率 效率比 6 84 168.2 8 886.6 52.8 7 170 318.1 7 746.4 24.4 8 340 329.3 6 297.5 19.7 9 682 324.6 6 027.7 18.6 10 1 364 292.3 5 437.3 18.6 11 2 730 276.6 4 871.3 17.6 12 5 460 255.9 4 500.1 17.6 13 10 922 249.2 3 683.5 14.8 14 21 844 242.8 3 399.0 14.0 15 43 690 232.7 3 346.5 14.4 16 87 382 224.6 3 044.8 13.6 17 174 764 213.6 2 828.0 13.2 18 349 526 203.9 2 556.2 12.5 19 699 052 190.3 2 383.4 12.5 -
[1] 周成虎, 欧阳, 马廷.地理格网模型研究进展[J].地理科学进展, 2009, 28(5):657-662 http://d.old.wanfangdata.com.cn/Periodical/dlkxjz200905001 Zhou Chenghu, Ou Yang, Ma Ting. Progress in Geographical Model[J]. Progress in Geography, 2009, 28(5):657-662 http://d.old.wanfangdata.com.cn/Periodical/dlkxjz200905001
[2] Sahr K, White D, Kimerling J. Geodesic Discrete Global Grid System[J]. Cartography and Geographic Information Science, 2003, 30(2):121-134 doi: 10.1559/152304003100011090
[3] 贲进, 童晓冲, 周成虎, 等.基于正八面体的六边形离散格网系统生成算法[J].地球信息科学学报, 2015, 17(7):789-797 Ben Jin, Tong Xiaochong, Zhou Chenghu, et al. Construction Algorithm of Octahedron Based on Hexagon Grid Systems[J]. Journal of Geo-Information Science, 2015, 17(7):789-797
[4] Sahr K. Hexagonal Discrete Global Grid Systems for Geospatial Computing[J]. Archives of Photogrammetry, Cartography and Remote Sensing, 2011, 6(22):363-376
[5] Gibson L, Lucas D. Spatial Data Processing Using Generalized Balanced Ternary[C]. Processing of PRIP 82, IEEE Computer Society Conference on Pattern Recognition and Image Processing, Las Vegas, Nevada, USA, 1982
[6] White D, Kimerling J, Sahr K, et al. Comparing Area and Shape Distortion on Polyhedral-Based Recursive Partitions of the Sphere[J]. International Journal of Geographical Information Science, 1998, 12(8):805-827 doi: 10.1080/136588198241518
[7] Sahr K. Location Coding on Icosahedral Aperture 3 Hexagon Discrete Global Grids[J]. Computers, Environment and Urban Systems, 2008, 32(3):174-187 doi: 10.1016/j.compenvurbsys.2007.11.005
[8] Sahr K. Icosahedral Modified Generalized Balanced Tenary and Aperture 3 Hexagon Tree: US20110022296A1[P]. 2011-01-26
[9] Vince A.Indexing the Aperture 3 Hexagonal Discrete Gobal Grid[J]. Journal of Visual Communication and Image Representation, 2006, 17(6):1 227-1 236 doi: 10.1016/j.jvcir.2006.04.003
[10] 童晓冲, 贲进.空间信息剖分组织的全球离散格网理论与方法[M].北京:测绘出版社, 2016 Tong Xiaochong, Ben Jin.The Principle and Methods of Discrete Global Grid Systems for Geospatial Information Subdivision Organization[M]. Beijing: Surveying and Mapping Press, 2016
[11] Ben J, Li Y L, Zhou C H, et al. Algebraic Encoding Method of the Aperture 3 Hexagonal Discrete Global Grid System[J]. Science China Earth Science, 2018, 61(2):97-109
-
期刊类型引用(10)
1. 向勉,易本顺,周丙涛,谭建军,朱黎. 利用惯性传感器与多模态网络解析跑步参数. 武汉大学学报(信息科学版). 2024(07): 1079-1087 . 百度学术
2. 王希彬,戴洪德,全闻捷,王瑞,贾临生. 基于加速度补偿的惯性行人导航非零速区间姿态估计CKF算法. 系统工程与电子技术. 2023(09): 2894-2901 . 百度学术
3. 汪涛. 基于智能手机惯性传感器导航的定位方法研究. 新乡学院学报. 2023(09): 37-41 . 百度学术
4. 戴洪德,张笑宇,郑百东,戴邵武,郑伟伟. 基于零速修正与姿态自观测的惯性行人导航算法. 北京航空航天大学学报. 2022(07): 1135-1144 . 百度学术
5. 曹娟,崔学荣,李娟,张国平. 多传感器融合的行人航位推算方法研究. 微型电脑应用. 2021(03): 1-3+9 . 百度学术
6. 刘宇,李俊林,路永乐,张旭,方针. 一种基于无线信号辅助的室内无死角定位算法. 导航定位与授时. 2019(01): 66-73 . 百度学术
7. 李刘颂,徐向波. 基于惯性导航的步行者零速检测算法. 传感器与微系统. 2019(03): 154-156+160 . 百度学术
8. 李雪梅,车爱静. 一种基于加速度传感器的自适应计步算法. 唐山学院学报. 2019(03): 18-21 . 百度学术
9. 彭慧,向高军,方针,严隆辉,方海斌. 基于可穿戴式MIMU的波峰-双阈值步数检测算法. 压电与声光. 2019(04): 607-610 . 百度学术
10. 陈国通,王小娜,张晓旭,许文倩,张璞. 基于惯性导航的室内定位误差修正算法. 河北工业科技. 2018(03): 185-190 . 百度学术
其他类型引用(17)