More complete implementation of A* pathing