JP6322023B2 - 計測装置、及びそれを用いた故障診断装置 - Google Patents

Description

本発明は、物理量を直接計測する物理量計測手段と、この物理量を推定する物理量推定手段とを有し、物理量計測手段で計測した第１物理量と物理量推定手段で推定した第２物理量とに基づいて第１物理量を較正した較正物理量を求める計測装置、及びそれを用いた故障診断装置に関する。

従来、車両に搭載されているヨーレートセンサ等の計測装置から出力される計測値は、熱害等の影響を受けて誤差が生じやすく、そのため、出力される計測値を中立較正（ゼロ点較正）する技術が種々提案されている。例えば、特許文献１（特許第５３１４６４９号公報）には、基準となる計測装置で計測した値と、この計測装置とは別の計測装置で計測した値とを比較し、移動平均により定常的にずれている成分をオフセット成分として中立較正する技術が開示されている。

又、例えば特許文献２（特開２０１１−１６９７２８号公報）には、ヨーレートセンサの中立較正を行うに際し、カメラで撮影した画像に基づいて認識した車線からヨーレートを推定し、この推定値に基づいてヨーレートを較正する技術が開示されている。

更に、特許文献３（特許第３６３７８０１号公報）や特許文献４（特許第４４３２８８５号公報）には、操舵角センサで検出した操舵角信号に基づいてヨーレートを推定し、この推定したヨーレートに基づいてヨーレートセンサの故障検出を行う技術が開示されている。

特許第５３１４６４９号 特開２０１１−１６９７２８号公報 特許第３６３７８０１号公報 特許第４４３２８８５号公報

ところで、路面横断勾配（カント）を有する走行路や横風を受けた状態での走行で直進走行しようとする場合、運転者はハンドルを切った状態で走行させる。このような状況で、特許文献１に開示されているように、操舵角に基づいてヨーレートセンサの中立較正を行った場合、上述した路面横断勾配や横風が横力外乱として作用するため誤差が大きくなり、ヨーレートセンサ等の計測装置の中立較正精度が低下してしまう不都合がある。

又、操舵角から推定されるヨーレートは実際の車両ヨーレートに対して位相特性が異なるため、位相特性の誤差分を除外するため定常状態に限定する方策や、位相合わせ処理を行う方策が必要となる。この場合、補正頻度が低下したり、位相合わせ自体の誤差により精度良い推定・補正が困難となる。

この点、特許文献２に開示されているように、カメラで撮影した画像に基づいて車線を検出し、検出した車線に基づいてヨーレートを推定する技術では、路面横断勾配や横風の影響を受け難く、引用文献１に開示されている技術に比し、中立較正を精度良く行うことができる。しかし、画像処理等の遅延により、特許文献１に記載の手段同様、両者の位相特性の差異による誤差分が含まれてしまうという不都合がある。

又、、ヨーレートセンサ等のレートジャイロを用いた計測装置には、誤差要因としてオフセット誤差以外にスケールファクタ誤差がある。特許文献２に開示されている技術では、オフセット誤差にスケールファクタ誤差因子が含まれた状態で検出されているため、スケールファクタ誤差をオフセット誤差として見積もってしまったり、又、その逆が生じることによって誤差の推定及び較正精度を高めることができない不都合がある。

又、特許文献３，４に開示されているように、計測装置の故障診断として、操舵角センサを用いた場合、上述したように路面横断勾配や横風の影響を受け易く、故障診断を精度良く行うことができない不具合がある。

本発明は、上記事情に鑑み、オフセット誤差とスケールファクタ誤差とを個別に検出することができ、なおかつ位相特性の影響を受け難く、更に、スケールファクタ誤差及びオフセット誤差の較正を高精度に行うことのできる計測装置、及びそれを用いた故障診断装置を提供することを目的とする。

