JP2000028632A - ヨーレートセンサの補正装置 - Google Patents

Abstract

(57)【要約】 【課題】 走行路に沿って配置された複数の位置情報発
生源からの情報を利用してヨーレートセンサの誤差の補
正を行えるようにする。 【解決手段】 車線の中央に沿って磁気ネイルＮ…を埋
設した道路の直線部分にヨーレートセンサ補正区間を設
定し、その入口部および出口部の各４個の補正区間設定
用磁気ネイルに隣接して第１補正用磁気ネイルＮａおよ
び第２補正用磁気ネイルＮｂを配置する。第１、第２補
正用磁気ネイルＮａ，Ｎｂが道路の直線部分に位置して
いるため、車両が車線に沿って正しく走行していれば、
そこを通過する車両に発生する基準ヨーレートはゼロに
なる。従って、車両が第１、第２補正用磁気ネイルＮ
ａ，Ｎｂ間を走行する間にヨーレートセンサで検出した
実ヨーレートの平均値がゼロに一致していなければ、そ
の偏差分をヨーレートセンサの出力から減算して較正を
行うことにより、ヨーレートセンサの誤差を補正するこ
とができる。

Description

【発明の詳細な説明】

【０００１】

【発明の属する技術分野】本発明は、走行路に沿って配
置された複数の位置情報発生源からの情報に基づいて車
両に搭載されたヨーレートセンサの誤差を補正するヨー
レートセンサの補正装置に関する。

【０００２】

【従来の技術】道路の車線の中央に沿って位置情報発生
源としての磁気ネイルを所定間隔（例えば、２ｍ間隔）
で埋め込み、車両に搭載した磁気センサで前記磁気ネイ
ルを検出することにより、車両の位置、走行距離、車
速、ヨー方向の姿勢等を検出するものが知られている。

【０００３】また慣性航法式のナビゲーションシステム
ではヨーレートおよび車速に基づいて自車位置の検出を
行うため、そのヨーレートを検出するためのヨーレート
センサが車両に搭載される。

【０００４】

【発明が解決しようとする課題】前記ナビゲーションシ
ステムにおいて自車位置を正確に検出するにはヨーレー
トセンサの精度を確保することが不可欠であり、そのた
めにはヨーレートセンサの誤差を補正（較正）する必要
があるが、ヨーレートセンサを一旦較正しても温度変化
や径年変化により誤差が再発することが避けられない。
しかしながら、ヨーレートセンサの較正を短いインター
バルで繰り返し行うことは手間およびコストの面で困難
である。

【０００５】本発明は前述の事情に鑑みてなされたもの
で、走行路に沿って配置された複数の位置情報発生源か
らの情報を利用してヨーレートセンサの誤差の補正を行
えるようにすることを目的とする。

【０００６】

【課題を解決するための手段】上記目的を達成するため
に、請求項１に記載された発明は、走行路に沿って配置
された複数の位置情報発生源からの情報に基づいて車両
に搭載されたヨーレートセンサの誤差を補正するヨーレ
ートセンサの補正装置であって、前記複数の位置情報発
生源のうちの少なくとも２つの位置情報発生源の相対的
な位置関係を予め記憶する記憶手段と、前記相対的な位
置関係に基づいて前記少なくとも２つの位置情報発生源
間を走行する車両に発生すべき基準ヨーレートを算出す
るヨーレート算出手段と、ヨーレート算出手段で算出し
た基準ヨーレートをヨーレートセンサで検出した実ヨー
レートと比較する比較手段と、比較手段による比較結果
に基づいてヨーレートセンサの検出誤差を補正するヨー
レートセンサの補正手段とを備えたことを特徴とする。

