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