Connected and automated vehicles (CAVs) have shown the potential to improve safety, increase road throughput, and optimize energy efficiency and emissions in several complicated traffic scenarios. This invention describes a mixed-integer programming (MIP) optimization method for global multi-vehicle decision making and motion planning of CAVs in a highly dynamic environment that consists of multiple human-driven, i.e., conventional or manual, vehicles and multiple conflict zones, such as merging points and intersections. The proposed approach ensures safety, high throughput and energy efficiency by solving a global multi-vehicle constrained optimization problem. The solution provides a feasible and optimal time schedule through road segments and conflict zones for the automated vehicles, by using information from the position, velocity, and destination of the manual vehicles, which cannot be directly controlled. Despite MIP having combinatorial complexity, the proposed formulation remains feasible for real-time implementation in the infrastructure, such as in mobile edge computers (MECs).

The invention relates to a method for adjusting fully automatic vehicle guidance functions, which are realized by means of a vehicle system of a motor vehicle, during the operation of the motor vehicles in a predefined navigation environment. A stationary infrastructure device that communicates with the motor vehicles is associated with the navigation environment. Function limits of each vehicle guidance function are defined by means of limit operation parameters of the vehicle guidance function. Current traffic situation information describing dynamic objects in the navigation environment is determined by the infrastructure device by means of environment sensors of the navigation environment. The current traffic situation information is used, together with a digital map describing stationary objects and properties of the navigation environment, to determine at least one piece of risk information for each motor vehicle.

Systems, device, and methods for trajectory association and tracking are provided. A method can include obtaining input data indicative of a respective trajectory for each of one or more first objects for a first time step and input data indicative of a respective trajectory for each of one or more second objects for a second time step subsequent to the first time step. The method can include generating, using a machine-learned model, a temporally-consistent trajectory for at least one of the one or more first objects or the one or more second objects based at least in part on the input data and determining a third predicted trajectory for the at least one of the one or more first objects or the one or more second objects for at least the second time step based at least in part on the temporally-consistent trajectory.

Ego actions for a mobile robot in the presence of at least one agent are autonomously planned. In a sampling phase, a goal for an agent is sampled from a set of available goals based on a probabilistic goal distribution, as determined using an observed trajectory of the agent. An agent trajectory is sampled, from a set of possible trajectories associated with the sampled goal, based on a probabilistic trajectory distribution, each trajectory of the set of possible trajectories reaching a location of the associated goal. In a simulation phase, an ego action is selected from a set of available ego actions and based on the selected ego action, the sampled agent trajectory, and a current state of the mobile robot, (i) behaviour of the mobile robot, and (ii) simultaneous behaviour of the agent are simulated, in order to assess the viability of the selected ego action.

Methods and systems for controlling navigation of a vehicle are disclosed. The system will first detect a URU within a threshold distance of a drivable area that a vehicle is traversing or will traverse. The system will then receive perception information relating to the URU, and use a plurality of features associated with each of a plurality of entry points on a drivable area boundary that the URU can use to enter the drivable area to determine a likelihood that the URU will enter the drivable area from that entry point. The system will then generate a trajectory of the URU using the plurality of entry points and the corresponding likelihoods, and control navigation of the vehicle while traversing the drivable area to avoid collision with the URU.

A method for monitoring the environment of a vehicle includes evaluating physical measurement data obtained from the environment of the vehicle to determine whether at least one person is approaching the vehicle, how many people approach the vehicle may also be recorded. The method includes evaluating physical measurement data obtained from the environment of the vehicle to determine whether at least one person is moving away from the vehicle and, if appropriate, the number of people that are moving away from the vehicle is also recorded. The method further includes carrying out a check as to whether the number of people that have moved away from the vehicle corresponds to the number of people that have previously approached the vehicle. In response to the check resulting in a difference, it is determined that the vehicle is in an unsafe state.

An agricultural system includes a target vehicle configured to harvest crops and a work vehicle. The work vehicle includes a controller. The controller includes a memory and a processor, and the controller is configured to receive or determine a plurality of vehicle paths as well as a location of the target vehicle. The controller is also configured to identify an active path of the plurality of vehicle paths based on the location of the target vehicle. The target path is a path traversed by the target vehicle.

A cruise control device 10 includes a cutting-in/deviation determination unit 12 for performing cutting-in determination and deviation determination of another vehicle. The cutting-in/deviation determination unit 12 calculates a lateral position that is a position in a vehicle width direction of a forward vehicle 51 traveling ahead of an own vehicle 50, and determines the forward vehicle 51 traveling on an adjacent lane 64 to be a cutting-in vehicle into an own lane 63 and determines the forward vehicle 51 traveling on the own lane 63 to be a deviating vehicle from the own lane 63 on the basis of the calculated lateral position. The cutting-in/deviation determination unit 12 determines whether or not the own vehicle 50 is in a predetermined own vehicle turning state that is either one of a state before starting a turn or a state of turning, and determines permission of performing of cutting-in determination and deviation determination of the other vehicle on the basis of the determination result.

An information processing system, including: a surveillance camera that detects a plurality of obstacles in the vicinity of a specific vehicle; a first determiner that determines whether an unidentified obstacle, which is included in the plurality of obstacles and is not visible from the specific vehicle, is present based on first information regarding the plurality of obstacles detected by the surveillance camera and vehicle information indicating the specific vehicle; and a first communicator that outputs information indicating the unidentified obstacle to the specific vehicle when the first determiner determines that the unidentified obstacle is present.

Methods, systems, and apparatus, including computer programs encoded on computer storage media, for agent trajectory prediction using anchor trajectories.