Started work on A* algorithm