Fixing header inclusion in the qpdoomed based ocp solver
OCP based on HPMPC stuff updated