Update A* Algorithm (using arrays_in progress))