A* Pathfinding algorithm written in Python and PyGame