Method and system for positioning using tightly coupled radar, motion sensors and map information

Patent metadata

Field	Value
Publication number	US-11422253-B2
Application number	US-201916420143-A
Country	US
Kind code	B2
Filing date	May 22, 2019
Priority date	Nov 19, 2018
Publication date	Aug 23, 2022
Grant date	Aug 23, 2022

Abstract

An integrated navigation solution is provided for a device within a moving platform. Motion sensor data is obtained from a sensor assembly of the device, radar measurements for the platform are obtained and map information for an environment encompassing the platform is obtained. Correspondingly, an integrated navigation solution is generated based at least in part on the obtained motion sensor data using a nonlinear state estimation technique, wherein the nonlinear state estimation technique uses a nonlinear measurement model for radar measurements. Generating the integrated navigation solution includes using the sensor data with the nonlinear state estimation technique and integrating the radar measurements directly by updating the nonlinear state estimation technique using the nonlinear measurement models and the map information. The integrated navigation solution is then provided.

First claim

What is claimed is:

1. A method for providing an integrated navigation solution in real-time for a device within a moving platform, the method comprising:
a) receiving motion sensor data from a sensor assembly of the device,
b) receiving radar measurements from at least one radar of the platform;
c) obtaining map information for an environment encompassing the platform;
d) generating an integrated navigation solution based at least in part on the obtained motion sensor data using a nonlinear state estimation technique, wherein a prediction phase involving a system model is used to propagate predictions about a state of the platform and an update phase involving at least one measurement model relating measurements to the state is used to update the state of the platform, wherein the nonlinear state estimation technique comprises using a nonlinear measurement model for radar measurements, wherein integrating the motion sensor data and the radar measurements in the nonlinear state estimation technique is tightly-coupled, and wherein the generating comprises:
i) using the obtained motion sensor data in the nonlinear state estimation technique; and
ii) integrating the radar measurements directly by updating the nonlinear state estimation technique using the nonlinear measurement models and the map information; and
e) providing the integrated navigation solution.

2. The method of claim 1 , wherein the measurement model comprises at least one of:
i) a radar range-based model based at least in part on a probability distribution of measured ranges using an estimated state of the platform and the map information;
ii) a radar nearest object likelihood model based at least in part on a probability distribution of distance to an object detected using the radar measurements, an estimated state of the platform and a nearest object identification from the map information;
iii) a radar map matching model based at least in part on a probability distribution derived by correlating a global map derived from the map information to a local map generated using the radar measurement and an estimated state of the platform; and
iv) a radar closed-form model based at least in part on a relation between an estimated state of the platform and ranges to objects from the map information derived from the radar measurements.

3. The method of claim 2 , wherein the measurement model comprises a radar range-based model and wherein the radar range-based model estimates range by casting rays between the platform and objects from the map information.

4. The method of claim 2 , wherein the measurement model comprises a radar closed-form model, further comprising any one or any combination of:
i) classifying a detected object using the radar measurements and determining a first correspondence between the classified object and an object from the map information; and
ii) classifying a detected object using data from a supplemental sensor, determining a first correspondence between the classified object and the radar measurements, and determining a second correspondence between the classified object and an object from the map information.

5. The method of claim 2 , wherein the nonlinear measurement model further comprises models for radar-related errors comprising any one or any combination of environmental errors, sensor-based errors and dynamic errors.

6. The method of claim 2 , wherein the nonlinear measurement model is configured to handle errors in the map information.

7. The method of claim 1 , wherein the nonlinear state estimation technique comprises at least one of:
i) an error-state system model;
ii) a total-state system model, wherein the integrated navigation solution is output directly by the total-state model; and
iii) a system model receiving input from an additional state estimation technique that integrates the motion sensor data.

8. The method of claim 7 , wherein the nonlinear state estimation technique comprises an error-state system model and wherein providing the integrated navigation solution comprises correcting an inertial mechanization output with the updated nonlinear state estimation technique.

9. The method of claim 7 , wherein the system model comprises a system model receiving input from an additional state estimation technique, and wherein the additional state estimation technique integrates any one or any combination of:
i) inertial sensor data;
ii) odometer or means for obtaining platform speed data;
iii) pressure sensor data;
iv) magnetometer data; and
v) absolute navigational information.

10. The method of claim 7 , wherein the system model of the nonlinear state estimation technique further comprises a motion sensor error model.

11. The method of claim 1 , wherein the nonlinear state estimation technique comprises at least one of:
i) a Particle Filter (PF);
ii) a PF, wherein the PF comprises a Sampling/Importance Resampling (SIR) PF; and
iii) a PF, wherein the PF comprises a Mixture PF.

12. The method of claim 1 , further comprising determining a misalignment between a frame of the sensor assembly and a frame of the platform, wherein the misalignment is at least one of:
i) a mounting misalignment; and
ii) a varying misalignment.

13. The method of claim 1 , further comprising determining a misalignment between a frame of the sensor assembly and a frame of the platform, wherein the misalignment is determined using any one or any combination of:
i) a source of absolute velocity;
ii) a radius of rotation calculated from the motion sensor data; and
iii) leveled horizontal components of acceleration readings along forward and lateral axes from the motion sensor data.

14. The method of claim 1 , further comprising integrating a source of absolute navigational information with the integrated navigation solution.

15. The method of claim 1 , further comprising using Doppler shift as a measurement update to the nonlinear state estimation technique.

16. The method of claim 1 , further comprising estimating a relative update for the platform using at least one of an object flow analysis from the radar measurements and Doppler information from the radar measurements.

17. The method of claim 1 , wherein the map information was built using radar measurements.

18. The method of claim 17 , wherein the map information further comprises reflected power information from radar measurements.

19. The method of claim 1 , further comprising building a map of objects detected using the radar measurements, wherein the map is built using a simultaneous localization and mapping technique.

20. A system for providing an integrated navigation solution in real-time for a device within a moving platform, comprising:
a device having a sensor assembly configured to output motion sensor data;
at least one radar of the platform configured to output radar measurements; and
at least one processor, coupled to receive the motion sensor data, the radar measurements, and map information for an environment encompassing the platform, and operative to:
A) generate an integrated navigation solution based at least in part on the motion sensor data using a nonlinear state estimation technique, wherein a prediction phase involving a system model is used to propagate predictions about a state of the platform and an update phase involving at least one measurement model relating measurements to the state is used to update the state of the platform, wherein the nonlinear state estimation technique comprises using a nonlinear measuremen

Assignees

• Invensense Inc
• Tdk Corportation

Inventors

• Mahmoud Anas
• Georgy Jacques
• Al-Hamad Amr
• Omr Medhat
• Ahmed Amr
• Ali Abdelrahman
• Goodall Christopher

Classifications

• G01C21/30

  Map- or contour-matching · CPC title

• G01S13/931 Primary

  of land vehicles · CPC title

• G01S7/41

  using analysis of echo signal for target characterisation; Target signature; Target cross-section · CPC title

• G01S2013/932

  using own vehicle data, e.g. ground speed, steering wheel direction · CPC title

• G01S13/86

  Combinations of radar systems with non-radar systems, e.g. sonar, direction finder · CPC title