CasADi-MPC-drone Original code for mpc_casadi.py: https://gist.github.com/gmsanchez/33a594e00fd348b7ed11