Sorta RRT working