System and Method for Controlling Motion of an Ego Vehicle

The present disclosure discloses a system and a method for controlling motion of an ego vehicle. The method includes collecting a feedback signal indicative of a current state of the ego vehicle and an environment, processing the feedback signal to determine a region of the state of the ego vehicle uplifted with admissible values of a control parameter, processing the feedback signal with a nominal controller to produce a nominal control command maintaining the state of the ego vehicle within the determined region, and evaluating a state function of an evasive controller with a value of the control parameter from the determined region to produce an evasive control command. The method further includes controlling the motion of the ego vehicle according to the nominal control command when the fault is not detected; and otherwise controlling the motion of the ego vehicle according to the evasive control command.