SYSTEMS AND METHODS FOR DECISION MAKING FOR AUTONOMOUS VEHICLES

A control system for controlling a motion of an ego-vehicle traveling to a target destination is provided. The control system includes a memory and a processor to execute instruction stored by the memory. The memory stores multiple trajectory-generating functions corresponding to a maneuver defined by a parameter vector associated with a driving decision. The parameter vector is defined by one or multiple parameters. Each of the multiple trajectory-generating functions is configured to generate an achieving sequence of regions of states and values of the parameter vector reaching an input target region within a prediction horizon. The stored instructions cause the control system to test control admissibility of at least some of the driving decisions consistent with the target destination of the ego-vehicle at a current state. The stored instruction also caused the control system to control the ego-vehicle according to one of the admissible driving decisions.