Simple EMPC implementation based on the paper of Hovgaard - View it on GitHub