IP Library Granted Patent US 11,953,608
Granted Patent B2
US 11,953,608 · App. 17/604,755 · Granted Apr 9, 2024

Position estimation device and position estimation method

Inventors: Yuji Hamada (Tokyo, JP); Naoki Isozaki (Tokyo, JP); Takuya Matsuda (Tokyo, JP); Takuma Okamoto (Tokyo, JP)
Assignee: MITSUBISHI ELECTRIC CORPORATION
G01S19/48G01S19/07G01S19/49G01S19/396G01S19/51G08G1/09
View Patent ↗
Loading inventors, assignments & file history…
Monitor This Case
Get email alerts when status or documents change.
Order Certified Copies
Most orders are placed with the USPTO same day — all within 24 business hours.
Order via The Patent Place →
Pre-filled with this patent's details
Quick Facts
Patent No.
US 11,953,608
App. No.
17/604,755
Granted
Apr 9, 2024
Kind
B2
Abstract

An object of the present invention is to continuously estimate the position with high accuracy while the moving body is traveling. A position estimation device is installed in a moving body, and includes a position estimation unit configured to estimate a position of a subject moving body being the moving body in which the position estimation device is installed using any of positioning means of satellite positioning using a positioning satellite or radio wave positioning using wireless communication, and a positioning means selection unit configured to switch the positioning means the position estimation unit uses for estimation of the position of the subject moving body based on a traveling environment or a peripheral environment of the subject moving body.

Claims (39)

1. A position estimation device installed in each of a plurality of moving bodies, comprising:

a processor to execute a program; and

a memory to store the program which, when executed by the processor, performs processes of,

estimating a position of a subject moving body being the moving body in which the position estimation device is installed as an estimated position using any of positioning means of satellite positioning using a positioning satellite or radio wave positioning using wireless communication with a cellular base station,

switching the positioning means for estimation of the position of the subject moving body based on a traveling environment or a peripheral environment of the subject moving body,

correcting the estimated position of the subject moving body in accordance with an estimation accuracy,

performing transmission/reception of the estimated position of the subject moving body and sensing information by a peripheral monitoring sensor installed in the subject moving body between the position estimation device installed in a peripheral moving body being the moving body traveling around the subject moving body,

when an estimation accuracy of the estimated position of the peripheral moving body is higher than the estimation accuracy of the estimated position of the subject moving body, selecting, as a position correction method, from at least any of the sensing information of the peripheral moving body or radio wave positioning of the subject moving body by wireless communication with the peripheral moving body based on the position accuracy of the sensing information of the peripheral moving body and the position accuracy of the radio wave positioning of the subject moving body by wireless communication with the peripheral moving body, calculating a relative distance and a relative angle between the subject moving body and the peripheral moving body based on the selected position correction method, and correcting the estimated position of the subject moving body based on the estimated position of the peripheral moving body, the relative distance, and the relative angle, and

when the estimation accuracy of the estimated position of the subject moving body is higher than an estimation accuracy of the estimated position of the peripheral moving body, selecting, as a position correction method, from at least any of the sensing information of the subject moving body or radio wave positioning of the subject moving body by wireless communication with the peripheral moving body based on a position accuracy of the sensing information of the subject moving body and a position accuracy of the radio wave positioning of the subject moving body by wireless communication with the peripheral moving body, calculating a relative distance and a relative angle between the subject moving body and the peripheral moving body based on the selected position correction method, and correcting the estimated position of the peripheral moving body based on the estimated position of the subject moving body, the relative distance, and the relative angle.

2. The position estimation device according to claim 1 , wherein

when the estimation accuracy of the estimated position of the peripheral moving body is higher than the estimation accuracy of the estimated position of the subject moving body, and both the sensing information of the peripheral moving body and the radio wave positioning of the subject moving body by wireless communication with the peripheral moving body are selected as the position correction method,

based on the estimated position of the peripheral moving body,

a position of the subject moving body is estimated as a first subject position from the relative distance and the relative angle calculated from the estimated positions of the subject moving body and the peripheral moving body,

a position of the subject moving body is estimated as a second subject position from the relative distance and the relative angle calculated from the sensing information of the peripheral moving body,

a position of the subject moving body is estimated as a third subject position from the relative distance and the relative angle calculated from the radio wave positioning of the subject moving body by radio wave communication with the peripheral moving body, and

the estimated position of the subject moving body is corrected based on the first subject position, the second subject position, and the third subject position, and

