本發明涉及室內定位、室內導航技術領域,具體是一種室內定位方法與裝置。
背景技術:
目前用于定位的技術方法很多,如GPS、北斗等,此類方法由于無室內信號,只能用于室外定位,室內定位的方法有WLAN、WIFI、RFID、Zigbee、超聲、藍牙等。此類方法易受到電磁干擾,在多用戶占居信號通道時,通信質量、傳播距離等都受到影響,從而嚴重影響了定位精度。室內LED可見光由于覆蓋面廣、節能、布設簡單、成本低廉、無電磁輻射、干擾源少等特點,因此在室內定位領域具有較好的前景。
目前,已有較多的基于LED可見光室內定位方法,有些只限于二維定位,也有三維的方法,大致方法歸類如下:
1、基于標簽的LED可見光室內定位方法,此方法將與位置相關的ID數據加載到不同LED光源上,接收終端通過對ID數據的處理實現被動定位。
2、基于接收光信號強度的定位方法。
3、其它測量方法有圖像成像法、三角測量法等。
上述方法,由于沒有考慮發射信號的反射、折射等干擾因素,發射信號遇到障礙物,如墻面、玻璃等,會產生反射現象,導致待測定位點接收的信號除了發射源直射信號外,還會接收到反射、折射等信號,從而引入了干擾,影響測量精度。此外,多種定位方法,如到達時間(TOA)、到達時間差(TDOA)等定位方法,發射端和接收端均要實現信號同步,在實際應用中受到了限制。
技術實現要素:
本發明的目的在于提供一種室內定位方法與裝置,它利用LED可見光進行室內定位,能夠減少反射、折射等信號干擾,能夠實現高精度定位,并且發射端和接收端信號無需同步,能夠降低定位成本。
本發明為實現上述目的,通過以下技術方案實現:
一種室內定位裝置,包括信號發送裝置、至少五盞LED燈、光電傳感器、信號處理裝置,
所述信號發送裝置用于控制不同的LED燈發出不同的光信號,
所述光電傳感器用于將接收待測定位點處的光信號轉化為電信號,并將電信號傳遞到信號處理裝置,
所述信號處理裝置用于獲得所述光電傳感器的坐標值,所述信號處理裝置包括相位測量模塊、若干路信號處理通道,所述信號處理通道的數量與LED燈的數量相同,所述信號處理通道包括信號調理模塊、帶通濾波模塊、載波跟蹤同步模塊、解調模塊、偽碼捕獲跟蹤模塊、本地PRN、下變頻模塊、本地載波。
一種室內定位方法,包括以下步驟:
步驟1:在室內天花板的不同位置安裝至少五盞所述LED燈,并記錄所述LED燈的安裝位置(xi,yi,zi),(xi,yi,zi)為第i盞LED燈的坐標,根據所述LED燈的數量,確定所述信號處理通道的數量,所述信號處理通道與所述LED燈一一對應,第i路信號處理通道處理第i盞LED燈發出的光信號;
步驟2:將所述LED燈與所述信號發送裝置連接,由所述信號發送裝置控制不同的所述LED燈發出不同的光信號,光信號為:
其中,a(t)=A0sin(2πfit)為所述信號發送裝置送入第i盞LED燈的幅度調制信號,i=1,...,N,N≥5,為偽碼序列,Tc為碼元寬度,nTc≤t≤(n+1)Tc,{cn}∈{±1},且速率為1/Tc,gc(t)為門函數,m(t)=Acosω0t為幅度調制載波信號,幅度調制信號a(t)頻率fi根據不同LED燈,均不相同;
步驟3:將所述光電傳感器與所述信號處理裝置連接,在接收待測定位點通過所述光電傳感器將接收待測定位點處的不同所述LED發出的光信號轉化為相應的電信號,并將電信號傳遞到相應的所述信號處理通道進行處理;
步驟4:利用所述信號調理模塊、帶通濾波模塊對進入所述信號處理通道的電信號進行處理,獲得信號:
其中,βdi為第i盞LED燈直射至接收待測定位點的信號衰減因子,βMi為第i盞LED燈經過反射、折射后至接收待測定位點的信號衰減因子,tdi為直射至接收待測定位點的時間延遲,tMdi為經過反射、折射后至接收待測定位點的時間延遲,為直射時的調制載波信號相移,為經過反射、折射后調制載波信號的相移,n0(t)為噪聲;
步驟5:利用所述偽碼捕獲跟蹤模塊的偽碼捕獲調整所述本地PRN使之與接收到的碼序列c(t-tdi)粗同步,利用所述偽碼捕獲跟蹤模塊的偽碼跟蹤在捕獲基礎之上進一步縮小發送和接收端偽碼序列的相位差,達到精確同步并持續保持同步,利用載波跟蹤同步模塊使得所述本地載波的頻率與接收信號的載波頻率相位進行對齊,步驟4中的信號ri(t)經偽碼捕獲跟蹤模塊、載波跟蹤同步模塊處理后表示為:
其中,為第i信號處理通道中本地PRN偽碼參考時間延遲,為本地載波的相位;
步驟6:利用所述解調模塊對步驟6中的信號進行解調,步驟6中的信號表示為:
ri(t)≈A′isin(2πfit-tdi)
步驟7:經步驟6獲得的信號進入所述下變頻模塊進行下變頻處理,將第i=1路信號處理通道作為基準通道,對應頻率為f1,步驟6獲得的信號經過所述下變頻后,表示為:
r1′(t)≈E1sin(πf1t-2πf1d1/c)
第j路信號處理通道通過下變頻后,表示為:
rj′(t)≈Ejsin[πf1t-2πfjdj/c]
其中,dj為第j盞LED燈到接收待測點的距離,c為光速;
步驟8:利用所述相位測量模塊對經步驟8獲得的信號進行處理,第i、j信號處理通道的信號送入相位測量模塊,有:
其中,△φij由Hilbert變換求得:
步驟9:(x,y,z)為接收待測定位點的坐標,利用第一公式x=(ATA)-1ATm得出接收待測定位點的x,y坐標,
其中,
利用第二公式獲得接收待測定位點的z坐標。
對比現有技術,本發明的有益效果在于:
本發明采用至少五盞LED燈,不同的LED燈發出不同的光信號,利用不同光信號相位的不同,獲得LED燈與接收待測定位點的距離,進而測得接收待測定位點的坐標,能夠減少反射、折射等信號干擾,能夠實現高精度定位,并且發射端和接收端信號無需同步,能夠降低定位成本。
附圖說明
附圖1是本發明的室內定位系統結構圖;
附圖2是本發明信號處理裝置接收信號的處理框圖;
附圖3是室內5×5×3米定位實際值與定位估算值比較圖。
附圖中標號:1、信號發送裝置;2、LED燈;3、光電傳感器;4、信號處理裝置;5、相位測量模塊;6、信號調理模塊;7、帶通濾波模塊;8、載波跟蹤同步模塊;9、解調模塊;10、偽碼捕獲跟蹤模塊;11、本地PRN;12、下變頻模塊;13、本地載波。
具體實施方式
下面結合具體實施例,進一步闡述本發明。應理解,這些實施例僅用于說明本發明而不用于限制本發明的范圍。此外應理解,在閱讀了本發明講授的內容之后,本領域技術人員可以對本發明作各種改動或修改,這些等價形式同樣落于本申請所限定的范圍。
本發明所述是一種室內定位裝置,包括信號發送裝置1、至少五盞LED燈2、光電傳感器3、信號處理裝置4,
所述信號發送裝置1用于控制不同的LED燈2發出不同的光信號,
所述光電傳感器3用于將接收待測定位點處的光信號轉化為電信號,并將電信號傳遞到信號處理裝置4,
所述信號處理裝置4用于獲得所述光電傳感器3的坐標值,所述信號處理裝置4包括相位測量模塊5、若干路信號處理通道,所述信號處理通道的數量與LED燈2的數量相同,所述信號處理通道包括信號調理模塊6、帶通濾波模塊7、載波跟蹤同步模塊8、解調模塊9、偽碼捕獲跟蹤模塊10、本地PRN 11、下變頻模塊12、本地載波13。
一種室內定位方法,包括以下步驟:
步驟1:如圖1所示,在室內天花板的不同位置安裝至少五盞所述LED燈,并記錄所述LED燈的安裝位置(xi,yi,zi),(xi,yi,zi)為第i盞LED燈的坐標,所有LED燈均安裝在天花板,zi=0,根據所述LED燈的數量,確定所述信號處理通道的數量,所述信號處理通道與所述LED燈一一對應,第i路信號處理通道處理第i盞LED燈發出的光信號;
步驟2:將所述LED燈與所述信號發送裝置連接,由所述信號發送裝置控制不同的所述LED燈發出不同的光信號,光信號為:
其中,a(t)=A0sin(2πfit)為所述信號發送裝置送入第i盞LED燈的幅度調制信號,i=1,...,N,N≥5,為偽碼序列,Tc為碼元寬度,nTc≤t≤(n+1)Tc,{cn}∈{±1},且速率為1/Tc,gc(t)為門函數,m(t)=Acosω0t為幅度調制載波信號,幅度調制信號a(t)頻率fi根據不同LED燈,均不相同;
步驟3:將所述光電傳感器與所述信號處理裝置連接,在接收待測定位點通過所述光電傳感器將接收待測定位點處的不同所述LED發出的光信號轉化為相應的電信號,并將電信號傳遞到相應的所述信號處理通道進行處理;
步驟4:如圖2所述,利用所述信號調理模塊、帶通濾波模塊對進入所述信號處理通道的電信號進行處理,獲得信號:
其中,βdi為第i盞LED燈直射至接收待測定位點的信號衰減因子,βMi為第i盞LED燈經過反射、折射后至接收待測定位點的信號衰減因子,tdi為直射至接收待測定位點的時間延遲,tMdi為經過反射、折射后至接收待測定位點的時間延遲,為直射時的調制載波信號相移,為經過反射、折射后調制載波信號的相移,n0(t)為噪聲;
步驟5:利用所述偽碼捕獲跟蹤模塊的偽碼捕獲調整所述本地PRN使之與接收到的碼序列c(t-tdi)粗同步,利用所述偽碼捕獲跟蹤模塊的偽碼跟蹤在捕獲基礎之上進一步縮小發送和接收端偽碼序列的相位差,達到精確同步并持續保持同步,利用載波跟蹤同步模塊使得所述本地載波的頻率與接收信號的載波頻率相位進行對齊,
設為第i信號處理通道中本地PRN偽碼參考時間延遲,為本地載波的相位,接收信號ri(t)通過偽碼捕獲跟蹤模塊處理后,信號可表示為:
當實現精確的偽碼捕獲跟蹤時,相當于頻譜擴展,將干擾信號的功率分散到很寬的頻帶上,濾波后只有頻帶相同的干擾進入載波跟蹤同步模塊。因此,式(4)可表示為:
本地載波相乘載波跟蹤同步后,式(5)表示為:
步驟6:利用所述解調模塊對步驟6中的信號進行解調,解擴前后頻帶相差很大,因此解擴后的干擾功率迅速降低,式(6)可表示為:
ri(t)≈A′isin(2πfit-tdi) (7)
同理,在第j路信號處理通道中(j=1,...,N,N≥5,j≠i),通過解調后的信號可表示為:
rj(t)≈A′jsin(2πfjt-tdj) (8)
步驟7:經步驟6獲得的信號進入所述下變頻模塊進行下變頻處理,將第i=1路信號處理通道作為基準通道,對應頻率為f1,步驟6獲得的信號經過所述下變頻后,表示為:
r1′(t)≈E1sin(πf1t-2πf1d1/c) (9)
第j路信號處理通道通過下變頻后,表示為:
rj′(t)≈Ejsin[πf1t-2πfjdj/c] (10)
其中,dj為第j盞LED燈到接收待測點的距離,c為光速;
步驟8:利用所述相位測量模塊對經步驟8獲得的信號進行處理,第i、j信號處理通道的信號送入相位測量模塊,有:
其中,△φij由Hilbert變換求得:
以第1盞LED燈作為參考,有:
結合式(11)、(13)有:
信號發送裝置發送給各盞LED燈的幅度調制信號a(t)=A0sin(2πfit)所對應的頻率為fi=(2i-1)f1。式(14)可表示為:
Ax=m (16)
其中,
步驟9:(x,y,z)為接收待測定位點的坐標,利用第一公式x=(ATA)-1ATm得出接收待測定位點的x,y坐標,利用第二公式獲得接收待測定位點的z坐標。
本發明采用至少五盞LED燈,不同的LED燈發出不同的光信號,利用不同光信號相位的不同,獲得LED燈與接收待測定位點的距離,進而測得接收待測定位點的坐標,能夠減少反射、折射等信號干擾,能夠實現高精度定位,并且發射端和接收端信號無需同步,能夠降低定位成本。