JP2004150973A - 車両用加速度検出装置 - Google Patents

Abstract

【課題】異なる方向の加速度及び角速度を検出する複数のセンサを備え、正確な加速度検出値を得ることができる車両用加速度検出装置を提供する。
【解決手段】車体の前後軸方向の加速度ａ、車体の左右軸方向の加速度ｂ、前記前後軸まわりのロールレートφ、前記左右軸まわりのピッチレートθが検出される。検出ロールレートφ及びピッチレートθの座標変換が行われ、変換ロールレートφｒ及び変換ピッチレートθｒが算出され、変換ロールレートφｒ及び変換ピッチレートθｒを積分することにより、ロール角Φ及びピッチ角Θが算出される。ロール角Φに基づいて、検出左右加速度ｂからロール角成分を除去することにより、純左右加速度Ｂが算出され、ピッチ角Θに基づいて、検出前後加速度ａからピッチ角成分を除去することにより、純前後加速度Ａが算出される。ロール角Φ及びピッチ角Θに基づいて、前記座標変換が行われる。
【選択図】 図５

Description

【０００１】
【発明の属する技術分野】
本発明は、車両に搭載される加速度検出装置に関し、特に異なる方向の加速度を検出する複数のセンサを備えた加速度検出装置に関する。
【０００２】
【従来の技術】
車両が勾配のある道路を走行しているときは、加速度センサにより検出される車両の前後方向の加速度は、勾配の影響により、真の値からずれる。このため、特許文献１及び２には、勾配の影響をなくす補正を行う手法が示されている。
【０００３】
特許文献１に示された第１の手法によれば、勾配センサにより道路の勾配が検出され、検出された勾配に応じて検出加速度の補正が行われる。また、勾配センサを用いることなく、検出加速度の補正を行う第２及び第３の手法が示されている。第２の手法によれば、車両の走行速度がほぼ一定であるときの、加速度センサ出力が加速度補正値とされる。第３の手法によれば、車輪の駆動力、転がり・空気抵抗、及び車両の質量に基づいて、加速度補正値が算出される。
【０００４】
また特許文献２に示された手法では、エンジン出力トルクに基づいて、走行中の道路が平坦路であるかいなかが判定され、平坦路でないと判定されたときに検出加速度の補正が行われる。
【０００５】
【特許文献１】
特開平９−１３３６９９号公報
【特許文献２】
特開平１１−２８１６７２号公報
【０００６】
【発明が解決しようとする課題】
特許文献１に示された第１の手法では、勾配センサを用いることが必要となるので、製造コストが上昇するという課題がある。また第２の手法では、車速がほぼ一定とならない限り補正値が得られないという課題がある。さらに第３の手法では、演算が複雑であるにも拘わらず、空気抵抗や車両質量などの変動要因があるため、正確な補正ができないという課題がある。
【０００７】
また特許文献２に示された手法では、走行中の道路が平坦路であるか否かに応じておおまかな補正が行われるだけであるので、補正の精度が低いという課題がある。
また最近は、車両の前後方向及び左右方向の加速度や、ヨーレートを検出し、これらの検出値を用いるナビゲーションシステムや横滑り制御システムなどが車両に搭載されるようになってきているため、複数の加速度センサや回転角速度センサを設けて、正確な検出データを各システムに供給することが必要となってきている。
【０００８】
本発明は上述した点を考慮してなされたものであり、異なる方向の加速度及び角速度を検出する複数のセンサを備え、正確な加速度検出値を得ることができる車両用加速度検出装置を提供することを目的とする。
【０００９】
【課題を解決するための手段】
上記目的を達成するため請求項１に記載の発明は、車体の前後軸方向の加速度を検出する前後加速度センサ（１１）と、車体の左右軸方向の加速度を検出する左右加速度センサ（１２）と、前記前後軸まわりの角速度を検出するロールレートセンサ（１５）と、前記左右軸まわりの角速度を検出するピッチレートセンサ（１４）と、前記ロールレートセンサ（１５）及びピッチレートセンサ（１４）の検出値（φ、θ）の座標変換を行う座標変換手段（１１３）と、該座標変換手段（１１３）により座標変換されたロールレート（φｒ）及びピッチレート（θｒ）を積分することにより、ロール角（Φ）及びピッチ角（Θ）を算出する積分手段（１１４，１１５）と、前記積分手段により算出されるロール角（Φ）に基づいて、前記左右加速度センサの検出値（ｂ）からロール角成分を除去する左右加速度補正手段（１０７）と、前記積分手段により算出されたピッチ角（Θ）に基づいて、前記前後加速度センサの検出値（ａ）からピッチ角成分を除去する前後加速度補正手段（１０３）とを備え、前記座標変換手段（１１３）は、前記積分手段（１１４，１１５）により算出されたロール角（Φ）及びピッチ角（Θ）に基づいて、前記座標変換を行うことを特徴とする車両用加速度検出装置を提供する。
【００１０】
この構成によれば、積分手段により算出されたロール角及びピッチ角に基づいて、ロールレートセンサ及びピッチレートセンサの検出値の座標変換が行われ、より正確なロールレート及びピッチレートが得られる。また積分手段により算出されたロール角に基づいて、左右加速度センサの検出値からロール角成分を除去する補正が行われ、さらに積分手段により算出されたピッチ角に基づいて、前後加速度センサの検出値からピッチ角成分を除去する補正が行われるので、車体の前後軸まわり及び左右軸まわりの傾きがあっても、正確な左右加速度及び前後加速度が得られる。
【００１１】
請求項２に記載の発明は、請求項１に記載の車両用加速度検出装置において、車体の上下軸まわりの角速度を検出するヨーレートセンサ（１６）をさらに備え、前記座標変換手段（１１３）は、前記積分手段（１１４，１１５）により算出されたロール角（Φ）及びピッチ角（Θ）に基づいて、前記ヨーレートセンサの検出値（ω）の座標変換を行うことを特徴とする。
【００１２】
この構成によれば、ヨーレートセンサにより当該車両のヨーレートが検出され、積分手段により算出されたロール角及びピッチ角に基づいて、検出ヨーレートセンサの座標変換が行われ、正確なヨーレートを得ることができる。
【００１３】
請求項３に記載の発明は、請求項１または２に記載の車両用加速度検出装置において、車体の上下軸方向の加速度を検出する上下加速度センサ（１３）と、前記積分手段（１１４，１１５）により算出されるロール角（Φ）及びピッチ角（Θ）に基づいて、前記上下加速度センサの検出値（ｃ）からロール角成分及びピッチ角成分を除去する上下加速度補正手段（１３１）とをさらに備えることを特徴とする。
【００１４】
この構成によれば、車体の上下軸方向の加速度が検出され、積分手段により算出されるロール角及びピッチ角に基づいて、上下加速度センサの検出値からロール角成分及びピッチ角成分を除去されるので、車体の前後軸まわり及び左右軸まわりの傾きがあっても、正確な上下加速度が得られる。
【００１５】
請求項４に記載の発明は、請求項２に記載の車両用加速度検出装置において、前記前後加速度補正手段（１０３）により補正された前後加速度（Ａ）を積分して車速（Ｕｃ）を演算する第１の車速演算手段と、前記左右加速度補正手段（１０７）により補正された左右加速度（Ｂ）、前記ヨーレートセンサ（１６）の検出値（ω）及び前記車速（Ｕｃ）の関係に基づいて、前記左右加速度センサ（１２）、前後加速度センサ（１１）、ロールレートセンサ（１５）またはヨーレートセンサ（１６）の故障を判断する第１の故障判断手段（１２２）とをさらに備えることを特徴とする。
【００１６】
この構成によれば、前後加速度補正手段により補正された前後加速度を積分することにより車速が演算され、左右加速度補正手段により補正された左右加速度、ヨーレート検出値及び車速の関係に基づいて、左右加速度センサ、前後加速度センサ、ロールレートセンサまたはヨーレートセンサの故障が判断される。したがって、左右加速度センサ、前後加速度センサ、ロールレートセンサ及びヨーレートセンサの動作が相互に常に監視され、故障を迅速に検出することができる。
【００１７】
請求項５に記載の発明は、請求項２に記載の車両用加速度検出装置において、前記車両の複数の車輪の車輪速度をそれぞれ検出する複数の車輪速度センサ（２１〜２４）と、前記複数の車輪速度センサにより検出された複数の車輪速度（ＶＤＲ、ＶＤＬ、ＶＶＲ，ＶＶＬ）に基づいて車速（ＶＰ）を演算する第２の車速演算手段（１４１）と、前記左右加速度補正手段（１０７）により補正された左右加速度（Ｂ）、前記ヨーレートセンサ（１６）の検出値（ω）及び前記車速（ＶＰ）の関係に基づいて、前記左右加速度センサ（１２）、ロールレートセンサ（１５）またはヨーレートセンサ（１６）の故障を判断する第２の故障判断手段（１２３ａ）とをさらに備えることを特徴とする。
【００１８】
この構成によれば、車輪速度センサにより検出された複数の車輪速度に基づいて車速が演算され、左右加速度補正手段により補正された左右加速度、ヨーレート検出値及び車速の関係に基づいて、左右加速度センサ、ロールレートセンサまたはヨーレートセンサの故障が判断される。したがって、左右加速度センサ、ロールレートセンサ及びヨーレートセンサの動作が相互に常に監視され、故障を迅速に検出することができる。
【００１９】
請求項６に記載の発明は、請求項５に記載の車両用加速度検出装置において、前記複数の車輪速度センサ（２１〜２４）の故障を個別に判断する車輪速度センサ故障判断手段（１２３ａ）を備え、前記第２の故障判断手段（１２３ａ）は、前記車輪速度センサの故障判断がなされていないことを条件として前記故障の判断を実行することを特徴とする。
【００２０】
この構成によれば、前記複数の車輪速度センサの故障が個別に判断され、車輪速度センサの故障判断がなされていないことを条件として、第１の故障診断手段による故障判断が実行されるので、車輪速度センサの故障による誤判定を防止することができる。
【００２１】
請求項７に記載の発明は、請求項１または２に記載の車両用加速度検出装置において、前記車両の停止状態を検出する停止状態検出手段（１１２）と、該停止状態検出手段により停止状態が検出されているときの、前記前後加速度センサ及び左右加速度センサの検出値（ａ，ｂ）に基づいて、前記車体の静止傾斜角（γ’）を算出する静止傾斜角算出手段（１１２）と、前記積分手段（１１４，１１５）により算出されるピッチ角（Θ）及びロール角（Φ）に基づいて、積分傾斜角（Γ）を算出する積分傾斜角算出手段（１１１）とをさらに備え、前記積分傾斜角算出手段（１１１）は、前記静止傾斜角算出手段（１１２）により算出された静止傾斜角（γ’）により、前記積分傾斜角（Γ）の初期値補正を行うことを特徴とする。
【００２２】
この構成によれば、当該車両の停止状態が検出されているときの、前後加速度センサ及び左右加速度センサの検出値に基づいて、車体の静止傾斜角が算出され、積分手段により算出されるピッチ角及びロール角に基づいて、積分傾斜角が算出される。そして静止傾斜角により、積分傾斜角の初期値補正が行われる。積分手段により算出されるピッチ角及びロール角は、車両の停止状態では「０」であるため、前後加速度センサ及び左右加速度センサの検出値に基づいて算出される静止傾斜角により初期値補正を行うことにより、正確な積分傾斜角が得られる。
【００２３】
請求項８に記載の発明は、請求項２に記載の車両用加速度検出装置において、前記ロールレートセンサ（１５）、ピッチレートセンサ（１４）及びヨーレートセンサ（１６）の検出値に基づいて、前記車両の安定状態を検出する安定状態検出手段（１１２ａ）と、該安定状態検出手段（１１２ａ）により前記車両の安定状態が検出されているときの、前記前後加速度センサ及び左右加速度センサの検出値に基づいて、前記車体の安定傾斜角（γ”）を算出する安定傾斜角算出手段（１１２ａ）と、前記積分手段（１１４，１１５）により算出されるピッチ角（Θ）及びロール角（Φ）に基づいて、前記積分傾斜角（Γ）を算出する積分傾斜角算出手段（１１１ａ）とをさらに備え、前記積分傾斜角算出手段（１１１ａ）は、前記安定傾斜角算出手段（１１２ａ）により算出された安定傾斜角（γ”）により、前記積分傾斜角（Γ）の初期値補正を行うことを特徴とする。
【００２４】
この構成によれば、ロールレートセンサ、ピッチレートセンサ及びヨーレートセンサの検出値に基づいて、当該車両の安定状態が検出され、当該車両の安定状態が検出されているときの、前後加速度センサ及び左右加速度センサの検出値に基づいて、車体の安定状態傾斜角が算出され、積分手段により算出されるピッチ角及びロール角に基づいて、積分傾斜角が算出される。そして安定状態傾斜角により、積分傾斜角の初期値補正が行われる。積分手段により算出されるピッチ角及びロール角は、車両の安定状態においては変化しないため、前後加速度センサ及び左右加速度センサの検出値に基づいて算出される安定状態傾斜角により初期値補正を行うことにより、正確な積分傾斜角が得られる。
【００２５】
請求項９に記載の発明は、請求項７または８に記載の車両用加速度検出装置において、前記上下加速度センサ（１３）により検出された上下加速度（ｃ）に基づいて、前記車両の傾斜角（γ）を算出する傾斜角算出手段（１１０）と、該傾斜角算出手段（１１０）により算出される傾斜角（γ）と、前記積分傾斜角算出手段により算出される積分傾斜角（Γ）とを比較することにより、前記上下加速度センサ（１３）、ピッチレートセンサ（１４）またはロールレートセンサ（１５）の故障を判断する第３の故障判断手段とをさらに備えることを特徴とする。
【００２６】
この構成によれば、上下加速度センサより検出された上下加速度に基づいて、車両の傾斜角が算出され、その傾斜角と、積分傾斜角算出手段により算出される積分傾斜角とを比較することにより、上下加速度センサ、ピッチレートセンサまたはロールレートセンサの故障が判断される。したがって、上下加速度センサ、ピッチレートセンサ及びヨーレートセンサの動作が相互に常に監視され、故障を迅速に検出することができる。
【００２７】
なお、上記座標変換は、より具体的には、車体に固定された座標系から、車体に傾きがない状態に対応する基準座標系への変換である。
【００２８】
【発明の実施の形態】
以下本発明の実施の形態を図面を参照して説明する。
図１は本発明の一実施形態にかかる車両用加速度検出装置、及びその周辺装置の構成を示すブロック図である。本実施形態においては、加速度検出装置は、慣性測定ユニット（ＩＭＵ：Ｉｎｅｒｔｉａ Ｍｅａｓｕｒｅｍｅｎｔ Ｕｎｉｔ）１と、これとは別に車両の各車輪の速度を検出する第１〜第４車輪速度センサ２１〜２４によって構成される。慣性測定ユニット１は、図２に示すように、車両１０の重心位置付近に配置される。図２に示されるように、車体の前後方向に延びる軸をＸ軸とし、車体の左右方向に延びる軸をＹ軸とし、車体の上下方向に延びる軸をＺ軸とする。
【００２９】
慣性測定ユニット１は、車体の前後軸（Ｘ軸）方向の加速度を検出する前後加速度センサ１１と、車体の左右軸（Ｙ軸）方向の加速度を検出する左右加速度センサ１２と、車両の上下軸（Ｚ軸）方向の加速度を検出する上下加速度センサ１３と、前記左右軸まわりの角速度であるピッチレートθを検出するピッチレートセンサ１４と、前記前後軸まわりの角速度であるロールレートφを検出するロールレートセンサ１５と、前記上下軸まわりの角速度であるヨーレートωを検出するを検出するヨーレートセンサ１６と、演算部１７とを備えている。
【００３０】
第１及び第２車輪速度センサは、それぞれ右駆動輪速度ＶＤＲ及び左駆動輪速度ＶＤＬを検出し、第３及び第４車輪速度センサは、それぞれ右従動輪速度ＶＶＲ及び左従動輪速度ＶＶＬを検出する。
【００３１】
横滑り制御等で直接制御に用いるヨーレートωを検出するヨーレートセンサ１６は、中点電位（静止時）の安定性が重要な因子なので、従来から横滑り制御に用いられている様な比較的高価で±１ｄｅｇ／ｓｅｃ程度の安定性を確保できるセンサが採用されている。一方、車両の場合、ロールレートφ及びピッチレートθは、常時継続的に発生することが無いので、検出信号にハイパスフィルタを施して使用することできる。したがって、ピッチレートセンサ１４及びロールレートセンサ１５としては、中点電位の安定性がそれほど高くない、比較的安価な製品が採用されている。また加速度センサ１１，１２，及び１３は、９．８ｍｍ／ｓｅｃ^２程度の分解能を有する車載用の一般的な低加速度センサが採用されている。このような構成とすることにより、ヨーレートセンサと加速度センサをそれぞれを２つずつ設ける構成より、コストを低減することができる。
【００３２】
慣性測定ユニット１は、ＬＡＮ（Ｌｏｃａｌ Ａｒｅａ Ｎｅｔｗｏｒｋ）２５を介して、各車輪速度センサ２１〜２４、ナビゲーションシステム３１、横滑り制御システム３２、アダプティブクルーズ制御システム３３、及び表示システム３５に接続されている。
ナビゲーションシステム３１は、人工衛星からの信号により得られる位置データと、上記加速度センサ及び角速度センサの出力を積分することにより、得られる位置データと、予め蓄積されている地図情報とに基づいて、当該車両の位置を地図情報とともに、表示システム３５に表示する。
【００３３】
横滑り制御システム３２は、車両のオーバステア状態、アンダーステア状態等の挙動を、操舵角や車速から定まる目標値と、ヨーレートや横加速度等の検出値との比較により判定し、その判定結果に基づいてオーバステアやアンダーステアを打ち消すように（検出値が目標値に近づくように）、旋回外側の車輪にブレーキをかけたり、旋回内側の車輪にブレーキをかけたりする制御を行う。
【００３４】
アダプティブクルーズ制御システム３３は、車間距離センサ（図示せず）を備え、オートクルーズの一定車速制御に加えて、車間距離が安全車間距離以下になると、シフトダウンや自動ブレーキ制御を行う。
表示システム３５は、液晶表示装置（図示せず）を含み、ナビゲーションシステム３１からの情報、及びその他の情報を液晶表示装置上に表示する。
【００３５】
演算部１７は、図３に示すように、上述したセンサの出力信号が入力され、アナログ信号をディジタル信号に変換するＡ／Ｄ変換素子５１，後述する各種演算処理を実行するＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）５２，演算プログラムなどを記憶するＲＯＭ（Ｒｅａｄ Ｏｎｌｙ Ｍｅｍｏｒｙ）及び演算データを格納するＲＡＭ（Ｒａｎｄｏｍ Ａｃｃｅｓｓ Ｍｅｍｏｒｙ）からなるメモリ回路５３と、ＬＡＮ２５を介して他のシステムとの間でデータの伝送を行うインターフェース回路５４と、表示システム３５に信号を供給する表示出力回路５５と、車両走行中の検出データを記録するデータ記録装置５６とを備えている。
【００３６】
ＣＰＵ５２は、図１に示すセンサにより検出される検出データに基づいて、前後方向の加速度、前後方向の速度、左右方向の加速度、左右方向の速度、上下方向の加速度、上下方向の速度、及び車体の前後軸（Ｘ軸）まわりの傾斜角であるロール角Φ、車体の左右軸（Ｙ軸）まわりの傾斜角であるピッチ角Θ、及び車体の上下軸（Ｚ軸）まわりの回転角であるヨー角Ωを算出し、算出した各種データを、ＬＡＮ２５を介して他のシステムに供給する。
【００３７】
車両１０の車体に固定された車体座標系の座標を（ｘ，ｙ，ｚ）で表し、車体の前後軸（Ｘ軸）まわりの傾斜角であるロール角Φ及び車体の左右軸（Ｙ軸）まわりの傾斜角であるピッチ角Θがともに「０」である状態、すなわち車体が傾斜していない状態に対応した基準座標系の座標を（ｘｒ，ｙｒ，ｚｒ）で表すこととすると、車体座標系の座標（ｘ，ｙ，ｚ）は、下記式（１）〜（３）により、基準座標系の座標（ｘｒ，ｙｒ，ｚｒ）に変換される。
ｘｒ＝ｘ・ｃｏｓΘ −ｚ・ｓｉｎΘ （１）
ｙｒ＝ｘ・ｓｉｎΘ・ｓｉｎΦ＋ｙ・ｃｏｓΦ＋ｚ・ｃｏｓΘ・ｓｉｎΦ （２）
ｚｒ＝ｘ・ｓｉｎΘ・ｃｏｓΦ−ｙ・ｓｉｎΦ＋ｚ・ｃｏｓΘ・ｃｏｓΦ （３）
【００３８】
各軸まわりの角速度も同様に座標変換できるので、車体座標系におけるロールレートφ、ピッチレートθ、及びヨーレートωは、下記式（４）〜（６）により、基準座標系におけるロールレートφｒ、ピッチレートθｒ、及びヨーレートωｒに変換される。
φｒ＝φ・ｃｏｓΘ −ω・ｓｉｎΘ （４）
θｒ＝φ・ｓｉｎΘ・ｓｉｎΦ＋θ・ｃｏｓΦ＋ω・ｃｏｓΘ・ｓｉｎΦ （５）
ωｒ＝φ・ｓｉｎΘ・ｃｏｓΦ−θ・ｓｉｎΦ＋ω・ｃｏｓΘ・ｃｏｓΦ （６）
【００３９】
式（４）〜（６）による座標変換では、回転の順序によって、実際の基準座標系の角速度と一致しない結果が得られる場合がある。回転角が小さい場合には、下記式（７）〜（９）が成り立つので、これらを式（５）及び（６）に適用することにより、下記式（５ａ）及び（６ａ）が得られる。
【００４０】
ｓｉｎΘ・ｓｉｎΦ≒０ （７）
ｓｉｎΘ・ｃｏｓΦ≒ｓｉｎΘ （８）
ｃｏｓΘ・ｓｉｎΦ≒ｓｉｎΦ （９）
θｒ＝ θ・ｃｏｓΦ＋ω・ｓｉｎΦ （５ａ）
ωｒ＝φ・ｓｉｎΘ−θ・ｓｉｎΦ＋ω・ｃｏｓΘ・ｃｏｓΦ （６ａ）
上記式（４）、（５ａ）及び（６ａ）による座標変換は、実際のデータとよく一致することが確認されている。サンプリング間隔はできるだけ短くすることが望ましいので、演算式はできるだけ簡単な方がよい。そのような点も考慮し、本実施形態では、近似式（５ａ）及び（６ａ）を用いた座標変換を行っている。
【００４１】
ロール角Φ及びピッチ角Θは、座標変換後のロールレートφｒ及びピッチレートθｒを積分することにより算出される。したがって、実際には、下記式（１０）〜（１２）に示すように、１サンプル周期前のロール角Φ（ｎ−１）及びピッチ角Θ（ｎ−１）を用いて、座標変換演算を行い、下記式（１３）〜（１５）により、積分演算（積算演算）を行う。

