System and method for fusing dead reckoning and GNSS data streams

Patent metadata

Field	Value
Publication number	US-12013472-B2
Application number	US-202218073304-A
Country	US
Kind code	B2
Filing date	Dec 1, 2022
Priority date	Dec 17, 2020
Publication date	Jun 18, 2024
Grant date	Jun 18, 2024

Abstract

A method can include receiving sensor data, receiving satellite observations, determining a positioning solution (e.g., PVT solution, PVA solution, kinematic parameters, etc.) based on the sensor data and the satellite observations. A system can include a sensor, a GNSS receiver, and a processor configured to determine a positioning solution based on readings from the sensor and the GNSS receiver.

First claim

We claim:

1. A method comprising:
measuring sensor data;
initializing a positioning solution for a body using a prior positioning solution for the body;
validating the prior positioning solution by performing hypothesis testing between a set of test positioning solutions and the prior positioning solution, wherein the set of test positioning solutions are generated based on the sensor data, wherein the prior positioning solution is validated when a test positioning solution of the set of test positioning solutions matches the prior positioning solution;
receiving satellite signals at a GNSS (global navigation satellite system) receiver of the body; and
when the prior positioning solution is validated, updating the positioning solution.

2. The method of claim 1 , wherein updating the positioning solution comprises updating the positioning solution using the sensor data, the satellite signals, and the prior positioning solution.

3. The method of claim 1 , wherein validating the prior positioning solution comprises comparing an attitude of each test positioning solution of the set of test positioning solutions to an attitude of the prior positioning solution, wherein the prior positioning solution is validated when an attitude of the test positioning solution of the set of test positioning solutions matches the attitude of the prior positioning solution.

4. The method of claim 1 , further comprising: when the prior positioning solution is not validated, determining an alignment of the body without using the prior positioning solution.

5. The method of claim 4 , wherein determining the alignment of the body comprises:
estimating an attitude of the body using two noncollinear vectors; and
determining a rotation matrix between the two noncollinear vectors using an alignment algorithm.

6. The method of claim 1 , further comprising when a covariance of the positioning solution exceeds a threshold covariance, determining an alignment of the body without using the prior positioning solution.

7. The method of claim 1 , wherein updating the positioning solution comprises updating the positioning solution using the sensor data and the satellite signals, wherein the sensor data and the satellite signals are loosely coupled.

8. The method of claim 1 , further comprising determining a motion state of the body using at least one of a velocity magnitude, a velocity orientation, an acceleration magnitude, or an acceleration orientation of the body.

9. The method of claim 8 , wherein a constraint used during updating the positioning solution depend on the motion state.

10. The method of claim 1 , wherein the body comprises a vehicle, agricultural equipment, a lawn mower, or a robot.

11. A method for determining a positioning solution of a body comprising:
at a first frequency:
receiving sensor data;
correcting for an error in the sensor data;
determining a sensor positioning solution of the body by integrating a sensor mechanization model to update a prior positioning solution;

at a second frequency that is less than the first frequency;
receiving satellite signals at a GNSS (global navigation satellite system) receiver of the body;
determining a GNSS positioning solution of the body using the satellite signals;

determining a motion state of the body; and
fusing the sensor positioning solution of the body with the GNSS positioning solution of the body to determine the positioning solution of the body;

wherein a constraint applied in determining at least one of the sensor positioning solution and the GNSS positioning solution depends on the motion state of the body.

12. The method of claim 11 , wherein fusing the sensor positioning solution with the GNSS positioning solution comprises fusing the sensor positioning solution with the GNSS positioning solution using an extended Kalman filter.

13. The method of claim 11 , wherein fusing the sensor positioning solution with the GNSS positioning solution comprises determining a sensor bias, wherein correcting for the error comprises correcting the sensor data for the sensor bias.

14. The method of claim 11 , further comprising determining an initial positioning solution, wherein the prior positioning solution begins at the initial positioning solution.

15. The method of claim 14 , further comprising validating the initial positioning solution, wherein the initial positioning solution comprises a previously determined positioning solution, wherein when the initial positioning solution is validated the initial positioning solution is used, wherein when the initial positioning solution is not validated the initial positioning solution is not used.

16. The method of claim 15 , wherein validating the initial positioning solution comprises:
determining a set of test positioning solutions;
performing hypothesis testing comparing the initial positioning solution to each test positioning solution of the set of test positioning solutions; and
validating the initial positioning solution when a test positioning solution of the set of test positioning solutions match differ by at most a threshold amount.

17. The method of claim 15 , further comprising when the initial positioning solution is not validated, determining an alignment of the body.

18. The method of claim 14 , wherein the initial positioning solution is determined when a velocity of the body is less than a threshold velocity.

19. The method of claim 11 , further comprising temporally aligning the sensor data to the satellite signals based on an epoch of the satellite signals.

20. The method of claim 11 , wherein the constraint comprises a nonholonomic constraint, wherein when the motion state comprises rectilinear motion the nonholonomic constraint is applied, wherein when the motion state comprises curvilinear motion the nonholonomic constraint is not applied.

Assignees

• Swift Navigation Inc

Inventors

• Reimer Christian
• Decerprit Guillaume
• Deurloo Richard
• Carcanague Sebastien
• Angelo Joseph

Classifications

• G01S19/52

  Determining velocity · CPC title

• G01S19/44

  Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method · CPC title

• G01S19/43

  using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry · CPC title

• G01S19/54

  using carrier phase measurements; using long or short baseline interferometry · CPC title

• G01S19/258

  relating to the satellite constellation, e.g. almanac, ephemeris data, lists of satellites in view · CPC title