Pushing my hw3 RRT code.