ADJUSTED NAVIGATION

• US 20160245655A1
• Filed: 10/17/2014
• Published: 08/25/2016
• Est. Priority Date: 10/18/2013
• Status: Abandoned Application

• Current Assignee: Nederlandse Organisatie Voor Toegepast-Natuurwetenschappelijk Onderzoek Tno
• Original Assignee: Nederlandse Organisatie Voor Toegepast-Natuurwetenschappelijk Onderzoek Tno
• Inventors: Ruizenaar, Marcel Gregorius Anthonius
• Application Number:
  US15/029,799
• Publication Number:
  US 20160245655A1
• Time in Patent Office: Days
• US Class Current: 1/1
• CPC Class Codes: G01C 21/08 involving use of the magnetic field of the earth
• CPC Class Codes: G01C 21/12 executed aboard the object being navigated; Dead reckoning
• CPC Class Codes: G01C 21/1654 with electromagnetic compass
• CPC Class Codes: G01C 21/188 for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
• CPC Class Codes: G01C 25/00 Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass testing, calibrating or compensating compasses G01C17/38

Abstract

A navigation device (1) comprises:

• • a navigation state estimation unit (11) for repeatedly providing a navigation state estimate comprising at least one of the position, the velocity and the attitude of the device,
  • a prediction unit (12) for providing, using the navigation state estimate, a predicted magnetic property value,
  • a storage unit (13) for retrieving, using the navigation state estimate, a previously stored magnetic property value,
  • a subtraction unit (14) for producing the difference of the predicted magnetic property value and the retrieved magnetic property value,
  • a filter unit (15) for producing, using said difference, a navigation state correction value, and
  • a correction unit (16) for correcting, using said navigation state correction value, a corrected navigation state estimate.

The prediction unit (12) comprises:

• • a magnetic measuring unit for repeatedly providing a measured magnetic field strength value, and
  • an integrating unit for integrating the measured magnetic field strength values to produce the magnetic property value corresponding with the navigation state estimate.

Claims

1. A navigation device, comprising:

a navigation state estimation unit for repeatedly providing a navigation state estimate,

a prediction unit for providing, using the navigation state estimate, a predicted magnetic property value,

a storage unit for retrieving, using the navigation state estimate, a previously stored magnetic property value,

a subtraction unit for producing the difference of the predicted magnetic property value and the retrieved magnetic property value,

a filter unit for producing, using said difference, a navigation state correction value, and

a correction unit for correcting, using said navigation state correction value, a corrected navigation state estimate,

wherein the prediction unit comprises;

a magnetic measuring unit for repeatedly providing a measured magnetic field strength value, and

an integrating unit for integrating the measured magnetic field strength values to produce the magnetic property value corresponding with the navigation state estimate.

2. The device according to claim 1, wherein the filter unit comprises a Kalman filter, which Kalman filter is preferably updated when producing each navigation state correction value.

3. The device according to claim 1, wherein the filter unit is not updated if the difference of the predicted magnetic property value and the retrieved magnetic property value substantially equals zero.

4. The device according to claim 1, wherein the filter unit is not updated if the difference of the predicted magnetic property value and the retrieved magnetic property value exceeds a threshold value.

5. The device according to claim 1, wherein the magnetic measuring unit is configured for determining variations in the magnetic field, and preferably for halting the correcting of the navigation state estimate if the variations fail to exceed a threshold value.

6. The device according to claim 1, wherein the difference of the predicted magnetic property value and the retrieved magnetic property value is given by {tilde over (ψ

)}−

ψ

^table({tilde over (p)}^end)=(H^avg−

H^end)·

{circumflex over (p)} where H^avg is the average magnetic field strength during a measurement trajectory, H^end is the magnetic field strength at the end of the measurement trajectory, and {circumflex over (p)} is the estimated navigation state error.

7. The device according to claim 1, wherein the difference of the predicted magnetic property value and the retrieved magnetic property value is given by

{tilde over (ψ

)}ψ

^t({tilde over (p)}^e)={circumflex over (V)}·

(∫

_O^TH·

dt)+{circumflex over (α

)}·

(∫

_O^TH·

t·

dt)−

{circumflex over (p)}·

(H^end),

