CA2221339C - Method and apparatus for navigating with correction of angular speed using azimuth detection sensor - Google Patents
Method and apparatus for navigating with correction of angular speed using azimuth detection sensor Download PDFInfo
- Publication number
- CA2221339C CA2221339C CA002221339A CA2221339A CA2221339C CA 2221339 C CA2221339 C CA 2221339C CA 002221339 A CA002221339 A CA 002221339A CA 2221339 A CA2221339 A CA 2221339A CA 2221339 C CA2221339 C CA 2221339C
- Authority
- CA
- Canada
- Prior art keywords
- determining
- azimuth
- gain error
- angular speed
- turn
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- 238000012937 correction Methods 0.000 title claims abstract description 52
- 238000000034 method Methods 0.000 title claims abstract description 43
- 238000001514 detection method Methods 0.000 title description 11
- 238000005070 sampling Methods 0.000 claims description 7
- 230000000875 corresponding effect Effects 0.000 claims description 4
- 230000003247 decreasing effect Effects 0.000 claims description 2
- 238000005065 mining Methods 0.000 claims 1
- 238000012935 Averaging Methods 0.000 description 3
- 238000012360 testing method Methods 0.000 description 3
- 238000013500 data storage Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- QHGVXILFMXYDRS-UHFFFAOYSA-N pyraclofos Chemical compound C1=C(OP(=O)(OCC)SCCC)C=NN1C1=CC=C(Cl)C=C1 QHGVXILFMXYDRS-UHFFFAOYSA-N 0.000 description 1
- 230000002040 relaxant effect Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Gyroscopes (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
An apparatus and method for more accurately determining the position of a moving object by using an azimuth detector distinct from an angular speed detector to correct the gain error and the offset error of the angular speed detector. The position of the moving body is determined using the offset error- and gain error-corrected angular speed. The correction of the offset error includes checking the azimuth and movement of the moving object for three predetermined periods of time; then checking whether the moving 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 moving object as straight; then determining the movement of the moving object as a turn; then determining the movement of the moving 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 computed.
The correction of the gain error includes determining the movement of the moving object as straight; then determining the movement of the moving object as a turn; then determining the movement of the moving 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 computed.
Description
METHOD AND APPARATUS FOR NAVIGATING WITH
CORRECTION OF ANGULAR SPEED USING AZIMUTH
DETECTION SENSOR
S FIELD 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.
BRIEF DESCRIPTION OF THE DRAWINGS
Figure 1 is a block diagram of a vehicle navi-gation system for use with the present invention;
Figure 2 presents a graph exemplifying the relationship of the gyroscopic output voltage to the angular speed of a vehicle;
Figure 3 illustrates the relationship of the offset error to the typifying offset of a gyroscope;
Figure 4 illustrates the relationship of the gain error to the typifying gain of a gyroscope;
Figure 5 illustrates the determination of the velocity of a vehicle with respect to North and East from the data from a GPS and detecting the vehicle azimuth using these data;
Figure 6 shows a series of azimuths for a minety degree turn to the left;
Figure 7 illustrates the averaging of a number of azimuths A~ to produce an average azimuth;
Figure 8 illustrates a method to determine ~ whether a vehicle is moving in a straight line;
Figures 9A and 9B illustrate an advantage of repeatedly testing new azimuth averages against an his-toric threshold;
Figures l0A and lOB illustrate the use of aver age azimuths to accurately determine the angle of a turn;
Figure 11 shows the flow of data to determine the corrected angular speed AS~ORRECTED:
Figure 12 illustrates the determination of the offset correction value;
CORRECTION OF ANGULAR SPEED USING AZIMUTH
DETECTION SENSOR
S FIELD 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.
BRIEF DESCRIPTION OF THE DRAWINGS
Figure 1 is a block diagram of a vehicle navi-gation system for use with the present invention;
Figure 2 presents a graph exemplifying the relationship of the gyroscopic output voltage to the angular speed of a vehicle;
Figure 3 illustrates the relationship of the offset error to the typifying offset of a gyroscope;
Figure 4 illustrates the relationship of the gain error to the typifying gain of a gyroscope;
Figure 5 illustrates the determination of the velocity of a vehicle with respect to North and East from the data from a GPS and detecting the vehicle azimuth using these data;
Figure 6 shows a series of azimuths for a minety degree turn to the left;
Figure 7 illustrates the averaging of a number of azimuths A~ to produce an average azimuth;
Figure 8 illustrates a method to determine ~ whether a vehicle is moving in a straight line;
Figures 9A and 9B illustrate an advantage of repeatedly testing new azimuth averages against an his-toric threshold;
Figures l0A and lOB illustrate the use of aver age azimuths to accurately determine the angle of a turn;
Figure 11 shows the flow of data to determine the corrected angular speed AS~ORRECTED:
Figure 12 illustrates the determination of the offset correction value;
Figure 13 illustrates the determination of the angular speed correction;
Figures 14A and 14B illustrate the determina-tion of the gain error correction value; and Figure 15 illustrates the relationship of the differential right and left gain error with respect to the typifying gain of a gyroscope.
BACKGROUND OF THE INVENTION
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 spe-cific 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 naviga-tion apparatus to incorrectly position the vehicle. Each is described in turn below.
Each gyroscope gives a voltage output corre-sponding to the angular speed of the object (e.g., the vehicle) on which it is mounted. Figure 2 presents a graph exemplifying the relationship of the gyroscopic output voltage to the angular speed of the vehicle. The angular speed (AS) of the vehicle equals the output volt-age of the gyroscope (V~YRO) less the typifying offset voltage (VpFFSET) . divided by the gain (G) AS _ ~G~O yOFFSET
However, each gyroscope has a characteristic offset error. Figure 3 illustrates the relationship of two offset errors to the typifying offset of the gyro-scope. In Figure 3, the offset error 310 is positive, causing the high offset 320.
Figures 14A and 14B illustrate the determina-tion of the gain error correction value; and Figure 15 illustrates the relationship of the differential right and left gain error with respect to the typifying gain of a gyroscope.
BACKGROUND OF THE INVENTION
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 spe-cific 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 naviga-tion apparatus to incorrectly position the vehicle. Each is described in turn below.
Each gyroscope gives a voltage output corre-sponding to the angular speed of the object (e.g., the vehicle) on which it is mounted. Figure 2 presents a graph exemplifying the relationship of the gyroscopic output voltage to the angular speed of the vehicle. The angular speed (AS) of the vehicle equals the output volt-age of the gyroscope (V~YRO) less the typifying offset voltage (VpFFSET) . divided by the gain (G) AS _ ~G~O yOFFSET
However, each gyroscope has a characteristic offset error. Figure 3 illustrates the relationship of two offset errors to the typifying offset of the gyro-scope. In Figure 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):
__ yGYRO,OFFSET ERROR OFFSET
ASOFFSET ERROR G
VGYRO.OFFSET ERROR VGYRO + VOFFSET ERROR (3' The angular speed with the offset error (ASOFFSET ERROR] equals the voltage output of the gyroscope with the offset error (UGYRO, OFFSET ERROR] less the Offset (vOFFSET~ ~ divided by the gain (G). The voltage output including the offset error (VGYRO, OFFSET ERROR) is sum of the voltage output of the gyroscope (VGYROj and the offset error (VOFFSET 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. Figure 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) __ VGYRO yOFFSET
ASG ERROR
~'G ERROR
Accordingly, the angular speed of the vehicle is better determined not as in equation (1) but as in equations (2) and (3):
__ yGYRO,OFFSET ERROR OFFSET
ASOFFSET ERROR G
VGYRO.OFFSET ERROR VGYRO + VOFFSET ERROR (3' The angular speed with the offset error (ASOFFSET ERROR] equals the voltage output of the gyroscope with the offset error (UGYRO, OFFSET ERROR] less the Offset (vOFFSET~ ~ divided by the gain (G). The voltage output including the offset error (VGYRO, OFFSET ERROR) is sum of the voltage output of the gyroscope (VGYROj and the offset error (VOFFSET 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. Figure 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) __ VGYRO yOFFSET
ASG ERROR
~'G ERROR
GG ERROR - G '~ KG ERROR
= 1, No Error KC ERROR ~ > 1. High Gain < 1, Low Gain Now the angular speed in consideration of the gain error (ASG ERgOR) is the difference between the output voltage of the ' gyroscope (vGYRO) and the offset voltage (VOFFSET) . divided by the gain with gain error (GG ERROR)~ The gain with gain error (GG ERROR) is the typifying gain of the gyroscope (G) ratioed by a factor KG ERROR~ KG ERROR equals 1 when there is no gain error but is less than one when the gain is erroneously low.
KG ERROR 1S 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. Figure 15 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 w 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. Patent No. 5,404,307 (April, 1995), Odagawa describes a navigation apparatus which corrects data from a 5 angular speed detector with data from an azimuth detector.
Likewise, in U.S. Patent 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 sxstem, 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 de-tector 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 1~ 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 peri-15 ods of time, then an offset error correction value is computed using data from the second of the three prede-termined periods of time.
The correction of the gain error includes de-termining the movement of the object as straight; then 20 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 computed.
DESCRIPTION OF THE PREFERRED EMBODIMENT
Figure 1 is a block diagram of a vehicle navi-gation system 100 for use with the present invention.
The sensors 112 to 116 and the GPS receiver 118 are cou-~ pled to the computing means 120 through the sensor/GPS
interface 130. In typical embodiments, the mileage sen-sor 112 comprises an odometer; the angular velocity sen-sor 114 comprises a gyroscope, or a differential odometer coupled to the wheels of the vehicle; and the geomagnetic sensor 116 usually comprises a magnetic compass mounted in the vehicle. A global positioning system (GPS) data receiver 118 is provided for receiving signals from, for example, a satellite-based navigating system. Data from the sensor/GPS interface 130 is 7 vn..a ..n transmitted to the CPU 140 which performs calibration, signal processing, dead-reckoning, vehicle positioning and route guidance functions.
A database containing map information may be stored in the storage medium 150, with software directing the operation of the computing means 120 stored in the ROM 161 or the RAM 162 for execution by the CPU 140. The RAM 162 also permits reading and writing of the information necessary to execute such software programs. The storage medium 150 may include a hard disk drive, CD-ROM or integrated circuit onto which digitized map information has been stored or may include an interface to an external storage medium (not shown).
The output controller 170, which may include a graphics controller, receives data processed by the CPU 140 and transmits such data to the output communicator 180, which usually includes a display screen. The user may input data, such as a desired destination, through user interface 190, typically including a keyboard.
The map database stored in the storage medium 150 preferably includes positional data such as, for example, latitude and longitude coordinates to describe road intersections, road segments, landmarks, points of interest and other geographical information. The data base may further include data representing characteristics of roads or places on the map such as road and place names, road features (for example, dividers, one-way restrictions, surface, speed limit, shape and elevation), and other properties. Using the data stored in the map data base, the vehicle navigation system 100 generates one or more possible positions of the vehicle by comparing the dead-reckoned position to the road segments, intersections, and other geographical locations stored in the data base. The system then filters the set of position.
possibilities and selects from the remaining position possibilities a position deemed to be the current position of the vehicle.
veua mn Overyiew The invention disclosed hereinbelow determines the characteristic offset error of a gyroscope and corrects for the offset error. Also, the invention determines the characteristic gain error of a gyroscope and corrects for the gain error. Still further, the invention also determines and corrects for the differential gain error for right and left turns. By incorporating the corrections to the offset error and the (right and left) gain error into the determination of the angular speed, the invention correctly determines the angular speed of the object. Each of these determinations is explained in turn below, beginning with the determination and correction of the characteristic offset error.
Determination of Offset Error Correction Value Figure 12 illustrates a method for determining the value for correcting the characteristic offset error of a gyroscope mounted on a vehicle. As the first steps, the azimuth and straight-wise movement of the vehicle are thrice checked, steps 1205, 1210, 1215. If the vehicle was moving straight for each of~the three checks, step 1220, a correction value for the offset error is computed, step 1225, and saved for later use, step 1230. Each of these steps is described more fully below.
- Detection of Vehicle Azimuth In one embodiment, a system incorporating the invention uses a Global Positioning System (GPS), or other broadcast positioning system as an azimuth detection method 3o for a vehicle. As Figure 5 illustrates, the system can determine the velocity of a vehicle 530 with respect to North and East from the data from the GPS receiver and can detect the vehicle azimuth 510 using these data. The octagon 520 shows the position given by the GPS and the arrow 510 shows the azimuth. Thus, the system can check vehicle azimuths as required in steps 1205 through 1215.
However, at low speeds, the difference in successive positions of the vehicle as detected by the GPS is small.
wua m Indeed, the difference may even fall below the ability of the GPS to detect. Therefore, in the pursuit of improved accuracy, the system 100 ignores the azimuth as determined from the GPS when the vehicle is moving slower than a predetermined speed.
- Detection of Vehicle Turn In another embodiment, a navigation system incorporating one aspect of the invention can detect when the vehicle 530 is turning by examining a series of azimuths and then deriving the locus of the series. Figure 6 shows a series of azimuths for a ninety degree turn to the left.
- _Detection of Vehicle Straight Movement On the other hand, a system incorporating another aspect of the invention determines whether the vehicle is moving in a straight line using a three-check method: Figure 12 gives an overview of this method, and Figure 8 illustrates this three-check method in more detail. The system samples azimuth values for a predetermined period of time, step 805.
If all the sampled azimuths are within a predetermined threshold of their average, the system recognizes the possibility that the vehicle was moving in a straight line for the sampling time period, step 810. In the second step, the system again samples azimuth values for a second predetermined period of time, step 815. However, the system continues to recognize the possibility of straight-line movement when the average of the azimuths sampled in the second predetermined period is within a predetermined threshold of the average azimuth from the first predetermined period, step 820.
Finally, as the third check, the system again samples azimuth values for a third predetermined period, step 825. The system finally concludes the vehicle was moving in a straight line over the three periods, step 840, where the average of the azimuths samples of the third predetermined period falls within a predetermined threshold of the average azimuth from the first predetermined period, step 830.
asi.n non In this way, the checks for straight movement and detection of straight movement for three periods of time of Figure 12 can be accomplished.
In a preferred embodiment, the first, second and third predetermined periods follow immediately one on the other and are of equal duration. Also, the thresholds for averages for the second and third periods are identical to the first, although some relaxing is permissible. Finally, while the method described uses three time periods, any number of time periods greater than or equal to two can be used.
Figure7 illustrates the averaging of a number of azimuths An to produce an average azimuth Aa~g and the testing of the average azimuth against a threshold. Equation (7) presents the averaging mathematically:
n An Aa~9 = n Figures 9A and 9B illustrate an advantage of repeatedly testing new azimuth averages against an historic average. In Figure 9A, the average of the second sampling of azimuths, Aa~g2, is used to determine whether the vehicle was still moving in a straight line during the second time period.
Likewise, the average of the third sampling of azimuths, g3, is used to determine whether the vehicle was moving in a straight line during the third time period. As can be seen, even though each of the average azimuths (e.g., Aa~g3) may fall within a threshold of the immediately preceding average azimuth (e.g., Aa~g2) and thus indicate that the'vehicle is moving linearly, the vehicle may in fact be turning. By contrast, for the same turn, Figure 9B illustrates that using an historic average azimuth (e. g., Aavgl) helps to prevent false determinations of linear movement.
11 vann W i Determination of Offset Correction Value Above has been described a system and method for detecting whether a vehicle is moving in a straight line.
Below is described the use of the straight-movement detection to determine an offset error correction value.
When a vehicle containing (a navigation system containing) a gyroscope moves in a straight line, the preferred output voltage of the gyroscope is ~IpFFSET~ If the output voltage of the gyroscope is not VoFFSET~ the voltage difference is an offset error which should be corrected.
Equation (8) gives the offset error and thus the offset error correction value as indicated in step 1225:
VOFFSET ERROR VGYRO AVG2 vOFFSET ( a ) where ~IGyRO AVG2 1S the average voltage obtained from the second of the three time periods (step 815) used to make the determination that the vehicle was moving straight (step 840).
Determination of Gain Correction Value A navigatiqn system incorporating another embodiment of the invention can determine and compensate for gain error as described herein. Figures 14A and 14B illustrate a method for determining a gain error correction value. When the system detects that the vehicle was first moving straight, step 1405, then turning, step 1415, then moving straight again, steps 1455, 1420, the system can determine an accurate angle for the turn from the GPS. The system uses the moving azimuths from the straight movements preceding alzd following the turn, steps 1405, 1455.
Figures loA and lOB illustrate the use of average azimuths to accurately determine the angle of a turn. The positional octagons 1010 represent the actual azimuths of the moving vehicle. Before the turn from Beta Street onto Alpha Street represented in Figure 10A, the vehicle is moving along Beta Street with an average azimuth Abefore~ (See Figures l0A
and lOB.) Similarly, the average azimuth Aafter Figures l0A
and lOB) represents the movement of the vehicle after 12 aena iw completing the turn. By projecting the average azimuth Abefore to indicate zero degrees with respect to any subsequent turn, Figure lOB, the navigation system can determine that the average azimuth Aafter represents a +90° turn with respect to the average azimuth AbeforeW
During the turn, the navigation system collects angular speeds from the gyroscope in the vehicle, steps 1415.
These angular speeds have been corrected for the offset error as described herein. During turning, the navigation system computes the angle of turn (0) by integrating these offset error-corrected angular speeds, step 1415. (The system does not compute the gain error correction value before determining the offset correction value in order to avoid incorrectly determining the gain error correction value with offset error.
Cf. step 1425.) The gain error correction value KGAIN ERROR 1S
determined as follows:
_ 8 C9) KGAIN ERROR Aaftez Abefore where B is the angle~of turn computed by integration of the offset error-corrected angular speed, obtained from the gyroscope; Aafter is the average azimuth after turning, obtained from the GPS; and Abefore is the average azimuth before turning, also obtained from the GPS. Cf. steps 1435, 1440.
The denominator of equation (9), the angle the vehicle makes in turning, can range from large to relatively small. Accordingly, when the difference between the before and after average azimuths is relatively small, KGAIN ERROR
includes a relatively larger error (as compared with larger turns). To avoid this problem, the navigation system does not compute K~AIN ERROR when the turn angle is smaller than a predetermined angle.
Alternatively, the navigation system determines KGAIN ERROR as an average over a predetermined number of turns.
For a gyroscope whose gain does not change suddenly, the gain error correction value (KGAIN ERROR) can be computed r~~a i.»
in another alternative as described herein. Where K1 and K2 are predetermined thresholds and where io _ ~ KGAIN ERROR + K1 ( ) Rafter Abefoze then KGAIN ERROR is increased by a predetermined amount.
Similarly, where 8 + (11) KGAIN ERROR
Rafter '~befoze then KGAIN ERROR 15 decreased by a predetermined amount. If the relationship among e~ Aafter~ Abefore arid KGAIN ERROR is OtherWl.Se, then KGAIN ERROR 15 nOt Changed. KGAIN ERROR 1S
initially set to zero.
Classification of Gain for Ri ht Turns ana L
The gain error correction value is determined independently for right and left turns, steps 1430 through 1440.
Correction of AnQUlar Speed A navigation system incorporating yet another embodiment of the invention correct the angular speed gyroscopic output voltage for the offset error and gain error as described herein. The angular speed is corrected according to the formula in Equation (12):
_ vGYRO O~IT ( vOFFSET + VOFFSET ERROR) ( 1Z ) ASCO~~Ep G~ KGAIN ERROR
In the case of right turns:
(13) KGAIN ERROR KRIGNT GAIN ERROR
where KRIGHT GAIN ERROR is the gain error correction value for right turns. Similarly, for left turns:
wmn w~
_ (14) KGAIN ERROR KLEFT GAIN ERROR
where KLEFT GAIN ERROR is the gain error correction value for left turns.
Figure 11 shows the flow of data to determine the corrected angular speed AS~ORRECTED ~ In Figure 11, the computation units 1110, 1111 compute the average azimuths before (Abefore) and after (Rafter) a turn, respectively, using GPS or similar data. These values are the inputs for the computation unit 1112. The output of the computation unit 1112 is a denominator input for the computation unit 1113.
The output voltage of the gyroscope (VGyRO) is an input to the computation unit 1115 which computes the offset correction value (VOFFSET ERROR) when the system detects straight movement (i.e., when the switch 1140 is closed). The computation unit 1114 computes the corrected output voltage of the gyroscope (UGYRO VOFFSET ERROR) with the output voltage of the gyroscope (vGYRO) and the output of the computation unit 1115 as inputs.
The corrected output voltage of the gyroscope is an input to the computation unit 1116 which computes the angular speed (ASwITH GAIN ERROR) ~ The output of the computation unit 1116 is an input to both computation units 1117 and 1118.
The computation unit 1117 computes the angle B of a turn for input as the numerator input to the computation unit 1113.
The output of the computation unit 1113 is an input for the computation unit 1119 which.computes the gain error correction values (KGAIN ERROR) for right and left turns. The switch 1141 is closed when straight movement is detected before and after a turn.
Finally, the output of the computation unit~.1119 and the computation unit 1116 are input to the computation unit 1118 for division. The output of the computation unit 1118 is the desired corrected angular speed (ASCORRECTED) ~ the angular speed with gain error ratioed by the gam error correction value.
Ana nm Correction Immediatel after Power On-The gain error correction Value (K~AIN ERROR) is stored in memory ( 113 0 ) so the angular speed ( AScoRRECTED ~ can be corrected on the powering up of the navigation system.
The invention as described herein is useful not only for gyroscopes but for all angular speed detection sensors.
Further, this invention is useful not only for the global positioning system but for all azimuth detection sensors.
Finally, this invention is useful not~only for vehicles but for any moveable body.
In contrast to Odagawa, U.S. Patent 5,404,307, the invention described herein is capable of correcting differentially for right and left turn gain errors.
In contrast to Masumoto, U.S. Patent 5,424,953, the present invention can detect a vehicle's movement in a straight line using only GPS (or similar) data, even where the angular speed sensor has an offset error.
Finally, the invention makes correction of data from the gyroscope possible immediately on powering up of the system by saving a correction value before the preceding powering off of the system.
Of course, the program text for such software as is herein disclosed can exist in its static form on a magnetic, optical or other disk, on magnetic tape or other medium requiring media movement for storage and/or retrieval, in ROM, in RAM, or in another data storage medium. That data storage medium may be integral to or insertable into a computer system.
= 1, No Error KC ERROR ~ > 1. High Gain < 1, Low Gain Now the angular speed in consideration of the gain error (ASG ERgOR) is the difference between the output voltage of the ' gyroscope (vGYRO) and the offset voltage (VOFFSET) . divided by the gain with gain error (GG ERROR)~ The gain with gain error (GG ERROR) is the typifying gain of the gyroscope (G) ratioed by a factor KG ERROR~ KG ERROR equals 1 when there is no gain error but is less than one when the gain is erroneously low.
KG ERROR 1S 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. Figure 15 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 w 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. Patent No. 5,404,307 (April, 1995), Odagawa describes a navigation apparatus which corrects data from a 5 angular speed detector with data from an azimuth detector.
Likewise, in U.S. Patent 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 sxstem, 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 de-tector 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 1~ 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 peri-15 ods of time, then an offset error correction value is computed using data from the second of the three prede-termined periods of time.
The correction of the gain error includes de-termining the movement of the object as straight; then 20 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 computed.
DESCRIPTION OF THE PREFERRED EMBODIMENT
Figure 1 is a block diagram of a vehicle navi-gation system 100 for use with the present invention.
The sensors 112 to 116 and the GPS receiver 118 are cou-~ pled to the computing means 120 through the sensor/GPS
interface 130. In typical embodiments, the mileage sen-sor 112 comprises an odometer; the angular velocity sen-sor 114 comprises a gyroscope, or a differential odometer coupled to the wheels of the vehicle; and the geomagnetic sensor 116 usually comprises a magnetic compass mounted in the vehicle. A global positioning system (GPS) data receiver 118 is provided for receiving signals from, for example, a satellite-based navigating system. Data from the sensor/GPS interface 130 is 7 vn..a ..n transmitted to the CPU 140 which performs calibration, signal processing, dead-reckoning, vehicle positioning and route guidance functions.
A database containing map information may be stored in the storage medium 150, with software directing the operation of the computing means 120 stored in the ROM 161 or the RAM 162 for execution by the CPU 140. The RAM 162 also permits reading and writing of the information necessary to execute such software programs. The storage medium 150 may include a hard disk drive, CD-ROM or integrated circuit onto which digitized map information has been stored or may include an interface to an external storage medium (not shown).
The output controller 170, which may include a graphics controller, receives data processed by the CPU 140 and transmits such data to the output communicator 180, which usually includes a display screen. The user may input data, such as a desired destination, through user interface 190, typically including a keyboard.
The map database stored in the storage medium 150 preferably includes positional data such as, for example, latitude and longitude coordinates to describe road intersections, road segments, landmarks, points of interest and other geographical information. The data base may further include data representing characteristics of roads or places on the map such as road and place names, road features (for example, dividers, one-way restrictions, surface, speed limit, shape and elevation), and other properties. Using the data stored in the map data base, the vehicle navigation system 100 generates one or more possible positions of the vehicle by comparing the dead-reckoned position to the road segments, intersections, and other geographical locations stored in the data base. The system then filters the set of position.
possibilities and selects from the remaining position possibilities a position deemed to be the current position of the vehicle.
veua mn Overyiew The invention disclosed hereinbelow determines the characteristic offset error of a gyroscope and corrects for the offset error. Also, the invention determines the characteristic gain error of a gyroscope and corrects for the gain error. Still further, the invention also determines and corrects for the differential gain error for right and left turns. By incorporating the corrections to the offset error and the (right and left) gain error into the determination of the angular speed, the invention correctly determines the angular speed of the object. Each of these determinations is explained in turn below, beginning with the determination and correction of the characteristic offset error.
Determination of Offset Error Correction Value Figure 12 illustrates a method for determining the value for correcting the characteristic offset error of a gyroscope mounted on a vehicle. As the first steps, the azimuth and straight-wise movement of the vehicle are thrice checked, steps 1205, 1210, 1215. If the vehicle was moving straight for each of~the three checks, step 1220, a correction value for the offset error is computed, step 1225, and saved for later use, step 1230. Each of these steps is described more fully below.
- Detection of Vehicle Azimuth In one embodiment, a system incorporating the invention uses a Global Positioning System (GPS), or other broadcast positioning system as an azimuth detection method 3o for a vehicle. As Figure 5 illustrates, the system can determine the velocity of a vehicle 530 with respect to North and East from the data from the GPS receiver and can detect the vehicle azimuth 510 using these data. The octagon 520 shows the position given by the GPS and the arrow 510 shows the azimuth. Thus, the system can check vehicle azimuths as required in steps 1205 through 1215.
However, at low speeds, the difference in successive positions of the vehicle as detected by the GPS is small.
wua m Indeed, the difference may even fall below the ability of the GPS to detect. Therefore, in the pursuit of improved accuracy, the system 100 ignores the azimuth as determined from the GPS when the vehicle is moving slower than a predetermined speed.
- Detection of Vehicle Turn In another embodiment, a navigation system incorporating one aspect of the invention can detect when the vehicle 530 is turning by examining a series of azimuths and then deriving the locus of the series. Figure 6 shows a series of azimuths for a ninety degree turn to the left.
- _Detection of Vehicle Straight Movement On the other hand, a system incorporating another aspect of the invention determines whether the vehicle is moving in a straight line using a three-check method: Figure 12 gives an overview of this method, and Figure 8 illustrates this three-check method in more detail. The system samples azimuth values for a predetermined period of time, step 805.
If all the sampled azimuths are within a predetermined threshold of their average, the system recognizes the possibility that the vehicle was moving in a straight line for the sampling time period, step 810. In the second step, the system again samples azimuth values for a second predetermined period of time, step 815. However, the system continues to recognize the possibility of straight-line movement when the average of the azimuths sampled in the second predetermined period is within a predetermined threshold of the average azimuth from the first predetermined period, step 820.
Finally, as the third check, the system again samples azimuth values for a third predetermined period, step 825. The system finally concludes the vehicle was moving in a straight line over the three periods, step 840, where the average of the azimuths samples of the third predetermined period falls within a predetermined threshold of the average azimuth from the first predetermined period, step 830.
asi.n non In this way, the checks for straight movement and detection of straight movement for three periods of time of Figure 12 can be accomplished.
In a preferred embodiment, the first, second and third predetermined periods follow immediately one on the other and are of equal duration. Also, the thresholds for averages for the second and third periods are identical to the first, although some relaxing is permissible. Finally, while the method described uses three time periods, any number of time periods greater than or equal to two can be used.
Figure7 illustrates the averaging of a number of azimuths An to produce an average azimuth Aa~g and the testing of the average azimuth against a threshold. Equation (7) presents the averaging mathematically:
n An Aa~9 = n Figures 9A and 9B illustrate an advantage of repeatedly testing new azimuth averages against an historic average. In Figure 9A, the average of the second sampling of azimuths, Aa~g2, is used to determine whether the vehicle was still moving in a straight line during the second time period.
Likewise, the average of the third sampling of azimuths, g3, is used to determine whether the vehicle was moving in a straight line during the third time period. As can be seen, even though each of the average azimuths (e.g., Aa~g3) may fall within a threshold of the immediately preceding average azimuth (e.g., Aa~g2) and thus indicate that the'vehicle is moving linearly, the vehicle may in fact be turning. By contrast, for the same turn, Figure 9B illustrates that using an historic average azimuth (e. g., Aavgl) helps to prevent false determinations of linear movement.
11 vann W i Determination of Offset Correction Value Above has been described a system and method for detecting whether a vehicle is moving in a straight line.
Below is described the use of the straight-movement detection to determine an offset error correction value.
When a vehicle containing (a navigation system containing) a gyroscope moves in a straight line, the preferred output voltage of the gyroscope is ~IpFFSET~ If the output voltage of the gyroscope is not VoFFSET~ the voltage difference is an offset error which should be corrected.
Equation (8) gives the offset error and thus the offset error correction value as indicated in step 1225:
VOFFSET ERROR VGYRO AVG2 vOFFSET ( a ) where ~IGyRO AVG2 1S the average voltage obtained from the second of the three time periods (step 815) used to make the determination that the vehicle was moving straight (step 840).
Determination of Gain Correction Value A navigatiqn system incorporating another embodiment of the invention can determine and compensate for gain error as described herein. Figures 14A and 14B illustrate a method for determining a gain error correction value. When the system detects that the vehicle was first moving straight, step 1405, then turning, step 1415, then moving straight again, steps 1455, 1420, the system can determine an accurate angle for the turn from the GPS. The system uses the moving azimuths from the straight movements preceding alzd following the turn, steps 1405, 1455.
Figures loA and lOB illustrate the use of average azimuths to accurately determine the angle of a turn. The positional octagons 1010 represent the actual azimuths of the moving vehicle. Before the turn from Beta Street onto Alpha Street represented in Figure 10A, the vehicle is moving along Beta Street with an average azimuth Abefore~ (See Figures l0A
and lOB.) Similarly, the average azimuth Aafter Figures l0A
and lOB) represents the movement of the vehicle after 12 aena iw completing the turn. By projecting the average azimuth Abefore to indicate zero degrees with respect to any subsequent turn, Figure lOB, the navigation system can determine that the average azimuth Aafter represents a +90° turn with respect to the average azimuth AbeforeW
During the turn, the navigation system collects angular speeds from the gyroscope in the vehicle, steps 1415.
These angular speeds have been corrected for the offset error as described herein. During turning, the navigation system computes the angle of turn (0) by integrating these offset error-corrected angular speeds, step 1415. (The system does not compute the gain error correction value before determining the offset correction value in order to avoid incorrectly determining the gain error correction value with offset error.
Cf. step 1425.) The gain error correction value KGAIN ERROR 1S
determined as follows:
_ 8 C9) KGAIN ERROR Aaftez Abefore where B is the angle~of turn computed by integration of the offset error-corrected angular speed, obtained from the gyroscope; Aafter is the average azimuth after turning, obtained from the GPS; and Abefore is the average azimuth before turning, also obtained from the GPS. Cf. steps 1435, 1440.
The denominator of equation (9), the angle the vehicle makes in turning, can range from large to relatively small. Accordingly, when the difference between the before and after average azimuths is relatively small, KGAIN ERROR
includes a relatively larger error (as compared with larger turns). To avoid this problem, the navigation system does not compute K~AIN ERROR when the turn angle is smaller than a predetermined angle.
Alternatively, the navigation system determines KGAIN ERROR as an average over a predetermined number of turns.
For a gyroscope whose gain does not change suddenly, the gain error correction value (KGAIN ERROR) can be computed r~~a i.»
in another alternative as described herein. Where K1 and K2 are predetermined thresholds and where io _ ~ KGAIN ERROR + K1 ( ) Rafter Abefoze then KGAIN ERROR is increased by a predetermined amount.
Similarly, where 8 + (11) KGAIN ERROR
Rafter '~befoze then KGAIN ERROR 15 decreased by a predetermined amount. If the relationship among e~ Aafter~ Abefore arid KGAIN ERROR is OtherWl.Se, then KGAIN ERROR 15 nOt Changed. KGAIN ERROR 1S
initially set to zero.
Classification of Gain for Ri ht Turns ana L
The gain error correction value is determined independently for right and left turns, steps 1430 through 1440.
Correction of AnQUlar Speed A navigation system incorporating yet another embodiment of the invention correct the angular speed gyroscopic output voltage for the offset error and gain error as described herein. The angular speed is corrected according to the formula in Equation (12):
_ vGYRO O~IT ( vOFFSET + VOFFSET ERROR) ( 1Z ) ASCO~~Ep G~ KGAIN ERROR
In the case of right turns:
(13) KGAIN ERROR KRIGNT GAIN ERROR
where KRIGHT GAIN ERROR is the gain error correction value for right turns. Similarly, for left turns:
wmn w~
_ (14) KGAIN ERROR KLEFT GAIN ERROR
where KLEFT GAIN ERROR is the gain error correction value for left turns.
Figure 11 shows the flow of data to determine the corrected angular speed AS~ORRECTED ~ In Figure 11, the computation units 1110, 1111 compute the average azimuths before (Abefore) and after (Rafter) a turn, respectively, using GPS or similar data. These values are the inputs for the computation unit 1112. The output of the computation unit 1112 is a denominator input for the computation unit 1113.
The output voltage of the gyroscope (VGyRO) is an input to the computation unit 1115 which computes the offset correction value (VOFFSET ERROR) when the system detects straight movement (i.e., when the switch 1140 is closed). The computation unit 1114 computes the corrected output voltage of the gyroscope (UGYRO VOFFSET ERROR) with the output voltage of the gyroscope (vGYRO) and the output of the computation unit 1115 as inputs.
The corrected output voltage of the gyroscope is an input to the computation unit 1116 which computes the angular speed (ASwITH GAIN ERROR) ~ The output of the computation unit 1116 is an input to both computation units 1117 and 1118.
The computation unit 1117 computes the angle B of a turn for input as the numerator input to the computation unit 1113.
The output of the computation unit 1113 is an input for the computation unit 1119 which.computes the gain error correction values (KGAIN ERROR) for right and left turns. The switch 1141 is closed when straight movement is detected before and after a turn.
Finally, the output of the computation unit~.1119 and the computation unit 1116 are input to the computation unit 1118 for division. The output of the computation unit 1118 is the desired corrected angular speed (ASCORRECTED) ~ the angular speed with gain error ratioed by the gam error correction value.
Ana nm Correction Immediatel after Power On-The gain error correction Value (K~AIN ERROR) is stored in memory ( 113 0 ) so the angular speed ( AScoRRECTED ~ can be corrected on the powering up of the navigation system.
The invention as described herein is useful not only for gyroscopes but for all angular speed detection sensors.
Further, this invention is useful not only for the global positioning system but for all azimuth detection sensors.
Finally, this invention is useful not~only for vehicles but for any moveable body.
In contrast to Odagawa, U.S. Patent 5,404,307, the invention described herein is capable of correcting differentially for right and left turn gain errors.
In contrast to Masumoto, U.S. Patent 5,424,953, the present invention can detect a vehicle's movement in a straight line using only GPS (or similar) data, even where the angular speed sensor has an offset error.
Finally, the invention makes correction of data from the gyroscope possible immediately on powering up of the system by saving a correction value before the preceding powering off of the system.
Of course, the program text for such software as is herein disclosed can exist in its static form on a magnetic, optical or other disk, on magnetic tape or other medium requiring media movement for storage and/or retrieval, in ROM, in RAM, or in another data storage medium. That data storage medium may be integral to or insertable into a computer system.
Claims (21)
1. A method for determining a position of an ob-ject, comprising:
correcting an offset error associated with an angular speed detector using an azimuth detector distinct from the angular speed detector, the azimuth detector determining an azimuth based on movement of the object wherein correcting the offset error comprises:
checking an azimuth of the object and movement of the object for first and second periods of time;
checking whether the object was moving in a straight line in each of the first and second peri-ods of time by referring to an average azimuth cor-responding to the first period of time; and computing an offset error correction value using data from the second period where the object was moving in a straight line in each of the first and second periods of time; and after correcting the offset error, determining the position of the object using the angular speed detec-tor.
correcting an offset error associated with an angular speed detector using an azimuth detector distinct from the angular speed detector, the azimuth detector determining an azimuth based on movement of the object wherein correcting the offset error comprises:
checking an azimuth of the object and movement of the object for first and second periods of time;
checking whether the object was moving in a straight line in each of the first and second peri-ods of time by referring to an average azimuth cor-responding to the first period of time; and computing an offset error correction value using data from the second period where the object was moving in a straight line in each of the first and second periods of time; and after correcting the offset error, determining the position of the object using the angular speed detec-tor.
2. The method of claim 1 wherein said step of correcting an offset error of an angular speed detector comprises correcting an offset error of a gyroscope.
3. The method of claim 1 wherein checking the azimuth of the object and checking whether the object was moving in a straight line are done during a third period of time.
4. A method for determining a position of an ob-ject, comprising:
correcting a gain error associated with an angular speed detector using an azimuth detector distinct from the angular speed detector, the azimuth detector determining an azimuth based on movement of the object, wherein correcting the gain error comprises:
determining the movement of said object as straight;
then determining the movement of said object as a turn;
then determining the movement of said object as straight again; and computing a left gain error correction value if said turn was left turn; and computing a right gain error correction value if said turn was a right turn; and after correcting the gain error, determining the position of the object using the angular speed detec-tor.
correcting a gain error associated with an angular speed detector using an azimuth detector distinct from the angular speed detector, the azimuth detector determining an azimuth based on movement of the object, wherein correcting the gain error comprises:
determining the movement of said object as straight;
then determining the movement of said object as a turn;
then determining the movement of said object as straight again; and computing a left gain error correction value if said turn was left turn; and computing a right gain error correction value if said turn was a right turn; and after correcting the gain error, determining the position of the object using the angular speed detec-tor.
5. A method for determining a position of an ob-ject, comprising:
correcting a gain error associated with an angular speed detector using an azimuth detector distinct from the angular speed detector, the azimuth detector determining an azimuth based on movement of the object, wherein correcting the gain error comprises determining said gain error as the ratio of an angle of a turn as determined by said angular speed detector and the angle of said turn as determined by the difference between average azimuths before and after said turn as determined by said azimuth detector; and after correcting the gain error, determining the position of the object using the angular speed detec-tor.
correcting a gain error associated with an angular speed detector using an azimuth detector distinct from the angular speed detector, the azimuth detector determining an azimuth based on movement of the object, wherein correcting the gain error comprises determining said gain error as the ratio of an angle of a turn as determined by said angular speed detector and the angle of said turn as determined by the difference between average azimuths before and after said turn as determined by said azimuth detector; and after correcting the gain error, determining the position of the object using the angular speed detec-tor.
6. A method for determining a position of an ob-ject, comprising:
correcting a gain error associated with an angular speed detector using an azimuth detector distinct from the angular speed detector, the azimuth detector determining an azimuth based on movement of the object, wherein correcting the gain error comprises determining said gain error as an average of gain errors over a pre-determined number of turns; and after correcting the gain error, determining the position of the object using the angular speed detec-tor.
correcting a gain error associated with an angular speed detector using an azimuth detector distinct from the angular speed detector, the azimuth detector determining an azimuth based on movement of the object, wherein correcting the gain error comprises determining said gain error as an average of gain errors over a pre-determined number of turns; and after correcting the gain error, determining the position of the object using the angular speed detec-tor.
7. A method for determining a position of an ob-ject, comprising:
correcting a gain error associated with an angular speed detector using an azimuth detector distinct from the angular speed detector, the azimuth detector determining an azimuth based on movement of the object;
correcting an offset error associated with the angular speed detector using the azimuth detector, wherein correcting the offset error comprises:
checking an azimuth of the object and movement of the object for first and second periods of time;
checking whether the object was moving in a straight line in each of the first and second peri-ods of time by referring to an average azimuth cor-responding to the first period of time; and computing an offset error correction value using data from the second period where the object was moving in a straight line in each of the first and second periods of time; and after correcting the gain error and the offset error, determining the position of the object using the angular speed detector.
correcting a gain error associated with an angular speed detector using an azimuth detector distinct from the angular speed detector, the azimuth detector determining an azimuth based on movement of the object;
correcting an offset error associated with the angular speed detector using the azimuth detector, wherein correcting the offset error comprises:
checking an azimuth of the object and movement of the object for first and second periods of time;
checking whether the object was moving in a straight line in each of the first and second peri-ods of time by referring to an average azimuth cor-responding to the first period of time; and computing an offset error correction value using data from the second period where the object was moving in a straight line in each of the first and second periods of time; and after correcting the gain error and the offset error, determining the position of the object using the angular speed detector.
8. A method for determining a position of an ob-ject, comprising:
correcting a gain error associated with an angular speed detector using an azimuth detector distinct from the angular speed detector, the azimuth detector determining an azimuth based on movement of the object, wherein correcting the gain error comprises:
determining the movement of said object as straight;
then determining the movement of said object as a turn;
then determining the movement of said object as straight again; and computing a left gain error correction value if said turn was a left turn; and computing a right gain error correction value if said turn was a right turn;
correcting an offset error associated with the angular speed detector using the azimuth detector; and after correcting the gain error and the offset error, determining the position of the object using the angular speed detector.
correcting a gain error associated with an angular speed detector using an azimuth detector distinct from the angular speed detector, the azimuth detector determining an azimuth based on movement of the object, wherein correcting the gain error comprises:
determining the movement of said object as straight;
then determining the movement of said object as a turn;
then determining the movement of said object as straight again; and computing a left gain error correction value if said turn was a left turn; and computing a right gain error correction value if said turn was a right turn;
correcting an offset error associated with the angular speed detector using the azimuth detector; and after correcting the gain error and the offset error, determining the position of the object using the angular speed detector.
9. A method for correcting an offset error associ-ated with an angular speed detector attached to an ob-ject, the method comprising:
checking an azimuth of the object and movement of the object for first and second periods of time;
checking whether the object was moving in a straight line in each of the first and second periods of time by referring to an average azimuth corresponding to the first period of time; and computing an offset error correction value without reference to data from the first period where the object was moving in a straight line in each of the first and second periods of time.
checking an azimuth of the object and movement of the object for first and second periods of time;
checking whether the object was moving in a straight line in each of the first and second periods of time by referring to an average azimuth corresponding to the first period of time; and computing an offset error correction value without reference to data from the first period where the object was moving in a straight line in each of the first and second periods of time.
10. The method of claim 9 wherein checking the azimuth of the object and checking whether the object was moving in a straight line are done during a third period of time.
11. A method for detecting gain error in an angular speed detector attached to an object, said method com-prising:
determining the movement of said object as straight;
then determining the movement of said object as a turn;
then determining the movement of said object as straight again; and computing a left gain error correction value if said turn was a left turn; and computing a right gain error correction value if said turn was a right turn.
determining the movement of said object as straight;
then determining the movement of said object as a turn;
then determining the movement of said object as straight again; and computing a left gain error correction value if said turn was a left turn; and computing a right gain error correction value if said turn was a right turn.
12. A method for detecting gain error in an angular speed detector attached to an object, said method com-prising:
subjecting said object to a turn;
determining an angular speed detected angle of said turn using said angular speed detector;
determining a differential of average azimuths angle of said turn as the difference between average azimuths before and after said turn; and determining said gain error using the ratio of said angular speed detected angle and the differential average azimuth angle.
subjecting said object to a turn;
determining an angular speed detected angle of said turn using said angular speed detector;
determining a differential of average azimuths angle of said turn as the difference between average azimuths before and after said turn; and determining said gain error using the ratio of said angular speed detected angle and the differential average azimuth angle.
13. The method of claim 12 wherein said step of determining said gain error comprises determining said gain error as the ratio of said angular speed detected angle and the differential of average azimuths angle.
14. The method of claim 12 wherein said step of determining said gain error comprises:
initially setting said gain error to a first predetermined value, thereby setting a current value of said gain error;
increasing said gain error by a second prede-termined value if said ratio is greater than the sum of the current value of said gain error and a first prede-termined threshold, thereby resetting the current value of said gain error; and decreasing said gain error by a third predeter-mined value if said ratio is less than the sum of the current value of said gain error and a second predeter-mined threshold, thereby resetting the current value of said gain error;
initially setting said gain error to a first predetermined value, thereby setting a current value of said gain error;
increasing said gain error by a second prede-termined value if said ratio is greater than the sum of the current value of said gain error and a first prede-termined threshold, thereby resetting the current value of said gain error; and decreasing said gain error by a third predeter-mined value if said ratio is less than the sum of the current value of said gain error and a second predeter-mined threshold, thereby resetting the current value of said gain error;
15. The method of claim 14 wherein said step of determining said gain error further comprises leaving said gain error unchanged if said ratio is neither more nor less than the sum of the current value of said gain error and a second predetermined threshold, thereby leav-ing the current value of said gain error unchanged.
16. A method for detecting straight-line movement of an object, said method comprising:
sampling azimuths for said object for a first predetermined time period; and computing a first average azimuth;
checking whether said first average azimuth is within a first predetermined threshold;
determining the movement, if any, of said ob-ject during said first predetermined time period as not straight-line if said first average azimuth is not within said first predetermined threshold;
sampling azimuths for said object for a next predetermined time period; and computing a next average azimuth;
checking whether said next average azimuth is within a next predetermined threshold; and determining the movement, if any, of said ob-ject during said predetermined time periods as not straight-line if said next average azimuth is not within said next predetermined threshold; otherwise, determining the movement of said object during said predetermined time periods as straight-line.
sampling azimuths for said object for a first predetermined time period; and computing a first average azimuth;
checking whether said first average azimuth is within a first predetermined threshold;
determining the movement, if any, of said ob-ject during said first predetermined time period as not straight-line if said first average azimuth is not within said first predetermined threshold;
sampling azimuths for said object for a next predetermined time period; and computing a next average azimuth;
checking whether said next average azimuth is within a next predetermined threshold; and determining the movement, if any, of said ob-ject during said predetermined time periods as not straight-line if said next average azimuth is not within said next predetermined threshold; otherwise, determining the movement of said object during said predetermined time periods as straight-line.
17. The method of claim 16, wherein said first and next predetermined thresholds are the same.
18. The method of claim 16, wherein said first and next predetermined time periods follow immediately one on the other.
19. The method of claim 16, wherein said first and next predetermined thresholds are of equal duration.
20. The method of claim 16, wherein before said step of sampling for a next predetermined time period is performed, the following steps are performed:
sampling azimuths for said object for a second predetermined time period; and computing a second average azimuth;
checking whether said second average azimuth is within a second predetermined threshold; and determining the movement, if any, of said ob-ject during said second predetermined time period as not straight-line if said second average azimuth is not within said second predetermined threshold.
sampling azimuths for said object for a second predetermined time period; and computing a second average azimuth;
checking whether said second average azimuth is within a second predetermined threshold; and determining the movement, if any, of said ob-ject during said second predetermined time period as not straight-line if said second average azimuth is not within said second predetermined threshold.
21. A method for correcting for gain error in an angular speed detector attached to an object, the angular speed detector being associated with a system for deter-mining a position of the object, said method comprising:
determining said gain error;
then saving said determined gain error in a nonvolatile memory;
then powering off said system; and then powering on said system; and using said saved determined gain error to correct the output of said angular speed detector.
determining said gain error;
then saving said determined gain error in a nonvolatile memory;
then powering off said system; and then powering on said system; and using said saved determined gain error to correct the output of said angular speed detector.
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| US08/754,484 US6253154B1 (en) | 1996-11-22 | 1996-11-22 | Method and apparatus for navigating with correction of angular speed using azimuth detection sensor |
| US08/754,484 | 1996-11-22 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CA2221339A1 CA2221339A1 (en) | 1998-05-22 |
| CA2221339C true CA2221339C (en) | 2001-07-31 |
Family
ID=25035000
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CA002221339A Expired - Fee Related CA2221339C (en) | 1996-11-22 | 1997-11-17 | Method and apparatus for navigating with correction of angular speed using azimuth detection sensor |
Country Status (5)
| Country | Link |
|---|---|
| US (1) | US6253154B1 (en) |
| EP (1) | EP0844462B1 (en) |
| JP (1) | JP3380727B2 (en) |
| CA (1) | CA2221339C (en) |
| DE (1) | DE69728497T2 (en) |
Families Citing this family (34)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| FR2768230B1 (en) * | 1997-09-11 | 2000-05-05 | Commissariat Energie Atomique | METHOD FOR LOCATING A MOVING OBJECT BY GRADIENTMETRIC MAGNETIC MEASUREMENTS |
| US7075459B1 (en) * | 1999-02-22 | 2006-07-11 | Magellan Dis, Inc. | Vehicle speed sensor for navigation system |
| DE19945120C2 (en) * | 1999-09-21 | 2001-12-06 | Mannesmann Vdo Ag | Method of navigating a vehicle |
| US6502033B1 (en) | 2000-10-05 | 2002-12-31 | Navigation Technologies Corp. | Turn detection algorithm for vehicle positioning |
| US6675077B2 (en) * | 2000-10-11 | 2004-01-06 | Transportation Technology Center Inc. | Wheel-railhead force measurement system and method having cross-talk removed |
| US7221287B2 (en) | 2002-03-05 | 2007-05-22 | Triangle Software Llc | Three-dimensional traffic report |
| US6826478B2 (en) * | 2002-04-12 | 2004-11-30 | Ensco, Inc. | Inertial navigation system for mobile objects with constraints |
| WO2005013063A2 (en) | 2003-07-25 | 2005-02-10 | Landsonar, Inc. | System and method for determining recommended departure time |
| JP4398430B2 (en) * | 2003-10-31 | 2010-01-13 | 富士通株式会社 | Distance calculation device and calculation program |
| US7260896B2 (en) * | 2004-04-07 | 2007-08-28 | Siemens Vdo Automotive Corporation | Electronic compass and method of calibration |
| TWI250302B (en) * | 2004-09-20 | 2006-03-01 | Wintecronics Co Ltd | Mutual angle correction method for navigation device, and the device thereof |
| JP2007033434A (en) * | 2005-06-20 | 2007-02-08 | Denso Corp | Current location detection device for vehicle, vehicle control device |
| US8838374B2 (en) * | 2005-07-05 | 2014-09-16 | Mi-Jack Products, Inc. | Automatic correction of past position errors for location and inventory tracking |
| JP4517298B2 (en) * | 2005-11-30 | 2010-08-04 | アイシン・エィ・ダブリュ株式会社 | Correction coefficient calculation device and calculation program for direction sensor |
| US20090254274A1 (en) * | 2007-07-27 | 2009-10-08 | Kulik Victor | Navigation system for providing celestial and terrestrial information |
| JP4466705B2 (en) * | 2007-09-21 | 2010-05-26 | ヤマハ株式会社 | Navigation device |
| JP4952518B2 (en) * | 2007-11-05 | 2012-06-13 | 株式会社デンソー | Vehicle current position detection device and program |
| FR2926902B1 (en) | 2008-01-24 | 2012-05-04 | Peugeot Citroen Automobiles Sa | DEVICE AND METHOD FOR DETECTING A PARTICULAR CONDITION OF A VEHICLE. |
| JP2009245002A (en) * | 2008-03-28 | 2009-10-22 | Kubota Corp | Travel controller for working vehicle |
| US8982116B2 (en) | 2009-03-04 | 2015-03-17 | Pelmorex Canada Inc. | Touch screen based interaction with traffic data |
| US8619072B2 (en) | 2009-03-04 | 2013-12-31 | Triangle Software Llc | Controlling a three-dimensional virtual broadcast presentation |
| US9046924B2 (en) | 2009-03-04 | 2015-06-02 | Pelmorex Canada Inc. | Gesture based interaction with traffic data |
| JP4831441B2 (en) * | 2010-03-30 | 2011-12-07 | アイシン・エィ・ダブリュ株式会社 | Correction coefficient calculation device and calculation program for direction sensor |
| JP5071533B2 (en) | 2010-05-19 | 2012-11-14 | 株式会社デンソー | Current position detection device for vehicle |
| US9273968B2 (en) * | 2010-06-23 | 2016-03-01 | Aisin Aw Co., Ltd. | Track information generating device, track information generating method, and computer-readable storage medium |
| EP2638493A4 (en) | 2010-11-14 | 2017-12-13 | Muddy River, Series 97 of Allied Security Trust 1 | Crowd sourced traffic reporting |
| WO2012135960A1 (en) * | 2011-04-06 | 2012-10-11 | Uti Limited Partnership | System and method for gyroscope error estimation |
| CA2839866C (en) | 2011-05-18 | 2021-04-13 | Triangle Software Llc | System for providing traffic data and driving efficiency data |
| JP2013145168A (en) * | 2012-01-13 | 2013-07-25 | Denso Corp | Angular velocity error correction device of gyro for vehicle |
| CA2883973C (en) | 2012-01-27 | 2021-02-23 | Edgar Rojas | Estimating time travel distributions on signalized arterials |
| US10223909B2 (en) | 2012-10-18 | 2019-03-05 | Uber Technologies, Inc. | Estimating time travel distributions on signalized arterials |
| US20140288824A1 (en) * | 2013-03-22 | 2014-09-25 | Qualcomm Incorporated | Method and/or system for selective application of direction of travel |
| WO2017085756A1 (en) * | 2015-11-16 | 2017-05-26 | 富士通株式会社 | Information processing device, method, and program |
| DE102017222290A1 (en) | 2017-12-08 | 2019-06-13 | Continental Teves Ag & Co. Ohg | Method for determining correction values, method for determining a position of a motor vehicle, electronic control device and storage medium |
Family Cites Families (43)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US3845289A (en) | 1972-07-18 | 1974-10-29 | Avon Inc | Method and apparatus employing automatic route control system |
| US4672565A (en) | 1981-03-10 | 1987-06-09 | Nippon Soken, Inc. | Direction detecting system for vehicles |
| JPS57169785A (en) | 1981-04-13 | 1982-10-19 | Nissan Motor | Travelling guidance system for car |
| EP0066397B2 (en) | 1981-05-15 | 1992-08-05 | Nippondenso Co., Ltd. | Navigational apparatus for use in automotive vehicles |
| JPH0619276B2 (en) | 1981-08-17 | 1994-03-16 | 工業技術院長 | Portable map display device assembly |
| JPS58151513A (en) | 1982-03-05 | 1983-09-08 | Alps Electric Co Ltd | Present position updating display of moving body |
| US4797841A (en) | 1983-11-28 | 1989-01-10 | Magnavox Government And Industrial Electronics Company | Method and apparatus for automatic calibration of magnetic compass |
| US4611293A (en) | 1983-11-28 | 1986-09-09 | Magnavox Government And Industrial Electronics Company | Method and apparatus for automatic calibration of magnetic compass |
| US4796191A (en) | 1984-06-07 | 1989-01-03 | Etak, Inc. | Vehicle navigational system and method |
| US4914605A (en) | 1984-10-22 | 1990-04-03 | Etak, Inc. | Apparatus and method for displaying a map |
| US4734863A (en) | 1985-03-06 | 1988-03-29 | Etak, Inc. | Apparatus for generating a heading signal for a land vehicle |
| JPH0650559B2 (en) | 1985-04-03 | 1994-06-29 | 日産自動車株式会社 | Vehicle route guidance device |
| US4751512A (en) | 1986-01-21 | 1988-06-14 | Oceanonics, Inc. | Differential navigation system for remote mobile users |
| US4831563A (en) | 1986-07-01 | 1989-05-16 | Pioneer Electronic Corporation | Method of processing output data from geomagnetic sensor |
| US4862398A (en) | 1986-11-18 | 1989-08-29 | Sumitomo Electric Industries, Ltd. | Correcting method and correcting errors in a terrestrial magnetism heading sensor |
| DE3715007A1 (en) | 1987-05-06 | 1988-11-17 | Bosch Gmbh Robert | METHOD AND DEVICE FOR DETERMINING THE COURSE OF A LAND VEHICLE |
| WO1988008961A1 (en) | 1987-05-11 | 1988-11-17 | Sumitomo Electric Industries, Ltd. | Position detection system |
| DE3719017A1 (en) | 1987-06-06 | 1988-12-15 | Bosch Gmbh Robert | METHOD AND DEVICE FOR DETERMINING A DRIVING ROUTE BETWEEN A START POINT AND A DESTINATION POINT |
| NL8702087A (en) | 1987-09-04 | 1989-04-03 | Philips Nv | VEHICLE NAVIGATION DEVICE WITH DISPLAY OF A SELECTED MAP ELEMENT ACCORDING TO A PRE-DEFINED REPRESENTATION STANDARD. |
| US4964052A (en) | 1987-10-30 | 1990-10-16 | Nec Home Electronics Ltd. | Navigation device for use in a vehicle |
| JP2680318B2 (en) | 1987-12-28 | 1997-11-19 | アイシン・エィ・ダブリュ株式会社 | Navigation device |
| JP2637446B2 (en) | 1987-12-28 | 1997-08-06 | アイシン・エィ・ダブリュ株式会社 | Navigation device |
| JPH01173824A (en) | 1987-12-28 | 1989-07-10 | Aisin Aw Co Ltd | Navigation device for vehicle with help function |
| JPH01214711A (en) | 1988-02-23 | 1989-08-29 | Toshiba Corp | Navigation apparatus |
| JPH023900A (en) | 1988-06-16 | 1990-01-09 | Nissan Motor Co Ltd | Present place displaying device for moving body |
| JPH07117420B2 (en) | 1988-06-27 | 1995-12-18 | パイオニア株式会社 | Road data generation method in vehicle-mounted navigation device |
| JPH07119617B2 (en) | 1988-07-05 | 1995-12-20 | マツダ株式会社 | Vehicle navigation system |
| US4918609A (en) | 1988-10-11 | 1990-04-17 | Koji Yamawaki | Satellite-based position-determining system |
| US5060162A (en) | 1988-12-09 | 1991-10-22 | Matsushita Electric Industrial Co., Ltd. | Vehicle in-situ locating apparatus |
| US5287297A (en) | 1989-11-02 | 1994-02-15 | Matsushita Electric Industrial Co., Ltd. | Magnetic direction finder with correcting circuit |
| US5177685A (en) | 1990-08-09 | 1993-01-05 | Massachusetts Institute Of Technology | Automobile navigation system using real time spoken driving instructions |
| EP0485132B1 (en) | 1990-11-06 | 1996-03-06 | Fujitsu Ten Limited | Direction sensor having an earth magnetism sensor and a rate gyro sensor and navigation system having this direction sensor |
| JP3018497B2 (en) * | 1990-11-30 | 2000-03-13 | 住友電気工業株式会社 | Offset correction device for turning angular velocity sensor |
| JPH04238216A (en) | 1991-01-23 | 1992-08-26 | Sumitomo Electric Ind Ltd | Calculating method for scale factor of gyroscope |
| JPH04315913A (en) | 1991-04-16 | 1992-11-06 | Pioneer Electron Corp | Vehicle bearing measuring device |
| JPH05172575A (en) | 1991-12-19 | 1993-07-09 | Pioneer Electron Corp | Navigation equipment |
| US5424953A (en) | 1992-01-16 | 1995-06-13 | Pioneer Electronic Corporation | Navigation apparatus |
| JPH0731062B2 (en) | 1992-02-10 | 1995-04-10 | 住友電気工業株式会社 | Gyro offset correction method and apparatus |
| EP0567268B1 (en) * | 1992-04-20 | 1997-10-01 | Sumitomo Electric Industries, Limited | Vehicle heading detecting apparatus |
| KR0161030B1 (en) | 1993-08-26 | 1998-12-15 | 김광호 | Apparatus and method for driving motor control of robot |
| JPH07324941A (en) * | 1994-06-02 | 1995-12-12 | Matsushita Electric Ind Co Ltd | Correction apparatus of offset drift |
| JP3423418B2 (en) | 1994-06-30 | 2003-07-07 | 松下電器産業株式会社 | Moving body turning angle calculation device |
| US5742925A (en) * | 1995-05-08 | 1998-04-21 | Pioneer Electronic Corporation | Automotive navigation system |
-
1996
- 1996-11-22 US US08/754,484 patent/US6253154B1/en not_active Expired - Lifetime
-
1997
- 1997-11-17 CA CA002221339A patent/CA2221339C/en not_active Expired - Fee Related
- 1997-11-21 JP JP32152297A patent/JP3380727B2/en not_active Expired - Lifetime
- 1997-11-21 DE DE69728497T patent/DE69728497T2/en not_active Expired - Lifetime
- 1997-11-21 EP EP97309419A patent/EP0844462B1/en not_active Expired - Lifetime
Also Published As
| Publication number | Publication date |
|---|---|
| CA2221339A1 (en) | 1998-05-22 |
| DE69728497T2 (en) | 2005-04-14 |
| EP0844462B1 (en) | 2004-04-07 |
| EP0844462A2 (en) | 1998-05-27 |
| JP3380727B2 (en) | 2003-02-24 |
| JPH10246642A (en) | 1998-09-14 |
| DE69728497D1 (en) | 2004-05-13 |
| US6253154B1 (en) | 2001-06-26 |
| EP0844462A3 (en) | 1999-10-20 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CA2221339C (en) | Method and apparatus for navigating with correction of angular speed using azimuth detection sensor | |
| KR100262057B1 (en) | Position correction method for vehicle navigation system | |
| EP2224208B1 (en) | Navigation device and navigation method | |
| CA2081185C (en) | Vehicle navigation system | |
| JP2961966B2 (en) | Vehicle position and orientation calculation device | |
| EP0763713B1 (en) | Method and apparatus for calibration of a distance sensor in a vehicle navigation system | |
| US8396659B2 (en) | Navigation device, method, and program | |
| EP0534892B1 (en) | Position-locating method | |
| US5220509A (en) | Vehicle navigation apparatus | |
| US5394333A (en) | Correcting GPS position in a hybrid naviation system | |
| US6574550B2 (en) | Navigation apparatus | |
| EP0451988A1 (en) | Heading detecting apparatus | |
| US6349259B1 (en) | Navigation apparatus and information generating apparatus | |
| KR20080036099A (en) | Method for the operation of a navigation system, and navigation system | |
| US5151872A (en) | Method and apparatus for correcting the output of an onboard vehicle terrestrial magnetism sensor | |
| KR100196725B1 (en) | Map matching method for car navigation system using gps | |
| JPH08114454A (en) | Method for measuring azimuth for automoble | |
| JPH10153444A (en) | Navigation device | |
| JP2590608B2 (en) | Vehicle running direction calculation device | |
| JPH05288558A (en) | Travel direction detecting device | |
| JPH02301808A (en) | Device for controlling running of moving vehicle |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| EEER | Examination request | ||
| MKLA | Lapsed |
Effective date: 20161117 |