Trajectory planning and following for UAVs with nonlinear dynamics

In this paper, we introduce a Matlab-based toolbox called OPTIPLAN, which is intended to formulate, solve and simulate problems of obstacle avoidance based on model predictive control (MPC). The main goal of the toolbox is that it allows the users to simply set up even complex control problems without loss in efficiency only in few lines of code. Slow mathematical and technical details are fully automated allowing researchers to focus on problem formulation. It can easily perform MPC based closed-loop simulations followed by fetching visualizations of the results. From the theoretical point of view, non-convex obstacle avoidance constraints are tackled in two ways in OPTIPLAN: either by solving mixed-integer program using binary variables, or using time-varying constraints, which leads to a suboptimal solution, but the problem remains convex.