发明名称 一种减小偏差的加权最小二乘定位方法
摘要 本发明公开了一种减小偏差的加权最小二乘定位方法,特点是根据布置好的每个接收机的位置、测量噪声功率以及信号从目标源到参考接收机和其它接收机的到达时间差,构造一个加权最小二乘关系式,然后构造拉格朗日函数,并利用二分法得到最优拉格朗日乘子,利用最优拉格朗日乘子得到目标源位置的有偏估计值,再计算偏差,并将得到有偏估计值减去偏差得到最终的无偏估计值,优点在于能够有效降低目标源位置的最终估计值的偏差,并能在大噪声环境下降低均方根误差,定位精度高且非常稳健。
申请公布号 CN104820204A 申请公布日期 2015.08.05
申请号 CN201510172071.4 申请日期 2015.04.13
申请人 宁波大学 发明人 王刚;高尚超;张圣金;金明;李有明
分类号 G01S5/06(2006.01)I 主分类号 G01S5/06(2006.01)I
代理机构 宁波奥圣专利代理事务所(普通合伙) 33226 代理人 程晓明
主权项 一种减小偏差的加权最小二乘定位方法,其特征在于包括以下步骤:(1)对于在无线网络环境中的一个待定位的目标源,首先在无线网络环境中建立一个n维坐标系作为参考坐标系,其中n=2或3,并在该无线网络中设置N+1个接收机,N≥n+1,选择任意一个接收机作为参考接收机并将其在参考坐标系的坐标记为s<sub>0</sub>,将其它接收机在参考坐标系的坐标记为s<sub>i</sub>,i=1,...,N,将目标源在参考坐标系的坐标记为x<sup>o</sup>,将目标源发出的测量信号到达第i个接收机和到达参考接收机所经历的时间差记为t<sub>i</sub>,进而得到信号传输的距离差d<sub>i</sub>=ct<sub>i</sub>,其中c为光速;(2)定义系数矩阵A、向量b以及噪声协方差矩阵Q如下:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mi>A</mi><mo>=</mo><mo>-</mo><mn>2</mn></mrow><mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mrow><mo>(</mo><msub><mi>s</mi><mn>1</mn></msub><mo>-</mo><msub><mi>s</mi><mn>0</mn></msub><mo>)</mo></mrow><mi>T</mi></msup></mtd><mtd><msub><mi>d</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><msup><mrow><mo>(</mo><msub><mi>s</mi><mi>N</mi></msub><mo>-</mo><msub><mi>s</mi><mn>0</mn></msub><mo>)</mo></mrow><mi>T</mi></msup></mtd><mtd><msub><mi>d</mi><mi>N</mi></msub></mtd></mtr></mtable></mfenced><mo>,</mo><mi>b</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msubsup><mi>d</mi><mn>1</mn><mn>2</mn></msubsup><mo>-</mo><msup><mrow><mo>|</mo><mo>|</mo><msub><mi>s</mi><mn>1</mn></msub><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>|</mo><mo>|</mo><msub><mi>s</mi><mn>0</mn></msub><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msup></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><msubsup><mi>d</mi><mi>N</mi><mn>2</mn></msubsup><mo>-</mo><msup><mrow><mo>|</mo><mo>|</mo><msub><mi>s</mi><mi>N</mi></msub><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>|</mo><mo>|</mo><msub><mi>s</mi><mn>0</mn></msub><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msup></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000697919890000011.GIF" wi="1081" he="264" /></maths><img file="FDA0000697919890000012.GIF" wi="556" he="282" />其中σ<sup>2</sup>为测量环境噪声功率,“T”为矩阵转置,“||·||”是欧几里德范数,然后根据下式计算对目标源位置的初始估计:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msup><mrow><mo>[</mo><msubsup><mover><mi>x</mi><mo>^</mo></mover><mn>0</mn><mi>T</mi></msubsup><mo>,</mo><msub><mover><mi>r</mi><mo>^</mo></mover><mn>0</mn></msub><mo>]</mo></mrow><mi>T</mi></msup><mo>=</mo><msup><mrow><mo>(</mo><msup><mi>A</mi><mi>T</mi></msup><msup><mi>Q</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><mi>A</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><msup><mi>A</mi><mi>T</mi></msup><msup><mi>Q</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><mi>b</mi><mo>,</mo></mrow>]]></math><img file="FDA0000697919890000013.GIF" wi="641" he="85" /></maths>其中<img file="FDA0000697919890000014.GIF" wi="64" he="77" />为目标源位置的初始估计,<img file="FDA0000697919890000015.GIF" wi="40" he="77" />为目标源到参考接收机距离的初始估计;(3)根据步骤(1)中定义的接收机的坐标s<sub>i</sub>以及信号传输的距离差d<sub>i</sub>,采用非线性加权最小二乘方法估计目标源的位置,表示为以下非线性加权最小二乘关系式:<maths num="0003" id="cmaths0003"><math><![CDATA[<mfenced open='' close=''><mtable><mtr><mtd><munder><mi>min</mi><mrow><mi>y</mi><mo>=</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mi>x</mi><mi>T</mi></msup></mtd><mtd><mi>r</mi></mtd></mtr></mtable></mfenced><mi>T</mi></msup></mrow></munder></mtd><mtd><msup><mrow><mo>(</mo><mi>Ay</mi><mo>-</mo><mi>b</mi><mo>)</mo></mrow><mi>T</mi></msup><mover><mi>W</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>Ay</mi><mo>-</mo><mi>b</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000697919890000016.GIF" wi="554" he="108" /></maths>s.t.  r=||x‑s<sub>0</sub>||其中y=[x<sup>T</sup> r]<sup>T</sup>为优化变量,x表示目标源位置变量,r表示目标源到参考接收机的距离变量,<img file="FDA0000697919890000017.GIF" wi="270" he="85" />为权矩阵,矩阵B定义为<img file="FDA0000697919890000018.GIF" wi="693" he="234" />“s.t.”表示“受约束为”,“min”表示“使最小化”;(4)定义矩阵<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mi>D</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>I</mi><mi>n</mi></msub></mtd><mtd><msub><mn>0</mn><mrow><mi>n</mi><mo>&times;</mo><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><msubsup><mn>0</mn><mrow><mi>n</mi><mo>&times;</mo><mn>1</mn></mrow><mi>T</mi></msubsup></mtd><mtd><mo>-</mo><mn>1</mn></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000697919890000021.GIF" wi="338" he="158" /></maths>及向量<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mi>f</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mo>-</mo><msub><mi>s</mi><mn>0</mn></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000697919890000022.GIF" wi="225" he="156" /></maths>其中“I<sub>n</sub>”为n×n单位矩阵,“0<sub>n×1</sub>”为n×1零向量,将步骤(3)中的非线性加权最小二乘关系式等价写为如下关系式:<maths num="0006" id="cmaths0006"><math><![CDATA[<mfenced open='' close=''><mtable><mtr><mtd><munder><mi>min</mi><mi>y</mi></munder></mtd><mtd><msup><mrow><mo>(</mo><mi>Ay</mi><mo>-</mo><mi>b</mi><mo>)</mo></mrow><mi>T</mi></msup><mover><mi>W</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>Ay</mi><mo>-</mo><mi>b</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000697919890000023.GIF" wi="525" he="105" /></maths>s.t.  y<sup>T</sup>Dy+2f<sup>T</sup>y+||s<sub>0</sub>||<sup>2</sup>=0.然后,构造上述关系式的拉格朗日函数<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><mi>L</mi><mrow><mo>(</mo><mi>&lambda;</mi><mo>)</mo></mrow><mo>=</mo><msup><mrow><mo>(</mo><mi>Ay</mi><mo>-</mo><mi>b</mi><mo>)</mo></mrow><mi>T</mi></msup><mover><mi>W</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>Ay</mi><mo>-</mo><mi>b</mi><mo>)</mo></mrow><mo>+</mo><mi>&lambda;</mi><mrow><mo>(</mo><msup><mi>y</mi><mi>T</mi></msup><mi>Dy</mi><mo>+</mo><msup><mrow><mn>2</mn><mi>f</mi></mrow><mi>T</mi></msup><mi>y</mi><mo>+</mo><msup><mrow><mo>|</mo><mo>|</mo><msub><mi>s</mi><mn>0</mn></msub><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msup><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0000697919890000024.GIF" wi="1078" he="93" /></maths>其中λ为拉格朗日乘子,最后,利用二分法得到最优拉格朗日乘子,记为λ<sup>*</sup>;(5)将步骤(4)得到的最优拉格朗日乘子λ<sup>*</sup>代入关系式<img file="FDA0000697919890000025.GIF" wi="612" he="83" />中,得到<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><mover><mi>y</mi><mo>^</mo></mover><mo>=</mo><msup><mrow><mo>(</mo><msup><mi>A</mi><mi>T</mi></msup><mover><mi>W</mi><mo>^</mo></mover><mi>A</mi><mo>+</mo><msup><mi>&lambda;</mi><mo>*</mo></msup><mi>D</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mrow><mo>(</mo><msup><mi>A</mi><mi>T</mi></msup><mover><mi>W</mi><mo>^</mo></mover><mi>b</mi><mo>-</mo><msup><mi>&lambda;</mi><mo>*</mo></msup><mi>f</mi><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0000697919890000026.GIF" wi="748" he="84" /></maths>其中<img file="FDA0000697919890000027.GIF" wi="44" he="69" />为加权最小二乘关系式的全局最优解,将<img file="FDA0000697919890000028.GIF" wi="118" he="70" />代入公式y=[x<sup>T</sup> r]<sup>T</sup>,得到<img file="FDA0000697919890000029.GIF" wi="251" he="75" />其中<img file="FDA00006979198900000210.GIF" wi="38" he="62" />即为目标源在参考坐标系中坐标的有偏估计值;(6)定义矩阵F为<maths num="0009" id="cmaths0009"><math><![CDATA[<mrow><mi>F</mi><mo>=</mo><mo>-</mo><mn>2</mn><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>d</mi><mn>1</mn></msub><msup><mi>&rho;</mi><mi>T</mi></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>s</mi><mn>1</mn></msub><mo>-</mo><msub><mi>s</mi><mn>0</mn></msub><mo>)</mo></mrow><mi>T</mi></msup></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><msub><mi>d</mi><mi>i</mi></msub><msup><mi>&rho;</mi><mi>T</mi></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>s</mi><mi>i</mi></msub><mo>-</mo><msub><mi>s</mi><mn>0</mn></msub><mo>)</mo></mrow><mi>T</mi></msup></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><msub><mi>d</mi><mi>N</mi></msub><msup><mi>&rho;</mi><mi>T</mi></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>s</mi><mi>N</mi></msub><mo>-</mo><msub><mi>s</mi><mn>0</mn></msub><mo>)</mo></mrow><mi>T</mi></msup></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA00006979198900000211.GIF" wi="572" he="381" /></maths>其中<img file="FDA00006979198900000212.GIF" wi="286" he="150" />为n×1维列向量,再定义矩阵V和U为<img file="FDA00006979198900000213.GIF" wi="479" he="83" /><maths num="0010" id="cmaths0010"><math><![CDATA[<mrow><mi>U</mi><mo>=</mo><mover><mi>W</mi><mo>^</mo></mover><mi>B</mi><mo>-</mo><mover><mi>W</mi><mo>^</mo></mover><mi>F</mi><msup><mrow><mo>(</mo><msup><mi>F</mi><mi>T</mi></msup><mover><mi>W</mi><mo>^</mo></mover><mi>F</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><msup><mi>F</mi><mi>T</mi></msup><mover><mi>W</mi><mo>^</mo></mover><mi>B</mi><mo>,</mo></mrow>]]></math><img file="FDA00006979198900000214.GIF" wi="673" he="85" /></maths>定义向量g,h为<maths num="0011" id="cmaths0011"><math><![CDATA[<mrow><mi>g</mi><mo>=</mo><mo>-</mo><mn>2</mn><mfenced open='[' close=']'><mtable><mtr><mtd><msubsup><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></msubsup><msup><mi>&rho;</mi><mi>T</mi></msup><msub><mi>v</mi><mi>i</mi></msub><msub><mi>Q</mi><mrow><mn>1</mn><mo>,</mo><mi>i</mi></mrow></msub></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><msubsup><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></msubsup><msup><mi>&rho;</mi><mi>T</mi></msup><msub><mi>v</mi><mi>i</mi></msub><msub><mi>Q</mi><mrow><mi>j</mi><mo>,</mo><mi>i</mi></mrow></msub></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><msubsup><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></msubsup><msup><mi>&rho;</mi><mi>T</mi></msup><msub><mi>v</mi><mi>i</mi></msub><msub><mi>Q</mi><mrow><mi>N</mi><mo>,</mo><mi>i</mi></mrow></msub></mtd></mtr></mtable></mfenced><mo>,</mo><mi>h</mi><mo>=</mo><mo>-</mo><mn>2</mn><mfenced open='[' close=']'><mtable><mtr><mtd><msubsup><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></msubsup><msup><msub><mi>&rho;</mi><mn>1</mn></msub><mi>T</mi></msup><msubsup><mi>u</mi><mi>i</mi><mi>T</mi></msubsup><msub><mi>q</mi><mi>i</mi></msub></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><msubsup><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></msubsup><msup><msub><mi>&rho;</mi><mi>k</mi></msub><mi>T</mi></msup><msubsup><mi>u</mi><mi>i</mi><mi>T</mi></msubsup><msub><mi>q</mi><mi>i</mi></msub></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><msubsup><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></msubsup><msup><msub><mi>&rho;</mi><mi>n</mi></msub><mi>T</mi></msup><msubsup><mi>u</mi><mi>i</mi><mi>T</mi></msubsup><msub><mi>q</mi><mi>i</mi></msub></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA00006979198900000215.GIF" wi="1021" he="463" /></maths>其中ρ<sub>k</sub>为ρ的第k个元素,k=1,…n,v<sub>i</sub>,u<sub>i</sub>,q<sub>i</sub>分别是V、U以及Q的第i列向量,而Q<sub>j,i</sub>是Q的第j行,第i列元素,j=1,…,N,定义偏差<maths num="0012" id="cmaths0012"><math><![CDATA[<mrow><mi>E</mi><mo>[</mo><mi>&Delta;x</mi><mo>]</mo><mo>=</mo><msup><mrow><mo>(</mo><msup><mi>F</mi><mi>T</mi></msup><mover><mi>W</mi><mo>^</mo></mover><mi>F</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><msup><mi>F</mi><mi>T</mi></msup><mover><mi>W</mi><mo>^</mo></mover><mover><mi>q</mi><mo>&OverBar;</mo></mover><mo>-</mo><msup><mrow><mo>(</mo><msup><mi>F</mi><mi>T</mi></msup><mover><mi>W</mi><mo>^</mo></mover><mi>F</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><msup><mi>F</mi><mi>T</mi></msup><mover><mi>W</mi><mo>^</mo></mover><mi>g</mi><mo>+</mo><msup><mrow><mo>(</mo><msup><mi>F</mi><mi>T</mi></msup><mover><mi>W</mi><mo>^</mo></mover><mi>F</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mi>h</mi><mo>,</mo></mrow>]]></math><img file="FDA0000697919890000031.GIF" wi="1181" he="84" /></maths>得到目标源在参考坐标系中坐标的最终无偏估计值为<img file="FDA0000697919890000032.GIF" wi="324" he="66" />这里,<img file="FDA0000697919890000033.GIF" wi="44" he="66" />是由Q的对角线元素组成的列向量。
地址 315211 浙江省宁波市江北区风华路818号