The controller for quadrotor tracking are include 3 subcontrollers. They are Altititude controller , Position controller and Attitude controller. The detail of them are shown in the Figure below.
The MPC solver is using CasADi.
Implement 3 MPC controller without relation
- Implement LNMPC controller for stable behavior