【０００７】上記構成によれば、走行路に沿って配置さ
れた複数の位置情報発生源のうちの少なくとも２つの位
置情報発生源の相対的な位置関係を予め記憶しておくこ
とにより、それら位置情報発生源間を車両が走行する際
に発生すべき基準ヨーレートがヨーレート算出手段によ
り算出される。従って、前記少なくとも２つの位置情報
発生源間を車両が走行する際にヨーレートセンサにより
実際に検出された実ヨーレートを、前記ヨーレート算出
手段により算出された基準ヨーレートと比較することに
より、ヨーレートセンサを較正して誤差を補正すること
ができる。前記位置情報発生源は、車両の位置検出用と
して予め設けられているものが利用可能であるため、ヨ
ーレートセンサの誤差補正用として特別に設ける必要が
ない。しかも走行路に位置情報発生源が設けられている
領域があれば、何時でもヨーレートセンサの誤差補正を
行うことができる。

【０００８】また請求項２に記載された発明は、請求項
１の構成に加えて、記憶手段は、前記少なくとも２つの
位置情報発生源が直線路上に存在することを記憶するこ
と特徴とする。

【０００９】上記構成によれば、ヨーレートセンサの誤
差補正用の少なくとも２つの位置情報発生源が直線路上
に存在するので、ヨーレート算出手段により算出される
基準ヨーレートはゼロになる。従って、そのときヨーレ
ートセンサで検出された実ヨーレートをゼロに較正すれ
ば、該ヨーレートセンサの検出誤差を容易且つ正確に補
正することができる。

【００１０】また請求項３に記載された発明は、請求項
１または２の構成に加えて、ヨーレートセンサの補正開
始時あるいは補正終了時は、所定個数の位置情報発生源
あるいは所定時間内の位置情報発生源の情報を較正用に
使用しないこと特徴とする。

【００１１】上記構成によれば、ヨーレートセンサの補
正開始時あるいは補正終了時の所定区間にはヨーレート
センサの誤差補正用の位置情報発生源が存在しないの
で、補正開始時や補正終了時に車両が車線変更を行って
も、少なくとも前記誤差補正用の位置情報発生源間では
車両が車線に沿って走行することが保証され、ヨーレー
トセンサの誤差補正を精密に行うことができる。

【００１２】尚、前記所定個数は実施例では４個に設定
され、前記所定時間は実施例では１秒に設定されている
が、誤差補正用の位置情報発生源間で車両が車線に沿っ
て走行していることが保証される限り、前記値は適宜変
更することができる。

【００１３】

【発明の実施の形態】以下、本発明の実施の形態を、添
付図面に示した本発明の実施例に基づいて説明する。

【００１４】図１〜図６は本発明の実施例を示すもの
で、図１は車両の全体構成図、図２は磁気ネイルおよび
磁気センサの説明図、図３は制御系のブロック図、図４
はヨーレート補正装置のブロック図、図５はヨーレート
センサ補正区間を道路の直線部分に設けた実施例の説明
図、図６はヨーレートセンサ補正区間を道路の曲線部分
に設けた実施例の説明図である。

【００１５】本実施例は、車線の中央に沿って所定間隔
（例えば、２ｍ間隔）で位置情報発生源としての磁気ネ
イルＮ…が埋め込まれた自動走行用道路上を自動走行す
る車両を対象とするものである。

【００１６】図１には、前走車Ｖ′および自車Ｖの全体
構成が示される。前走車Ｖ′の構成および自車Ｖの構成
は実質的に同一であるため、以下自車Ｖを例にとって説
明を行う。

【００１７】自車Ｖは通信信号処理手段１と、制御計画
処理手段２と、操舵制御手段３と、車速制御手段４と
を、それぞれに信号処理装置（ＣＰＵ）を搭載したモジ
ュールとして有している。

【００１８】通信信号処理手段１は、自車Ｖと前走車
Ｖ′との間の車車間通信と、道路に沿って設けられた漏
洩同軸ケーブルＣとの間の送受信と、道路データ上の自
車位置の算出とを行うものである。尚、道路データは地
図上の磁気ネイル列（走行ライン）のデータからなり、
これは予め記憶装置に記憶してもよいし、通信で外部か
ら所定走行区域ごとに受信してもよい。

