一种基于混合方式的非合作目标定位方法与流程

文档序号:13764085阅读:来源:国知局
一种基于混合方式的非合作目标定位方法与流程

技术特征:

1.一种基于混合方式的非合作目标定位方法,其特征在于:包括以下步骤,

步骤1,利用预先布置的若干无线节点组成能够互相通信的测量网络,测量不同无线节点间信号强度的变化量,即链路中RSSI变化量;

步骤2,根据目标移动的最大速度,计算出当前目标存在的有效区域;

步骤3,根据链路中RSSI变化量和当前目标存在的有效区域,选取通过有效区域的有效链路;

步骤4,利用有效链路的几何关系进行粗定位;

步骤5,利用无线节点坐标对粗定位结果进行修正,得到精确定位结果。

2.根据权利要求1所述的一种基于混合方式的非合作目标定位方法,其特征在于:步骤1中,链路中RSSI变化量的计算公式为,

Δyi(t)=yi(t)-yi(0)≈-Si(t)-vi(t)+vi(0) (1)

其中,yi(0)为没有目标存在时第i条链路的基线RSSI测量值,yi(t)为t时刻第i条链路的RSSI测量值,Δyi(t)为从没有目标存在到t时刻第i条链路中RSSI变化量,Si(t)为t时刻第i条链路的阴影损耗,vi(t)为t时刻第i条链路的噪声,vi(0)为没有目标存在时第i条链路的噪声。

3.根据权利要求1所述的一种基于混合方式的非合作目标定位方法,其特征在于:步骤2中,当前目标存在的有效区域为,以上一刻目标位置为圆心,以(1+m)r为半径的圆内;即

zt={pt|H(pt-1,pt)<(1+m′)r} (2)

其中,zt为t时刻的有效区域,pt为t时刻的目标位置点,pt-1为t-1时刻的目标位置,H(pt-1,pt)为pt与pt-1之间的欧几里得距离,r为目标最大移动距离,r=umax×Δt,umax为目标最大速度,Δt为t时刻与t-1时刻之间的时间间隔,即单位时间,m′∈(0,1)。

4.根据权利要求1所述的一种基于混合方式的非合作目标定位方法,其特征在于:步骤3中,当链路中RSSI变化量大于最优门限值并且位于有效区域内,则该链路为有效链路;即

其中,S′t为有效链路集合,li表示挑选出的第i条链路,为最优门限值,di(t)为有效区域圆心到第i条链路的距离,

<mrow> <msub> <mi>d</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <mo>|</mo> <msub> <mi>k</mi> <mi>i</mi> </msub> <msub> <mi>x</mi> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>y</mi> <mrow> <mi>t</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>b</mi> <mi>i</mi> </msub> <mo>|</mo> </mrow> <msqrt> <mrow> <mn>1</mn> <mo>+</mo> <msubsup> <mi>k</mi> <mi>i</mi> <mn>2</mn> </msubsup> </mrow> </msqrt> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>

其中,ki为第i条链路直线方程中的斜率,bi为第i条链路直线方程中的截距,(xt-1,yt-1)为t-1时刻的目标位置坐标。

5.根据权利要求4所述的一种基于混合方式的非合作目标定位方法,其特征在于:采用方差最小准则选择最优门限值,具体过程为,

S1,选择初始自适应门限值

S2,将RSSI变化量大于的链路归为A1类,将RSSI变化量小于的链路归为A2类;

S3,分别计算A1类和A2类链路RSSI变化量的方差并统计每一类中链路数目b1和b2

S4,计算代价函数

S5,令i′=1;

S6,其中,δ为步长;

S7,重复S3和S4的工作,得到β(i′)

S8,当时,i′=i′+1,转至S6,Δymax为预设的RSSI的最大变化量;否则选择满足下述条件的门限值为最优门限值,