ここで、Δｔはサンプリング周期であり、例えば１０ミリ秒に設定される。またｎは、サンプリング周期Δｔで離散化されたサンプリング時刻である。
【００４２】
図４（ａ）は、走行中の車体の実際の全傾斜角（重力加速度の方向と、車体に固定したＺ軸とのなす角）と、積分全傾斜角Γと対比して示すタイムチャートである。積分傾斜角Γは、ロールレートセンサ１５及びピッチレートセンサ１４により検出されるロールレートφ及びピッチレートθをそのまま積分してロール角Φ及びピッチ角Θを算出し、これらのロール角Φ及びピッチ角Θを下記式（１６）に適用して算出される。
Γ＝ａｃｏｓ（ｃｏｓΘ×ｃｏｓΦ） （１６）
ここでａｃｏｓは、コサイン（ｃｏｓ）の逆関数である。
図４（ａ）の破線が実際の全傾斜角を示し、実線が積分全傾斜角Γを示す。この図から明らかなように、積分全傾斜角Γは、実際の全傾斜角から大きくずれることがある。
【００４３】
図４（ｂ）は、実際の全傾斜角と、上記座標変換演算により得られる変換ロールレートφｒ及び変換ピッチレートθｒを積分することにより算出されるロール角Φ及びピッチ角Θを式（１６）に適用して算出される積分全傾斜角Γとを対比して示すタイムチャートである。この図から、実際の全傾斜角（破線）と、積分全傾斜角（実線）とがよく一致していることが確認される。すなわち、上記座標変換を行うことにより、より正確なロール角Φ及びピッチ角Θが得られる。
【００４４】
図５は、ＣＰＵ１７による演算処理を説明するためのブロック図である。同図に示す機能ブロック１０１〜１２３の演算処理、及びこれらの演算処理に関連する処理がＣＰＵ１７で実行される。
前後加速度センサ１１、左右加速度センサ１２及び上下加速度センサ１３により、前後加速度ａ、左右加速度ｂ及び上下加速度ｃが検出される。また、ピッチレートセンサ１４、ロールレートセンサ１５、及びヨーレートセンサ１６により、ピッチレートθ、ロールレートφ、及びヨーレートωが検出される。
【００４５】
座標変換部１１３は、上述した座標変換演算を実行し、変換ピッチレートθｒ、変換ロールレートφｒ及び変換ヨーレートωｒを算出する。ピッチ角算出部１１４は、変換ピッチレートθｒを積分することにより、積分ピッチ角Θを算出する。ロール角算出部１１５は、変換ロールレートφｒを積分することにより、積分ロール角Φを算出する。ヨー角算出部１１５は、変換ヨーレートωｒを積分することにより、積分ヨー角Ωを算出する。
【００４６】
前後速度算出部１０１は、検出前後加速度ａを積分することにより、前後速度Ｕを算出する。ピッチ角算出部１０２は、下記式（２１）により、ピッチ角αを算出する。
α＝ａｓｉｎ（ａ／ｇ） （２１）
ここで、ａｓｉｎはサイン（ｓｉｎ）の逆関数であり、ｇは重力加速度である。
【００４７】
純前後加速度算出部１０３は、下記式（２２）に検出前後加速度ａ及び積分ピッチ角Θを適用し、純前後加速度Ａを算出する。式（２２）により、車両の左右軸（Ｙ軸）まわりの傾きに起因する前後加速度の検出誤差が補正される。
Ａ＝ａ−ｇ×ｓｉｎ（Θ） （２２）
純前後速度算出部１０４は、純前後加速度Ａを積分することにより、純前後速度Ｕｃを算出する。
【００４８】
左右速度算出部１０５は、検出左右加速度ｂを積分することにより、左右速度Ｖを算出する。ロール角算出部１０６は、下記式（２３）により、ロール角βを算出する。
β＝ａｓｉｎ（ｂ／ｇ） （２３）
純左右加速度算出部１０７は、下記式（２４）に検出左右加速度ｂび積分ロール角Φを適用し、純左右加速度Ｂを算出する。式（２４）により、車両の前後軸（Ｘ軸）まわりの傾きに起因する左右加速度の検出誤差が補正される。
Ｂ＝ｂ−ｇ×ｓｉｎ（Φ） （２４）
【００４９】
純左右速度算出部１０８は、純左右加速度Ｂを積分することにより、純左右速度Ｖｃを算出する。上下速度算出部１０９は、検出上下加速度ｃを積分することにより、上下速度Ｗを算出する。
【００５０】
全傾斜角算出部１１０は、下記式（２５）に検出上下加速度ｃを適用し、全傾斜角γを算出する。
γ＝ａｃｏｓ（ｃ／ｇ） （２５）
静止全傾斜角算出部１１２は、車両の停車時に検出されるピッチ角α及びロール角βを下記式（２６）に適用し、静止全傾斜角γ’を算出する。車両の停止状態は、例えば純前後速度Ｕｃが「０」であることにより検出される。
γ’＝ａｃｏｓ（ｃｏｓα×ｃｏｓβ） （２６）
【００５１】
積分全傾斜角算出部１１１は、下記式（１６ａ）に静止全傾斜角γ’、積分ピッチ角Θ及び積分ロール角Φを適用し、積分全傾斜角Γを算出する。
Γ＝γ’＋ａｃｏｓ（ｃｏｓΘ×ｃｏｓΦ） （１６ａ）
ここで、静止全傾斜角γ’を適用するのは初期値補正を行うためである。ピッチレートセンサ１４及びロールレートセンサ１５は、車両の停止時は出力が「０」であるため、車両停止時において路面が傾斜している場合には、積分全傾斜角Γは、正確な全傾斜角とならない。そこで、静止全傾斜角γ’を加算することにより、初期値補正が行われる。これにより、正確な積分全傾斜角を得ることができる。
【００５２】
監視部１２１は、全傾斜角γと積分全傾斜角Γとの比較を常時行い、両者の差（γ−Γ）の絶対値が所定閾値ＤＧＡＭＭＡ１を超えたとき、上下加速度センサ１３、ピッチレートセンサ１４またはロールレートセンサ１５のいずれかが故障したと判定する。
【００５３】
比較部１２３は、車両の停止時において、全傾斜角γと静止全傾斜角γ’との比較を行い、両者の差（γ−γ’）の絶対値が所定閾値ＤＧＡＭＭＡ２を超えたとき、上下加速度センサ１３、前後加速度センサ１１、または左右加速度センサ１２のいずれかが故障したと判定する。
【００５４】
左右加速度算出部１１７は、ヨーレートω及び純前後速度Ｕｃを下記式（２７）に適用し、左右加速度Ｒを算出する。
Ｒ＝ω×Ｕｃ （２７）
監視部１２２は、純左右加速度Ｂと左右加速度Ｒとの比較を常時行い、両者の差（Ｂ−Ｒ）の絶対値が所定閾値ＤＢＲを超えたとき、左右加速度センサ１２、前後加速度センサ１１、ロールレートセンサ１５、またはヨーレートセンサ１６のいずれかが故障したと判定する。
【００５５】
図６は、センサがすべて正常である場合における左右加速度Ｒと、純左右加速度Ｂとを対比して示すタイムチャートである。この図から明らかなように、センサが正常であれば、左右加速度Ｒと純左右加速度Ｂとの差（Ｂ−Ｒ）の絶対値が所定閾値ＤＢＲ以下となる。
【００５６】
なお、図７に示すように、純上下加速度算出部１３１及び純上下速度算出部１３２を設けるようにしてもよい。純上下加速度算出部１３１は、下記式（２８）に検出上下加速度ｃ、ピッチ角Θ及びロール角Φを適用し、純上下加速度Ｃを算出する。純上下速度算出部１３２は、純上下加速度Ｃを積分することにより、純上下速度Ｗｃを算出する。これにより、正確な上下加速度Ｃ及び上下速度Ｗｃを得ることができる。
Ｃ＝ｃ×ｃｏｓ（ａｃｏｓ（ｃｏｓΘ×ｃｏｓΦ）） （２８）
【００５７】
以上のように本実施形態では、座標変換部１１３を設け、車体に固定された車体座標系から車体に傾斜がない状態に対応する基準座標系への座標変換を行うようにしたので、ピッチレートセンサ出力、ロールレートセンサ出力及びヨーレートセンサ出力から、正確なピッチ角Θ、ロール角Φ及びヨー角Ωを得ることができる。
【００５８】
またピッチ角Θに応じて検出前後加速度ａを補正し、純前後加速度Ａを算出するようにしたので、正確な前後加速度を得ることができる。またロール角Φに応じて検出左右加速度ｂを補正し、純左右加速度Ｂを算出するようにしたので、正確な左右加速度を得ることができる。
【００５９】
また監視部１２１を設け、全傾斜角γと積分全傾斜角Γとを常時比較することにより、上下加速度センサ１３、ピッチレートセンサ１４またはロールレートセンサ１５の故障を判定するようにした。さらに監視部１２２を設け、純左右加速簿Ｂと左右加速度Ｒとを常時比較することにより、左右加速度センサ１２、前後加速度センサ１１、ロールレートセンサ１５、またはヨーレートセンサ１６の故障を判定するようにした。したがって、複数のセンサ出力に基づく相互監視により、故障を迅速に検出することができる。
【００６０】
（変形例）
図８は、上述した実施形態の変形例を示すブロック図である。この変形例は、車速演算部１４１が新たに設けられ、図５の左右加速度算出部１１７及び監視部１２３に代えて、左右加速度算出部１１７ａ及び監視部１２３ａが設けられている。
【００６１】
車速演算部１４１は、車輪速度センサ２１〜２４により検出される右駆動輪速度ＶＤＲ、左駆動輪速度ＶＤＬ、右従動輪速度ＶＶＲ、及び左従動輪速度ＶＶＬの平均値として、車速ＶＰを算出する。なお、車速演算部１４１は、右従動輪速度ＶＶＲ及び左従動輪速度ＶＶＬの平均値として、車速ＶＰを算出するようにしてもよい。
【００６２】
左右加速度算出部１１７ａは、下記式（２７ａ）に車速ＶＰ及びヨーレートωを適用して、左右加速度Ｒ’を算出する。
Ｒ’＝ω×ＶＰ （２７ａ）
監視部１２３ａは、純左右加速度Ｂと左右加速度Ｒ’との比較を常時行い、両者の差（Ｂ−Ｒ’）の絶対値が所定閾値ＤＢＲを超えたとき、左右加速度センサ１２、ロールレートセンサ１５、またはヨーレートセンサ１６のいずれかが故障したと判定する。
【００６３】
また監視部１２３ａは、車輪速度センサ２１〜２４のそれぞれの故障診断を行い、何れかの車輪速度センサの故障が検出されたときは、上記純左右加速度Ｂと左右加速度Ｒ’との比較による故障判定を実行しないようにする。車輪速度センサの出力がないとき、または車輪速度センサ出力の変化量の絶対値、例えば右従動輪速度ＶＶＲの今回値ＶＶＲ（ｎ）と前回値ＶＶＲ（ｎ−１）との差（ＶＶＲ（ｎ）−ＶＶＲ（ｎ−１））の絶対値が、判定閾値ＤＶを超えたとき、車輪速度センサは故障していると判定される。判定閾値ＤＶは、通常ではあり得ないような加速度（減速度）に対応した値に設定される。
【００６４】
図９は、他の変形例を説明するためのブロック図である。この変形例は、図５の静止全傾斜角算出部１１２及び積分全傾斜角算出部１１１に代えて、安定全傾斜角算出部１１２ａ及び積分全傾斜角算出部１１１ａを設けるようにしたものである。
【００６５】
安定全傾斜角算出部１１２ａは、検出ロールレートφ、検出ピッチレートθ及び検出ヨーレートωに基づいて当該車両の安定状態を判定する。具体的には、検出ロールレートφの変化量Ｄφ（＝φ（ｎ）−φ（ｎ−１））の絶対値、検出ピッチレートθの変化量Ｄθ（＝θ（ｎ）−θ（ｎ−１））の絶対値、及び検出ヨールレートωの変化量Ｄω（＝ω（ｎ）−ω（ｎ−１））の絶対値がいずれも、所定変化量ＤＳＴ以下であるとき、車両が安定状態にあると判定される。安定全傾斜角算出部１１２ａは、車両安定状態におけるピッチ角α及びロール角βを用いて、下記式（２６ａ）により、安定全傾斜角γ”を算出する。
γ”＝ａｃｏｓ（ｃｏｓα×ｃｏｓβ） （２６ａ）
【００６６】
積分全傾斜角算出部１１１ａは、下記式（１６ｂ）により、積分全傾斜角Γを算出する。すなわち、安定全傾斜角γ”を用いて初期値補正が行われる。これにより、正確な積分全傾斜角が得られる。
Γ＝γ”＋ａｃｏｓ（ｃｏｓΘ×ｃｏｓΦ） （１６ｂ）
【００６７】
上述した実施形態では、演算部１７が、座標変換手段、積分手段、左右加速度補正手段、前後加速度補正手段、上下加速度補正手段、第１の車速演算手段、第１の故障判断手段、第２の車速演算手段、第２の故障判断手段、車輪速度センサ故障判断手段、停止状態検出手段、静止傾斜角算出手段、積分傾斜角算出手段、安定状態検出手段、安定傾斜角算出手段、傾斜角算出手段、及び第３の故障判断手段を構成する。
【００６８】
より具体的には、図５の座標変換部１１３が座標変換手段に相当し、ピッチ角算出部１１４及びロール角算出部１１５が積分手段に相当し、純左右加速度算出部１０７が左右加速度補正手段に相当し、純前後加速度算出部１０３が前後加速度補正手段に相当し、純前後速度算出部１０４が第１の車速演算手段に相当し、監視部１２２が第１の故障判断手段に相当し、静止全傾斜角算出部１１２が停止状態検出手段及び静止傾斜角算出手段に相当し、積分全傾斜角算出部１１１が積分傾斜角算出手段に相当し、全傾斜角算出部１１０が傾斜角算出手段に相当し、監視部１２１が第３の故障判断手段に相当する。
【００６９】
また、図７の純上下加速度算出部１３１が上下加速度補正手段に相当し、図８の車速算出部１４１が第２の車速演算手段に相当し、監視部１２３ａが第２の故障判断手段及び車輪速度センサ故障判断手段に相当する。また、図９の安定全傾斜角算出部１１２ａが、安定状態検出手段及び安定傾斜角算出手段に相当し、積分全傾斜角算出部１１１ａが、積分傾斜角算出手段に相当する。
【００７０】
【発明の効果】
以上詳述したように請求項１に記載の発明によれば、積分手段により算出されたロール角及びピッチ角に基づいて、ロールレートセンサ及びピッチレートセンサの検出値の座標変換が行われ、より正確なロールレート及びピッチレートが得られる。また積分手段により算出されたロール角に基づいて、左右加速度センサの検出値からロール角成分を除去する補正が行われ、さらに積分手段により算出されたピッチ角に基づいて、前後加速度センサの検出値からピッチ角成分を除去する補正が行われるので、車体の前後軸まわり及び左右軸まわりの傾きがあっても、正確な左右加速度及び前後加速度が得られる。
【００７１】
請求項２に記載の発明によれば、ヨーレートセンサにより当該車両のヨーレートが検出され、積分手段により算出されたロール角及びピッチ角に基づいて、検出ヨーレートセンサの座標変換が行われ、正確なヨーレートを得ることができる。
【００７２】
請求項３に記載の発明によれば、車体の上下軸方向の加速度が検出され、積分手段により算出されるロール角及びピッチ角に基づいて、上下加速度センサの検出値からロール角成分及びピッチ角成分を除去されるので、車体の前後軸まわり及び左右軸まわりの傾きがあっても、正確な上下加速度が得られる。
【００７３】
請求項４に記載の発明によれば、前後加速度補正手段により補正された前後加速度を積分することにより車速が演算され、左右加速度補正手段により補正された左右加速度、ヨーレート検出値及び車速の関係に基づいて、左右加速度センサ、前後加速度センサ、ロールレートセンサまたはヨーレートセンサの故障が判断される。したがって、左右加速度センサ、前後加速度センサ、ロールレートセンサ及びヨーレートセンサの動作が相互に常に監視され、故障を迅速に検出することができる。
【００７４】
請求項５に記載の発明によれば、車輪速度センサにより検出された複数の車輪速度に基づいて車速が演算され、左右加速度補正手段により補正された左右加速度、ヨーレート検出値及び車速の関係に基づいて、左右加速度センサ、ロールレートセンサまたはヨーレートセンサの故障が判断される。したがって、左右加速度センサ、ロールレートセンサ及びヨーレートセンサの動作が相互に常に監視され、故障を迅速に検出することができる。
【００７５】
請求項６に記載の発明によれば、前記複数の車輪速度センサの故障が個別に判断され、車輪速度センサの故障判断なされていないことを条件として、第１の故障診断手段による故障判断が実行されるので、車輪速度センサの故障による誤判定を防止することができる。
【００７６】
請求項７に記載の発明によれば、当該車両の停止状態が検出されているときの、前後加速度センサ及び左右加速度センサの検出値に基づいて、車体の静止傾斜角が算出され、積分手段により算出されるピッチ角及びロール角に基づいて、積分傾斜角が算出される。そして静止傾斜角により、積分傾斜角の初期値補正が行われる。積分手段により算出されるピッチ角及びロール角は、車両の停止状態では「０」であるため、前後加速度センサ及び左右加速度センサの検出値に基づいて算出される静止傾斜角により初期値補正を行うことにより、正確な積分傾斜角が得られる。
【００７７】
請求項８に記載の発明によれば、ロールレートセンサ、ピッチレートセンサ及びヨーレートセンサの検出値に基づいて、当該車両の安定状態が検出され、当該車両の安定状態が検出されているときの、前後加速度センサ及び左右加速度センサの検出値に基づいて、車体の安定状態傾斜角が算出され、積分手段により算出されるピッチ角及びロール角に基づいて、積分傾斜角が算出される。そして安定状態傾斜角により、積分傾斜角の初期値補正が行われる。積分手段により算出されるピッチ角及びロール角は、車両の安定状態においては変化しないため、前後加速度センサ及び左右加速度センサの検出値に基づいて算出される安定状態傾斜角により初期値補正を行うことにより、正確な積分傾斜角が得られる。
【００７８】
請求項９に記載の発明によれば、上下加速度センサより検出された上下加速度に基づいて、車両の傾斜角が算出され、その傾斜角と、積分傾斜角算出手段により算出される積分傾斜角とを比較することにより、上下加速度センサ、ピッチレートセンサまたはロールレートセンサの故障が判断される。したがって、上下加速度センサ、ピッチレートセンサ及びヨーレートセンサの動作が相互に常に監視され、故障を迅速に検出することができる。
【図面の簡単な説明】
【図１】本発明の一実施形態にかかる車両用加速度検出装置、及びその周辺装置の構成を示すブロック図である。
【図２】車体に固定された座標軸を説明するための図である。
【図３】演算部（１７）の構成を示すブロック図である。
【図４】積分演算により算出される全傾斜角及び実際の全傾斜角の推移を示すタイムチャートである。
【図５】演算部（１７）で実行される演算処理を説明するための機能ブロック図である。
【図６】左右加速度の推移を示すタイムチャートである。
【図７】図５のブロック図に示されていない他の演算処理を説明するための機能ブロック図である。
【図８】図５に示した実施例の変形例を説明するための機能ブロック図である。
【図９】他の変形例を説明するための機能ブロック図である。
【符号の説明】
１ 慣性測定ユニット
１１ 前後加速度センサ
１２ 左右加速度センサ
１３ 上下加速度センサ
１４ ピッチレートセンサ
１５ ロールレートセンサ
１６ ヨーレートセンサ
１７ 演算部（座標変換手段、積分手段、左右加速度補正手段、前後加速度補正手段、上下加速度補正手段、第１の車速演算手段、第１の故障判断手段、第２の車速演算手段、第２の故障判断手段、車輪速度センサ故障判断手段、停止状態検出手段、静止傾斜角算出手段、積分傾斜角算出手段、安定状態検出手段、安定傾斜角算出手段、傾斜角算出手段、第３の故障判断手段）
２１ 第１車輪速度センサ
２２ 第２車輪速度センサ
２３ 第３車輪速度センサ
２４ 第４車輪速度センサ

