Implement safe MPC agent for reference

[stheid]

Use the Gekko library and try to get a controller that achieves results similar to the LQR controller

Questions:

• Is a MPC controller linear or can it be better than the optimal LQR controller?
• how does int compare to PPO