Embedded Hierarchical MPC for Autonomous Navigation
2406.11506
0
0
Abstract
To efficiently deploy robotic systems in society, mobile robots need to autonomously and safely move through complex environments. Nonlinear model predictive control (MPC) methods provide a natural way to find a dynamically feasible trajectory through the environment without colliding with nearby obstacles. However, the limited computation power available on typical embedded robotic systems, such as quadrotors, poses a challenge to running MPC in real-time, including its most expensive tasks: constraints generation and optimization. To address this problem, we propose a novel hierarchical MPC scheme that interconnects a planning and a tracking layer. The planner constructs a trajectory with a long prediction horizon at a slow rate, while the tracker ensures trajectory tracking at a relatively fast rate. We prove that the proposed framework avoids collisions and is recursively feasible. Furthermore, we demonstrate its effectiveness in simulations and lab experiments with a quadrotor that needs to reach a goal position in a complex static environment. The code is efficiently implemented on the quadrotor's embedded computer to ensure real-time feasibility. Compared to a state-of-the-art single-layer MPC formulation, this allows us to increase the planning horizon by a factor of 5, which results in significantly better performance.
Create account to get full access
Overview
- This paper presents a hierarchical model predictive control (MPC) framework for autonomous navigation of mobile robots.
- The approach combines a high-level MPC planner that generates optimal trajectories and a low-level MPC controller that tracks these trajectories in real-time.
- The hierarchical structure allows for efficient computation and obstacle avoidance while maintaining stability and recursive feasibility.
Plain English Explanation
The paper describes a new way for autonomous robots, like self-driving cars or delivery drones, to plan and execute their movements. The key idea is to use a "hierarchical" control system with two main parts:
-
A high-level planner that figures out the best overall path the robot should take, taking into account obstacles and other constraints. This planner uses an advanced optimization technique called model predictive control to find the optimal trajectory.
-
A low-level controller that constantly adjusts the robot's speed and direction to actually follow the path planned by the high-level module. This low-level controller also uses model predictive control to track the trajectory in real-time.
By splitting the control system into these two layers, the approach can plan efficient, obstacle-avoiding paths while also maintaining stable, responsive control of the robot's movements. The hierarchical structure allows for faster computation and more reliable performance compared to a single, monolithic control system.
Technical Explanation
The paper proposes an embedded hierarchical MPC framework for autonomous navigation of mobile robots. The high-level MPC planner generates globally optimal trajectories that consider the robot's dynamic constraints and obstacles in the environment. This planner runs at a lower frequency to minimize computational load.
The low-level MPC controller tracks the planned trajectory in real-time, adjusting the robot's controls to maintain stability and follow the desired path. The controller runs at a higher frequency to provide responsive, closed-loop control. The hierarchical structure allows the system to balance global optimality, real-time feasibility, and computational efficiency.
The authors demonstrate the effectiveness of their approach through simulation experiments and comparisons to other MPC-based navigation methods. They show that the hierarchical MPC framework can handle complex environments, avoid obstacles, and maintain stable control of the robot's motion.
Critical Analysis
The paper provides a thorough technical explanation of the proposed hierarchical MPC approach and its benefits for autonomous navigation. However, the authors acknowledge some limitations, such as the need for accurate modeling of the robot's dynamics and the environment.
Additionally, the recursive feasibility and stability properties of the hierarchical MPC framework are not formally proven, which could be an area for further research.
The authors also mention that the real-world implementation of their approach on physical robots would require additional considerations, such as sensor uncertainty and computational constraints on embedded hardware.
Conclusion
This paper presents a promising hierarchical MPC framework for autonomous navigation that combines global trajectory planning with real-time control. The key strengths of the approach are its ability to generate optimal, obstacle-avoiding paths while maintaining stable, responsive control of the robot's movements.
The hierarchical structure allows for efficient computation and reliable performance, making the framework a valuable contribution to the field of embedded autonomous mobile robotics. While some limitations and areas for further research are identified, the paper demonstrates the potential of this approach to enable more advanced and capable autonomous navigation systems.
This summary was produced with help from an AI and may contain inaccuracies - check out the links to read the original source documents!
Related Papers
📈
Towards Using Fast Embedded Model Predictive Control for Human-Aware Predictive Robot Navigation
Till Hielscher, Lukas Heuer, Frederik Wulle, Luigi Palmieri
0
0
Predictive planning is a key capability for robots to efficiently and safely navigate populated environments. Particularly in densely crowded scenes, with uncertain human motion predictions, predictive path planning, and control can become expensive to compute in real time due to the curse of dimensionality. With the goal of achieving pro-active and legible robot motion in shared environments, in this paper we present HuMAN-MPC, a computationally efficient algorithm for Human Motion Aware Navigation using fast embedded Model Predictive Control. The approach consists of a novel model predictive control (MPC) formulation that leverages a fast state-of-the-art optimization backend based on a sequential quadratic programming real-time iteration scheme while also providing feasibility monitoring. Our experiments, in simulation and on a fully integrated ROS-based platform, show that the approach achieves great scalability with fast computation times without penalizing path quality and efficiency of the resulting avoidance behavior.
5/22/2024
🛸
Deadlock Resolution and Recursive Feasibility in MPC-based Multi-robot Trajectory Generation
Yuda Chen, Meng Guo, Zhongkui Li
0
0
Online collision-free trajectory generation within a shared workspace is fundamental for most multi-robot applications. However, many widely-used methods based on model predictive control (MPC) lack theoretical guarantees on the feasibility of underlying optimization. Furthermore, when applied in a distributed manner without a central coordinator, deadlocks often occur where several robots block each other indefinitely. Whereas heuristic methods such as introducing random perturbations exist, no profound analyses are given to validate these measures. Towards this end, we propose a systematic method called infinite-horizon model predictive control with deadlock resolution. The MPC is formulated as a convex optimization over the proposed modified buffered Voronoi with warning band. Based on this formulation, the condition of deadlocks is formally analyzed and proven to be analogous to a force equilibrium. A detection-resolution scheme is proposed, which can effectively detect deadlocks online before they even happen. Once detected, it utilizes an adaptive resolution scheme to resolve deadlocks, under which no stable deadlocks can exist under minor conditions. In addition, the proposed planning algorithm ensures recursive feasibility of the underlying optimization at each time step under both input and model constraints, is concurrent for all robots and requires only local communication. Comprehensive simulation and experiment studies are conducted over large-scale multi-robot systems. Significant improvements on success rate are reported, in comparison with other state-of-the-art methods and especially in crowded and high-speed scenarios.
4/10/2024
🧠
PlanNetX: Learning an Efficient Neural Network Planner from MPC for Longitudinal Control
Jasper Hoffmann, Diego Fernandez, Julien Brosseit, Julian Bernhard, Klemens Esterle, Moritz Werling, Michael Karg, Joschka Boedecker
0
0
Model predictive control (MPC) is a powerful, optimization-based approach for controlling dynamical systems. However, the computational complexity of online optimization can be problematic on embedded devices. Especially, when we need to guarantee fixed control frequencies. Thus, previous work proposed to reduce the computational burden using imitation learning (IL) approximating the MPC policy by a neural network. In this work, we instead learn the whole planned trajectory of the MPC. We introduce a combination of a novel neural network architecture PlanNetX and a simple loss function based on the state trajectory that leverages the parameterized optimal control structure of the MPC. We validate our approach in the context of autonomous driving by learning a longitudinal planner and benchmarking it extensively in the CommonRoad simulator using synthetic scenarios and scenarios derived from real data. Our experimental results show that we can learn the open-loop MPC trajectory with high accuracy while improving the closed-loop performance of the learned control policy over other baselines like behavior cloning.
5/24/2024
MPCC++: Model Predictive Contouring Control for Time-Optimal Flight with Safety Constraints
Maria Krinner, Angel Romero, Leonard Bauersfeld, Melanie Zeilinger, Andrea Carron, Davide Scaramuzza
0
0
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.
6/17/2024