motion planning improvements (CRRT)