Added AssertCloseEnough to Point, should have been committed with
PathPlanningTest.