# US 2023/0054327 A1 · Collaborative localization of a vehicle using radiolocation

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

- Number: US 2023/0054327 A1
- Document ID: US20230054327A1
- Status: Published application
- Kind: A1
- Application number: 17/407,115
- Filed: 2021-08-19
- Published: 2023-02-23
- Earliest claimed: 2021-08-19
- Assignees: Toyota Research Institute, Inc.
- Applicants: Toyota Research Institute, Inc.
- Inventors: Hiroshi Yasuda; Manuel Ludwig Kuehner; Alexander Christoph Schaefer
- Web page: https://patentgrep.com/patent/US20230054327A1

## CPC

- G01S 5/021: {Calibration, monitoring or correction (G01S5/0252 takes precedence)}
- G01S 5/10: Position of receiver fixed by co-ordinating a plurality of position lines defined by path-difference measurements {, e.g. omega or decca systems}(G01S5/12 takes precedence {; beacons and receivers cooperating therewith G01S1/306, G01S1/308})
- G01C 21/3841: {Data obtained from two or more sources, e.g. probe vehicles}
- G01S 5/0284: {Relative positioning}
- G01S 5/0294: {Trajectory determination or predictive filtering, e.g. target tracking or Kalman filtering}
- G01S 19/01: Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S 1/042: {Transmitters}
- G01S 11/10: using Doppler effect
- G01S 2205/01: specially adapted for specific applications
- 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
- 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)

## Abstract

Systems and methods of collaborative localization for a vehicle are provided. In particular, one or more vehicles that are able to localize themselves with high accuracy may transmit timestamped localization information (i.e. localization packets) to a nearby vehicles which lack high-accuracy localization sensors. Each localization packet may include the location of the transmitting vehicle with respect to a global reference frame. Upon receiving the localization packets, a vehicle may use radiolocation techniques to estimate its location relative to the transmitting vehicle(s). Based on this estimation and the information in the localization packets, the vehicle may then estimate its location with respect to the global reference frame with a high degree of accuracy.

## Claims

### Claim 1

A vehicle comprising:
an electronic control unit (ECU) including machine executable instructions in non-transitory memory to perform a method comprising:
receiving one or more localization packets, each localization comprising a location of an associated transmitter vehicle with respect to a global reference frame and a transmission timestamp;
estimating a relative location for the vehicle using radiolocation, the relative location comprising a location of the vehicle relative to the one or more transmitter vehicles; and
estimating a collaborative localization for the vehicle, the collaborative localization comprising a location of the vehicle with respect to the global reference frame.

### Claim 2 (depends on 1)

The vehicle of claim 1, wherein estimating the relative location of the vehicle using radiolocation comprises:
calculating a distance between the vehicle and each of the one or more transmitter vehicles using the one or more transmission timestamps; and
estimating a location of the vehicle relative to the one or more transmitter vehicles.

### Claim 3 (depends on 1)

The vehicle of claim 1, wherein the method further comprises filtering the collaborative localization of the vehicle based on accuracy.

### Claim 4 (depends on 3)

The vehicle of claim 3, wherein filtering the collaborative localization of the vehicle comprises:
comparing the collaborative localization to a first localization estimated by a Global Positioning System (GPS) in the vehicle; and
excluding the collaborative localization when it exceeds a threshold deviation from the first localization estimate.

### Claim 5 (depends on 1)

The vehicle of claim 1, wherein the collaborative localization further comprises a trajectory of the vehicle with respect to the global reference frame.

### Claim 6 (depends on 5)

The vehicle of claim 5, wherein:
each localization packet further comprises a velocity of its associated transmitter vehicle with respect to the global reference frame; and
the method further comprises:
estimating one or more relative velocities, each relative velocity comprising a velocity of the vehicle relative to a transmitter vehicle; and
estimating a trajectory of the vehicle with respect to the global reference frame.

### Claim 7 (depends on 6)

The vehicle of claim 6, wherein estimating each of the one or more relative velocities comprises using doppler shift.

