Worked on A* implementation