JP3455329B2 - Car navigation system - Google Patents

Description

Detailed Description of the Invention

[0001]

BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a car navigation system, and more particularly, to an improvement in correction performed in a car navigation system having an angular velocity sensor to eliminate the influence of the sensitivity of the angular velocity sensor.

[0002]

2. Description of the Related Art Conventionally, in car navigation systems, an angular velocity sensor is mounted on a vehicle, and the angular velocity detected by this sensor is integrated to calculate the azimuth of the vehicle. If this angular velocity is affected by the sensitivity of the angular velocity sensor and contains an error, this error is also integrated, so that an undesired cumulative error that gradually increases with the passage of time occurs in the azimuth by the angular velocity sensor. Therefore, in order to suppress such an error, in addition to the angular velocity detected by the angular velocity sensor, it is usually added after the zero point adjustment.
Correction is also performed to remove the influence of the sensitivity of the angular velocity sensor.

In the car navigation system disclosed in Japanese Patent Laid-Open No. 4-9710, a GPS (Global Pos
itionning System) positioning system is also installed, and the azimuth data obtained by the positioning system is used to calibrate the azimuth by the above-mentioned angular velocity sensor, which aims to eliminate the accumulated error in the azimuth by the angular velocity sensor. Things are also being done.

Further, in the car navigation device disclosed in Japanese Patent Laid-Open Nos. 63-11813 and 63-109315, the map included in the map data at the time of the intersection drawing process based on the map data. The azimuth is referred to and the azimuth is calibrated by the angular velocity sensor using the azimuth, and the accumulated error in the azimuth is also corrected by the angular velocity sensor.

As described above, the car navigation system adopting the hybrid structure including the GPS positioning system and the self-supporting positioning system based on the angular velocity sensor is generally available when the GPS positioning system is considered to have good accuracy. While azimuth θ is calibrated with azimuth θ'based on this, G
When the PS positioning system does not work or when the traveling direction is low and the accuracy of the bearing θ'is not good because of a calculation delay or the like, it is possible to use the bearing θ based on the angular velocity sensor as it is, We are striving to meet both demands for continuous operation. FIG. 7 is an overall block diagram of a conventional car navigation device having such a function, and FIG. 8 is a function-related diagram of its azimuth calculation program.

This car navigation system has a CPU 1
1 or a ROM1 connected to this via a bus line 12
Device main body 10 which is a computer system including three or the like
And a command input unit such as an input processing program 22 for processing various commands input from the remote controller 20 connected to the apparatus main body 10 by a cable via the input circuit 21, and a CD-recorded CD-data.
A map reading means including a map reading program (not shown) for controlling the CD-ROM drive 30 in which the ROM is set to read the map data 33 is provided.

The car navigation system also converts the map data 33 and other data such as the traveling direction of the vehicle into video data and sends it to the dual port RAM 41a, and at the same time controls the drawing processing circuit 41 to display it on the monitor. It also comprises a display means including a monitor display program 42 to be executed, and a voice output means such as a voice output program (not shown) for controlling the speaker drive circuit 51 to generate a voice alarm from the speaker 50.

Further, this car navigation system is
Radio waves from GPS satellites are sent to GPS antenna 60 and GP
The current position (x, y) is detected based on the information received through the S reception circuit 61 and sent on this radio wave, and the azimuth θ ′ is also calculated based on the change in the position to obtain these. A GPS positioning system including a position detection program 62 or the like stored in the storage area 63, or a vibration gyro 70 having a piezoelectric element or the like as a detection element is used as an angular velocity sensor, and the angular velocity detected by the vibration gyro 70 is A / D conversion circuit 71. The vehicle speed sensor 80 further comprises means for converting the azimuth ω and the azimuth θ based on the input, and calculating the angular velocities ω and the azimuth θ on the basis of the azimuth calculation program 72, that is, means for detecting the azimuth based on the angular velocity. A vehicle speed detecting means including a vehicle speed detecting program (not shown) for converting the output by the A / D conversion circuit 81 and storing the input vehicle speed V in the storage area 83 is also provided.