【００１９】制御計画処理手段２は、自動走行スタート
スイッチ１２の操作により自動走行のための情報を作成
する。具体的には、漏洩同軸ケーブルＣから受信した速
度指令に基づき、磁気ネイル列に沿った車速計画を作成
し、自車Ｖ直下の磁気ネイルＮ…に対する現在位置偏差
（誤差）と、方向偏差（誤差）と、所定時間であるＴ秒
後の予想到達点の磁気ネイルＮ…に対する位置偏差（誤
差）および方向偏差（誤差）とを算出する。この算出結
果は、自車Ｖの操舵制御に利用されるとともに、自車Ｖ
の加減速度の修正に利用される。本実施例では所定時間
を１．５秒に設定しているが、１秒〜２秒の間で設定す
ることが好ましい。尚、前走車Ｖ′に追従する追従車で
は自車ＶのＴ秒後の予想到達点と、前走車Ｖ′のＴ秒後
の予想到達点の車間距離および車間速度差も算出し、こ
の算出結果は自車Ｖの加減速度の修正に利用される。

【００２０】更に、制御計画処理手段２は、追従車の場
合は自車Ｖの速度および前走車の速度、前走車までの車
間距離、前方道路形状や車線形状等のデータをディスプ
レイ１８およびスピーカ１７に出力する。また前走車の
場合は自車Ｖの速度および追従車の速度、追従車までの
車間距離、前方道路形状や車線形状等のデータをディス
プレイ１８およびスピーカ１７に出力する。

【００２１】操舵制御手段３は、制御計画処理手段２の
出力結果に基づいて、操舵角の指示信号を算出し、ステ
アリング操作伝達系に設けられたアクチュエータ１４を
制御する。このアクチュエータ１４により、ステアリン
グが自動制御され磁気ネイル列に沿った走行が行われ
る。

【００２２】車速制御手段４は、制御計画処理手段２の
車速計画および後述するセンサ信号に基づいて加速度指
示信号を算出し、スロットルに設けられたアクチュエー
タ１５とブレーキに設けられたアクチュエータ１６とを
制御する。これら両アクチュエータ１５，１６により、
スロットルおよびブレーキが駆動されて自車Ｖの加減速
が行われる。車速制御手段４にはブレーキペダルスイッ
チ１３が接続されており、このブレーキペダル１３が踏
まれたことが検出されると車速制御は解除される。

【００２３】また、自車Ｖには、ヨーレートセンサ５
と、道路表面に埋め込まれた磁気ネイルＮ…を検出する
磁気センサ６と、車輪パルスセンサ８と、前後加速度セ
ンサ９と、レーザレーダ１０と、漏洩同軸ケーブルＣと
の送受信を行う通信手段７と、車車間通信手段１１とが
搭載されている。

【００２４】前述の漏洩同軸ケーブルＣからは、速度指
令情報、道路曲率情報、渋滞情報および緊急メッセージ
等が受信され、自車Ｖ側からは自車ＶのＩＤナンバーが
送信される。このＩＤナンバーにより、漏洩同軸ケーブ
ルＣ側では各車両の走行位置が把握される。

【００２５】車車間通信では、走行距離、車速および前
後加速度データ（制御計画データ）が送受信される。追
従車の場合、この車車間通信により前走車の位置および
走行状況（速度や加速度）が検出され、追従制御の修正
データ作成に利用される。

【００２６】ヨーレートセンサ５は、車両の横方向の角
速度を検出し、この検出信号を通信信号処理手段１、制
御計画処理手段２および操舵制御手段３に出力する。

