본 논문에서는 수중에서 이동체의 3차원 위치를 추정하기 위한 위치추적 시스템을 구현하였다. 본 연구에서는 네 개의 초음파 센서를 수중의 서로 다른 위치에 고정시키고, 이동중인 이동체 센서와 서로 다른 신호를 송 수신하게 함으로써 고정체와 이동체 모두에서 이동체의 3차원 위치 추적과 이동체의 원격제어를 가능하게 하였다. 또한 위치 추적 시에 Newton 알고리즘에서 매 iteration 시에 Jacobian 행렬의 norm을 추정하고, 행렬의 norm이 임계값 이상이 되어 역행렬에 의한 해가 불안정해질 때는 또 다른 초기값을 이용하여 해를 구하게 함으로써 이동체의 위치가 보다 신뢰성 있게 추정되게 하였다. 그리고 제안한 알고리즘을 이용하여 실시간 위치 추적이 가능한 위치 추적 DSP 시스템을 구현하였으며, 성능 검증을 위한 수조 실험을 수행하였다. 성능 검증결과 본 연구에서 구현한 위치 추적 시스템은 1초에 2회 이상의 속도로 오차율 5cm 이내에서 이동체의 위치를 추적함을 알 수 있었다.
In this paper we have implemented a 3-D PL (Position Location) system to estimate the 3-dimensional position of a moving object in underwater environments. In this research, we let four sensors fixed in different Positions and moving sensorsto communicate with each other to find the 3-dementianal positions for both the fixed and moving objects. Using this we were also able to control the moving object remotely. When finding the position, we calculated the norm of the Jacobian matrix every iteration in the Newton algorithm. Also by using a different initial value for calculating the solution when the norm became higher than the critical value and the solution from the inverse matrix became unstable, we could find a more reliable position for the moving object. The proposed algorithm was used in implementing a DSP system capable of real-time position location. To verify the performance, experiments were done in a water tank. As a result we could see that our system could located the position of an object every 2 seconds with a error range of 5cm.
