A method of controlling a vehicle having an automated driving system configured to control vehicle steering includes determining a commanded vehicle path. The method additionally includes calculating a steering command to satisfy the commanded vehicle path. The method also includes controlling vehicle steering, via the automated driving system, according to the steering command. The method further controls detecting a difference between an actual vehicle path and the commanded vehicle path, and, in response to the detected difference, controlling the vehicle according to a secondary mode.