一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法
【專利摘要】一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法，包括基于接收信號強度的粗定位以及結(jié)合接收信號強度和估計反射信號強度的迭代定位兩部分：首先，根據(jù)接收光信號的強度進行粗定位；隨后根據(jù)粗定位的結(jié)果和預先計算的在接收平面網(wǎng)格節(jié)點上的反射信號強度對粗定位位置處的反射信號強度進行估算；再結(jié)合接收信號強度和估算的反射信號強度，通過對定位結(jié)果和定位方程進行多次迭代，就可以得到最終的精確定位結(jié)果。由于該算法能夠?qū)碜詨γ婕捌渌矬w表面的漫反射光信號進行估計并抑制了這些反射信號的影響，因此，應(yīng)用于實際場景中能實現(xiàn)較為準確的室內(nèi)可見光定位。
【專利說明】
一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法
技術(shù)領(lǐng)域
[0001] 本發(fā)明涉及照明集成的室內(nèi)可見光定位技術(shù)，尤其涉及一種用于提高室內(nèi)可見光 定位系統(tǒng)定位精度的迭代算法，屬于可見光通信技術(shù)領(lǐng)域。
【背景技術(shù)】
[0002] 隨著定位導航技術(shù)的廣泛應(yīng)用和基于位置服務(wù)的不斷發(fā)展，室內(nèi)定位技術(shù)逐漸進 入人們的視野，相關(guān)需求也不斷增長。在定位與導航市場中，GPS和北斗等基于衛(wèi)星信號的 定位系統(tǒng)占據(jù)了絕大多數(shù)。但是與此同時，由于在城市中衛(wèi)星信號會被高樓遮擋;而且在室 內(nèi)，衛(wèi)星信號經(jīng)過穿墻之后會被嚴重衰減，因此GPS和北斗這類基于衛(wèi)星信號的定位技術(shù)在 室內(nèi)環(huán)境下并不實用。近年來，隨著綠色照明的發(fā)展，LED以其高發(fā)光效率、低能耗、低成本、 高顯色性和環(huán)境友好等優(yōu)勢逐漸得到普及。而基于LED光源的可見光通信和可見光定位技 術(shù)也不斷發(fā)展，出現(xiàn)了多種原理的與可見光定位相關(guān)的論文和專利。
[0003] 與基于Wi-Fi和藍牙的定位技術(shù)相比，可見光定位技術(shù)不會產(chǎn)生電磁輻射，且不受 電磁信號的干擾。因此其定位精度高于基于Wi-Fi和藍牙定位，且更加穩(wěn)定。而與基于超聲、 紅外和超寬帶(UWB)的室內(nèi)定位技術(shù)相比，可見光定位技術(shù)可直接利用室內(nèi)的照明LED燈， 無需額外假設(shè)信號發(fā)射裝置。因此其成本更低，更易于推廣和實用。
[0004] 對于當前的室內(nèi)可見光定位技術(shù)，出于成本的考慮，很多都是在接收端采用光電 探測器，同時利用接收到的來自各個光源的光信號強度進行定位，例如專利"一種基于頻移 鍵控的室內(nèi)可見光定位及信息推送方法"（申請?zhí)?01510379394.0)和專利"基于可見光信 號強度的三維空間室內(nèi)定位方法"（申請?zhí)?01510063426.6)。但是對于這一類的定位技術(shù) 而言，都只考慮到了直接來自光源的直射信號，而忽略了來自于墻面或家具的反射光信號， 因此在實際應(yīng)用中存在較大誤差。

【發(fā)明內(nèi)容】