Here, in particular, the means for detecting the azimuth based on the angular velocity will be described in detail. The gyro 70 in this means outputs the detected angular velocity as an analog signal of 0V to 5V. A positive angular velocity corresponding to a change, that is, a right turn is output as a deviation voltage from 2.5V to the 5V side, while a negative angular velocity corresponding to a counterclockwise direction change, that is, a left turn is 2.5V toward the 0V side.
It is output as a deviation voltage from V. And this 2.
5V indicates the zero-point voltage of the angular velocity (output at rest), but drifts depending on the temperature of the gyro 70 and the like.
Further, the sensitivity of the gyro 70 expressed in the unit of the deviation of the angular velocity from 2.5 V, that is, (mV / deg / sec)) conforms to the standard defined in the horizontal state and is within a predetermined error. It fits in.

The A / D conversion circuit 71 is a 12-bit A / D conversion circuit, and the output analog signal of the gyro 70 is an angular velocity ω1 that takes a digital value of 0H to 0FFFH.
Is to be converted to.

The azimuth calculation program 72 in the means for detecting the azimuth based on the angular velocity is a program which is repeatedly executed every 100 ms. The positive angular velocity is a positive digital value and the negative angular velocity is negative. A subtraction processing unit 72a that calculates the angular velocity ω2 by subtracting the zero point ω0 from the angular velocity ω1 so as to obtain a digital value, and the angular velocity error is stricter than the standard value so as to minimize the azimuth error due to the accumulation of the angular velocity errors. In order to finely adjust the value, the multiplication processing unit (correction means) 7 that adds the correction coefficient G having a value corresponding to the sensitivity of the gyro 70 to the angular velocity ω2 to calculate the angular velocity ω.
2b and the angular velocity ω are obtained.

Further, the azimuth calculation program 72 is
A product sum processing (calculating means) for accumulating the angular velocities ω and calculating the azimuth θ of the vehicle is provided, and the azimuth θ based on the gyro 70 is obtained.

In addition to this, this azimuth calculation program 72
Is a straight-ahead determination processing unit that determines the condition that the angular velocity ω is less than a predetermined threshold value for a predetermined period or over a predetermined distance and, if this condition is satisfied, gives a determination result that the host vehicle is in a straight-ahead state. 72d and a zero-point adjustment processing unit 72e that adjusts the zero point ω0 by increasing or decreasing by 0.01% so that the average value of ω2 at this time is asymptotic to the zero-point voltage corresponding to the straight traveling state. , The influence of the dynamic zero-point drift of the gyro 70 is removed, and when the vehicle is traveling straight at a vehicle speed V equal to or higher than a predetermined value, the azimuth data θ ′ from the GPS positioning system is used to replace the azimuth θ and the intersection pull-in processing. At this time, the azimuth calibration processing unit 72f for calibrating the azimuth θ by the gyro 70 by replacing the azimuth θ with the map azimuth data of the map data 33 is also provided, and the accumulated error in the azimuth by the angular velocity sensor is provided. Has become aims also eliminated.

Further, the azimuth calculation program 72 includes a comparison processing unit 72g for comparing the azimuth θ with another azimuth θ '.
(Comparing means), a bend determination processing unit 72h that determines whether the vehicle has made a right or left turn when the absolute value of the angular velocity ω exceeds a predetermined threshold value, and the like, and a vehicle. Approximately 4 seconds after the judgment that the azimuth has bent, that is, there is a significant level change in the azimuth θ and after waiting for the stabilization of the azimuth θ ′, the azimuth θ changes according to the comparison result of the azimuth θ and the azimuth θ ′ The correction coefficient G is set to 0.2% so as to approach the azimuth θ'or 0.1% or 0.05% depending on the previous adjustment amount.
A correction coefficient adjustment processing unit 72i for increasing / decreasing the adjustment is also provided, and the influence of the aging of the sensitivity of the gyro 70 is removed to further finely adjust the angular velocity error.

By the processing of the azimuth calculation program 72, the zero point is adjusted when the vehicle goes straight and the gyro 7 is operated.
The effect of zero dynamic zero drift is eliminated, and
Azimuth calibration is performed to eliminate the accumulated error in the azimuth θ. Further, when the vehicle bends, the correction coefficient is adjusted to remove the influence of the angular velocity ω due to the secular change of the sensitivity of the gyro 70 and the like. The azimuth θ or the like thus obtained is referred to by the monitor display program 42, the voice output program, or the like for the display on the monitor 40 or the voice alarm from the speaker 50.

[0016]

[Problems to be Solved by the Invention]