本発明による計測装置は、第１物理量を計測する物理量計測手段と、前記第１物理量を推定する第２物理量を設定する、前記物理量計測手段とは別の物理量推定手段と、前記第１物理量と前記第２物理量とを座標軸として座標データを取得する座標データ取得手段と、取得した前記座標データに基づき最小二乗法により線形回帰パラメータを求めるパラメータ演算手段と、前記線形回帰パラメータの傾きと切片とをスケールファクタ誤差とオフセット誤差として同定するパラメータ同定手段と、前記スケールファクタ誤差と前記オフセット誤差とに基づいて前記物理量計測手段で計測した前記第１物理量を較正して較正物理量を求める物理量較正手段とを備える計測装置において、走行車線を規定する車線区画線を検出する車線区画線演算手段と、前記車線区画線演算手段で検出した前記車線区画線に基づいて該車線区画線の曲率及び車両と該車線区画線とのなす角度を求める対車線ヨー角演算手段とを更に有し、前記物理量計測手段が前記第１物理量である前記車両のヨーレートを検出するヨーレートセンサであり、前記物理量推定手段が前記対車線ヨー角演算手段で求めた前記曲率及び前記車両と前記車線区画線とのなす角から前記第２物理量である該車両の推定ヨーレートを求める推定ヨーレート演算部であり、前記座標データ取得手段は、前記ヨーレートセンサにて検出した前記ヨーレートと前記推定ヨーレート演算部で求めた前記推定ヨーレートとを座標軸として前記座標データを取得する。

本発明による前記計測装置を用いた故障診断装置は、前記スケールファクタ誤差及び前記オフセット誤差を予め設定した故障判定用しきい値と比較し、少なくとも一方の誤差が該故障判定用しきい値を越えている場合、前記物理量計測手段の故障と判定する故障診断手段を備える。

本発明によれば、第１物理量と、これを推定する第２物理量とを異なる装置で求め、得られた各物理量を座標軸として取得した座標データに基づき最小二乗法により線形回帰パラメータを求め、この線形回帰パラメータの傾きと切片とをスケールファクタ誤差とオフセット誤差として同定して、第１物理量を較正するようにしたので、較正により得られた物理量は、オフセット誤差とスケールファクタ誤差とで個別に較正されているため、位相特性の影響を受け難く、スケールファクタ誤差及びオフセット誤差の較正を高精度に行うことができる。

車両の操舵系の概略構成図 操舵制御部の機能ブロック図 ヨーレート補正値演算ルーチンを示すフローチャート（その１） ヨーレート補正値演算ルーチンを示すフローチャート（その２） カーブ路の曲線近似に基づいてヨーレートを推定する手順を示す説明図 路面横断勾配を有する走行路を直進する際の説明図 （ａ）は座標上に座標データをプロットした状態の説明図、（ｂ）はヨーレートのヒストグラム、（ｃ）はヒストグラムの分散を示す説明図 座標平面の縦軸にヨーレート、横軸に推定ヨーレートを取る座標の説明図

以下、図面に基づいて本発明の一実施形態を説明する。図１の符号１は操舵角を運転者入力と独立して設定自在な電動パワーステアリング装置である。この電動パワーステアリング装置１は、ステアリング軸２が、図示しない車体フレームにステアリングコラム３を介して回動自在に支持されており、その一端が運転席側へ延出され、他端がエンジンルーム側へ延出されている。ステアリング軸２の運転席側端部には、ステアリングホイール４が固設され、又、エンジンルーム側へ延出する端部には、ピニオン軸５が連設されている。

エンジンルームには、車幅方向へ延出するステアリングギヤボックス６が配設されており、このステアリングギヤボックス６にラック軸７が往復移動自在に挿通支持されている。このラック軸７に形成されたラック（図示せず）に、ピニオン軸５に形成されたピニオンが噛合されて、ラックアンドピニオン式のステアリングギヤ機構が形成されている。

