#include "tsid/math/utils.hpp"
#include "tsid/contacts/contact-two-frame-positions.hpp"
#include <pinocchio/spatial/skew.hpp>