#include "tsid/math/utils.hpp"
#include "tsid/contacts/contact-6d.hpp"
#include <pinocchio/spatial/skew.hpp>