Constrained Location Algorithm Using TDOA
Constrained Location Algorithm Using TDOA
12 DECEMBER 2003
3291
LETTER
SUMMARY One conventional technique for source localization is to utilize the time-dierence-of-arrival (TDOA) measurements of a signal received at spatially separated sensors. A simple
TDOA-based location algorithm that combines the advantages of
two ecient positioning methods is developed. It is demonstrated
that the proposed approach can give optimum performance in geolocation via satellites at dierent noise conditions.
key words: positioning algorithm, weighted least squares, timedierence-of-arrival
to form a new computationally ecient location algorithm. It is shown that the proposed method is superior to the LCLS and its performance can attain the
Cramer-Rao lower bound (CRLB), which gives a lower
bound on the variance attainable by any unbiased estimator.
1.
Introduction
2.
Proposed Algorithm
rl1 = cDl1 ,
l = 2, 3, , L
(1)
where c is the speed of signal propagation. In practice, the range dierence measurements obtained are
corrupted by noise:
rl1 = rl1 + nl1
(2)
(6)
3292
where
G=
x 2 x1
x3 x1
..
.
xL x 1
y2 y1
y3 y1
..
.
z2 z1
z3 z1
..
.
r21
r31
..
.
yL y1
zL z1
rL1
f () = pT ( + I)2 q
2
(xL x1 )2 + (yL y1 )2 + (zL z1 )2 rL1
pi qi
( + i )2
( + i )2 i=1
(12)
s in
3. Construct W using (8) using the obtained R
and repeat Step 2.
It is noteworthy that the estimation procedure in [6]
can be simplied as Steps 1 and 2 without any loss
in performance.
(8)
o
o
, r31
,
where B is a diagonal matrix of the form diag(r21
o
o
s , and Q is the noise co , rL1 ) with rl1 = rl1 + R
variance matrix which is assumed known a priori. A
second estimate of is then obtained via minimizing
s2 based on anys y1 )2 + (
zs z1 )2 R
(
xs x1 )2 + (
other WLS procedure. Note that a few iterations for
the two steps are required to attain the best solution
s is not available at the beginning. On the
because R
other hand, the LCLS aims to minimize the standard
least squares of (G h)T (G h) subject to the constraint of
s2
ys y1 )2 + (
zs z1 )2 = R
(
xs x1 )2 + (
4
i=1
(G h)T W1 (G h)
( + i )2
i=1
2
(x2 x1 ) + (y2 y1 ) + (z2 z1 )2 r21
2
2
2
2
(9)
3.
Computer simulations had been conducted to evaluate the performance of the proposed location algorithm
by comparing with the LCLS and the CRLB [2],[6].
We considered a GPS scenario with (xs , ys , zs ) =
(3895818.244, 325592.485, 5022723.016) m, (x1 , y1 , z1 )
= (8787698.532, 18691292.353, 16789171.19) m, (x2 ,
y2 , z2 ) = (2228828.313, 18073221.126, 19405688.467)
m, (x3 , y3 , z3 ) = (9775123.349, 8627055.585,
23247777.886) m, (x4 , y4 , z4 ) = (23770926.545,
11819578.480, 2041166.259) m, (x5 , y5 , z5 ) =
(14528356.708, 6175808.909, 21148031.464) m, (x6 ,
y6 , z6 ) = (1069123.922, 16400053.194, 20698995.486)
m and (x7 , y7 , z7 ) = (22653816.587, 13572760.609,
1638758.941) m. All simulation results provided were
averages of 1000 independent runs.
Figure 1 shows the mean square range errors
(MSREs) of the proposed method and LCLS as well
L(, ) = (G h)T W1 (G h) + T
(10)
where is the Lagrange multiplier to be determined
and = diag(1, 1, 1, 1). Following [6], we dierentiate L(, ) with respect to and then equate the results
to zero, which gives the estimate of as
= GT W1 G + 1 GT W1 h
(11)
LETTER
3293