你有三个传感器坐标A,B,C
,未知的信号源坐标,P
未知的信号开始时间t0
,和3次信号配准ta, tb, tc
。
示例:让我们传感器 A 在 12:00:05 捕获信号,传感器 B - 在 12:00:00,传感器 C - 12:00:07。所以分配时差:ta=5, tb=0, tc=7
从传感器到源的平方距离对应于信号随速度行走的时间v
(空气或其他环境中的声速)
(Ax-Px)^2 + (Ay-Py)^2 = (v*(ta-t0))^2 {1}
(Bx-Px)^2 + (By-Py)^2 = (v*(tb-t0))^2 {2}
(Cx-Px)^2 + (Cy-Py)^2 = (v*(tc-t0))^2 {3}
打开括号,然后减去方程({2}-{1}、{3}-{2}、{1}-{3})以丢弃未知项的平方。
Ax^2-2*Ax*Px + Px^2 + Ay^2-2*Ay*Py + Py^2 = v^2*(ta^2 - 2*ta*t0 + t0^2)
Bx^2-2*Bx*Px + Px^2 + By^2-2*By*Py + Py^2 = v^2*(tb^2 - 2*tb*t0 + t0^2)
Cx^2-2*Cx*Px + Px^2 + Cy^2-2*Cy*Py + Py^2 = v^2*(tc^2 - 2*tc*t0 + t0^2)
Bx^2-Ax^2 -2*(Bx-Ax)*Px + By^2-Ay^2 -2*(By-Ay)*Py = v^2*(tb^2-ta^2 -2*(tb-ta)*t0) {1'}
Cx^2-Bx^2 -2*(Cx-Bx)*Px + Cy^2-By^2 -2*(Cy-By)*Py = v^2*(tc^2-tb^2 -2*(tc-tb)*t0) {2'}
Ax^2-Cx^2 -2*(Ax-Cx)*Px + Ay^2-Cy^2 -2*(Ay-Cy)*Py = v^2*(ta^2-tc^2 -2*(ta-tc)*t0) {3'}
现在您有了具有三个未知数的三个线性方程组。它可以用一些广泛的算法来解决 -高斯消除,LU分解等。
请注意,求解精度很大程度上取决于坐标和时间测量中的小误差(这种方法不是很稳健)。