# US 2024/0319736 A1 · Position estimation device, automated driving system, position estimation method, and storage medium storing program

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

- Number: US 2024/0319736 A1
- Document ID: US20240319736A1
- Status: Published application
- Kind: A1
- Application number: 18/442,797
- Filed: 2024-02-15
- Published: 2024-09-26
- Earliest claimed: 2023-03-22
- Assignees: Mitsubishi Electric Corporation
- Applicants: Mitsubishi Electric Corporation
- Inventors: Nariaki Takehara; Kohei Mori; Hiroshi Yamada
- Web page: https://patentgrep.com/patent/US20240319736A1

## CPC

- G05D 1/24: Arrangements for determining position or orientation
- B60W 40/114: Yaw movement
- G01C 21/16: by integrating acceleration or speed, i.e. inertial navigation
- G01C 22/025: {Differential odometers}
- G05D 1/245: using dead reckoning
- G05D 1/43: Control of position or course in two dimensions [2D]
- B60W 2520/14: Yaw
- G05D 2109/10: Land vehicles
- G05D 2111/52: {generated by inertial navigation means, e.g. gyroscopes or accelerometers}
- G05D 2111/54: {for measuring the travel distances, e.g. by counting the revolutions of wheels}
- G05D 2111/67: Sensor fusion
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- 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)

## Abstract

A position estimation device includes: a weight determination unit to determine weights to be set to first yaw information of a vehicle A based on an angular velocity of the vehicle A, second yaw information of the vehicle A based on movement distances of left and right wheels of the vehicle A, and third yaw information of the vehicle A based on a steering angle and a vehicle speed of the vehicle A; a yaw information acquiring unit to acquire the first to third yaw information; a combining unit to generate combined yaw information by combining the first to third yaw information, to which the determined weights have been set; and a position estimation unit to estimate a position of the vehicle A using positioning information of the vehicle A, the vehicle speed of the vehicle A, and the combined yaw information.

## Claims

### Claim 1

A position estimation device comprising:
processing circuitry performing:
to determine, on a basis of a travel state of a vehicle or a peripheral state of the vehicle, weights to be set to first yaw information of the vehicle based on an angular velocity of the vehicle, second yaw information of the vehicle based on a difference in movement distance between left and right wheels of the vehicle, and third yaw information of the vehicle based on a steering angle and a vehicle speed of the vehicle;
to acquire the first yaw information, the second yaw information, and the third yaw information;
to generate combined yaw information obtained by combining the first yaw information, the second yaw information, and the third yaw information to which the determined weights have been set; and
to estimate a position of the vehicle using positioning information of the vehicle, the vehicle speed of the vehicle, and the combined yaw information.

### Claim 2 (depends on 1)

The position estimation device according to claim 1, wherein
the processing circuitry includes performing:
to calculate first yaw angle information of the vehicle as the first yaw information on a basis of the angular velocity of the vehicle;
to calculate second yaw angle information of the vehicle as the second yaw information on a basis of the difference in movement distance between the left and right wheels of the vehicle; and
to calculate third yaw angle information of the vehicle as the third yaw information on a basis of the steering angle and the vehicle speed of the vehicle.

### Claim 3 (depends on 2)

The position estimation device according to claim 2, wherein
the processing circuitry increases a weight of the first yaw angle information, decreases a weight of the second yaw angle information, and decreases a weight of the third yaw angle information in a case where the vehicle speed of the vehicle is equal to or greater than a first threshold, the angular velocity of the vehicle is less than a second threshold, and a time during which an error in the angular velocity of the vehicle is not removed is less than a given time, and
decreases the weight of the first yaw angle information and increases the weight of the second yaw angle information in a case where the time during which the error in the angular velocity of the vehicle is not removed is equal to or longer than the given time.

### Claim 4 (depends on 3)

