Data processing: vehicles – navigation – and relative location – Navigation – Employing position determining equipment
Reexamination Certificate
1999-07-21
2001-09-04
Nguyen, Tan (Department: 3661)
Data processing: vehicles, navigation, and relative location
Navigation
Employing position determining equipment
C701S220000, C342S357490
Reexamination Certificate
active
06285954
ABSTRACT:
CROSS-REFERENCE TO RELATED APPLICATIONS
(Not applicable)
BACKGROUND OF THE INVENTION
The invention relates generally to inertial navigation systems and more specifically to sensors used in such systems to measure the values of environmental variables and the compensation of such sensors for variations in other environmental variables.
Strapdown inertial navigation systems are frequently used in missiles and aircraft. Physically isolated and stabilized apparatus, such as a gimballed platform that is physically angularly-stabilized relative to the local vertical direction, require precise and mechanically complex angle positioning apparatus, and are being systematically replaced by systems of the strapdown type.
A state-of-the-art strapdown inertial navigation system has three rotation sensors or gyros and three accelerometers rigidly attached to a supporting vehicle. The rotation sensors are each positioned and oriented to sense angular displacement about one of three defined orthogonal axes attached to the vehicle body and known as the body coordinate system. The accelerometers are each positioned and oriented in a fixed direction relative to the vehicle, to sense velocity changes (incremental velocities) along different ones of the three defined orthogonal axes. In a strapdown system, the accelerometer axes are not angularly stabilized.
Because the accelerometers are constantly changing direction relative to gravity, navigation velocities cannot be computed by directly integrating the accelerometer signals. Instead, a stable computational frame or analytic navigation coordinate system is continually generated. The output signals from the rotation sensors are used by an attitude integration apparatus to calculate the directions of local vertical, together with two other axes orthogonal to the local vertical direction.
Sensed angle changes and accelerations (incremental velocities) are continually rotated through the calculated angles from the vehicle body axes to the calculated navigation axes. Angle signals from the rotation sensors are used to update the computer-stored angular position and incremental velocity data for both the angle sensors and accelerometers relative to the navigation coordinate system.
The rotation sensors and accelerometers have fixed relative directions in the body coordinate system. An angular transformation matrix of direction cosines is computed in an attitude integration apparatus. The accelerometer signals, which are incremental changes in velocity, in the strapdown body coordinate system are converted in a coordinate transformation computer from that system into corresponding signals in the stabilized navigation coordinate system.
After transformation into the navigation coordinate system, the incremental velocity signals are integrated or summed to form updated velocity signals. The rotation sensor and accelerometer signals are sampled, and the sampled signals are delivered to a computer which is programmed to accept the signals and to calculate both velocities along the three axes in the stabilized navigation coordinate system and attitude angles relative to this system.
The estimate x
1e
produced by a sensor of an environmental variable x
1
may be affected by the values of other environmental variables x
2
, x
3
, . . . , x
K
such as temperature, pressure, and humidity and possibly first and even higher-order time derivatives of such variables. To achieve the ultimate measurement accuracy, the output x
1e
of such a sensor is compensated for variations in these other environmental variables by means of a compensation model &dgr;x
1
(x
1e
, x
2e
, x
3e
, . . . , x
Ke
) where x
1e
, x
2e
, x
3e
, . . . , x
Ke
are the outputs from sensors that result respectively from the sensor inputs x
1
, x
2
, x
3
, . . . , x
K
. The compensated output x
1c
is given by
x
1c
=x
1e
−&dgr;x
1
(1)
Note that the compensation model &dgr;x
1
may be a function of x
1
. The compensation model can be expressed as
δ
x
1
=
∑
i
a
i
f
i
(
x
ie
)
(
2
)
The quantity x
ie
denotes a particular set of the variables of interest x
1e
, x
2e
, x
3e
, . . . , x
Ke
. The set may be different for each value of i. The function ƒ
i
(x
ie
) is a function of the one or more variables in the set x
ie
associated with the index i. The symbols a
i
denote quantities that are constant, at least over the short term.
We can rewrite equation (1) as
x
1c
−x
1a
=x
1e
−x
1a
−&dgr;x
1
(3)
where x
1a
is the actual value of x
1
supplied by an external source. We wish to choose the coefficients a
i
so that x
1c
is an accurate estimate of x
1
. We do this by finding the values which minimize a statistical measure of the magnitude of
x
1
e
-
x
1
a
-
∑
i
a
i
f
i
(
x
ie
)
for a variety of values for x
1
, x
2
, x
3
, . . . , x
K
. A suitable statistical measure might be the sum of the squares of
x
1
e
-
x
1
-
∑
i
a
i
f
i
(
x
ie
)
for the variety of values for x
1
, x
2
, x
3
, . . . , x
K
.
The sensor outputs may be noisy and it may be desirable for the purpose of minimizing the computational requirements to apply a noise-reducing operator G to the sensor outputs prior to determining the values of a
i
. The operator G transforms the values of a sensor output associated with times extending from present time minus a predetermined time interval T to present time into a single present-time value. An example of an operator G operating on a function x(t) is provided by a lowpass filter which is described mathematically by the equation
Gx
(
t
)
=
∫
0
∞
x
(
t
-
t
′
)
h
(
t
′
)
ⅆ
t
′
(
4
)
where the function h(t) is the impulse response of the filter and is essentially zero for times greater than T. For some cases, the operator G may be nonlinear: G(x
1
+x
2
) may not be equal to the sum of Gx
1
and Gx
2
.
Applying G to equation (3),
G
(
x
1c
−x
1a
)
=G
(
x
1e
−x
1a
−&dgr;x
1
) (5)
A relatively simple approach to determining a compensation model is to assume G to be reasonably linear. We also assume Gx
ke
to be equal to x
ke
at times T after a change in the values of one or more of the sensor inputs x
1
, x
2
, . . . , x
k
, . . . , x
K
in the absence of noise. Then at such times T,
G
(
x
1
c
-
x
1
a
)
=
Gx
1
e
-
x
1
a
-
∑
i
a
i
f
i
(
Gx
ie
)
(
6
)
where the notation Gx
ie
means that each x
ke
in the functional representation is replaced by Gx
ke
.
We determine the values of the coefficients a
i
by finding the values which minimize a statistical measure of the magnitude of
Gx
1
e
-
x
1
a
-
∑
i
a
i
f
i
(
Gx
ie
)
using the values obtained at times T after changes in the values of x
i
.
This process for determining the a's may be difficult, inconvenient, and inadequate for several reasons. First of all, the process is time-consuming since x
1
, x
2
, x
3
, . . . , x
K
must be held constant for time intervals T. Second, the calibration must sometimes include variables that are time derivatives of other variables. One cannot hold a variable constant if the time derivative of the variable is required to take on values other than zero.
A calibration process is needed that does not require the variables affecting the output of a sensor to be held constant for time periods T during the execution of the calibration process.
BRIEF SUMMARY OF THE INVENTION
The invention is a method and apparatus for obtaining an accurate value x
1c
of a variable x
1
based on an estimate x
1e
that is a function of K variables x
1
, x
2
, . . . , x
k
, . . . , x
K
. The method comprises the steps of (a) obtaining a plurality of estimates x
1e
, x
2e
, . . . , x
ke
, . . . , x
Ke
of the variables x
1
, x
2
, . . . , x
k
, . . . , x
K
over a method-execution time period, the values of the variables x
1
,
Mark John G.
Tazartes Daniel A.
Litton Systems Inc.
Malm Robert E.
Nguyen Tan
LandOfFree
Compensation system does not yet have a rating. At this time, there are no reviews or comments for this patent.
If you have personal experience with Compensation system, we encourage you to share that experience with our LandOfFree.com community. Your opinion is very important and Compensation system will most certainly appreciate the feedback.
Profile ID: LFUS-PAI-O-2530799