一种基于滑动窗口的指纹法与传感器融合的室内定位方法与流程

文档序号:11944494阅读:来源:国知局

技术特征:

1.一种基于滑动窗口的指纹法与传感器融合的室内定位方法,其特征在于,包括以下步骤:

步骤一,将整个定位过程分成多段来消除长期定位带来的累计误差,其中每一段被定义为一个窗口;

步骤二,对参数进行初始化后,对在某一个窗口内的行人的运动进行PDR定位;

步骤三,对行人进行WiFi位置指纹法定位;

步骤四,将PDR定位结果与WiFi指纹法定位结果融合,得到融合定位结果;

步骤五,当行人到达下一个窗口时,重复步骤二至步骤四,计算用户接下来的每一步的定位结果直到用户停止运动,即完成基于滑动窗口的指纹法与传感器融合的室内定位方法。

2.根据权利要求1所述的一种基于滑动窗口的指纹法与传感器融合的室内定位方法,其特征在于,所述步骤二中,初始化的具体方法如下:

从初始位置开始,令步数t=0,初始位置L0=(x0,y0)(t=0)已知,其中x0代表x轴坐标,y0代表y轴坐标,设窗口大小为W,滑动间隔为I。

3.根据权利要求1所述的一种基于滑动窗口的指纹法与传感器融合的室内定位方法,其特征在于,所述步骤二中,PDR定位的具体方法如下:

当行人脚步被探测之后,令t=t+1,假定用户第t步的PDR的定位结果为第t步估计步长为dt,第t步运动方向为θt,则根据PDR定位结果的计算公式,如式(1),可得t时刻PDR的定位结果;

