Hybrid inertial navigation system based on a kinematic model

• US 8,165,795 B2
• Filed: 12/07/2005
• Issued: 04/24/2012
• Est. Priority Date: 12/07/2004
• Status: Active Grant

• Current Assignee: Safran Electronics & Defense
• Original Assignee: Sagem Defense Securite SA (Safran SA)
• Inventors: Debailleul, Frédéric
• Primary Examiner(s): Hellner, Mark
• Assistant Examiner(s): Diacou, Ari M
• Application Number:
  US11/792,403
• Publication Number:
  US 20080221794A1
• Time in Patent Office: 2,330 Days
• Field of Search: 701220-221, 701/205, 342/357.14, 244/3.2, 244/79, 244/164
• US Class Current: 701/220
• 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

The invention concerns a method for improving determination of inertial navigation parameters (1) of a carrier (1) moving along modelizable kinematic movement components, the method including the following steps: (a) selecting, taking into account a kinematic model (13) of the carrier (1), at least one movement component whereby integration (11) of the inertial measurements (20) is assumed to give a predetermined value, (b) integrating (11) the inertial measurements (20) in accordance with the selected component(s), (c) determining (14) based on the component(s) a variation between the integration (11) obtained at step (b) and the predetermined value of step (a), (d) estimating on the basis of the variation(s) thus obtained a global inertial error resulting from internal errors associated with said modelizable components, and values to be updated of variable parameters of the kinematic model (13), (e) correcting said inertial navigation based on the thus determined global inertial error. The invention also concerns an inertial navigation system for implementing said method.

Claims

1. A method intended to determine the inertial navigation parameters (18) of a carrier (1) moving along with modelizable kinematic movement components and comprising an inertial navigation system without motion external information, in which the inertial navigation system performs the steps consisting of:

(a) providing inertial measurements (20), which can include an error, known as the inertia error, which results in determining these parameters inaccurately (18),

(b) choosing, by the inertial navigation system, on a kinematic model (13) of the carrier (1), at least one movement component according to which the integration (11) of the inertial measurements (20) is assumed to give a predetermined value,

(c) integrating (11) measurements (20) according to the chosen component or components,

(d) determining (14), according to these components, a difference between the integration (11) obtained at step (c) and the predetermined value from step (b),

(e) estimating, as a function of the difference or differences thus obtained, an overall inertia error resulting from the inertia errors associated with the said modelizable components, and the values of the variable parameters of the kinematic model that are to be updated (13), and

(f) correcting said inertial navigation parameters as a function of the overall inertia error thus determined.

2. A method according to claim 1, characterised in that the estimates in step (e) are made by means of a filter.

3. A method according to claim 2, characterised in that the filter is a Kalman filter.

4. A method according to claim 1, characterised in that one of the variable parameters of the kinematic model is an angle α

between at least one axis (Xb) of the carrier and an axis (Xr) of a road traveled by this carrier.

5. A method according to claim 4, characterised in that the angle α

is modeled as a function of at least one parameter reflecting an operational state of the carrier.

6. A method according to claim 4, characterized in that one of the variable parameters of the kinematic model is a distance coordinate between the axis of the road and of the carrier.

8. A system according to claim 7, characterised in that it also includes means designed to implement the method according to any of claims 2 to 6.

9. A method according to claim 5, characterized in that one of the variable parameters of the kinematic model is a distance coordinate between the axis of the road and of the carrier.

7. An inertial navigation system without motion external information, mounted in a carrier (1) moving along with modelizable kinematic movement components, and that includes:

inertial measurement means for obtaining inertial measurements,

means designed to choose, on a kinematic model (13) of the carrier, at least one movement component according to which integration of the inertial measurements is assumed to give a predetermined value,

means designed to integrate measurements according to the chosen component or components, means designed to determine, in accordance with said components, a difference between the integration and the predetermined value,

means designed to estimate, as a function of the difference or differences thus obtained, an overall inertia error resulting from the inertia errors associated with said modelizable components,

means designed to correct said inertial navigation measurements as a function of the overall inertia error determined, and

means designed to estimate, in accordance with the said difference, values of the variable parameters of the kinematic model that are to be updated (13).