Get OTP rigid body working again

and simplify it down to the simplest case