Cleaned up pathfind function in tileMap.cpp

mostly just removed commented out code and made the pathfind function
slightly more readable