【技术实现步骤摘要】
一种基于TDoA的搜索加权定位方法
[0001]本专利技术涉及定位与导航
,尤其涉及一种基于TDoA的搜索加权定位方法。
技术介绍
[0002]信号到达时间差(Time Difference of Arrival,TDoA)是定位领域被广泛使用的测量之一,它是指目标接收到不同基站发射信号的时间差,或者是不同的基站接收到目标发射信号的时间差。基于TDoA的定位系统的优点是不需要基站和目标间的时间同步,从而降低了系统设计的成本和复杂度。
[0003]基于TDoA的定位算法已得到广泛的研究,主要分为3类:非线性优化方法、线性方法和几何方法。非线性优化方法有高斯
‑
牛顿法、梯度下降法等,缺点是性能与选择的初值有关,在迭代求解过程中可能陷入局部最优解;线性方法主要有两步加权最小二乘算法、约束加权最小二乘算法和分离的约束加权最小二乘算法等,两步加权最小二乘算法和约束加权最小二乘算法在噪声较小的情况下达到克拉美罗下界,但是在特殊的几何条件下时定位效果很差,分离的约束加权最小二乘算法通过把位置坐标与辅助变量分离在等式的两边,可避免系统矩阵的病态。总之,由于加权最小二乘类方法忽视了噪声的高次项,它在较小的量测噪声下可以接近获得克拉美罗下届的估计性能,但是随着量测噪声的增加,估计的误差会偏离克拉美罗下届,尤其在基站呈均匀圆形阵列分布且目标靠近基站时,抗噪能力较差;几何方法主要包括缩圆法,这类方法计算计算复杂度低,但无法利用冗余的量测信息来提高定位精度。
技术实现思路
[0004]本专利技术 ...
【技术保护点】
【技术特征摘要】
1.一种基于TDoA的搜索加权定位方法,其特征在于,所述方法包括:步骤1、当基站数目等于3时,通过建立方程直接求得一个解析解,该解析解即为最终目标估计位置;步骤2、当基站数目大于3时,计算三基站的组合个数,并针对每个组合基于TDoA求解出目标位置的解析解;步骤3、基于步骤2求出的目标位置的解析解,构造矩形搜索区域;步骤4、然后在所构造的矩形搜索区域内选取候选位置,针对所有的候选位置计算对应候选位置的权重;步骤5、将步骤4计算的权重代入构建的目标函数中,计算得到所有候选位置对应的目标函数值;其中,所述目标函数是测量值与真实值之间偏差的加权平方和;步骤6、从计算得到的所有候选位置对应的目标函数值中找到最小值,该最小值对应的候选位置就是最终目标估计位置。2.根据权利要求1所述基于TDoA的搜索加权定位方法,其特征在于,所述步骤1的过程具体为:假设第i个基站的坐标为S
i
(x
i
,y
i
,h
i
),其中h
i
是基站i与目标间的垂直高度差,i=1,2,
…
,N,N是基站总数,第k时刻目标所处的实际位置为P
k
(x
k
,y
k
),对其的估计为实现基于TDoA的定位至少需要3个基站,即要求N≥3,已知的TDoA量测可转化为与距离相关的量测,如式(1)所示:其中,c为声速,单位为m/s,是以基站1作为参考点,目标与基站S
i
间以及与参考基站间的距离之差;当N=3时,用量测代替真实的RDOA
i1,k
,求得的解是对P
k
的估计,具体求解过程如下:式(2)中的
②
和
③
分别减去
①
得:其中为目标与基站1之间的距离;x
12
=x1‑
x2,y
12
=y1‑
y2,x
13
=x1‑
x3,y
13
=y1‑
y3,以及式(3)的求解分为两种情况:三基站不在同一条直线,即x
12
y
13
≠x
13
y
12
;三基站在同一条直线上,即x
12
y
13
=x
13
y
12
;在
这两种情况下,三个基站均在不同的位置上;当x
12
y
13
≠x
13
y
12
时,从式(3)可得到与的关系,见式(4):其中,把式(4)代入式(2)中的
①
式可得到一个关于的一元二次方程,如式(6):其中,显然式(6)有两个解,但只能选择其中一个作为的解,令Δ=b2‑
4ac,选择的准则如下:
③
若Δ≥0,式(6)有两个实数根,即和如果两个根都是正值,则选择较小的作为的解,否则选择较大的;
④
若Δ<0,式(6)有两个复数根,那么取其实部作为的解,即把代入式(4)中可求得目标的估计位置当x
12
y
13
=x
13
y
12
时,此时式(4)是不成立的,因为式(5)中的分母均为零,因此需要通过如下的方法求解式(3),分为3种情形:1)若x
12
=0,一定有y
12
≠0,否则基站1和基站2在同一位置,从而有x
13
=0且y
13
≠0,令式(3)中的
①
式两边乘以y
13
,且
②
式两边乘以y
12
,那么可通过式(8)求解:
2)若y
12
=0,同情形
①
,一定有x
12
≠0,那么有x
13
≠0且y
13
=0,此时通过式(9)求解:3)若x
12
≠0且y
12
≠0,那么可通过式(8)或者(9)求解;在求出后,把其代入式(2)中的式
①
和
②
可求得目标的估计位置3.根据权利要求1所述基于TDoA的搜索加权定位方法,其特征在于,在步骤2中,当基站数目大于3,即N>3时,对N个基站,共有M个3基站组合,M值由下式确定,其中
‘
C
’
表示组合操作符,
‘
!
’
表示求阶乘操作符:针对M个3基站组合,每个基站组合利用步骤1中N=3时的求解方法,求出目标估计位置的解析解,共M个,形成一个集合S。4.根据权利要求1所述基于TDoA的搜索加权定位方法,其特征在于,在步骤3中,构造矩形搜索区域的过程具体为:利用所有三基站组合解的横坐标最小值和最大值以及纵坐标最小值和最大值构建,矩形搜索区域的顶点坐标分别为:和5.根据权利要求1所述基于TDoA的搜索加权定位方法,其特征在于,在步骤4中,在所构造的矩形搜索区域内选取候选位置的过程具体为:使用m条水平线和n条竖直线等分矩形搜索区域,以水平线与竖直线的交点、水平线与矩形边的交点、竖直线与矩形边的交点、矩形顶点构成所有候选位置,共计(m+2)
·
(n+2)个。6.根据权利要求1所述基于TDoA的搜索加权定位方法,其特征在于,在步骤4中,对应候选位置的权重计算过程为:首先测量噪声在侯选位置与两基站间的距离差上得到经过坐标系的旋转和平移,针对一般情况,以两基站坐标和构建单支标准双曲线,求解所述候选位置到该单支标准双曲线的最短距离r;针对特殊情况,以两基站坐标和构建直线或射线,求解所述候选位置到该直线或射线的最短距离r;则权重α
i,j
按照如下公式计算:
α
i,j
=1/r2。7.根据权利要求6所述基于TDoA的搜索加权定位方法,其特征在于,所述权重α
i,j
的具体计算过程为:选择两个不同的基站S
i
和S
j
,其坐标分别为S
i
(x
i
,y
i
),S
j
(x
j
,y
j
);选取一个候选位置,坐标为T(x
t
,y
t
),那么目标未知待定位置与基站S
i
和S
j
的距离差RDOA
i,j
的值可由式(12)计算得到:设置当前测量噪声为Δd
i,j
,令假设有一个位置点Q,满足其中||QS
i
||表示点Q与基站S
i
...
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。