[0005] 本發(fā)明的目的在于解決目前室內(nèi)可見光定位技術(shù)受到反射光信號干擾的問題。提 出一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法。
[0006] 本發(fā)明的技術(shù)核心為:其利用基于接收信號強度的粗定位以及結(jié)合接收信號強度 和估計反射信號強度的迭代定位來進行基于可見光信號的室內(nèi)定位，并通過不斷迭代來提 高定位精度;本發(fā)明一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法，具體步驟如 下：
[0007] 步驟一、預處理，具體包括：
[0008] 1.1在室內(nèi)天花板上放置N個光源，每個光源都采用強度調(diào)制的方式進行驅(qū)動，同 時每個光源通過光信號發(fā)送自己的空間坐標，在完成照明功能的同時作為可見光定位系統(tǒng) 的信號源；
[0009] 其中，所述的N>3;
[0010] 1.2根據(jù)室內(nèi)環(huán)境，將可見光定位系統(tǒng)的接收端所處的接收平面分為R個網(wǎng)格節(jié) 點，并求出或測量出在各個網(wǎng)格節(jié)點處分別來自各個光源的經(jīng)墻面和家具所反射光信號的 強度；
[0011]其中，所述的可見光定位系統(tǒng)的接收端位于光源下方的某個平面上，假設(shè)接收端 與光源的垂直距離為h，且豎直向上放置；
[0012]所述的R的選擇依據(jù)主要為系統(tǒng)定位精度和定位時間要求，且優(yōu)選的R值密度范圍 為：100個/平方米到400個/平方米之間；
[0013] 1.3初始化迭代次數(shù)K為1，預設(shè)迭代次數(shù)M;
[0014]步驟二、可見光定位系統(tǒng)的接收端根據(jù)接收到的來自各個光源的光信號強度進行 粗定位，具體過程為：
[0015]假設(shè)第i個光源所發(fā)射的原始光信號強度為Ptl，接收端接收到的來自第i個光源的 光信號強度為Pn，第i個光源的坐標為(Xl，yi);通過求解以下超定方程組的最小二乘解，可 以獲得粗定位結(jié)果的坐標(X。，％)，并將其作為迭代定位算法的初值；
[0017] 步驟三、尋找距離步驟二輸出的粗定位結(jié)果坐標(Xc，yc)最近的S個網(wǎng)格節(jié)點：結(jié)合 預處理中所得的各個網(wǎng)格節(jié)點處分別來自各個光源的經(jīng)墻面和家具所反射光信號的強度， 可以利用插值的方法，估計在粗定位結(jié)果的位置上來自第i個光源的經(jīng)墻面和家具所反射 光信號的強度，記為Prdi ;
[0018] 其中，S的大小由網(wǎng)格節(jié)點的分布形式?jīng)Q定，通?？蔀?、4或6，分別對應(yīng)
[0019] 三角形排布矩形排布以及六邊形排布；
[0020] 步驟四、根據(jù)步驟三估計的粗定位坐標附近的反射光信號強度，求解以下方程組， 重新計算接收端的位置坐標(X，y);
[0022] 步驟五、判斷迭代次數(shù)K是否到達預設(shè)迭代次數(shù)M，并根據(jù)判斷結(jié)果進行如下操作：
[0023] 5.1當K〈M，即沒有達到預定迭代次數(shù)，將K值加1，并將步驟四重新計算的接收端坐 標(χ，y)作為新的粗定位坐標(χ。，y。），跳至步驟三；
[0024] 5.2當K = M，即已經(jīng)達到預定迭代次數(shù)，步驟四得出的接收端坐標(x，y)即為最終 的定位結(jié)果；
[0025]其中，所述的迭代次數(shù)K由系統(tǒng)的定位準確度和復雜度要求決定。
[0026]有益效果
[0027] 本發(fā)明同現(xiàn)有技術(shù)中"一種基于頻移鍵控的室內(nèi)可見光定位及信息推送方法"和 "基于可見光信號強度的三維空間室內(nèi)定位方法"相比，具有以下有益效果：
[0028] 1.考慮并從一定程度上消除了反射光對室內(nèi)可見光定位系統(tǒng)的影響，在同等條件 下的定位精度更高，對于實施例1中的情況，可以將室內(nèi)的平均定位誤差減小10倍以上；
[0029] 2.利用迭代算法在計算中不斷提高定位精度，通過設(shè)置不同的迭代次數(shù)，可在定 位精度和算法復雜度之間任意取舍。
【附圖說明】
[0030] 下面結(jié)合附圖與【具體實施方式】對本發(fā)明作更進一步的說明：
[0031] 圖1為本發(fā)明一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法的算法流程 圖；
[0032] 圖2為本發(fā)明一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法實施例1中 步驟S1網(wǎng)格節(jié)點示意圖；
[0033] 圖3為本發(fā)明一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法實施例1中 步驟S5反射信號強度估計算法中網(wǎng)格節(jié)點示意圖。
【具體實施方式】
[0034] 下面，結(jié)合附圖詳細描述本發(fā)明的優(yōu)選實施方式。為了便于描述和突出顯示本發(fā) 明，附圖中省略了現(xiàn)有技術(shù)中已有的相關(guān)部件，并將省略對這些公知部件的描述。
[0035] 實施例1
[0036] 具體結(jié)合圖1、圖2和圖3對本發(fā)明一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的 迭代算法進行細致闡述。圖1為本發(fā)明一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代 算法及實施例中的算法流程圖；圖2為本發(fā)明一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度 的迭代算法及實施例1中步驟S1網(wǎng)格節(jié)點示意圖；圖3為本發(fā)明一種用于提高室內(nèi)可見光定 位系統(tǒng)定位精度的迭代算法實施例1中步驟S5反射信號強度估計算法中網(wǎng)格節(jié)點示意圖。
[0037] 在本實施例中，假設(shè)在室內(nèi)房間中進行定位，房間的大小為5米X 5米X 3米，天花 板上有4個LED燈在提供照明的同時作為可見光定位系統(tǒng)的信號源。這4個LED燈采用不同頻 率的開關(guān)鍵控(00K)信號調(diào)制，并循環(huán)發(fā)送自己的位置坐標，分別為（1，1，3)，（1，3,3)，（3， 1，3)和(3,3,3)。與此同時，接收端位于光源下方且與光源垂直距離為3米的平面上，并豎直 向上放置。圖1中所描述的是本發(fā)明中定位算法的總體流程圖，其主要步驟如下：
[0038] 步驟S1:根據(jù)室內(nèi)環(huán)境，將接收端所處的接收平面均勻分為2601個網(wǎng)格節(jié)點，每個 節(jié)點與相鄰節(jié)點的間距為10厘米(如圖2所示），此時節(jié)點密度為100個/平方米;隨后利用可 見光信道傳輸模型求出在各個網(wǎng)格節(jié)點處分別來自各個光源的經(jīng)墻面和家具所反射光信 號的強度;初始化迭代次數(shù)K為1，預設(shè)迭代次數(shù)Μ為3;
[0039] 步驟S2:在接收端接收來自4個不同LED光源的光信號。根據(jù)不同的頻率對其進行 識別并分別測量光信號強度，分別記為Prl，Pr2，Pr3和Pr4;與此同時，對分別來自4個LED光源 的光信號進行解調(diào)，并獲取他們的位置坐標，即（1，1，3)，（1，3,3)，（3，1，3)和(3,3,3)，并將 光信號強度和光源位置坐標 對應(yīng)；
[0040] 步驟S3:在定位時，首先根據(jù)接收到的來自4個光源的光信號強度進行粗定位，假 設(shè)第i個光源所發(fā)射的原始光信號強度為ptl，列出超定方程組為：
[0042]步驟S4:求解步驟S3中所給出的超定方程組的最小二乘解，可以獲得粗定位結(jié)果 坐標，并將其作為迭代定位算法的初值；
[0043]步驟S5:在獲取了粗定位結(jié)果的坐標后，尋找距離其最近的4個網(wǎng)格節(jié)點（如圖3所 示），假設(shè)對于第m個節(jié)點，來自光源i的經(jīng)墻面和家具所反射光信號的強度為Prdim;利用雙 線性插值的方法，利用下式可以估計在粗定位結(jié)果的位置上，來自光源i的經(jīng)墻面和家具所 反射光信號的強度為Prdi:
[0045] 其中，AuS以粗定位位置與節(jié)點i之間連線作為對角線的矩形的面積；
[0046] 步驟S6:根據(jù)估計的粗定位位置的反射光信號強度，求解以下方程組，重新計算接 收端的位置坐標；
[0048]步驟S7:統(tǒng)計迭代次數(shù)K;
[0049] 步驟S8:對于定位精度(定位速度)優(yōu)先的系統(tǒng)，判定當前已經(jīng)進行過的迭代次數(shù)K 是否等于預設(shè)的Μ值，并進行相應(yīng)操作：
[0050] S8.1若等于Μ = 3次，將定位結(jié)果(即接收端的位置)輸出，定位結(jié)束；
[0051 ] S8.2若少于Μ = 3次，則將步驟S6中求得的接收端位置坐標代替粗定位結(jié)果，作為 新的迭代初值，將迭代次數(shù)Κ加1，并跳轉(zhuǎn)至步驟S5,繼續(xù)進行迭代定位的計算。
[0052] 實施例2
[0053]將實施例1中的4個LED燈改成N( N>4)個燈，該定位系統(tǒng)依然有效。
[0054] 實施例3
[0055]將實施例1中的LED燈改成其他固體光源如0LED，該定位系統(tǒng)依然有效。為了更好 地理解本發(fā)明，對有關(guān)內(nèi)容補充說明如下：
[0056]關(guān)于反射光信號的預處理:在本算法中，需要預先獲取接收平面網(wǎng)格節(jié)點上來自 各個光源的反射信號光強。這些光強可由多種仿真算法或軟件對室內(nèi)環(huán)境仿真計算得出， 也可通過在實際場景中的實地測量獲得。上述實施方式中未述及的有關(guān)技術(shù)內(nèi)容采取或借 鑒已有技術(shù)即可實現(xiàn)，例如實施例1中發(fā)射端的的可見光信號調(diào)制驅(qū)動電路和接收端的數(shù) 據(jù)采集，均可采用專利"一種基于頻移鍵控的室內(nèi)可見光定位及信息推送方法"（申請?zhí)?201510379394.0)中所述的方法進行。
[0057]需要說明的是，本說明書所述的只是本發(fā)明的3種較佳具體實施例，以上實施例僅 用于說明本發(fā)明的技術(shù)方案而非對本發(fā)明的限制。凡本領(lǐng)域技術(shù)人員依本發(fā)明的構(gòu)思通過 邏輯分析、推理或者有限的實驗可以得到的技術(shù)方案，皆應(yīng)在本發(fā)明的范圍之內(nèi)。
【主權(quán)項】
1. 一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法，其特征在于： 具體步驟如下： 步驟一、預處理； 步驟二、可見光定位系統(tǒng)的接收端根據(jù)接收到的來自各個光源的光信號強度進行粗定 位； 步驟三、尋找距離步驟二輸出的粗定位結(jié)果坐標(Xc，yc)最近的S個網(wǎng)格節(jié)點;結(jié)合預處 理中所得的各個網(wǎng)格節(jié)點處分別來自各個光源的經(jīng)墻面和家具所反射光信號的強度； 步驟四、根據(jù)步驟三估計的粗定位坐標附近的反射光信號強度，重新計算接收端的位 置坐標； 步驟五、判斷迭代次數(shù)K是否到達預設(shè)迭代次數(shù)M，并根據(jù)判斷結(jié)果進行如下操作： 5.1當K〈M，即沒有達到預定迭代次數(shù)，將K值加1，并將步驟四重新計算的接收端坐標 (X，y)作為新的粗定位坐標(X。，yc)，跳至步驟三； 5.2當K = M，即已經(jīng)達到預定迭代次數(shù)，步驟四得出的接收端坐標(x，y)即為最終的定 位結(jié)果； 至此，步驟一至步驟五完成了一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算 法。2. 如權(quán)利要求1所述的一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法，其特 征還在于： 步驟一具體包括： 1.1在室內(nèi)天花板上放置N個光源，每個光源都采用強度調(diào)制的方式進行驅(qū)動，同時每 個光源通過光信號發(fā)送自己的空間坐標，在完成照明功能的同時作為可見光定位系統(tǒng)的信 號源； 1.2根據(jù)室內(nèi)環(huán)境，將可見光定位系統(tǒng)的接收端所處的接收平面分為R個網(wǎng)格節(jié)點，并 求出或測量出在各個網(wǎng)格節(jié)點處分別來自各個光源的經(jīng)墻面和家具所反射光信號的強度； 其中，所述的可見光定位系統(tǒng)的接收端位于光源下方的某個平面上，假設(shè)接收端與光 源的垂直距離為h，且豎直向上放置； 1.3初始化迭代次數(shù)K為1。3. 如權(quán)利要求2所述的一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法，其特 征還在于： 步驟一中所述的N>3。4. 如權(quán)利要求2所述的一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法，其特 征還在于： 步驟一中所述的R的選擇依據(jù)主要為系統(tǒng)定位精度和定位時間要求，且優(yōu)選的R值密度 范圍為:100個/平方米到400個/平方米之間。5. 如權(quán)利要求1所述的一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法，其特 征還在于： 步驟二具體過程為： 假設(shè)第i個光源所發(fā)射的原始光信號強度為Ptl，接收端接收到的來自第i個光源的光信 號強度為Pn，第i個光源的坐標為(Xl，yi);通過求解以下超定方程組的最小二乘解，可以獲 得粗定位結(jié)果的坐標(Xc；，y。），并將其作為迭代定位算法的初值； ^G6. 如權(quán)利要求1所述的一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法，其特 征還在于： 步驟三具體為:利用插值的方法，估計在粗定位結(jié)果的位置上來自第i個光源的經(jīng)墻面 和家具所反射光信號的強度，記為Prdi。7. 如權(quán)利要求1所述的一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法，其特 征還在于： 步驟三中S的大小由網(wǎng)格節(jié)點的分布形式?jīng)Q定，通?？蔀?、4或6，分別對應(yīng)三角形排布 矩形排布以及六邊形排布。8. 如權(quán)利要求1所述的一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法，其特 征還在于： 步驟四中重新計算接收端的位置坐標(x，y)采用解如下方程組得出；9. 如權(quán)利要求1所述的一種用于提高室內(nèi)可見光定位系統(tǒng)定位精度的迭代算法，其特 征還在于： 步驟五中所述的迭代次數(shù)K由系統(tǒng)的定位準確度和復雜度要求決定。
【文檔編號】G01S5/16GK105866738SQ201610245106
【公開日】2016年8月17日
【申請日】2016年4月19日
【發(fā)明人】楊愛英, 黃河清, 馮立輝, 倪國強
【申請人】北京理工大學