IDAStarSolver implementation