#include "QPOasesSolver.hpp"
#include "../../core/QuadraticProgram.hpp"
#include <Eigen/Core>
#include <iostream>
#include "../../tools/Logger.hpp"