### Claim 8 (depends on 6)

The vehicle of claim 6, wherein:
the vehicle further comprises at least a first and a second antenna separated by a known distance, each antenna configured to receive the one or more localization packets; and
estimating each of the one or more relative velocities comprises:
receiving a localization packet at the first antenna at a first time, and at the second antenna at second time;
comparing the difference between the first and second time to a known distance; and
determining a relative radial velocity between the vehicle and the transmitter vehicle associated with the localization packet.

### Claim 9

A transmitter vehicle comprising:
an ECU including machine executable instructions in non-transitory memory to perform a method comprising:
estimating a localization for the transmitter vehicle, the localization comprising a location of the transmitter vehicle relative to a global reference frame; and
transmitting a localization packet to one or more vehicle using wireless communication, the localization packet comprising the estimated localization of the transmitter vehicle and a transmission timestamp.

### Claim 10 (depends on 9)

The transmitter vehicle of claim 9 further comprising an imaging sensor and a proximity sensor.

### Claim 11 (depends on 10)

The transmitter vehicle of claim 10, wherein estimating a localization for the transmitter vehicle comprises:
detecting a landmark using the imaging sensor;
estimating a location of the transmitter vehicle relative to the landmark using the proximity sensor;
correlating the landmark to a map; and
estimating a location of the transmitter vehicle relative to the global reference frame.

### Claim 12

A computer-implemented method comprising:
generating, by an ECU in a vehicle, a first localization estimate, the first localization estimate comprising a first location of the vehicle with respect to a global reference frame;
receiving, by the ECU, one or more localization packets, each localization packet comprising a location of an associated transmitter vehicle with respect to the global reference frame and a transmission timestamp;
determining, by the ECU, a relative location for the vehicle using radiolocation, the relative location comprising a location of the vehicle relative to the one or more transmitter vehicles; and
refining, by the ECU, the first localization estimate, the refined localization estimate comprising a location of the vehicle with respect to the global reference frame.

### Claim 13 (depends on 12)

The computer-implemented method of claim 12, wherein generating the first localization estimate comprises using a GPS in the vehicle.

### Claim 14 (depends on 12)

The computer-implemented method of claim 12, wherein determining the relative location comprises:
calculating a distance between the vehicle and each of the one or more transmitter vehicles using the transmission timestamps; and
determining a location of the vehicle relative to the one or more transmitter vehicles.

### Claim 15 (depends on 12)

The computer-implemented method of claim 12, wherein refining the first localization estimate comprises:
comparing the first localization estimate to a second localization estimate, wherein the second localization estimate is based on the one or more localization packets and the relative location of the vehicle, and comprises a second location of the vehicle with respect to the global reference frame; and
refining the first localization estimate based on the comparison.

### Claim 16 (depends on 15)

The computer-implemented method of claim 15, wherein the first localization estimate is only refined when the deviation between the first and second localization estimate is within a threshold interval.

### Claim 17 (depends on 12)

The computer-implemented method of claim 12, wherein the refined localization estimate further comprises a trajectory of the vehicle with respect to the global reference frame.

### Claim 18 (depends on 17)

The computer-implemented method of claim 17, wherein:
each localization packet further comprises a velocity of its associated transmitter vehicle with respect to the global reference frame; and
the computer-implemented method further comprises:
determining one or more relative velocities, each relative velocity comprising a velocity of the vehicle relative to a transmitter vehicle; and
estimating a trajectory of the vehicle with respect to the global reference frame.

### Claim 19 (depends on 18)

The computer-implemented method of claim 18, wherein determining each of the one or more relative velocities comprises using doppler shift.

### Claim 20 (depends on 18)

The computer-implemented method of claim 18, wherein determining each of the one or more relative velocities comprises:
receiving a localization packet at a first antenna at a first time, and at a second antenna at second time;
comparing the difference between the first and second time to a known distance; and
determining a relative radial velocity between the vehicle and the transmitter vehicle associated with the localization packet.
