Just a little suggestion for an improvement. A couple of times now I've had wierd behaviour, and struggled with a bug hunt until noticing it's because I reference a geom object instead of a body in dBodyDisable(obj\geom). It'd be nice if a compile error was generated when the wrong object type was passed to ODE functions, if that's possible.