added loop script for rrt tests + waypoint interpolation in irreducible space