Hello,
I have been working with MPC for a while, using only linear constraints, and everything has been working fine. However, now I want to add some quadratic constraints to the problem and, even though the solver is able to find a solution, the constraints are not fulfilled.
The quadratic constraints represent distances between two points and look like this:
I've seen in some other posts that Prof. Löfberg advices to change some of the variables to make it easier, I've done it, but the problem persists.
In this case the equality constraint is not fulfilled, z12 is always 0.0325 even though x_h is always changing.
I would appreciate some help to be able to solve this.
Thank you very much!
Best regards,
Marc