#include <vector>
#include <abstract-robot-dynamics/fwd.hh>
#include <abstract-robot-dynamics/joint.hh>