Small speedup in Point2DSpace by making Point2D a strict data type
RRT now stops running when it's within a fixed distance from the goal state. By the way, RRT from the prior commits wasn't even being generated correctly at all!