<mrow> <mo>{</mo> <mfrac> <msub> <mi>b</mi> <mn>1</mn> </msub> <mrow> <msub> <mi>b</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>b</mi> <mn>2</mn> </msub> </mrow> </mfrac> <msubsup> <mi>&sigma;</mi> <mn>1</mn> <mn>2</mn> </msubsup> <mo>+</mo> <mfrac> <msub> <mi>b</mi> <mn>2</mn> </msub> <mrow> <msub> <mi>b</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>b</mi> <mn>2</mn> </msub> </mrow> </mfrac> <msubsup> <mi>&sigma;</mi> <mn>2</mn> <mn>2</mn> </msubsup> <mo>}</mo> <msub> <mo>|</mo> <mrow> <msubsup> <mi>&Delta;y</mi> <mrow> <mi>t</mi> <mi>h</mi> </mrow> <mo>*</mo> </msubsup> </mrow> </msub> <mo>=</mo> <mi>m</mi> <mi>i</mi> <mi>n</mi> <mo>{</mo> <mfrac> <msub> <mi>b</mi> <mn>1</mn> </msub> <mrow> <msub> <mi>b</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>b</mi> <mn>2</mn> </msub> </mrow> </mfrac> <msubsup> <mi>&sigma;</mi> <mn>1</mn> <mn>2</mn> </msubsup> <mo>+</mo> <mfrac> <msub> <mi>b</mi> <mn>2</mn> </msub> <mrow> <msub> <mi>b</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>b</mi> <mn>2</mn> </msub> </mrow> </mfrac> <msubsup> <mi>&sigma;</mi> <mn>2</mn> <mn>2</mn> </msubsup> <mo>}</mo> <msub> <mo>|</mo> <mrow> <msubsup> <mi>&Delta;y</mi> <mrow> <mi>t</mi> <mi>h</mi> </mrow> <mrow> <mo>(</mo> <msup> <mi>i</mi> <mo>&prime;</mo> </msup> <mo>)</mo> </mrow> </msubsup> </mrow> </msub> <mo>.</mo> </mrow>

6.根据权利要求1所述的一种基于混合方式的非合作目标定位方法,其特征在于:步骤4中,假设有效链路有Q条,共可形成∑max个三角形,对∑max个三角形的重心取加权平均得到粗定位坐标(xs,ys);

<mrow> <msub> <mi>x</mi> <mi>s</mi> </msub> <mo>=</mo> <mfrac> <mrow> <msubsup> <mo>&Sigma;</mo> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <msub> <mo>&Sigma;</mo> <mi>max</mi> </msub> </msubsup> <msub> <mi>p</mi> <mi>j</mi> </msub> <msub> <mi>&omega;</mi> <mi>j</mi> </msub> <msub> <mi>x</mi> <mi>j</mi> </msub> </mrow> <mrow> <msubsup> <mo>&Sigma;</mo> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <msub> <mo>&Sigma;</mo> <mi>max</mi> </msub> </msubsup> <msub> <mi>p</mi> <mi>j</mi> </msub> <msub> <mi>&omega;</mi> <mi>j</mi> </msub> </mrow> </mfrac> <mo>,</mo> <msub> <mi>y</mi> <mi>s</mi> </msub> <mo>=</mo> <mfrac> <mrow> <msubsup> <mo>&Sigma;</mo> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <msub> <mo>&Sigma;</mo> <mi>max</mi> </msub> </msubsup> <msub> <mi>p</mi> <mi>j</mi> </msub> <msub> <mi>&omega;</mi> <mi>j</mi> </msub> <msub> <mi>y</mi> <mi>j</mi> </msub> </mrow> <mrow> <msubsup> <mo>&Sigma;</mo> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <msub> <mo>&Sigma;</mo> <mi>max</mi> </msub> </msubsup> <msub> <mi>p</mi> <mi>j</mi> </msub> <msub> <mi>&omega;</mi> <mi>j</mi> </msub> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>

