Data-driven planning for automated driving