Trajectory estimation device, trajectory estimation system, trajectory estimation method, and program recording medium

Patent metadata

Field	Value
Publication number	US-12135192-B2
Application number	US-202018034608-A
Country	US
Kind code	B2
Filing date	Nov 16, 2020
Priority date	Nov 16, 2020
Publication date	Nov 5, 2024
Grant date	Nov 5, 2024

Abstract

A trajectory estimation device that includes a waveform generation unit that generates, by using signals based on waves detected by at least three sensors, peak waveforms consisting of time series data of peak frequencies of the signals, a parameter estimation unit that estimates, from the peak waveforms relating to the waves detected by the at least three sensors, a trajectory parameter relating to a trajectory of a moving body having a wave source of the waves, and a trajectory estimation unit that estimates, for all combinations of two of the peak waveforms selected from among combinations of at least three of the peak waveforms, a wave source direction candidate for each of the waves by using the trajectory parameter, and estimate, as a trajectory of the moving body, overlapping trajectory candidates from among trajectory candidates estimated based on the wave source direction candidates.

First claim

What is claimed is:

1. A trajectory estimation device comprising:
at least one memory storing instructions; and
at least one processor connected to the at least one memory and configured to execute the instructions to:
generate, by using signals based on waves detected by at least three sensors to, peak waveforms consisting of time series data of peak frequencies of the signals;
estimate, from the peak waveforms relating to the waves detected by the at least three sensors, a trajectory parameter relating to a trajectory of a moving body having a wave source of the waves; and
estimate, for all combinations of two of the peak waveforms selected from among combinations of at least three of the peak waveforms, a wave source direction candidate for each of the waves by using the trajectory parameter, and
estimate, as a trajectory of the moving body, overlapping trajectory candidates from among trajectory candidates estimated based on the wave source direction candidates.

2. The trajectory estimation device according to claim 1 , wherein
the at least one processor is configured to execute the instructions to
estimate, by fitting a theoretical formula of a Doppler shift to the peak waveforms, the trajectory parameter including a velocity of the moving body, a wave frequency generated by the wave source, a shortest distance between the moving body and the sensor, and a time when the moving body comes closest to the sensor.

3. The trajectory estimation device according to claim 2 , wherein
the at least one processor is configured to execute the instructions to
cluster three of the peak waveforms in which the velocity of the moving body and the wave frequency are close to one another, from among all the selected peak waveforms of the sensors, and
estimate, for all combinations of two of the peak waveforms selected from among combinations of the clustered three peak waveforms, the wave source direction candidate for each of the waves by using the trajectory parameter.

4. The trajectory estimation device according to claim 2 , wherein
a noise elimination means the at least one processor is configured to execute the instructions to
eliminate a peak waveform derived from noise, among the peak waveforms relating to the waves detected by the sensors.

5. The trajectory estimation device according to claim 4 , wherein
the at least one processor is configured to execute the instructions to
calculate an index representing an error in fitting of the theoretical formula of the Doppler shift to the peak waveform, and
eliminate a waveform derived from noise, among the peak waveforms relating to the waves detected by the sensors, based on the index representing an error in the fitting.

6. The trajectory estimation device according to claim 1 , wherein
the at least one processor is configured to execute the instructions to
generate a frequency spectrogram by using the signals based on the waves detected by the sensors, and
generate time series data of peak frequencies extracted from the generated frequency spectrogram as the peak waveform.

7. The trajectory estimation device according to comprising claim 1 , wherein
the at least one processor is configured to execute the instructions to
estimate a position of the moving body in a current verification frame based on a position of the moving body estimated in a previous frame, and select the signals based on the waves detected by the at least three sensors close to the estimated position of the moving body, and
generate the peak waveform that is time series data of peak frequencies of the selected signals by using the signals based on the waves detected by the at least three sensors.

8. A trajectory estimation system comprising:
the trajectory estimation device according to claim 1 ; and
at least three sensors that detect waves and output signals based on the detected waves to the trajectory estimation device.

9. A trajectory estimation method for causing a computer to execute:
generating, by using signals based on waves detected by at least three sensors, peak waveforms consisting of time series data of peak frequencies of the signals;
estimating, from the peak waveforms relating to the waves detected by the at least three sensors, a trajectory parameter relating to a trajectory of a moving body having a wave source of the waves;
estimating, for all combinations of two of the peak waveforms selected from among combinations of at least three of the peak waveforms, a wave source direction candidate for each of the waves by using the trajectory parameter; and
estimating, as a trajectory of the moving body, overlapping trajectory candidates from among trajectory candidates estimated based on the wave source direction candidates.

10. A non-transitory program recording medium having stored therein a program for causing a computer to execute:
generating, by using signals based on waves detected by at least three sensors, peak waveforms consisting of time series data of peak frequencies of the signals;
estimating, from the peak waveforms relating to the waves detected by the at least three sensors, a trajectory parameter relating to a trajectory of a moving body having a wave source of the waves;
estimating, for all combinations of two of the peak waveforms selected from among combinations of at least three of the peak waveforms, a wave source direction candidate for each of the waves by using the trajectory parameter; and
estimating, as a trajectory of the moving body, overlapping trajectory candidates from among trajectory candidates estimated based on the wave source direction candidates.

Assignees

• Nec Corp

Inventors

• Arai Yumi

Classifications

• F41G7/343 Primary

  comparing observed and stored data of target position or of distinctive marks along the path towards the target · CPC title

• G01S5/18 Primary

  using ultrasonic, sonic or infrasonic waves · CPC title