Added RRTConnect planner