遮蔽物を避けて目標を追跡するリアルタイム多凸モデル予測制御
Real-Time Multi-Convex Model Predictive Control for Occlusion Free Target Tracking
静的・動的障害物の中で目標を追跡するMPCを提案し、追跡・衝突・遮蔽の制約を多凸構造に再定式化して分割Bregman反復で解くことで、ラップトップやJetson TX2上でリアルタイムに動作する高速な軌道計画を実現した論文。
著者: Houman Masnavi, Vivek Adajania, Karl Kruusamae, Arun Kumar Singh
分類: cs.RO, cs.SY, eess.SY
原文アブストラクト
This paper proposes a Model Predictive Control (MPC) algorithm for target tracking amongst static and dynamic obstacles. Our main contribution lies in improving the computational tractability and reliability of the underlying non-convex trajectory optimization. The result is an MPC algorithm that runs real-time on laptops and embedded hardware devices such as Jetson TX2. Our approach relies on novel reformulations for the tracking, collision, and occlusion constraints that induce a multi-convex structure in the resulting trajectory optimization. We exploit these mathematical structures using the split Bregman Iteration technique, eventually reducing our MPC to a series of convex Quadratic Programs solvable in a few milliseconds. The fast re-planning of our MPC allows for occlusion and collision-free tracking in complex environments even while considering a simple constant-velocity prediction for the target trajectory and dynamic obstacles. We perform extensive bench-marking in a realistic physics engine and show that our MPC outperforms the state-of-the-art algorithms in visibility, smoothness, and computation-time metrics.
