Graph generation motion planning