Refactor PathFind()
Undid refactor, added search algorithm
Added tilefinding test