Added rotation to astar Heuristic