Traveling trajectory estimation system, traveling trajectory estimation program, and traveling trajectory estimating method

Patent metadata

Field	Value
Publication number	US-11938952-B2
Application number	US-202117546300-A
Country	US
Kind code	B2
Filing date	Dec 9, 2021
Priority date	Jan 28, 2021
Publication date	Mar 26, 2024
Grant date	Mar 26, 2024

Abstract

A traveling trajectory estimation system obtains traveling record information indicating a past traveling record of a vehicle, and characteristic object position information indicating the installation position of a characteristic object, and performs a vehicle position estimation process to estimate an object vehicle position at an object time, based on the traveling record information and the characteristic object position information. In the vehicle position estimation process, not only a time previous to the object time, but also a time subsequent to the object time, is used as a reference time. The traveling trajectory estimation system sets each of a plurality of successive times as the object time, and performs the vehicle position estimation process, to estimate the object vehicle positions at the respective times, and determines a collection of the estimated object vehicle positions as a traveling trajectory of the vehicle.

First claim

What is claimed is:

1. A traveling trajectory estimation system, comprising:
a storage device that stores traveling record information indicating a past traveling record of a vehicle, and characteristic object position information indicating an installation position of a characteristic object; and
a processor configured to perform a traveling trajectory estimation process to estimate a traveling trajectory of the vehicle, based on the traveling record information and the characteristic object position information,
wherein the traveling record information includes vehicle traveling information including a traveling state or a position of the vehicle detected by an internal sensor installed on the vehicle, and external recognition information including information on the characteristic object recognized by an external sensor installed on the vehicle,
wherein the traveling trajectory estimation process includes a vehicle position estimation process for estimating a vehicle position as a position of the vehicle,
wherein an object vehicle position is the vehicle position at an object time,
wherein a first reference vehicle position is the vehicle position at a first reference time previous to the object time,
wherein a second reference vehicle position is the vehicle position at a second reference time subsequent to the object time,
wherein a first vehicle movement amount is a movement amount of the vehicle between the first reference time and the object time,
wherein a second vehicle movement amount is a movement amount of the vehicle between the second reference time and the object time,
wherein the vehicle position estimation process includes
obtaining the first vehicle movement amount and the second vehicle movement amount, based on the vehicle traveling information,
obtaining a relative position of the characteristic object recognized at the object time, based on the external recognition information,
calculating the object vehicle position as an internal estimated vehicle position, based on the first reference vehicle position, the first vehicle movement amount, the second reference vehicle position, and the second vehicle movement amount,
calculating the object vehicle position as an external estimated vehicle position, based on the installation position of the characteristic object indicated by the characteristic object position information and the relative position of the characteristic object at the object time, and
estimating the object vehicle position by combining the internal estimated vehicle position with the external estimated vehicle position,

wherein the processor is configured to set each of a plurality of successive times as the object time, and perform the vehicle position estimation process, to estimate a plurality of object vehicle positions at the respective times, and determine a collection of the object vehicle positions estimated, as the traveling trajectory of the vehicle,
wherein the vehicle performs a localization process during traveling to estimate the vehicle position, based on the vehicle traveling information, the external recognition information, and the characteristic object position information,
wherein the processor is configured to calculate an error between the estimated traveling trajectory, and the vehicle position estimated by the localization process, and generate a warning to an operator of the traveling trajectory estimation system or a user of the vehicle, when the error satisfies a warning condition, and
wherein the processor is configured to control travel of the vehicle based on the estimated vehicle position.

2. The traveling trajectory estimation system according to claim 1 , wherein the processor is configured to set the plurality of successive times in parallel as the object time, and perform the vehicle position estimation process, to estimate the object vehicle positions at the respective times via batch processing.

3. The traveling trajectory estimation system according to claim 2 , wherein the processor is configured to repeatedly execute the vehicle position estimation process, by setting the object vehicle positions estimated in the last cycle of the vehicle position estimation process as the first reference vehicle position and the second reference vehicle position in a current cycle of the vehicle position estimation process.

4. The traveling trajectory estimation system according to claim 3 , wherein the processor is configured to repeatedly execute the vehicle position estimation process, until an amount of change between the object vehicle positions estimated in the last cycle of the vehicle position estimation process and the object vehicle positions estimated in the current cycle of the vehicle position estimation process becomes smaller than a threshold value.

5. The traveling trajectory estimation system according to claim 1 , wherein:
a calibration parameter indicates an installation position and an installation direction of the external sensor in a vehicle coordinate system fixed to the vehicle;
the processor is configured to calculate the external estimated vehicle position, based on the installation position of the characteristic object, the relative position of the characteristic object at the object time, and the calibration parameter; and
in the vehicle position estimation process, the processor is configured to set the calibration parameter as a variable, and estimate the calibration parameter along with the object vehicle positions.

6. The traveling trajectory estimation system according to claim 5 , wherein the processor is further configured to:
calculate an error between the calibration parameter estimated, and a set value of the calibration parameter; and
generate a waring to an operator of the traveling trajectory estimation system or a user of the vehicle, when the error satisfies a warning condition.

7. The traveling trajectory estimation system according to claim 1 , wherein the processor is further configured to generate a warning to an operator of the traveling trajectory estimation system or a user of the vehicle, when the estimated traveling trajectory includes meandering having no relationship with a driving lane, or when the estimated traveling trajectory has an abnormal curvature that exceeds a given curvature threshold value.

8. The traveling trajectory estimation system according to claim 1 , wherein:
the vehicle performs trajectory following control to travel while following a target trajectory; and
the processor is further configured to calculate an error between the estimated traveling trajectory and the target trajectory, and generate a warning to an operator of the traveling trajectory estimation system or a user of the vehicle, when the error satisfies a warning condition.

9. The traveling trajectory estimation system according to claim 1 , wherein the processor is further configured to:
calculate a plurality of vehicle positions at the respective times, as comparable vehicle positions, based on the vehicle traveling information, without using the external recognition information;
calculate an error between the estimated traveling trajectory and the comparable vehicle positions; and
generate a warning to an operator of the traveling trajectory estimation system or a user of the vehicle, when the error satisfies a warning condition.

10. A non-transitory storage medium storing a traveling trajectory estimation program, that when executed by a computer, cause the computer to perform an information acquisition process to acquire traveling record information indicating a past traveling record of a vehicle, and characteristic object position information indicating an installation position of a char

Assignees

• Toyota Motor Co Ltd

Inventors

• Abe Sadayuki
• Kawanai Taichi
• Kamikado Kazuhiko

Classifications

• B60W40/10 Primary

  related to vehicle motion · CPC title

• B60W50/0205

  Diagnosing or detecting failures; Failure detection models · CPC title

• B60W50/14

  Means for informing the driver, warning the driver or prompting a driver intervention · CPC title

• G06V20/58

  Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads · CPC title

• B60W2050/0054

  Cut-off filters, retarders, delaying means, dead zones, threshold values or cut-off frequency · CPC title