# US 2021/0173075 A1 · Methods and systems for determining an initial ego-pose for initialization of self-localization

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

- Number: US 2021/0173075 A1
- Document ID: US20210173075A1
- Status: Published application
- Kind: A1
- Application number: 17/106,710
- Filed: 2020-11-30
- Published: 2021-06-10
- Earliest claimed: 2019-12-05
- Assignees: Aptiv Technologies AG
- Applicants: Aptiv Technologies Limited
- Inventors: Ahmad PISHEHVARI; Stephanie LESSMANN
- Web page: https://patentgrep.com/patent/US20210173075A1

## CPC

- G01C 21/30: Map- or contour-matching
- G01S 13/89: for mapping or imaging
- G01C 21/206: {specially adapted for indoor navigation}
- G05D 1/024: {in combination with a laser (lasers per se H01S)}
- G05D 1/0274: {using mapping information stored in a memory device (navigation using map-matching G01C21/30)}
- 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)
- G01S: RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES

## Abstract

A computer-implemented method for determining an initial ego-pose for initialization of self-localization includes providing a plurality of particles in a map; grouping the particles in a plurality of clusters, each cluster comprising a respective subset of the plurality of particles; during particle filtering, injecting particles based on the plurality of clusters; and determining an initial ego-pose based on the particle filtering.

## Claims

### Claim 1

A computer-implemented method for determining an initial ego-pose for initialization of self-localization, the method comprising:
providing a plurality of particles in a map;
grouping the particles in a plurality of clusters, each cluster comprising a respective subset of the plurality of particles;
during particle filtering, injecting particles based on the plurality of clusters; and
determining an initial ego-pose based on the particle filtering.

### Claim 2 (depends on 1)

The computer-implemented method of claim 1, comprising determining a mean value and a variance of respective locations of a respective subject of particles for each of the clusters.

### Claim 3 (depends on 2)

The computer-implemented method of claim 2, wherein injecting particles based on the plurality of clusters comprises injecting the particles based on the respective mean value and the respective variance.

### Claim 4 (depends on 2)

The computer-implemented method of claim 2, comprising updating the respective mean value for each of the clusters based on a motion model.

### Claim 5 (depends on 2)

The computer-implemented method of claim 2, comprising updating the respective variance for each of the clusters based on an uncertainty propagation law.

### Claim 6 (depends on 1)

The computer-implemented method of claim 1, wherein the plurality of particles are provided based on at least one of a random distribution over the map, or an estimate of the ego-pose.

### Claim 7 (depends on 1)

The computer-implemented method of claim 1, wherein performing the particle filtering comprises: sample distribution, prediction, updating, and re-sampling.

### Claim 8 (depends on 1)

The computer-implemented method of claim 1, wherein the particles are grouped into the plurality of clusters based on at least one of a numbers of particles in a potential cluster, or a numbers of potential clusters.

### Claim 9 (depends on 1)

The computer-implemented method of claim 1, comprising
exhausting a cluster if it is outside a region of interest and/or
exhausting a part of a cluster if the part of the cluster is outside a region of interest.

### Claim 10 (depends on 1)

The computer-implemented method of claim 1, comprising receiving electromagnetic radiation emitted from at least one emitter of a sensor system of a vehicle and reflected in a vicinity of the vehicle toward the sensor system.

### Claim 11 (depends on 10)

The computer-implemented method of claim 10, wherein the particle filtering is performed based on the received electromagnetic radiation and based on the map.

### Claim 12 (depends on 1)

The computer-implemented method of claim 1, wherein the initial ego-position is determined based on entropy based monitoring based on a binary grid.

### Claim 13 (depends on 1)

A computer system configured to carry out the computer-implemented method of claim 1.

### Claim 14 (depends on 13)

A vehicle, comprising:
the computer system of claim 13, and
a sensor system adapted to receive electromagnetic radiation emitted from at least one emitter of the sensor system and reflected in a vicinity of the vehicle toward the sensor system, and the computer system of claim 13 configured for determining the initial ego-pose for initialization of self-localization of the vehicle.

### Claim 15 (depends on 1)

A non-transitory computer readable medium comprising instructions for carrying out the computer-implemented method of claim 1.
