Abstract
This paper proposes a waypoint guidance algorithm for the Autonomous Underwater Vehicle(AUV). The proposed simplified guidance algorithm is presented, which is combined LOS guidance and cross-track guidance for path following. Cross-track error is calculated using the position of the AUV and reference path. LOS guidance and cross-track guidance are appropriately changed according to cross-track error. And the stability of the system has been improved using variable cross-track control gain by cross-track error. Also, in this paper, navigation hardware in-the loop simulation(HILS) is implemented to verify navigation algorithm of AUV that performs combined navigation using inertial navigation device and doppler velocity log(DVL). Finally, we design integrated system HILS (including navigation HILS) for performance verification of guidance algorithm of the autonomous underwater vehicle. By comparing the sea test result with HILS result, the proposed guidance algorithm and HILS configuration were confirmed be correct.
본 논문에서는 수중에서 운동하는 무인잠수정의 경로점 유도법칙을 제안한다. 시선각 유도법칙과 수선경로 오차를 줄여가는 경로추종 유도법칙을 조합하여 효과적인 경로점 유도법칙을 설계하였고, 수선경로 오차의 거리에 따라 제어이득을 변화시켜 시스템의 안정성을 증가시켰다. 또한, 관성항법장치와 도플러속도계를 이용한 복합항법 시스템의 성능을 확인할 수 있는 HILS를 구성하였다. 같은 경로점 및 목표점을 입력 후 HILS 수행결과와 실해역 주행시험 결과를 비교하여, 제안한 유도법칙 및 HILS가 올바르게 구성되어 있음을 확인하였다.