US Patent 11231715 Method and system for controlling a vehicle

Method and system for controlling a vehicle that includes using velocity vectors of obstacles in the vehicle's environment to determining boundaries of the one or more obstacles and thereby generate a velocity space that may include velocity vectors for the vehicle and which are represented as collision cones. The using an identified velocity vector in combination with the velocity vectors of the one or more obstacles to produce a maximum motion in of the vehicle towards a target location while avoiding all determined collision cones.