One common approach to the design of control systems forautonomous vehicles is to utilize a hierarchical control struc-ture (see Fig. 1), wherein a higher level outer-loop controllergenerates reference trajectories for the lower level inner-loopcontroller, which, in turn, determines the steering angle andacceleration/deceleration inputs required to track the referencetrajectory [8].