一種無線傳感網絡高精度定位系統的制作方法
【專利摘要】本發明提供一種無線傳感網絡高精度定位系統，其特征在于，包括初始化模塊：設置一組錨節點，并選擇適當的位置作為坐標原點o，建立原點坐標系xoz,計算各個錨節點相對于坐標原點o的相對極坐標(r,δ)，每個錨節點上設置有一組紅外攝像頭，計算各個紅外攝像頭的方向信息，將各個相對極坐標和紅外攝像頭方向信息錄入對應的錨節點主控模塊，被測節點上設置兩個紅外發光模塊。本方法對無線傳感網定位參考坐標獲取這一核心為題提供低成本高精度的解決方案，對于無線傳感網機近距離無線通信高精度定位系統研究具有重要的參考價值。
【專利說明】
-種無線傳感網絡高精度定位系統
技術領域
[0001] 本發明設及無線傳感網絡定位領域，具體地講，設及一種無線傳感網絡高精度定 位系統。
【背景技術】
[0002] 無線傳感網（WSN)中的節點定位是WSN眾多研究和應用的基礎，也是一個研究熱 點。為了評價定位算法，我們需要獲取高精度的參考坐標，采用普通的GPS定位方法定位精 度能夠達到2米W內，對于一些高精度定位而言不能滿足需求;雖然通過差分GPS方法可W 達到非常高的精度，但是運種方法花費極大，更重要的是GPS技術室內無法完成定位，而無 線定位的試驗環境很多時候是在室內或半開放環境下，因此我們需要一種通用、廉價、便捷 的參考坐標提供系統和方法，攝像定位系統可W實現高精度的物體定位，但是通常運些系 統需要非常復雜的圖像處理算法、圖像識別技術及強大的處理器來進行圖像分析處理，要 求很強的專業知識，開發難度大，我們設計了一種不同于傳統攝像定位方法的低復雜度攝 像實時定位系統，過濾掉無關的信息，能夠用簡單的算法實現較精度的實時定位。
【發明內容】
[0003] 本發明要解決的技術問題是提供一種無線傳感網絡高精度定位系統，能夠用簡單 的算法實現較精度的實時定位。
[0004] 本發明采用如下技術方案實現發明目的：
[0005] -種無線傳感網絡高精度定位系統，其特征在于，包括如下模塊：
[0006] 初始化模塊:設置一組錯節點，并選擇適當的位置作為坐標原點0,建立原點坐標 系XOZ，計算各個錯節點相對于坐標原點O的相對極坐標(r，s)，每個錯節點上設置有一組 紅外攝像頭，計算各個紅外攝像頭的方向信息，將各個相對極坐標和紅外攝像頭方向信息 錄入對應的錯節點主控模塊，被測節點上設置兩個紅外發光模塊；
[0007] 預處理模塊:首先進行預測量操作，將兩個間距為d紅外發光模塊豎直放置，其中 位置較低的紅外發光模塊與錯節點的紅外攝像頭同高的位置，分別用紅外攝像頭拍攝距離 紅外發光模塊不同設定距離時的紅外圖像，并求得每個紅外圖像的兩個紅外發光模塊間的 像素點數存入距離參考緩沖區DisRef山，緩沖區格式如下：Dref [i]、nref[i]，其中，Dref [i]表示不同設定距離，nref[i]表示不同設定距離對應的兩個紅外發光模塊之間的像素點 數，距離參考緩沖區DisRefti]按照由大到小的順序進行存儲；
[000引無線通信測試模塊:其中一個錯節點自動成為主節點，每5秒鐘在發送時隙TO發送 一次系統同步指令SYSSYNC，其他錯節點在自己對應的錯節點時隙化發送應答無線數據包 ACKSYSSYNC，被測節點在終端節點時隙Tt發送應答無線數據包TACKSYSSYNC，如果主節點收 到應答無線數據包ACKSYSSYNC和TACKSYSSYNC，則表明無線網絡通信成功，否則，持續測試 直到網絡通信成功；
[0009]拍照前同步通信模塊：被測試節點按鍵在Tt時隙發送請求測試無線數據包 Appl^est，每個錯節點接收到請求數據包后在對應的化時隙發送ACKApplyTest數據包，被 測節點接收到全部錯節點的應答數據包；
[0010] 被測節點全局坐標計算模塊:被測節點按鍵打開紅外發射模塊，然后發送定位測 試數據包LocTest,等待2秒后關閉紅外發射模塊，每個錯節點接收到無線數據包后通知對 應的圖像處理模塊進行拍照，并對采集的圖像信息進行處理，獲取被測節點的全局坐標：
[0011] 被測節點最終坐標計算模塊:各個錯節點將獲取的原始數據和最終計算的被測節 點全局坐標發送至主節點，主節點將接收的所有被測節點坐標取平均后得到最終的被測節 點坐標，同時將坐標信息存入TF卡，然后將被測節點坐標信息發送至被測節點，被測節點 接收到坐標信息后在顯示模塊上顯示，至此完成一次定位。
[0012] 作為對本技術方案的進一步限定，所述被測節點全局坐標計算模塊包括如下步 驟：
[0013] (1)被測節點打開紅外發射模塊，然后發送定位測試數據包LocTest,錯節點接收 到無線數據包后通知圖像處理模塊進行拍照，每個錯節點拍攝的圖像不存在重疊現象，圖 像處理模塊對采集的圖像信息進行處理；
[0014] (2)將圖像處理模塊的處理信息發送到錯節點主控模塊計算被測節點的相對坐 標；
[001引（3)通過極坐標運算就可W得到被測節點的全局坐標。
[0016] 作為對本技術方案的進一步限定，所述步驟(1)的圖像信息處理包括如下步驟：
[0017] (1.1)圖像處理模塊首先將N個發光區域的存儲緩沖區化s[N]清空，每個存儲緩沖 區有7個參數，分別為最小X坐標Xmin，最大X坐標Xmax，最小Y坐標化in，最大Y坐標Ymax，X坐 標平均值Xavg，Y坐標平均值化Vg，像素點數量Num，上述參數的初始值均為0;
[0018] (1.2)然后將紅外攝像頭采集的灰度圖像按照行列的順序依次將各像素點發送至 圖像處理模塊，圖像處理模塊判斷每個像素點的亮度是否大于預設的強度闊值Ath,如果亮 度大于Ath,則判斷該像素點為發光點，然后將該像素點的坐標依次與每個存儲緩沖區的參 數進行比對：
[0019] 如果像素點X坐標<Xmin-2或像素 X坐標〉Xmax+2，
[0020] 同時
[0021 ] 像素 Y坐標別min-2或像素 Y坐標〉Ymax+2，
[0022] 則判斷該像素點不在該發光區域內，查找下一個存儲緩沖區；
[0023] 否則判斷該發光點在該發光區域內，更新存儲緩沖區參數：
[0024] 如果乂坐標。111；[]1，貝化111；[]1=乂坐標，
[0025] 否則如果X坐標〉Xmax，則Xmax=X坐標，
[0026] 如果Y坐標 <化;[]1，則化;[]1 = ￥坐標，
[0027] 否則如果Y坐標〉Ymax，則Ymax = Y坐標；
[002引 Xavg= (Xavg*Num 巧坐標）/Num;
[0029] 化 Vg= (Yavg*Num 巧坐標）/Num;
[0030] Num = Num+!；
[0031] (1.3)如果該像素點不在所有的發光區域中，則判斷為新的發光區域，新的發光區 域的存儲緩沖區化s[m]的參數設置如下：
[0032] Xmin=X 坐標；
[003；3] Xmax=X 坐標；
[0034] %iin = Y 坐標；
[0035] Ymax = Y 坐標；
[0036] Xavg=X 坐標；
[0037] 化 Vg = Y 坐標；
[00；3 引 Num=I;
[0039] (1.4)當所有的像素點傳輸完畢后圖像處理模塊將所有存儲緩沖區信息處理，首 先選擇滿足如下條件的發光區域W降低誤差：
[0040] Xavg-Xmin〉Rxth 同時 Xmax-Xavg〉Rxth 同時化 vg-%iin〉R}fth 同時 Ymax-化 vg〉RYth， Rxth, Ryth為系統設置的發光區域最小有效半徑;然后選出所有發光區域Xavg相差5W內的 發光區域，如有2個發光區域滿足條件則表明成功拍攝到被測節點，否則表明未拍攝到被測 節點。
[0041] 作為對本技術方案的進一步限定，所述步驟(2)包括如下步驟：
[0042] (2.1)獲取被測節點的高度：
[0043]
[0044] 其中，nt為拍攝圖像中兩個發光區域中屯、點間的像素點數，假設較高的發光區域 中屯、點Y坐標為Yavgl，較低的發光區域中屯、點Y坐標為Yavg2，則nt= (Yavgl-Yavg2); Yimagemax表示拍攝圖像的高度，d表示兩個紅外發光模塊的實際間距；
[0045] (2.2)計算紅外攝像頭與被測節點的距離Dis,具體步驟如下：
[0046] 首先在距離參考緩沖區DisRef [ i ]中查找nt，當nref [i ]<nt或者nref [ i ] = nt時停 止查找，
[0047] 如果nref [i]=nt，則被測節點與攝像頭距離Dis = Drefti];
[004引 否則 Dis = nt*(Dref [ i ]-Dref [ i-1 ] )/(nref [ i ]-nref [ i-1 ])
[0049] 如果沒有找到則：
[0050] Dis = nt*(Dref [Nmax-1 ]-Dref [Nmax-2] )/(nref [Nmax-1 ]-nref [Nmax-2])，Nmax 表示化ef和nref數組的最大數量；
[0051] (2.3)計算被測節點的坐標，具體步驟如下：
[0052] 首先建立垂直于拍攝圖像XY平面的XZ平面，)(Z平面穿過紅外攝像頭且與兩個被測 節點連線垂直，拍攝圖像平面為XY平面，紅外攝像頭在XY平面的投影位于拍攝圖像的中屯、O 扣/2，117/2)他為拍攝圖像的寬度，117為拍攝圖像的高度，拍攝圖像的中屯、〇距離兩個被測 節點連線的距離化為：；
[0化3]
[0054] ;平面映射距離Diszx為：
[0化5]
[0056]紅外攝像頭與拍攝圖像中屯、O的距離化為 [0化7]
[0化引 試日下：
[0化9]
[0060] 被測節點相對攝像頭在XZ平面上的相對極坐標為(Diszx，丫）。
[0061] 作為對本技術方案的進一步限定，所述紅外攝像頭的方向信息是指紅外攝像頭 與原點坐標系XOZ的X軸在XZ平面的夾角0。
[0062] 作為對本技術方案的進一步限定，所述步驟(3)包括如下步驟：
[0063] 被測節點在XZ平面上與紅外攝像頭的夾角為丫；
[0064] 被測節點相對錯節點的高度Dy,也就是被測節點距離XZ平面的高度，即被測節點 的實際的Y向坐標為；
[0065] 所W可W得到被測節點相對錯節點X軸坐標：
[0066] 被測節點相對紅外攝像頭在XZ平面上映射距離為Diszx,又已知紅外攝像頭與原 點坐標系的X軸在XZ平面夾角為0，因此被測節點相對紅外攝像頭在XZ平面上與原點坐標系 的X軸的夾角為e+y ;
[0067] 最后利用各錯節點的相對極坐標(r，S)計算得到被測節點相對于原點O的坐標，被 測節點的全局X向坐標為? cos(S)+Diszx ? cos(0+ 丫）；
[006引被測節點的全局Z向坐標為? sin(S)+Diszx ? sin(0+丫）。
[0069] 與現有技術相比，本發明的優點和積極效果是:本測試方法通過在被測節點安裝 紅外發光模塊，定位錯節點上安裝多臺單通道紅外攝像頭采集圖像信息，得到被測節點紅 外發光區域大小和位置計算得到被測節點的=維坐標，通過多錯節點協同得到精確的位置 信息，為無線傳感網定位提供高精度的參考位置信息。本方法對無線傳感網定位參考坐標 獲取運一核屯、為題提供低成本高精度的解決方案，對于無線傳感網機近距離無線通信高精 度定位系統研究具有重要的參考價值。
【附圖說明】
[0070] 圖1為本發明的被測節點控制裝置的原理方框圖。
[0071] 圖2為本發明的錯節點控制裝置的原理方框圖。
[0072] 圖3為本發明的被測節點所處的無線網絡的結構示意圖。
[0073] 圖4為本發明的全局坐標系結構示意圖。
[0074] 圖5為本發明的拍攝圖像的結構示意圖。
[0075] 圖6為本發明的XY平面和XZ平面的結構示意圖。
【具體實施方式】
[0076] 下面結合附圖和優選實施例對本發明作更進一步的詳細說明。
[0077] 參見圖1-圖6,本發明的硬件部分包括被測節點控制裝置和錯節點控制裝置，所述 被測節點控制裝置包括被測節點主控模塊1，所述被測節點主控模塊1分別連接被測節點無 線模塊2和兩個紅外發射模塊3,所述錯節點控制裝置包括錯節點主控模塊7,所述錯節點主 控模塊7分別連接錯節點無線模塊8和圖像處理模塊9,每個所述圖像處理模塊9分別連接紅 外攝像頭10,所述被測節點無線模塊和錯節點無線模塊分別連接有天線6。
[0078] 所述被測節點主控模塊1還連接被測節點顯示模塊4和被測節點鍵盤模塊5。所述 錯節點主控模塊7還連接錯節點顯示模塊11和錯節點鍵盤模塊12,被測節點顯示模塊4和錯 節點顯示模塊11采用OL邸模塊。
[0079] 兩個所述紅外發射模塊3豎直放置，兩個所述紅外攝像頭10的夾角為90-120度。
[0080] 所述被測節點控制裝置和所述錯節點控制裝置都設置于支架13上，所述被測節點 控制裝置和所述錯節點控制裝置都設置有電源模塊14。
[0081] 本發明包括如下模塊：
[0082] 初始化模塊:設置一組錯節點，并選擇適當的位置作為坐標原點0,建立原點坐標 系XOZ，計算各個錯節點相對于坐標原點O的相對極坐標(r，S)，每個錯節點上設置有一組紅 外攝像頭，計算各個紅外攝像頭的方向信息，將各個相對極坐標和紅外攝像頭方向信息錄 入對應的錯節點主控模塊，被測節點上設置兩個紅外發光模塊；
[0083] 預處理模塊:首先進行預測量操作，將兩個間距為d紅外發光模塊豎直放置，其中 位置較低的紅外發光模塊與錯節點的紅外攝像頭同高的位置，分別用紅外攝像頭拍攝距 離紅外發光模塊不同設定距離時的紅外圖像，并求得每個紅外圖像的兩個紅外發光模塊間 的像素點數存入距離參考緩沖區DisRef [i]，緩沖區格式如下：Dref [i]、nref[i]，其中， Dref [i]表示不同設定距離，nref[i]表示不同設定距離對應的兩個紅外發光模塊之間的像 素點數，距離參考緩沖區DisRefti]按照由大到小的順序進行存儲；
[0084] 無線通信測試模塊:其中一個錯節點自動成為主節點，每5秒鐘在發送時隙TO發送 一次系統同步指令SYSSYNC，其他錯節點在自己對應的錯節點時隙化發送應答無線數據包 ACKSYSSYNC，被測節點在終端節點時隙Tt發送應答無線數據包TACKSYSSYNC，如果主節點收 到應答無線數據包ACKSYSSYNC和TACKSYSSYNC，則表明無線網絡通信成功，否則，持續測試 直到網絡通信成功；
[0085] 拍照前同步通信模塊：被測試節點按鍵在Tt時隙發送請求測試無線數據包 Appl^est,每個錯節點接收到請求數據包后在對應的化時隙發送ACKApplyTest數據包，被 測節點接收到全部錯節點的應答數據包；
[0086] 被測節點全局坐標計算模塊:被測節點按鍵打開紅外發射模塊，然后發送定位測 試數據包LocTest,等待2秒后關閉紅外發射模塊，每個錯節點接收到無線數據包后通知對 應的圖像處理模塊進行拍照，并對采集的圖像信息進行處理，獲取被測節點的全局坐標：
[0087] 被測節點最終坐標計算模塊:各個錯節點將獲取的原始數據和最終計算的被測節 點全局坐標發送至主節點，主節點將接收的所有被測節點坐標取平均后得到最終的被測節 點坐標，同時將坐標信息存入TF卡，然后將被測節點坐標信息發送至被測節點，被測節點接 收到坐標信息后在顯示模塊上顯示，至此完成一次定位。
[0088] 所述被測節點全局坐標計算模塊包括如下步驟：
[0089] (1)被測節點打開紅外發射模塊，然后發送定位測試數據包LocTest,錯節點接收 到無線數據包后通知圖像處理模塊進行拍照，每個錯節點拍攝的圖像不存在重疊現象，圖 像處理模塊對采集的圖像信息進行處理；
[0090] (2)將圖像處理模塊的處理信息發送到錯節點主控模塊計算被測節點的相對坐 標；
[0091] (3)通過極坐標運算就可W得到被測節點的全局坐標。
[0092] 所述步驟(1)的圖像信息處理包括如下步驟：
[0093] (1.1)圖像處理模塊首先將N個發光區域的存儲緩沖區化s[N]清空，每個存儲緩沖 區有7個參數，分別為最小X坐標Xmin，最大X坐標Xmax，最小Y坐標化in，最大Y坐標Ymax，X坐 標平均值Xavg，Y坐標平均值化Vg，像素點數量Num，上述參數的初始值均為0;
[0094] (1.2)然后將紅外攝像頭采集的灰度圖像按照行列的順序依次將各像素點發送至 圖像處理模塊，圖像處理模塊判斷每個像素點的亮度是否大于預設的強度闊值Ath,如果亮 度大于Ath,則判斷該像素點為發光點，然后將該像素點的坐標依次與每個存儲緩沖區的參 數進行比對：
[0095] 如果像素點X坐標<Xmin-2或像素 X坐標〉Xmax+2，
[0096] 同時
[0097] 像素 Y坐標別min-2或像素 Y坐標〉Ymax+2，
[0098] 則判斷該像素點不在該發光區域內，查找下一個存儲緩沖區；
[0099] 否則判斷該發光點在該發光區域內，更新存儲緩沖區參數：
[0100] 如果 X 坐標 <Xmin，貝 IjXmin=X 坐標，
[0101 ] 否則如果X坐標〉Xmax,則Xmax=X坐標，
[0102] 如果Y坐標 <化;[]1，則化;[]1 = ￥坐標，
[0103] 否則如果Y坐標〉Ymax,則Ymax = Y坐標；
[0104] Xavg= (Xavg*Num 巧坐標）/Num;
[0105] 化 Vg= (Yavg*Num 巧坐標）/Num;
[0106] Num = Num+!；
[0107] (1.3)如果該像素點不在所有的發光區域中，則判斷為新的發光區域，新的發光區 域的存儲緩沖區化s[m]的參數設置如下：
[010 引 Xmin=X 坐標；
[0109] Xmax=X 坐標；
[0110] %iin = Y 坐標；
[0111] Ymax = Y坐標；
[0112] Xavg=X 坐標；
[0113] 化 Vg = Y 坐標；
[0114] Num=I ；
[0115] (1.4)當所有的像素點傳輸完畢后圖像處理模塊將所有存儲緩沖區信息處理，首 先選擇滿足如下條件的發光區域W降低誤差：
[0116] Xavg-Xmin〉Rxth 同時 Xmax-Xavg〉Rxth 同時化 vg-%iin〉R}fth 同時 Ymax-化 vg〉RYth， Rxth, Ryth為系統設置的發光區域最小有效半徑;然后選出所有發光區域Xavg相差5W內的 發光區域，如有2個發光區域滿足條件則表明成功拍攝到被測節點，否則表明未拍攝到被測 節點。
[0117] 作為對本技術方案的進一步限定，所述步驟(2)包括如下步驟：
[0118] (2.1)獲取被測節點的高度：
[0119]
[0120] 其中，nt為拍攝圖像中兩個發光區域中屯、點間的像素點數，假設較高的發光區域 中屯、點Y坐標為Yavgl,較低的發光區域中屯、點Y坐標為Yavg2,則nt=(Yavgl-Yavg2); Yimagemax表示拍攝圖像的高度，d表示兩個紅外發光模塊的實際間距；
[0121] (2.2)計算紅外攝像頭與被測節點的距離Dis,具體步驟如下：
[0122] 首先在距離參考緩沖區DisRef [ i ]中查找nt，當nref [i ]<nt或者nref [ i ] = nt時停 止查找，
[0123] 如果nref[i] =nt,則被測節點與攝像頭距離Dis = Dref[i];
[0124] 否則Dis = nt*( Dref [ i]-Dref[ i_l ])/(nref [ i]-nref[ i_l ])
[0125] 如果沒有找到則：
[01 %] Dis = nt*(Dref [Nmax-l ]-Dref [Nmax-2] )/(nref [Nmax-l ]-nref [Nmax-2])，Nmax 表示化ef和nref數組的最大數量；
[0127] (2.3)計算被測節點的坐標，具體步驟如下：
[012引首先建立垂直于拍攝圖像XY平面的XZ平面，)(Z平面穿過紅外攝像頭且與兩個被測 節點連線垂直，拍攝圖像平面為XY平面，紅外攝像頭在XY平面的投影位于拍攝圖像的中屯、O (11又/2，117/2)他為拍攝圖像的寬度，117為拍攝圖像的高度，拍攝圖像的中屯、0距離兩個被測 節點連線的距離化為：
[0129]
[0130] ;平面映射距離Diszx為：
[0131]
[0132] :為
[0133]
[0134]
[0135]
[0136] 被測節點相對攝像頭在XZ平面上的相對極坐標為(Diszx，丫）。
[0137] 所述紅外攝像頭的方向信息是指紅外攝像頭與原點坐標系XOZ的X軸在XZ平面的 夾角e。
[0138] 所述步驟(3)包括如下步驟：
[0139] 被測節點在XZ平面上與紅外攝像頭的夾角為丫；
[0140] 被測節點相對錯節點的高度Dy,也就是被測節點距離XZ平面的高度，即被測節點 的實際的Y向坐標為：
[0141] 所W可W得到被測節點相對貓節點X軸坐標：
[0142] 被測節點相對紅外攝像頭在XZ平面上映射距離為Diszx，又已知紅外攝像頭與原 點坐標系的X軸在XZ平面夾角為0，因此被測節點相對紅外攝像頭在XZ平面上與原點坐標系 的X軸的夾角為0+T ;
[0143] 最后利用各錯節點的相對極坐標(r，S)計算得到被測節點相對于原點O的坐標，被 測節點的全局X向坐標為? cos(S)+Diszx ? cos(0+ 丫）；被測節點的全局Z向坐標為:1'? sin(5)+Diszx ? sin(0+ 丫）。
【主權項】
1. 一種無線傳感網絡高精度定位系統，其特征在于，包括如下模塊： 初始化模塊：設置一組錯節點，并選擇適當的位置作為坐標原點0,建立原點坐標系 X0Z，計算各個錯節點相對于坐標原點0的相對極坐標(r，s)，每個錯節點上設置有一組紅外 攝像頭，計算各個紅外攝像頭的方向信息，將各個相對極坐標和紅外攝像頭方向信息錄入 對應的錯節點主控模塊，被測節點上設置兩個紅外發光模塊； 預處理模塊:首先進行預測量操作，將兩個間距為d紅外發光模塊豎直放置，其中位置 較低的紅外發光模塊與錯節點的紅外攝像頭同高的位置，分別用紅外攝像頭拍攝距離紅外 發光模塊不同設定距離時的紅外圖像，并求得每個紅外圖像的兩個紅外發光模塊間的像素 點數存入距離參考緩沖區DisRef [i],緩沖區格式如下:Dref [i]、nref [i]，其中，Dref [i]表 示不同設定距離，nref[i]表示不同設定距離對應的兩個紅外發光模塊之間的像素點數，距 離參考緩沖區DisRefti]按照由大到小的順序進行存儲； 無線通信測試模塊:其中一個錯節點自動成為主節點，每5秒鐘在發送時隙TO發送一次 系統同步指令SYSSYNC，其他錯節點在自己對應的錯節點時隙Τη發送應答無線數據包 ACKSYSSYNC，被測節點在終端節點時隙Tt發送應答無線數據包TACKSYSSYNC，如果主節點收 到應答無線數據包ACKSYSSYNC和TACKSYSSYNC，則表明無線網絡通信成功，否則，持續測試 直到網絡通信成功； 拍照前同步通信模塊:被測試節點按鍵在Tt時隙發送請求測試無線數據包Appl^est， 每個錯節點接收到請求數據包后在對應的化時隙發送ACKApplyTest數據包，被測節點接收 到全部錯節點的應答數據包； 被測節點全局坐標計算模塊:被測節點按鍵打開紅外發射模塊，然后發送定位測試數 據包LocTest，等待2秒后關閉紅外發射模塊，每個錯節點接收到無線數據包后通知對應的 圖像處理模塊進行拍照，并對采集的圖像信息進行處理，獲取被測節點的全局坐標： 被測節點最終坐標計算模塊:各個錯節點將獲取的原始數據和最終計算的被測節點全 局坐標發送至主節點，主節點將接收的所有被測節點坐標取平均后得到最終的被測節點坐 標，同時將坐標信息存入TF卡，然后將被測節點坐標信息發送至被測節點，被測節點接收到 坐標信息后在顯示模塊上顯示，至此完成一次定位。2. 根據權利要求1所述的無線傳感網絡高精度定位系統，其特征在于，所述被測節點全 局坐標計算模塊包括如下步驟： (1) 被測節點打開紅外發射模塊，然后發送定位測試數據包LocTest，錯節點接收到無 線數據包后通知圖像處理模塊進行拍照，每個錯節點拍攝的圖像不存在重疊現象，圖像處 理模塊對采集的圖像信息進行處理； (2) 將圖像處理模塊的處理信息發送到錯節點主控模塊計算被測節點的相對坐標； (3) 通過極坐標運算就可W得到被測節點的全局坐標。3. 根據權利要求2所述的無線傳感網絡高精度定位系統，其特征在于，所述步驟（1)的 圖像信息處理包括如下步驟： (1.1) 圖像處理模塊首先將N個發光區域的存儲緩沖區Pos[N]清空，每個存儲緩沖區有 7個參數，分別為最小X坐標Xmin，最大X坐標Xmax，最小Y坐標％iin，最大Y坐標Ymax，X坐標平 均值Xavg，Y坐標平均值化vg，像素點數量Num，上述參數的初始值均為0; (1.2) 然后將紅外攝像頭采集的灰度圖像按照行列的順序依次將各像素點發送至圖像 處理模塊，圖像處理模塊判斷每個像素點的亮度是否大于預設的強度闊值Ath，如果亮度大 于Ath，則判斷該像素點為發光點，然后將該像素點的坐標依次與每個存儲緩沖區的參數 進行比對： 如果像素點X坐標<Xmin-2或像素 X坐標〉Xmax+2， 同時 像素 Y坐標或像素 Y坐標〉Ymax+2， 則判斷該像素點不在該發光區域內，查找下一個存儲緩沖區； 否則判斷該發光點在該發光區域內，更新存儲緩沖區參數： 如果X坐標<Xmin，則Xmin = X坐標， 否則如果X坐標〉Xmax，則Xmax = X坐標， 如果Y坐標別min，則化in = Υ坐標， 否則如果Υ坐標〉Ymax，則Ymax = Υ坐標； Xavg= (Xavg*Num+X 坐標)/Num; 化 vg= (Yavg*Num+Y 坐標)/Num; Num=Num+l ； (1.3) 如果該像素點不在所有的發光區域中，則判斷為新的發光區域，新的發光區域的 存儲緩沖區化s[m]的參數設置如下： Xmin = X 坐標； Xmax = X 坐標； %iin = Y 坐標； Ymax = Y 坐標； Xavg = X 坐標； 化vg = Y坐標； Num= 1 ； (1.4) 當所有的像素點傳輸完畢后圖像處理模塊將所有存儲緩沖區信息處理，首先選 擇滿足如下條件的發光區域W降低誤差： Xavg-Xmin〉Rxth 同時 Xmax-Xavg〉Rxth 同時化 vg-Ymin〉Ryth 同時 Ymax-Yavg〉RYth， Rxth，Ryth為系統設置的發光區域最小有效半徑;然后選出所有發光區域Xavg相差5W內 的發光區域，如有2個發光區域滿足條件則表明成功拍攝到被測節點，否則表明未拍攝到被 測節點。4.根據權利要求3所述的無線傳感網絡高精度定位系統，其特征在于，所述步驟(2)包 括如下步驟： (2.1) 獲取被測節點的高度：其中，nt為拍攝圖像中兩個發光區域中屯、點間的像素點數，假設較高的發光區域中屯、 點Y坐標為化vgl，較低的發光區域中屯、點Y坐標為化vg2,則nt = (Yavgl-Yavg2);Yimagemax 表示拍攝圖像的高度，d表示兩個紅外發光模塊的實際間距； (2.2) 計算紅外攝像頭與被測節點的距離Dis，具體步驟如下： 首先在距離參考緩沖區DisRef [i]中查找nt，當nref [i]<nt或者nref [i] =nt時停止查 找， 如果nref [ i ] = nt，則被測節點與攝像頭距離Dis =化ef [ i ]; 否則 Dis = nt*(Dref [i]-Dref [i-1] )/(nref [i]-nref [i-1]) 如果沒有找到則： Dis = nt*(Dref [Nmax-1]-Dref [Nmax-2] )/(nref [Nmax-1 ]-nref [Nmax-2])，Nmax表示 Dref和nref數組的最大數量； (2.3)計算被測節點的坐標，具體步驟如下： 首先建立垂直于拍攝圖像XY平面的XZ平面，)(Z平面穿過紅外攝像頭且與兩個被測節點 連線垂直，拍攝圖像平面為XY平面，紅外攝像頭在XY平面的投影位于拍攝圖像的中屯、〇(nx/ 2，ny/2)，nx為拍攝圖像的寬度，ny為拍攝圖像的高度，拍攝圖像的中屯、0距離兩個被測節點 連線的距離化為：被測節點相對攝像頭在XZ平面上的相對極坐標為化iszx，丫）。5. 根據權利要求4所述的無線傳感網絡高精度定位系統，其特征在于，所述紅外攝像頭 的方向信息是指紅外攝像頭與原點坐標系XOZ的X軸在XZ平面的夾角β。6. 根據權利要求5所述的無線傳感網絡高精度定位系統，其特征在于，所述步驟(3)包 括如下步驟： 被測節點在ΧΖ平面上與紅外攝像頭的夾角為丫； 被測節點相對錯節點的高度Dy，也就是被測節點距離ΧΖ平面的高度，即被測節點的實 際的Y向坐標為：所W可W得到被測節點相對錯節點X軸坐標： 被測節點相對紅外攝像頭在XZ平面上映射距離為Diszx，又已知紅外攝像頭與原點坐 標系的X軸在XZ平面夾角為β，因此被測節點相對紅外攝像頭在XZ平面上與原點坐標系的X 軸的夾角為β+γ ; 最后利用各錯節點的相對極坐標(r，S)計算得到被測節點相對于原點0的坐標，被測節 點的全局X向坐標為:r · cos(S)+Diszx · cos(0+ 丫）； 被測節點的全局z向坐標為:1· · sin(S)+Diszx · sin(0+丫）。
【文檔編號】H04W64/00GK105848284SQ201610286648
【公開日】2016年8月10日
【申請日】2016年5月3日
【發明人】付勇, 王春梅, 徐梅, 劉瑞霞, 陳長英, 孔祥龍, 朱亮, 王英龍
【申請人】山東省計算中心（國家超級計算濟南中心）