A margin-based approach to threat assessment for autonomous highway navigation

In this paper we present a new approach to the threat assessment problem for semi-autonomous and fully autonomous vehicles, based on the estimation of the control freedom afforded to a vehicle. Given sensor information available about the surrounding environment, an algorithm is described for identifying fields of safe travel through which the vehicle can safely navigate. Within each candidate field, we then characterize the level of threat, to influence autonomous navigation or driver support inputs. To characterize threat, the fields of safe travel are associated with sets of feasible trajectories generated from a lattice sampled in the vehicle´s input space. A planner then computes a metric associated with available control freedom from these sampled trajectories. This method potentially allows a semi-autonomous control system to honor safe driver inputs while ensuring safe and robust navigation properties. It could also serve as an input to an autonomous decision-making layer.