#include "RobotModelHyrodyn.hpp"
#include <urdf_parser/urdf_parser.h>
#include "../../tools/URDFTools.hpp"
#include "../../tools/Logger.hpp"
#include <tinyxml2.h>