# US 2022/0089151 A1 · Path planning in autonomous driving environments

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2022/0089151 A1
- Document ID: US20220089151A1
- Status: Published application
- Kind: A1
- Application number: 17/477,906
- Filed: 2021-09-17
- Published: 2022-03-24
- Earliest claimed: 2020-09-18
- Assignees: Zenuity AB
- Applicants: Zenuity AB
- Inventors: Magnus GYLLENHAMMAR; Håkan SIVENCRONA
- Web page: https://patentgrep.com/patent/US20220089151A1

## CPC

- B60W 30/09: Taking automatic action to avoid collision, e.g. braking and steering
- G01C 21/3407: {specially adapted for specific applications}
- B60W 60/0011: {involving control alternatives for a single driving scenario, e.g. planning several paths to avoid obstacles}
- B60W 60/0016: {of the vehicle or its occupants}
- G08G 1/166: {for active traffic, e.g. moving vehicles, pedestrians, bikes}
- B60W 2555/20: Ambient conditions, e.g. wind or rain
- G01C 21/3461: {Preferred or disfavoured areas, e.g. dangerous zones, toll or emission zones, intersections, manoeuvre types or segments such as motorways, toll roads or ferries}
- G01C 21/3807: {characterised by the type of data}
- G01C 21/3833: {characterised by the source of data}
- B60W: CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- G01C: MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY (measuring liquid level G01F; radio navigation, determining distance or velocity by use of propagation effects, e.g. Doppler effects, propagation time, of radio waves, analogous arrangements using other waves G01S)
- G08G: TRAFFIC CONTROL SYSTEMS (guiding railway traffic, ensuring the safety of railway traffic B61L; arrangement of road signs or traffic signals E01F9/00; radar or analogous systems, sonar systems, lidar systems specially adapted for traffic control G01S13/91, G01S15/88, G01S17/88; {radar or analogous systems, sonar systems, lidar systems specially adapted for anti-collision purposes G01S13/93, G01S15/93, G01S17/93})

## Abstract

A path planning method and system for a vehicle. The method includes obtaining risk map of a surrounding environment of vehicle. Risk map is formed based on an actuation capability of the vehicle and location of free-space areas in the surrounding environment, actuation capability including uncertainty estimation for actuation capability and the location of free-space areas comprising an uncertainty estimation for the estimated location of free-space areas. Risk map includes risk parameter for each of a plurality of area segments included in the surrounding environment of the vehicle. Obtaining at least one candidate path for vehicle, determining total risk value for each candidate path based on risk parameters of a set of area segments intersected by the at least one path, selecting a candidate path, of at least one candidate path, fulfilling a risk value criterion, and generating, at an output, a first signal indicative of selected candidate path.

## Claims

### Claim 1

A path planning method for a vehicle, the method comprising:
obtaining a risk map of a surrounding environment of the vehicle, wherein the risk map is formed based on an actuation capability of the vehicle and a location of free-space areas in the surrounding environment, the actuation capability including an uncertainty estimation for the actuation capability and the location of free-space areas comprising an uncertainty estimation for the estimated location of free-space areas;
wherein the risk map comprises a risk parameter for each of a plurality of area segments comprised in the surrounding environment of the vehicle;
obtaining at least one candidate path for the vehicle;
determining a total risk value for each candidate path based on the risk parameters of a set of area segments intersected by the at least one path;
selecting a candidate path, of the at least one candidate path, fulfilling a risk value criterion; and
generating, at an output, a first signal indicative of the selected candidate path.

### Claim 2 (depends on 1)

The method according to claim 1, further comprising:
determining a back-up path from the at least one candidate path, the back-up path having the lowest total risk value relative to any other candidate path of the at least one candidate path; and
generating, at an output, a second signal indicative of the determined back-up path.

### Claim 3 (depends on 1)

The method according to claim 1, further comprising:
if no candidate path is fulfilling the risk value criterion, generating, at an output, a request signal indicative of a request for new candidate paths.

### Claim 4 (depends on 1)