when the estimation accuracy of the estimated position of the subject moving body is higher than the estimation accuracy of the estimated position of the peripheral moving body, and both the sensing information of the subject moving body and the radio wave positioning of the subject moving body by wireless communication with the peripheral moving body are selected as the position correction method,

based on the estimated position of the subject moving body,

a position of the peripheral moving body is estimated as a first peripheral position from the relative distance and the relative angle calculated from the estimated positions of the subject moving body and the peripheral moving body,

a position of the peripheral moving body is estimated as a second peripheral position from the relative distance and the relative angle calculated from the sensing information of the subject moving body,

a position of the peripheral moving body is estimated as a third peripheral position from the relative distance and the relative angle calculated from the radio wave positioning of the subject moving body by radio wave communication with the peripheral moving body, and

the position of the peripheral moving body is corrected based on the first peripheral position, the second peripheral position, and the third peripheral position.

3. The position estimation device according to claim 1 , wherein

the traveling environment or the peripheral environment of a path through which the subject moving body is to travel in the future is acquired, based on the position of the subject moving body by the satellite positioning or the radio wave positioning and map information, and the positioning means is switched based on the traveling environment or the peripheral environment of the path through which the subject moving body is to travel in the future.

4. The position estimation device according to claim 1 , wherein

switching of the positioning means is performed in accordance with a positioning means switching table in which a correspondence relation between the traveling environment or the peripheral environment and the positioning means is determined.

5. The position estimation device according to claim 4 , wherein

switching to the positioning means corresponding to the traveling environment or the peripheral environment is performed at a timing at which the subject moving body travels at a position in front by a predetermined distance of the traveling environment or the peripheral environment determined in the positioning means switching table.

6. The position estimation device according to claim 1 , wherein

the number of the peripheral moving bodies is three or more.

7. The position estimation device according to claim 1 , wherein

the positioning means is switched based on a position accuracy of, among the peripheral moving bodies traveling around the subject moving body, the peripheral moving body traveling in front of the subject moving body.

8. A position estimation method executed by a position estimation device installed in each of a plurality of moving bodies, the position estimation device executing the method comprising the steps of:

estimating a position of a subject moving body as an estimated position using any of positioning means of satellite positioning using a positioning satellite or radio wave positioning using wireless communication with a cellular base station,

switching the positioning means for estimation of the position of the subject moving body based on a traveling environment or a peripheral environment of the subject moving body,

correcting the estimated position of the subject moving body in accordance with an estimation accuracy,

performing transmission/reception of the estimated position of the subject moving body and sensing information by a peripheral monitoring sensor installed in the subject moving body between the position estimation device installed in a peripheral moving body being the moving body traveling around the subject moving body,

when an estimation accuracy of the estimated position of the peripheral moving body is higher than the estimation accuracy of the estimated position of the subject moving body, selecting, as a position correction method, from at least any of the sensing information of the peripheral moving body or radio wave positioning of the subject moving body by wireless communication with the peripheral moving body based on the position accuracy of the sensing information of the peripheral moving body and the position accuracy of the radio wave positioning of the subject moving body by wireless communication with the peripheral moving body, calculating a relative distance and a relative angle between the subject moving body and the peripheral moving body based on the selected position correction method, and correcting the estimated position of the subject moving body based on the estimated position of the peripheral moving body, the relative distance, and the relative angle, and

when the estimation accuracy of the estimated position of the subject moving body is higher than an estimation accuracy of the estimated position of the peripheral moving body, selecting, as a position correction method, from at least any of the sensing information of the subject moving body or radio wave positioning of the subject moving body by wireless communication with the peripheral moving body based on a position accuracy of the sensing information of the subject moving body and a position accuracy of the radio wave positioning of the subject moving body by wireless communication with the peripheral moving body, calculating a relative distance and a relative angle between the subject moving body and the peripheral moving body based on the selected position correction method, and correcting the estimated position of the peripheral moving body based on the estimated position of the subject moving body, the relative distance, and the relative angle.

Assignments (1)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Oct 19, 2021
From: HAMADA, YUJI; ISOZAKI, NAOKI; MATSUDA, TAKUYA; OKAMOTO, TAKUMA
To: MITSUBISHI ELECTRIC CORPORATION
Reel/Frame 057830/0348 →
Continuity (1)
Related Publication 20220179104A1 · Jun 9, 2022
Cited By (5)
US 12,216,211 US 12,442,929 US 12,578,482 US 12,656,506 US 12,736,683