Claims (9)

1. 車体の前後軸方向の加速度を検出する前後加速度センサと、
   車体の左右軸方向の加速度を検出する左右加速度センサと、
   前記前後軸まわりの角速度を検出するロールレートセンサと、
   前記左右軸まわりの角速度を検出するピッチレートセンサと、
   前記ロールレートセンサ及びピッチレートセンサの検出値の座標変換を行う座標変換手段と、
   該座標変換手段により座標変換されたロールレート及びピッチレートを積分することにより、ロール角及びピッチ角を算出する積分手段と、
   前記積分手段により算出されるロール角に基づいて、前記左右加速度センサの検出値からロール角成分を除去する左右加速度補正手段と、
   前記積分手段により算出されたピッチ角に基づいて、前記前後加速度センサの検出値からピッチ角成分を除去する前後加速度補正手段と
   を備え、
   前記座標変換手段は、前記積分手段により算出されたロール角及びピッチ角に基づいて、前記座標変換を行うことを特徴とする車両用加速度検出装置。
2. 車体の上下軸まわりの角速度を検出するヨーレートセンサをさらに備え、前記座標変換手段は、前記積分手段により算出されたロール角及びピッチ角に基づいて、前記ヨーレートセンサの検出値の座標変換を行うことを特徴とする請求項１に記載の車両用加速度検出装置。
3. 車体の上下軸方向の加速度を検出する上下加速度センサと、前記積分手段により算出されるロール角及びピッチ角に基づいて、前記上下加速度センサの検出値からロール角成分及びピッチ角成分を除去する上下加速度補正手段と
   をさらに備えることを特徴とする請求項１または２に記載の車両用加速度検出装置。
