Trajectory Planning for Safe Dual Control with Active Exploration
Planning safe trajectories under model uncertainty is a fundamental challenge. Robust planning ensures safety by considering worst-case realizations of the uncertainty with fixed uncertainty bounds, which leads to conservative behavior. Actively reducing uncertainty on-the-fly while planning for the system trajectories defines the dual control problem. Most approaches add a weighted exploration term to the mission cost, tuned to tradeoff the nominal objective and the uncertainty reduction, but without formal consideration of when exploration is beneficial to the mission. In addition, safety constraints are not in general considered in dual control approaches. In this paper we study a budget-constrained dual control problem, in which uncertainty is reduced while accounting for both safety constraints and a budget on the exploratory cost. To solve this problem we propose Dual-gatekeeper, a framework that integrates the nominal mission objective with active exploration under formal guarantees of safety and budget feasibility, so that exploratory actions are allowed only when safety and budget feasibility are then formally verified. We develop deterministic and probabilistic safety instantiations of the proposed approach, demonstrated through quadrotor navigation with uncertain aerodynamic parameters and autonomous racing with uncertain tire-road friction coefficients, respectively.