仿生型自主式水下載具利用環境特徵之定位控制

Abstract

本文提出一個使用延伸式卡爾曼濾波器的資訊融合方法，裝設於仿生型自主式水下載具（簡稱BAUV）上做為環境偵測與導航之用。本文於BAUV載具前端裝設聲納以及攝影機來偵測未知的環境，單點式聲納可以提供載具與未知物的距離，而立體視覺也可配合載具狀態來計算在影像座標上目標物與載具之間的相對位置，聲納及攝影機之資料先由卡爾曼濾波器執行載具及目標點位置估測，二者之資訊再由聯邦濾波器來更新估測值，使得載具在感測器資訊融合之下能夠準確地的接近目標點。本文所提出的資料融合方法，最後以BUAV載具在水槽內測試可行性，實驗結果證明本方法皆可以提高載具及環境位置估測之準確度。

A sensor fusion algorithm using Extended Kalman Filter for a fishlike Biomimetic Autonomous Underwater Vehicle (BAUV) is presented. This is a step toward the applications of BAUVs in real missions. There are six brushless DC servomotors mounted inside the BAUV, four of the motors responsible for the motion of side fins, two motors responsible for the tail joint and the tail fin joint. In addition, the BAUV’s head moves in a cyclic fashion, so one can use an echo sounder and two video cameras installed on its head to detect the environment. Firstly, BAUV uses an imaging sonar to detect and estimate the target location roughly until the BAUV proceeds to visible range of the target, then switch to visual guidance mode to reach the target point in good precision. An efficient, federated Kalman filter is developed for use in distributed multi-sensor systems. Using data fusion and updating the information, the BAUV can have more accuracy in detecting target and control its orientation to approach targets in an unknown environment.