JP5128457B2 - 車両姿勢角推定装置及びプログラム - Google Patents

車両姿勢角推定装置及びプログラム Download PDF

Info

Publication number
JP5128457B2
JP5128457B2 JP2008322315A JP2008322315A JP5128457B2 JP 5128457 B2 JP5128457 B2 JP 5128457B2 JP 2008322315 A JP2008322315 A JP 2008322315A JP 2008322315 A JP2008322315 A JP 2008322315A JP 5128457 B2 JP5128457 B2 JP 5128457B2
Authority
JP
Japan
Prior art keywords
state quantity
acceleration state
deviation
lateral
vehicle body
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.)
Expired - Fee Related
Application number
JP2008322315A
Other languages
English (en)
Other versions
JP2010143379A (ja
Inventor
英一 小野
有美子 三浦
克之 山口
大祐 安富
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.)
Toyota Motor Corp
Toyota Central R&D Labs Inc
Original Assignee
Toyota Motor Corp
Toyota Central R&D Labs Inc
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 Toyota Motor Corp, Toyota Central R&D Labs Inc filed Critical Toyota Motor Corp
Priority to JP2008322315A priority Critical patent/JP5128457B2/ja
Publication of JP2010143379A publication Critical patent/JP2010143379A/ja
Application granted granted Critical
Publication of JP5128457B2 publication Critical patent/JP5128457B2/ja
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • B60W40/112—Roll movement

Landscapes

  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Description

