Path following

In this paper, the problem of vehicle guidance by means of an external leader is described. The objective is to navigate a four-wheeled vehicle through unstructured environments, characterized by the lack of availability of typical guidance infrastructure like lane markings or HD maps. The trajectory-following approach is based on an estimate of the leader’s path. For that, position measurements are stored over time with respect to an inertial frame. A new strategy is proposed to rate the  significance of position measurements and ensure that a certain threshold of stored samples is not exceeded. Having an estimate of the leader path is essential to prevent the cutting-corner phenomenon and for exact path following in general. A spline-approximation technique is applied to obtain a smooth reference path for the underlying lateral and longitudinal motion controllers. For longitudinal tracking, a constant time-headway policy was implemented, to follow the leader with a constant time gap along the estimated path. The algorithm was first developed and tested in a simulation framework and then deployed in a demonstrator vehicle for validation under real operating conditions. The presented experimental results were achieved using only on-board sensors of the demonstrator vehicle, while high-accuracy differential GPS-based position measurements serve as the ground truth data for visualization.

This paper proposes a mode switching supervisory controller for autonomous vehicles. The supervisory controller selects the most appropriate controller based on safety constraints and on the vehicle location with respect to junctions. Autonomous steering, throttle and deceleration control inputs are used to perform variable speed lane keeping assist, standard or emergency braking and to manage junctions, including roundabouts. Adaptive model predictive control with lane keeping assist is performed on the main roads and a linear pure pursuit inspired controller is applied using waypoints at road junctions where lane keeping assist sensors present a safety risk. A multi-stage rule based autonomous braking algorithm performs stop, restart and emergency braking maneuvers. The controllers are implemented in MATLAB® and Simulink™ and are demonstrated using the Automatic Driving Toolbox™ environment. Numerical simulations of autonomous driving scenarios demonstrate the efficiency of the lane keeping assist mode on roads with curvature and the ability to accurately track waypoints at cross intersections and roundabouts using a simpler pure pursuit inspired mode. The ego vehicle also autonomously stops in time at signaled intersections or to avoid collision with other road users.