又、ラック軸７の左右両端はステアリングギヤボックス６の端部から各々突出されており、その端部に、タイロッド８を介してフロントナックル９が連設されている。このフロントナックル９は、操舵輪としての左右輪１０Ｌ，１０Ｒを回動自在に支持すると共に、車体フレームに転舵自在に支持されている。従って、ステアリングホイール４を操作し、ステアリング軸２、ピニオン軸５を回転させると、このピニオン軸５の回転によりラック軸７が左右方向へ移動し、その移動によりフロントナックル９がキングピン軸（図示せず）を中心に回動して、左右輪１０Ｌ，１０Ｒが左右方向へ転舵される。

又、ピニオン軸５にアシスト伝達機構１１を介して、電動パワーステアリングモータ（電動モータ）１２が連設されており、この電動モータ１２にてステアリングホイール４に加える操舵トルクのアシスト、及び、設定されたヨーレート（目標ヨーレート）となるような目標ヨーモーメント（操舵トルク）の付加が行われる。電動モータ１２はモータ駆動部２１から出力される駆動力で駆動される。このモータ駆動部２１には、後述する操舵制御部２０から目標操舵トルクに対応する制御信号が入力される。

この操舵制御部２０の入力側には、走行車線を規制する左右の白線を代表とする車線区画線を検出し、これら車線区画線の位置情報を取得する前方認識手段及び車線区画線演算手段としての前方認識装置３１、車速Ｖを検出する車速センサ３２、操舵角を検出する操舵角センサ３３、第１物理量であるヨーレートγを検出する物理量計測手段としてのヨーレートセンサ３４等が接続されており、これらのパラメータに基づき、運転者の操舵力を補助する電動パワーステアリング制御、車両を目標進行路に沿って走行させるレーンキープ制御、走行車線からの車線逸脱を防止する車線逸脱防止制御等を実行する。以下においては、この各制御のうち車線逸脱防止制御機能について説明する。

前方認識装置３１は、例えば、車室内の天井前方に一定の間隔をもって取り付けられ、車外の対象を異なる視点からステレオ撮像するメインカメラとサブカメラとからなるステレオカメラと、この両カメラからの画像データを処理するステレオ画像処理部とで構成されている。

又、この前方認識装置３１のステレオ画像処理装置における、各カメラからの画像データの処理は、例えば以下のように行われる。先ず、メインカメラで撮影した基準画像とサブカメラで撮影した比較画像との視差から距離情報を求め、距離画像を生成する。走行車線の左右を規制する車線区画線は道路面と比較して高輝度であるという知得に基づき、道路の幅方向の輝度変化を評価して、画像平面における左右の車線区画線の位置を画像平面上で特定する。

この車線区画線の仮装平面上の二軸座標（ｘ，ｚ）は、画像平面上の位置（ｉ，ｊ）とこの位置に関して算出された距離情報に基づいて、周知の座標変換式より算出される。自車両の位置を基準に設定された実空間の座標系は、本実施形態では、例えば、図５に示すように、ステレオカメラの中央真下の道路面を原点として、車幅方向をＸ軸（左方向を「＋」）、車長方向（距離方向）をＺ軸（前方向を「＋」）とする。このとき、Ｘ−Ｚ平面は、道路が平坦な場合、道路面と一致する。

道路モデルは、道路上の自車両の走行車線を距離方向に複数区間に分割し、各区間における左右の車線区画線を所定に近似して連結することによって表現される。尚、本実施形態では、走行車線の形状を１組のカメラからの画像を基に認識する例で説明したが、他に、単眼カメラ、カラーカメラからの画像情報を基に求めるものであっても良い。又、車線区画線までの距離が認識できるものであれば、前方認識装置３１は、ミリ波レーダや赤外線レーザレーダであっても良い。

次に、操舵制御部２０で実行される車線逸脱防止制御について説明する。図２に示すように、操舵制御部２０には車線逸脱防止制御を実行する機能として、目標ヨーレート演算部４１、フィードフォワード制御値演算部４２、物理量推定手段としての推定ヨーレート演算部４３、物理量較正手段としての較正ヨーレート演算部４４、フィードバック制御値演算部４５、レートリミッタ演算部４６、操舵トルク演算部４７を備えている。

