障害物環境下で動く水中ロボットのロバスト軌道追従制御
Robust Trajectory Tracking Control for Underactuated Autonomous Underwater Vehicles
外乱やモデル不確かさ、障害物のある制約空間で動く劣駆動AUVに対し、オンラインセンサ情報を更新しつつ入力・状態制約を満たすロバストNMPCによる3次元軌道追従制御を提案した論文。
著者: Shahab Heshmati-alamdari, Alexandros Nikou, Dimos V. Dimarogonas
分類: cs.RO
原文アブストラクト
Motion control of underwater robotic vehicles is a demanding task with great challenges imposed by external disturbances, model uncertainties and constraints of the operating workspace. Thus, robust motion control is still an open issue for the underwater robotics community. In that sense, this paper addresses the tracking control problem or 3D trajectories for underactuated underwater robotic vehicles operating in a constrained workspace including obstacles. In particular, a robust Nonlinear Model Predictive Control (NMPC) scheme is presented for the case of underactuated Autonomous Underwater Vehicles (AUVs) (i.e., vehicles actuated only in surge, heave and yaw). The purpose of the controller is to steer the underactuated AUV to a desired trajectory with guaranteed input and state constraints within a partially known and dynamic environment where the knowledge of the operating workspace is constantly updated on-line via the vehicle's on-board sensors. In particular, by considering a ball that covers the volume of the system, obstacle avoidance with any of the detected obstacles is guaranteed, despite the model dynamic uncertainties and the presence of external disturbances representing ocean currents and waves. The proposed feedback control law consists of two parts: an online law which is the result of a Finite Horizon Optimal Control Problem (FHOCP) solved for the nominal dynamics; and a state feedback law which is tuned off-line and guarantees that the real trajectories remain bound in a hyper-tube centered along the nominal trajectories for all times. Finally, a simulation study verifies the performance and efficiency of the proposed approach.
