#include "RobotModelRBDL.hpp"
#include "tools/URDFTools.hpp"
#include <rbdl/rbdl_utils.h>
#include <rbdl/addons/urdfreader/urdfreader.h>
#include "../tools/Logger.hpp"
#include <tinyxml2.h>