where {circumflex over (V)}is the estimated velocity error, H is the magnetic field strength during a measurement trajectory, H^end is the magnetic field strength at the end of the measurement trajectory, α

is the acceleration error, and {circumflex over (p)} is the estimated navigation state error.

8. The device according to claim 1, wherein the navigation state estimation unit is configured for inertial navigation.

9. A vehicle, comprising a navigation device according to claim 1.

10. A set of vehicles arranged for data exchange, the vehicles together comprising all constituent units of the navigation device according to claim 1, a first vehicle comprising the magnetic measuring unit and a second vehicle comprising the navigation state estimation unit.

11. A set of vehicles according to claim 10, wherein the magnetic measuring unit of said first vehicle is part of a first navigation device comprised in the first vehicle, and wherein the navigation state estimation unit of the second vehicle is part of a second navigation device comprised in the second vehicle, said second navigation device comprising:

a navigation state estimation unit for repeatedly providing a navigation state estimate,

a prediction unit for providing, using the navigation state estimate, a predicted magnetic property value,

a storage unit for retrieving, using the navigation state estimate, a previously stored magnetic property value,

a subtraction unit for producing the difference of the predicted magnetic property value and the retrieved magnetic property value,

a filter unit for producing, using said difference, a navigation state correction value, and

a correction unit for correcting, using said navigation state correction value, a corrected navigation state estimate,

wherein the prediction unit comprises;

a magnetic measuring unit for repeatedly providing a measured magnetic field strength value, and

an integrating unit for integrating the measured magnetic field strength values to produce the magnetic property value corresponding with the navigation state estimate,

wherein said magnetic measuring unit of said first vehicle determines magnetic property values for storage in said storage unit of said second navigation device, to be used by the subtraction unit of the second navigation device for producing the difference of the predicted magnetic property value and the retrieved magnetic property value.

12. A navigation method comprising the steps of:

repeatedly providing a navigation state estimate,

providing, using the navigation state estimate, a predicted magnetic property value,

retrieving, using the navigation state estimate, a previously stored magnetic property value,

producing the difference of the predicted magnetic property value and the retrieved magnetic property value,

producing, using said difference, a navigation state correction value, and

correcting, using said navigation state correction value, a corrected navigation state estimate,

wherein the step of providing a predicted magnetic property value comprises;

repeatedly providing a measured magnetic field strength value, and

integrating the measured magnetic field strength values to produce the magnetic property value corresponding with the navigation state estimate.

13. The method according to claim 12, wherein the step of producing a navigation state correction value comprises Kalman filtering, which Kalman filtering preferably comprises updating a filtering state when producing each navigation state correction value.

14. The method according to claim 13, wherein the Kalman filtering state is not updated if the difference of the predicted magnetic property value and the retrieved magnetic property value substantially equals zero.

15. The method according to claim 12, wherein the previously stored magnetic property values are obtained by repeatedly providing a measured magnetic field strength value, and integrating the measured magnetic field strength values.

16. The method according to claim 15, wherein the step of repeatedly providing a measured magnetic field strength value is carried out in a first vehicle, and wherein the other steps are carried out in a second vehicle, the values being transmitted from the first to the second vehicle, the second vehicle preferably following the first vehicle.

17. The method according to claim 12, wherein the difference of the predicted magnetic property value and the retrieved magnetic property value is given by {tilde over (ψ

)}−

ψ

^table({tilde over (p)}^end)=(H^avg−

H^end)·

{circumflex over (p)}, where H^avg is the average magnetic field strength during a measurement trajectory, H^end is the magnetic field strength at the end of the measurement trajectory, and {circumflex over (p)} is the estimated navigation state.

18. The method according to claim 12, wherein the difference of the predicted magnetic property value and the retrieved magnetic property value is given by

{tilde over (ψ

)}−

ψ

^t({tilde over (p)}^e)={circumflex over (V)}·

(∫

_O^TH·

dt)+{circumflex over (α

)}·

(∫

_O^TH·

t·

dt)−

{circumflex over (p)}·

(H^end),

where {circumflex over (V)} is the estimated velocity, H is the magnetic field strength during a measurement trajectory, H^end is the magnetic field strength at the end of the measurement trajectory, a is the acceleration, and {circumflex over (p)} is the estimated navigation state.

19. A computer program product for carrying out the method according to claim 12.