#include <assert.h>
#include <ode_robots/joint.h>
#include <ode_robots/nimm2.h>
#include "robotchain.h"