IP Library › Granted Patent US 10,282,861
Granted Patent B2
US 10,282,861 · App. 15/375,513 · Granted May 7, 2019

Pose error estimation and localization using static features

Inventors: Richard Kwant (Oakland, CA); Anish Mittal (Berkeley, CA)
Assignee: HERE Global B.V.
G06T7/74G01S19/40G01S19/47G05D1/027G05D1/0251G05D1/0278G06T2207/20081G06T2207/30252
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 10,282,861
App. No.
15/375,513
Granted
May 7, 2019
Kind
B2
Abstract

The position and/or pose of a vehicle is determined in real time. An observed position and an observed pose of a vehicle are determined. A reference image is generated based on the observed position and the observed pose. The reference image comprises one or more reference static features. A captured image and the reference image are implicitly compared. Based on a result of the comparison, a correction to the observed position, the observed pose, or both is determined.

Claims (59)

1. A method comprising:

determining an observed position and an observed pose of a vehicle;

generating a reference image based on the observed position and observed pose, wherein (a) the reference image comprises one or more reference static features and (b) the reference image is generated from the perspective of the observed position and the observed pose;

implicitly comparing the reference image to a captured image using a pose error network to determine a misalignment between at least one feature of the reference image and a corresponding feature of the captured image, wherein the pose error network comprises a trained neural network; and

based on the determined misalignment, determining, by the pose error network, a correction to the observed position, the observed pose, or both.

2. The method according to claim 1 , wherein the reference image comprises a binary map that is a two dimensional projection of a three dimensional feature map at the observed position and observed pose.

3. The method according to claim 1 , wherein the observed position and observed pose are determined based on a position and pose determined by a global positioning system (GPS), a position and pose determined by an inertial measurement unit (IMU), or a combination thereof.

4. The method according to claim 1 , wherein the reference image is generated based on reference static feature information that comprises ground truth information for one or more reference static features.

5. The method according to claim 1 , wherein generating the reference image comprises:

selecting one or more reference static features from a plurality of reference static features stored in association with a map tile of a digital map based on the observed position, observed pose, or both;

accessing reference static feature information corresponding to the selected reference static features from the map tile;

generating a three dimensional feature map based on the accessed reference static feature information; and

generating the reference image, wherein the reference image is a two dimensional projection of the three dimensional feature map based on the observed position, observed pose, or both.

6. The method according to claim 1 , wherein the captured image comprises multi-channel color information.

7. The method according to claim 1 , further comprising:

identifying one or more static features within the captured image;

identifying at least one of the one or more static features within at least one second captured image;

generating three dimensional information corresponding to the at least one static feature identified in both the captured image and the second captured image based at least in part on the captured image and the second captured image; and

generating a three dimensional image based at least in part on the three dimensional information, and

determining, by the pose error network, a correction to the observed position, the observed pose, or both based on implicitly comparing the generated three dimensional image and the reference image.

8. An apparatus comprising at least one processor, at least one memory storing computer program code, and a pose error network, the at least one memory and the computer program code configured to, with the processor, cause the apparatus to at least:

determine an observed position and an observed pose of a vehicle;

generate a reference image based on the observed position and observed pose, wherein (a) the reference image comprises one or more reference static features and (b) the reference image is generated from the perspective of the observed position and the observed pose;

implicitly compare the reference image to a captured image using the pose error network to determine a misalignment between at least one feature of the reference image and a corresponding feature of the captured image, wherein the pose error network comprises a trained neural network; and

based on the determined misalignment, determine, by the pose error network, a correction to the observed position, the observed pose, or both.

9. The apparatus according to claim 8 , wherein the reference image comprises a binary map that is a two dimensional projection of a three dimensional feature map at the observed position and observed pose.

10. The apparatus according to claim 8 , wherein the observed position and observed pose are determined based on a position and pose determined by a global positioning system (GPS), a position and pose determined by an inertial measurement unit (IMU), or a combination thereof.

11. The apparatus according to claim 8 , wherein the reference image is generated based on reference static feature information that comprises ground truth information for one or more reference static features.

12. The apparatus according to claim 8 , wherein to generate the reference image the at least one memory and the computer program code are configured to, with the processor, cause the apparatus to at least:

select one or more reference static features from a plurality of reference static features stored in association with a map tile of a digital map based on the observed position, observed pose, or both;

access reference static feature information corresponding to the selected reference static features from the map tile; and

generate a three dimensional feature map based on the accessed reference static feature information; and

generate the reference image, wherein the reference image is a two dimensional projection of the three dimensional feature map based on the observed position, observed pose, or both.

13. The apparatus according to claim 8 , wherein the captured image comprises multi-channel color information.

14. The apparatus according to claim 9 , wherein the at least one memory and the computer program code are further configured to, with the processor, cause the apparatus to at least:

identify one or more static features within the captured image;

identify at least one of the one or more static features within at least one second captured image;

generate three dimensional information corresponding to the at least one static feature identified in both the captured image and the second captured image based at least in part on the captured image and the second captured image; and

generate a three dimensional image based at least in part on the three dimensional information; and

determine, by the pose error network, a correction to the observed position, the observed pose, or both based on implicitly comparing the generated three dimensional image and the reference image.

15. A computer program product comprising at least one non-transitory computer-readable storage medium having computer-executable program code instructions stored therein, the computer-executable program code instructions comprising program code instructions configured to:

determine an observed position and an observed pose of a vehicle;

generate a reference image based on the observed position and observed pose, wherein (a) the reference image comprises one or more reference static features and (b) the reference image is generated from the perspective of the observed position and the observed pose;

implicitly compare the reference image to a captured image using a pose error network to determine a misalignment between at least one feature of the reference image and a corresponding feature of the captured image, wherein the pose error network comprises a trained neural network; and

based on the determined misalignment, determine, by the pose error network, a correction to the observed position, the observed pose, or both.

16. The computer program product according to claim 15 , wherein the reference image comprises a binary map that is a two dimensional projection of a three dimensional feature map at the observed position and observed pose.

17. The computer program product according to claim 15 , wherein the observed position and observed pose are determined based on a position and pose determined by a global positioning system (GPS), a position and pose determined by an inertial measurement unit (IMU), or a combination thereof.

18. The computer program product according to claim 15 , wherein the reference image is generated based on reference static feature information that comprises ground truth information for one or more reference static features.

19. The computer program product according to claim 15 , wherein the computer-executable program code instructions comprise program code instructions configured to generate the reference image by:

selecting one or more reference static features from a plurality of reference static features stored in association with a map tile of a digital map based on the observed position, observed pose, or both;

accessing reference static feature information corresponding to the selected reference static features from the map tile; and

generating a three dimensional feature map based on the accessed reference static feature information; and

generating the reference image, wherein the reference image is a two dimensional projection of the three dimensional feature map based on the observed position, observed pose, or both.

20. The computer program product according to claim 15 , wherein the computer-executable program code instructions further comprise program code instructions configured to:

identify one or more static features within the captured image;

identify at least one of the one or more static features within at least one second captured image;

generate three dimensional information corresponding to the at least one static feature identified in both the captured image and the second captured image based at least in part on the captured image and the second captured image;

generate a three dimensional image based at least in part on the three dimensional information; and

determine, by the pose error network, a correction to the observed position, the observed pose, or both based on implicitly comparing the generated three dimensional image and the reference image.

Assignments (1)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Dec 12, 2016
From: KWANT, RICHARD; MITTAL, ANISH
To: HERE GLOBAL B.V.
Reel/Frame 040886/0710 →
Continuity (1)
Related Publication 20180165831A1 · Jun 14, 2018
Cited By (1)
US 12,726,799