目標ヨーレート演算部４１は、目標ヨーレートγ＊を以下のようにして求める。尚、本発明の対車線ヨー角演算手段は、この目標ヨーレート演算部４１に含まれている。

すなわち、図５に示すように、基準画像データと比較画像データとに基づいて生成した仮想道路平面上に、距離データに基づいて算出した左右車線区画線の候補点ＰＬ，ＰＲをプロットする。この仮想道路平面には自車両Ｍが配設されており、自車両Ｍに搭載されている前方認識装置（ステレオカメラ）３１の中央の真下の道路面上の点を原点とし、自車両Ｍの車幅方向にｘ軸、前後方向にｚ軸を取る座標が設定される。尚、符号θｙａｗは走行車線と自車両Ｍとのなす角（対車線ヨー角）である。

そして、この左右にプロットした候補点ＰＬ，ＰＲの群から最小二乗法により、左右車線区画線の二次モデル式
Ｙ_ＬＩＮＥ_Ｌ＝Ａ_Ｌ・Ｚ^２＋Ｂ_Ｌ・Ｚ＋Ｃ_Ｌ…（１）
Ｙ_ＬＩＮＥ_Ｒ＝Ａ_Ｒ・Ｚ^２＋Ｂ_Ｒ・Ｚ＋Ｃ_Ｒ…（２）
の各係数Ａ_Ｌ，Ｂ_Ｌ，Ｃ_Ｌ，Ａ_Ｒ，Ｂ_Ｒ，Ｃ_Ｒを求め、これにより左右の車線区画線モデルを求める。尚、ここで、Ａ_Ｌ、Ａ_Ｒは車線曲率に関するパラメータであり、左側車線区画線の曲率κは、κ＝２・Ａ_Ｌ、右側の車線区画線の曲率κは、κ＝２・Ａ_Ｒである。又、Ｂ_Ｌ，Ｂ_Ｒは自車両Ｍの中央を通る仮想線に対する自車両Ｍの傾き（ヨー角）に関する角度パラメータである。更に、Ｃ_Ｌ，Ｃ_Ｒは左右車線区画線からの横位置を示す係数である。

そして、自車両Ｍの対車線ヨー角θｙａｗを、
θｙａｗ＝（Ｂ_Ｌ＋Ｂ_Ｒ）／２…（３）
から求める。

又、走行車線の中央からの自車両位置である車線幅方向車両横位置Ｙを、
Ｙ＝（Ｃ_Ｌ＋Ｃ_Ｒ）／２…（４）
から求める。

次いで、車線区画線＿車両間距離Ｌを、
Ｌ＝（（Ｃ_Ｌ−Ｃ_Ｒ）−ＴＲ）／２−Ｙ…（５）
から算出する。ここで、ＴＲは車両のトレッドであり、本実施形態では、タイヤの外側端位置を車線逸脱判定の基準に用いるものとする。

そして、走行車線から逸脱する車線逸脱予想時間Ｔttlcを、例えば、
Ｔttlc＝Ｌ／（Ｖ・ｓｉｎ（θyaw））…（６）
から求める。

そして、対車線ヨー角θｙａｗと車線逸脱予想時間Ｔttlcとに基づき、車線逸脱を防止する目標ヨーレートγ＊を、
γ＊＝−θｙａｗ／Ｔttlc…（７）
から求める。

そして、フィードフォワード制御値演算部４２は、目標ヨーレートγ＊を所定ゲインで補正してフィードフォワード値Ｍｚｆｆを設定する。

一方、推定ヨーレート演算部４３は、前方認識装置３１で認識した画像に基づいて求めた車線区画線の車線曲率κと対車線ヨー角θｙａｗ、及び車速センサ３２で検出した車速Ｖに基づいて、第２物理量である推定ヨーレートγlaneを、
γlane＝κ・Ｖ＋ｄθｙａｗ／ｄｔ…（８）
から求める。