The method according to claim 1, wherein the step of obtaining each candidate path comprises:
generating at least one path from a starting position of the vehicle to a goal position of the vehicle, each generated path having a set of quality parameters; and
comparing the quality parameters of each path with a set of quality criteria in order to generate at least one candidate path having a set of quality parameters fulfilling the set of quality criteria.

### Claim 5 (depends on 1)

The method according to claim 1, wherein the risk value criterion is a maximum risk value threshold and the set of quality parameters of each path candidate path are indicative of a quality score of each candidate path; and
wherein the step of selecting the candidate path fulfilling the risk value criterion comprises:
selecting the candidate path having the highest quality score and having a total risk value below the maximum risk value threshold.

### Claim 6 (depends on 1)

The method according to claim 1, wherein the step of determining the total risk value for each candidate path comprises:
aggregating the risk parameters of the set of area segments intersected by each candidate path; and
determining the total risk value for each candidate path based on the aggregated risk parameters.

### Claim 7 (depends on 1)

The method according to claim 1, wherein the step of determining the total risk value for each candidate path comprises:
analysing a risk gradient of each candidate path, the risk gradient being indicative of a change in the risk parameters of adjacent area segments intersected by each candidate path; and
determining the total risk value for each candidate path based on the analysed risk gradient.

### Claim 8 (depends on 1)

The method according to claim 1, wherein the step of determining the total risk value for each candidate path comprises:
determining the area segment having the highest risk parameter intersected by each candidate path, in order to obtain a value of a highest risk zone entered by each candidate path; and
determining the total risk value for each candidate based on the obtained value of the highest risk zone entered by each candidate path.

### Claim 9 (depends on 1)

The method according to claim 1, wherein each risk parameter is indicative of at least one of a probability of an accident event if a candidate path were to intersect an associated area segment and a probability of violating a predefined safety threshold if a candidate path were to intersect an associated area segment.

### Claim 10 (depends on 1)

The method according to claim 1, wherein the location of free-space areas comprises:
a position of external objects located in the surrounding environment of the vehicle, and wherein the estimated position of the external objects includes uncertainties of the position of the external objects, trajectories of any dynamic objects of the external objects and uncertainties of the estimated trajectories of the dynamic objects.

### Claim 11 (depends on 1)

A non-transitory computer-readable storage medium storing one or more instructions configured to be executed by one or more processors of an in-vehicle processing system, the one or more instructions for performing the method according to claim 1.

### Claim 12

A path planning system for a vehicle, the path planning system comprising control circuitry configured to:
obtain a risk map of a surrounding environment of the vehicle, wherein the risk map is based on an actuation capability of the vehicle and a location of free-space areas in the surrounding environment, the actuation capability including an uncertainty estimation for the actuation capability and the location of free-space areas comprising an uncertainty estimation for the estimated location of free-space areas;
wherein the risk map comprises a risk parameter for each of a plurality of area segments comprised in the surrounding environment of the vehicle;
obtain at least one candidate path for the vehicle;
determine a total risk value for each candidate path based on the risk parameters of a set of area segments intersected by each candidate path;
select a candidate path, of the at least one candidate path, fulfilling a risk value criterion; and
generate, at an output, a first signal indicative of the selected candidate path.

### Claim 13

A vehicle comprising:
an Automated Driving System, ADS;
a perception system comprising at least one sensor configured to monitor a surrounding environment of the ground vehicle;
a vehicle control system comprising at least one sensor configured to monitor an actuation capability of the vehicle;
a localization system configured to monitor a geographical map position of the ground vehicle;
a path planning system for a vehicle, the path planning system comprising
control circuitry configured to:
obtain a risk map of a surrounding environment of the vehicle, wherein the risk map is based on an actuation capability of the vehicle and a location of free-space areas in the surrounding environment, the actuation capability including an uncertainty estimation for the actuation capability and the location of free-space areas comprising an uncertainty estimation for the estimated location of free-space areas;
wherein the risk map comprises a risk parameter for each of a plurality of area segments comprised in the surrounding environment of the vehicle;
obtain at least one candidate path for the vehicle;
determine a total risk value for each candidate path based on the risk parameters of a set of area segments intersected by each candidate path;
select a candidate path, of the at least one candidate path, fulfilling a risk value criterion; and
generate, at an output, a first signal indicative of the selected candidate path.