<mrow> <mtable> <mtr> <mtd> <mrow> <msubsup> <mi>x</mi> <mrow> <mi>p</mi> <mi>d</mi> <mi>r</mi> </mrow> <mi>t</mi> </msubsup> <mo>=</mo> <msubsup> <mi>x</mi> <mrow> <mi>p</mi> <mi>d</mi> <mi>r</mi> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mo>+</mo> <msub> <mi>d</mi> <mi>t</mi> </msub> <mo>&CenterDot;</mo> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mrow> <mo>(</mo> <msub> <mi>&theta;</mi> <mi>t</mi> </msub> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>y</mi> <mrow> <mi>p</mi> <mi>d</mi> <mi>r</mi> </mrow> <mi>t</mi> </msubsup> <mo>=</mo> <msubsup> <mi>y</mi> <mrow> <mi>p</mi> <mi>d</mi> <mi>r</mi> </mrow> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mo>+</mo> <msub> <mi>d</mi> <mi>t</mi> </msub> <mo>&CenterDot;</mo> <mi>sin</mi> <mrow> <mo>(</mo> <msub> <mi>&theta;</mi> <mi>t</mi> </msub> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>

4.根据权利要求1所述的一种基于滑动窗口的指纹法与传感器融合的室内定位方法,其特征在于,所述步骤三中,WiFi位置指纹法定位的具体方法如下:

假定用户第t步的位置指纹法的定位结果为位置指纹法的定位结果根据KNN算法计算得到。

5.根据权利要求1所述的一种基于滑动窗口的指纹法与传感器融合的室内定位方法,其特征在于,所述步骤四中,将PDR定位结果与WiFi指纹法定位结果融合的方法如下:

第一步,假定用户第t步的融合方案定位结果为lt=(xt,yt);

第二步,用户初始位置已知,l0=(x0,y0);

第三步,对于第t(t=1,2,…,W-1)步,PDR的定位结果即为融合算法的定位结果,即

第四步,对于第t(t=W,…,W+I-1)步,设第一个窗口内指纹法定位结果的均值为第一个窗口内指纹法定位结果的均值到第一个窗口内中间步数前一时刻融合算法定位结果的距离为dis_wf(1),第一个窗口内中间时刻融合算法定位结果到第一个窗口内中间步数前一时刻融合算法定位结果l(1)=(x(1),y(1))的距离为dis(1);则dis_wf(1),dis(1)的计算公式如下:

<mrow> <mtable> <mtr> <mtd> <mrow> <msubsup> <mi>x</mi> <mrow> <mi>a</mi> <mi>v</mi> <mi>g</mi> </mrow> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>t</mi> <mo>=</mo> <mn>0</mn> </mrow> <mrow> <mi>W</mi> <mo>-</mo> <mn>1</mn> </mrow> </munderover> <msubsup> <mi>x</mi> <mrow> <mi>w</mi> <mi>f</mi> </mrow> <mi>t</mi> </msubsup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>y</mi> <mrow> <mi>a</mi> <mi>v</mi> <mi>g</mi> </mrow> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>t</mi> <mo>=</mo> <mn>0</mn> </mrow> <mrow> <mi>W</mi> <mo>-</mo> <mn>1</mn> </mrow> </munderover> <msubsup> <mi>y</mi> <mrow> <mi>w</mi> <mi>f</mi> </mrow> <mi>t</mi> </msubsup> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mi>d</mi> <mi>i</mi> <mi>s</mi> <mo>_</mo> <msup> <mi>wf</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msup> <mo>=</mo> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <msubsup> <mi>x</mi> <mrow> <mi>a</mi> <mi>v</mi> <mi>g</mi> </mrow> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> <mo>-</mo> <msup> <mi>x</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msubsup> <mi>y</mi> <mrow> <mi>a</mi> <mi>v</mi> <mi>g</mi> </mrow> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> <mo>-</mo> <msup> <mi>y</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <msup> <mi>dis</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msup> <mo>=</mo> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <msubsup> <mi>x</mi> <mi>m</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> <mo>-</mo> <msup> <mi>x</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msubsup> <mi>y</mi> <mi>m</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> <mo>-</mo> <msup> <mi>y</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>

接着,按照下述公式归一化加权系数为:

<mrow> <msup> <mi>c</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msup> <mo>=</mo> <mfrac> <mrow> <mn>1</mn> <mo>/</mo> <mi>d</mi> <mi>i</mi> <mi>s</mi> <mo>_</mo> <msup> <mi>wf</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msup> </mrow> <mrow> <mn>1</mn> <mo>/</mo> <mi>d</mi> <mi>i</mi> <mi>s</mi> <mo>_</mo> <msup> <mi>wf</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msup> <mo>+</mo> <mn>1</mn> <mo>/</mo> <msup> <mi>dis</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msup> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>

则c(1)代表WiFi指纹法定位结果归一化加权系数,1-c(1)代表融合算法定位结果归一化加权系数;

因此,第一个窗口内初始位置可以更新为:

<mrow> <mtable> <mtr> <mtd> <mrow> <msubsup> <mi>x</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>i</mi> </mrow> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <msup> <mi>c</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mo>&times;</mo> <msubsup> <mi>x</mi> <mi>m</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msup> <mi>c</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msup> <mo>&times;</mo> <msubsup> <mi>x</mi> <mrow> <mi>a</mi> <mi>v</mi> <mi>g</mi> </mrow> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>y</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>i</mi> </mrow> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <msup> <mi>c</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msup> <mo>)</mo> </mrow> <mo>&times;</mo> <msubsup> <mi>y</mi> <mi>m</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <msup> <mi>c</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msup> <mo>&times;</mo> <msubsup> <mi>y</mi> <mrow> <mi>a</mi> <mi>v</mi> <mi>g</mi> </mrow> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>

此时,可以得到第t(t=W,…,W+I-1)步融合算法的定位结果,其计算公式如下:

<mrow> <mtable> <mtr> <mtd> <mrow> <msup> <mi>x</mi> <mi>t</mi> </msup> <mo>=</mo> <msubsup> <mi>x</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>i</mi> </mrow> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>p</mi> <mo>=</mo> <mn>2</mn> </mrow> <mi>t</mi> </munderover> <msub> <mi>d</mi> <mi>p</mi> </msub> <msub> <mi>cos&theta;</mi> <mi>p</mi> </msub> <mo>,</mo> <mi>t</mi> <mo>=</mo> <mi>W</mi> <mo>,</mo> <mo>...</mo> <mo>,</mo> <mi>W</mi> <mo>+</mo> <mi>I</mi> <mo>-</mo> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msup> <mi>y</mi> <mi>t</mi> </msup> <mo>=</mo> <msubsup> <mi>y</mi> <mrow> <mi>i</mi> <mi>n</mi> <mi>i</mi> </mrow> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> <mo>+</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>p</mi> <mo>=</mo> <mn>2</mn> </mrow> <mi>t</mi> </munderover> <msub> <mi>d</mi> <mi>p</mi> </msub> <msub> <mi>sin&theta;</mi> <mi>p</mi> </msub> <mo>,</mo> <mi>t</mi> <mo>=</mo> <mi>W</mi> <mo>,</mo> <mo>...</mo> <mo>,</mo> <mi>W</mi> <mo>+</mo> <mi>I</mi> <mo>-</mo> <mn>1</mn> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1