Data processing: vehicles – navigation – and relative location – Navigation – Employing position determining equipment
Reexamination Certificate
1996-11-22
2001-06-26
Zanelli, Michael J. (Department: 3661)
Data processing: vehicles, navigation, and relative location
Navigation
Employing position determining equipment
C701S220000, C702S093000, C702S151000
Reexamination Certificate
active
06253154
ABSTRACT:
BACKGROUND OF THE INVENTION
The present invention generally relates to systems for navigation. In particular, the invention relates to correcting angular speed, offset error and gain error in a system for navigation.
Systems in the art for navigating a vehicle may employ a gyroscopic sensor to detect the angular speed of the vehicle. It is well known that each such gyroscope has several characteristics whose actual values are specific to that particular gyroscope. These gyroscopic characteristics include offset error for the typifying offset; gain error for the typifying gain; and right and left gain differences for the typifying right and left gain. These gyroscopic characteristics cause the navigation apparatus to incorrectly position the vehicle. Each is described in turn below.
Each gyroscope gives a voltage output corresponding to the angular speed of the object (e.g., the vehicle) on which it is mounted.
FIGS. 2A and 2B
illustrate the relationship of the gyroscopic output voltage to the angular speed of the vehicle. The angular speed (AS) of the vehicle equals the output voltage of the gyroscope (V
GYRO
) less the typifying offset voltage (V
OFFSET
), divided by the gain (G):
AS
=
V
GYRO
-
V
OFFSET
G
(
1
)
However, each gyroscope has a characteristic offset error.
FIG. 3
illustrates the relationship of two offset errors to the typifying offset of the gyroscope. In
FIG. 3
, the offset error
310
is positive, causing the high offset
320
. The offset error
311
is negative, causing the low offset
321
.
Accordingly, the angular speed of the vehicle is better determined not as in equation (1) but as in equations (2) and (3):
AS
OFFSET
ERROR
=
V
GYRO
,
OFFSET
ERROR
-
V
OFFSET
G
(
2
)
V
GYRO
,
OFFSET
ERROR
=
V
GYRO
+
V
OFFSET
ERROR
(
3
)
The angular speed with the offset error (AS
OFFSET ERROR
) equals the voltage output of the gyroscope with the offset error (V
GYRO, OFFSET ERROR
) less the offset (V
OFFSET
), divided by the gain (G). The voltage output including the offset error (V
GYRO, OFFSET ERROR
) is sum of the voltage output of the gyroscope (V
GYRO
) and the offset error (V
OFFSET ERROR
).
Thus, even though the vehicle may be moving in a straight line, the systems of the prior art may determine that the vehicle is turning right when the characteristic offset error is positive. Conversely, the systems of the prior art may determine that the vehicle is turning left when the characteristic offset error is negative. These wrong determinations cause systems of the prior art to position the vehicle incorrectly.
Further, each gyroscope has a characteristic gain error.
FIG. 4
illustrates the relationship of two gain errors to the typifying gain of the gyroscope. A high gain error is charted as the high gain error
410
. A low gain error is charted as the low gain error
411
. As a result, in the presence of gain error, the angular speed of the vehicle is determined by equations (4), (5) and (6) rather than equation (1):
AS
G
ERROR
=
V
GYRO
-
V
OFFSET
G
G
ERROR
(
4
)
G
G
ERROR
=
G
×
K
G
ERROR
(
5
)
K
G
ERROR
:
=
1
,
No
Error
>
1
,
High
Gain
<
1
,
Low
Gain
(
6
)
Now the angular speed in consideration of the gain error (AS
G ERROR
) is the difference between the output voltage of the gyroscope (V
GYRO
) and the offset voltage (V
OFFSET
), divided by the gain with gain error (G
G ERROR
). The gain with gain error (G
G ERROR
) is the typifying gain of the gyroscope (G) ratioed by a factor K
G ERROR
. K
G ERROR
equals 1 when there is no gain error but is less than one when the gain is erroneously low. K
G ERROR
is greater than one when the gain is erroneously high.
The presence of the characteristic gain error causes apparatus of the prior art to detect and determine the position of the vehicle incorrectly. For example, where the vehicle actually turns 90°, a system with a high gain error determines that the vehicle has turned more than the actual 90°. Likewise, a system with a low gain error detects that the vehicle has turned something less than the true 90°.
As a final example consider the difference in characteristic gyroscopic gain error between right and left vehicle movements.
FIG. 4
illustrates the relationship of the differential right and left gain error with respect to the typifying gain of a gyroscope. For a vehicle turning m degrees/sec to the left and then m degrees/sec to the right, a system not adjusting for the differential right and left gain error detects different absolute values ¦n′¦ and ¦n″¦ for the left and right turns, respectively.
Accordingly, there is a need for a methodology and device which detects a characteristic error in a gyroscope, including offset error, gain error and the differential right and left gain error.
Also, there is a need for a methodology and device which compensates for a characteristic error in a gyroscope, including offset error, gain error and the differential right and left gain error.
In U.S. Pat. No. 5,404,307 (April, 1995), Odagawa describes a navigation apparatus which corrects data from a angular speed detector with data from an azimuth detector. Likewise, in U.S. Pat. No. 5,424,953 (June, 1995), Masumoto et al. also describes a navigation apparatus which corrects data from an angular speed detector with data from an azimuth detector.
However, when the gyroscope has different gains for right and left turns, the Odagawa navigation system cannot effect corrections so that the gain correction value is accurate for both right and left turns.
Further, Masumoto attempts to detect the straight movement of a vehicle using the output of an angular speed sensor and a direction detection sensor. However, where the angular speed sensor has an offset error, the Masumoto device operates incorrectly.
In both the Odagawa and Masumoto devices, before the first determination of the gain error correction value after powering on of the system, compensation for that gain error is not possible.
SUMMARY OF THE INVENTION
Herein is described an apparatus and method for determining the position of an object, particularly during navigation. In one embodiment, the apparatus and method include correcting the offset error of an angular speed detector (typically, a gyroscope) using an azimuth detector distinct from the angular speed detector; and then determining the position of the moving body using the offset error-corrected angular speed.
In a second embodiment, the apparatus and method include correcting the gain error of the angular speed detector using an azimuth detector distinct from the angular speed detector; and then determining the position of the moving body using the gain error-corrected angular speed.
In a third embodiment, the apparatus and method include correcting both the gain error and the offset error of an angular speed detector using an azimuth detector distinct from the angular speed detector; and then determining the position of the moving body using the offset error- and gain error-corrected angular speed.
The correction of the offset error includes checking the azimuth and movement of the object for three predetermined periods of time; then checking whether the object was moving in a straight line each of the three predetermined periods of time. If the object was moving in a straight line each of the three predetermined periods of time, then an offset error correction value is computed using data from the second of the three predetermined periods of time.
The correction of the gain error includes determining the movement of the object as straight; then determining the movement of the object as a turn; then determining the movement of the object as straight again. If the turn was a left turn, a left gain error correction value is computed. Similarly, if the turn was a right turn, a right gain error correction value is
Oshizawa Hidekazu
Sakakibara Toshikazu
Taniguchi Noboru
Beyer & Weaver, LLP
Visteon Technologies, LLC
Zanelli Michael J.
LandOfFree
Method and apparatus for navigating with correction of... does not yet have a rating. At this time, there are no reviews or comments for this patent.
If you have personal experience with Method and apparatus for navigating with correction of..., we encourage you to share that experience with our LandOfFree.com community. Your opinion is very important and Method and apparatus for navigating with correction of... will most certainly appreciate the feedback.
Profile ID: LFUS-PAI-O-2435572