本発明は、車両姿勢角推定装置及びプログラムにかかり、特に、ピッチ角速度の推定値を利用してオブザーバによって車両物理量としての鉛直軸に対する車両の姿勢角であるロール角及びピッチ角を推定する車両姿勢角推定装置及びプログラムに関する。
剛体運動の加速度及び角速度とオイラー角で記述される車両の姿勢角との関係は、非特許文献１等で知られており、この関係に基づいて積分演算を行うことによって、車両の姿勢角を導出することができる。しかしながら、単純な積分演算ではセンサドリフト誤差が蓄積されて正確な姿勢角を導出することはできない。このような積分演算での誤差の蓄積を回避するためには、他のセンサ信号の出力と比較し、略一致するように出力を補正するオブザーバを構成する必要がある。
また、車体の鉛直軸に対するロール角を推定する従来技術として、スピン等の影響を受けない低周波数領域の車両運動の横方向の成分と車両の姿勢角の影響との関係からロール角を推定する技術が知られている（特許文献１）。
航空機力学入門（p12、加藤、大屋、柄沢：東京大学出版会、1982） 特開２００８−９４３７５号公報
しかしながら、上記の特許文献１に記載の技術では、姿勢角オブザーバにおいて、「時定数の長いフィルタ処理した鉛直方向加速度は重力加速度に等しい」という条件を利用しており、この条件は、路面勾配変化などによる短時間の鉛直方向加速度変化をフィルタによって除去できることを仮定して設定された条件であり、下り坂から上り坂に変化する路面勾配の最下点で、鉛直方向加速度が増大する場合には、フィルタ処理によって、鉛直方向加速度が変化することによる影響を十分に除去できないため、推定精度が劣化してしまう、という問題がある。
本発明は、上記の問題点を解決するためになされたもので、鉛直方向加速度が変化する路面であっても、精度よく姿勢角を推定することができる車両姿勢角推定装置及びプログラムを提供することを目的とする。
上記目的を達成するために第１の発明の車両姿勢角推定装置は、各輪の車輪速度に基づいて車両前後方向の車体速度である前後車体速度を推定する前後速度推定手段と、車両横方向の車体速度である横車体速度を推定する横速度推定手段と、ピッチ角速度を推定するピッチ角速度推定手段と、車両運動の前後加速度、横加速度、上下加速度、ロール角速度、及びヨー角速度の各検出値に応じたセンサ信号、前記前後車体速度の推定値、並びに前記ピッチ角速度の推定値に基づいて、車体の鉛直軸に対する姿勢角であるロール角及びピッチ角を推定する姿勢角推定手段と、を含む車両姿勢角推定装置であって、前記姿勢角推定手段は、前記ロール角の推定値及び前記ピッチ角の推定値を用いて得られる前後加速度状態量、横加速度状態量、及び鉛直加速度状態量の少なくとも１つを、飽和特性を持たせるように補正する補正手段と、前記前後加速度状態量、前記横加速度状態量、及び前記鉛直加速度状態量と、前記センサ信号、前記前後車体速度の推定値、及び前記横車体速度の推定値を用いて得られる前後加速度状態量及び横加速度状態量とに基づいて、ローパスフィルタ処理が行われた、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算する状態量偏差演算手段とを備え、前記演算された前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差をフィードバックして、前記ロール角及びピッチ角を推定するようにしたものである。
第２の発明のプログラムは、コンピュータを、各輪の車輪速度に基づいて車両前後方向の車体速度である前後車体速度を推定する前後速度推定手段、車両横方向の車体速度である横車体速度を推定する横速度推定手段、ピッチ角速度を推定するピッチ角速度推定手段、及び車両運動の前後加速度、横加速度、上下加速度、ロール角速度、及びヨー角速度の各検出値に応じたセンサ信号、前記前後車体速度の推定値、並びに前記ピッチ角速度の推定値に基づいて、車体の鉛直軸に対する姿勢角であるロール角及びピッチ角を推定する姿勢角推定手段として機能させるためのプログラムであって、前記姿勢角推定手段は、前記ロール角の推定値及び前記ピッチ角の推定値を用いて得られる前後加速度状態量、横加速度状態量、及び鉛直加速度状態量の少なくとも１つを、飽和特性を持たせるように補正する補正手段と、前記前後加速度状態量、前記横加速度状態量、及び前記鉛直加速度状態量と、前記センサ信号、前記前後車体速度の推定値、及び前記横車体速度の推定値を用いて得られる前後加速度状態量及び横加速度状態量とに基づいて、ローパスフィルタ処理が行われた、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算する状態量偏差演算手段とを備え、前記演算された前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差をフィードバックして、前記ロール角及びピッチ角を推定するようにしたものである。
第１の発明及び第２の発明では、ロール角の推定値及びピッチ角の推定値を用いて得られる前後加速度状態量、横加速度状態量、及び鉛直加速度状態量の少なくとも１つを、飽和特性を持たせるように補正する。また、前後加速度状態量、横加速度状態量、及び鉛直加速度状態量と、センサ信号、前後車体速度の推定値、及び横車体速度の推定値を用いて得られる前後加速度状態量及び横加速度状態量とに基づいて、ローパスフィルタ処理が行われた、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算する。そして、演算された前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差をフィードバックして、ロール角及びピッチ角を推定する。
第１の発明及び第２の発明では、ロール角の推定値及びピッチ角の推定値を用いて得られる前後加速度状態量、横加速度状態量、及び鉛直加速度状態量の少なくとも１つを、飽和特性を持たせるように補正して、ローパスフィルタ処理が行われた、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算し、フィードバックしているので、鉛直方向加速度が変化する路面であっても、精度よく姿勢角を推定することができる。
第３の発明に係る車両姿勢角推定装置は、各輪の車輪速度に基づいて車両前後方向の車体速度である前後車体速度を推定する前後速度推定手段と、車両横方向の車体速度である横車体速度を推定する横速度推定手段と、ピッチ角速度を推定するピッチ角速度推定手段と、車両運動の前後加速度、横加速度、上下加速度、ロール角速度、及びヨー角速度の各検出値に応じたセンサ信号、前記前後車体速度の推定値、並びに前記ピッチ角速度の推定値に基づいて、車体の鉛直軸に対する姿勢角であるロール角及びピッチ角を推定する姿勢角推定手段と、を含む車両姿勢角推定装置であって、前記姿勢角推定手段は、前記ロール角の推定値及び前記ピッチ角の推定値を用いて得られる前後加速度状態量、横加速度状態量、及び鉛直加速度状態量と、前記センサ信号、前記前後車体速度の推定値、及び前記横車体速度の推定値を用いて得られる前後加速度状態量及び横加速度状態量とに基づいて、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算すると共に、前記前後加速度状態量の偏差、前記横加速度状態量の偏差、及び前記鉛直加速度状態量の偏差の少なくとも１つを、飽和特性を持たせるように補正する補正手段と、前記前後加速度状態量の偏差、前記横加速度状態量の偏差、及び前記鉛直加速度状態量の偏差に対して、ローパスフィルタ処理が行うローパスフィルタ処理手段とを備え、前記ローパスフィルタ処理が行われた、前記前後加速度状態量の偏差、前記横加速度状態量の偏差、及び前記鉛直加速度状態量の偏差をフィードバックして、前記ロール角及びピッチ角を推定するようにしたものである。
第４の発明のプログラムは、コンピュータを、各輪の車輪速度に基づいて車両前後方向の車体速度である前後車体速度を推定する前後速度推定手段、車両横方向の車体速度である横車体速度を推定する横速度推定手段、ピッチ角速度を推定するピッチ角速度推定手段、及び車両運動の前後加速度、横加速度、上下加速度、ロール角速度、及びヨー角速度の各検出値に応じたセンサ信号、前記前後車体速度の推定値、並びに前記ピッチ角速度の推定値に基づいて、車体の鉛直軸に対する姿勢角であるロール角及びピッチ角を推定する姿勢角推定手段として機能させるためのプログラムであって、前記姿勢角推定手段は、前記ロール角の推定値及び前記ピッチ角の推定値を用いて得られる前後加速度状態量、横加速度状態量、及び鉛直加速度状態量と、前記センサ信号、前記前後車体速度の推定値、及び前記横車体速度の推定値を用いて得られる前後加速度状態量及び横加速度状態量とに基づいて、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算すると共に、前記前後加速度状態量の偏差、前記横加速度状態量の偏差、及び前記鉛直加速度状態量の偏差の少なくとも１つを、飽和特性を持たせるように補正する補正手段と、前記前後加速度状態量の偏差、前記横加速度状態量の偏差、及び前記鉛直加速度状態量の偏差に対して、ローパスフィルタ処理が行うローパスフィルタ処理手段とを備え、前記ローパスフィルタ処理が行われた、前記前後加速度状態量の偏差、前記横加速度状態量の偏差、及び前記鉛直加速度状態量の偏差をフィードバックして、前記ロール角及びピッチ角を推定するようにしたものである。
第３の発明及び第４の発明では、ロール角の推定値及びピッチ角の推定値を用いて得られる前後加速度状態量、横加速度状態量、及び鉛直加速度状態量と、センサ信号、前後車体速度の推定値、及び横車体速度の推定値を用いて得られる前後加速度状態量及び横加速度状態量とに基づいて、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算する。そして、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差の少なくとも１つを、飽和特性を持たせるように補正し、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差に対して、ローパスフィルタ処理が行う。そして、ローパスフィルタ処理が行われた、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差をフィードバックして、ロール角及びピッチ角を推定する。
第３の発明及び第４の発明では、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差の少なくとも１つを、飽和特性を持たせるように補正して、ローパスフィルタ処理が行われた、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算し、フィードバックしているので、鉛直方向加速度が変化する路面であっても、精度よく姿勢角を推定することができる。
上記の車両姿勢角推定装置には、車両運動の前後加速度、横加速度、上下加速度、ヨー角速度、及びロール角速度の各々を検出して検出値に応じたセンサ信号を出力するセンサを設けることができる。
また、ピッチ角速度は、前後車体速度の推定値、横車体速度の推定値、上下加速度の検出値、ロール角速度の検出値、姿勢角推定手段で推定されたロール角の前回推定値、及び姿勢角推定手段で推定されたピッチ角の前回推定値に基づいて、推定することができる。これによって、車体の上下方向運動の釣り合いからピッチ角速度を推定し、ピッチ角速度の推定値を利用して車体の鉛直軸に対する姿勢角であるロール角及びピッチ角を推定しているので、上下加速度が増加するバンク走行時においても精度良くロール角及びピッチ角を推定することができる。
また、上記の各発明のプログラムを、記憶媒体に格納して提供することもできる。
以上説明したように本発明によれば、ロール角の推定値及びピッチ角の推定値を用いて得られる前後加速度状態量、横加速度状態量、及び鉛直加速度状態量の少なくとも１つを、飽和特性を持たせるように補正し、又は、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差の少なくとも１つを、飽和特性を持たせるように補正して、ローパスフィルタ処理が行われた、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算し、フィードバックしているので、鉛直方向加速度が変化する路面であっても、精度よく姿勢角を推定することができる、という効果が得られる。
以下、図面を参照して本発明の実施の形態を詳細に説明する。本実施の形態は、鉛直軸に対する車両の姿勢角であるピッチ角及びロール角を推定する車両姿勢角推定装置に本発明を適用したものである。
図１に示すように、第１の実施の形態の車両姿勢角推定装置には、車両横方向の車体速度である横車体速度Ｖを推定する横速度推定手段１０、及び各輪の車輪速度に基づいて車両前後方向の車体速度である前後車体速度Ｕを推定する前後速度推定手段１２が設けられている。
横車体速度Ｖは、カルマンフィルタ等を用いて推定したり、横加速度センサの検出値から推定したりすることができる。
各輪の車輪速度は、各輪に対応して設けられた車輪速センサにより検出することができ、前後車体速度Ｕは各輪の車輪速度、または各輪の車輪速度及び車輪速度の微分値から推定することができる。例えば、制動時には、４輪の車輪速度の最大値を前後車体速度Ｕとして出力し、駆動時には、従動輪の車輪速度の平均値を前後車体速度Ｕとして出力することができる。
また、本実施の形態の車両姿勢角推定装置には、車両運動のｘｙｚ３軸の加速度である上下加速度Ｇｚ、横加速度Ｇｙ、前後加速度Ｇｘの各々を検出する上下加速度センサ１４、横加速度センサ１６、及び前後加速度センサ１８が設けられている。図２に示すように、ｘ軸は車両前後方向、ｙ軸は車両幅方向（横方向）、ｚ軸は車両上下方向に対応している。
また、本実施の形態の車両姿勢角推定装置には、ロール角速度Ｐを検出するロール角速度センサ２０、及びヨー角速度Ｒを検出するヨー角速度センサ２２が設けられている。
横速度推定手段１０、前後速度推定手段１２、上下加速度センサ１４、及びロール角速度センサ２０は、ピッチ角速度Ｑを推定するピッチ角速度推定手段２４に接続されている。
横速度推定手段１０、前後速度推定手段１２、横加速度センサ１６、前後加速度センサ１８、及びヨー角速度センサ２２は、着目すべき運動のみを通過させるローパスフィルタ処理が施された、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差の各々のローパスフィルタ処理値を演算する状態量偏差ローパスフィルタ値演算手段２６に接続されている。
状態量偏差ローパスフィルタ値演算手段２６は、車体の鉛直軸に対する姿勢角であるロール角φ及びピッチ角θを推定する姿勢角推定手段２８に接続されている。姿勢角推定手段２８には、更に、上下加速度センサ１４、横加速度センサ１６、前後加速度センサ１８、ロール角速度センサ２０、ヨー角速度センサ２２、及びピッチ角速度推定手段２４が接続されている。
また、姿勢角推定手段２８には、更に、鉛直加速度状態量を算出すると共に、鉛直加速度状態量に対して飽和特性を持たせるように補正する加速度状態量飽和特性補正手段３０と、前後、横、鉛直加速度状態量の偏差のローパスフィルタ処理値のフィードバックゲインを設定するフィードバックゲイン設定手段３２と、が接続されている。
姿勢角推定手段２８は、ローパスフィルタ処理された前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を、フィードバックゲインを用いてフィードバックすると共に、車両運動の前後加速度Ｇｘ、横加速度Ｇｙ、上下加速度Ｇｚ、ロール角速度Ｐ、及びヨー角速度Ｒの各検出値に応じたセンサ信号と、ピッチ角速度Ｑの推定値とに基づいて、車体の鉛直軸に対する姿勢角であるロール角φ及びピッチ角θを推定する。また、姿勢角推定手段２８は、ロール角φ及びピッチ角θの推定値を前回値として、ピッチ角速度推定手段２４、加速度状態量飽和特性補正手段３０、及びフィードバックゲイン設定手段３２に入力するように、ピッチ角速度推定手段２４、加速度状態量飽和特性補正手段３０、及びフィードバックゲイン設定手段３２に接続されている。また、姿勢角推定手段２８は、オブザーバから出力される、ローパスフィルタ処理された前後加速度状態量、横加速度状態量、及び鉛直加速度状態量を、状態量偏差ローパスフィルタ値演算手段２６に入力するように、状態量偏差ローパスフィルタ値演算手段２６に接続されている。
なお、本実施の形態における、状態量偏差ローパスフィルタ値演算手段２６、姿勢角推定手段２８、加速度状態量飽和特性補正手段３０、及びフィードバックゲイン設定手段３２は、本発明の姿勢角推定手段に対応し、状態量偏差ローパスフィルタ値演算手段２６は、本発明の状態量偏差演算手段に対応し、加速度状態量飽和特性補正手段３０は、本発明の補正手段に対応している。
横速度推定手段１０、前後速度推定手段１２、ピッチ角速度推定手段２４、状態量偏差ローパスフィルタ値演算手段２６、姿勢角推定手段２８、加速度状態量飽和特性補正手段３０、フィードバックゲイン設定手段３２は、各手段の機能を実現する１つまたは複数のコンピュータ、または１つまたは複数の電子回路で構成することができる。
次に、ピッチ角速度の推定について説明する。剛体に固定された３軸加速度及び３軸角速度を検出する３軸センサから出力されるセンサ信号と運動状態量との関係を表す剛体の運動方程式は、以下のように記述することができる。
ただし、 Ｇｘ：前後加速度、Ｇｙ：横加速度、Ｇｚ：上下加速度、Ｐ：ロール角速度、Ｑ：ピッチ角速度、Ｒ：ヨー角速度、Ｕ：前後速度、Ｖ：横速度、Ｗ：上下速度、φ：ロール角、θ：ピッチ角、g：重力加速度である。
本実施の形態において車両を剛体とした場合、前後加速度Ｇｘ、横加速度Ｇｙ、上下加速度Ｇｚ、ロール角速度Ｐ、及びヨー角速度Ｒの各々は、前後加速度センサ１８、横加速度センサ１６、上下加速度センサ１４、ロール角速度センサ２０、及びヨー角速度センサ２２によって検出される。横速度Ｖは、上記で説明したように横速度推定手段１０で推定することができ、前後速度Ｕは、各輪の車輪速に基づいて上記で説明したように前後速度推定手段１２で推定することができる。
なお、本実施の形態では、図２に示すように車体の上向きをｚ軸の正方向とする右手系で座標を記述すると共に角度はオイラー角で表現している。
バンク走行中は、遠心力によって上下加速度Ｇｚが増加する。上下加速度Ｇｚの増加は、上記（３）式において左辺の−ＱＵが大きくなることと対応しており、この性質を利用し、（３）式において上下速度Ｗの変化を無視（Ｗ＝０とする）すると共に、ロール角及びピッチ角の各々の前回値、及び横速度の推定値、前後速度Ｕとして前後車体速度の推定値Ｖｓ０を用いることによりことにより、ピッチ角速度の推定値を以下の式から求めることができる。ピッチ角速度推定手段２４は、下記（６）式の演算を実行することによりピッチ角速度の推定値を求める。
ピッチ角速度が上記のように推定されると、ピッチ角もロール角と同時に姿勢角オブザーバによって推定することができる。姿勢角オブザーバを用いた場合の自動車固有の運動の拘束条件について説明する。上記の運動方程式を利用して、姿勢角オブザーバを構成する場合、積分演算によって推定される速度及び角度の状態量が発散しないように、測定できる物理量のフィードバックが必要となる。本実施の形態では、自動車運動固有の特徴を以下のようにフィードバックする物理量に利用する。なお、以下の式では、ロール角及びピッチ角として各々の前回推定値、横速度として横車体速度の推定値、前後速度Ｕとして前後車体速度の推定値Ｖｓ０を各々用いている。
前後車体速度の推定値Ｖｓ０を微分して上記（１）式に代入し、自動車運動固有の特徴として、車体の前後方向に関しては「車輪のスリップは長時間増加し続けない」という性質を利用すると、上記（１）式から、上下速度の変化を無視したフィードバックに利用する以下の（７）式に示す条件が得られる。
上記（７）式は、車輪速度から推定される加速度（前後車体速度の推定値Ｖｓ０の微分値）と前後加速度Ｇｘとの差と、ピッチ角θとの関係を記述している。
また、車体の横方向に関しては、「スリップ角は長時間増加し続けない」という性質からロール角速度及び横加速度が無視できることから、上記（２）式から、フィードバックに利用する以下の（８）式に示す条件が得られる。
さらに、一般的な道路勾配を考慮すると、「鉛直方向の加速度は、重力加速度に略一致している」とみなすことができる。この条件は前後加速度Ｇｘ、横加速度Ｇｙ、上下加速度Ｇｚ、ピッチ角θ、及びロール角φを用いて、以下の（９）式に示す代数方程式によって記述することができる。
次に、基本的な非線形オブザーバの構成について説明する。ここでは、センサから出力されるセンサ信号、及びピッチ角速度の推定値を含む値ｕを下記（１０）式のように表現している。
また、対象となる車両運動を下記（１１）式のように表現し、オブザーバを構成するために測定できる物理量を（１２）式のように表現すると、非線形オブザーバは、以下の（１３）式及び（１４）式の非線形運動方程式によって記述することができる。
ただし、ｘのチルダ、ｙのチルダは、それぞれｘ、ｙの推定値を表わし、ｋ（ｘのチルダ、ｕ）は設計するオブザーバゲインを表わしている。
上記（７）式〜（９)式は、何れもある程度長い時間を考慮したときに満足する条件であることから、オブザーバの測定量のフィードバックには、上記（７）〜（９）式の両辺の各々をローパスフィルタでローパスフィルタ処理した値を利用する。
以下の（１５）〜（１７）式に示す微分方程式を解くことにより、上記（７）〜（９）式の右辺、すなわち、ロール角の推定値及びピッチ角の推定値を用いて得られる前後加速度状態量、横加速度状態量、及び鉛直加速度状態量を、ローパスフィルタでローパスフィルタ処理した値が演算される。
ただし、τx、 τy、 τgは各々（７）〜（９）式で考慮するローパスフィルタの数秒から数十秒以上の時定数を表している。
上記（４）式、（５）式の角度に関する状態方程式には、速度の状態量が含まれていないことから、速度の推定と分離して、角度としてロール角φ及びピッチ角θを推定することができる。
このため、まず、上記のローパスフィルタによって得られる前後加速度状態量、横加速度状態量、及び鉛直加速度状態量を含め、ロール角及びピッチ角を推定するためのオブザーバを構成する。本実施の形態では、オブザーバの状態量を下記（１８）式で表す。
なお、上記の各変数のチルダは、推定値であることを意味している。
また、フィードバックに用いるオブザーバ出力としての状態量は、下記（１９）式で表わされる。
さらに、センサ信号等から演算される、車両出力としての前後加速度状態量、横加速度状態量、及び鉛直加速度状態量からなる状態量ｙは、以下の（２０）式で表わされる。
ただし、
なお、上記（２１）式の右辺第２項の分子は、上記（７）式の左辺、すなわち、前後車体速度の推定値Ｖｓ０の微分値から、３軸センサで検出されたヨー角速度値Ｒと横車体速度の推定値との積と、３軸センサで検出された前後加速度値Ｇｘとの和を減算した前後加速度状態量である。また、上記（２２）式の右辺第２項の分子は、上記（７）式の左辺、すなわち、３軸センサで検出されたヨー角速度値Ｒと前後車体速度の推定値Ｖｓ０との積から３軸センサで検出された横加速度値Ｇｙを減算した横加速度状態量である。
上記（２１）式、（２２）式に示す微分方程式を解くことにより、センサ信号、前後車体速度の推定値、及び横車体速度の推定値を用いて得られる前後加速度状態量及び横加速度状態量を、ローパスフィルタでローパスフィルタ処理した値が演算される。また、上記（２０）式におけるｇは、鉛直加速度状態量である。
上記（１５）式〜（１７）式から演算される前後加速度状態量、横加速度状態量、及び鉛直加速度状態量の各々のローパスフィルタ処理値と、上記（２０）式が表わす前後加速度状態量、横加速度状態量、及び鉛直加速度状態量の各々のローパスフィルタ処理値とに基づいて、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差の各々のローパスフィルタ処理値を演算する。
また、本実施の形態では、適切なオブザーバゲインｋ（ｘのチルダ，ｕ）を設定することによって、ロール角及びピッチ角を推定する姿勢角オブザーバを構成している。
次に、ロール角φ及びピッチ角θを推定する姿勢角オブザーバについて説明する。
まず、オブザーバゲインの一例として、オブザーバの安定性を確保するため、線形化を行ったときの対角成分が負の係数を持つように、下記（２３）式のように表されるオブザーバゲインを設定した場合について説明する。
ただし、Ｋφｙ、 Ｋφg、 Ｋθｘ、 Ｋθg、 Ｋx、 Ｋy、 Ｋgは適切な正の定数である。
この場合には、ロール角及びピッチ角を推定する非線形オブザーバとなる姿勢角オブザーバは、以下の（２４）式に示す運動方程式で記述される。
ただし、ｘのチルダは、以下の（２５）式で表される。
ここで、上記（２４）式に示す非線形オブザーバを利用して、山岳サーキットコース走行時の姿勢角を推定した結果について、図３（Ａ）、（Ｂ）を参照して説明する。図３（Ａ）に示すように、１２〜１５ｓ付近で、実際のバンク角などの路面状況からは想定できない大きなロール角が推定されている。
このようなロール角推定値の異常は、下り坂から上り坂に変化する路面勾配の最下点で発生しており、鉛直方向加速度が増大することと関係あると推測できる。ここでの姿勢角オブザーバでは、「時定数の長いフィルタ処理した鉛直方向加速度は重力加速度に等しい」という条件を利用している。この条件は、路面勾配変化などによる短時間の鉛直方向加速度の変化は、フィルタによって除去できることを仮定して設定された条件であるが、上記の山岳サーキットコース走行のような限界走行では、鉛直方向加速度の変化の影響を十分に除去できなかったことが予想される。
図４（Ａ）〜（Ｃ）に示すように、ローパスフィルタ処理後の鉛直加速度、横加速度、及びロール角推定値の時間変化が得られ、図４（Ａ）に示すように、１２〜１５ｓ付近で、フィルタ処理後の鉛直加速度が増加しているため、路面勾配変化などによる鉛直方向加速度の変化を、フィルタによって除去できなかったことがわかる。
また、上記（２４）式からわかるように、上記（１７）式で演算されるフィルタ処理後の鉛直加速度状態量が増加すると、ロール角推定値を演算する上記（２４）式の１行目が増減（増減は、横加速度の符号に依存）する。例えば、上記図４（Ａ）、（Ｂ）に示すように、鉛直方向加速度が増大している時（オブザーバへのフィードバック量ｇ−ｇｆのチルダが負になる時）に、負の横加速度が生じた場合には、上記（２４）式の１行目は増加方向に修正され、図４（Ｃ）に示すように、ロール角が、大きく正の値として推定演算される。
上述したように、下り坂から上り坂に変化する路面勾配の最下点で発生するロール角推定値の発散現象（絶対値の増加）は、鉛直加速度に関する条件のフィードバックに起因すると推測される。
そこで、下り坂から上り坂に変化する路面勾配の最下点で、鉛直加速度に関する条件のフィードバックを緩和するような補正を行うことにより、ロール角推定値の発散現象（絶対値の増加）の抑制を図ることが考えられる。
本実施の形態では、路面勾配変化などによる短時間の鉛直方向加速度の変化を除去するために、ローパスフィルタへの入力信号に飽和特性を追加する。すなわち、上記（１７）式の代わりに、以下の（２６）式で得られる、鉛直加速度状態量のローパスフィルタ処理値を、フィードバックに利用する。
ここで、ｇｍは、上記（２６）式のローパスフィルタに入力される鉛直加速度状態量ｇｖを制限するための定数である。
上記（２７）式に示すように、鉛直加速度状態量に対して飽和特性を持たせることにより、鉛直加速度状態量が上限値以上であれば、鉛直加速度状態量を上限値に補正し、鉛直加速度状態量が下限値以下であれば、鉛直加速度状態量を下限値に補正する。
加速度状態量飽和特性補正手段３０は、上記（２８）式に従って、鉛直加速度状態量を演算すると共に、上記（２７）式に従って、鉛直加速度状態量に対して飽和特性を持たせるように、演算した鉛直加速度状態量を補正する。また、後述するように、姿勢角推定手段２８の姿勢角オブザーバにおいて、上記（２６）式に従って、補正した鉛直加速度状態量のローパスフィルタ処理値を演算する。
状態量偏差ローパスフィルタ値演算手段２６は、横加速度センサ１６、前後加速度センサ１８、及びヨー角速度センサ２２の各々の検出値、横車体速度の推定値、並びに前後車体速度の推定値に基づいて、上記（２０）式に示すローパスフィルタ処理が行われた前後加速度状態量、及び横加速度状態量を演算し、演算した前後加速度状態量、及び横加速度状態量と、姿勢角オブザーバにおいて上記（１５）式、（１６）式に従って演算された、ローパスフィルタ処理が行われた前後加速度状態量及び横加速度状態量と、姿勢角オブザーバにおいて上記（２６）式に従って演算された、ローパスフィルタ処理が行われた鉛直加速度状態量とに基づいて、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差の各々のローパスフィルタ処理値を演算する。
次に、本実施の形態におけるオブザーバゲインを設定する原理について説明する。
まず、上記（２４）式に示す非線形オブザーバを動作点周りで線形化し、線形化されたシステムの安定性を解析する。上記（２４）式を線形化した（ｄｘのチルダ／ｄｔ＝Ａｘ＋Ｂｕと表わした）ときのＡ行列は、以下の（２９）式で表される。
上記（２９）式で、各変数の添え字の０は、動作点での値を表現している。
また、ロール角、ピッチ角、ピッチ角速度、ヨー角速度、前後加速度、横加速度に関して、車両運動の想定されうる領域を設定し、この領域内の任意の点での安定性を調査した結果について説明する。
図５に、この安定性の解析結果を示す。図５では、ピッチ角を横軸に、ロール角を縦軸に表示しており、その他のすべてのパラメータを想定範囲内で探索し、１点でも不安定な動作点が存在した場合に＋の記号を表示している。また、図５には、不安定極の最大実部の値を等高線で示している。上記（２３）式に示すオブザーバゲインを用いた場合には、姿勢角の増大に伴い、オブザーバの不安定化の可能性のある領域が生じていることがわかる。
鉛直加速度状態量の偏差のフィードバックゲインに相当する上記（２３）式の１行３列、２行３列における前後加速度及び横加速度は、それぞれのセンサ信号の符号に応じたゲイン設定を目的としているが、これに対し、本実施の形態では、不安定領域を安定化するため、以下の（３０）式に示すように、オブザーバゲインを設定する。
ただし、鉛直加速度状態量の偏差のフィードバックゲインに相当する上記（３０）式の１行３列、２行３列におけるＫφｇ（Ｇｙ）、Ｋθｇ（Ｇｘ）について、以下の（３１）式、（３２）式に示すように、並進加速度（前後加速度、横加速度）に対する飽和特性を持たせて、オブザーバゲインが過大となることを防止する。
なお、Ｋφｇ０、Ｋθｇ０は定数ゲインであり、Ｇｙｍ、Ｇｘｍは、ゲインの増大を抑制するための前後加速度の上限値、横加速度の上限値であり、−Ｇｙｍ、−Ｇｘｍは、ゲインの増大を抑制するための前後加速度の下限値、横加速度の下限値である。
上記（２４）式の１行目における鉛直加速度状態量の偏差のフィードバックゲインは、ＫφｇＧｙであり、横加速度Ｇｙの値に比例する構成となっているが、本実施の形態では、上記（３０）式のように、鉛直加速度状態量の偏差のフィードバックゲインに対して、横加速度に応じた飽和特性を持たせることによって、ロール角推定値の発散現象（絶対値の増加）を抑制することができる。また、上記（３１）式、（３２）式は、鉛直加速度状態量偏差のフィードバックゲインであり、ゲイン増大を抑制することにより、鉛直加速度状態量の偏差の増大時における姿勢角誤差の増大を抑制することができる。
さらに、前後、横加速度状態量の偏差のフィードバックゲインを、姿勢角に応じて変化させることによって、姿勢角の大きな領域のオブザーバ安定性が確保できることに着目し、図６に示すように、ピッチ角の推定値の絶対値、ロール角の推定値の絶対値が大きいほど、前後、横加速度状態量の偏差のフィードバックゲインに相当する上記（３０）式の２行１列、１行２列におけるＫφｘ、Ｋθｙを増大させて、前後、横加速度状態量偏差信号のフィードバックゲインの絶対値を増加させる。これによって、上記図５の不安定領域でＫφｘ、Ｋθｙの制御ゲインを大きく設定して安定化を図ることができ、図７に示すように、広い範囲で、オブザーバの安定化が可能である。
フィードバックゲイン設定手段３２は、鉛直加速度状態量の偏差のフィードバックゲインにおけるＫφｇ（Ｇｙ）、Ｋθｇ（Ｇｘ）について、前後加速度に対する飽和特性及び横加速度に対する飽和特性を持たせるように設定すると共に、ピッチ角の推定値の絶対値、ロール角の推定値の絶対値が大きくなるほど、前後、横加速度状態量の偏差のフィードバックゲインの絶対値を大きくようにＫφｘ、Ｋθｙを設定する。
次に、本実施の形態で用いるロール角φ及びピッチ角θを推定する非線形オブザーバについて説明する。ロール角及びピッチ角を推定する非線形オブザーバは、以下の（３３）式に示す運動方程式で記述される。
姿勢角推定手段２８は、上記（３３）式を用いることにより、車体鉛直方向に対する姿勢角であるロール角の微分量ｄφのチルダとピッチ角の微分量ｄθのチルダとを算出し、算出したロール角の微分量ｄφのチルダ及びピッチ角の微分量ｄθのチルダの各々を積分することにより、ロール角φのチルダ及びピッチ角θのチルダを算出することができる。また、姿勢角推定手段２８は、上記（３３）式を用いることにより、ローパスフィルタ処理が行われた前後加速度状態量、横加速度状態量、及び鉛直加速度状態量を算出する。
コンピュータを、横速度推定手段１０、前後速度推定手段１２、ピッチ角速度推定手段２４、状態量偏差ローパスフィルタ値演算手段２６、姿勢角推定手段２８、加速度状態量飽和特性補正手段３０、及びフィードバックゲイン設定手段３２の各手段として機能させるプログラムによる情報処理は、図８のフローチャートに示す姿勢角推定処理ルーチンで実現することができる。コンピュータは、相互にバスによって接続されたＣＰＵ、ＲＯＭ、及びＲＡＭ、並びに必要に応じて接続されたＨＤＤで構成され、これらのプログラムは、コンピュータのＣＰＵに接続されているＲＯＭまたはＨＤＤ等の記録媒体に記録される。
この姿勢角推定処理ルーチンを説明すると、ステップ１００で、上記で説明したように横車体速度を推定し、ステップ１０２において各輪の車輪速度に基づいて前後車体速度を推定する。
ステップ１０４において、最初の演算か否かを判断し、最初の演算の場合には、ロール角及びピッチ角の前回推定値、並びに前後、横、鉛直加速度状態量の前回値が存在しないので、ステップ１０６でロール角及びピッチ角の前回推定値、並びに前後、横、鉛直加速度状態量のローパスフィルタ処理値の前回値として、予め定められた初期値を設定し、ステップ１１０において、上記で説明したように上記（６）式を用いてピッチ角速度Ｑの推定値を演算する。
一方、２回目以降の演算の場合には、後述するステップ１１８でロール角及びピッチ角の推定値と、前後、横、鉛直加速度状態量のローパスフィルタ処理値とが演算されるので、ステップ１０８においてロール角及びピッチ角の前回推定値、並びに前後、横、鉛直加速度状態量のローパスフィルタ処理値として、前回演算された値を設定し、ステップ１１０において、上記で説明したように上記（６）式を用いてピッチ角速度Ｑの推定値を演算する。
ステップ１１２において、上記で説明したように、車両運動の前後加速度Ｇｘ、横加速度Ｇｙ、及びヨー角速度Ｒの検出値に応じたセンサ信号、前後車体速度Ｕの推定値Ｖｓ０に基づいて、上記（２１）、（２２）式に従って、前後加速度状態量及び横加速度状態量の各々のローパスフィルタ処理値を演算すると共に、ローパスフィルタ処理された前後、横、鉛直加速度状態量の値として前回演算された前回値を用いて、ローパスフィルタ処理された前後、横、鉛直加速度状態量の偏差を演算する。
次のステップ１１４では、上記で説明したように、前後加速度Ｇｘ及び横加速度Ｇｙに対して飽和特性を持たせると共に、ロール角及びピッチ角の前回推定値の絶対値に応じて、フィードバックゲインを設定する。
そして、ステップ１１６において、車両運動の前後加速度Ｇｘ、横加速度Ｇｙ、及び上下加速度Ｇｚの検出値に応じたセンサ信号と、ロール角及びピッチ角の前回推定値とに基づいて、上記（２８）式に従って、鉛直加速度状態量を演算すると共に、上記（２７）式に従って、飽和特性を持たせるように、演算した鉛直加速度状態量を補正する。
次のステップ１１８では、上記ステップ１１０で演算されたピッチ角速度Ｑの推定値、上記ステップ１１２で演算されたローパスフィルタ処理値、上記ステップ１１４で設定されたフィードバックゲイン、及び上記ステップ１１６で演算された鉛直加速度状態量を用いて、上記（３３）式に従って、車体の鉛直軸に対する姿勢角であるロール角φ及びピッチ角θを推定し、ロール角φ及びピッチ角θの推定値をコンピュータのメモリに記憶して、上記ステップ１００へ戻る。また、上記ステップ１１８では、上記（３３）に従って、前後加速度状態量、横加速度状態量、及び鉛直加速度状態量の各々のローパスフィルタ処理値を算出して、コンピュータのメモリに記憶する。
次に、本実施の形態の飽和特性を持たせる方法による推定結果について説明する。なお、飽和特性を持たせる方法の効果を確認するため、山岳サーキットを走行したときの姿勢角推定を行った。本実施の形態で説明したように、鉛直加速度状態量について飽和特性を持たせると共に、鉛直加速度状態量の偏差のフィードバックゲインについて飽和特性を持たせた場合と、従来手法として、これらの飽和特性を除いた場合との各々について、姿勢角の推定を行った。
図９（Ａ）、（Ｂ）に示すように、飽和特性を除いた従来手法では、１２〜１５秒付近でのロール角の推定値の誤差が増大してしまっている。これに対し、飽和特定を持たせた場合には、１２〜１５秒付近でのロール角の推定値の誤差が改善されていることがわかる。
以上説明したように、第１の実施の形態に係る車両姿勢角推定装置によれば、ロール角の推定値及びピッチ角の推定値を用いて得られる鉛直加速度状態量を、飽和特性を持たせるように補正して、ローパスフィルタ処理が行われた鉛直加速度状態量の偏差を演算し、フィードバックしているので、鉛直方向加速度が変化する路面であっても、精度よく姿勢角を推定することができる。
また、ロール角の推定値の絶対値及びピッチ角の推定値の絶対値が大きいほど、前後加速度状態量の偏差及び横加速度状態量の偏差のフィードバックゲインの絶対値を大きく設定しているので、姿勢角が大きくなる急坂路であっても、精度よくロール角及びピッチ角を推定することができる。
また、車体の上下方向運動の釣り合いからピッチ角速度を推定し、ピッチ角速度の推定値を利用してロール角及びピッチ角を推定しているので、上下加速度が増加するバンク走行時においても精度良くロール角及びピッチ角を推定することができる。
次に、本発明の第２の実施の形態について説明する。なお、第２の実施の形態に係る車両姿勢角推定装置の構成は、第１の実施の形態と同様の構成であるため、同一符号を付して説明を省略する。
第２の実施の形態では、鉛直加速度状態量に対してだけでなく、前後加速度状態量及び横加速度状態量に対しても、飽和特性を持たせて、ローパスフィルタ処理を行っている点が、第１の実施の形態と主に異なっている。
第２の実施の形態では、加速度状態量飽和特性補正手段３０において、上記（２８）式に従って、鉛直加速度状態量を演算すると共に、上記（２７）式に従って、飽和特性を持たせるように、演算した鉛直加速度状態量を補正する。また、加速度状態量飽和特性補正手段３０は、上記（２１）式の右辺の第２項の分子で表される前後加速度状態量、及び上記（２２）式の右辺の第２項の分子で表される横加速度状態量を演算すると共に、鉛直加速度状態量と同様に、飽和特性を持たせるように、演算した前後加速度状態量及び横加速度状態量を補正する。
また、姿勢角推定手段２８の姿勢角オブザーバにおいて、補正した、前後、横、鉛直加速度状態量を用いて、前後、横、鉛直加速度状態量のローパスフィルタ処理値を演算する。
状態量偏差ローパスフィルタ値演算手段２６は、上記（１９）式に示すローパスフィルタ処理が行われた前後加速度状態量、横加速度状態量、及び鉛直加速度状態量を演算し、演算した前後加速度状態量、横加速度状態量、及び鉛直加速度状態量と、姿勢角オブザーバにおいて上記のように演算された、ローパスフィルタ処理が行われた前後加速度状態量、横加速度状態量、及び鉛直加速度状態量とに基づいて、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差の各々のローパスフィルタ処理値を演算する。
なお、第２の実施の形態に係る車両姿勢角推定装置の他の構成及び作用については、第１の実施の形態と同様であるため、説明を省略する。
このように、ロール角の推定値及びピッチ角の推定値を用いて得られる、前後、横、鉛直加速度状態量を、飽和特性を持たせるように補正して、ローパスフィルタ処理が行われた、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算し、フィードバックしているので、鉛直方向加速度が変化する路面であっても、精度よく姿勢角を推定することができる。
なお、上記の実施の形態では、前後加速度状態量、横加速度状態量、及び鉛直加速度状態量の各々を、飽和特性を持たせるように補正する場合を例に説明したが、これに限定されるものではなく、前後加速度状態量、横加速度状態量、及び鉛直加速度状態量の少なくとも１つを、飽和特性を持たせるように補正するようにしてもよい。
次に、本発明の第３の実施の形態について説明する。なお、第１の実施の形態と同様の構成となる部分については、同一符号を付して説明を省略する。
第３の実施の形態では、鉛直加速度状態量の偏差を演算した後に、飽和特性を持たせるように補正している点が、第１の実施の形態と主に異なっている。
図１０に示すように、第３の実施の形態では、横速度推定手段１０、前後速度推定手段１２、横加速度センサ１６、前後加速度センサ１８、及びヨー角速度センサ２２は、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差の各々を演算する状態量偏差演算手段３２６に接続されている。
状態量偏差演算手段３２６は、鉛直加速度状態量の偏差に対して飽和特性を持たせるように補正する状態量偏差飽和特性補正手段３２８に接続されている。
状態量偏差演算手段３２６及び状態量偏差飽和特性補正手段３２８は、着目すべき運動のみを通過させるローパスフィルタ処理が施された、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差の各々のローパスフィルタ処理値を演算するローパスフィルタ値演算手段３３０に接続されている。
ローパスフィルタ値演算手段３３０は、姿勢角推定手段２８に接続されている。姿勢角推定手段２８は、車体の鉛直軸に対する姿勢角であるロール角φ及びピッチ角θを推定すると共に、フィードバックに用いる状態量として、上記（７）式〜（９）式の右辺で表わされる、前後加速度状態量、横加速度状態量、及び鉛直加速度状態量を算出する。
また、姿勢角推定手段２８は、ロール角φ及びピッチ角θの推定値を前回値として、ピッチ角速度推定手段２４、及びフィードバックゲイン設定手段３２に入力するように、ピッチ角速度推定手段２４、及びフィードバックゲイン設定手段３２に接続されている。また、姿勢角推定手段２８は、オブザーバから出力される、前後加速度状態量、横加速度状態量、及び鉛直加速度状態量を、状態量偏差演算手段３２６に入力するように、状態量偏差演算手段３２６に接続されている。
なお、本実施の形態における、状態量偏差演算手段３２６、状態量偏差飽和特性補正手段３２８、ローパスフィルタ値演算手段３３０、姿勢角推定手段２８、及びフィードバックゲイン設定手段３２は、本発明の姿勢角推定手段に対応し、状態量偏差演算手段３２６及び状態量偏差飽和特性補正手段３２８は、本発明の補正手段に対応し、ローパスフィルタ値演算手段３３０は、本発明のローパスフィルタ処理手段に対応している。
状態量偏差演算手段３２６は、横加速度センサ１６、前後加速度センサ１８、及びヨー角速度センサ２２の各々の検出値、横車体速度の推定値、並びに前後車体速度の推定値に基づいて、上記（７）式〜（８）式の左辺で表わされる、前後加速度状態量及び横加速度状態量を演算すると共に、姿勢角推定手段２８によって算出された前後加速度状態量、横加速度状態量、及び鉛直加速度状態量を用いて、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算する。
状態量偏差飽和特性補正手段３２８は、以下の（３４）式に従って、鉛直加速度状態量の偏差に対して飽和特性を持たせるように、鉛直加速度状態量の偏差を補正する。
ここで、ｕｇｆは、補正後の鉛直加速度状態量の偏差であり、ｇｍは、鉛直加速度状態量の偏差ｇ−ｇｖを制限するための定数である。
上記（３４）式に示すように、鉛直加速度状態量の偏差に対して飽和特性を持たせることにより、鉛直加速度状態量の偏差が上限値以上であれば、鉛直加速度状態量の偏差を上限値に補正し、鉛直加速度状態量の偏差が下限値以下であれば、鉛直加速度状態量の偏差を下限値に補正する。
また、ローパスフィルタ値演算手段３３０は、以下の（３６）式〜（３８）式に従って、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差に対してローパスフィルタ処理を行い、前後加速度状態量の偏差のローパスフィルタ処理値ｇｘｄｆ−ｇｘｄｆのチルダ、横加速度状態量の偏差のローパスフィルタ処理値ｇｙｄｆ−ｇｙｄｆのチルダ、及び鉛直加速度状態量の偏差のローパスフィルタ処理値ｇｚｄｆ−ｇｚｄｆのチルダを演算する。
なお、第３の実施の形態に係る車両姿勢角推定装置の他の構成は、第１の実施の形態と同様であるため、説明を省略する。
コンピュータを、横速度推定手段１０、前後速度推定手段１２、ピッチ角速度推定手段２４、状態量偏差演算手段３２６、状態量偏差飽和特性補正手段３２８、ローパスフィルタ値演算手段３３０、姿勢角推定手段２８、及びフィードバックゲイン設定手段３２の各手段として機能させるプログラムによる情報処理は、図１１のフローチャートに示す姿勢角推定処理ルーチンで実現することができる。コンピュータは、相互にバスによって接続されたＣＰＵ、ＲＯＭ、及びＲＡＭ、並びに必要に応じて接続されたＨＤＤで構成され、これらのプログラムは、コンピュータのＣＰＵに接続されているＲＯＭまたはＨＤＤ等の記録媒体に記録される。
この姿勢角推定処理ルーチンを以下に説明する。なお、第１の実施の形態と同様の処理については同一符号を付して詳細な説明を省略する。
まず、ステップ１００で、上記で説明したように横車体速度を推定し、ステップ１０２において各輪の車輪速度に基づいて前後車体速度を推定する。
ステップ１０４において、最初の演算か否かを判断し、最初の演算の場合には、ステップ３４６でロール角及びピッチ角の前回推定値、並びに前後、横、鉛直加速度状態量の前回値として予め定められた初期値を設定し、ステップ１１０において、ピッチ角速度Ｑの推定値を演算する。
一方、２回目以降の演算の場合には、後述するステップ３５６で、ロール角及びピッチ角の推定値、並びに、前後、横、鉛直加速度状態量が演算されるので、ステップ３４８においてロール角及びピッチ角の前回推定値、並びに前後、横、鉛直加速度状態量の前回値として前回演算された値を設定し、ステップ１１０において、ピッチ角速度Ｑの推定値を演算する。
ステップ３５０において、上記で説明したように、車両運動の前後加速度Ｇｘ、横加速度Ｇｙ、及びヨー角速度Ｒの検出値に応じたセンサ信号、並びに前後車体速度Ｕの推定値Ｖｓ０に基づいて、上記（７）式の左辺及び上記（８）式の左辺に従って、前後加速度状態量及び横加速度状態量を演算すると共に、前後加速度状態量、横加速度状態量、及び鉛直加速度状態量の前回値を用いて、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算する。
そして、ステップ３５２において、上記（３４）式に従って、上記ステップ３５０で演算された鉛直加速度状態量の偏差を、飽和特性を持たせるように補正する。次のステップ３５４では、上記（３６）〜（３８）式に従って、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差の各々のローパスフィルタ処理値を演算する。
そして、ステップ１１４では、上記で説明したように、前後加速度Ｇｘ及び横加速度Ｇｙに対して飽和特性を持たせると共に、ロール角及びピッチ角の前回推定値の絶対値に応じて、フィードバックゲインを設定する。
次のステップ３５６では、上記ステップ１１０で演算されたピッチ角速度Ｑの推定値、上記ステップ３５４で演算されたローパスフィルタ処理値、及び上記ステップ１１４で設定されたフィードバックゲインを用いて、車体の鉛直軸に対する姿勢角であるロール角φ及びピッチ角θを推定し、ロール角φ及びピッチ角θの推定値をコンピュータのメモリに記憶して、上記ステップ１００へ戻る。また、上記ステップ３５６では、前後加速度状態量、横加速度状態量、及び鉛直加速度状態量の各々を算出して、コンピュータのメモリに記憶する。
以上説明したように、第３の実施の形態に係る車両姿勢角推定装置によれば、鉛直加速度状態量の偏差を、飽和特性を持たせるように補正して、ローパスフィルタ処理が行われた鉛直加速度状態量の偏差を演算し、フィードバックしているので、鉛直方向加速度が変化する路面であっても、精度よく姿勢角を推定することができる。
次に、本発明の第４の実施の形態について説明する。なお、第４の実施の形態に係る車両姿勢角推定装置の構成は、第３の実施の形態と同様の構成であるため、同一符号を付して説明を省略する。
第４の実施の形態では、鉛直加速度状態量の偏差に対してだけでなく、前後加速度状態量の偏差及び横加速度状態量の偏差に対しても、飽和特性を持たせるように補正した後に、ローパスフィルタ処理を行っている点が、第１の実施の形態と主に異なっている。
第４の実施の形態では、状態量偏差飽和特性補正手段３２８において、上記（３４）式に従って、鉛直加速度状態量の偏差に対して飽和特性を持たせるように、鉛直加速度状態量の偏差を補正する。また、状態量偏差飽和特性補正手段３２８は、鉛直加速度状態量の偏差と同様に、前後加速度状態量の偏差及び横加速度状態量の偏差に対して飽和特性を持たせるように、前後加速度状態量の偏差及び横加速度状態量の偏差を補正する。
また、ローパスフィルタ値演算手段３３０において、補正した、前後、横、鉛直加速度状態量の偏差のローパスフィルタ処理値を演算する。
なお、第４の実施の形態に係る車両姿勢角推定装置の他の構成及び作用については、第３の実施の形態と同様であるため、説明を省略する。
このように、前後、横、鉛直加速度状態量の偏差を、飽和特性を持たせるように補正して、ローパスフィルタ処理が行われた、前後、横、鉛直加速度状態量の偏差を演算し、フィードバックしているので、鉛直方向加速度が変化する路面であっても、精度よく姿勢角を推定することができる。
なお、上記の実施の形態では、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差の各々を、飽和特性を持たせるように補正する場合を例に説明したが、これに限定されるものではなく、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差の少なくとも１つを、飽和特性を持たせるように補正するようにしてもよい。
なお、上記の実施の形態では、各推定値の前回値を用いて、ピッチ角速度やロール角及びピッチ角を推定する場合を例に説明したが、これに限定されるものではなく、各推定値の前々回値を用いて、ピッチ角速度やロール角及びピッチ角を推定するようにしてもよい。
本発明の第１の実施の形態を示すブロック図である。 本実施の形態の座標系を示す説明図である。 山岳サーキットコース走行時の姿勢角を推定した結果を示すグラフである。 （Ａ）ローパスフィルタ処理後の鉛直加速度の時間変化を示すグラフ、（Ｂ）ローパスフィルタ処理後の横加速度の時間変化を示すグラフ、及び（Ｃ）ロール角推定値の時間変化を示すグラフである。 姿勢角オブザーバの安定性の解析結果を示す図である。 （Ａ）ピッチ角及びロール角と、前後加速度状態量の偏差のフィードバックゲインにおけるＫθｘとの関係を示すグラフ、及び（Ｂ）ピッチ角及びロール角と、横加速度状態量の偏差のフィードバックゲインにおけるＫθｘとの関係を示すグラフである。 本発明の第１の実施の形態で用いる姿勢角オブザーバの安定性の解析結果を示す図である。 本発明の第１の実施の形態の処理を示す流れ図である。 第１の実施の形態におけるロール角及びピッチ角の推定結果を示す線図である。 本発明の第３の実施の形態を示すブロック図である。 本発明の第３の実施の形態の処理を示す流れ図である。
符号の説明
１０ 横速度推定手段
１２ 前後速度推定手段
１４ 上下加速度センサ
１６ 横加速度センサ
１８ 前後加速度センサ
２０ ロール角速度センサ
２２ ヨー角速度センサ
２４ ピッチ角速度推定手段
２６ 状態量偏差ローパスフィルタ値演算手段
２８ 姿勢角推定手段
３０ 加速度状態量飽和特性補正手段
３２ フィードバックゲイン設定手段
３２６ 状態量偏差演算手段
３２８ 状態量偏差飽和特性補正手段
３３０ ローパスフィルタ値演算手段

