Robust hierarchical controller with conditional integrator based on small gain theorem for reference trajectory tracking of autonomous vehicles

A robust trajectory tracking controller is designed for autonomous vehicles based on a hierarchical architecture to make the autonomous vehicle track a given reference trajectory. The controller consists of two sub controllers: kinematic controller and dynamic controller. Based on the kinematics of tracking reference trajectory, a desired yaw rate is calculated by kinematic controller to make the lateral deviation global asymptotic stable. Then, steering wheel angle is calculated by a vehicle dynamic controller to make the vehicle yaw rate converge to the desired value and make the vehicle dynamic stable. Conditional integration method is used in the sub controllers. This method guarantees global asymptotic stability of tracking reference values and considers the uncertainty of parameters and constraints of desired yaw rate and actuators. Then based on small-gain theorem, the condition of the finite-gain L stability is given to the hierarchical controller to ensure the interconnected sub systems stable and prevent the amplification of system disturbance. Finally, the effectiveness and robustness of the controller are validated by real vehicle experiments.