Holistic planning with multiple intentions for self-driving cars

Patent metadata

Field	Value
Publication number	US-10591920-B2
Application number	US-201715604437-A
Country	US
Kind code	B2
Filing date	May 24, 2017
Priority date	May 24, 2017
Publication date	Mar 17, 2020
Grant date	Mar 17, 2020

Abstract

Aspects of the disclosure are related to a method, apparatus and system for joint motion planning and trajectory estimation, comprising: determining a cost function to describe system kinematics comprising trajectories, speeds, and accelerations of a host vehicle and of one or more other vehicles for each possible intention of the host vehicle and of the other vehicles, wherein the trajectories are described with spline functions; and determining jointly the trajectories of the host vehicle and of the other vehicles.

First claim

What is claimed is:

1. A method for joint motion planning and trajectory estimation, comprising:
sensing, by one or more sensors of a host vehicle, whether one or more other vehicles are in the vicinity of the host vehicle;
determining a cost function to describe system kinematics comprising trajectories, speeds, and accelerations of the host vehicle and of the one or more other vehicles in the vicinity of the host vehicle for each possible intention of the host vehicle and of the other vehicles in the vicinity of the host vehicle, wherein the trajectories are described with spline functions;
determining jointly the trajectories of the host vehicle and of the other vehicles in the vicinity of the host vehicle; and
generating control signals for the host vehicle based on the determined trajectories of the host vehicle and of the other vehicles in the vicinity of the host vehicle, wherein the control signals are used to minimize accumulated speed change.

2. The method of claim 1 , wherein the cost function is based on a vehicle sensor model and/or kinematics.

3. The method of claim 1 , wherein the cost function is based on a road model.

4. The method of claim 3 , wherein the road model imposes a boundary distance limit.

5. The method of claim 1 , wherein the control signals minimize accumulated steering angle change.

6. The method of claim 1 , wherein the trajectories are represented by piecewise continuous splines.

7. A host vehicle apparatus for joint motion planning and trajectory estimation, comprising:
one or more sensors configured to detect road and vehicle parameters, including whether one or more other vehicles are in the vicinity of a host vehicle;
a memory configured to store code and data; and
a processor coupled to the memory, the processor configured to:
determine a cost function to describe system kinematics comprising trajectories, speeds, and accelerations of the host vehicle and of the one or more other vehicles in the vicinity of the host vehicle for each possible intention of the host vehicle and of the other vehicles in the vicinity of the host vehicle, wherein the trajectories are described with spline functions;
determine jointly the trajectories of the host vehicle and of the other vehicles in the vicinity of the host vehicle; and
generate control signals for the host vehicle based on the determined trajectories of the host vehicle and other vehicles within the vicinity of the host vehicle, wherein the control signals minimize accumulated speed change.

8. The host vehicle apparatus of claim 7 , wherein the cost function is based on a vehicle sensor model and/or kinematics.

9. The host vehicle apparatus of claim 7 , wherein the cost function is based on a road model.

10. The host vehicle apparatus of claim 9 , wherein the road model imposes a boundary distance limit.

11. The host vehicle apparatus of claim 7 , wherein the control signals minimize accumulated steering angle change.

12. The host vehicle apparatus of claim 7 , wherein the trajectories are represented by piecewise continuous splines.

13. An apparatus for joint motion planning and trajectory estimation, comprising:
means for sensing, by one or more sensors of a host vehicle, whether one or more other vehicles are in the vicinity of the host vehicle;
means for determining a cost function to describe system kinematics comprising trajectories, speeds, and accelerations of the host vehicle and of one or more other vehicles in the vicinity of the host vehicle for each possible intention of the host vehicle and of the other vehicles in the vicinity of the host vehicle, wherein the trajectories are described with spline functions;
means for determining jointly the trajectories of the host vehicle and of the other vehicles in the vicinity of the host vehicle; and
means for generating control signals for the host vehicle based on the determined trajectories of the host vehicle and other vehicles within the vicinity of the host vehicle, wherein the control signals minimize accumulated speed change.

14. The apparatus of claim 13 , wherein the cost function is based on a vehicle sensor model and/or kinematics.

15. The apparatus of claim 13 , wherein the cost function is based on a road model.

16. The apparatus of claim 15 , wherein the road model imposes a boundary distance limit.

17. The apparatus of claim 13 , wherein the control signals minimize accumulated steering angle change.

18. The apparatus of claim 13 , wherein the trajectories are represented by piecewise continuous splines.

19. A non-transitory computer-readable medium comprising code which, when executed by a processor, causes the processor to perform a method, comprising:
sensing, by one or more sensors of a host vehicle, whether one or more other vehicles are in the vicinity of the host vehicle;
determining a cost function to describe system kinematics comprising trajectories, speeds, and accelerations of the host vehicle and of one or more other vehicles in the vicinity of the host vehicle for each possible intention of the host vehicle and of the other vehicles in the vicinity of the host vehicle, wherein the trajectories are described with spline functions;
determining jointly the trajectories of the host vehicle and of the other vehicles in the vicinity of the host vehicle; and
generating control signals for the host vehicle based on the determined trajectories of the host vehicle and other vehicles within the vicinity of the host vehicle, wherein the control signals minimize accumulated speed change.

20. The non-transitory computer-readable medium of claim 19 , wherein the cost function is based on a vehicle sensor model and/or kinematics.

21. The non-transitory computer-readable medium of claim 19 , wherein the cost function is based on a road model.

22. The non-transitory computer-readable medium of claim 21 , wherein the road model imposes a boundary distance limit.

Assignees

• Qualcomm Inc

Inventors

• Lv Zhaoyang
• Aghamohammadi Aliakbar

Classifications

• G01C21/3453

  Special cost functions, i.e. other than distance or default speed limit of road segments · CPC title

• G08G1/167

  Driving aids for lane monitoring, lane changing, e.g. blind spot detection · CPC title

• G01C21/3407

  specially adapted for specific applications · CPC title

• G08G1/161

  Decentralised systems, e.g. inter-vehicle communication · CPC title

• G05D1/0217 Primary

  in accordance with energy consumption, time reduction or distance reduction criteria · CPC title