#include "odehandle.h"
#include <assert.h>
#include <ode-dbl/ode.h>
#include <algorithm>
#include "primitive.h"