1.一種視距與非視距混合環(huán)境中基于到達時間差的穩(wěn)健定位方法,其特征在于包括以下步驟:
①為處于視距與非視距混合環(huán)境中的無線網(wǎng)絡建立一個平面坐標系或一個空間坐標系作為參考坐標系,該無線網(wǎng)絡中存在一個未知的目標源和N+1個傳感器,任選一個傳感器作為參考傳感器,其余傳感器作為非參考傳感器,將目標源在參考坐標系中的坐標位置記為x,將參考傳感器在參考坐標系中的坐標位置記為s0,將N個非參考傳感器在參考坐標系中的坐標位置依次對應記為s1,s2,…,sN;將測量信號從目標源發(fā)出到參考傳感器接收所經(jīng)過的路徑定義為參考路徑,參考路徑的路徑狀態(tài)已知,將測量信號在參考路徑上傳輸所經(jīng)歷的時間記為t0;將測量信號從目標源發(fā)出到每個非參考傳感器接收所經(jīng)過的路徑定義為普通路徑,測量信號從目標源發(fā)出到第i個非參考傳感器接收所經(jīng)過的路徑為第i條普通路徑,每條普通路徑的路徑狀態(tài)已知,將測量信號在第i條普通路徑上傳輸所經(jīng)歷的時間記為ti;然后計算測量信號在每條普通路徑上傳輸與測量信號在參考路徑上傳輸?shù)木嚯x差,將測量信號在第i條普通路徑上傳輸與測量信號在參考路徑上傳輸?shù)木嚯x差記為di,di=c(ti-t0);再構(gòu)建一個初始值為空集的視距集合Φl和一個初始值為空集的非視距集合Φn,在到達時間差的測量中,找出測量信號所經(jīng)過的參考路徑與普通路徑都為視距路徑情況下的所有普通路徑,將這些普通路徑各自所對應的非參考傳感器的序號歸屬于視距集合Φl,而非視距集合Φn={1,2,…,N}-Φl;其中,N≥3,s1表示第1個非參考傳感器在參考坐標系中的坐標位置,s2表示第2個非參考傳感器在參考坐標系中的坐標位置,sN表示第N個非參考傳感器在參考坐標系中的坐標位置,1≤i≤N,c為光速;
②建立測量信號在普通路徑上傳輸與測量信號在參考路徑上傳輸?shù)木嚯x差在非視距環(huán)境下的測量模型,表示為:di=ri-r0+ni+ei,i∈Φn,其中,ri=||x-si||,r0=||x-s0||,符號“|| ||”為歐幾里德范數(shù)符號,si表示第i個非參考傳感器在參考坐標系中的坐標位置,ni表示第i條普通路徑上的測量噪聲與參考路徑上的測量噪聲的差值,ei表示第i條普通路徑上的非視距誤差與參考路徑上的非視距誤差的差值,|ni|<<ei,符號“| |”為取絕對值符號;然后對di=ri-r0+ni+ei,i∈Φn進行形式轉(zhuǎn)變,得到
其中,(s0-si)T為s0-si的轉(zhuǎn)置;
并建立測量信號在普通路徑上傳輸與測量信號在參考路徑上傳輸?shù)木嚯x差在視距環(huán)境下的測量模型,表示為:di=ri-r0+ni,i∈Φl;然后對di=ri-r0+ni,i∈Φl進行形式轉(zhuǎn)變,得到其中,(si-s0)T為si-s0的轉(zhuǎn)置;
③根據(jù)和采用最壞情況下的魯棒最小二乘方法,將視距與非視距混合環(huán)境中的定位問題描述為:
其中,min{}為取最小值函數(shù),max()為取最大值函數(shù),y=[xT,r0,r1,…,rN]T,符號“[]”為矢量表示符號,xT為x的轉(zhuǎn)置,[xT,r0,r1,…,rN]T為[xT,r0,r1,…,rN]的轉(zhuǎn)置,r1=||x-s1||,rN=||x-sN||,“s.t.”表示“受約束于”,fl,i(x,r0)和fn,i(x,ri,ei)均為中間變量,
然后通過簡單變換將
s.t. ||x-si||=ri,i=1,…,N
||x-s0||=r0
轉(zhuǎn)變?yōu)?img id="icf0009" file="FDA0001146637250000032.GIF" wi="700" he="280" img-content="drawing" img-format="GIF" orientation="portrait" inline="no" />其中,符號“| |”為取絕對值符號;
接著根據(jù)三角不等式,確定,其中,ρi表示ei的上限,0≤ei≤ρi,h(ei)為中間變量,
之后將轉(zhuǎn)變?yōu)?img id="icf0013" file="FDA0001146637250000036.GIF" wi="700" he="64" img-content="drawing" img-format="GIF" orientation="portrait" inline="no" />
再將和與結(jié)合,
得到其中,gn,i(x,ri)為中間變量;
④根據(jù)中與的不平衡性,在中添加權(quán)值
得到加權(quán)最小二乘問題,描述為:
⑤在已知路徑狀態(tài)的情況下,根據(jù)得到非凸的定位問題,描述為:
其中,w0表示參考路徑上的非視距誤差的值,wi表示第i條普通路徑上的非視距誤差的值;
⑥在非凸的定位問題中引入輔助變量γ,τ1,τ2,…,τi,…,τN,η1,η2,…,ηi,…,ηN,得到等價的引入輔助變量后非凸的定位問題,描述為:
||x-si||=ri,i=1,…,N
||x-s0||=r0
||x||2=γ
其中,為si的轉(zhuǎn)置,為s0的轉(zhuǎn)置;
⑦采用二階錐松弛將引入輔助變量后非凸的定位問題中的||x-si||=ri松弛為||x-si||≤ri、||x-s0||=r0松弛為||x-s0||≤r0、松弛為松弛為||x||2=γ松弛為||x||2≤γ,同時為了滿足凸問題的要求,將gn,i(x,ri)展開為
得到二階錐規(guī)劃問題,描述為:
||x-si||≤ri,i=1,…,N
||x-s0||≤r0
且w0=0
且wi=0
⑧利用內(nèi)點法對二階錐規(guī)劃問題進行求解,得到y(tǒng)的全局最優(yōu)解,記為y*;然后將y*代入y=[xT,r0,r1,…,rN]T中,得到x的最優(yōu)解,記為x*,x*為目標源在參考坐標系中的坐標位置的最終定位值。
2.根據(jù)權(quán)利要求1所述的視距與非視距混合環(huán)境中基于到達時間差的穩(wěn)健定位方法,其特征在于所述的步驟④中θ的獲取過程為:
④_1、引入中間變量pi,j,其中,符號為定義符號,dj=rj-r0+nj,rj=||x-sj||,nj表示第j條普通路徑上的測量噪聲與參考路徑上的測量噪聲的差值,nj服從均值為0且方差為的高斯分布,sj表示第j個非參考傳感器在參考坐標系中的坐標位置;
④_2、根據(jù)di=ri-r0+ni+ei,i∈Φn,且|ni|是一個非常小的值,認為di-ri≈-r0+ei,i∈Φn;
④_3、根據(jù)和di-ri≈-r0+ei,i∈Φn,得到
④_4、根據(jù)及pi,j在ei=-ρi時取得最大值,獲得pi,j的上界,
④_5、根據(jù)及0<r0≤α0和|nj|≤3σj,獲得pi,j的上確界,記為其中,α0表示目標源到參考傳感器可取到的最大距離;
④_6、令然后根據(jù)和最終得到
3.根據(jù)權(quán)利要求1或2所述的視距與非視距混合環(huán)境中基于到達時間差的穩(wěn)健定位方法,其特征在于所述的步驟⑤中且w0=0的確定過程為:根據(jù)一般情況下測量噪聲遠小于非視距誤差的結(jié)論,若第i條普通路徑是非視距路徑即wi>0且參考路徑是視距路徑即w0=0,那么ei=wi-w0=wi>>|ni|;然后根據(jù)ei=wi-w0=wi>>|ni|和di=ri-r0+ni+ei,i∈Φn,得到di+r0≥ri;接著對di+r0≥ri的兩側(cè)同時平方并展開,并結(jié)合ri=||x-si||和r0=||x-s0||,得到約束條件再進一步將描述為且w0=0;
所述的步驟⑤中且wi=0的確定過程為:根據(jù)一般情況下測量噪聲遠小于非視距誤差的結(jié)論,若第i條普通路徑是視距路徑即wi=0且參考路徑是非視距路徑即w0>0,那么ei=wi-w0=-w0<<-|ni|;然后根據(jù)ei=wi-w0=-w0<<-|ni|和di=ri-r0+ni+ei,i∈Φn,得到ri-di≥r0;接著對ri-di≥r0的兩側(cè)同時平方并展開,并結(jié)合ri=||x-si||和r0=||x-s0||,得到約束條件再進一步將描述為且wi=0。