To solve the problem of sound source localisation in underwater sensor networks, this paper constructs a pseudo-linear equation system of time difference of arrival and angle of arrival (TDOA/AOA) and then uses the weighted least squares algorithm to estimate the target position. This paper proposes a two-stage weighted least squares algorithm that uses target position error. First, the adapted TDOA equation and the existing AOA equation are combined into the first-stage weighted least squares algorithm, which improves the estimation accuracy of the first stage compared with the traditional algorithm. Second, this paper uses the target position error in the second stage to derive a new TDOA/AOA equation. Finally, the target position calculated in the previous stage is adjusted by the solved target position error. The performance of the proposed algorithm is verified by comparison with the Cramer–Rao lower bound. Simulation results show that the proposed algorithm still has good localisation performance even under high-angle noise.
Read full abstract