#include <kdl_parser/RobotModelFormat.hpp>
#include <stdexcept>
#include <fstream>
#include <base-logging/Logging.hpp>