[Recognition of Problem] In such a conventional car navigation device, the correction coefficient adjustment is performed in addition to the zero point adjustment to ensure the accuracy of the angular velocity ω based on the angular velocity sensor that exceeds the standard accuracy of the angular velocity sensor. .

However, in the self-contained positioning system based on the angular velocity sensor, since the angular velocity ω is integrated to calculate the azimuth θ as described above, the angular velocity ω has an error even if it is a slight error. However, there is an essential property that the error of the angular velocity ω is accumulated in the azimuth θ until the azimuth θ is calibrated. Therefore, it is required to further improve the accuracy of the angular velocity ω.

Therefore, the azimuth calculation program 72 is added with a trace output process such as the zero point ω0, the angular velocities ω1, ω2, ω, the azimuth θ, the correction coefficient G, and further the straight-ahead judgment result and the turn-judgment result, and these changes are made. -When the change situation was monitored, it was found that the correction coefficient G sometimes changes in conjunction with the bending judgment result, that is, it shows regularity, although it is rare.

Since the correction coefficient G is dynamically adjusted in order to remove the influence of the sensitivity of the angular velocity sensor due to the secular change or the like, the fact that the change of the correction coefficient G may have regularity may occur. When any condition is satisfied, the sensitivity of the angular velocity sensor fluctuates according to the condition, and the correction coefficient G has a regular change corresponding to the fluctuation so as to cancel the influence of the fluctuation. Is supposed to do. Therefore, it is expected that the correction for removing the influence of the sensitivity of the angular velocity sensor will be more accurate if the condition is clarified and the fluctuation suppressing process corresponding to the regularity is performed.

The present invention has been made in view of the above point, and more accurately performs the correction for removing the influence of the sensitivity of the angular velocity sensor for detecting the angular velocity of the vehicle to accurately determine the azimuth of the vehicle. It is an object of the present invention to provide a car navigation device that can be demanded from customers.

[Clarification of Problem] Here, in order to clarify the condition in which a change in the correction coefficient having regularity appears, the sensitivity characteristic of the angular velocity sensor and the correspondence relationship between the sensitivity change and the correction coefficient are clarified. To do. It should be noted that FIG. 3 shows the correction coefficient corresponding to the gyro in the horizontal mounting state, and FIG. 4 shows the correction coefficient corresponding to the gyro in the tilted mounting state, and the correspondence between the sensitivity change and the correction coefficient due to the sensitivity characteristic of the gyro. It is a schematic diagram for demonstrating a relationship.

First, the sensitivity characteristics of the vibration gyro 70 will be described. In addition to general characteristics such as secular change, a gyro mounted with an inclination of β has a sensitivity higher than that of a horizontally mounted gyro. It has a characteristic of being COS (β) times lower. The same applies to angular velocity sensors such as optical gyros and gas rate gyros.

Due to this characteristic, when the gyro is attached to the vehicle by inclining from the horizontal by β, if the correction coefficient G corresponding to the gyro sensitivity in the horizontally attached state is set to "1" (see FIG. 3), the inclined attachment is performed. The correction coefficient G corresponding to the gyro sensitivity in the state is approximately “1 + β” (see FIG. 4, the slope β is exaggeratedly displayed). As a result, COS
The influence of the gyro sensitivity dropped by (β) times is (1 / COS
(Β)) This is offset by the correction coefficient G that is doubled.

Therefore, the above-mentioned change in the correction coefficient does not appear just by mounting the gyro at an angle.
This agrees with the fact that the gyro characteristic standard is specified in a horizontal state, and the gyro is mounted on the vehicle horizontally within the range allowed by this standard.

Therefore, in consideration of the fact that the correction coefficient G changes in association with the result of the turn determination, consideration will be given to the inconsistency of the rolling characteristics of the vehicle at the time of turn. That is, consider the change in gyro sensitivity when the vehicle inclination α at the time of right turn is different from the vehicle inclination α ′ at the time of left turn due to the difference in radius of curvature and the driver's habit. Therefore, the correction coefficient G is divided into two, a positive correction coefficient Gr when turning right and a negative correction coefficient Gl when turning left, and the influence of the gyro sensitivity on each is evaluated.

FIG. 5 is a schematic diagram for explaining the influence of rolling when the vehicle turns right or left, with respect to the correction coefficient corresponding to the gyro mounted parallel to the horizontal vehicle. The inclinations α and α'are both exaggeratedly displayed.