The position estimation device according to claim 3, wherein
the processing circuitry increases the weight of the second yaw angle information, decreases the weight of the first yaw angle information, and decreases the weight of the third yaw angle information, in a case where the vehicle speed of the vehicle is less than the first threshold, and the angular velocity of the vehicle is less than the second threshold.

### Claim 5 (depends on 3)

The position estimation device according to claim 3, wherein
the processing circuitry increases the weight of the third yaw angle information, decreases the weight of the first yaw angle information, and decreases the weight of the second yaw angle information in a case where the vehicle speed of the vehicle is less than the first threshold, and the angular velocity of the vehicle is equal to or greater than the second threshold, and
increases the weight of the first yaw angle information, decreases the weight of the second yaw angle information, and decreases the weight of the third yaw angle information in a case where the vehicle speed of the vehicle is equal to or greater than the first threshold, and the angular velocity of the vehicle is equal to or greater than the second threshold.

### Claim 6 (depends on 2)

The position estimation device according to claim 2, wherein
the processing circuitry increases the weight of the first yaw angle information, decreases the weight of the second yaw angle information, and decreases the weight of the third yaw angle information in a case where an undulation of a road surface on which the vehicle is traveling is equal to or greater than a third threshold.

### Claim 7 (depends on 2)

The position estimation device according to claim 2, wherein
the processing circuitry increases the weight of the first yaw angle information, decreases the weight of the second yaw angle information, and decreases the weight of the third yaw angle information in a case where a degree of slippage of a road surface on which the vehicle is traveling is equal to or greater than a fourth threshold.

### Claim 8 (depends on 2)

The position estimation device according to claim 2, wherein
the processing circuitry includes performing:
to determine weights to be set to the first yaw angle information, the second yaw angle information, and the third yaw angle information for each section in a travel route along which the vehicle travels; and
to change the weights to be set to the first yaw angle information, the second yaw angle information, and the third yaw angle information depending on a change in a state of the travel route during traveling of the vehicle.

### Claim 9 (depends on 1)

The position estimation device according to claim 1, wherein
the first yaw information is first yaw rate information based on the angular velocity of the vehicle,
the second yaw information is second yaw rate information based on movement distances of the left and right wheels of the vehicle, and
the third yaw information is third yaw rate information based on the steering angle and the vehicle speed of the vehicle.

### Claim 10 (depends on 1)

An automated driving system comprising:
the position estimation device according to claim 1; and
a vehicle automatic control device to control movement of the vehicle on a basis of a position of the vehicle estimated by the position estimation device.

### Claim 11

A position estimation method performed by a position estimation device, the method comprising:
determining weights to be set to first yaw information of a vehicle based on an angular velocity of the vehicle, second yaw information of the vehicle based on a difference in movement distance between left and right wheels of the vehicle, and third yaw information of the vehicle based on a steering angle and a vehicle speed of the vehicle, on a basis of a travel state of the vehicle or a peripheral state of the vehicle;
acquiring the first yaw information, the second yaw information, and the third yaw information;
generating combined yaw information obtained by combining the first yaw information, the second yaw information, and the third yaw information to which the determined weights have been set; and
estimating a position of the vehicle using positioning information of the vehicle, the vehicle speed of the vehicle, and the combined yaw information.

### Claim 12

A non-transitory tangible computer readable storage medium storing a program to cause a computer to perform:
to determine, on a basis of a travel state of a vehicle or a peripheral state of the vehicle, weights to be set to first yaw information of the vehicle based on an angular velocity of the vehicle, second yaw information of the vehicle based on a difference in movement distance between left and right wheels of the vehicle, and third yaw information of the vehicle based on a steering angle and a vehicle speed of the vehicle;
to acquire the first yaw information, the second yaw information, and the third yaw information;
to generate combined yaw information obtained by combining the first yaw information, the second yaw information, and the third yaw information to which the determined weights have been set; and
to estimate a position of the vehicle using positioning information of the vehicle, the vehicle speed of the vehicle, and the combined yaw information.
