updated motion graph with computesucc and added heuristic_astar