#include <Debug.hh>
#include <Mathematics/FootConstraintsAsLinearSystem.hh>
#include <fstream>
#include <iostream>