專利名稱:基于預(yù)測濾波器的位置測量方法
技術(shù)領(lǐng)域:
本發(fā)明一般涉及位置測量方法,更具體地,涉及使用預(yù)測濾波器的、移動節(jié)點的位置測量方法,該預(yù)測濾波器能夠提高移動節(jié)點的位置測量精確性。
背景技術(shù):
在用于計算移動節(jié)點的位置測量誤差的方法中,預(yù)測濾波器使用以往
(past)測量信息和環(huán)境信息來預(yù)測移動節(jié)點的位置。
為了補償移動節(jié)點的位置測量誤差,使用基于利用以往測量和環(huán)境信息的補償方法的預(yù)測濾波器,或利用先前(previously)記錄的位點特異性(site-specific ) 4言號才莫式的指纟丈(finger printing )方法。
預(yù)測濾波器允許利用以往位置和狀態(tài)信息來估計移動節(jié)點的當(dāng)前位置,以及通過采用取決于信息可靠性的權(quán)重來補償測量的位置與預(yù)測的位置之間的偏差??柭?Kalman)濾波器是熟知的預(yù)測濾波器之一。卡爾曼濾波器調(diào)整應(yīng)用到協(xié)方差矩陣的估計值和實際測量值的權(quán)重。
下面,簡要地說明基于卡爾曼濾波器的位置預(yù)測方法。首先,移動節(jié)點獲得至少三個錨點(anchornode)的坐標(biāo),并且周期性地測量與(from)錨點的距離,然后通過最小平方法(least square method)確定具有來自每個錨點的最小誤差的坐標(biāo)作為該移動節(jié)點的位置。將獲得的坐標(biāo)輸入到卡爾曼濾波器,以便將輸出作為補償?shù)淖鴺?biāo)。以下參照圖1、 2A和2B更詳細(xì)地說明該方法。
圖1是說明使用傳統(tǒng)最小平方法和卡爾曼濾波器的測量誤差補償?shù)姆抡娼Y(jié)果的圖形,而圖2A和2B是說明在室內(nèi)環(huán)境中移動節(jié)點的運動的示例的概念圖。
圖l中,X軸和Y軸代表以米(m)為單位的距離。測量周期(A"被設(shè)置為2秒,而移動節(jié)點以0.6m/s的速度運動。
實線110代表移動節(jié)點的運動路線,而標(biāo)記x 130代表使用最小平方法估計的位置值,粗實線150代表使用卡爾曼濾波器補償位置測量誤差的移動
節(jié)點的運動路線。
這里,假設(shè)卡爾曼濾波器(即,處理協(xié)方差矩陣)和測量協(xié)方差矩陣的權(quán)重是恒定。
RMSE (最小平方)是通過應(yīng)用最小平方法而獲得的均方根誤差(RootMean Squared Error, RMSE)。也就是說,RMSE指示通過最小平方法計算的坐標(biāo)與測量的坐標(biāo)之間的平均誤差量。RMSE (卡爾曼濾波器)是通過應(yīng)用卡爾曼濾波器而獲得的RMSE。也就是說,RMSE (卡爾曼濾波器)指示通過應(yīng)用最小平方法和接著應(yīng)用卡爾曼濾波器而獲得的坐標(biāo)與測量的坐標(biāo)之間的平均誤差的大小。
如圖1中所示,當(dāng)使用恒定協(xié)方差,并且移動節(jié)點的運動方向突然改變時,通過應(yīng)用卡爾曼濾波器而獲得的路徑與實際的運動路徑發(fā)生偏離。當(dāng)先前筆直沿著走廊運動的移動節(jié)點的運動方向在走廊的拐角處改變它的運動方向時(參看圖2A),或者當(dāng)移動節(jié)點進(jìn)入到位于走廊的一側(cè)的房間時(參看圖2B),會發(fā)生這種效果。
為了解決這個問題,已經(jīng)將研究集中在適應(yīng)于移動節(jié)點的情況來確定預(yù)測濾波器的權(quán)重的方法。結(jié)果,大部分傳統(tǒng)技術(shù)已經(jīng)被開發(fā)具有諸如加速度傳感器和/或初始傳感器(initiasensor)的補充設(shè)備,用于獲取調(diào)整預(yù)測濾波器的權(quán)重所需的信息。
然而,由于諸如加速度傳感器和初始傳感器的額外的物理元件增加了移動節(jié)點的制造成本和大小,傳統(tǒng)技術(shù)是不利的。另外,處理額外元件獲得的信息增加了系統(tǒng)的復(fù)雜性。
發(fā)明內(nèi)容
為了解決現(xiàn)有技術(shù)的上面的問題,本發(fā)明提供一種位置測量方法,該方法能夠使用預(yù)測濾波器提高位置測量的精確性。
本發(fā)明還提供一種位置測量方法,該方法能夠適應(yīng)性地調(diào)整卡爾曼濾波器的參數(shù),用于提高位置測量的精確性,特別是在室內(nèi)環(huán)境中。
本發(fā)明還提供一種位置測量方法,該方法能夠通過適應(yīng)性地使用卡爾曼濾波器來提高位置測量的精確性。
本發(fā)明還提供一種用于移動節(jié)點的位置測量方法,該方法能夠適應(yīng)于移
5動節(jié)點的運動而改變位置測量周期(&)和預(yù)測濾波器的權(quán)重。
此外,本發(fā)明提供一種用于移動節(jié)點的位置測量方法,該方法通過預(yù)測移動節(jié)點的運動的變化,并適應(yīng)性地校正在測量周期和誤差補償過程中使用的預(yù)測濾波器的權(quán)重,能夠提高位置測量的精確性。
依照本發(fā)明的實施例,移動節(jié)點的位置測量方法包括4企測移動節(jié)點運動方式(pattern)的變化;根據(jù)運動方式的變化來校正位置測量周期和預(yù)測濾波器的權(quán)重;以及使用位置測量周期和預(yù)測濾波器的校正后的權(quán)重來計算移動節(jié)點的位置。
依照本發(fā)明的另一個實施例,移動節(jié)點的位置測量方法包括當(dāng)4企測移動節(jié)點的運動方式的變化時,使用最小平方法估計移動節(jié)點的位置;將運動方式的距離和方位角與各自的閾值進(jìn)行比較;當(dāng)運動方式的距離大于閾值時,校正位置測量周期的權(quán)重,當(dāng)運動方式的方位角大于閾值時,校正預(yù)測濾波器的權(quán)重;以及通過應(yīng)用校正后的權(quán)重來計算移動節(jié)點的位置測量。
通過以下以結(jié)合附圖的詳細(xì)描述,本發(fā)明的上述的和其他的目的、特征和優(yōu)勢將更加清楚,其中
圖1是說明使用傳統(tǒng)的最小平方法和卡爾曼濾波器補償位置測量誤差的仿真結(jié)果的圖形;
圖2A和2B是說明在室內(nèi)環(huán)境中移動節(jié)點的運動的概念圖;圖3是說明在根據(jù)本發(fā)明實施例的位置測量方法中使用的位置測量周期(A,)和位置變化測量周期(& )的概念的示圖4和圖5是說明根據(jù)本發(fā)明實施例的位置測量及測量補償方法的流程
圖6是說明在根據(jù)本發(fā)明實施例的位置測量方法中位置測量的計算的示圖;以及
圖7是說明根據(jù)本發(fā)明實施例的位置測量方法的仿真結(jié)果的圖形。
具體實施例方式
參照附圖詳細(xì)地描述本發(fā)明的實施例。貫穿附圖,相同的參考數(shù)字用于指代相同或相似的部分。省略對結(jié)合于此的熟知的功能和結(jié)構(gòu)的詳細(xì)描述,以避免其使本發(fā)明的實質(zhì)內(nèi)容^t糊。
在說明書和權(quán)利要求書中所使用的詞和術(shù)語僅是為了說明的目的而不是限制。其中所描述的示例和構(gòu)造不覆蓋本發(fā)明的全部技術(shù)精神,而僅是本發(fā)明的最優(yōu)選實施例。因此,應(yīng)當(dāng)理解的是,可以對本發(fā)明的實施例做出各種等效替換和修改。
在下面的說明中,提供一種基于預(yù)測濾波器的位置測量方法,用于提高移動節(jié)點的位置測量的精準(zhǔn)性。在下面的實施例中,移動節(jié)點適應(yīng)性地調(diào)整預(yù)測濾波器的參數(shù)值,用于增加位置測量的精準(zhǔn)性,特別是在室內(nèi)環(huán)境中。也就是說,移動節(jié)點校正測量周期(Af )和預(yù)測濾波器的權(quán)重以適應(yīng)于移動節(jié)點的運動。
為此,根據(jù)實施例的移動節(jié)點辨識(recognize)運動方式的改變,并且校正測量周期(")和預(yù)測濾波器的權(quán)重以適應(yīng)于運動方式的改變,用于補償移動節(jié)點的位置測量。
在根據(jù)本發(fā)明實施例的位置測量方法中,移動節(jié)點在每個測量周期將位移信息轉(zhuǎn)換到柱面坐標(biāo),以便辨識運動的變化。
在根據(jù)本發(fā)明實施例的位置測量方法中,位置測量周期(A,)被調(diào)整以便補償由移動節(jié)點的運動而引發(fā)的誤差。
在根據(jù)本發(fā)明實施例的位置測量方法中,位置測量周期()被與移動節(jié)點的運動速度成比反例地調(diào)整。
在根據(jù)本發(fā)明實施例的位置測量方法中,預(yù)測濾波器的權(quán)重根據(jù)移動節(jié)點的運動的變化來調(diào)整。
在根據(jù)本發(fā)明實施例的位置測量方法中,移動節(jié)點計算其運動方向和速度的變化,以及當(dāng)計算的值大于閾值時,移動節(jié)點調(diào)整要在預(yù)測濾波器的估計值和測量值之間應(yīng)用的權(quán)重。
在根據(jù)本發(fā)明實施例的位置測量方法中,當(dāng)運動方向和速度的變化大于閾值時,移動節(jié)點增加要應(yīng)用到測量值的權(quán)重,因此,在測量位置的補償過程中,首先補償測量值。
盡管根據(jù)本發(fā)明的實施例,在位置測量方法中采用卡爾曼濾波器作為預(yù)測濾波器,但本發(fā)明不被限制于此。例如,本發(fā)明的位置測量方法能夠用多種的用于計算位置測量誤差的預(yù)測濾波器來實現(xiàn)。
卡爾曼濾波器被稱為最優(yōu)遞歸數(shù)據(jù)處理算法??柭鼮V波器通過遞歸數(shù)據(jù)處理追蹤最優(yōu)值并且是有效用于使用最小平方法,依照具有運動比噪聲的
方程(equations of motion to noise )的時間,實時追蹤基于時間的狀態(tài)向量的遞歸計算方法。其中,最小平方法是用于獲得估計量的方法,該估計量減少誤差的平方和,即,最小平方估計器??柭鼮V波器的使用描述如下。
首先,假設(shè);c(")和;K")滿足等式組(1 ):
jc(" + l)-F(" + l,")x(") + v,("), (Mxl矩P車) (1)= C(w)x(") + v2 (w), (M x 1殺巨P車)
(") ~ ,, Q (")), (M x 1矩陣)
v2 (") ~ ,,込(")), (M x 1矩陣)
在等式(l)中,忽略噪聲。由于們的線性關(guān)系,變量會隨著時間變化。另外,忽略變量和觀察的值之間預(yù)期的噪聲,其間存在線性關(guān)系。
在等式(l)中,x(")是Mxl矩陣,其包含預(yù)期為已知的、在特定時間n處的變量。如在第一個等式中所示的,忽略噪聲^("),通過矩陣F(/7 + l,"),相對于jc(" +1)線性地變化。限定與x(" +1)之間關(guān)系的F(w +1, 是M xM矩陣,其被稱為轉(zhuǎn)換矩陣。如第三個等式中所示,W")是噪聲或觀察誤差且遵循具有均值0 (M x 1零矩陣)以及協(xié)方差矩陣^(") ( M x M矩陣)的正態(tài)分布(normal distribution )。 y(")是包含用于獲取x(")而 見測的Y直的N x 1矩陣。
如在第二個等式中所示的,忽略噪聲v,(n),少(n)通過矩陣C(n)具有與;c(")的線性關(guān)系。限定;K")與x(n)之間關(guān)系的C(")是NxM矩陣,被稱為測量矩陣。h(")可以被當(dāng)作噪聲或觀察誤差并遵循具有均值0 (Nx 1零矩陣)和協(xié)方差矩陣^(") (NxN矩陣)的正態(tài)分布。
利用上述系統(tǒng)模型,依照如下使用卡爾曼濾波器來估計x("):
1 )初始化
x(l|Y(0))=>x(l)最佳期望值(Mx 1矩陣)K(l,O)=>用于最佳性能的恒定值(M x M矩陣)FCi^n+l^FCn+l,!!)-1 =>如果確定模型則預(yù)計算(M x M矩陣)2)實際執(zhí)行(n=l, 2,...)
G(") = F("+1, ")/C("," - l)C" (")「C(")A"(rt," - 1)CW (")+込(")",(M x N矩陣)= x") - C(") x (" I y(" -1)), (M x 1矩陣)<formula>formula see original document page 9</formula>
其中,y(")是一組觀察值<formula>formula see original document page 9</formula>是基于對Y(n-l)的觀 察結(jié)果所估計的;c(") , " +1)是F(" +1,")的擴展概念,即F(" +1,")的逆矩陣, 用于在忽略噪聲時從x(n + l)獲得x("),以及其他的參數(shù)是在中間計算過程中 所使用的變量。上標(biāo)H代表矩陣的共軛轉(zhuǎn)置(conjugate transpose),以及上 標(biāo)-1代表矩陣的逆矩陣。
以下,定義在本發(fā)明的實施例中所使用的參數(shù)。
根據(jù)本發(fā)明的實施例,位置測量周期(A,)是用于測量移動節(jié)點的位置 的間隔。在每一測量周期(Af),移動節(jié)點測量與至少三個錨點的距離并基 于所述距離計算其的位置。
另外,根據(jù)本發(fā)明的實施例,位置變化測量周期(&)用于測量移動節(jié) 點的運動變化。移動節(jié)點將以往變化測量周期的坐標(biāo)與當(dāng)前的變化測量周期 的坐標(biāo)進(jìn)行比較,即,位置變化測量周期()是確定用于比較以往坐標(biāo)與 當(dāng)前的坐標(biāo)的持續(xù)時間的參數(shù),并且是位置測量周期(A/ )的常數(shù)倍(constant multiple )。
位置變化測量周期(Ay )被設(shè)置為位置測量周期(A,)的常數(shù)倍,以便 保證至少有一組坐標(biāo)來自先前測量。
位置變化測量周期(A5 )是可變的。為了更精確地檢測移動節(jié)點的運動, 優(yōu)選地將位置變化測量周期(As )設(shè)置為大值。不然,為了更快地檢測移動 節(jié)點的運動,優(yōu)選地將位置變化測量周期(As )設(shè)置為小值。位置變化測量 周期太短時,難以確定角度的變化是由實際的運動引發(fā)的還是誤差。 因此,位置變化測量周期(A5 )應(yīng)當(dāng)被設(shè)置為針對最優(yōu)化系統(tǒng)性能而獲得的 值。
參照附圖,更詳細(xì)地描述根據(jù)本發(fā)明的實施例的位置測量方法。 圖3是說明在根據(jù)本發(fā)明的實施例的位置測量方法中使用的位置測量周 期(& )和位置變化測量周期()的概念的示圖。圖3中示出具有預(yù)定誤 差范圍的移動節(jié)點的最大誤差角是根據(jù)位置變化測量周期來確定的。 參考數(shù)字310代表移動節(jié)點的實際運動路徑,參考數(shù)字320代表位置變化測量周期(A5 )以及參考數(shù)字330代表位置測量周期(A/ )。參考數(shù)字341、 343、 345和347代表隨著移動節(jié)點沿路徑310運動時移動節(jié)點的測量位置, 而參考數(shù)字351、 353、 355和357代表到測量的位置341、 343、 345和347 的移動節(jié)點的補償?shù)奈恢谩?br>
如下描述用于計算測量的位置測量周期以及預(yù)測濾波器的權(quán)重的調(diào)整。 移動節(jié)點在每個位置測量周期(&)獲得來自至少三個錨點的測距結(jié)果 (ranging result),并使用最小平方估計來計算移動節(jié)點的位置辨識坐標(biāo)
(x,y)。位置辨識坐標(biāo)(JC,^)是測量的位置坐標(biāo)。
從至少三個錨點獲得測距結(jié)果的原因在于使用三角形算法來計算移動 節(jié)點的位置。三角形算法利用來自錨點的信號的接收時間(time-of-arrivals) 來計算移動節(jié)點與錨點之間的距離。將位置確定在用來自至少三個錨點的距 離作為它們的直徑而所畫的圓周相交叉的點上。為此,移動節(jié)點接收來自至 少三個錨點的測距結(jié)果。
接下來,移動節(jié)點將根據(jù)最小平方估計而獲得的位置辨識坐標(biāo)(x,;O與在 位置變化測量周期(As )之前所補償?shù)囊酝鴺?biāo)進(jìn)行比較,并將位移轉(zhuǎn)換到
^主面坐標(biāo)系(O",0,Z)的坐標(biāo)。
柱面坐標(biāo)系是三維的極坐標(biāo)系,其中P點是由三元組((j,(zU )來表示的, 除平面極坐標(biāo)系外,包括與平面的高度z (或h)。柱面坐標(biāo)系在分析關(guān)于軸 對稱的表面時是有效的。在柱面坐標(biāo)系的情況下,點可以由多個坐標(biāo)來表示。 因此,概括來講,參數(shù)的范圍限制如下
0S"2;r,以及 (3) r無約束
在參數(shù)的范圍中,如下將直角坐標(biāo)系的坐標(biāo)轉(zhuǎn)換為柱面坐標(biāo)系的坐標(biāo) cr = V "2 ,
^ = arctan上,and (4)
根據(jù)本發(fā)明的一個實施例,坐標(biāo)轉(zhuǎn)換等式(4)可以由要應(yīng)用于位置測 量方法的等式(5)來表示。從最小平方估計獲得的位置辨識坐標(biāo)(^c,7)可如 下轉(zhuǎn)換到柱面坐標(biāo)
=\fe -x",.)2-3V&)2 以及將在時間t測量的位置辨識坐標(biāo)(x,少)與在位置變化測量周期()之前 計算的以往位置測量進(jìn)行比較,位置辨識坐標(biāo)(i,;O將依照等式(5)轉(zhuǎn)換到 柱面坐標(biāo)。在柱面坐標(biāo)系中,C7,是移動節(jié)點的運動的距離,而0,是移動節(jié)點 的運動的方位角(角度)。
接著,移動節(jié)點將在位置變化測量周期(Ay )期間的運動的距離O",和方 位角A與各自的閾值進(jìn)行比較。
閾值被優(yōu)選地設(shè)置為大于位置測量的誤差范圍。因此,在位置測量誤差 范圍較窄的情況下,閾值被設(shè)置為更小的值,從而能更敏感地檢測移動節(jié)點 的運動方式。
作為測量值與閾值之間的比較結(jié)果,如果測量的距離大于閾值距離,則 移動節(jié)點減少位置測量周期(AO。另外,如果測量的方位角大于閾值方位 角,則移動節(jié)點在位置測量的計算中通過調(diào)整預(yù)測濾波器的權(quán)重來加權(quán)位置 辨識坐標(biāo)(^少)而不是估計的坐標(biāo)。
另外,如果移動節(jié)點的運動的測量的距離和方位角小于閾值,則移動節(jié) 點以傳統(tǒng)方式使用預(yù)測濾波器來3卜償測量。
以下,描述基于上述系統(tǒng)的位置測量方法。本發(fā)明不被限制于下面的描 述,而在其他實施例中能夠用等重等效替換和修改來實踐。
圖4和圖5是說明根據(jù)本發(fā)明實施例的位置測量及測量補償方法的流程圖。
參照圖4,根據(jù)本發(fā)明實施例的位置測量方法包括在步驟401中,檢 測移動節(jié)點的運動方式的變化;在步驟403中,根據(jù)移動節(jié)點的運動方式的 變化程度來校正位置測量周期(Af )和預(yù)測濾波器的權(quán)重;以及,在步驟 405中,基于校正后的位置測量周期(M )和預(yù)測濾波器的權(quán)重來計算移動 節(jié)點的位置。
位置測量周期(Af )是用于測量移動節(jié)點的位置的持續(xù)時間。參照圖5 更詳細(xì)地描述了圖4的步驟。
參照圖4和圖5,如果檢測到運動方式的變化,則在步驟501中移動節(jié) 點使用最小平方法估計它的位置。
為了辨識運動方式的變化,移動節(jié)點能夠在每一位置變化測量周期(& )將位移信息轉(zhuǎn)換到柱面坐標(biāo),該周期是可變的。移動節(jié)點的當(dāng)前位置(即, 位置辨識坐標(biāo)(XJ))是通過將最小平方法應(yīng)用到從至少三個錨點接收的測距 結(jié)果來估計的。這里,位置辨識坐標(biāo)(x,y)是移動節(jié)點的測量的坐標(biāo)。
接著,在步驟503,通過位置變化測量周期(Ay),移動節(jié)點將位置辨 識坐標(biāo)(;c,y)與移動節(jié)點的以往測量的坐標(biāo)進(jìn)行比較,并且,在步驟505,計 算當(dāng)前坐標(biāo)與以往坐標(biāo)之間的位移。然后,在步驟507,移動節(jié)點將該位移 轉(zhuǎn)換到柱面坐標(biāo)。柱面坐標(biāo)系是三維極坐標(biāo)系,除平面極坐標(biāo)系外,還包括 與平面的高度z (或h)。坐標(biāo)轉(zhuǎn)換能夠使用等式(3)至(5)來執(zhí)行。
接著,在步驟509,通過位置變化測量周期(A5),移動節(jié)點將其運動 的距離和方位角分別與閾值距離和閾值方位角進(jìn)行比較。
作為比較的結(jié)果,如果移動節(jié)點的運動的距離和方位角兩者都大于閾值 距離和閾值方位角,則移動節(jié)點在步驟511減少位置測量周期()并校正 預(yù)測濾波器的權(quán)重,并在步驟513基于更新的位置測量周期(M )和預(yù)測濾 波器的權(quán)重來補償移動節(jié)點的位置。另外,在步驟513中,如果移動節(jié)點的 運動的距離和方位角中的至少一個小于或等于閾值距離或閾值方位角,則移 動節(jié)點以正常的補償方式來補償不大于對應(yīng)閾值的目標(biāo)(距離和/或方位角), 而通過校正其權(quán)重來補償大于對應(yīng)閾值的目標(biāo)(距離/方位角)。
圖6是說明根據(jù)本發(fā)明的實施例的位置測量方法中位置測量的計算的示圖。
參照圖6,參考數(shù)字610、 620、 630和640代表通過位置變化測量周期 (As )補償?shù)南惹拔恢?卜4A^,卜3As,卜2Ay和,-As),以及參考數(shù)字650 代表在時間t測量的位置,即,移動節(jié)點的當(dāng)前測量的位置。參考數(shù)字660 代表位置610、 620、 630和640相較于在位置變化測量周期(As )之前的位 置的位移,以及參考數(shù)字670代表當(dāng)移動節(jié)點的運動方式突然變化時的位移。 所示出的由節(jié)點的行進(jìn)方向的變化所引發(fā)的方位角是較大的。
在圖7中示出針對這樣的示例情況執(zhí)行的仿真結(jié)果。
圖7是說明根據(jù)本發(fā)明的實施例的位置測量方法的仿真結(jié)果的圖形。具 體地說,圖7示出了使用最小平方估計和卡爾曼濾波器的位置測量仿真結(jié)果, 其中增加了在移動節(jié)點的運動變化較大的位置處所測量的值的權(quán)重(圖6的 670)。
如圖7中所示,與圖1中的傳統(tǒng)方法的仿真結(jié)果相比較,根據(jù)本發(fā)明的
12實施例的使用位置測量方法所追蹤的路徑近似幾乎與移動節(jié)點的實際路徑 相同,從而提高了位置測量的精確性。
位置700處的測量值已經(jīng)通過采用校正后的協(xié)方差矩陣被計算,該矩陣 擔(dān)當(dāng)卡爾曼濾波器的權(quán)重,且相比于圖1的傳統(tǒng)方法,已經(jīng)減少了 70%的 RMSE (卡爾曼濾波器)。
模擬使用Matlap來執(zhí)行。Matlap是提供數(shù)字分析和編程環(huán)境的工程軟 件,并且允許簡單的矩陣運算、繪制函數(shù)及數(shù)據(jù)、執(zhí)行算法、創(chuàng)建用戶接口 以及與其它語言的程序進(jìn)行接口連接。
盡管在上面詳細(xì)地描述了本發(fā)明的實施例,但應(yīng)當(dāng)清楚地知道,本領(lǐng)域 技術(shù)人員所想到的、對這里所教導(dǎo)的基本發(fā)明構(gòu)思的很多變化或修改仍在由 所附權(quán)利要求書限定的本發(fā)明的精神和范圍之內(nèi)。
如上所述,使用根據(jù)本發(fā)明的預(yù)測濾波器的位置測量方法適應(yīng)于移動節(jié) 點的運動變化來調(diào)整在預(yù)測濾波器中所使用的權(quán)重和位置測量周期(), 因此提高了位置測量的精確性。
此外,本發(fā)明的位置測量方法使得預(yù)測濾波器的誤差補償性能相比于傳 統(tǒng)誤差補償方法提高了大約70%。另外,本發(fā)明的位置測量方法改進(jìn)了移動 節(jié)點的誤差補償性能,而沒有在系統(tǒng)實施復(fù)雜性上妥協(xié),因為位置測量方法 可以在不增加任何額外設(shè)備的情況下執(zhí)行。
權(quán)利要求
1、一種移動節(jié)點的位置測量方法,包括檢測所述移動節(jié)點的運動方式的變化;依照所述運動方式的變化來校正位置測量周期及預(yù)測濾波器的權(quán)重;使用由校正后的權(quán)重更新的值來計算所述移動節(jié)點的當(dāng)前位置。
2、 如權(quán)利要求1所述的位置測量方法,其中,檢測所述移動節(jié)點的運動方式的變化包括在位置變化測量周期期間將位移信息轉(zhuǎn)換到柱面坐標(biāo),并且,其中,所述位置變化測量周期是可變的。
3、 如權(quán)利要求1所述的位置測量方法,其中,所述權(quán)重包括至少一個參數(shù),該參數(shù)應(yīng)用于位置測量周期和預(yù)測濾波器,用于計算由移動節(jié)點的運動方式的變化而引發(fā)的位置測量誤差。
4、 如權(quán)利要求3所述的位置測量方法,其中,所述位置測量周期與所述移動節(jié)點的運動速度成反比例。
5、 如權(quán)利要求1所述的位置測量方法,其中,校正所述位置測量周期和所述預(yù)測濾波器的權(quán)重包括在每一位置測量周期,計算所述移動節(jié)點的運動方向和距離的位移;將計算的位移與預(yù)定的閾值進(jìn)行比較;以及當(dāng)所述位移大于預(yù)定的閾值中的各自的閾值時,調(diào)整要應(yīng)用于所述預(yù)測濾波器的估計值的權(quán)重。
6、 如權(quán)利要求5所述的位置測量方法,其中,校正所述位置測量周期和所述預(yù)測濾波器的權(quán)重包括當(dāng)所述位移小于或等于所述各自的閾值時,通過應(yīng)用調(diào)整后的權(quán)重來計算位置測量誤差。
7、 一種移動節(jié)點的位置測量方法,包括當(dāng)檢測所述移動節(jié)點的運動方式的變化時,使用最小平方法估計所述移動節(jié)點的位置;將所述運動方式的距離和方位角與各自的閾值進(jìn)行比較;當(dāng)所述運動方式的距離大于所述閾值時,校正位置測量周期的權(quán)重;當(dāng)所述運動方式的方位角大于所述閾值時,校正預(yù)測濾波器的權(quán)重;以及通過應(yīng)用校正后的權(quán)重來計算所述移動節(jié)點的位置測量。
8、 如權(quán)利要求7所述的位置測量方法,其中,估計所述位置包括依照位置變化測量周期將位移信息轉(zhuǎn)換到柱面坐標(biāo),以侵_;險測所述移動節(jié)點的運動方式的變4匕,以及,其中所述位置變化測量周期是可變的。
9、 如權(quán)利要求7所述的位置測量方法,其中,將所述位移信息轉(zhuǎn)換到柱面坐標(biāo)包4舌計算估計位置與在所述位置變化測量周期之前的先前位置之間的位移;將所述位移轉(zhuǎn)換到柱面坐標(biāo);以及從所述柱面坐標(biāo)獲得所述運動方式的距離和方位角。
10、 如權(quán)利要求7所述的位置測量方法,其中,計算所述位置測量包括當(dāng)所述運動方式的距離和方位角中的至少一個小于或等于所述各自的閾值時,使用所述預(yù)測濾波器計算所述距離和方位角中的至少一個;以及當(dāng)所述運動方式的距離和方位角中的至少一個大于所述各自的閾值時,校正所述距離和方位角中的至少一個的權(quán)重。
11、 如權(quán)利要求9所述的位置測量方法,其中,所述距離和方位角是通過計算在時間(t)處測量的位置辨識坐標(biāo)(xj)與在位置變化測量周期(& )之前測量并補償?shù)淖鴺?biāo)之間的位移、以及使用以下公式將所述位移轉(zhuǎn)換到柱面坐標(biāo)而獲得的<formula>formula see original document page 3</formula>和<formula>formula see original document page 3</formula>其中,^是所述移動節(jié)點的運動的距離,而-,是所述移動節(jié)點的運動的方位角(角度)。
12、 如權(quán)利要求11所述的位置測量方法,其中,位置辨識坐標(biāo)(;,少)是當(dāng)前測量的移動節(jié)點的坐標(biāo),而所述位置變化測量周期()是用于測量移動節(jié)點的運動的變化的單位持續(xù)時間。
13、 如權(quán)利要求7所述的位置測量方法,其中,所述閾值對應(yīng)于所述移動節(jié)點的測量誤差范圍。
14、 如權(quán)利要求7所述的位置測量方法,其中,所述預(yù)測濾波器是卡爾曼濾波器。
全文摘要
本發(fā)明提供一種使用預(yù)測濾波器的、移動節(jié)點的位置測量方法,用于提高移動節(jié)點的位置測量的精確性。移動節(jié)點的位置測量方法檢測所述移動節(jié)點的運動方式的變化,基于所述運動方式的變化來校正位置測量周期及預(yù)測濾波器的權(quán)重,以及使用所述位置測量周期及預(yù)測濾波器的校正后的權(quán)重來補償所述移動節(jié)點的位置。
文檔編號G01S5/02GK101526602SQ20091011856
公開日2009年9月9日 申請日期2009年3月4日 優(yōu)先權(quán)日2008年3月4日
發(fā)明者吳潤濟, 崔成昌, 徐明煥, 池明仁, 白鎮(zhèn)碩, 金俊佑, 馬重秀 申請人:三星電子株式會社;韓國情報通信大學(xué)校產(chǎn)學(xué)協(xié)力團