Added RRT Connect version for problem 2d