Manoeuver generation for automated driving

Patent metadata

Field	Value
Publication number	US-9469296-B2
Application number	US-201414478664-A
Country	US
Kind code	B2
Filing date	Sep 5, 2014
Priority date	Sep 12, 2013
Publication date	Oct 18, 2016
Grant date	Oct 18, 2016

Abstract

A method and arrangement are described for manoeuvre generation for automated driving on a one-way road of a vehicle (e) hosting the arrangement, the host vehicle (e) further including one or more advanced driver assistance systems. A collision free reference trajectory for longitudinal and lateral movement of the host vehicle (e) is determined repeatedly, with a fix time interval, for allowing the host vehicle (e) to retain a desired velocity and maintain the host vehicle (e) in a preferred lane utilizing model predictive control and quadratic program formulation. A control scheme where the structured environment of the one-way road is exploited in order to linearly formulate collision avoidance constraints is utilized. Manoeuvre generation is performed through solving the quadratic program. The one or more advanced driver assistance systems are controlled to perform the generated manoeuvre.

First claim

What is claimed is:

1. An arrangement for maneuver generation for automated driving on a one-way road of a vehicle (e) hosting the arrangement, the host vehicle (e) comprising one or more advanced driver assistance systems, the arrangement comprising:
a controller configured to repeatedly determine a collision free reference trajectory for longitudinal and lateral movement of the host vehicle (e) allowing the host vehicle (e) to retain a desired velocity and maintain the host vehicle (e) in a preferred lane of a road utilizing model predictive control formulated as a quadratic program;
a communications interface for providing communication between the controller and the one or more advanced driver assistance systems;
the controller further being configured to utilize a control scheme where a structured environment of the one-way road is exploited in order to linearly formulate collision avoidance constraints;
the controller further being configured to perform the maneuver generation through solution of the quadratic program,
the controller further being configured to control the one or more advanced driver assistance systems to perform the generated maneuver.

2. The arrangement according to claim 1 wherein the controller is configured to determine the collision free reference trajectory for longitudinal and lateral movement of the host vehicle (e) through solving an optimization problem minimizing a path performance index subject to dynamics of the host vehicle (e), convenience/comfort constraints and safety constraints.

3. The arrangement according to claim 2 , wherein the controller is configured to use a set of difference equations to model the host vehicle (e) dynamics relative to surrounding vehicles (i) in a road aligned coordinate frame.

4. The arrangement according to claim 2 , wherein the controller is configured to use a set of convenience/comfort constraints for determination of convenient and smooth trajectories for longitudinal and lateral movement of the host vehicle (e).

5. The arrangement according to claim 1 , wherein the controller is configured to use a set of collision constraints to ensure the host vehicle (e) is restricted to stay outside safety critical regions, which set includes one or more of a requirement that the vehicle stays on the road, forward collision constraints, and rear collision constraints.

6. The arrangement according to claim 1 wherein the one or more advanced driver assistance systems, comprises at least one of an adaptive cruise control and a lane keeping aid system, including actuators and sensors associated therewith.

7. An arrangement for maneuver generation for automated driving of a vehicle on a one-way road, the arrangement comprising:
a host vehicle (e) comprising one or more advanced driver assistance systems:
a controller configure to repeatedly determine a collision free reference trajectory for longitudinal and lateral movement of the host vehicle (e) allowing the host vehicle (e) to retain a desired velocity and maintain the host vehicle (e) in a preferred lane of a road utilizing model predictive control formulated as a quadratic program;
a communications interface for providing communication between the controller and the one or more advanced driver assistance systems:
the controller further being configured to utilize a control scheme where a structured environment of the one-way road is exploited in order to linearly formulate collision avoidance constraints:
the controller further being configured to perform the maneuver generation through solution of the quadratic program,
the controller further being configured to control the one or more advanced driver assistance systems to perform the generated maneuver.

