Add A* search (config A not working)