JPH10153443A - Navigation device - Google Patents

Navigation device

Info

Publication number
JPH10153443A
JPH10153443A JP31031496A JP31031496A JPH10153443A JP H10153443 A JPH10153443 A JP H10153443A JP 31031496 A JP31031496 A JP 31031496A JP 31031496 A JP31031496 A JP 31031496A JP H10153443 A JPH10153443 A JP H10153443A
Authority
JP
Japan
Prior art keywords
angular velocity
integrated
output
pitch angle
pitch
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.)
Pending
Application number
JP31031496A
Other languages
Japanese (ja)
Inventor
Taro Ura
太郎 浦
Kenichi Nakano
健一 中野
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Panasonic Holdings Corp
Original Assignee
Matsushita Electric Industrial Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Matsushita Electric Industrial Co Ltd filed Critical Matsushita Electric Industrial Co Ltd
Priority to JP31031496A priority Critical patent/JPH10153443A/en
Publication of JPH10153443A publication Critical patent/JPH10153443A/en
Pending legal-status Critical Current

Links

Abstract

PROBLEM TO BE SOLVED: To provide a navigation device which prevents the increase of the accumulated error of the totalized pitch angle, and to correctly calculate the moving distance of a vehicle. SOLUTION: This device has a pitch angle judging means 13 for judging an output of a pitch angle speed detector to be a drift component, when a microtime totalized pitch angle as an accumulated value for a specific microtime, of the output values of the pitch angle speed detector 2, is less than a specific value, and a moving distance calculating means 4 for making the output value of the pitch angle speed detector 2 zero in the calculation of the totalized pitch angle when the output of the pitch angle speed detector 2 is judged to be the drift component by the pitch angle judging means 13, when the acceleration output from an acceleration sensor 1 is corrected on the basis of the totalized pitch angle as the accumulated value of the output values of the pitch angle speed detector 2 in the vehicle travelling time. Thereby, the navigation device which can prevent the increase of the accumulated error of the totalized pitch angle, and which can correctly calculate the moving distance of the vehicle, can be obtained.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は、車両の位置を検出
するナビゲーション装置に関する。
The present invention relates to a navigation device for detecting a position of a vehicle.

【0002】[0002]

【従来の技術】図3は従来のナビゲーション装置を示す
ブロック図である。図3において、Aは演算、制御の処
理を行う中央制御部、1は車両の進行方向における加速
度を検出する加速度センサ、2は車両のピッチ動作方向
における角速度(ピッチ角速度)を検出するピッチ角速
度検出器としてのジャイロセンサ、3は車両のヨー動作
方向における角速度(ヨー角速度)を検出するヨー角速
度検出器としてのジャイロセンサ、4は加速度センサ1
から出力される加速度から車両の移動距離を算出する移
動距離算出手段、5はジャイロセンサ3から出力される
ヨー角速度から車両の移動方位角(移動ヨー角)を算出
する移動方位算出手段、6は移動距離算出手段4および
移動方位算出手段5から出力される所定微小時間におけ
る車両の移動距離および移動方位を前回の車両位置およ
び車両方位に加算して現在の車両位置および車両方位を
求める相対位置演算手段、7はジャイロセンサ2から出
力されるピッチ角速度からピッチ角度を算出し、加速度
センサ1からの加速度に対してピッチ成分の加速度を除
去するように補正する速度補正手段、8はディジタルの
地図データが記憶されている地図記憶部、9は車両の位
置や地図などを表示する表示部、10は相対位置演算手
段6から出力される車両の位置データに基づき、その車
両の位置が該当する所定の領域の地図データを地図記憶
部8から読み出し、車両の位置と地図とを表示部9に出
力する表示制御手段である。
2. Description of the Related Art FIG. 3 is a block diagram showing a conventional navigation device. In FIG. 3, A is a central control unit that performs arithmetic and control processing, 1 is an acceleration sensor that detects acceleration in the traveling direction of the vehicle, and 2 is pitch angular velocity detection that detects an angular velocity (pitch angular velocity) in the pitching direction of the vehicle. A gyro sensor as a detector, 3 is a gyro sensor as a yaw angular velocity detector for detecting an angular velocity (yaw angular velocity) in the yaw operation direction of the vehicle, and 4 is an acceleration sensor 1
Moving distance calculating means for calculating the moving distance of the vehicle from the acceleration outputted from the gyro sensor 3; moving azimuth calculating means for calculating the moving azimuth angle (moving yaw angle) of the vehicle from the yaw angular velocity outputted from the gyro sensor 3; Relative position calculation in which the current vehicle position and vehicle direction are obtained by adding the vehicle's travel distance and direction in a predetermined short period of time output from the travel distance calculating means 4 and the moving direction calculating means 5 to the previous vehicle position and vehicle direction. Means 7, a speed correction means for calculating a pitch angle from the pitch angular velocity output from the gyro sensor 2 and correcting the acceleration from the acceleration sensor 1 so as to remove the acceleration of the pitch component; and 8, a digital map data. , A display unit 9 for displaying the position of the vehicle, a map, and the like. Based on the position data of the vehicle, it reads map data of a predetermined area where the position of the vehicle corresponds the map storage unit 8, a display control means for outputting the position and the map of the vehicle on the display unit 9.

【0003】図4はナビゲーション装置の車載概念図で
ある。図4において、加速度センサ1、ジャイロセンサ
2、3は図3と同様のものなので、同一符号を付し、説
明は省略する。11は車両、12は中央制御部A、地図
記憶部8および表示部9から成る装置本体である。
FIG. 4 is a conceptual diagram of a navigation device mounted on a vehicle. 4, the acceleration sensor 1, the gyro sensors 2, 3 are the same as those in FIG. Reference numeral 11 denotes a vehicle, and 12 denotes an apparatus main body including a central control unit A, a map storage unit 8, and a display unit 9.

【0004】以上のように構成されたナビゲーション装
置について、その動作を説明する。図3、図4に示すよ
うに、加速度センサ1およびジャイロセンサ2、3の出
力データ(加速度データおよびピッチ角速度データ、ヨ
ー角速度データ)から相対位置演算手段6により車両1
1の位置の演算を行う。この演算内容について以下説明
する。
[0004] The operation of the navigation device configured as described above will be described. As shown in FIGS. 3 and 4, the vehicle 1 is output from the output data (acceleration data, pitch angular velocity data, yaw angular velocity data) of the acceleration sensor 1 and the gyro sensors 2 and 3 by the relative position calculating means 6.
1 is calculated. The details of this calculation will be described below.

【0005】まず、移動距離算出手段4は、所定の周期
(所定微小時間)Δt毎に加速度センサ1から出力され
るデータ(加速度データ)を時間軸で2回積分演算を行
う。つまり、(数1)、(数2)の演算を行うことによ
り、車両11の速度vnおよび移動距離Δdnを得る。
ただし、加速度センサ1からデータの得られる時間周期
をΔt、時刻nにおける車両11の加速度をan、時刻
nにおける車両11の速度をvn、時間周期Δtにおけ
る車両11の移動距離をΔdn、車両11の初期速度を
V0とする。
[0005] First, the moving distance calculating means 4 performs an integral operation twice on the time axis for data (acceleration data) output from the acceleration sensor 1 at a predetermined cycle (predetermined minute time) Δt. That is, by performing the calculations of (Equation 1) and (Equation 2), the speed vn and the moving distance Δdn of the vehicle 11 are obtained.
However, the time period at which data is obtained from the acceleration sensor 1 is Δt, the acceleration of the vehicle 11 at time n is an, the speed of the vehicle 11 at time n is vn, the moving distance of the vehicle 11 at time period Δt is Δdn, The initial speed is V0.

【0006】[0006]

【数1】 (Equation 1)

【0007】[0007]

【数2】 (Equation 2)

【0008】ここで、車両11がピッチ方向に傾いてい
る場合、加速度センサ1の出力データには重力加速度の
ピッチ成分が含まれるため、加速度をそのまま用いて計
算しては移動距離算出に誤差が生じる。そこで、次に示
すような重力加速度成分除去のための補正を速度補正手
段7で行う。
Here, when the vehicle 11 is tilted in the pitch direction, the output data of the acceleration sensor 1 includes the pitch component of the gravitational acceleration. Occurs. Therefore, the following correction for removing the gravitational acceleration component is performed by the speed correction unit 7.

【0009】速度補正手段7では、ジャイロセンサ2か
らの出力データ(ピッチ角速度データ)に対して時間軸
で積分演算を行う。つまり、(数3)の演算を行うこと
により、車両11のピッチ角(積算ピッチ角)αnを得
る。ただし、ジャイロセンサ2からデータの得られる時
間周期をΔt、時刻nにおける車両11のピッチ角速度
をωn、時刻nで時間周期Δtにおける車両11のピッ
チ角をαn、初期ピッチ角をα0とする。
The speed correction means 7 performs an integral operation on the output data (pitch angular velocity data) from the gyro sensor 2 on the time axis. That is, the pitch angle (integrated pitch angle) αn of the vehicle 11 is obtained by performing the calculation of (Equation 3). Here, the time period at which data is obtained from the gyro sensor 2 is Δt, the pitch angular velocity of the vehicle 11 at the time n is ωn, the pitch angle of the vehicle 11 at the time period Δt at the time n is αn, and the initial pitch angle is α0.

【0010】[0010]

【数3】 (Equation 3)

【0011】この(数3)により求められたピッチ角α
nを用いて(数4)により加速度センサ1出力データの
補正を行う。ただし、補正された時刻nにおける車両1
1の加速度An、加速度センサ1から出力された車両1
1の加速度をan、重力加速度をgとする。
[0011] The pitch angle α obtained by the equation (3)
The output data of the acceleration sensor 1 is corrected according to (Equation 4) using n. However, the vehicle 1 at the corrected time n
1 and the vehicle 1 output from the acceleration sensor 1
The acceleration of 1 is an and the acceleration of gravity is g.

【0012】[0012]

【数4】 (Equation 4)

【0013】(数4)のAnを(数1)、(数2)のa
nに代入して、時刻nにおける車両11の速度Vnと時
間周期Δtにおける車両11の移動距離ΔDnとを得
る。これを(数5)、(数6)として示す。
An in (Equation 4) is replaced by (A) in (Equation 1) and a in (Equation 2).
Substituting into n, the speed Vn of the vehicle 11 at time n and the moving distance ΔDn of the vehicle 11 in the time period Δt are obtained. This is shown as (Equation 5) and (Equation 6).

【0014】[0014]

【数5】 (Equation 5)

【0015】[0015]

【数6】 (Equation 6)

【0016】次に、移動方位算出手段5は、所定の時間
周期(所定微小時間)Δt毎にジャイロセンサ3から出
力されるデータ(ヨー角速度データ)に対して時間軸で
積分演算を行う。つまり、(数7)の演算を行うことに
より、車両11の方位角(積算ヨー角)θnを得る。た
だし、ジャイロセンサ3からデータの得られる時間周期
をΔt、時刻nにおける車両11の方位角速度(ヨー角
速度)をωn、時刻nで時間周期Δtにおける車両11
の移動方位角をθn、初期方位角をθ0とする。
Next, the moving azimuth calculating means 5 performs an integral operation on the data (yaw angular velocity data) output from the gyro sensor 3 at a predetermined time period (predetermined minute time) Δt on a time axis. That is, the azimuth (integrated yaw angle) θn of the vehicle 11 is obtained by performing the calculation of (Equation 7). Here, the time period at which data is obtained from the gyro sensor 3 is Δt, the azimuth angular velocity (yaw angular speed) of the vehicle 11 at time n is ωn, and the vehicle 11 at time n is time period Δt.
Is the moving azimuth angle θn, and the initial azimuth angle is θ0.

【0017】[0017]

【数7】 (Equation 7)

【0018】図5はナビゲーション装置における位置演
算を説明するための位置演算概念図である。相対位置演
算手段6は、前述したように車両11の移動距離ΔDn
および移動方位角θnを求めると、図5に示す考え方
(移動距離に移動方位角を乗算して所定時間Δtにおけ
るX、Y方向の移動距離を求めるという考え方)を用い
て、(数8)、(数9)から車両11の初期位置から累
積演算して車両11の位置を求める。ただし、時刻nに
おける車両11の位置座標を(xn、yn)、初期位置
を(x0、y0)とする。なお、移動距離算出におい
て、水平面となすピッチ角の影響については考慮されて
いないが、これは簡単に演算可能であるので、説明は省
略する。
FIG. 5 is a conceptual diagram of position calculation for explaining position calculation in the navigation device. The relative position calculating means 6 calculates the moving distance ΔDn of the vehicle 11 as described above.
When the moving azimuth θn is obtained, using the concept shown in FIG. 5 (the concept of multiplying the moving distance by the moving azimuth to obtain the moving distance in the X and Y directions at a predetermined time Δt), The position of the vehicle 11 is obtained by cumulative calculation from the initial position of the vehicle 11 from (Equation 9). However, the position coordinates of the vehicle 11 at time n are (xn, yn), and the initial position is (x0, y0). In the calculation of the moving distance, the influence of the pitch angle with respect to the horizontal plane is not taken into account. However, since this can be easily calculated, the description is omitted.

【0019】[0019]

【数8】 (Equation 8)

【0020】[0020]

【数9】 (Equation 9)

【0021】相対位置演算手段6からは車両11の位置
データが表示制御手段10に出力される。表示制御手段
10は、車両11の位置データを受け取ると、地図記憶
部8から、所定の領域のディジタル地図データを読み出
し、表示部9に出力する。
The relative position calculation means 6 outputs position data of the vehicle 11 to the display control means 10. Upon receiving the position data of the vehicle 11, the display control unit 10 reads out digital map data of a predetermined area from the map storage unit 8 and outputs the digital map data to the display unit 9.

【0022】このように、従来のナビゲーション装置で
は、加速度センサ1による速度算出を精度良く行うため
に、車両11のピッチ角を検出するためのジャイロセン
サ2からの出力データ(ピッチ角速度データ)により、
加速度センサ1からの出力データ(加速度データ)に対
して補正を行う。
As described above, in the conventional navigation device, in order to accurately calculate the speed by the acceleration sensor 1, the output data (pitch angular velocity data) from the gyro sensor 2 for detecting the pitch angle of the vehicle 11 is used.
The output data (acceleration data) from the acceleration sensor 1 is corrected.

【0023】[0023]

【発明が解決しようとする課題】しかしながら、上記従
来のナビゲーション装置では、加速度センサ1からの加
速度に対して補正を行うためのピッチ角速度を検出する
ジャイロセンサ2からの出力にドリフト成分があると、
ジャイロセンサ2により車両のピッチ角速度を検出しよ
うとする場合、速度補正手段7はジャイロセンサ2の出
力データを積算していくため、ジャイロセンサ2の出力
ドリフトまで積算されることになり、積算ピッチ角の累
積誤差が増大し、速度精度(従って移動距離算出精度)
が非常に悪くなるという問題点を有していた。
However, in the above conventional navigation device, if there is a drift component in the output from the gyro sensor 2 for detecting the pitch angular velocity for correcting the acceleration from the acceleration sensor 1,
When the gyro sensor 2 is to detect the pitch angular velocity of the vehicle, the speed correction means 7 accumulates the output data of the gyro sensor 2, so that the output drift of the gyro sensor 2 is integrated. Accumulation error increases, and the speed accuracy (and therefore the travel distance calculation accuracy)
Had a problem that it became very bad.

【0024】このナビゲーション装置では、積算ピッチ
角の累積誤差の増大を防止して車両の移動距離を正確に
算出することができることが要求されている。
This navigation device is required to be able to accurately calculate the moving distance of the vehicle while preventing an increase in the accumulated error of the integrated pitch angle.

【0025】本発明は、積算ピッチ角の累積誤差の増大
を防止して車両の移動距離を正確に算出することができ
るナビゲーション装置を提供することを目的とする。
An object of the present invention is to provide a navigation device capable of preventing the increase in the accumulated error of the integrated pitch angle and accurately calculating the moving distance of the vehicle.

【0026】[0026]

【課題を解決するための手段】この課題を解決するため
に本発明によるナビゲーション装置は、ピッチ角速度検
出器の出力値の所定微小時間における積算値である微小
時間積算ピッチ角が所定値以下のときにはピッチ角速度
検出器の出力はドリフト成分であると判定するピッチ角
判定手段と、ピッチ角速度検出器の出力値の車両走行時
間における積算値である積算ピッチ角に基づいて加速度
センサから出力される加速度を補正するに際し、ピッチ
角速度検出器の出力はドリフト成分であるとピッチ角判
定手段で判定されたときには、積算ピッチ角の算出にお
いてはピッチ角速度検出器の出力値をゼロとなす移動距
離算出手段とを有するように構成した。
SUMMARY OF THE INVENTION To solve this problem, a navigation device according to the present invention provides a navigation apparatus in which a minute time integrated pitch angle which is an integrated value of an output value of a pitch angular velocity detector in a predetermined minute time is equal to or smaller than a predetermined value. The output of the pitch angular velocity detector is a pitch angle determining means that determines that the output is a drift component, and the acceleration output from the acceleration sensor based on the integrated pitch angle that is the integrated value of the output value of the pitch angular velocity detector during the vehicle travel time. When the correction is made, when the pitch angle velocity detector determines that the output of the pitch angular velocity detector is a drift component, the movement of the pitch angular velocity detector becomes zero when calculating the integrated pitch angle. It was configured to have.

【0027】これにより、積算ピッチ角の累積誤差の増
大を防止して車両の移動距離を正確に算出することがで
きるナビゲーション装置が得られる。
As a result, a navigation device capable of preventing the increase of the accumulated error of the integrated pitch angle and accurately calculating the moving distance of the vehicle can be obtained.

【0028】[0028]

【発明の実施の形態】本発明の請求項1に記載の発明
は、ピッチ角速度検出器の出力値の所定微小時間におけ
る積算値である微小時間積算ピッチ角が所定値以下のと
きにはピッチ角速度検出器の出力はドリフト成分である
と判定するピッチ角判定手段と、ピッチ角速度検出器の
出力値の車両走行時間における積算値である積算ピッチ
角に基づいて加速度センサから出力される加速度を補正
するに際し、ピッチ角速度検出器の出力はドリフト成分
であるとピッチ角判定手段で判定されたときには、積算
ピッチ角の算出においてはピッチ角速度検出器の出力値
をゼロとなす移動距離算出手段とを有することとしたも
のであり、微小時間積算ピッチ角が所定値以下のときの
ピッチ角速度は積算ピッチ角の算出に使用されず、従っ
て移動距離算出に使用されないという作用を有する。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS The invention according to claim 1 of the present invention is directed to a pitch angular velocity detector when a minute time integrated pitch angle which is an integrated value of the output value of the pitch angular velocity detector during a predetermined minute time is equal to or smaller than a predetermined value. The output of the pitch angle determination means to determine that the drift component, and, when correcting the acceleration output from the acceleration sensor based on the integrated pitch angle which is the integrated value of the output value of the pitch angular velocity detector during the vehicle travel time, When the output of the pitch angular velocity detector is determined to be a drift component by the pitch angle determining means, the calculation of the integrated pitch angle includes a moving distance calculating means for setting the output value of the pitch angular velocity detector to zero. The pitch angular velocity when the minute time integrated pitch angle is equal to or less than a predetermined value is not used for calculating the integrated pitch angle, and is therefore used for calculating the moving distance. It has the effect that it is not.

【0029】請求項2に記載の発明は、ピッチ角速度検
出器の出力値の所定微小時間における積算値である微小
時間積算ピッチ角が所定値以下のときにはピッチ角速度
検出器の出力値がゼロとなるようなバイアスをピッチ角
速度検出器に印加するピッチ角判定手段と、ピッチ角速
度検出器の出力値の車両走行時間における積算値である
積算ピッチ角に基づいて加速度センサから出力される加
速度を補正する移動距離算出手段とを有することとした
ものであり、ピッチ角速度検出器の出力値からドリフト
成分が除去されるという作用を有する。
According to a second aspect of the present invention, the output value of the pitch angular velocity detector becomes zero when the minute time integrated pitch angle which is the integrated value of the output value of the pitch angular velocity detector during a predetermined minute time is equal to or smaller than a predetermined value. Pitch angle determining means for applying such a bias to the pitch angular velocity detector, and movement for correcting the acceleration output from the acceleration sensor based on the integrated pitch angle which is the integrated value of the output value of the pitch angular velocity detector during the vehicle travel time. And a distance calculating means, which has an effect that a drift component is removed from an output value of the pitch angular velocity detector.

【0030】請求項3に記載の発明は、ヨー角速度検出
器の出力値の所定微小時間における積算値である微小時
間積算ヨー角が所定値以下のときにはヨー角速度検出器
の出力はドリフト成分であると判定するヨー角判定手段
と、ヨー角速度検出器の出力値を積算して積算ヨー角を
算出するに際し、ヨー角速度検出器の出力はドリフト成
分であるとヨー角判定手段で判定されたときには、積算
ヨー角の算出においてはヨー角速度検出器の出力値をゼ
ロとなす移動方位算出手段とを有することとしたもので
あり、微小時間積算ヨー角が所定値以下のときのヨー角
速度は積算ヨー角の算出に使用されないという作用を有
する。
The output of the yaw angular velocity detector is a drift component when the minute time integrated yaw angle which is the integrated value of the output value of the yaw angular velocity detector during a predetermined minute time is equal to or smaller than a predetermined value. When calculating the integrated yaw angle by integrating the output values of the yaw angular velocity detector, when the yaw angle determination means determines that the output of the yaw angular velocity detector is a drift component, In calculating the integrated yaw angle, there is provided a moving azimuth calculating means for setting the output value of the yaw angular velocity detector to zero, and the yaw angular velocity when the minute time integrated yaw angle is equal to or smaller than a predetermined value is calculated as the integrated yaw angle. Is not used in the calculation of

【0031】請求項4に記載の発明は、ヨー角速度検出
器の出力値の所定微小時間における積算値である微小時
間積算ヨー角が所定値以下のときにはヨー角速度検出器
の出力値がゼロとなるようなバイアスをヨー角速度検出
器に印加するヨー角判定手段と、ヨー角速度検出器の出
力値の車両走行時間における積算値である積算ヨー角を
算出する移動方位算出手段とを有することとしたもので
あり、ヨー角速度検出器の出力値からドリフト成分が除
去されるという作用を有する。
According to a fourth aspect of the present invention, the output value of the yaw angular velocity detector becomes zero when the minute time integrated yaw angle, which is the integrated value of the output value of the yaw angular velocity detector during a predetermined minute time, is equal to or smaller than a predetermined value. A yaw angle determining means for applying such a bias to the yaw angular velocity detector, and a moving azimuth calculating means for calculating an integrated yaw angle which is an integrated value of the output value of the yaw angular velocity detector during the vehicle traveling time. This has the effect that the drift component is removed from the output value of the yaw angular velocity detector.

【0032】請求項5に記載の発明は、請求項1に記載
のピッチ角判定手段および移動距離算出手段と、請求項
3に記載のヨー角判定手段および移動方位算出手段とを
有することとしたものであり、微小時間積算ピッチ角が
所定値以下のときの微小時間積算ピッチ角のピッチ角速
度は積算ピッチ角の算出に使用されず、従って移動距離
算出に使用されないという作用を有すると共に、微小時
間積算ヨー角が所定値以下のときのヨー角速度は積算ヨ
ー角の算出に使用されないという作用を有する。
According to a fifth aspect of the present invention, there is provided the pitch angle determining means and the moving distance calculating means according to the first aspect, and the yaw angle determining means and the moving direction calculating means according to the third aspect. The pitch angular velocity of the minute time accumulated pitch angle when the minute time accumulated pitch angle is equal to or less than a predetermined value is not used for calculating the accumulated pitch angle, and therefore is not used for calculating the moving distance. The yaw angular velocity when the integrated yaw angle is equal to or less than the predetermined value has an effect that it is not used for calculating the integrated yaw angle.

【0033】以下、本発明の実施の形態について、図
1、図2を用いて説明する。 (実施の形態1)図1は本発明の実施の形態1によるナ
ビゲーション装置を示すブロック図である。図1におい
て、加速度センサ1、ジャイロセンサ2、3、移動距離
算出手段4、移動方位算出手段5、相対位置演算手段
6、速度補正手段7、地図記憶部8、表示部9、表示制
御手段10は図3と同様のものなので、同一符号を付
し、説明は省略する。Bは演算、制御の処理を行う中央
制御部、13はジャイロセンサ2の出力データ(ピッチ
角速度データ)を微小時間だけ積算して得られた微小時
間積算ピッチ角を用いて、ジャイロセンサ2の出力値を
速度補正に使用するか否かを決定するピッチ角判定手段
である。
An embodiment of the present invention will be described below with reference to FIGS. (Embodiment 1) FIG. 1 is a block diagram showing a navigation device according to Embodiment 1 of the present invention. 1, an acceleration sensor 1, gyro sensors 2, 3, a moving distance calculating unit 4, a moving direction calculating unit 5, a relative position calculating unit 6, a speed correcting unit 7, a map storage unit 8, a display unit 9, and a display controlling unit 10. Are the same as those in FIG. 3, and thus are denoted by the same reference numerals and description thereof will be omitted. B is a central control unit that performs arithmetic and control processing, and 13 is an output of the gyro sensor 2 using a minute time accumulated pitch angle obtained by accumulating output data (pitch angular velocity data) of the gyro sensor 2 for a minute time. Pitch angle determination means for determining whether to use the value for speed correction.

【0034】以上のように構成されたナビゲーション装
置について、その動作を説明する。まず移動距離算出手
段4は、加速度センサ1の出力データ(加速度データ)
から車両11の速度を求め、この車両速度を積分するこ
とにより車両11の移動距離を算出し、移動方位算出手
段5は、ジャイロセンサ3の出力データ(方位角速度デ
ータ)を入力し、この方位角速度を積分することにより
車両11の方位角を算出する。相対位置演算手段6は、
移動距離算出手段4と移動方位算出手段5から出力され
る車両移動距離と車両方位角から車両11の位置データ
を算出し、表示制御手段10に出力する。このとき、速
度補正手段7は、ジャイロセンサ2の出力値から算出し
た車両11のピッチ角を用いて、加速度センサ1の出力
データを補正する。
The operation of the navigation device configured as described above will be described. First, the moving distance calculating means 4 outputs output data (acceleration data) of the acceleration sensor 1.
, The moving distance of the vehicle 11 is calculated by integrating the vehicle speed, and the moving azimuth calculating means 5 receives the output data (azimuth angular velocity data) of the gyro sensor 3 and inputs the azimuth angular velocity. To calculate the azimuth of the vehicle 11. The relative position calculation means 6
The position data of the vehicle 11 is calculated from the vehicle moving distance and the vehicle azimuth output from the moving distance calculating means 4 and the moving azimuth calculating means 5 and output to the display control means 10. At this time, the speed correction means 7 corrects the output data of the acceleration sensor 1 using the pitch angle of the vehicle 11 calculated from the output value of the gyro sensor 2.

【0035】ジャイロセンサ2の出力には通常ドリフト
成分が含まれているが、従来は、速度成分補正手段7で
そのドリフト成分も積算され、累積された誤差成分を含
んだ車両ピッチ角により加速度センサ1の出力データが
補正されていた。このため、移動距離算出手段4により
算出した車両11の移動距離は実際の車両11の移動距
離とは異なって誤差を含むことになり、また、その誤差
が累積により増大してしまうという問題点を有してい
た。このような誤差を除去するためにピッチ角判定手段
13を設けた。
The output of the gyro sensor 2 usually includes a drift component. Conventionally, however, the drift component is also integrated by the speed component correction means 7 and the acceleration sensor is calculated based on the vehicle pitch angle including the accumulated error component. The output data of No. 1 was corrected. For this reason, the moving distance of the vehicle 11 calculated by the moving distance calculating means 4 includes an error different from the actual moving distance of the vehicle 11, and the error is increased by accumulation. Had. In order to eliminate such an error, a pitch angle determining means 13 is provided.

【0036】次に、ピッチ角判定手段13におけるドリ
フト成分除去のための補正動作について説明する。時間
周期(所定微小時間)Δtにジャイロセンサ2から得ら
れるピッチ角速度の積分値(微小時間積算ピッチ角)を
In、閾値をIxとする。閾値Ixは、補正動作が最適
動作となるように、実験等により求められた値である。
ピッチ角判定手段13は、In>Ixの場合は、車両1
1にピッチ角速度が発生しているとみなし、その旨を速
度補正手段7に通知する。速度補正手段7は、ピッチ角
判定手段13から出力されるピッチ角速度から微小時間
積算ピッチ角を算出し、さらに、いままで算出した走行
時間分の積算ピッチ角に上記微小時間積算ピッチ角を加
えて新たな積算ピッチ角(つまり車両11の算出ピッチ
角)とし、この新たな積算ピッチ角に基づいて、移動距
離算出に使用する車両11の加速度を(数4)を用いて
補正する。また、ピッチ角判定手段13は、In≦Ix
の場合は、ジャイロセンサ2の出力は車両11のピッチ
角速度でなくドリフト成分であるとみなし、その旨を速
度補正手段7に通知する。速度補正手段7は、ピッチ角
判定手段13から出力されるピッチ角速度はゼロである
とみなし、それまでに算出した走行時間分の積算ピッチ
角をそのまま使用し、この積算ピッチ角に基づいて、移
動距離算出に使用する車両11の加速度を(数4)を用
いて補正する。
Next, a correction operation for removing the drift component in the pitch angle determination means 13 will be described. In the time period (predetermined minute time) Δt, the integral value of the pitch angular velocity obtained from the gyro sensor 2 (minute time integrated pitch angle) is In, and the threshold value is Ix. The threshold value Ix is a value obtained by an experiment or the like so that the correction operation becomes the optimum operation.
When In> Ix, the pitch angle determination means 13 determines whether the vehicle 1
It is assumed that a pitch angular velocity has occurred in No. 1 and the fact is notified to the speed correcting means 7. The speed correcting means 7 calculates the minute time integrated pitch angle from the pitch angular velocity output from the pitch angle determining means 13 and further adds the minute time integrated pitch angle to the integrated pitch angle for the travel time calculated so far. A new integrated pitch angle (that is, the calculated pitch angle of the vehicle 11) is set, and based on the new integrated pitch angle, the acceleration of the vehicle 11 used for calculating the moving distance is corrected using (Equation 4). Further, the pitch angle determination means 13 determines that In ≦ Ix
In the case of (1), the output of the gyro sensor 2 is regarded as not a pitch angular velocity of the vehicle 11 but a drift component, and the fact is notified to the speed correcting means 7. The speed correcting means 7 assumes that the pitch angular velocity output from the pitch angle determining means 13 is zero, uses the accumulated pitch angle for the traveling time calculated up to that time as it is, and moves based on the accumulated pitch angle. The acceleration of the vehicle 11 used for calculating the distance is corrected using (Equation 4).

【0037】図2はピッチ角判定手段13の動作を示す
フローチャートである。まず、ジャイロセンサ2から出
力される微小時間のピッチ角速度を積算し、微小時間積
算ピッチ角Inを得る(S1)。次に、微小時間積算ピ
ッチ角Inを閾値Ixとを比較し(S2)、In≧Ix
か否かを判定する(S3)。In≧Ixの場合にはジャ
イロセンサ2の出力データを速度補正に使用し(S
4)、In<Ixの場合にはジャイロセンサ2の出力デ
ータを速度補正に使用しない(S5)。これを走行時間
中、繰り返す(S2〜S5)。
FIG. 2 is a flowchart showing the operation of the pitch angle judging means 13. First, the pitch angular velocity for a very short time output from the gyro sensor 2 is integrated to obtain a minute time integrated pitch angle In (S1). Next, the minute time integration pitch angle In is compared with a threshold value Ix (S2), and In ≧ Ix
It is determined whether or not (S3). When In ≧ Ix, the output data of the gyro sensor 2 is used for speed correction (S
4) If In <Ix, the output data of the gyro sensor 2 is not used for speed correction (S5). This is repeated during the running time (S2 to S5).

【0038】このようにジャイロセンサ2の出力がドリ
フト成分と判定されたときには、速度補正手段7は、ピ
ッチ角速度に基づいて新たな積算ピッチ角を算出するこ
とはせず、それまでに算出した走行時間分の積算ピッチ
角に基づく加速度の補正を行うようにしたので、ジャイ
ロセンサ2にドリフトが発生している場合でもドリフト
成分がピッチ角として積算されることがなく、従って、
ドリフト成分に基づく積算ピッチ角の誤差累積を防止す
ることができ、移動距離算出における誤差増大を防止す
ることができる。また、ジャイロセンサ2の出力がドリ
フト成分とみなされるときには、ジャイロセンサ2の出
力をゼロにするようなバイアスをピッチ角判定手段13
からジャイロセンサ2に印加することにより、ジャイロ
センサ2の出力データの精度を高めることができ、ま
た、速度補正手段7は、ピッチ角判定手段13から通知
を受けることなく、そのままジャイロセンサ2の出力デ
ータを使用することができる。
As described above, when the output of the gyro sensor 2 is determined to be a drift component, the speed correction means 7 does not calculate a new integrated pitch angle based on the pitch angular speed, but the running calculated so far. Since the acceleration is corrected based on the integrated pitch angle for the time, the drift component is not integrated as the pitch angle even when the gyro sensor 2 is drifting.
Accumulation of an error in the integrated pitch angle based on the drift component can be prevented, and an increase in the error in the calculation of the moving distance can be prevented. When the output of the gyro sensor 2 is regarded as a drift component, a bias that makes the output of the gyro sensor 2 zero is set to the pitch angle determination means 13.
, The accuracy of the output data of the gyro sensor 2 can be improved, and the speed correction means 7 outputs the output of the gyro sensor 2 without receiving a notification from the pitch angle determination means 13. Data can be used.

【0039】ジャイロセンサ3についてもジャイロセン
サ2と同様のことが言える。この場合は図1のピッチ角
判定手段13に相当するものとしてヨー角判定手段(図
示せず)をジャイロセンサ3と移動方位算出手段5との
間に配置する。ヨー角判定手段は、微小時間積算ヨー角
が閾値以上か否かを比較し、微小時間積算ヨー角が閾値
以上の場合にはジャイロセンサ3からはヨー角速度が出
力されていると判定し、微小時間積算ヨー角が閾値より
小さい場合にはジャイロセンサ3からはドリフト成分が
出力されていると判定する。ジャイロセンサ3の出力が
ドリフト成分と判定されたときには、移動方位算出手段
5は、ヨー角速度に基づいて新たな積算ヨー角を算出す
ることはせず、それまでに算出した走行時間分の積算ヨ
ー角を使用する。ジャイロセンサ3からはヨー角速度が
出力されていると判定されたときは従来と同様の動作と
なり、新たな積算ヨー角が得られる。
The same can be said for the gyro sensor 3 as for the gyro sensor 2. In this case, a yaw angle determining means (not shown) is disposed between the gyro sensor 3 and the moving direction calculating means 5 as equivalent to the pitch angle determining means 13 in FIG. The yaw angle determining means compares whether or not the minute time integrated yaw angle is equal to or greater than a threshold value, and determines that the yaw angular velocity is output from the gyro sensor 3 when the minute time integrated yaw angle is equal to or greater than the threshold value. If the time integrated yaw angle is smaller than the threshold value, it is determined that the drift component is output from the gyro sensor 3. When the output of the gyro sensor 3 is determined to be a drift component, the moving azimuth calculating means 5 does not calculate a new integrated yaw angle based on the yaw angular velocity, but calculates the integrated yaw for the travel time calculated so far. Use horns. When it is determined that the yaw angular velocity is output from the gyro sensor 3, the operation is the same as the conventional one, and a new integrated yaw angle is obtained.

【0040】このように、ジャイロセンサ3の出力がド
リフト成分と判定されたときには、ヨー角速度に基づい
て新たな積算ヨー角を算出することはせず、それまでに
算出した走行時間分の積算ヨー角を使用するようにした
ので、ジャイロセンサ3にドリフトが発生している場合
でもドリフト成分がヨー角として積算されることがな
く、従って、ドリフト成分に基づく積算ヨー角の誤差累
積を防止することができる。また、ジャイロセンサ3の
出力がドリフト成分とみなされるときには、ジャイロセ
ンサ3の出力をゼロにするようなバイアスをヨー角判定
手段からジャイロセンサ3に印加することにより、ジャ
イロセンサ3の出力データの精度を高めることができ、
また、移動方位算出手段5は、ヨー角判定手段から通知
を受けることなく、そのままジャイロセンサ3の出力デ
ータを使用することができる。
As described above, when the output of the gyro sensor 3 is determined to be a drift component, a new integrated yaw angle is not calculated based on the yaw angular velocity, but the integrated yaw angle for the travel time calculated so far is calculated. Since the angle is used, even when a drift occurs in the gyro sensor 3, the drift component is not integrated as the yaw angle, and therefore, it is possible to prevent the error accumulation of the integrated yaw angle based on the drift component. Can be. When the output of the gyro sensor 3 is regarded as a drift component, a bias that makes the output of the gyro sensor 3 zero is applied to the gyro sensor 3 from the yaw angle determining means, so that the accuracy of the output data of the gyro sensor 3 is improved. Can be increased,
Further, the moving azimuth calculating means 5 can use the output data of the gyro sensor 3 without receiving a notification from the yaw angle determining means.

【0041】なお、本実施の形態では、中央制御部Bの
各手段4〜7、10、13はハードウェア構成として説
明したが、本発明はこれに限らず、各手段4〜7、1
0、13をソフトウェアで構成すること、すなわちCP
Uがプログラムを実行することにより各手段4〜7、1
0、13を実現するようにしてもよい。
In this embodiment, each of the means 4 to 7, 10 and 13 of the central control unit B has been described as a hardware configuration. However, the present invention is not limited to this.
0, 13 by software, ie, CP
U executes the program so that each means 4 to 7, 1
0 and 13 may be realized.

【0042】以上のように本実施の形態によれば、ジャ
イロセンサ2、3の出力がドリフト成分と判定されたと
きには、ピッチ角速度、ヨー角速度に基づいて新たな積
算ピッチ角、積算ヨー角を算出することはせず、それま
でに算出した走行時間分の積算ピッチ角、積算ヨー角を
使用するようにしたので、ジャイロセンサ2、3にドリ
フトが発生している場合でもドリフト成分が積算される
ことがなく、従って、ドリフト成分に基づく積算ピッチ
角、積算ヨー角の誤差累積を防止することができる。ま
た、ジャイロセンサ2、3の出力がドリフト成分とみな
されるときには、ジャイロセンサ2、3の出力をゼロに
するようなバイアスをジャイロセンサ2、3に印加する
ことにより、ジャイロセンサ2、3の出力データの精度
を高めることができ、速度補正手段7、移動方位算出手
段5に通知をする必要がなく、そのままジャイロセンサ
2、3の出力データを使用することができる。
As described above, according to the present embodiment, when the outputs of the gyro sensors 2 and 3 are determined to be drift components, a new integrated pitch angle and a new integrated yaw angle are calculated based on the pitch angular velocity and the yaw angular velocity. Since the integrated pitch angle and the integrated yaw angle for the travel time calculated up to that point are used, the drift components are integrated even when the gyro sensors 2 and 3 have drift. Therefore, it is possible to prevent the error accumulation of the integrated pitch angle and the integrated yaw angle based on the drift component. When the outputs of the gyro sensors 2 and 3 are regarded as drift components, a bias that makes the outputs of the gyro sensors 2 and 3 zero is applied to the gyro sensors 2 and 3 so that the outputs of the gyro sensors 2 and 3 are output. The accuracy of the data can be improved, and there is no need to notify the speed correcting means 7 and the moving direction calculating means 5, and the output data of the gyro sensors 2 and 3 can be used as they are.

【0043】[0043]

【発明の効果】以上のように本発明のナビゲーション装
置によれば、微小時間積算ピッチ角が所定値以下のとき
のピッチ角速度は積算ピッチ角の算出に使用されず、従
って移動距離算出に使用されないようにしたので、ドリ
フト成分が積算ピッチ角の算出に使用されることによる
積算ピッチ角の誤差増大が生じないようにすることがで
き、車両の移動距離を正確に算出することができるとい
う有利な効果が得られる。
As described above, according to the navigation apparatus of the present invention, the pitch angular velocity when the minute time integrated pitch angle is equal to or smaller than the predetermined value is not used for calculating the integrated pitch angle, and therefore is not used for calculating the moving distance. With this configuration, it is possible to prevent the error of the integrated pitch angle from increasing due to the use of the drift component for calculating the integrated pitch angle, and it is possible to calculate the moving distance of the vehicle accurately. The effect is obtained.

【0044】また、ピッチ角速度検出器の出力値の所定
微小時間における積算値である微小時間積算ピッチ角が
所定値以下のときにはピッチ角速度検出器の出力値がゼ
ロとなるようなバイアスをピッチ角速度検出器に印加す
るようにしたので、ピッチ角速度検出器の出力値からド
リフト成分を除去することができ、ピッチ角速度検出器
の出力値をそのまま積算ピッチ角の算出に使用しても積
算ピッチ角の誤差増大が生じないようにすることができ
るという有利な効果が得られる。
When the integrated pitch angle of the minute time, which is the integrated value of the output value of the pitch angular velocity detector during a predetermined minute time, is equal to or smaller than a predetermined value, a bias such that the output value of the pitch angular velocity detector becomes zero is detected. The drift component can be removed from the output value of the pitch angular velocity detector, and the error of the integrated pitch angle can be obtained even if the output value of the pitch angular velocity detector is used as it is for the calculation of the integrated pitch angle. An advantageous effect is obtained that the increase can be prevented.

【0045】さらに、ヨー角速度検出器の出力値の所定
微小時間における積算値である微小時間積算ヨー角が所
定値以下のときにはヨー角速度検出器の出力はドリフト
成分であると判定するようにしたので、微小時間積算ヨ
ー角が所定値以下のときのヨー角速度は積算ヨー角の算
出に使用されないようにすることができ、積算ヨー角の
誤差増大が生じないようにすることができ、従って或る
方向たとえばX、Y平面座標におけるX方向の移動距離
算出の誤差増大が生じないようにすることができる。
Further, the output of the yaw angular velocity detector is determined to be a drift component when the minute time integrated yaw angle which is the integrated value of the output value of the yaw angular velocity detector during a predetermined minute time is equal to or smaller than a predetermined value. The yaw angular velocity when the minute time integrated yaw angle is equal to or less than the predetermined value can be prevented from being used in the calculation of the integrated yaw angle, and the error of the integrated yaw angle can be prevented from increasing. It is possible to prevent an increase in the error in calculating the moving distance in the direction, for example, the X direction in the X, Y plane coordinates.

【0046】さらに、ヨー角速度検出器の出力値の所定
微小時間における積算値である微小時間積算ヨー角が所
定値以下のときにはヨー角速度検出器の出力値がゼロと
なるようなバイアスをヨー角速度検出器に印加するよう
にしたので、ヨー角速度検出器の出力値からドリフト成
分を除去することができ、ヨー角速度検出器の出力値を
そのまま積算ヨー角の算出に使用しても積算ヨー角の誤
差増大が生じないようにすることができるという有利な
効果が得られる。
Further, when the minute time integrated yaw angle, which is the integrated value of the output value of the yaw angular velocity detector during a predetermined minute time, is equal to or smaller than a predetermined value, a bias such that the output value of the yaw angular velocity detector becomes zero is detected. The drift component can be removed from the output value of the yaw angular velocity detector, and even if the output value of the yaw angular velocity detector is used as it is to calculate the integrated yaw angle, the error of the integrated yaw angle An advantageous effect is obtained that the increase can be prevented.

【0047】さらに、ピッチ角速度検出器の出力値の所
定微小時間における積算値である微小時間積算ピッチ角
が所定値以下のときにはピッチ角速度検出器の出力はド
リフト成分であると判定するピッチ角判定手段と、ピッ
チ角速度検出器の出力値の車両走行時間における積算値
である積算ピッチ角に基づいて加速度センサから出力さ
れる加速度を補正するに際し、ピッチ角速度検出器の出
力はドリフト成分であるとピッチ角判定手段で判定され
たときには、積算ピッチ角の算出においてはピッチ角速
度検出器の出力値をゼロとなす移動距離算出手段と、ヨ
ー方向角速度検出器の出力値の所定微小時間における積
算値である微小時間積算ヨー角が所定値以下のときには
ヨー方向角速度検出器の出力はドリフト成分であると判
定するヨー角判定手段と、ヨー方向角速度検出器の出力
値を積算して積算ヨー角を算出するに際し、ヨー角速度
検出器の出力はドリフト成分であるとヨー角判定手段で
判定されたときには、積算ヨー角の算出においてはヨー
角速度検出器の出力値をゼロとなす移動方位算出手段と
を有することにより、ドリフト成分が積算ピッチ角の算
出に使用されることによる積算ピッチ角の誤差増大が生
じないようにすることができ、車両の移動距離を正確に
算出することができると共に、微小時間積算ヨー角が所
定値以下のときのヨー角速度は積算ヨー角の算出に使用
されないようにすることができ、積算ヨー角の誤差増大
が生じないようにすることができ、従って或る方向たと
えばX、Y平面座標におけるX方向の移動距離算出の誤
差増大が生じないようにすることができるという有利な
効果が得られる。
Further, when the minute time integrated pitch angle, which is the integrated value of the output value of the pitch angular velocity detector during a predetermined minute time, is equal to or smaller than a predetermined value, the pitch angle determining means determines that the output of the pitch angular velocity detector is a drift component. And correcting the acceleration output from the acceleration sensor based on the integrated pitch angle, which is the integrated value of the output value of the pitch angular velocity detector during the vehicle travel time, when the output of the pitch angular velocity detector is a drift component When the judgment is made by the judging means, in calculating the integrated pitch angle, a moving distance calculating means for setting the output value of the pitch angular velocity detector to zero, and a minute value which is an integrated value of the output value of the yaw direction angular velocity detector in a predetermined minute time When the time integrated yaw angle is equal to or smaller than a predetermined value, the output of the yaw direction angular velocity detector is determined to be a drift component. In calculating the integrated yaw angle by integrating the output values of the yaw angular velocity detector and the step, when the yaw angle determination means determines that the output of the yaw angular velocity detector is a drift component, the integrated yaw angle is calculated. In the above, the moving azimuth calculating means for setting the output value of the yaw angular velocity detector to zero is provided to prevent an increase in the error of the integrated pitch angle due to the drift component being used for calculating the integrated pitch angle. It is possible to accurately calculate the moving distance of the vehicle, and to prevent the yaw angular velocity when the minute time integrated yaw angle is equal to or less than a predetermined value from being used for calculating the integrated yaw angle. Therefore, it is possible to prevent an increase in the error in the calculation of the moving distance in a certain direction, for example, the X direction in the X, Y plane coordinates. Advantageous effect of wear can be obtained.

【図面の簡単な説明】[Brief description of the drawings]

【図1】本発明の実施の形態1によるナビゲーション装
置を示すブロック図
FIG. 1 is a block diagram showing a navigation device according to a first embodiment of the present invention.

【図2】図1のナビゲーション装置の中央制御部を構成
するピッチ角判定手段の動作を示すフローチャート
FIG. 2 is a flowchart showing an operation of a pitch angle determining means constituting a central control unit of the navigation device in FIG. 1;

【図3】従来のナビゲーション装置を示すブロック図FIG. 3 is a block diagram showing a conventional navigation device.

【図4】ナビゲーション装置の車載概念図FIG. 4 is a conceptual view of a navigation device mounted on a vehicle.

【図5】ナビゲーション装置における位置演算を説明す
るための位置演算概念図
FIG. 5 is a conceptual diagram of position calculation for explaining position calculation in the navigation device.

【符号の説明】[Explanation of symbols]

B 中央制御部 1 加速度センサ 2 ジャイロセンサ(ピッチ角速度検出器) 3 ジャイロセンサ(ヨー角速度検出器、方位角速度検
出器) 4 移動距離算出手段 5 移動方位算出手段 6 相対位置演算手段 7 速度補正手段 8 地図記憶部 9 表示部 10 表示制御手段 13 ピッチ角判定手段
B Central control unit 1 Acceleration sensor 2 Gyro sensor (pitch angular velocity detector) 3 Gyro sensor (yaw angular velocity detector, azimuth angular velocity detector) 4 Moving distance calculating means 5 Moving azimuth calculating means 6 Relative position calculating means 7 Speed correcting means 8 Map storage unit 9 display unit 10 display control means 13 pitch angle determination means

Claims (5)

【特許請求の範囲】[Claims] 【請求項1】ピッチ角速度検出器の出力値の所定微小時
間における積算値である微小時間積算ピッチ角が所定値
以下のときには前記ピッチ角速度検出器の出力はドリフ
ト成分であると判定するピッチ角判定手段と、前記ピッ
チ角速度検出器の出力値の車両走行時間における積算値
である積算ピッチ角に基づいて加速度センサから出力さ
れる加速度を補正するに際し、前記ピッチ角速度検出器
の出力はドリフト成分であると前記ピッチ角判定手段で
判定されたときには、前記積算ピッチ角の算出において
は前記ピッチ角速度検出器の出力値をゼロとなす移動距
離算出手段とを有するナビゲーション装置。
1. A pitch angle judging circuit for judging that an output of the pitch angular velocity detector is a drift component when a minute time integrated pitch angle which is an integrated value of the output value of the pitch angular velocity detector during a predetermined minute time is equal to or smaller than a predetermined value. Means for correcting the acceleration output from the acceleration sensor based on the integrated pitch angle which is the integrated value of the output value of the pitch angular velocity detector during the vehicle travel time, wherein the output of the pitch angular velocity detector is a drift component And a moving distance calculating means for setting the output value of the pitch angular velocity detector to zero in the calculation of the integrated pitch angle when it is determined by the pitch angle determining means.
【請求項2】ピッチ角速度検出器の出力値の所定微小時
間における積算値である微小時間積算ピッチ角が所定値
以下のときには前記ピッチ角速度検出器の出力値がゼロ
となるようなバイアスを前記ピッチ角速度検出器に印加
するピッチ角判定手段と、前記ピッチ角速度検出器の出
力値の車両走行時間における積算値である積算ピッチ角
に基づいて加速度センサから出力される加速度を補正す
る移動距離算出手段とを有するナビゲーション装置。
2. A bias which makes the output value of the pitch angular velocity detector zero when the minute time integrated pitch angle, which is the integrated value of the output value of the pitch angular velocity detector during a predetermined minute time, is equal to or smaller than a predetermined value. Pitch angle determining means to be applied to the angular velocity detector; and moving distance calculating means for correcting acceleration output from the acceleration sensor based on an integrated pitch angle which is an integrated value of an output value of the pitch angular velocity detector during a vehicle traveling time. Navigation device having the same.
【請求項3】ヨー角速度検出器の出力値の所定微小時間
における積算値である微小時間積算ヨー角が所定値以下
のときには前記ヨー角速度検出器の出力はドリフト成分
であると判定するヨー角判定手段と、前記ヨー角速度検
出器の出力値を積算して積算ヨー角を算出するに際し、
前記ヨー角速度検出器の出力はドリフト成分であると前
記ヨー角判定手段で判定されたときには、前記積算ヨー
角の算出においては前記ヨー角速度検出器の出力値をゼ
ロとなす移動方位算出手段とを有するナビゲーション装
置。
3. A yaw angle determination in which the output of the yaw angular velocity detector determines that the output of the yaw angular velocity detector is a drift component when a minute time integrated yaw angle which is an integrated value of the output value of the yaw angular velocity detector during a predetermined minute time is equal to or smaller than a predetermined value. In calculating the integrated yaw angle by integrating the output value of the means and the yaw angular velocity detector,
When the output of the yaw angular velocity detector is determined to be a drift component by the yaw angle determination means, the calculation of the integrated yaw angle includes a movement azimuth calculation means for setting the output value of the yaw angular velocity detector to zero. Navigation device.
【請求項4】ヨー角速度検出器の出力値の所定微小時間
における積算値である微小時間積算ヨー角が所定値以下
のときには前記ヨー角速度検出器の出力値がゼロとなる
ようなバイアスを前記ヨー角速度検出器に印加するヨー
角判定手段と、前記ヨー角速度検出器の出力値の車両走
行時間における積算値である積算ヨー角を算出する移動
方位算出手段とを有するナビゲーション装置。
4. A bias such that the output value of the yaw angular velocity detector becomes zero when the minute time integrated yaw angle, which is the integrated value of the output value of the yaw angular velocity detector during a predetermined minute time, is equal to or smaller than a predetermined value. A navigation device comprising: a yaw angle determining means for applying to an angular velocity detector; and a moving direction calculating means for calculating an integrated yaw angle which is an integrated value of an output value of the yaw angular velocity detector during a vehicle traveling time.
【請求項5】請求項1に記載のピッチ角判定手段および
移動距離算出手段と、請求項3に記載のヨー角判定手段
および移動方位算出手段とを有するナビゲーション装
置。
5. A navigation device comprising: a pitch angle determining means and a moving distance calculating means according to claim 1; and a yaw angle determining means and a moving direction calculating means according to claim 3.
JP31031496A 1996-11-21 1996-11-21 Navigation device Pending JPH10153443A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP31031496A JPH10153443A (en) 1996-11-21 1996-11-21 Navigation device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP31031496A JPH10153443A (en) 1996-11-21 1996-11-21 Navigation device

Publications (1)

Publication Number Publication Date
JPH10153443A true JPH10153443A (en) 1998-06-09

Family

ID=18003741

Family Applications (1)

Application Number Title Priority Date Filing Date
JP31031496A Pending JPH10153443A (en) 1996-11-21 1996-11-21 Navigation device

Country Status (1)

Country Link
JP (1) JPH10153443A (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009210296A (en) * 2008-02-29 2009-09-17 Furuno Electric Co Ltd Satellite navigation/dead-reckoning navigation integrated positioning device
JP2010043945A (en) * 2008-08-12 2010-02-25 Toyota Central R&D Labs Inc Apparatus for estimating vehicle attitude angle and apparatus for estimating sensor drift
JP2012141220A (en) * 2010-12-28 2012-07-26 Pioneer Electronic Corp Installation angle detection device, method, program, and storage medium

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009210296A (en) * 2008-02-29 2009-09-17 Furuno Electric Co Ltd Satellite navigation/dead-reckoning navigation integrated positioning device
US8965690B2 (en) 2008-02-29 2015-02-24 Furuno Electrics Co., Ltd. Satellite navigation/dead-reckoning navigation integrated positioning device
JP2010043945A (en) * 2008-08-12 2010-02-25 Toyota Central R&D Labs Inc Apparatus for estimating vehicle attitude angle and apparatus for estimating sensor drift
JP2012141220A (en) * 2010-12-28 2012-07-26 Pioneer Electronic Corp Installation angle detection device, method, program, and storage medium

Similar Documents

Publication Publication Date Title
US8548723B2 (en) Car navigation system
JPH102746A (en) Navigator
JPH0291513A (en) Method and device for correcting zero point of gyro
JP2009023485A (en) Inclination angle detection device of motorcycle
JPH11326361A (en) Detecting apparatus for yaw rate, roll rate and transverse acceleration of car body
JP2004138553A (en) Device, method, program, and record medium for detecting position of moving object
JPH08327378A (en) Vehicle position calculating device
JPH10153443A (en) Navigation device
JP3791074B2 (en) Navigation device
JP2002174531A (en) Moving bearing calculator, moving bearing calculation method and recording medium having recorded moving bearing calculation program
JPH102747A (en) Navigator
JP2011055342A (en) Imaging apparatus for vehicle
JPH0996533A (en) Device for calculating traveling body advancing acceleration, and device for calculating traveling body position and speed using that device
JP3975416B2 (en) Navigation device, sensor output calibration method, and navigation processing program
JP3551663B2 (en) Navigation device
JP6632727B2 (en) Angle measuring device
JP2020134460A (en) Gyro sensor correction system, gyro sensor correction method and processing device
JP2004294244A (en) Adding device of velocity polarity of moving body
KR102200521B1 (en) Estimation device of lateral slip for vehicle
JP3487134B2 (en) Vehicle lateral acceleration calculation device
JP2009264798A (en) Speed detecting apparatus and inclined angle calculating apparatus
JP6187310B2 (en) Inverted moving body
JPH0850024A (en) Navigation device for vehicle
JP2011252760A (en) Yaw rate detection device
JPH0921650A (en) State detector for moving body

Legal Events

Date Code Title Description
A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20040106