A* Pathfinding Algorithm - START GOAL PATH OPEN LIST