この推定ヨーレートγlaneは、前方認識装置３１で認識した画像に基づいて求めているため、路面横断勾配（カント）や横風の影響を受けることなく高い精度でヨーレートを推定することができる。すなわち、図６に示すように、自車両Ｍが路面横断勾配を有する直進路を走行する場合、車体に対して下り方向の横力Ｆｙが作用するため、運転者はハンドルを上り方向に切った状態で直進走行する。従って、ヨーレートをハンドル角に基づいて推定した場合、この横力Ｆｙが外乱として作用するため、ヨーレートを高い精度で推定することができない。

これに対し、本実施形態では、前方認識装置３１で認識した画像から求めた左右の車線区画線の曲線近似式に基づいて、推定ヨーレートγlaneを求めているため、自車両Ｍに横力Ｆｙが作用しても、これが車線区画線を求める際に外乱として作用することがないので、推定ヨーレートγlaneを高い精度で求めることができる。

そして、較正ヨーレート演算部４４は、推定ヨーレートγlaneとヨーレートセンサ３４で検出したヨーレートγとの関係から、ヨーレートγを較正した較正ヨーレートγcalを求める。この較正ヨーレート演算部４４での処理は、具体的には、図３に示す較正ヨーレート演算ルーチンに従って実行される。

このルーチンでは、先ず、ステップＳ１で、推定ヨーレートγlaneを時間微分することで、推定ヨー角加速度ｄγlane／ｄｔを求める。

次いで、ステップＳ２へ進み、推定ヨー角加速度ｄγlane／ｄｔが予め設定したしきい値γsl以上か否かを調べる。この推定ヨー角加速度ｄγlane／ｄｔは、後述する最小二乗を行うためのサンプルデータであり、しきい値γslは、推定ヨー角加速度ｄγlane／ｄｔの変動が小さいものを排除し、サンプルデータとして好ましい値を抽出するために設定されている。

そして、ｄγlane／ｄｔ≧γslの場合、ステップＳ３へ進み、推定ヨーレートγlaneと、それに同期するヨーレートセンサ３４で検出したヨーレートγ（以下、これを「センサヨーレートγsensor」と称する）とのサンプリングを開始する。一方、ｄγlane／ｄｔ＜γslの場合はルーチンを抜ける。

ステップＳ３へ進むと、推定ヨーレートγlaneのサンプルデータ数ｎが、予め設定したしきい値ｎsl未満か否かを調べる。このしきい値ｎslは、後述する最小二乗を行う場合のデータとして十分なサンプルデータ数ｎに達しているか否かを判定する値であり、本実施形態は操舵制御部２０のメモリ容量に基づいて設定されている。尚、メモリ容量に余裕がある場合は、このしきい値ｎslは予めシミュレーション等から求めて設定しても良い。

そして、ｎ＜ｎslの場合、ステップＳ５へ進み、ｎ≧ｎslの場合、ステップＳ４へ分岐する。ステップＳ４では、サンプリングした推定ヨーレートγlaneとセンサヨーレートγsensorとに基づいて最小二乗用座標データを作成し取得する。尚、このステップでの処理が本発明の座標データ取得手段に対応している。

すなわち、図７（ａ）に示すように、横座標軸に推定ヨーレートγlaneの値を取り、縦座標軸にセンサヨーレートγsensorの値を取る座標平面上に座標データである関数ｆ（γlane，γsensor）をプロットする。ところで、サンプルデータは、平均的に分散している方が線形回帰式（γsensor＝ａ・γlane＋ｂ）を高い精度で求めることができる。

そのため、ステップＳ４では、同図（ｂ）に示すように、推定ヨーレートγlane軸上に、センサヨーレートγsensorの頻度分布を示す所定階のヒストグラムを作成する。そして、同図（ｃ）に示すように、あるしきい値ＳＬ以上の頻度を示す階のセンサヨーレートγsensorを、最大頻度を示す階から次の頻度を示す階へ移動させ、これを繰り返してほぼ平均化させる。その後、この最小二乗用データが作成された場合、ステップＳ７へジャンプする。