【００２７】磁気検出手段としての磁気センサ６は、車
両の前方バンパ下部および後方バンパ下部に設けられ、
道路の車線に２ｍ間隔で設けられた磁気ネイルＮ…に対
するセンサ位置（車両位置）を、この磁気ネイルＮ…の
中心から左右約４５cmの範囲で測定するものである。本
実施例では、図２に示すように、車両の前方バンパ下部
および後方バンパ下部に磁気センサ６が設けられてお
り、これら磁気センサ６で検出された横方向位置データ
により、磁気ネイル列と自車Ｖとのなす角度（誤差角
度）も検出している。また磁気センサ６の出力をカウン
トすることにより車両の走行距離Ｄが検出され、また単
位時間当たりの磁気センサ６の出力をカウントすること
により、あるいは走行距離Ｄを時間微分することにより
車速が検出される。

【００２８】車輪パルスセンサ８は車両の走行距離Ｄお
よび車速の検出に用いられる。磁気センサ６による走行
距離Ｄおよび車速の検出だけでは、例えば車両が走行予
定レーンから大きく逸脱したような場合に磁気検出がで
きないことが想定され、このような場合に車輪パルスセ
ンサ８が用いられる。尚、車輪パルスセンサ８により検
出した走行距離Ｄおよび車速は、例えば車輪の空気圧の
大小による直径の変化に起因して検出誤差が発生するの
が避けられないため、その検出値が磁気センサ６の出力
を用いて補正される。その詳細は後から説明する。

【００２９】前後加速度センサ９は車両の前後加速度の
検出に用いられる。車両の前後加速度は磁気センサ６の
出力信号からも得られるが、前述と同様に、例えば車両
が走行予定レーンから大きく逸脱して磁気検出ができな
い場合の前後加速度の検出に用いられる。

【００３０】レーザレーダ１０は、前走車Ｖ′や前方障
害物の検出を検出するとともに、それらの物体までの距
離を算出して車速制御手段４に出力する。この出力に基
づいて、車速制御手段４により状況に応じてブレーキ量
の制御が行われる。前走車Ｖ′の位置は車車間情報によ
って得られるが、このレーザレーダ１０の搭載により前
走車Ｖ′の検出および車間距離の算出を一層確実に行う
ことができる。

【００３１】図４に示すように、ヨーレートセンサ５お
よび磁気ネイルセンサ６からの信号が入力される通信信
号処理手段１に設けられたヨーレートセンサ補正装置
は、記憶手段Ｍ１、ヨーレート算出手段Ｍ２、比較手段
Ｍ３および補正手段Ｍ４から構成される。

【００３２】次に、本発明の実施例の作用を、図３のブ
ロック線図を参照して説明する。

【００３３】先ず、自車Ｖの目標加速度が以下のように
して算出される。即ち、制御計画処理手段２により、磁
気センサ６による検出信号に基づいた自車位置Ｘ
_i （０）２１と、自車速度（自車位置の一階微分値）Ｖ
_i （０）２２と、自車加速度（自車位置の二階微分値）
Ａ_i （０）２３とが算出され、自車ＶのＴ秒後の状態を
予測する車速制御手段４の第１処理部２４に出力され
る。

【００３４】この第１処理部２４では、Ｔ秒後の予測位
置Ｘ_i （Ｔ）と、Ｔ秒後の予測速度Ｖ_i （Ｔ）とを、次
式により算出する。

【００３５】Ｘ_i （Ｔ）＝Ｘ_i （０）＋Ｖ_i （０）×Ｔ
＋１／２×Ａ_i （０）×Ｔ² Ｖ_i （Ｔ）＝Ｖ_i （０）＋Ａ_i （０）×Ｔ 一方、制御計画処理手段２の制御計画処理部２５は、漏
洩同軸ケーブルＣからの速度指令に基づき、磁気ネイル
列に沿った車速計画を作成し、Ｔ秒後の目標位置Ｘ_i ′
（Ｔ）および目標速度Ｖ_i ′（Ｔ）と共に出力する。

