发明名称 一种结合加速度计的LED室内2D定位方法
摘要 本发明提供了一种结合加速度计的LED室内2D定位方法,LED灯作为发射机并发送带有其位置信息的ID编码,移动设备作为接收机,将旋转角度考虑到定位方法中,使用带加速度计的接收机接收各LED灯的发射光并获取接收功率,通过加速度计的角度信息获取不同旋转角度下接收机的法线方向,引入入射角度的详细计算方法,将手持设备的旋转角度最终量化为入射角度,从而提供更高的定位精度,可将定位精度从现有技术的分米级或米级提高至厘米级;使用的接收机可以是日常使用的手机,由于大多数手机自带加速度计,定位过程中自动调用手机自带的加速度计的相关信息,使用成本较低,采用矩阵运算,软件实现复杂度低,不会影响手机运行速率。
申请公布号 CN106441289A 申请公布日期 2017.02.22
申请号 CN201610815746.7 申请日期 2016.09.09
申请人 中国地质大学(武汉) 发明人 王瑾;黎好栩
分类号 G01C21/16(2006.01)I 主分类号 G01C21/16(2006.01)I
代理机构 武汉华旭知识产权事务所 42214 代理人 刘荣;周宗贵
主权项 一种结合加速度计的LED室内2D定位方法,其特征在于,包括如下步骤:(1)对室内照明系统的各LED灯进行编码,将各LED灯的编码以时分复用的形式加载到LED灯的发射光中;(2)使用带加速度计的接收机接收各LED灯的发射光并获取接收功率,在同一位置将接收机旋转K个不同角度,7≥K≥3,在各旋转角度下选取接收机的接收功率中最大的N个接收功率为有效接收功率,1≤N≤4,接收机获取不同旋转角度下的有效接收功率P<sub>rik</sub>和加速度计的角度信息,1≤i≤N,1≤k≤K;(3)定义向量R<sub>ik</sub>,其方向为不同旋转角度下接收机的法线方向、大小为∣R<sub>ik</sub>∣=P<sub>rik</sub>,接收机的法线方向通过加速度计的角度信息进行确定;(4)定义平面W<sub>ik</sub>,平面W<sub>ik</sub>为经过向量R<sub>ik</sub>末端并垂直于向量R<sub>ik</sub>的平面,平面W<sub>ik</sub>的公式为:a<sub>ik</sub>*x+b<sub>ik</sub>*y+c<sub>ik</sub>*z=d<sub>ik</sub>,(5)定义向量T<sub>i</sub>,其方向从接收机指向接收到的发射光所对应LED灯,向量T<sub>i</sub>即为入射光线,计算公式为:<maths num="0001"><math><![CDATA[<mrow><msub><mi>T</mi><mi>i</mi></msub><mo>=</mo><msup><mrow><mo>(</mo><munderover><mo>&Sigma;</mo><mrow><mi>k</mi><mo>=</mo><mn>1</mn></mrow><mi>K</mi></munderover><msubsup><mi>A</mi><mrow><mi>i</mi><mi>k</mi></mrow><mi>T</mi></msubsup><msub><mi>A</mi><mrow><mi>i</mi><mi>k</mi></mrow></msub><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mrow><mo>(</mo><munderover><mo>&Sigma;</mo><mrow><mi>k</mi><mo>=</mo><mn>1</mn></mrow><mi>K</mi></munderover><msubsup><mi>A</mi><mrow><mi>i</mi><mi>k</mi></mrow><mi>T</mi></msubsup><msub><mi>B</mi><mrow><mi>i</mi><mi>k</mi></mrow></msub><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0001112257290000011.GIF" wi="686" he="173" /></maths><maths num="0002"><math><![CDATA[<mrow><msub><mi>A</mi><mrow><mi>i</mi><mi>k</mi></mrow></msub><mo>=</mo><mfrac><mrow><mo>-</mo><mn>1</mn></mrow><mrow><msubsup><mi>a</mi><mrow><mi>i</mi><mi>k</mi></mrow><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>b</mi><mrow><mi>i</mi><mi>k</mi></mrow><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>c</mi><mrow><mi>i</mi><mi>k</mi></mrow><mn>2</mn></msubsup></mrow></mfrac><msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mi>a</mi><mrow><mi>i</mi><mi>k</mi></mrow></msub></mtd><mtd><msub><mi>b</mi><mrow><mi>i</mi><mi>k</mi></mrow></msub></mtd><mtd><msub><mi>c</mi><mrow><mi>i</mi><mi>k</mi></mrow></msub></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>&lsqb;</mo><mtable><mtr><mtd><msub><mi>a</mi><mrow><mi>i</mi><mi>k</mi></mrow></msub></mtd><mtd><msub><mi>b</mi><mrow><mi>i</mi><mi>k</mi></mrow></msub></mtd><mtd><msub><mi>c</mi><mrow><mi>i</mi><mi>k</mi></mrow></msub></mtd></mtr></mtable><mo>&rsqb;</mo><mo>,</mo></mrow>]]></math><img file="FDA0001112257290000012.GIF" wi="1062" he="167" /></maths><maths num="0003"><math><![CDATA[<mrow><msub><mi>B</mi><mrow><mi>i</mi><mi>k</mi></mrow></msub><mo>=</mo><mfrac><msub><mi>d</mi><mrow><mi>i</mi><mi>k</mi></mrow></msub><mrow><msubsup><mi>a</mi><mrow><mi>i</mi><mi>k</mi></mrow><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>b</mi><mrow><mi>i</mi><mi>k</mi></mrow><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>c</mi><mrow><mi>i</mi><mi>k</mi></mrow><mn>2</mn></msubsup></mrow></mfrac><msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mi>a</mi><mrow><mi>i</mi><mi>k</mi></mrow></msub></mtd><mtd><msub><mi>b</mi><mrow><mi>i</mi><mi>k</mi></mrow></msub></mtd><mtd><msub><mi>c</mi><mrow><mi>i</mi><mi>k</mi></mrow></msub></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>;</mo></mrow>]]></math><img file="FDA0001112257290000013.GIF" wi="725" he="151" /></maths>(6)计算接收机法线方向与入射光线的夹角,该夹角即入射角度<img file="FDA0001112257290000014.GIF" wi="66" he="47" />计算公式为:<img file="FDA0001112257290000015.GIF" wi="595" he="171" />(7)计算接收机与接收到的发射光所对应LED灯之间的距离D<sub>i</sub>,计算公式为:<img file="FDA0001112257290000016.GIF" wi="607" he="199" />其中P<sub>ti</sub>为接收到的发射光所对应LED灯的发射功率,h为接收机与接收到的发射光所对应LED灯之间的垂直距离,C根据如下公式计算得到:<img file="FDA0001112257290000021.GIF" wi="682" he="151" />式中,m为朗伯系数,A为接收端光接收面的物理探测面积,<img file="FDA0001112257290000022.GIF" wi="114" he="63" />是接收机中的光滤波器的传播系数,<img file="FDA0001112257290000023.GIF" wi="103" he="60" />是接收机中的光集中器的增益,<img file="FDA0001112257290000024.GIF" wi="107" he="63" />由下式确定:<img file="FDA0001112257290000025.GIF" wi="791" he="281" />式中,Φ<sub>c</sub>为光集中器视角,n是折射率;(8)利用2D定位法计算接收机的二维位置坐标:(8‑1)设接收到的发射光所对应LED灯的坐标为(X<sub>i</sub>,Y<sub>i</sub>),接收机的二维位置坐标为(x,y),有(x‑X<sub>i</sub>)<sup>2</sup>+(y‑Y<sub>i</sub>)<sup>2</sup>=r<sub>i</sub><sup>2</sup>,r<sub>i</sub>为接收到的发射光所对应LED灯与接收机的水平距离;(8‑2)令Q=[x,y]<sup>T</sup>,由最小二乘法得到:Q=(M<sup>T</sup>M)<sup>‑1</sup>M<sup>T</sup>N,其中,<maths num="0004"><math><![CDATA[<mrow><mi>M</mi><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><msub><mi>X</mi><mn>2</mn></msub><mo>-</mo><msub><mi>X</mi><mn>1</mn></msub></mrow></mtd><mtd><mrow><msub><mi>Y</mi><mn>2</mn></msub><mo>-</mo><msub><mi>Y</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mrow><msub><mi>X</mi><mi>n</mi></msub><mo>-</mo><msub><mi>X</mi><mn>1</mn></msub></mrow></mtd><mtd><mrow><msub><mi>Y</mi><mi>n</mi></msub><mo>-</mo><msub><mi>Y</mi><mn>1</mn></msub></mrow></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0001112257290000026.GIF" wi="509" he="255" /></maths><maths num="0005"><math><![CDATA[<mrow><mi>N</mi><mo>=</mo><mfrac><mn>1</mn><mn>2</mn></mfrac><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mo>(</mo><msubsup><mi>r</mi><mn>1</mn><mn>2</mn></msubsup><mo>-</mo><msubsup><mi>r</mi><mn>2</mn><mn>2</mn></msubsup><mo>)</mo><mo>+</mo><mo>(</mo><msubsup><mi>X</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>Y</mi><mn>2</mn><mn>2</mn></msubsup><mo>)</mo><mo>-</mo><mo>(</mo><msubsup><mi>X</mi><mn>1</mn><mn>1</mn></msubsup><mo>+</mo><msubsup><mi>Y</mi><mn>1</mn><mn>2</mn></msubsup><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mrow><mo>(</mo><msubsup><mi>r</mi><mn>1</mn><mn>2</mn></msubsup><mo>-</mo><msubsup><mi>r</mi><mi>n</mi><mn>2</mn></msubsup><mo>)</mo><mo>+</mo><mo>(</mo><msubsup><mi>X</mi><mi>n</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>Y</mi><mi>n</mi><mn>2</mn></msubsup><mo>)</mo><mo>-</mo><mo>(</mo><msubsup><mi>X</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>Y</mi><mn>1</mn><mn>2</mn></msubsup><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0001112257290000027.GIF" wi="816" he="259" /></maths>解得接收机的二维位置坐标(x,y)。
地址 430074 湖北省武汉市洪山区鲁磨路388号