8. A method for maneuver generation for automated driving on a one-way road of a host vehicle (e) comprising one or more advanced driver assistance systems and a controller, the method comprising:
repeatedly determining, by the controller, a collision free reference trajectory for longitudinal and lateral movement of the host vehicle (e) allowing the host vehicle (e) to retain a desired velocity and maintain the host vehicle (e) in a preferred lane utilizing model predictive control formulated as a quadratic program;
utilizing, by the controller, a control scheme where the structured environment of the one-way road is exploited in order to linearly formulate collision avoidance constraints;
performing the maneuver generation through the controller solving the quadratic program; and
controlling the one or more advanced driver assistance systems to perform the generated maneuver.

9. The arrangement according to claim 2 wherein the controller is configured to use a set of difference equations to model the host vehicle (e) dynamics relative to surrounding vehicles (i) in a road aligned coordinate frame, the set of difference equations comprising:
Δ x i k =Δx i k−1 +v i s h−v x k−1 h;

y k =y k−1 +v y k h;
v x k =v x k−1 +a x k h ; and
v y k =v y k−1 +a y k h;
wherein,
Δx i k is a longitudinal distance between a surrounding vehicle i and the host vehicle e at a time instance k;
Δx i k−1 is a longitudinal distance between the surrounding vehicle i and the host vehicle e at a previous time instance k−1;
v i s is a longitudinal velocity of the surrounding vehicle i at the instance k;
h is a sampling time;
v x k−1 is a longitudinal velocity of the host vehicle e at the previous instance k −1;
y k is a lateral position of the host vehicle e at the time instance k;
y k−1 is a lateral position of the host vehicle e at the time instance k−1;
v y k is a lateral position of the host vehicle e at the previous instance k;
v x k is a longitudinal velocity of the host vehicle e at the instance k;
v i k−1 is a longitudinal velocity of the host vehicle e at the previous instance k −1;
a x k is a longitudinal acceleration of the host vehicle e at the instance k;
v y k is a lateral velocity of the host vehicle e at the instance k;
v y k−1 is a lateral velocity of the host vehicle e at the previous instance k −1; and
a y k is a lateral acceleration of the host vehicle e at the sampling instance k.

10. The arrangement according to claim 2 wherein the controller is configured to use a set of convenience/comfort constraints for determination of convenient and smooth trajectories for longitudinal and lateral movement of the host vehicle (e), the set of convenience/comfort constraints comprising:
(a) 0≦v x k ≦v ref , wherein v x k is a longitudinal velocity of the host vehicle e at a specific time instance k, and v ref is a specified reference longitudinal velocity;
(b) v y min ≦v y k ≦v y max , wherein v y k is a lateral velocity of the host vehicle e at the instance k, v y min is a minimum lateral velocity, and v y max is a maximum lateral velocity;
(c) a x min ≦a x k ≦a x max , wherein a x k is a longitudinal acceleration of the host vehicle e at the instance k, a x min is a minimum longitudinal acceleration, and a x max is a maximum longitudinal acceleration;
(d) a y min ≦a y k ≦a y max , wherein a y k is a lateral acceleration of the host vehicle e at the instance k, a y min is a minimum lateral acceleration, and a y max is a maximum lateral acceleration;
(e) Δa x min ≦Δa x k ≦Δa x max , wherein Δa x k is a difference between a longitudinal acceleration of the

Assignees

• Volvo Car Corp

Inventors

• Nilsson Julia
• Ali Mohammad

Classifications

• B60W50/0098

  Details of control systems ensuring comfort, safety or stability not otherwise provided for · CPC title

• Y02T10/84

  Data processing systems or methods, management, administration · CPC title

• B60W2552/05

  Type of road, e.g. motorways, local streets, paved or unpaved roads · CPC title

• B60W30/08 Primary

  Active safety systems} predicting or avoiding probable or impending collision {or attempting to minimise its consequences · CPC title

• B60W50/0097 Primary

  Predicting future conditions · CPC title