rrt with basic shapes on path