4. 前記前後加速度補正手段により補正された前後加速度を積分して車速を演算する第１の車速演算手段と、
   前記左右加速度補正手段により補正された左右加速度、前記ヨーレートセンサの検出値及び前記車速の関係に基づいて、前記左右加速度センサ、前後加速度センサ、ロールレートセンサまたはヨーレートセンサの故障を判断する第１の故障判断手段と
   をさらに備えることを特徴とする請求項２に記載の車両用加速度検出装置。
5. 前記車両の複数の車輪の車輪速度をそれぞれ検出する複数の車輪速度センサと、
   前記複数の車輪速度センサにより検出された複数の車輪速度に基づいて車速を演算する第２の車速演算手段と、
   前記左右加速度補正手段により補正された左右加速度、前記ヨーレートセンサの検出値及び前記車速の関係に基づいて、前記左右加速度センサ、ロールレートセンサまたはヨーレートセンサの故障を判断する第２の故障判断手段と
   をさらに備えることを特徴とする請求項２に記載の車両用加速度検出装置。
6. 前記複数の車輪速度センサの故障を個別に判断する車輪速度センサ故障判断手段を備え、
   前記第２の故障判断手段は、前記車輪速度センサの故障判断がなされていないことを条件として前記故障の判断を実行することを特徴とする請求項５に記載の車両用加速度検出装置。
7. 前記車両の停止状態を検出する停止状態検出手段と、
   該停止状態検出手段により停止状態が検出されているときの、前記前後加速度センサ及び左右加速度センサの検出値に基づいて、前記車体の静止傾斜角を算出する静止傾斜角算出手段と、
   前記積分手段により算出されるピッチ角及びロール角に基づいて、積分傾斜角を算出する積分傾斜角算出手段とをさらに備え、
   前記積分傾斜角算出手段は、前記静止傾斜角算出手段により算出された静止傾斜角により、前記積分傾斜角の初期値補正を行うことを特徴とする請求項１または２に記載の車両用加速度検出装置。
8. 前記ロールレートセンサ、ピッチレートセンサ及びヨーレートセンサの検出値に基づいて、前記車両の安定状態を検出する安定状態検出手段と、
   該安定状態検出手段により前記車両の安定状態が検出されているときの、前記前後加速度センサ及び左右加速度センサの検出値に基づいて、前記車体の安定傾斜角を算出する安定傾斜角算出手段と、
   前記積分手段により算出されるピッチ角及びロール角に基づいて、前記積分傾斜角を算出する積分傾斜角算出手段とをさらに備え、
   前記積分傾斜角算出手段は、前記安定傾斜角算出手段により算出された安定傾斜角により、前記積分傾斜角の初期値補正を行うことを特徴とする請求項２に記載の車両用加速度検出装置。
9. 前記上下加速度センサにより検出された上下加速度に基づいて、前記車両の傾斜角を算出する傾斜角算出手段と、
   該傾斜角算出手段により算出される傾斜角と、前記積分傾斜角算出手段により算出される積分傾斜角とを比較することにより、前記上下加速度センサ、ピッチレートセンサまたはロールレートセンサの故障を判断する第３の故障判断手段
   とをさらに備えることを特徴とする請求項７または８に記載の車両用加速度検出装置。

Images