一方、ステップＳ３でサンプルデータ数ｎが所定しきい値ｎsl未満と判定されてステップＳ５へ進むと、センサヨーレートγsensorの値が０か否かを調べる。γsensor＝０の場合、ヨーレートセンサ３４の分解能を越えている値であるため、データサンプリングすることなく、ステップＳ７へジャンプする。一方、γsensor≠０の場合、ステップＳ６へ進む。

ステップＳ６では、今回読込んだサンプルデータを格納する処理を実行する。すなわち、サンプリングしたデータ（γlane，γsensor）の数nが、メモリ容量に応じて設定されたしきい値ｎslに達するまで、順次、格納される。

そして、ステップＳ４，ステップＳ５．或いはステップＳ６からステップＳ７へ進むと、ヨーレート検出範囲を算出する処理を実行する。このヨーレート検出範囲は、上述した最大値−最小値の間であり、これによりサンプリングしたデータ（γlane，γsensor）の分散を調べる。尚、ステップＳ６でメモリに格納したデータ（γlane，γsensor）のサンプル数がメモリしきい値に達していない場合でも、このステップＳ７において、ヨーレートの検出範囲（最大値−最小値）が算出される。

その後、ステップＳ８へ進むと、サンプリングした最小二乗用データ（γlane，γsensor）の数ｎがしきい値ｎsl以上か否かを調べ、ｎ≧ｎslの場合、ステップＳ９へ進み、又、ｎ＜ｎslの場合 、ルーチンを抜ける。

そして、ステップＳ９へ進むと、上述したステップＳ７で算出したヨーレートの検出範囲（最大値−最小値）が、予め設定した範囲を判定するしきい値以上か否かを調べる。このしきい値は最小二乗による線形回帰式を求める範囲として充分か否かを調べるもので、予めシミュレーション等から求めて設定されている。

そして、検出範囲≧しきい値の場合、ステップＳ１０へ進み、又、検出範囲＜しきい値の場合、線形回帰式を正確に求めることができないため、ルーチンを抜ける。

その後、ステップＳ１０へ進むと、上述したステップＳ４で作成された最小二乗用データの座標上の各関数ｆ（γlane，γsensor）に基づき、推定ヨーレートγlaneを基準として最小二乗法により線形回帰式（γsensor＝ａ・γlane＋ｂ）を求める。

その後、ステップＳ１１へ進み、線形回帰式（γsensor＝ａ・γlane＋ｂ）の線形回帰パラメータである傾きａと切片ｂとを取得し、この傾きａと切片ｂとに基づきスケールファクタ誤差とオフセット誤差を算出する。スケールファクタ誤差は線形回帰式（γsensor＝ａ・γlane＋ｂ）の傾きａに相当し、オフセット誤差が切片ｂに相当する。従って、オフセット誤差をｂとして同定し、一方、スケールファクタ誤差をａとして同定する。尚、ステップＳ１０，Ｓ１１での処理が本発明の線形回帰パラメータ演算手段、及びパラメータ同定手段に対応している。

次いで、ステップＳ１２へ進み、スケールファクタ誤差ａとオフセット誤差ｂが、予め設定したしきい値ａsl，ｂsl以下か否かを調べる。このしきい値ａsl，ｂslは、センサヨーレートγsensorを較正することで正しい値を得ることのできる限界値であり、予めシミュレーション等から求めて設定されている。そして、ａ≦ａsl、且つｂ≦ｂslの場合、ステップＳ１３へ進む。又、少なくとも一方が、ａ＞ａsl，ｂ＞ｂslの場合、は誤差が大きく、較正しても良好なフィードバック特性を得ることが難しいため、ステップＳ１４へジャンプする。

