A* Search Algorithm pathfinding
Wrote the A* Search Algorithm, not yet implemented