发明名称 一种基于隐马尔科夫模型的室内地磁定位方法
摘要 本发明涉及一种基于隐马尔科夫模型的室内地磁定位方法,包括离线阶段和在线阶段,离线阶段包括:根据地图把待定位区域分成网格;使用智能手机内置的磁力计在每个网格中心RP测量地磁场强度数据;构建离线指纹库,离线指纹库由N个指纹构成,每个指纹数据包括指纹位置l<sub>w</sub>=[x<sub>w</sub>,y<sub>x</sub>]和指纹向量ξ<sub>w</sub>=[μ<sub>w</sub>,σ<sub>w</sub>],在线定位包括:根据步长估计与磁力计确定步伐长度D<sub>i</sub>和运动方向角度Φ<sub>i</sub>,预测行人位置;计算状态转移概率;估计行人步行i步之后的位置。本发明仅通过智能手机即可达到较高的室内定位精度。
申请公布号 CN105910601A 申请公布日期 2016.08.31
申请号 CN201610379288.7 申请日期 2016.05.31
申请人 天津大学 发明人 马永涛;窦智
分类号 G01C21/08(2006.01)I;G01C21/20(2006.01)I;G01C21/16(2006.01)I 主分类号 G01C21/08(2006.01)I
代理机构 天津市北洋有限责任专利代理事务所 12201 代理人 程毓英
主权项 一种基于隐马尔科夫模型的室内地磁定位方法,包括离线阶段和在线阶段,离线数据采集阶段包括以下步骤:1)根据地图把待定位区域分成网格,B<sub>w</sub>为第w个网格;2)使用智能手机内置的磁力计在每个网格中心RP测量地磁场强度数据;3)构建离线指纹库,离线指纹库由N个指纹构成,每个指纹数据包括指纹位置l<sub>w</sub>=[x<sub>w</sub>,y<sub>x</sub>]和指纹向量ξ<sub>w</sub>=[μ<sub>w</sub>,σ<sub>w</sub>],其中μ<sub>w</sub>和σ<sub>w</sub>分别为在第w个网格内采集的地磁场数据的平均值和方差,L表示所有网格中心RP组成的集合,L={l<sub>w</sub>|1≤w≤N};在线定位阶段包括以下步骤:1)令上一次定位的结果为<img file="FDA0001005637060000011.GIF" wi="83" he="71" />位置<img file="FDA0001005637060000012.GIF" wi="30" he="71" />表示人步行i步之后的位置,当检测到人步行一步,根据步长估计与磁力计确定步伐长度D<sub>i</sub>和运动方向角度Φ<sub>i</sub>,认为D<sub>i</sub>与Φ<sub>i</sub>相互独立并服从高斯分布,分别计算D<sub>i</sub>与Φ<sub>i</sub>的概率分布;利用贝叶斯准则,预测行人位置的概率分布<img file="FDA0001005637060000013.GIF" wi="347" he="78" />求行人位置的概率分布<img file="FDA0001005637060000014.GIF" wi="317" he="78" />大于p<sub>T</sub>的集合H:<maths num="0001"><math><![CDATA[<mrow><mi>H</mi><mo>=</mo><mo>{</mo><mi>l</mi><mo>|</mo><mi>p</mi><mrow><mo>(</mo><msub><mi>l</mi><mi>i</mi></msub><mo>=</mo><mi>l</mi><mo>|</mo><msub><mover><mi>l</mi><mo>^</mo></mover><mrow><mi>i</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>,</mo><msub><mi>D</mi><mi>i</mi></msub><mo>,</mo><msub><mi>&Phi;</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>&GreaterEqual;</mo><msub><mi>p</mi><mi>T</mi></msub><mo>}</mo><mo>,</mo></mrow>]]></math><img file="FDA0001005637060000015.GIF" wi="685" he="78" /></maths>其中p<sub>T</sub>为设置的阈值概率l为人员当前可能存在的位置;2)计算状态转移概率:设在行人步行i步之后存储的地磁强度值序列为O<sub>i</sub>:<img file="FDA0001005637060000018.GIF" wi="532" he="63" />其中o<sub>i‑k+1</sub>为第i‑k+1步时测得的地磁信息;a.计算H和L的交集为H',其中l<sub>i,j</sub>表示行人在步行i步之后可能存在的位置,可能存在的位置总数为N<sub>P</sub>:<maths num="0002"><math><![CDATA[<mrow><msup><mi>H</mi><mo>&prime;</mo></msup><mo>=</mo><mo>{</mo><msub><mi>l</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>|</mo><msub><mi>l</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>&Element;</mo><mi>H</mi><mo>,</mo><msub><mi>l</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>&Element;</mo><mi>L</mi><mo>}</mo><mo>=</mo><mo>{</mo><msub><mi>l</mi><mrow><mi>i</mi><mo>,</mo><mn>1</mn></mrow></msub><mo>,</mo><msub><mi>l</mi><mrow><mi>i</mi><mo>,</mo><mn>2</mn></mrow></msub><mo>,</mo><mo>...</mo><mo>,</mo><msub><mi>l</mi><mrow><mi>i</mi><mo>,</mo><msub><mi>N</mi><mi>P</mi></msub></mrow></msub><mo>}</mo><mo>;</mo></mrow>]]></math><img file="FDA0001005637060000019.GIF" wi="899" he="71" /></maths>b.根据运动信息对于每个位置l<sub>i,j</sub>=(x<sub>i,j</sub>,y<sub>i,j</sub>)预测之前的N<sub>s</sub>个位置,横坐标为x<sub>i,j</sub>,纵坐标为y<sub>i,j</sub>,N<sub>s</sub>为序列的长度,l<sub>i,j,k</sub>=(x<sub>i,j,k</sub>,y<sub>i,j,k</sub>)表示通过PDR来预测的l<sub>i,j</sub>之前的第k个位置:<maths num="0003"><math><![CDATA[<mrow><msub><mi>x</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>=</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>-</mo><munderover><mo>&Sigma;</mo><mrow><mi>t</mi><mo>=</mo><mi>i</mi><mo>-</mo><mi>k</mi><mo>+</mo><mn>1</mn></mrow><mi>i</mi></munderover><msub><mi>d</mi><mi>t</mi></msub><mo>&CenterDot;</mo><msub><mi>cos&phi;</mi><mi>t</mi></msub><mo>,</mo><mn>0</mn><mo>&le;</mo><mi>k</mi><mo>&lt;</mo><msub><mi>N</mi><mi>s</mi></msub><mo>,</mo></mrow>]]></math><img file="FDA0001005637060000016.GIF" wi="790" he="127" /></maths><maths num="0004"><math><![CDATA[<mrow><msub><mi>y</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>=</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>-</mo><munderover><mo>&Sigma;</mo><mrow><mi>t</mi><mo>=</mo><mi>i</mi><mo>-</mo><mi>k</mi><mo>+</mo><mn>1</mn></mrow><mi>i</mi></munderover><msub><mi>d</mi><mi>t</mi></msub><mo>&CenterDot;</mo><msub><mi>sin&phi;</mi><mi>t</mi></msub><mo>,</mo><mn>0</mn><mo>&le;</mo><mi>k</mi><mo>&lt;</mo><msub><mi>N</mi><mi>s</mi></msub><mo>;</mo></mrow>]]></math><img file="FDA0001005637060000017.GIF" wi="797" he="125" /></maths>c.在离线指纹库的指纹位置l<sub>w</sub>中寻找距离l<sub>i,j,k</sub>最近的点,并且分别存储该网格中心RP的均值与方差为μ<sub>i,j,k</sub>和σ<sub>i,j,k</sub>;d.对于每一个l<sub>i,j</sub>构建两个后向序列:<img file="FDA0001005637060000021.GIF" wi="558" he="87" />和<img file="FDA0001005637060000022.GIF" wi="574" he="86" />e.认定地磁场强度观测值符合以真实值为中心的高斯分布,计算在位置l<sub>i,j,k</sub>出现地磁场强度o<sub>i‑k+1</sub>的概率:f.对于每个可能的位置l<sub>i,j</sub>,计算观测值概率b<sub>i,j</sub>g.对每一个可能存在的位置l<sub>i,j</sub>计算状态转移概率a<sub>i,j</sub>;3)将a<sub>i,j</sub>作为权重估计行人步行i步之后的位置。
地址 300072 天津市南开区卫津路92号