そして、ステップＳ１３へ進むと、センサヨーレートγsensorを較正した較正ヨーレートγcalを、
γcal←（１／ａ）・γsensor−ｂ…（９）
から求めて、ステップＳ１４へ進む。尚、この場合、スケールファクタ誤差を（１／ａ）と定義し、オフセット誤差を（−ｂ）と定義し、
ａ‘＝（１／ａ）
ｂ‘＝（−ｂ）
とすれば、（９）式は、
γcal←ａ‘・γsensor＋ｂ’…（９‘）
となる。

図８に示すように、推定ヨーレートγlaneとセンサヨーレートγsensorとが同じ値を示す場合、線形回帰式（γsensor＝ａ・γlane＋ｂ）は、ａ＝１，ｂ＝０の原点を通る直線となる（理想値）。一方、誤差が生じた場合、例えば、同図に計測値として示すように、線形回帰式（γsensor＝ａ・γlane＋ｂ）は、ａ＝０．５，ｂ＝−１のずれた値となる。従って、この場合は、センサヨーレートγsensorを（９）式、或いは（９‘）式で、原点を通る較正ヨーレートcalに中立較正することで、良好なフィードバック特性を得ることができる。

その後、ステップＳ１２，或いはステップＳ１３からステップＳ１４へ進むと、メモリに格納されている最小二乗用データ（γlane，γsensor）を全てクリアして、ルーチンを抜ける。

そして、前述した目標ヨーレート演算部４１で求めた目標ヨーレートγ＊と較正ヨーレート演算部４４で求めた較正ヨーレートγcalとの差分Δγ（Δγ＝γ＊−γcal）が、フィードバック制御値演算部４５に読込まれる。

フィードバック制御値演算部４５は、上述した差分Δγに基づきＰＩＤ制御等によりフィードバック制御値Ｍｚｆｂを求める。

そして、フィードフォワード制御値演算部４２で求めたフィードフォワード値Ｍｚｆｆとフィードバック制御値演算部４５で求めたフィードバック制御値Ｍｚｆｂとの差分から目標ヨーモーメントＭｚ*を求める。この目標ヨーモーメントＭｚ*がレートリミッタ演算部４６に読込まれる。

レートリミッタ演算部４６では、前回のルーチン実行時に求めた目標ヨーモーメントＭｚ*(n-1)と、今回求めた目標ヨーモーメントＭｚ* (n)との差分を求め、この差分が予め設定したしきい値を超えているか否かを調べる。このしきい値は、目標ヨーモーメントＭｚ*(n-1)，目標ヨーモーメントＭｚ* (n)の段差が大きいか否かを調べるものであり、段差が大きい場合、円滑な制御が行えないため、今回求めた目標ヨーモーメントＭｚ* (n)の上限値を制限する。

そして、この目標ヨーモーメントＭｚ* (n)が操舵トルク演算部４７に読込まれる。操舵トルク演算部４７では、目標ヨーモーメントＭｚ*に対応する操舵トルクＴｐを求め、モータ駆動部２１へ出力し、電動モータ１２を所定に駆動させる。

このように、本実施形態では、前方認識装置３１で認識した画像から求めた車線区画線モデルに基づいて推定ヨーレートγlaneを求め、この推定ヨーレートγlaneとセンサヨーレートγsensorとを座標軸とする座標面上に関数ｆ（γlane，γsensor）をプロットし、この関数ｆ（γlane，γsensor）に基づいて最小二乗により線形回帰式（γsensor＝ａ・γlane＋ｂ）を求める。

そして、この線形回帰式の傾きａをスケールファクタ誤差とし、切片ｂをオフセット誤差として同定するようにしたので、スケールファクタ誤差ａとオフセット誤差ｂとを個別に検出することができて、中立較正を高精度に行うことができる。更に、この両誤差ａ，ｂにてセンサヨーレートγsensorを較正して較正ヨーレートcalを求めるようにしたので、精度の高いフィードバック特性を得ることができる。

又、推定ヨーレートγlaneを前方認識装置３１で撮影した画像に基づいて求めているので、平地直進走行のみならず、路面横断勾配の走行や走行中に横風を受けても、その影響を受けることなく、センサヨーレートγsensorを高精度に中立較正させることができる。

