RECURSIVE, REAL-TIME CAPABLE, INTERACTION-AWARE METHODS OF PLANNING MOTIONS FOR AUTONOMOUS VEHICLES

摘要

The invention is notably directed to computer-implemented method of planning motion of a vehicle. The method comprises receiving (S20) real-time signals as to positions of N traffic participants. At each time step of multiple time steps, the method plans (S50) motion for the vehicle by computing (S30) states of each of the N traffic participants according to the signals received (S20). Said states include current states, which are estimated for each of the N traffic participants, as well as future states of each of the participants, wherein the future states are predicted over a prediction horizon T. This is achieved using an interaction-aware model of the N traffic participants. This model is designed to cause the method to recursively compute (S32 - S38), at said each time step, the states of each of the N traffic participants according to a hierarchical list. The N traffic participants are ordered in the list from a most determinative one to a least determinative one of the N traffic participants. As a result, the states of the η-th participant in the list are computed based on the states of each of the η - 1 participants in the list, (formula (I)), This model is further designed to cause the method to update and sort (S40) the hierarchical list based on rules of the road, wherein the rules are evaluated based on the states of each of the N traffic participants as computed at said each time step. The invention is further directed to related computerized systems, vehicles, and computer program products.