Add time measurement
Add different types of astar