Full to-goal planning demo is up and running. Runs a Newton's method starting from a greedy rollout.