尚、本発明は、上述した実施形態に限るものではなく、例えば、故障診断装置において、スケールファクタ誤差ａとオフセット誤差ｂの何れか一方が、上述したしきい値ａsl，ｂslを越えている場合、ヨーレートセンサ３４の故障と判定する故障診断手段を備えるようにしても良い。

３１…前方認識装置、
３２…車速センサ、
３３…操舵角センサ、
３４…ヨーレートセンサ、
４１…目標ヨーレート演算部、
４３…推定ヨーレート演算部、
４４…較正ヨーレート演算部、
ａ…スケールファクタ誤差、
ｂ…オフセット誤差、
γcal…較正ヨーレート、
ｄγlane／ｄｔ…推定ヨー角加速度、
Ｍ…自車両、
ｎ…サンプルデータ数、
Ｖ…車速、
γ…ヨーレート、
γ＊…目標ヨーレート、
Ｍｚ*…目標ヨーモーメント、
γcal…較正ヨーレート、
γlane…車線推定ヨーレート、
γsensor…センサヨーレート、
θｙａｗ…対車線ヨー角

Claims (5)

1. 第１物理量を計測する物理量計測手段と、
   前記第１物理量を推定する第２物理量を設定する、前記物理量計測手段とは別の物理量推定手段と、
   前記第１物理量と前記第２物理量とを座標軸として座標データを取得する座標データ取得手段と、
   取得した前記座標データに基づき最小二乗法により線形回帰パラメータを求めるパラメータ演算手段と、
   前記線形回帰パラメータの傾きと切片とをスケールファクタ誤差とオフセット誤差として同定するパラメータ同定手段と、
   前記スケールファクタ誤差と前記オフセット誤差とに基づいて前記物理量計測手段で計測した前記第１物理量を較正して較正物理量を求める物理量較正手段と
   を備える計測装置において、
   走行車線を規定する車線区画線を検出する車線区画線演算手段と、
   前記車線区画線演算手段で検出した前記車線区画線に基づいて該車線区画線の曲率及び車両と該車線区画線とのなす角度を求める対車線ヨー角演算手段と
   を更に有し、
   前記物理量計測手段が前記第１物理量である前記車両のヨーレートを検出するヨーレートセンサであり、
   前記物理量推定手段が前記対車線ヨー角演算手段で求めた前記曲率及び前記車両と前記車線区画線とのなす角から前記第２物理量である該車両の推定ヨーレートを求める推定ヨーレート演算部であり、
   前記座標データ取得手段は、前記ヨーレートセンサにて検出した前記ヨーレートと前記推定ヨーレート演算部で求めた前記推定ヨーレートとを座標軸として前記座標データを取得する
   ことを特徴とする計測装置。
2. 前記物理量較正手段は、前記ヨーレートを前記スケールファクタ誤差で除算した値に前記オフセット誤差を減算することで前記較正物理量である較正ヨーレートを求める
   ことを特徴とする請求項１記載の計測装置。
3. 前記物理量較正手段は、前記ヨーレートを前記スケールファクタ誤差で乗算した値に前記オフセット誤差を加算することで前記較正物理量である較正ヨーレートを求める
   ことを特徴とする請求項１記載の計測装置。
4. 前記スケールファクタ誤差と前記オフセット誤差を、前記ヨーレートセンサで検出した前記ヨーレートを較正する線形回帰パラメータとする
   ことを特徴とする請求項１〜３の何れか１項に記載の計測装置。
5. 前記スケールファクタ誤差及び前記オフセット誤差を予め設定した故障判定用しきい値と比較し、少なくとも一方の誤差が該故障判定用しきい値を越えている場合、前記ヨーレートセンサの故障と判定する故障診断手段を備える
   ことを特徴とする請求項１〜４の何れか１項に記載の計測装置を用いた故障診断装置。

Images