到达时间差测量目标位置（TDOA）定位

到达时间差测量目标位置（TDOA）

基本原理

由数学原理可知，距离两个定点的距离差为常数的动点的轨迹为双曲线。而若要在三维空间里确定一个点，至少需要三个距离差，四个观测点。因此，利用TOOA定位，至少要有四个观测站。

现有坐标为$(x,y,z)$的目标$T$，有$M+1$个观测站，其中有一个主站$S_0$,$M$个副站$S_i$,他们的坐标为$(x_i,y_i,z_i),i=0,1,\cdot \cdot \cdot ,M$。设电磁辐射由目标到达各站的时间为$t_i(i=0,1,2，\cdot \cdot \cdot ,M)$。各副站到达时间与主站到达时间的时间差可写为${\tau }_i(i=1,2,\cdot \cdot \cdot ,M)$。

将到达时间差乘光速，可得$T$到各副站到总站的距离差
$$\Delta r_i=c{\tau }_i$$
这个距离差还可由目标到主站的距离减去目标到副站的距离直接得到，即
$$\Delta r_i=r_i-r_0=[(x-x_i{)}^2+(y-y_i{)}^2+(z-z_i{)}^2{]}^{\frac{1}{2}}-[(x-x_0{)}^2+(y-y_0{)}^2+(z-z_0{)}^2{]}^{\frac{1}{2}}$$
可得
$$(\Delta r_i+r_0{)}^2=r_i^2=(x-x_i{)}^2+(y-y_i{)}^2+(z-z_i{)}^2$$
两边同减去$r_0^2$
$$\begin{array}{rl}\Delta r_i^2+2\Delta r_i{r}_0& =(x-x_i{)}^2+(y-y_i{)}^2+(z-z_i{)}^2-(x-x_0{)}^2+(y-y_0{)}^2+(z-z_0{)}^2\\ & =2x(x_0-x_i)+2y(y_0-y_i)+2z(z_0-z_i)+(x_i^2+y_i^2+z_i^2)-(x_0^2+y_0^2+z_0^2)\end{array}$$
令$d_i^2=x_i^2+y_i^2+z_i^2$，则
$$\Delta r_i^2+2\Delta r_i{r}_0=2x(x_0-x_i)+2y(y_0-y_i)+2z(z_0-z_i)+d_i^2-d_0^2$$
整理可得
$$x(x_0-x_i)+y(y_0-y_i)+z(z_0-z_i)=\Delta r_i{r}_0+\frac{\Delta r_i^2+d_o^2-d_i^2}{2}$$
上述方程应有$i=1,2,\cdot \cdot \cdot ,M个$，$x,y,z$是未知数，将它改写为矩阵形式，如下：
[x1−x0y1−y0z1−z0x2−x0y2−y0z2−z0⋮⋮⋮xM−x0yM−y0zM−z0][xyz]=[−Δr1−Δr2⋮−ΔrM]r0+[l1l2⋮lM]其中，li=di2−d02−Δri22 \begin{bmatrix} x_1-x_0 & y_1-y_0 & z_1-z_0\\ x_2-x_0 & y_2-y_0 & z_2-z_0\\ \vdots & \vdots & \vdots \\ x_M-x_0 & y_M-y_0 &z_M-z_0 \end{bmatrix} \begin{bmatrix} x\\ y\\ z \end{bmatrix}= \begin{bmatrix} -\Delta r_1\\ -\Delta r_2\\ \vdots\\ -\Delta r_M \end{bmatrix}r_0+ \begin{bmatrix} l_1\\ l_2\\ \vdots\\ l_M \end{bmatrix}其中，l_i=\frac{d_i^2-d_0^2-\Delta r_i^2}{2} ⎣⎢⎢⎢⎡​x1​−x0​x2​−x0​⋮xM​−x0​​y1​−y0​y2​−y0​⋮yM​−y0​​z1​−z0​z2​−z0​⋮zM​−z0​​⎦⎥⎥⎥⎤​⎣⎡​xyz​⎦⎤​=