Custom Non-Linear Model Predictive Control for Obstacle Avoidance in Indoor and Outdoor Environments

Lara Laban,Mariusz Wzorek,Piotr Rudol,Tommy Persson
2024-10-04
Abstract:Navigating complex environments requires Unmanned Aerial Vehicles (UAVs) and autonomous systems to perform trajectory tracking and obstacle avoidance in real-time. While many control strategies have effectively utilized linear approximations, addressing the non-linear dynamics of UAV, especially in obstacle-dense environments, remains a key challenge that requires further research. This paper introduces a Non-linear Model Predictive Control (NMPC) framework for the DJI Matrice 100, addressing these challenges by using a dynamic model and B-spline interpolation for smooth reference trajectories, ensuring minimal deviation while respecting safety constraints. The framework supports various trajectory types and employs a penalty-based cost function for control accuracy in tight maneuvers. The framework utilizes CasADi for efficient real-time optimization, enabling the UAV to maintain robust operation even under tight computational constraints. Simulation and real-world indoor and outdoor experiments demonstrated the NMPC ability to adapt to disturbances, resulting in smooth, collision-free navigation.
Robotics,Artificial Intelligence,Hardware Architecture,Computational Engineering, Finance, and Science,Systems and Control
What problem does this paper attempt to address?
The problem that this paper attempts to solve is: in complex environments (including indoor and outdoor), how can unmanned aerial vehicles (UAVs) and other autonomous systems achieve real - time trajectory tracking and obstacle avoidance. Specifically, the article focuses on the development of a nonlinear model predictive control (NMPC) framework to address the following challenges: 1. **Non - linear dynamics**: Many existing control strategies rely on linear approximations, but in obstacle - dense environments, such approximations cannot accurately describe the dynamic characteristics of UAVs. 2. **Real - time performance and computational resource limitations**: Large - scale UAVs (such as DJI Matrice 100) need to handle more complex dynamic behaviors and must perform optimization calculations efficiently in real - time environments, which imposes higher requirements on computational resources. 3. **Path smoothness and safety**: Ensure that UAVs can generate smooth reference trajectories when avoiding obstacles and comply with safety constraints to avoid collisions. To solve these problems, the paper introduces a framework based on nonlinear model predictive control (NMPC). This framework uses dynamic models and B - spline interpolation to generate smooth reference trajectories, and at the same time improves control accuracy through penalty functions, especially for maneuvering operations in narrow spaces. In addition, this framework utilizes the CasADi tool for efficient real - time optimization, enabling UAVs to maintain stable operation even with limited computational resources. ### Main contributions - **Non - linear dynamics modeling**: Maintain the non - linear characteristics of the system, enabling UAVs to effectively handle large deviations and complex trajectories. - **Efficient real - time optimization**: By using the CasADi library, efficient real - time optimization is achieved, supporting UAVs to make rapid decisions under computationally - constrained situations. - **Path representation and obstacle avoidance**: Use B - spline curves to represent paths, ensuring that the paths are smooth and adaptable; by adding obstacle penalty terms in the cost function, effective obstacle avoidance is achieved. - **Experimental verification**: Through simulations and actual indoor and outdoor experiments, the adaptability and robustness of the NMPC framework in different scenarios are verified. These improvements enable UAVs to achieve more accurate and safer flights in complex environments, especially in obstacle - dense areas.