MPCC++: Model Predictive Contouring Control for Time-Optimal Flight with Safety Constraints

Maria Krinner,Angel Romero,Leonard Bauersfeld,Melanie Zeilinger,Andrea Carron,Davide Scaramuzza
2024-06-14
Abstract:Quadrotor flight is an extremely challenging problem due to the limited control authority encountered at the limit of handling. Model Predictive Contouring Control (MPCC) has emerged as a promising model-based approach for time optimization problems such as drone racing. However, the standard MPCC formulation used in quadrotor racing introduces the notion of the gates directly in the cost function, creating a multi objective optimization that continuously trades off between maximizing progress and tracking the path accurately. This paper introduces three key components that enhance the state-of-the-art MPCC approach for drone racing. First and foremost, we provide safety guarantees in the form of a track constraint and terminal set. The track constraint is designed as a spatial constraint which prevents gate collisions while allowing for time optimization only in the cost function. Second, we augment the existing first principles dynamics with a residual term that captures complex aerodynamic effects and thrust forces learned directly from real-world data. Third, we use Trust Region Bayesian Optimization (TuRBO), a state-of-the-art global Bayesian Optimization algorithm, to tune the hyperparameters of the MPCC controller given a sparse reward based on lap time minimization. The proposed approach achieves similar lap times to the best-performing RL policy and outperforms the best model-based controller while satisfying constraints. In both simulation and real world, our approach consistently prevents gate crashes with 100% success rate, while pushing the quadrotor to its physical limits reaching speeds of more than 80km/h.
Robotics
What problem does this paper attempt to address?
This paper proposes a solution to the safety and time-optimal control problem of unmanned aerial vehicles (quadcopters) during high-speed flight. Existing Model Predictive Contouring Control (MPCC) methods have limitations in drone racing, such as sacrificing safety in the multi-objective optimization of the cost function. To address this, the paper introduces three key improvements: 1. Safety Assurance: Provides safety flight guarantees through trajectory constraints and termination sets. The trajectory constraint is designed as a spatial constraint to prevent collisions and only allows time optimization in the cost function. 2. Dynamics Enhancement: Complements first principle dynamics with residual terms to capture complex aerodynamic effects and thrust learned directly from real data. 3. Hyperparameter Optimization: Uses the Trust Region Bayesian Optimization (TuRBO) algorithm to tune the hyperparameters of the MPCC controller, achieving better performance based on sparse rewards (minimizing lap time). These improvements enable the proposed MPCC++ method to maintain high performance while satisfying safety constraints, achieving a 100% success rate in simulations and real-world experiments, avoiding gate collisions, and flying at speeds exceeding 80 kilometers per hour. Compared to the best model-based controller, this method performs better and is comparable to the best reinforcement learning strategy in terms of lap time, but with increased safety.