Some optimizations and more detailed README
ODE stepper is resetted after trajectory change, speeding up integration quite a bit
More robust geometry collision point iteration
Some more information in README