Claims (6)

  1. 各輪の車輪速度に基づいて車両前後方向の車体速度である前後車体速度を推定する前後速度推定手段と、
    車両横方向の車体速度である横車体速度を推定する横速度推定手段と、
    ピッチ角速度を推定するピッチ角速度推定手段と、
    車両運動の前後加速度、横加速度、上下加速度、ロール角速度、及びヨー角速度の各検出値に応じたセンサ信号、前記前後車体速度の推定値、並びに前記ピッチ角速度の推定値に基づいて、車体の鉛直軸に対する姿勢角であるロール角及びピッチ角を推定する姿勢角推定手段と、
    を含む車両姿勢角推定装置であって、
    前記姿勢角推定手段は、前記ロール角の推定値及び前記ピッチ角の推定値を用いて得られる前後加速度状態量、横加速度状態量、及び鉛直加速度状態量の少なくとも１つを、飽和特性を持たせるように補正する補正手段と、前記前後加速度状態量、前記横加速度状態量、及び前記鉛直加速度状態量と、前記センサ信号、前記前後車体速度の推定値、及び前記横車体速度の推定値を用いて得られる前後加速度状態量及び横加速度状態量とに基づいて、ローパスフィルタ処理が行われた、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算する状態量偏差演算手段とを備え、前記演算された前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差をフィードバックして、前記ロール角及びピッチ角を推定することを特徴とする車両姿勢角推定装置。
  2. 各輪の車輪速度に基づいて車両前後方向の車体速度である前後車体速度を推定する前後速度推定手段と、
    車両横方向の車体速度である横車体速度を推定する横速度推定手段と、
    ピッチ角速度を推定するピッチ角速度推定手段と、
    車両運動の前後加速度、横加速度、上下加速度、ロール角速度、及びヨー角速度の各検出値に応じたセンサ信号、前記前後車体速度の推定値、並びに前記ピッチ角速度の推定値に基づいて、車体の鉛直軸に対する姿勢角であるロール角及びピッチ角を推定する姿勢角推定手段と、
    を含む車両姿勢角推定装置であって、
    前記姿勢角推定手段は、前記ロール角の推定値及び前記ピッチ角の推定値を用いて得られる前後加速度状態量、横加速度状態量、及び鉛直加速度状態量と、前記センサ信号、前記前後車体速度の推定値、及び前記横車体速度の推定値を用いて得られる前後加速度状態量及び横加速度状態量とに基づいて、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算すると共に、前記前後加速度状態量の偏差、前記横加速度状態量の偏差、及び前記鉛直加速度状態量の偏差の少なくとも１つを、飽和特性を持たせるように補正する補正手段と、前記前後加速度状態量の偏差、前記横加速度状態量の偏差、及び前記鉛直加速度状態量の偏差に対して、ローパスフィルタ処理が行うローパスフィルタ処理手段とを備え、前記ローパスフィルタ処理が行われた、前記前後加速度状態量の偏差、前記横加速度状態量の偏差、及び前記鉛直加速度状態量の偏差をフィードバックして、前記ロール角及びピッチ角を推定することを特徴とする車両姿勢角推定装置。
  3. 前記ピッチ角速度推定手段が、前記前後車体速度の推定値、前記横車体速度の推定値、前記上下加速度の検出値、前記ロール角速度の検出値、前記姿勢角推定手段で推定された前記ロール角の前回推定値、及び前記姿勢角推定手段で推定された前記ピッチ角の前回推定値に基づいて、前記ピッチ角速度を推定する請求項１又は２記載の車両姿勢角推定装置。
  4. 車両運動の前後加速度、横加速度、上下加速度、ヨー角速度、及びロール角速度の各々を検出して検出値に応じたセンサ信号を出力するセンサを更に含む請求項１〜請求項３の何れか１項記載の車両姿勢角推定装置。
  5. コンピュータを、
    各輪の車輪速度に基づいて車両前後方向の車体速度である前後車体速度を推定する前後速度推定手段、
    車両横方向の車体速度である横車体速度を推定する横速度推定手段、
    ピッチ角速度を推定するピッチ角速度推定手段、及び
    車両運動の前後加速度、横加速度、上下加速度、ロール角速度、及びヨー角速度の各検出値に応じたセンサ信号、前記前後車体速度の推定値、並びに前記ピッチ角速度の推定値に基づいて、車体の鉛直軸に対する姿勢角であるロール角及びピッチ角を推定する姿勢角推定手段
    として機能させるためのプログラムであって、
    前記姿勢角推定手段は、前記ロール角の推定値及び前記ピッチ角の推定値を用いて得られる前後加速度状態量、横加速度状態量、及び鉛直加速度状態量の少なくとも１つを、飽和特性を持たせるように補正する補正手段と、前記前後加速度状態量、前記横加速度状態量、及び前記鉛直加速度状態量と、前記センサ信号、前記前後車体速度の推定値、及び前記横車体速度の推定値を用いて得られる前後加速度状態量及び横加速度状態量とに基づいて、ローパスフィルタ処理が行われた、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算する状態量偏差演算手段とを備え、前記演算された前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差をフィードバックして、前記ロール角及びピッチ角を推定するプログラム。
  6. コンピュータを、
    各輪の車輪速度に基づいて車両前後方向の車体速度である前後車体速度を推定する前後速度推定手段、
    車両横方向の車体速度である横車体速度を推定する横速度推定手段、
    ピッチ角速度を推定するピッチ角速度推定手段、及び
    車両運動の前後加速度、横加速度、上下加速度、ロール角速度、及びヨー角速度の各検出値に応じたセンサ信号、前記前後車体速度の推定値、並びに前記ピッチ角速度の推定値に基づいて、車体の鉛直軸に対する姿勢角であるロール角及びピッチ角を推定する姿勢角推定手段
    として機能させるためのプログラムであって、
    前記姿勢角推定手段は、前記ロール角の推定値及び前記ピッチ角の推定値を用いて得られる前後加速度状態量、横加速度状態量、及び鉛直加速度状態量と、前記センサ信号、前記前後車体速度の推定値、及び前記横車体速度の推定値を用いて得られる前後加速度状態量及び横加速度状態量とに基づいて、前後加速度状態量の偏差、横加速度状態量の偏差、及び鉛直加速度状態量の偏差を演算すると共に、前記前後加速度状態量の偏差、前記横加速度状態量の偏差、及び前記鉛直加速度状態量の偏差の少なくとも１つを、飽和特性を持たせるように補正する補正手段と、前記前後加速度状態量の偏差、前記横加速度状態量の偏差、及び前記鉛直加速度状態量の偏差に対して、ローパスフィルタ処理が行うローパスフィルタ処理手段とを備え、前記ローパスフィルタ処理が行われた、前記前後加速度状態量の偏差、前記横加速度状態量の偏差、及び前記鉛直加速度状態量の偏差をフィードバックして、前記ロール角及びピッチ角を推定するプログラム。