【００３６】偏差算出手段５０では、制御計画処理部２
５で算出した目標位置Ｘ_i ′（Ｔ）および目標速度
Ｖ_i ′（Ｔ）から、前記距離Ｘ_i （Ｔ）および速度Ｖ_i
（Ｔ）を減算することにより、位置誤差および速度誤差
をそれぞれ算出する。

【００３７】この位置誤差および速度誤差は、制御計画
データ変換部２６で加速度制御ゲインＫｘ，Ｋｕを乗算
された後に加算され、目標加速度として比較部２７に出
力される。即ち、目標加速度は次式で与えられる。

【００３８】目標加速度＝Ｋｘ×｛Ｘ_i ′（Ｔ）−Ｘ_i
（Ｔ）｝＋Ｋｕ×｛Ｖ_i ′（Ｔ）−Ｖ_i （Ｔ）｝ 一方、車車間通信による前走車Ｖ′の位置データＸ_i-1
（０）２８、速度データ（前走車位置の微分値）Ｖ_i-1
（０）２９および加速度データ（前走車位置の二階微分
値）Ａ_i-1 （０）３０は、前走車Ｖ′のＴ秒後の状態を
予測する第２処理部３１へ出力される。

【００３９】第２処理部３１では、前述の第１処理部２
４と同様の計算により、Ｔ秒後における前走車Ｖ′の予
測位置Ｘ_i-1 （Ｔ）およびＴ秒後の予測速度Ｖ
_i-1 （Ｔ）を算出する。偏差算出手段４０は、この前走
車Ｖ′のＴ秒後の予測位置Ｘ_i-1 （Ｔ）および予測速度
Ｖ_i-1 （Ｔ）から、自車ＶのＴ秒後の予測位置Ｘ
_i （Ｔ）および予測速度Ｖ_i （Ｔ）を減算することによ
り、距離偏差としての車間距離および速度偏差としての
車間速度を算出する。

【００４０】尚、自車速度Ｖ_i （０）２２に応じて車間
距離の修正を行うべく、目標車間距離調整手段３２が設
けられている。これは、走行初期間や走行終了期間に速
度を調整するために用られるものであり、車間距離を速
度の比例値に設定した場合、低速時の接近し過ぎに対し
補正するものである。車間距離の設定方法によっては、
この目標車間距離調整手段３２は不要となる。

【００４１】算出された車間距離および車間速度は、変
換部３３においてそれぞれ加速度制御ゲインＫｘ₁ ，Ｋ
ｕ₁ を乗算された後に加算され、次式のように目標加速
度が算出される。

【００４２】目標加速度＝Ｋｘ₁ ×｛Ｘ_i-1 （Ｔ）−Ｘ
_i （Ｔ）｝＋Ｋｕ₁ ×｛Ｖ_i-1 （Ｔ）−Ｖ_i （Ｔ）｝ この目標加速度は比較部２７に出力される。比較部２７
では、前述の自車ＶのＴ秒後の予測偏差に基づく目標加
速度と、前述の前走車Ｖ′との車間距離および車間速度
に基づく目標加速度とを比較し、より大きな修正が必要
な方を選択し、スロットル側積分器４１およびブレーキ
側積分器４２に修正データとして出力する。この修正デ
ータの積分値がスロットル制御量換算手段３４およびブ
レーキ制御量換算手段３５に出力され、スロットル制御
部３６およびブレーキ制御部３７はスロットルのアクチ
ュエータ１５およびブレーキのアクチュエータ１６にそ
れぞれ指示デューティを出力してフィードフォワード制
御を行う。

【００４３】比較部２７では、例えば前走車Ｖ′側では
変換手段２６側の修正データを出力し、自車（追従車）
Ｖ側では変換手段３３側の修正データを出力するように
してもよい。

【００４４】操舵制御手段３（図１参照）では、磁気ネ
イルＮ…からの車両位置の変位量と、漏洩同軸ケーブル
Ｃからの現在位置受信曲率信号による走行予定ラインの
接線に対する車両進行方向変位角とを算出するととも
に、前述の経路データの前方道路形状（道路曲率）デー
タにより算出した所定距離先の目標点および予想到達点
間の位置誤差と、走行予定ラインからの車両進行方向変
位角とを算出し、それらに基づいて自車Ｖを磁気ネイル
列（走行ライン）に沿って走行させるべくステアリング
装置のアクチュエータ１４を駆動する。

【００４５】次に、ヨーレートセンサ補正装置の作用に
ついて説明する。

【００４６】図５に示すように、車線の中央に沿って磁
気ネイルＮ…が埋設された道路の直線部分に、長さ５０
ｍのヨーレートセンサ補正区間が設定される。ヨーレー
トセンサ補正区間の入口部および出口部に補正区間設定
用磁気ネイルが配置される。入口部の４個の補正区間設
定用磁気ネイルＮ₁ ，Ｎ₂ ，Ｎ₃ ，Ｎ₄ と、出口部の４
個の補正区間設定用磁気ネイルＮ₅ ，Ｎ₆ ，Ｎ₇ ，Ｎ₈
とは、そのＮ極およびＳ極が所定のパターン（例えば、
Ｓ−Ｎ−Ｓ−Ｓ）で配置される。前記入口部の最後の補
正区間設定用磁気ネイルＮ₄ の１つ前方の磁気ネイルが
第１ヨーレート補正用磁気ネイルＮａとされ、前記出口
部の最初の補正区間設定用磁気ネイルＮ ₅ の１つ後方の
磁気ネイルが第２ヨーレート補正用磁気ネイルＮｂとさ
れる。

【００４７】記憶手段Ｍ１は、磁気センサ６で検出した
磁気ネイルＮ…の情報から、ヨーレートセンサ補正区間
の入口部および出口部を特定するとともに、第１ヨーレ
ート補正用磁気ネイルＮａおよび第２ヨーレート補正用
磁気ネイルＮｂを特定する。第１、第２ヨーレート補正
用磁気ネイルＮａ，Ｎｂの相対的な位置関係は記憶手段
Ｍ１に予め記憶されている。本実施例では、第１、第２
ヨーレート補正用磁気ネイルＮａ，Ｎｂが道路の直線部
分に設置されていることが記憶されている。

【００４８】車両が破線で示す移動軌跡で入口部の途中
位置（例えば、４個の補正区間設定用磁気ネイルのうち
の３番目の磁気ネイルＮ₃ の位置）から車線に進入した
場合、あるいは出口部の途中位置（例えば、４個の補正
区間設定用磁気ネイルのうちの２番目の磁気ネイルＮ₆
の位置）から車線を離脱した場合には、前記ヨーレート
センサ補正区間におけるヨーレートセンサ５の誤差補正
は実行されない。換言すると、車両が入口部の４個の補
正区間設定用磁気ネイルＮ₁ ，Ｎ₂ ，Ｎ₃ ，Ｎ ₄ および
出口部の４個の補正区間設定用磁気ネイルＮ₅ ，Ｎ₆ ，
Ｎ₇ ，Ｎ₈ を確実に検出した場合に限り、ヨーレートセ
ンサ５の誤差補正が実行される。なぜならば、車両が入
口部あるいは出口部の途中位置で車線に進入あるいは車
線を離脱した場合には、第１、第２ヨーレート補正用磁
気ネイルＮａ，Ｎｂの位置で車両が正しく車線に沿って
走行していることが保証されず、その状態でヨーレート
センサ５の誤差補正を実行しても精度の高い補正が不可
能なためである。

【００４９】ヨーレート算出手段Ｍ２は、予め記憶され
た第１、第２ヨーレート補正用磁気ネイルＮａ，Ｎｂの
相対的位置関係に基づいて車両に発生すべき基準ヨーレ
ートを算出する。本実施例では第１、第２ヨーレート補
正用磁気ネイルＮａ，Ｎｂが道路の直線部分に位置して
いるため、車両が車線に沿って正しく走行していれば発
生する基準ヨーレートはゼロになる。

【００５０】比較手段Ｍ３は、ヨーレート算出手段Ｍ２
で算出した基準ヨーレート（＝０）と、車両が第１、第
２ヨーレート補正用磁気ネイルＮａ，Ｎｂ間を走行する
間にヨーレートセンサ５で検出した実ヨーレートの平均
値とを比較し、その結果ヨーレートセンサ５に検出誤差
が存在すれば、補正手段Ｍ４がヨーレートセンサ５の出
力を補正する。具体的には、ヨーレートセンサ５が正し
い実ヨーレートを検出していれば、その実ヨーレートの
平均値はゼロになる筈であるが、実ヨーレートの平均値
がゼロでなければ誤差分をヨーレートセンサ５の出力か
ら減算して較正を行うことにより、ヨーレートセンサ５
の誤差を補正することができる。

【００５１】上記実施例では、道路の直線部分にヨーレ
ートセンサ補正区間を設定しているが、そのヨーレート
センサ補正区間を道路の曲線部分に設定することも可能
である。

【００５２】図６は道路の曲線部分にヨーレートセンサ
補正区間を設定した実施例を示すものである。この場
合、記憶手段Ｍ１には第１、第２ヨーレート補正用磁気
ネイルＮａ，Ｎｂ間の道路（車両）の方位角偏差θが予
め記憶されている。従って、ヨーレート算出手段Ｍ２
は、車両が第１、第２ヨーレート補正用磁気ネイルＮ
ａ，Ｎｂ間を通過するのに要した時間で前記方位角偏差
θを除算することにより、基準ヨーレートを算出するこ
とができる。

【００５３】而して、比較手段Ｍ３により、ヨーレート
算出手段Ｍ２で算出した基準ヨーレートと、車両が第
１、第２ヨーレート補正用磁気ネイルＮａ，Ｎｂ間を走
行する間にヨーレートセンサ５で検出した実ヨーレート
の平均値とを比較し、その結果実ヨーレートの平均値が
基準ヨーレートに一致せずに偏差が存在すれば、補正手
段Ｍ４が前記偏差をゼロにするようにヨーレートセンサ
５の出力を補正する。

【００５４】この実施例によれば、ヨーレートセンサ補
正区間を道路の直線部以外の任意の区間に設定すること
ができる。但し、ヨーレートセンサ補正区間を道路の直
線部に設定する図５の実施例によれば、ヨーレート算出
手段Ｍ２により算出されるヨーレートが常にゼロになる
ため、演算を容易化するとができ且つ補正の精度を高め
ることができる。

【００５５】以上、本発明の実施例を詳述したが、本発
明はその要旨を逸脱しない範囲で種々の設計変更を行う
ことが可能である。

【００５６】例えば、実施例ではヨーレートセンサ補正
区間の入口部および出口部の各４個の補正区間設定用磁
気ネイルＮ₁ ，Ｎ₂ ，Ｎ₃ ，Ｎ₄ ；Ｎ₅ ，Ｎ₆ ，Ｎ₇ ，
Ｎ₈をヨーレートの誤差補正用の磁気ネイルＮａ，Ｎｂ
として使用していないが、前記入口部および出口部の区
間を車両が走行する時間（例えば、１秒）で規定し、そ
の時間内に車両が通過する磁気ネイルをヨーレートの誤
差補正用の磁気ネイルＮａ，Ｎｂとして使用していない
ようにすることも可能である。

【００５７】

【発明の効果】以上のように請求項１に記載された発明
によれば、走行路に沿って配置された複数の位置情報発
生源のうちの少なくとも２つの位置情報発生源の相対的
な位置関係を予め記憶しておくことにより、それら位置
情報発生源間を車両が走行する際に発生すべき基準ヨー
レートがヨーレート算出手段により算出される。従っ
て、前記少なくとも２つの位置情報発生源間を車両が走
行する際にヨーレートセンサにより実際に検出された実
ヨーレートを、前記ヨーレート算出手段により算出され
た基準ヨーレートと比較することにより、ヨーレートセ
ンサを較正して誤差を補正することができる。前記位置
情報発生源は、車両の位置検出用として予め設けられて
いるものが利用可能であるため、ヨーレートセンサの誤
差補正用として特別に設ける必要がない。しかも走行路
に位置情報発生源が設けられている領域があれば、何時
でもヨーレートセンサの誤差補正を行うことができる。

【００５８】また請求項２に記載された発明によれば、
ヨーレートセンサの誤差補正用の少なくとも２つの位置
情報発生源が直線路上に存在するので、ヨーレート算出
手段により算出される基準ヨーレートはゼロになる。従
って、そのときヨーレートセンサで検出された実ヨーレ
ートをゼロに較正すれば、該ヨーレートセンサの検出誤
差を容易且つ正確に補正することができる。

【００５９】また請求項３に記載された発明によれば、
ヨーレートセンサの補正開始時あるいは補正終了時の所
定区間にはヨーレートセンサの誤差補正用の位置情報発
生源が存在しないので、補正開始時や補正終了時に車両
が車線変更を行っても、少なくとも前記誤差補正用の位
置情報発生源間では車両が車線に沿って走行することが
保証され、ヨーレートセンサの誤差補正を精密に行うこ
とができる。

【図面の簡単な説明】

【図１】車両の全体構成図

【図２】磁気ネイルおよび磁気センサの説明図

【図３】制御系のブロック図

【図４】ヨーレート補正装置のブロック図

【図５】ヨーレートセンサ補正区間を道路の直線部分に
設けた実施例の説明図

【図６】ヨーレートセンサ補正区間を道路の曲線部分に
設けた実施例の説明図

【符号の説明】

Ｍ１ 記憶手段 Ｍ２ ヨーレート算出手段 Ｍ３ 比較手段 Ｍ４ 補正手段 Ｎ 磁気ネイル（位置情報発生源） ５ ヨーレートセンサ

Claims (3)

【特許請求の範囲】
1. 【請求項１】 走行路に沿って配置された複数の位置情
   報発生源（Ｎ）からの情報に基づいて車両に搭載された
   ヨーレートセンサ（５）の誤差を補正するヨーレートセ
   ンサの補正装置であって、 前記複数の位置情報発生源（Ｎ）のうちの少なくとも２
   つの位置情報発生源（Ｎ）の相対的な位置関係を予め記
   憶する記憶手段（Ｍ１）と、 前記相対的な位置関係に基づいて前記少なくとも２つの
   位置情報発生源（Ｎ）間を走行する車両に発生すべき基
   準ヨーレートを算出するヨーレート算出手段（Ｍ２）
   と、 ヨーレート算出手段（Ｍ２）で算出した基準ヨーレート
   をヨーレートセンサ（５）で検出した実ヨーレートと比
   較する比較手段（Ｍ３）と、 比較手段（Ｍ３）による比較結果に基づいてヨーレート
   センサ（５）の検出誤差を補正する補正手段（Ｍ４）
   と、を備えたことを特徴とするヨーレートセンサの補正
   装置。
2. 【請求項２】 記憶手段（Ｍ１）は、前記少なくとも２
   つの位置情報発生源（Ｎ）が直線路上に存在することを
   記憶すること特徴とする、請求項１に記載のヨーレート
   センサの補正装置。
3. 【請求項３】 ヨーレートセンサ（５）の補正開始時あ
   るいは補正終了時は、所定個数の位置情報発生源（Ｎ）
   あるいは所定時間内の位置情報発生源（Ｎ）の情報を補
   正用に使用しないこと特徴とする、請求項１または２に
   記載のヨーレートセンサの補正装置。