其中,(xj,yj)表示第j个三角形的重心坐标,ωj为第j个三角形的重心坐标的权重,ωj等于组成第j个三角形三条链路的RSSI变化量之和,表示从Q条链路中选出任意三条链路组成三角形的组合数目,pj表示第j个三角形重心落在有效区域内外的概率系数;

其中,为t时刻第j个三角形的重心坐标,为有效区域圆心与t时刻第j个三角形重心之间的欧几里得距离。

7.根据权利要求1所述的一种基于混合方式的非合作目标定位方法,其特征在于:步骤5中,利用无线节点坐标对粗定位结果进行修正,根据距离误差得到目标函数J(θ):

J(θ)=(Aθ-b)T(Aθ-b)+λθTΣθ (6)

约束条件为:

θTΣθ=0

其中,

λ为拉格朗日乘子,

θ=[x0 y0 R0]T

(xm,ym)为第m个无线节点坐标,m∈{1,2,…,M},M表示无线测量节点个数,(x0,y0)为目标待求位置坐标,

将式(6)对θ求导,并令导数为0,可得:

<mrow> <mfrac> <mrow> <mo>&part;</mo> <mi>J</mi> <mrow> <mo>(</mo> <mi>&theta;</mi> <mo>)</mo> </mrow> </mrow> <mrow> <mo>&part;</mo> <mi>&theta;</mi> </mrow> </mfrac> <mo>=</mo> <mn>2</mn> <mrow> <mo>(</mo> <msup> <mi>A</mi> <mi>T</mi> </msup> <mi>A</mi> <mo>+</mo> <mi>&lambda;</mi> <mi>&Sigma;</mi> <mo>)</mo> </mrow> <mi>&theta;</mi> <mo>-</mo> <mn>2</mn> <msup> <mi>A</mi> <mi>T</mi> </msup> <mi>b</mi> <mo>=</mo> <mn>0</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>

θ=(ATA+λΣ)-1ATb。 (8)

8.根据权利要求7所述的一种基于混合方式的非合作目标定位方法,其特征在于:求解拉格朗日乘子λ的过程为,

将式θ=(ATA+λΣ)-1ATb带入约束条件得到;

bTA(ATA+λΣ)-1Σ(ATA+λΣ)-1ATb=0 (9)

利用特征值分解,矩阵ATAΣ可以分解为;

ATAΣ=UΛU-1 (10)

其中,γn均为矩阵ATAΣ的特征值,n∈{1,2,3},n为整数,每一个特征值对应一个特征矢量,U为特征矢量构成的矩阵;

将式(10)带入式(9)可得;

pT(Λ+λI)-2q=0

其中,p=UTΣATb=[p1 p2 p3]T,q=UTATb=[q1 q2 q3]T,pn为p的分量,qn为q的分量;I为与Λ同维数的单位矩阵;

可得拉格朗日乘子λ的方程为;

<mrow> <mi>f</mi> <mrow> <mo>(</mo> <mi>&lambda;</mi> <mo>)</mo> </mrow> <mo>=</mo> <msup> <mi>p</mi> <mi>T</mi> </msup> <msup> <mrow> <mo>(</mo> <mi>&Lambda;</mi> <mo>+</mo> <mi>&lambda;</mi> <mi>I</mi> <mo>)</mo> </mrow> <mrow> <mo>-</mo> <mn>2</mn> </mrow> </msup> <mi>q</mi> <mo>=</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mn>3</mn> </munderover> <mfrac> <mrow> <msub> <mi>p</mi> <mi>i</mi> </msub> <msub> <mi>q</mi> <mi>i</mi> </msub> </mrow> <msup> <mrow> <mo>(</mo> <mi>&lambda;</mi> <mo>+</mo> <msub> <mi>&gamma;</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mfrac> <mo>=</mo> <mn>0</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>11</mn> <mo>)</mo> </mrow> </mrow>

求解方程(11)即可得到拉格朗日乘子λ。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1