Method and apparatus for in motion initialization of global navigation satellite system—inertial navigation system

Patent metadata

Field	Value
Publication number	US-12313753-B2
Application number	US-202318331026-A
Country	US
Kind code	B2
Filing date	Jun 7, 2023
Priority date	Jul 13, 2020
Publication date	May 27, 2025
Grant date	May 27, 2025

Abstract

A mobile device in a moving vehicle initializes a Global Navigation Satellite System (GNSS)—Inertial Navigation System (INS) system while the vehicle is in-motion with the orientation of the mobile device with respect to a global reference frame. The mobile device uses gyroscope measurements made while the vehicle is turning to determine a gravity vector. The gravity vector and accelerometer measurements may be used to determine a forward vector for the mobile device. A north vector is determined using the GNSS measurements. After the GNSS-INS system is calibrated, the mobile device may be positioned with respect to the vehicle. The orientation of the mobile device, prior to repositioning, may be compared to a current orientation, determined while the vehicle is in motion, in order to determine whether the GNSS-INS system should be re-initialized.

First claim

What is claimed is:

1. A method of in-motion calibration of a Global Navigation Satellite System (GNSS)—Inertial Navigation System (INS) system in a mobile device in a vehicle, the method comprising:
determining a gravity vector based on gyroscope measurements while the vehicle is turning;
determining a forward vector based on the gravity vector and accelerometer measurements while the vehicle is traveling straight;
determining a north vector based on GNSS measurements of a heading angle; and
initializing a GNSS-INS filter using the gravity vector, the forward vector and the north vector.

2. The method of claim 1 , further comprising:
determining the vehicle is turning using the gyroscope measurements before determining the gravity vector.

3. The method of claim 1 , wherein the gravity vector is determined based on gyroscope measurements values and a normalized gyroscope value.

4. The method of claim 1 , further comprising:
determining the vehicle is traveling straight using the gyroscope measurements before estimating the forward vector.

5. The method of claim 1 , wherein the forward vector is determined based on a difference between the accelerometer measurements and the gravity vector and predetermined accelerometer biases.

6. The method of claim 1 , wherein initializing the GNSS-INS filter is performed to determine an orientation of the mobile device with respect to a global reference frame.

7. The method of claim 1 , further comprising:
determining a position fix using the GNSS-INS filter.

8. The method of claim 1 , further comprising:
determining a first orientation of the mobile device with respect to a global reference frame based on the initialized GNSS-INS filter; and
detecting an indication that the mobile device has moved with respect to the vehicle.

9. The method of claim 8 , further comprising:
determining a second orientation of the mobile device with respect to the global reference frame based on an in-motion calibration of the GNSS-INS filter while the vehicle is moving;
comparing the first orientation and the second orientation; and
using the first orientation for the GNSS-INS filter to produce a position and a heading based on the first orientation if a difference between the first orientation and the second orientation is below a threshold and using the second orientation for the GNSS-INS filter to produce the position and the heading based on the second orientation if the difference between the first orientation and the second orientation is above the threshold.

10. The method of claim 9 , further comprising:
determining a third orientation of the mobile device with respect to the global reference frame based on the initialized GNSS-INS filter, wherein comparing the first orientation and the second orientation comprises comparing the first orientation, the second orientation, and the third orientation, wherein the first orientation is used for the GNSS-INS filter if a difference between any of the first orientation, the second orientation, and the third orientation is below the threshold and the second orientation is used for the GNSS-INS filter if the difference between the first orientation, the second orientation, and the third orientation is above the threshold.

11. The method of claim 9 , wherein determining the second orientation of the mobile device with respect to the global reference frame is performed at least in part while the vehicle is turning.

12. The method of claim 8 , wherein detecting the indication that the mobile device has moved with respect to the vehicle comprises comparing inertial sensor measurement data with at least one of velocity data and heading data produced by the GNSS-INS filter and determining the mobile device has moved with respect to the vehicle when a difference between motion determined based on the inertial sensor measurement data and motion determined by the GNSS-INS filter is greater than a threshold.

13. A mobile device in a vehicle, the mobile device configured to support in-motion calibration of a Global Navigation Satellite System (GNSS)-Inertial Navigation System (INS) system in the mobile device, the mobile device comprising:
an inertial measurement unit comprising an accelerometer and a gyroscope;
a GNSS receiver;
at least one memory; and
at least one processor coupled to the inertial measurement unit and the GNSS receiver and the at least one memory, wherein the at least one processor is configured to:
determine a gravity vector based on gyroscope measurements while the vehicle is turning;
determine a forward vector based on the gravity vector and accelerometer measurements while the vehicle is traveling straight;
determine a north vector based on GNSS measurements of a heading angle; and
initialize a GNSS-INS filter using the gravity vector, the forward vector and the north vector.

14. The mobile device of claim 13 , wherein the at least one processor is further configured to:
determine the vehicle is turning using the gyroscope measurements before determining the gravity vector.

15. The mobile device of claim 13 , wherein the gravity vector is determined based on gyroscope measurements values and a normalized gyroscope value.

16. The mobile device of claim 13 , wherein the at least one processor is further configured to:
determine the vehicle is traveling straight using the gyroscope measurements before estimating the forward vector.

17. The mobile device of claim 13 , wherein the forward vector is determined based on a difference between the accelerometer measurements and the gravity vector and predetermined accelerometer biases.

18. The mobile device of claim 13 , wherein the at least one processor is further configured to:
initialize the GNSS-INS filter to determine an orientation of the mobile device with respect to a global reference frame.

19. The mobile device of claim 13 , wherein the at least one processor is further configured to:
determine a position fix using the GNSS-INS filter.

20. The mobile device of claim 13 , wherein the at least one processor is further configured to:
determine a first orientation of the mobile device with respect to a global reference frame based on the initialized GNSS-INS filter; and
detect an indication that the mobile device has moved with respect to the vehicle.

21. The mobile device of claim 20 , wherein the at least one processor is further configured to:
determine a second orientation of the mobile device with respect to the global reference frame based on an in-motion calibration of the GNSS-INS filter while the vehicle is moving;
compare the first orientation and the second orientation; and
use the first orientation for the GNSS-INS filter to produce a position and a heading based on the first orientation if a difference between the first orientation and the second orientation is below a threshold and using the second orientation for the GNSS-INS filter to produce the position and the heading based on the second orientation if the difference between the first orientation and the second orientation is above the threshold.

22. The mobile device of claim 21 , wherein the at least one processor is further configured to:
determine a third orientation of the mobile device with respect to the global reference frame based on the initialized GNSS-INS filter, wherein to compare the first orientation and the second orientation, the at least one processor is configured to compare the first orientation, the second orientati

Assignees

• Qualcomm Inc

Inventors

• Saini Vinod Kumar
• Lakhzouri Abdelmonaem
• Zheng Bo
• Morrison William

Classifications

• G01S19/52

  Determining velocity · CPC title

• G01S19/428

  using multipath or indirect path propagation signals in position determination · CPC title

• G01S19/393

  Trajectory determination or predictive tracking, e.g. Kalman filtering · CPC title

• G01S19/47 Primary

  the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial · CPC title

• G01C25/005 Primary

  initial alignment, calibration or starting-up of inertial devices · CPC title