Integrated motion planning and control for automated vehicles up to the limits of handling