JP2008322315A 2008-12-18 2008-12-18 車両姿勢角推定装置及びプログラム Expired - Fee Related JP5128457B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2008322315A JP5128457B2 (ja) 2008-12-18 2008-12-18 車両姿勢角推定装置及びプログラム

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2008322315A JP5128457B2 (ja) 2008-12-18 2008-12-18 車両姿勢角推定装置及びプログラム

Publications (2)

Publication Number Publication Date
JP2010143379A JP2010143379A (ja) 2010-07-01
JP5128457B2 true JP5128457B2 (ja) 2013-01-23

Family

ID=42564260

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2008322315A Expired - Fee Related JP5128457B2 (ja) 2008-12-18 2008-12-18 車両姿勢角推定装置及びプログラム

Country Status (1)

Country Link
JP (1) JP5128457B2 (ja)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2014179640A1 (en) 2013-05-02 2014-11-06 GM Global Technology Operations LLC Integrated grade and pitch estimation using a three-axis inertial-measuring device
JP6153493B2 (ja) 2014-04-25 2017-06-28 ヤマハ発動機株式会社 ロール角推定装置および輸送機器
US10235817B2 (en) * 2015-09-01 2019-03-19 Ford Global Technologies, Llc Motion compensation for on-board vehicle sensors
US9821744B2 (en) * 2015-12-15 2017-11-21 Robert Bosch Gmbh Acceleration sensing of fast roll and slow roll for vehicle
JP7540270B2 (ja) * 2020-09-29 2024-08-27 株式会社アイシン 駐車支援装置、駐車支援方法、およびプログラム
JP2023148094A (ja) * 2022-03-30 2023-10-13 セイコーエプソン株式会社 慣性センサー
CN121224678B (zh) * 2025-12-01 2026-02-10 吉林大学 一种角模块构型车辆斜行转向切换控制方法

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3282449B2 (ja) * 1995-06-09 2002-05-13 トヨタ自動車株式会社 車輌の横滑り状態量検出装置
JP2904118B2 (ja) * 1996-05-27 1999-06-14 日本電気株式会社 姿勢角検出装置及び方法
JP4861813B2 (ja) * 2006-09-14 2012-01-25 株式会社豊田中央研究所 車両物理量推定装置及びプログラム

