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