As can be seen from this figure, the sensitivity decreases to about 1 / (1 + α) times when the vehicle turns right with the inclination α, and accordingly, the positive correction coefficient for the vehicle right turn is set to offset this. Gr rises to (1 + α), and the sensitivity decreases to about 1 / (1 + α ') times when turning left with a slope α'. Therefore, in order to offset this, the negative correction coefficient Gl for turning left is Go up to (1 + α '). As a result, the difference ΔG between the positive correction coefficient Gr and the negative correction coefficient Gl is approximately (α−α ′).

However, even though the inclinations α and α'are different, the difference is usually small except when the driver has a very strong tendency. Therefore, even if the rolling characteristic at the time of turning the vehicle to the left or right is taken into consideration, the above-mentioned change in the correction coefficient is not actualized. This is consistent with the fact that the above-described change in the correction coefficient having regularity rarely appears even when the bending is repeated.

However, even if the gyro is mounted horizontally in the vehicle, the vehicle itself may temporarily continue for a certain period depending on the riding / mounting status of the vehicle occupant or luggage, road conditions, and the like. The gyro may be tilted correspondingly. Moreover, if this is the case, the effect should be canceled by the dynamic adjustment of the correction coefficient G as described above. However, in such a tilted state, the correction should be made only when the rolling of the vehicle is taken into consideration. Changes in the coefficient become apparent.

FIG. 6 is a schematic diagram for explaining the influence of rolling when the vehicle turns right or left, with respect to the correction coefficient corresponding to the gyro mounted parallel to the inclined vehicle. Note that, as in the other figures, the inclinations α, α '
Are exaggerated together.

As is clear from this figure, when the vehicle and thus the gyro have a continuous slope β, the slope α
Since the sensitivity drops to COS (β + α) times when making a right turn accompanied by, the positive correction coefficient Gr for turning right correspondingly increases to approximately (1 + β + α) to cancel this.
Sensitivity is COS (β-α ') when turning left with inclination α'
Since it only doubles, the negative correction coefficient Gl for left turn is raised to (1 + β-α ') in order to offset it. As a result, when the slope β exists, the influences of the rolling (α) at the time of right turn and the rolling (α ′) at the time of left turn on the correction coefficients Gr and Gl are opposite, so that the positive correction coefficient Gr and the negative correction coefficient Gr are negative. The difference ΔG from the correction coefficient Gl is
It will be as large as approximately (α + α ').

As described above, when the vehicle is temporarily and continuously tilted due to the mounting condition, etc., in consideration of not only the tilted state but also rolling of the vehicle when the vehicle makes a right or left turn, they are in a simultaneous relationship. , It became clear that the influence of the sensitivity characteristic of the gyro is different when turning right and when turning left. Therefore, it is necessary to provide a solution that can deal with such a case.

[0033]

Therefore, a car navigation device as a first solution means (in claim 1) invented to achieve the above object is an angular velocity sensor for detecting an angular velocity of a vehicle. A car navigation device comprising means for calculating the azimuth of the vehicle based on the angular velocity of the vehicle detected by the angular velocity sensor, and means for performing navigation processing such as displaying a traveling direction based on the calculated azimuth and the like. At a correction coefficient for removing the influence of the sensitivity of the angular velocity sensor, the first coefficient having a value corresponding to the sensitivity of the angular velocity sensor when the vehicle turns right.
And another correction coefficient for removing the influence of the sensitivity of the angular velocity sensor, which is a second correction coefficient having a value corresponding to the sensitivity of the angular velocity sensor when the vehicle turns left. Receiving the correction coefficient and the angular velocity selected by the selecting means, the selecting means selecting either one of the two correction coefficients according to the traveling direction of the vehicle determined by the positive or negative of the angular velocity. A correction means for correcting the angular velocity by adding the selected correction coefficient to the angular velocity and the like, and receiving the corrected angular velocity by the correcting means and integrating the corrected angular velocity to obtain the corrected angular velocity. Calculating means for calculating the azimuth from the angular velocity of , and the value of the azimuth from the calculating means,
Other azimuth data obtained by GPS positioning system or other means
The two orientation values of the data or the difference between these orientation values
Comparing means for seeking and detecting means for detecting a bend in the vehicle
And the comparison result of the comparison means according to the detection of the detection means.
The first correction coefficient or the second correction coefficient based on the fruit, etc.
It is characterized by comprising an adjusting means for adjusting the number .

Further, a car navigation device as a second solving means (invention 2) invented to achieve the above-mentioned object comprises a selecting means and a correcting means in the above-mentioned first solving means. The procedure is changed. That is, in a car navigation device that calculates the azimuth of the vehicle based on the angular velocity of the vehicle detected by the angular velocity sensor and performs a navigation process such as a traveling direction display, a value corresponding to the sensitivity of the angular velocity sensor when the vehicle turns right. First correction means for correcting the angular velocity with a first correction coefficient, and second correction means for correcting the angular velocity with a second correction coefficient having a value depending on the sensitivity of the angular velocity sensor when the vehicle turns left. And a selecting means for selecting one of the angular velocity corrected by the first correcting means and the angular velocity corrected by the second correcting means according to the traveling direction of the vehicle, and the selecting means. Calculating means for calculating the azimuth based on the corrected angular velocity, a value of the azimuth from the calculating means, and GPS positioning
Two other orientation data obtained by other means
Comparing bearing values or finding the difference between these bearing values
Means, detection means for detecting a bend in the vehicle, and
According to the detection result of the output means,
Adjustment of the first correction coefficient or the second correction coefficient
And an adjusting means for performing the adjustment .

[0035]

[0036]

In the car navigation system according to the first means for solving the problems of the present invention, the influence of the sensitivity of the angular velocity sensor is calculated when the azimuth of the vehicle is calculated based on the angular velocity of the vehicle detected by the angular velocity sensor. The correction value is used to correct the detected value of the angular velocity sensor, and two such correction coefficients are prepared. That is, a first correction coefficient for turning right and a second correction coefficient for turning left are prepared. Accordingly, even when the angular velocity sensor has different sensitivities when turning right and when turning left, the correction coefficient corresponding to each can be selected.

Then, these correction coefficients are selected by the selection means according to the traveling direction of the vehicle, and the selected correction coefficients are used for the correction of the angular velocity by the correction means. In other words, when making a right turn, the angular velocity is corrected with a correction coefficient that corresponds to the sensitivity of the angular velocity sensor when making a right turn.
When turning left, the angular velocity is corrected by a correction coefficient corresponding to the sensitivity of the angular velocity sensor when turning left. Even if the angular velocity sensor has different sensitivities when turning right and when turning left, such correction factors are used to make corrections that are suitable for turning right and turning left. It is possible to accurately remove the influence of the sensitivity of the angular velocity sensor from the angular velocity output from the angular velocity sensor while still including.

Further, the azimuth of the vehicle is calculated from the corrected angular velocity by the calculating means. However, since the azimuth is calculated based on the angular velocity which is an accurate value by the accurate correction, the azimuth is also accurate. It will be Therefore, the car navigation system of the present invention can perform the sensitivity correction after the output of the angular velocity sensor for detecting the angular velocity of the vehicle more accurately even when the sensitivities of the angular velocity sensor are different between the right turn and the left turn. Therefore, the direction of the vehicle can be accurately obtained.

In the car navigation system of the second solving means, the procedures of the selecting means and the correcting means are exchanged in the first solving means, so that the processing by these means is performed in the reverse order. The same effects as the effects of the first solving means are achieved. That is, it is equivalent to the first solving means. Note that the configuration is different in that the processing by the correction unit is increased.

In the car navigation device of the first or second solving means, the azimuth value depending on the angular velocity sensor and the other azimuth value depending on other means are compared by the comparing means. This makes it possible to calibrate the azimuth value that depends on the angular velocity sensor based on the other azimuth value in a situation where the other azimuth value is more reliable, and further, to change the sensitivity of the angular velocity sensor. It is also possible to estimate.

When the vehicle bend is detected by the detecting means, the first and second adjusting means are operated by the adjusting means.
The correction coefficient of is adjusted based on the result of comparison or the like. As a result, even if the sensitivity of the angular velocity sensor when the vehicle bends changes with the vehicle condition, road conditions, and driver's habit, the sensitivity after the change is dynamically tracked. Since the correction suitable for the angular velocity sensor at this time is performed, the influence due to the sensitivity variation of the angular velocity sensor can be accurately removed from the angular velocity output from the angular velocity sensor while including the influence of the sensitivity of the angular velocity sensor. Therefore, the car navigation system according to the present invention can be applied to the vehicle even when the angular velocity sensor has different sensitivities when turning right and when turning left, and when the sensitivity of the angular velocity sensor dynamically fluctuates due to bending of the vehicle. The sensitivity correction after the output of the angular velocity sensor for detecting the angular velocity can be performed more accurately, and the azimuth of the vehicle can be accurately obtained.

[0042]

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS The configuration of an embodiment of the car navigation system of the present invention will be described. FIG. 1 is an overall block diagram of a car navigation device as an embodiment of the present invention, and corresponds to FIG. 7 in a conventional example. Further, FIG. 2 is a function-related diagram of the azimuth calculation program in the car navigation device of the embodiment, and corresponds to FIG. 8 in the conventional example. In addition,
The same components as those of the conventional example are designated by the same reference numerals and the description thereof will be omitted.

The car navigation system of this embodiment is different from the conventional system only in that a storage area 730 is provided in place of the storage area 73 for memory allocation, and the direction calculation program 72 is related to the program. Instead, it is different in that an azimuth calculation program 720 as a means for calculating the azimuth based on the angular velocity is provided.

Specifically, the former difference is that a positive correction coefficient Gr as a first correction coefficient and a negative correction coefficient Gl as a second correction coefficient are newly provided. The positive correction coefficient Gr is set to a value corresponding to the sensitivity of the gyro 70 when the vehicle turns right in order to remove the influence of the sensitivity of the gyro 70 from the angular velocity ω.
Further, in order to remove the influence of the sensitivity of the gyro 70 from the angular velocity ω, the negative correction coefficient Gl is set to a value corresponding to the sensitivity of the gyro 70 when the vehicle turns left.

The specific difference of the latter is that, instead of the turn determination processing section 72h and the correction coefficient adjustment processing section 72i, the left turn determination processing section 721 as the detection means, the negative correction coefficient adjustment processing section 722 as the adjustment means, and the The right turn determination processing unit 723 as the detection unit and the positive correction coefficient adjustment processing unit 724 as the adjustment unit are provided, and the correction coefficient selection processing unit 725 as the selection unit is newly provided.

The left turn determination processor 721 determines whether or not the angular velocity ω exceeds a predetermined negative threshold value to the negative side, and when the angular velocity ω exceeds a predetermined negative threshold value, the vehicle turns left. It is judged that it did.

The negative correction coefficient adjustment processing unit 722 makes a predetermined adjustment to the negative correction coefficient Gl for a left turn after about 4 seconds have elapsed since it was determined that the vehicle turned left. That is, there is a significant level of change in azimuth θ when turning left, and after waiting for stabilization of azimuth θ ′, azimuth θ is asymptotic to azimuth θ ′ according to the comparison result of azimuth θ and azimuth θ ′. In such a direction, the negative correction coefficient Gl is adjusted by increasing or decreasing by 0.2% or by 0.1% or 0.05% depending on the previous adjustment amount or the like.

The right turn determination processing unit 723 determines whether or not the angular velocity ω exceeds a predetermined positive threshold value to the positive side, and when the angular velocity ω exceeds a predetermined positive threshold value, the vehicle turns right. It is judged that it did.

The positive correction coefficient adjustment processing unit 724 makes a predetermined adjustment to the positive correction coefficient Gr for right turn after about 4 seconds have elapsed since it was determined that the vehicle turned right. That is, there is a significant level of change in azimuth θ when turning right, and after waiting for stabilization of azimuth θ ′, azimuth θ is asymptotic to azimuth θ ′ according to the comparison result of azimuth θ and azimuth θ ′. In such a direction, the positive correction coefficient Gr is adjusted by increasing or decreasing by 0.2% or by 0.1% or 0.05% according to the previous adjustment amount or the like.

The correction coefficient selection processing unit 725 determines the angular velocity ω2.
Is negative, the negative correction coefficient Gl is selected and its value is set as the correction coefficient G for the addition processing 72b as the correction means, and when the angular velocity ω2 is positive, the positive correction coefficient Gr is set.
Is selected and its value is set as the correction coefficient G. As a result, the correction coefficient selection processing unit 725 selects either one of the two correction coefficients according to the traveling direction of the vehicle, and the surplus processing 72b is selected by the correction coefficient selection processing unit 725. The correction coefficient is used to correct the angular velocity.

The operation of the car navigation system of this embodiment will be described below, but the characteristic operation based on the above-mentioned differences will be mainly described.

When the vehicle is traveling straight, zero point adjustment is performed by the zero point adjustment processing 72e and the like. Thus, the influence of the dynamic zero point drift of the gyro 70 is eliminated. Further, azimuth calibration is also performed by the azimuth calibration processing unit 72f and the like. Then, this eliminates the accumulated error in the azimuth θ depending on the gyro 70.
Therefore, these conventional functions are maintained even in this car navigation device.

On the other hand, when the vehicle turns left, the left turn determination processing unit 721 determines that the vehicle has turned left, and the negative correction coefficient adjustment processing unit 722 corresponding thereto determines that the azimuth θ approaches the azimuth θ ′. Negative correction factor Gl for left turn
Is adjusted. Therefore, the negative correction coefficient Gl has a value that cancels the decrease in the sensitivity of the gyro 70 when turning left.

Further, when the vehicle turns right, the right turn determination processing unit 723 determines that the vehicle has turned right, and the positive correction coefficient adjustment processing unit 724 responsive thereto determines that the azimuth θ approaches the azimuth θ ′. The positive correction coefficient Gr for the hour is adjusted. Therefore, the positive correction coefficient Gr is equal to the negative correction coefficient Gl.
Independently of, the value becomes a value that cancels the decrease in the sensitivity of the gyro 70 when turning right.

Therefore, when a vehicle equipped with the gyro 70 in a state parallel to the vehicle is traveling in a substantially horizontal state (corresponding to FIG. 5), such a vehicle is in a state of boarding / mounting passengers / baggage, etc. Even when the vehicle is tilting due to road conditions (corresponding to FIG. 6), the sensitivity of the gyro 70 is reduced by COS (α) times or COS (β + α) when turning right.
Corresponding to double, the positive correction coefficient Gr for right turn is 1 / COS
It becomes (α) times or 1 / COS (β + α) times, whereby the sensitivity decrease of the gyro 70 at the time of turning right is exactly offset. Further, the negative correction coefficient Gl for left turn is 1 / COS (α ') times or 1 / COS corresponding to the sensitivity decrease COS (α') times or COS (β-α ') times of the gyro 70 at the time of left turning. (Β−α ′) times, and the sensitivity decrease of the gyro 70 at the time of left turn is exactly offset by this. As a result, it becomes possible to obtain the angular velocity ω and the azimuth θ that are more accurate than in the conventional case, and the traveling state can be displayed more reliably than in the conventional case.

[0056]

As is apparent from the above description, in the car navigation system of the first and second means for solving the problems of the present invention, the first correction coefficient for right turn and for left turn are provided. The second correction coefficient and the second correction coefficient are used appropriately and the corrections suitable for the right turn and the left turn are performed. Therefore, even when the sensitivities of the angular velocity sensors differ between right turn and left turn, the sensitivity of the angular velocity sensor that detects the angular velocity of the vehicle can be corrected more accurately, and the azimuth of the vehicle can be accurately determined. It has the effect of being able to.

Further, in the car navigation device of the first or second solving means of the present invention , the sensitivity of the angular velocity sensor is dynamically corrected so as to correct the angular velocity between the right turn and the left turn. Even if the sensitivities of the sensors are different, and even if the sensitivities of the angular velocity sensors dynamically fluctuate due to bending of the vehicle, etc., the sensitivity of the angular velocity sensor that detects the angular velocity of the vehicle can be corrected more accurately. Therefore, there is an effect that the direction of the vehicle can be accurately obtained.

[Brief description of drawings]

FIG. 1 is an overall block diagram of a car navigation device as an embodiment of the present invention.

FIG. 2 is a function-related diagram of the processing of the azimuth calculation program.

FIG. 3 is a schematic diagram for explaining a correction coefficient corresponding to a gyro in a horizontally mounted state.

FIG. 4 is a schematic diagram for explaining a correction coefficient corresponding to a gyro in an inclined mounting state.

FIG. 5 is a schematic diagram for explaining an influence of rolling when a vehicle turns right or left, with respect to a correction coefficient corresponding to a gyro mounted parallel to a horizontal vehicle.

FIG. 6 is a schematic diagram for explaining an influence of rolling when a vehicle turns right or left, with respect to a correction coefficient corresponding to a gyro mounted parallel to a tilted vehicle.

FIG. 7 is an overall block diagram of a conventional car navigation device.

FIG. 8 is a function-related diagram of the azimuth calculation program.

[Explanation of symbols]

10 Car Navigation Device Main Body 11 CPU 12 Bus Line 13 ROM 14 RAM 20 Remote Controller 21 Input Circuit 22 Input Processing Program 30 CD-ROM Drive 31 CD-ROM Controller 33 Map Data 40 Monitor 41a Dual Port RAM 41 Drawing Processing Circuit 42 Monitor Display program (means for performing processing such as traveling direction display) 50 Speaker 51 Speaker driving circuit 60 GPS antenna 61 GPS receiving circuit 62 Position detection program 63 Storage area for current position 70 Vibration gyro (angular velocity sensor) 71 A / D conversion Circuit 72 azimuth calculation program (means for calculating azimuth based on angular velocity) 72a subtraction processing 72b summation processing (correction means) 72c sum-of-products processing (calculation means) 72d straight traveling determination processing 72e zero point adjustment processing 72f Position calibration processing 72g Comparison processing (comparing means) 72h Bending judgment processing 72i Correction coefficient adjustment processing 73 Angular velocity storage area 80 Vehicle speed sensor 81 A / D conversion circuit 82 Vehicle speed detection program 83 Vehicle speed storage area 720 Direction calculation program (based on angular velocity) Orientation calculation means) 721 Left turn determination processing (detection means) 722 Negative correction coefficient adjustment processing (adjustment means) 723 Right turn determination processing (detection means) 724 Positive correction coefficient adjustment processing (adjustment means) 725 Correction coefficient selection processing (selection means) ) 730 angular velocity storage area V vehicle speed G correction coefficient Gr positive correction coefficient (first correction coefficient) Gl negative correction coefficient (second correction coefficient) θ, θ ′ azimuth ω, ω1, ω2 angular speed

Front page continuation (58) Fields surveyed (Int.Cl. ⁷ , DB name) G01C 21/00 G01S 5/02 G01S 5/14 G08G 1/0968 G09B 29/10

Claims (2)

(57) [Claims] 1. A car navigation device that calculates the azimuth of the vehicle based on the angular velocity of the vehicle detected by an angular velocity sensor to perform navigation processing such as display of a traveling direction according to the sensitivity of the angular velocity sensor when the vehicle turns right. Selection of either one of a first correction coefficient having a different value and a second correction coefficient having a value corresponding to the sensitivity of the angular velocity sensor when the vehicle is turning left according to the traveling direction of the vehicle. Means, a correcting means for correcting the angular velocity by the correction coefficient selected by the selecting means, a calculating means for calculating the azimuth based on the angular velocity corrected by the correcting means, and a azimuth of the azimuth from the calculating means. Value, and
Other azimuth data obtained by GPS positioning system or other means
The two orientation values of the data or the difference between these orientation values
Comparing means for seeking and detecting means for detecting a bend in the vehicle
And the comparison result of the comparison means according to the detection of the detection means.
The first correction coefficient or the second correction coefficient based on the fruit, etc.
A car navigation device comprising: an adjusting unit for adjusting the number . 2. A car navigation device that calculates the azimuth of the vehicle based on the angular velocity of the vehicle detected by an angular velocity sensor to perform navigation processing such as display of a traveling direction according to the sensitivity of the angular velocity sensor when the vehicle turns right. First correction means for correcting the angular velocity with a first correction coefficient having a different value, and second correction means for correcting the angular velocity with a second correction coefficient having a value corresponding to the sensitivity of the angular velocity sensor when the vehicle turns left. Correction means, selection means for selecting one of the angular velocity corrected by the first correction means and the angular velocity corrected by the second correction means according to the traveling direction of the vehicle, and the selection means. Calculating means for calculating the azimuth based on the corrected angular velocity selected by the means , the value of the azimuth from the calculating means, and GP
S Orientation data of other direction data obtained by other means
Compare two bearing values or find the difference between these bearing values
Comparing means, and detecting means for detecting a bend in the vehicle,
According to the detection of the detection means, the comparison result of the comparison means, etc.
Of the first correction coefficient or the second correction coefficient based on
A car navigation device comprising: an adjusting unit for adjusting .