Also Published As

Publication number Publication date
JP2010143379A (ja) 2010-07-01

Similar Documents

Publication Publication Date Title
JP4724163B2 (ja) 車体速度推定装置
JP5029442B2 (ja) 車両姿勢角推定装置及びプログラム
JP5173854B2 (ja) センサドリフト量推定装置
JP4655004B2 (ja) 車両物理量推定装置及びプロブラム
JP5128457B2 (ja) 車両姿勢角推定装置及びプログラム
JP5035419B2 (ja) 路面摩擦係数推定装置及び路面摩擦係数推定方法
US10435028B2 (en) Vehicle state estimation apparatus and method
KR101637887B1 (ko) 차량의 최대 조향각의 결정
US10363939B2 (en) Vehicle reference velocity estimation apparatus and method
JP2017531597A (ja) 車両サイドスリップ角を推定する方法、該方法を実施するコンピュータプログラム、該コンピュータプログラムを読み込んだ制御ユニット、及び該制御ユニットを備える車両
JP2019513613A (ja) 車両を制御する方法、システム、及び非一時的コンピューター可読メモリ
JP2010117356A (ja) センサ信号を補償するためのシステム及び方法
JP5402244B2 (ja) 車両物理量推定装置
JP5091047B2 (ja) 車両姿勢角推定装置及びセンサドリフト推定装置
JP5103629B2 (ja) 車両動作測定装置および、車両非正常動作防止装置
JP5137792B2 (ja) 車両横力外乱推定装置
JP2011068207A (ja) 車両制御装置
JP4861813B2 (ja) 車両物理量推定装置及びプログラム
JP5128456B2 (ja) 車両姿勢角推定装置及びプログラム
EP3583021B1 (en) System for estimating the slope of a pedal-assisted bicycle
JP5521943B2 (ja) 車両の総重量推定装置
KR102200521B1 (ko) 차량의 횡슬립각 추정장치
JP2014108728A (ja) 車体横滑り角推定装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20111018

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20121023

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20121031

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

Ref document number: 5128457

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20151109

Year of fee payment: 3

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees