JP2014169055A - 舵角ゼロ点補正装置 - Google Patents
舵角ゼロ点補正装置 Download PDFInfo
- Publication number
- JP2014169055A JP2014169055A JP2013043063A JP2013043063A JP2014169055A JP 2014169055 A JP2014169055 A JP 2014169055A JP 2013043063 A JP2013043063 A JP 2013043063A JP 2013043063 A JP2013043063 A JP 2013043063A JP 2014169055 A JP2014169055 A JP 2014169055A
- Authority
- JP
- Japan
- Prior art keywords
- zero point
- steering angle
- point correction
- value
- correction value
- 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
Links
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
【課題】舵角ゼロ点補正値の設定精度を向上させることができる舵角ゼロ点補正装置を提供する。
【解決手段】制御装置は、車両停止時にヨーレートセンサによって検出されたヨーレートセンサ値Yr_Rに基づいてヨーゼロ点補正値Yr_Zを設定する(第2のタイミングt12)。そして、車両発進後に、制御装置は、車両が直進走行しているときのヨーレートセンサ値Yr_Rからヨーゼロ点補正値Yr_Zを差し引いたヨーレート演算値Yrに基づいて舵角ゼロ点補正値θ_Zを演算する(第5のタイミングt15)。そして、第5のタイミングt15以降では、車両の走行状態が走行初期状態ではなくなったと判定できるため、制御装置は、舵角ゼロ点補正値θ_Zの演算を行わない。
【選択図】図4
【解決手段】制御装置は、車両停止時にヨーレートセンサによって検出されたヨーレートセンサ値Yr_Rに基づいてヨーゼロ点補正値Yr_Zを設定する(第2のタイミングt12)。そして、車両発進後に、制御装置は、車両が直進走行しているときのヨーレートセンサ値Yr_Rからヨーゼロ点補正値Yr_Zを差し引いたヨーレート演算値Yrに基づいて舵角ゼロ点補正値θ_Zを演算する(第5のタイミングt15)。そして、第5のタイミングt15以降では、車両の走行状態が走行初期状態ではなくなったと判定できるため、制御装置は、舵角ゼロ点補正値θ_Zの演算を行わない。
【選択図】図4
Description
本発明は、舵角ゼロ点補正装置に関する。
操舵角センサを操舵系に取り付ける際に生じる取り付け誤差によって、操舵角センサによって検出される操舵角センサ値とステアリングホイールの実際の操舵角との間にずれが生じる。そこで、操舵角をパラメータとする車両制御を行う際には、操舵角センサによって検出される操舵角センサ値から上記のずれ量に相当する舵角ゼロ点補正値を差し引いた操舵角演算値が操舵角として採用される。
そして、特許文献1に記載される装置では、このようにして演算された操舵角演算値が基準値以下であるときには、車両が直進していると判断して操舵系の剛性を高める車両制御を行っている。
また、特許文献2には、車両走行中に操舵角センサによって検出される操舵角センサ値に基づいて車両が直進走行しているか否かを判定する装置が開示されている。この装置では、車両が直進走行していると判定したときに、ヨーレートセンサによって検出されるヨーレートセンサ値がゼロ点となるように補正処理が行われている。
ところで、上記の操舵角演算値をパラメータとして用いる車両制御の制御性を向上させるためには、操舵角演算値とステアリングホイールの実際の操舵角とのずれを小さくすることが有効であり、舵角ゼロ点補正値の設定精度の更なる向上が希求されている。
本発明の目的は、舵角ゼロ点補正値の設定精度を向上させることができる舵角ゼロ点補正装置を提供することにある。
上記課題を解決するための舵角ゼロ点補正装置は、車両停止時にヨーレートセンサによって検出されるヨーレートセンサ値に基づいてヨーゼロ点補正値を設定するヨーゼロ点設定部と、車両が直進走行しているときにヨーレートセンサによって検出されるヨーレートセンサ値からヨーゼロ点設定部によって設定されたヨーゼロ点補正値を差し引いたヨーレートに基づいて舵角ゼロ点補正値を演算する舵角ゼロ点演算部と、を備えている。そして、舵角ゼロ点演算部は、ヨーゼロ点設定部によってヨーゼロ点補正値が設定されてからの車両発進後において同車両の走行状態が走行初期状態であるときには舵角ゼロ点補正値の演算を行い、車両の走行状態が走行初期状態ではないときには舵角ゼロ点補正値の演算を行わない。
停止中の車両ではヨーモーメントが発生していないため、車両停止時にヨーレートセンサによって検出されたヨーレートセンサ値は車両の実際のヨーレートとのずれ量又はずれ量に近い値である。そのため、こうしたヨーレートセンサ値に基づいてヨーゼロ点補正値が設定される。このようにヨーゼロ点補正値を設定すると、車両走行中においては、ヨーレートセンサ値からヨーゼロ点補正値を差し引いた演算値を車両のヨーレートとして用いることができるようになる。
また、ステアリングホイールの実際の操舵角は、車両の実際のヨーレートと車両の車体速度との関係から求めることができる。そこで、上記構成では、車両が直進走行しているときには、直進走行中に検出されたヨーレートセンサ値からヨーゼロ点補正値を差し引いたヨーレートに基づいて舵角ゼロ点補正値が演算される。こうして舵角ゼロ点補正値が演算された以降では、操舵角センサによって検出される操舵角センサ値から舵角ゼロ点補正値を差し引いた演算値を操舵角として用いることができるようになる。
なお、ヨーレートセンサ値は、ヨーレートセンサの温度変化などに起因して次第に大きくなったり小さくなったりする。ヨーレートセンサの温度変化は、同センサへの通電に伴う自己発熱及び外部からのセンサの受熱などによって生じる。そのため、ヨーゼロ点補正値を設定してからある程度時間が経過すると、設定されているヨーゼロ点補正値と、実際のヨーゼロ点補正値との間にずれが生じる又はずれが大きくなるおそれがある。すなわち、こうした事象が発生している状態では、舵角ゼロ点補正値の設定精度の低下を招くおそれがある。
この点、上記構成では、車両停止中にヨーゼロ点補正値が設定されてから車両が発進し、車両発進後における車両の走行状態が走行初期状態であるときには、こうした状況下で検出されるヨーレートセンサ値からヨーゼロ点補正値を差し引いたヨーレートに基づいて舵角ゼロ点補正値が演算される。この場合、ヨーゼロ点補正値の設定時点と舵角ゼロ点補正値の演算時点とではヨーレートセンサの温度があまり変化しておらず、設定されているヨーゼロ点補正値と実際のヨーゼロ点補正値との間のずれが小さいと推定することができる。そのため、車両の走行状態が走行初期状態であるときに演算された舵角ゼロ点補正値の精度は高いと推定することができる。
その一方で、車両の走行状態が走行初期状態でなくなったときには、ヨーゼロ点補正値の設定時点からヨーレートセンサの温度が変化し、ヨーレートセンサ値の温度ドリフトが発生しているおそれがある。この場合、設定されているヨーゼロ点補正値と実際のヨーゼロ点補正値との間にずれが生じた又はずれが大きくなった可能性がある。そのため、こうした状況下で検出されるヨーレートセンサ値からヨーゼロ点補正値を差し引いたヨーレートに基づいた舵角ゼロ点補正値の演算が行われない。したがって、舵角ゼロ点補正値の設定精度を向上させることができるようになる。
ここで、上記の舵角ゼロ点補正装置では、ヨーゼロ点設定部によってヨーゼロ点補正値が設定されてからの車両発進後における舵角ゼロ点演算部による舵角ゼロ点補正値の演算回数が判定回数未満であるときを、車両の走行状態が走行初期状態であるとしてもよい。
ただし、発進後において車両がなかなか直進走行しないことがある。この場合、車両発進後においてヨーゼロ点補正値の設定が一回もなされていなくても、ヨーゼロ点補正値の設定時点からヨーレートセンサの温度が変化し、ヨーレートセンサ値の温度ドリフトが発生するおそれがある。そこで、舵角ゼロ点演算部は、ヨーゼロ点設定部によってヨーゼロ点補正値が設定されてからの経過時間が判定時間未満であるときには、舵角ゼロ点補正値の演算を許可するようにしてもよい。この構成によれば、上記経過時間が判定時間以上であるときには、設定されているヨーゼロ点補正値と実際のヨーゼロ点補正値との間にずれが生じた又はずれが大きくなった可能性があるため、舵角ゼロ点補正値がさらに演算されにくくなる。そのため、舵角ゼロ点補正値の設定精度の低下を抑制することができるようになる。
ところで、車両に設けられている加速度センサでは、運転者による通常の車両操作時には発生し得ない大きな加速度が検出されることがある。こうした場合、大きな加速度の検出前後で車両特性が大きく変動した、すなわち操舵角センサによって検出される操舵角センサ値とステアリングホイールの実際の操舵角とのずれ量が変わった可能性がある。
そこで、上記の舵角ゼロ点補正装置は、車両の加速度センサによって検出される加速度センサ値が異常判定値以上になった場合に、その後の車両の直進走行中で前記ヨーレートセンサによって検出されるヨーレートセンサ値からヨーゼロ点設定部によって設定されたヨーゼロ点補正値を差し引いたヨーレートに基づいて舵角ゼロ点補正値を演算する他の舵角ゼロ点演算部をさらに備えることが好ましい。これにより、大きな加速度の検出後における操舵角センサ値と実際の操舵角とのずれ量と舵角ゼロ点補正値との乖離が生じにくくなる。その結果、操舵角センサ値から舵角ゼロ点補正値を差し引いた演算値を操舵角として用いる制御構成が採用される場合にあっては、操舵角の演算精度の低下を抑制することができるようになる。
また、大きな加速度が検出される前の舵角ゼロ点補正値を、前回の舵角ゼロ点補正値とし、大きな加速度が検出された後に演算された舵角ゼロ点補正値を、今回の舵角ゼロ点補正値とする。このとき、前回の舵角ゼロ点補正値と今回の舵角ゼロ点補正値との差分が大きすぎる場合、大きな加速度の検出前後での車両特性の変化が大きすぎるおそれがあり、舵角ゼロ点補正値を更新しないほうがよい。
そこで、上記の差分が差分判定値未満であるときには舵角ゼロ点補正値を今回の舵角ゼロ点補正値とし、上記の差分が差分判定値以上であるときには舵角ゼロ点補正値を変更しないことが好ましい。これにより、大きな加速度の検出前後での車両特性の変化が小さい場合には舵角ゼロ点補正値を更新することができる一方で、車両特性の変動が大きい場合には舵角ゼロ点補正値の更新を禁止することができるようになる。
以下、舵角ゼロ点補正装置を具体化した一実施形態を図1〜図5に従って説明する。
図1に示すように、車両の制動システムには、複数(例えば、4つ)の車輪10に制動力を付与する制動装置20と、この制動装置20を制御する制御装置30とが設けられている。制動装置20は、ブースタ、マスタシリンダ及びリザーバを有する液圧発生装置21と、ブレーキアクチュエータ22とを備えている。そして、運転手がブレーキペダル23を操作すると、液圧発生装置21のマスタシリンダ内の液圧が上昇し、この液圧に応じた液量のブレーキ液がブレーキアクチュエータ22の図示しない液圧回路を介して車輪10毎に設けられた制動機構24のホイールシリンダ内に流入する。これにより、制動機構24がホイールシリンダ内の液圧に応じた制動力を車輪10に付与するようになる。
図1に示すように、車両の制動システムには、複数(例えば、4つ)の車輪10に制動力を付与する制動装置20と、この制動装置20を制御する制御装置30とが設けられている。制動装置20は、ブースタ、マスタシリンダ及びリザーバを有する液圧発生装置21と、ブレーキアクチュエータ22とを備えている。そして、運転手がブレーキペダル23を操作すると、液圧発生装置21のマスタシリンダ内の液圧が上昇し、この液圧に応じた液量のブレーキ液がブレーキアクチュエータ22の図示しない液圧回路を介して車輪10毎に設けられた制動機構24のホイールシリンダ内に流入する。これにより、制動機構24がホイールシリンダ内の液圧に応じた制動力を車輪10に付与するようになる。
ブレーキアクチュエータ22は、運転者がブレーキペダル23を操作しない場合であっても各車輪10に対する制動力を個別に調整できるように構成されている。例えば、ブレーキアクチュエータ22は、マスタシリンダ内の液圧と、ホイールシリンダ内の液圧との間に差圧を発生させる差圧調整弁と、ホイールシリンダ内にブレーキ液を供給するための電動ポンプとを備えている。また、ブレーキアクチュエータ22には、各ホイールシリンダ内の液圧を個別に調整するための各種弁が設けられている。
制御装置30には、ブレーキペダル23が操作されているか否かを検出するブレーキスイッチSW1と、車輪10の車輪速度VWを検出する車輪速度センサSE1と、加速度センサ値の一例としての車両の横方向加速度Gyを検出する加速度センサの一例としての横方向加速度センサSE2とが電気的に接続されている。また、制御装置30は、ステアリングホイール25の操舵角を検出する操舵角センサSE3と、車両のヨーレート(Yaw Rate)を検出するヨーレートセンサSE4と、加速度センサ値の一例としての車両の前後方向加速度Gxを検出する加速度センサの一例としての前後方向加速度センサSE5とが電気的に接続されている。そして、制御装置30は、ブレーキスイッチSW1及び各種センサSE1〜SE5によって検出される各種情報などに基づいて、ブレーキアクチュエータ22を作動させて車両の挙動安定化を図っている。
なお、操舵角センサSE3から出力される信号に基づいて検出される操舵角のことを、「操舵角センサSE3によって検出される操舵角センサ値θ_R」という。同様に、ヨーレートセンサSE4から出力される信号に基づいて検出されるヨーレートのことを、「ヨーレートセンサSE4によって検出されるヨーレートセンサ値Yr_R」というものとする。
こうした制御装置30は、CPU及びメモリ31などで構築されるマイクロコンピュータを備えている。メモリ31には、CPUが実行する各種プログラム及びマップなどが予め記憶されている領域及び車体速度や各種補正値などのように適宜更新される情報が記憶される領域が形成されている。
上記の制動システムを搭載する車両においては、車両旋回中での車両挙動を制御する挙動制御が行われるようになっている。こうした挙動制御では、運転者が要求する車両の進行方向としてステアリングホイール25の操舵角、及びその時点の車両の挙動を示す車両のヨーレートがパラメータとして採用される。こうした挙動制御を精度良く行うためには、操舵角及びヨーレートを精度良く求める必要がある。
ここで、ヨーレートセンサSE4によって検出されるヨーレートセンサ値Yr_Rは、車両の実際のヨーレートからある程度オフセットされて検出されることがある。そこで、本実施形態では、上記のオフセット量に相当するヨーゼロ点補正値Yr_Zが求められ、ヨーレートセンサ値Yr_Rからヨーゼロ点補正値Yr_Zを差し引いたヨーレート演算値Yrがヨーレートとして用いられる。
また、操舵角センサSE3によって検出される操舵角センサ値θ_Rについても、ステアリング装置への操舵角センサSE3の取り付け誤差などに応じたずれ量だけオフセットされている。そこで、本実施形態では、上記のずれ量に相当する舵角ゼロ点補正値θ_Zが求められ、操舵角センサ値θ_Rから舵角ゼロ点補正値θ_Zを差し引いた操舵角演算値θが操舵角として用いられる。したがって、制動システムを制御する制御装置30が、舵角ゼロ点補正値θ_Zを演算する「舵角ゼロ点補正装置」として機能するとともに、「操舵角演算装置」としても機能する。
次に、図2及び図3に示すフローチャートを参照して、ヨーゼロ点補正値Yr_Z及び舵角ゼロ点補正値θ_Zを取得するために制御装置30が実行する処理ルーチンについて説明する。なお、この処理ルーチンは、予め設定された所定周期毎に実行される処理ルーチンである。
図2及び図3に示すように、本処理ルーチンにおいて、制御装置30は、各種センサSE1〜SE5によって検出される各種センサ値、すなわち各車輪10の車輪速度VW、車両の前後方向加速度Gx、車両の横方向加速度Gy、ヨーレートセンサ値Yr_R及び操舵角センサ値θ_Rを取得する(ステップS11)。続いて、制御装置30は、取得した各種センサ値に基づいて車両状態値を演算する(ステップS12)。すなわち、制御装置30は、各車輪10のうち少なくとも一つの車輪の車輪速度VWに基づいて車両の車体速度VSを演算し、ヨーレートセンサ値Yr_Rからヨーゼロ点補正値Yr_Zを差し引いてヨーレート演算値Yrを求め、操舵角センサ値θ_Rから舵角ゼロ点補正値θ_Zを差し引いて操舵角演算値θを求める。
そして、制御装置30は、ステップS11で取得した前後方向加速度の絶対値|Gx|が予め設定されている前後G異常判定値Gx1_Th以上であるか否かを判定するとともに、横方向加速度の絶対値|Gy|が予め設定されている横G異常判定値Gy1_Th以上であるか否かを判定する(ステップS13)。前後G異常判定値Gx1_Th及び横G異常判定値Gy1_Thは、運転手による通常の車両操作時にあっては発生し得ない大きな加速度を前後方向加速度センサSE5及び横方向加速度センサSE2によって検出したか否かを判定するための基準値である。
前後方向加速度の絶対値|Gx|が前後G異常判定値Gx1_Th以上となる場合、及び横方向加速度の絶対値|Gy|が横G異常判定値Gy1_Th以上となる場合としては、例えば、自車両と他車両との衝突などのように自車両が大きな衝撃を受けた場合が挙げられる。こうした場合では、前後方向加速度の絶対値|Gx|が前後G異常判定値Gx1_Th以上となる前後、又は横方向加速度の絶対値|Gy|が横G異常判定値Gy1_Th以上となる前後で、操舵角センサSE3の位置が変わるなどして操舵角センサ値θ_Rとステアリングホイール25の実際の操舵角とのずれ量が変わったおそれがある。また、ヨーレートセンサSE4の設置位置にずれが生じているおそれもある。
前後方向加速度の絶対値|Gx|が前後G異常判定値Gx1_Th以上となること、及び横方向加速度の絶対値|Gy|が横G異常判定値Gy1_Th以上となることのうち少なくとも一方が成立している場合(ステップS13:YES)、制御装置30は、異常フラグFLG2にオンをセットする(ステップS14)。そして、制御装置30は、その処理を次のステップS15に移行する。一方、前後方向加速度の絶対値|Gx|が前後G異常判定値Gx1_Th未満であって且つ横方向加速度の絶対値|Gy|が横G異常判定値Gy1_Th未満である場合(ステップS13:NO)、制御装置30は、ステップS14の処理を行うことなく、その処理を次のステップS15に移行する。
ステップS15において、制御装置30は、走行中タイマT1を「1」だけインクリメントする。続いて、制御装置30は、以下に示す2つの条件がともに成立しているか否かを判定する(ステップS16)。
(条件1)ブレーキ操作中であること。
(条件2)ステップS12で演算した車体速度VSが予め設定されている停車判定値VS_th未満であること。
(条件1)ブレーキ操作中であること。
(条件2)ステップS12で演算した車体速度VSが予め設定されている停車判定値VS_th未満であること。
なお、ブレーキ操作中であるか否かは、例えば、ブレーキスイッチSW1から出力される信号に基づき判定してもよいし、マスタシリンダ内の液圧に基づき判定してもよい。また、停車判定値VS_Thは、車両が停止しているか否かを車体速度VSに基づき判断するための判定値である。
これら各条件(条件1),(条件2)のうち少なくとも一方が成立していない場合(ステップS16:NO)、車両が停止中ではないと判定できるため、制御装置30は、その処理を後述するステップS24に移行する。一方、各条件(条件1),(条件2)がともに成立している場合(ステップS16:YES)、車両が停止していると判定できるため、制御装置30は、演算カウンタCnt1を「1」だけインクリメントする(ステップS17)。そして、制御装置30は、現時点のヨー積算値ΣYr_Rに今回の制御サイクルで取得したヨーレートセンサ値Yr_Rを加算してヨー積算値ΣYr_Rを更新する、すなわちヨーレートセンサ値Yr_Rを積算する(ステップS18)。
続いて、制御装置30は、ステップS17で更新した演算カウンタCnt1が予め設定されている積算判定値Cnt1_Th(例えば、10)以上であるか否かを判定する(ステップS19)。演算カウンタCnt1が積算判定値Cnt1_Th未満である場合(ステップS19:NO)、制御装置30は、本処理ルーチンを一旦終了する。一方、演算カウンタCnt1が積算判定値Cnt1_Th以上である場合(ステップS19:YES)、制御装置30は、ステップS18で更新した最新のヨー積算値ΣYr_RをステップS17で更新した演算カウンタCnt1で除算し、この除算結果(=ΣYr_R/Cnt1)をヨーゼロ点補正値Yr_Zとしてメモリ31の所定領域に記憶させる(ステップS20)。すなわち、演算カウンタCnt1は、ヨーレートセンサ値Yr_Rの積算回数に相当する。したがって、制御装置30が、「ヨーゼロ点設定部」としても機能する。
そして、制御装置30は、機関運転が開始されてからヨーゼロ点補正値Yr_Zが設定されたか否かを示す設定済みフラグFLG1にオンをセットする(ステップS201)。続いて、制御装置30は、演算カウンタCnt1を「0(零)」にリセットし(ステップS21)、演算回数Nを「0(零)」にリセットする(ステップS22)。この演算回数Nは、ヨーゼロ点補正値Yr_Zが設定されてからの舵角ゼロ点補正値θ_(M)の演算回数である。続いて、制御装置30は、ヨーゼロ点補正値Yr_Zを設定した時点からの経過時間に相当する走行中タイマT1を「0(零)」にリセットし(ステップS23)、本処理ルーチンを一旦終了する。
ステップS24において、車両が停止していない可能性があると判定できるため、制御装置30は、演算カウンタCnt1を「0(零)」にリセットする。そして、制御装置30は、ヨー積算値ΣYr_Rを「0(零)」にリセットし(ステップS25)、異常フラグFLG2がオフであるか否かを判定する(ステップS26)。異常フラグFLG2がオンである場合(ステップS26:NO)、制御装置30は、その処理を後述するステップS29に移行する。
異常フラグFLG2がオフである場合(ステップS26:YES)、制御装置30は、設定済みフラグFLG1がオンであるか否かを判定する(ステップS261)。設定済みフラグFLG1がオフである場合(ステップS261:NO)、今回の機関運転中にヨーゼロ点補正値Yr_Zが未だ設定されていないため、制御装置30は、本処理ルーチンを一旦終了する。一方、設定済みフラグFLG1がオンである場合(ステップS261:YES)、今回の機関運転中では既にヨーゼロ点補正値Yr_Zが設定されているため、制御装置30は、演算回数Nが予め設定されている判定回数N_Th(本実施形態では1)未満であるか否かを判定する(ステップS27)。この演算回数Nが多いほど、ヨーゼロ点補正値Yr_Zの設定時点からの経過時間が長いと推定することができる。そこで、本実施形態の制御装置30は、演算回数Nが判定回数N_Th未満であるときにはヨーゼロ点補正値Yr_Zが設定されてからの車両発進後において車両の走行状態が走行初期状態であると判定し、演算回数Nが判定回数N_Th以上になったときには車両の走行状態が走行初期状態ではなくなったと判定する。
そして、演算回数Nが判定回数N_Th以上である場合(ステップS27:NO)、制御装置30は、本処理ルーチンを一旦終了する。一方、演算回数Nが判定回数N_Th未満である場合(ステップS27:YES)、車両停止中にヨーゼロ点補正値Yr_Zを設定し、その後に車両が発進してから一回も舵角ゼロ点補正値θ_Zを演算していない。そのため、制御装置30は、上記ステップS15で更新した走行中タイマT1が予め設定されている判定タイマ値T1_Th未満であるか否かを判定する(ステップS28)。この判定タイマ値T1_Thは、ヨーレートセンサSE4の温度がヨーゼロ点補正値Yr_Zの設定時点から大きく変化している可能性があるか否かをヨーゼロ点補正値Yr_Zの設定時点からの経過時間に基づいて判断するための判定時間(例えば、30分)に相当する。
走行中タイマT1が判定タイマ値T1_Th以上である場合(ステップS28:NO)、制御装置30は、本処理ルーチンを一旦終了する。一方、走行中タイマT1が判定タイマ値T1_Th未満である場合(ステップS28:YES)、制御装置30は、その処理を次のステップS29に移行する。すなわち、走行中タイマT1が判定タイマ値T1_Th未満であるときには舵角ゼロ点補正値θ_Zの設定が許可され、走行中タイマT1が判定タイマ値T1_Th以上であるときには舵角ゼロ点補正値θ_Zの設定が許可されない。
ステップS29において、制御装置30は、後述する特大異常フラグFLG3がオフであるか否かを判定する。特大異常フラグFLG3がオンである場合(ステップS29:NO)、制御装置30は、本処理ルーチンを一旦終了する。一方、特大異常フラグFLG3がオフである場合(ステップS29:NO)、制御装置30は、車両が直進走行しているか否かを判定する(ステップS30)。例えば、以下に示す2つの条件がともに成立しているときに、車両が直進走行していると判定することができる。
(条件3)ステップS12で演算したヨーレート演算値の絶対値|Yr|がヨー判定値Yr_Th未満であること。
(条件4)ステップS12で演算した横方向加速度の絶対値|Gy|が横G判定値Gy_Th未満であること。
(条件3)ステップS12で演算したヨーレート演算値の絶対値|Yr|がヨー判定値Yr_Th未満であること。
(条件4)ステップS12で演算した横方向加速度の絶対値|Gy|が横G判定値Gy_Th未満であること。
なお、ヨー判定値Yr_Th及び横G判定値Gy_Thは、ヨーレート演算値の絶対値|Yr|及び横方向加速度の絶対値|Gy|が小さいか否かを判定するための基準値である。
これら各条件(条件3),(条件4)のうち少なくとも一方が成立していない場合(ステップS30:NO)、車両が直進走行していない可能性があるため、制御装置30は、本処理ルーチンを一旦終了する。一方、各条件(条件3),(条件4)がともに成立している場合(ステップS30:YES)、車両が直進走行していると判定できる。そのため、制御装置30は、以下に示す関係式(式1)にステップS12で演算したヨーレート演算値Yr及び車体速度VSを代入して今回の舵角ゼロ点補正値θ_Z(M)を求める(ステップS31)。なお、関係式(式1)における「N」はステアリング装置のギヤ比であり、「L」は車両のホイールベース長である。
そして、制御装置30は、演算回数Nを「1」だけインクリメントし(ステップS32)、異常フラグFLG2がオフであるか否かを判定する(ステップS33)。異常フラグFLG2がオフである場合(ステップS33:YES)、制御装置30は、今回の舵角ゼロ点補正値θ_Z(M)を舵角ゼロ点補正値θ_Zとしてメモリ31の所定領域に記憶させる(ステップS34)。したがって、本実施形態の制御装置30が、「舵角ゼロ点演算部」としても機能する。
続いて、制御装置30は、異常フラグFLG2をオフとし(ステップS35)、その後、本処理ルーチンを一旦終了する。
その一方で、異常フラグFLG2がオンである場合(ステップS33:NO)、メモリ31に記憶されている舵角ゼロ点補正値θ_Zを前回の舵角ゼロ点補正値θ_Z(M−1)とし、この前回の舵角ゼロ点補正値θ_Z(M−1)とステップS31で演算した今回の舵角ゼロ点補正値θ_Z(M)との差分θSubを求める(ステップS36)。そして、制御装置30は、演算した差分θSubが予め設定されている差分判定値θSub_Th未満であるか否かを判定する(ステップS37)。この差分判定値θSub_Thは、操舵角センサ値θ_Rとステアリングホイール25の実際の操舵角とのずれが大きくなり過ぎたか否かの判定基準として設定される基準値である。
その一方で、異常フラグFLG2がオンである場合(ステップS33:NO)、メモリ31に記憶されている舵角ゼロ点補正値θ_Zを前回の舵角ゼロ点補正値θ_Z(M−1)とし、この前回の舵角ゼロ点補正値θ_Z(M−1)とステップS31で演算した今回の舵角ゼロ点補正値θ_Z(M)との差分θSubを求める(ステップS36)。そして、制御装置30は、演算した差分θSubが予め設定されている差分判定値θSub_Th未満であるか否かを判定する(ステップS37)。この差分判定値θSub_Thは、操舵角センサ値θ_Rとステアリングホイール25の実際の操舵角とのずれが大きくなり過ぎたか否かの判定基準として設定される基準値である。
差分θSubが差分判定値θSub_Th以上である場合(ステップS37:NO)、制御装置30は、特大異常フラグFLG3をオンにセットし(ステップS38)、本処理ルーチンを一旦終了する。すなわち、差分θSubが大きすぎる場合には、舵角ゼロ点補正値θ_Zが前回の舵角ゼロ点補正値θ_Z(M−1)で保持される、すなわち舵角ゼロ点補正値θ_Zの変更が禁止される。
一方、差分θSubが差分判定値θSub_Th未満である場合(ステップS37:YES)、制御装置30は、その処理を前述したステップS34に移行する。したがって、ステップS31,S33,S34,S36〜S38を実行する制御装置30が、「他の舵角ゼロ点演算部」としても機能する。
次に、図4及び図5に示すタイミングチャートを参照して、舵角ゼロ点補正値θ_Zを設定する際の車両の動作について説明する。なお、前提として、車両停止中ではステアリングホイール25の実際の操舵角が「0(零)」であり、今回の車両走行中に舵角ゼロ点補正値θ_Zが設定されるまで舵角ゼロ点補正値θ_Zが「0(零)」に設定されているものとする。また、第6のタイミングt16からは、ヨーレートセンサSE4によって検出されるヨーレートセンサ値Yr_Rでドリフト現象が発生し、車両が直進走行していてもヨーレートセンサ値Yr_Rが時間の経過に伴って次第に変化するものとする。さらに、車両の車体速度VSが一定となる第4のタイミングt14以降で舵角ゼロ点補正値θ_Zの演算が行われるものとする。
また、図4では、車両の走行状態が走行初期状態でなくなっても定期的に舵角ゼロ点補正値θ_Zの演算を行う比較例についても説明している。そして、図4(f),(g)では、本実施形態における舵角ゼロ点補正値θ_Z及び操舵角演算値θ(=θ_R−θ_Z)を実線にて示し、比較例における舵角ゼロ点補正値θ_Z及び操舵角演算値θを破線にて示している。
図4(a)に示すように、第1のタイミングt11で車両の運転スイッチが操作されてエンジンの運転が開始されると、ヨーレートセンサ値Yr_Rや操舵角センサ値θ_Rが通電され、所定の制御サイクル毎にヨーレートセンサ値Yr_R及び操舵角センサ値θ_Rが検出されるようになる。本実施形態では、図4(c),(e)に示すように、車両停止中であっても、ヨーレートセンサ値Yr_Rは「0(零)」よりも大きい値となっているとともに、操舵角センサ値θ_Rは実際の操舵角からずれた値となっている。
そして、第2のタイミングt12で車両が停止中であると判定されると、ヨーゼロ点補正値Yr_Zが設定される。すなわち、車両停止中にあっては、車両にヨーモーメントが発生しておらず、車両の実際のヨーレートは「0(零)」のはずである。しかし、本実施形態では、車両が停止中であるにも拘らずヨーレートセンサ値Yr_Rが「0(零)」からずれた値となっている。そのため、車両停止中におけるヨーレートセンサ値Yr_Rがゼロ点からのずれ量と判断され、ヨーゼロ点補正値Yr_Zが設定される。
すると、図4(d)に示すように、ヨーレートセンサ値Yr_Rからヨーゼロ点補正値Yr_Zを差し引いたヨーレート演算値Yrはほぼ「0(零)」とされる。このように車両停止中でヨーゼロ点補正値Yr_Zを設定することにより、車両走行中に発生する車両のヨーモーメントに相当するヨーレート演算値Yrを精度よく演算することが可能となる。
その後、図4(a)に示すように、第3のタイミングt13で車両が発進すると、車両の車体速度VSが次第に速くなる。そして、車体速度VSが一定となる第4のタイミングt14よりも後の第5のタイミングt15では、図4(b),(d)に示すように、横方向加速度の絶対値|Gy|は横G判定値Gy_Th未満であるとともに、ヨーレート演算値の絶対値|Yr|はヨー判定値Yr_Th未満である。また、この第5のタイミングt15では、ヨーゼロ点補正値Yr_Zが設定される第2のタイミングt12からの経過時間が判定時間KTに達していない。そのため、図4(f)に示すように、第5のタイミングt15では、このタイミングのヨーレート演算値Yr及び車体速度VSを上記関係式(式1)に代入することにより、舵角ゼロ点補正値θ_Zが設定される。
すると、図4(g)に示すように、ステアリングホイール25の実際の操舵角は「0(零)」であるため、操舵角センサ値θ_Rから舵角ゼロ点補正値θ_Zを差し引いた操舵角演算値θがほぼ「0(零)」となる。そして、本実施形態にあっては、第5のタイミングt15以降で車両が停止して同車両が再び発進するまでの間、舵角ゼロ点補正値θ_Zは、基本的には第5のタイミングt15で設定された値に保持される。
ここで、図4(c),(d)に示すように、車両の走行中の第6のタイミングt16でヨーレートセンサ値Yr_Rにドリフト現象が発生すると、車両に発生しているヨーモーメントが変わっていないにも拘わらず、ヨーレートセンサ値Yr_R及びヨーレート演算値Yrが時間の経過に伴って除変する。もし仮に、こうした状態で車両が停止しても、ヨーレート演算値Yrは「0(零)」にはならない。これは、ヨーレートセンサSE4の温度が、ヨーゼロ点補正値Yr_Zの設定時点から大きく変化したため、ヨーゼロ点補正値Yr_Zの設定が行われた前回の車両停止時と今回の車両停止時とでヨーレートセンサSE4からの信号の出力態様が変わったためである。
比較例にあっては、こうしたヨーレートセンサ値Yr_Rのドリフト現象が発生している第7のタイミングt17でも、車両が直進走行していると判定できると、舵角ゼロ点補正値θ_Zが演算される。この場合、第7のタイミングt17で演算されたヨーレート演算値Yrが上記関係式(式1)に代入されることとなるため、図4(f)にて破線で示すように、舵角ゼロ点補正値θ_Zは、第7のタイミングt17以前から大きく変わる。その結果、図4(g)に示すように、車両が直進走行していても、操舵角演算値θは「0(零)」から乖離した値となりやすい。すなわち、第7のタイミングt17での舵角ゼロ点補正値θ_Zの再設定によって操舵角演算値θの演算精度が低くなる。
これに対し、本実施形態では、車両が発進してから舵角ゼロ点補正値θ_Zが一回演算されると、それ以降(ここでは、第5のタイミングt15以降)では、車両の走行状態が走行初期状態ではなくなったと判定され、舵角ゼロ点補正値θ_Zが演算されない。そのため、比較例の場合と比較して、ヨーレートセンサ値Yr_Rにドリフト現象が発生している状態での舵角ゼロ点補正値θ_Zの演算が行われにくくなり、舵角ゼロ点補正値θ_Zの設定精度の低下が抑制される。
ただし、車両の走行状態が走行初期状態ではなくなった場合であっても、舵角ゼロ点補正値θ_Zが演算されることがある。こうした場合としては、運転者による通常の車両操作では発生し得ない大きな加速度が車両に発生することにより、車両特性が大きく変わった可能性がある場合などが挙げられる。
図5(a),(b)に示すように、運転者によるステアリングホイール25の操作によって車両の横方向加速度Gyが大きくなる第1のタイミングt21では、横方向加速度Gyの変化に合わせてヨーレート演算値Yrも変化する。この場合、横方向加速度の絶対値|Gy|は異常判定値Gy1_Th未満であるため、舵角ゼロ点補正値θ_Zの再演算は許可されない。
その後の第2のタイミングt22で、横方向加速度の絶対値|Gy|が異常判定値Gy1_Th以上になると、舵角ゼロ点補正値θ_Zの再演算が許可される。こうした場合としては、自車両に側方から大きな衝撃が加わった場合などが挙げられる。この場合は、運転者によるステアリングホイール25の操作によって横方向加速度Gyが変化したわけではないため、横方向加速度Gyが大きく変化してもヨーレート演算値Yrはあまり変化しない。
そして、第2のタイミングt22よりも後の第3のタイミングt23で、車両が直進走行していると判定されると、その時点のヨーレート演算値Yrと車体速度VSを上記関係式(式1)に代入することで今回の舵角ゼロ点補正値θ_Z(M)が演算される。また、第3のタイミングt23以前の舵角ゼロ点補正値θ_Zである前回の舵角ゼロ点補正値θ_Z(M−1)と今回の舵角ゼロ点補正値θ_Z(M)との差分θSubが演算される。そして、図5(c)にて実線で示すように、上記の差分θSubが差分判定値θSub_Th未満である場合には、今回の舵角ゼロ点補正値θ_Z(M)が舵角ゼロ点補正値θ_Zとされる。
その一方で、図5(c)にて二点鎖線で示すように、上記の差分θSubが差分判定値θSub_Th以上である場合には、横方向加速度Gyの変動前後で車両特性が変わりすぎたと判断できるため、舵角ゼロ点補正値θ_Zは第3のタイミングt23以前の値(すなわち、前回の舵角ゼロ点補正値θ_Z(M−1))で保持される。そして、操舵角演算値θを用いる挙動制御の実行が制限される。例えば、挙動制御の開始タイミングを決定するための閾値が、通常の閾値よりも大きい値に設定される。
なお、本実施形態では、車両の停止期間が非常に短い場合には、ヨーゼロ点補正値Yr_Zが設定されないことがある。この場合、図2及び図3に示すように、舵角ゼロ点補正値θ_Zの演算回数Nと、ヨーゼロ点補正値Yr_Zを最後に設定してからの経過時間に相当する走行中タイマT1とがリセットされない。しかし、ヨーゼロ点補正値Yr_Zの設定が行われる前に車両が発進した場合であっても、演算回数Nが判定回数N_Th未満(ステップS27:YES)であって且つ走行中タイマT1が判定タイマ値T1_Th未満(ステップS28:YES)であるときには、舵角ゼロ点補正値θ_Zが演算されることもある。
以上説明したように、本実施形態では、以下に示す効果を得ることができる。
(1)ヨーレートセンサSE4の特性は、車両の走行時間が長くなるほど変化しやすい。そこで、本実施形態では、舵角ゼロ点補正値θ_Zの演算回数Nが判定回数N_Th未満であるときには、車両の走行状態が走行初期状態であると判定できるため、車両が直進走行しているときのヨーレートセンサ値Yr_Rを用いて舵角ゼロ点補正値θ_Zが演算される。その一方で、舵角ゼロ点補正値θ_Zの演算回数Nが判定回数N_Th以上であるときには、車両の走行状態が走行初期状態ではなくなったと判定できるため、舵角ゼロ点補正値θ_Zの演算が禁止される。すなわち、ヨーレートセンサSE4の特性がヨーゼロ点補正値Yr_Zを設定した時点から変わった時点以降で検出されたヨーレートセンサ値Yr_Rを用いた舵角ゼロ点補正値θ_Zの演算が行われにくくなる。そのため、舵角ゼロ点補正値θ_Zの設定精度を向上させることができ、ひいては操舵角演算値θの演算精度を向上させることができる。
(1)ヨーレートセンサSE4の特性は、車両の走行時間が長くなるほど変化しやすい。そこで、本実施形態では、舵角ゼロ点補正値θ_Zの演算回数Nが判定回数N_Th未満であるときには、車両の走行状態が走行初期状態であると判定できるため、車両が直進走行しているときのヨーレートセンサ値Yr_Rを用いて舵角ゼロ点補正値θ_Zが演算される。その一方で、舵角ゼロ点補正値θ_Zの演算回数Nが判定回数N_Th以上であるときには、車両の走行状態が走行初期状態ではなくなったと判定できるため、舵角ゼロ点補正値θ_Zの演算が禁止される。すなわち、ヨーレートセンサSE4の特性がヨーゼロ点補正値Yr_Zを設定した時点から変わった時点以降で検出されたヨーレートセンサ値Yr_Rを用いた舵角ゼロ点補正値θ_Zの演算が行われにくくなる。そのため、舵角ゼロ点補正値θ_Zの設定精度を向上させることができ、ひいては操舵角演算値θの演算精度を向上させることができる。
(2)舵角ゼロ点補正値θ_Zの設定方法としては、車両が直進していると判定できるときの操舵角センサ値θ_Rをそのまま舵角ゼロ点補正値θ_Zとする方法も考えられる。この場合、車両が直進しているか否かの判定基準を厳しめに設定すると、舵角ゼロ点補正値θ_Zを精度よく設定できるものの、舵角ゼロ点補正値θ_Zの設定機会が少なくなるおそれがある。
この点、本実施形態では、舵角ゼロ点補正値θ_Zを演算するに際し、上記関係式(式1)を用いて舵角ゼロ点補正値θ_Zを演算している。そのため、上記の場合と比較して、車両が直進しているか否かの判定精度を厳しめに設定しなくても、舵角ゼロ点補正値θ_Zを精度よく設定することができる。また、車両が直進しているか否かの判定精度を厳しめに設定しなくてもよい分、車両発進後から早期に舵角ゼロ点補正値θ_Zを演算できるようになる。すなわち、ヨーレートセンサSE4の温度がヨーゼロ点補正値Yr_Zを設定した時点から大きく変化したときに検出されたヨーレートセンサ値Yr_Rを用いた舵角ゼロ点補正値θ_Zの演算が行われにくくなる。
(3)車両が発進してから同車両が直進走行しているとなかなか判定されないと、舵角ゼロ点補正値θ_Zを未だ演算してないにも拘わらず、ヨーレートセンサSE4の温度がヨーゼロ点補正値Yr_Zの設定時点から大きく変化してしまう可能性がある。こうした場合には、ヨーゼロ点補正値Yr_Zが再度設定されるまで舵角ゼロ点補正値θ_Zの演算を行わないほうが好ましい。そこで、本実施形態では、ヨーゼロ点補正値Yr_Zが最後に設定された時点からの経過時間が判定時間KT以上になった場合には、演算回数Nが判定回数N_Th未満であっても舵角ゼロ点補正値θ_Zの演算を行わないようにした。この場合、今回の走行期間で舵角ゼロ点補正値θ_Zが演算されなくても、今回の走行期間よりも以前の走行期間で設定された舵角ゼロ点補正値θ_Zに基づいて操舵角演算値θが演算されることとなる。そのため、舵角ゼロ点補正値θ_Zの設定精度の低下を抑制することができる。
(4)前後方向加速度の絶対値|Gx|が前後G異常判定値Gx1_Th以上になったとき、又は横方向加速度の絶対値|Gy|が異常判定値Gy1_Th以上になったときには、上記演算回数Nが判定回数N_Th以上であっても、走行中タイマT1が判定タイマ値T1_Th以上であっても、舵角ゼロ点補正値θ_Zの演算が許可される。すなわち、車両が直進していると判定できるタイミングで舵角ゼロ点補正値θ_Zが演算される。これにより、車両特性が変わっていたとしても、舵角ゼロ点補正値θ_Zを演算することにより、操舵角演算値θの演算精度の低下を抑制することができる。
(5)本実施形態では、前後方向加速度の絶対値|Gx|が前後G異常判定値Gx1_Th以上、又は横方向加速度の絶対値|Gy|が異常判定値Gy1_Th以上になり、今回の舵角ゼロ点補正値θ_Z(M)が演算されると、この今回の舵角ゼロ点補正値θ_Z(M)と前回の舵角ゼロ点補正値θ_Z(M−1)との差分θSubが演算される。そして、差分θSubが差分判定値θSub_Th未満であるときにのみ、舵角ゼロ点補正値θ_Zが再設定される。この場合、再設定後の舵角ゼロ点補正値θ_Zを用いて操舵角演算値θが演算されることになり、この操舵角演算値θによって上記挙動制御を行うことにより車両の挙動を適切に制御することができる。
その一方で、差分θSubが差分判定値θSub_Th以上であるときには、車両特性が変化しすぎた判断されて上記挙動制御の実行が禁止されるため、舵角ゼロ点補正値θ_Zが再設定されない。
なお、上記実施形態は以下のような別の実施形態に変更してもよい。
・ステップS37において差分θSubが差分判定値θSub_Th以上であったときには、挙動制御の実行を禁止するようにしてもよい。そして、差分θSubが差分判定値θSub_Th未満であったときには、挙動制御の開始タイミングを決定するための閾値を以前よりも大きい値に変更するようにしてもよい。
・ステップS37において差分θSubが差分判定値θSub_Th以上であったときには、挙動制御の実行を禁止するようにしてもよい。そして、差分θSubが差分判定値θSub_Th未満であったときには、挙動制御の開始タイミングを決定するための閾値を以前よりも大きい値に変更するようにしてもよい。
・ステップS37の判定処理を省略してもよい。この場合、ステップS31で演算された今回の舵角ゼロ点補正値θ_Z(M)が、前回の舵角ゼロ点補正値θ_Z(M−1)との差分の大きさとは関係なく、舵角ゼロ点補正値θ_Zとされることとなる。
・ステップS13において前後方向加速度の絶対値|Gx|が前後G異常判定値Gx1_Th以上又は横方向加速度の絶対値|Gy|が横G異常判定値Gy1_Th以上である場合には、舵角ゼロ点補正値θ_Zを変更することなく、挙動制御の実行を禁止してもよい。また、挙動制御の開始タイミングを決定するための閾値を以前よりも大きい値に変更するようにしてもよい。
・ステップS13では、前後方向加速度の絶対値|Gx|が前後G異常判定値Gx1_Th以上であるか否かのみを判定するようにしてもよい。また、横方向加速度の絶対値|Gy|が横G異常判定値Gy1_Th以上であるか否かのみを判定するようにしてもよい。
・ステップS28の判定処理を省略してもよい。このような制御構成を採用しても、車両の状態が走行初期状態ではないと判定されたとき(すなわち、ステップS27の判定結果が「NO」であるとき)には、舵角ゼロ点補正値θ_Zの演算が禁止される。
・ヨーレートセンサ値Yr_Rのドリフト現象の発生は、エンジンの運転が開始されてからの経過時間が長くなるほど発生しやすい。そこで、判定タイマ値T1_Thを、エンジンの運転が開始されてからの経過時間が長いときには同経過時間が短いときよりも小さい値に設定するようにしてもよい。これにより、ヨーゼロ点補正値Yr_Zを設定した時点からヨーレートセンサSE4の温度が大きく変わった時点以降に検出されるヨーレートセンサ値Yr_Rを用いた舵角ゼロ点補正値θ_Zの演算が行われにくくなる。したがって、舵角ゼロ点補正値θ_Zの設定精度の低下をより抑制することができる。
・判定回数N_Thを「2」以上の任意の整数(例えば、3)としてもよい。
・また、判定回数N_Thを、エンジンの運転が開始されてからの経過時間が長いときには同経過時間が短いときよりも小さい値に設定するようにしてもよい。これにより、ヨーゼロ点補正値Yr_Zを設定した時点からヨーレートセンサSE4の温度が大きく変わった以降に検出されたヨーレートセンサ値Yr_Rを用いた舵角ゼロ点補正値θ_Zの演算が行われにくくなる。したがって、舵角ゼロ点補正値θ_Zの設定精度の低下をより抑制することができる。
・また、判定回数N_Thを、エンジンの運転が開始されてからの経過時間が長いときには同経過時間が短いときよりも小さい値に設定するようにしてもよい。これにより、ヨーゼロ点補正値Yr_Zを設定した時点からヨーレートセンサSE4の温度が大きく変わった以降に検出されたヨーレートセンサ値Yr_Rを用いた舵角ゼロ点補正値θ_Zの演算が行われにくくなる。したがって、舵角ゼロ点補正値θ_Zの設定精度の低下をより抑制することができる。
・ステップS28の判定処理を省略した場合にあっては、車両の状態が走行初期状態であるか否かの判定を、上記演算回数Nではなく、車両が発進してからの経過時間に基づき判定するようにしてもよい。この場合、車両が発進してからの経過時間が所定の走行初期判定時間未満であるときには舵角ゼロ点補正値θ_Zの演算が許可され、車両が発進してからの経過時間が走行初期判定時間以上になったには舵角ゼロ点補正値θ_Zの演算が基本的には禁止される。このような制御構成を採用しても、上記実施形態と同等の作用・効果を得ることができる。
・ステップS28の判定処理を行うのであれば、ステップS27の判定処理を省略してもよい。このような制御構成を採用しても、ヨーゼロ点補正値Yr_Zが最後に設定された時点からの経過時間が判定時間KT以上になった場合には、舵角ゼロ点補正値θ_Zが演算されない。そのため、舵角ゼロ点補正値θ_Zの設定精度を向上させることができ、ひいては操舵角演算値θの演算精度を向上させることができる。
・ヨーゼロ点補正値Yr_Zは、停車中に検出されたヨーレートセンサ値Yr_Rに基づいて設定されたものであれば、上記実施形態以外の他の任意の方法で設定してもよい。例えば、停車中と判定された時点のヨーレートセンサ値Yr_Rをヨーゼロ点補正値Yr_Zとしてもよい。
・車両が直進しているか否かの判定条件は、上記条件(条件3),(条件4)以外の他の条件を含んでもよい。例えば、右前輪の車輪速度VWと左前輪の車輪速度VWとの車輪速度差が所定差未満であるか否かを含んでもよい。この条件を判定条件に加える場合には、上記条件(条件3),(条件4)の少なくとも一方を判定条件から除外してもよい。
次に、上記各実施形態及び別の実施形態から把握できる技術的思想を以下に追記する。
(イ)前記ヨーゼロ点設定部によってヨーゼロ点補正値が設定されてからの車両発進後の経過時間が走行初期判定時間未満であるときを、車両の走行状態が走行初期状態であるとしてもよい。
(イ)前記ヨーゼロ点設定部によってヨーゼロ点補正値が設定されてからの車両発進後の経過時間が走行初期判定時間未満であるときを、車両の走行状態が走行初期状態であるとしてもよい。
(ロ)車両停止時にヨーレートセンサによって検出されるヨーレートセンサ値に基づいてヨーゼロ点補正値を設定するヨーゼロ点設定部と、
車両が直進走行しているときに前記ヨーレートセンサによって検出されるヨーレートセンサ値から前記ヨーゼロ点設定部によって設定されたヨーゼロ点補正値を差し引いたヨーレートに基づいて舵角ゼロ点補正値を演算する舵角ゼロ点演算部と、を備え、
前記舵角ゼロ点演算部は、前記ヨーゼロ点設定部によってヨーレートセンサ値が設定されてからの経過時間が判定時間未満であるときには舵角ゼロ点補正値の演算を行い、同経過時間が前記判定時間以上であるときには舵角ゼロ点補正値の演算を行わない舵角ゼロ点補正装置。
車両が直進走行しているときに前記ヨーレートセンサによって検出されるヨーレートセンサ値から前記ヨーゼロ点設定部によって設定されたヨーゼロ点補正値を差し引いたヨーレートに基づいて舵角ゼロ点補正値を演算する舵角ゼロ点演算部と、を備え、
前記舵角ゼロ点演算部は、前記ヨーゼロ点設定部によってヨーレートセンサ値が設定されてからの経過時間が判定時間未満であるときには舵角ゼロ点補正値の演算を行い、同経過時間が前記判定時間以上であるときには舵角ゼロ点補正値の演算を行わない舵角ゼロ点補正装置。
(ハ)操舵角センサによって検出される操舵角センサ値から上記舵角ゼロ点補正装置によって設定された舵角ゼロ点補正値を差し引いてステアリングホイールの操舵角演算値を求める操舵角演算装置。
上記構成によれば、舵角ゼロ点補正装置によって舵角ゼロ点補正値を精度良く設定できるため、操舵角の演算精度を向上させることができるようになる。
25…ステアリングホイール、30…舵角ゼロ点補正装置及び操舵角演算装置としての制御装置(ヨーゼロ点設定部、舵角ゼロ点演算部、他の舵角ゼロ点演算部)、SE2…加速度センサの一例としての横方向加速度センサ、SE3…操舵角センサ、SE4…ヨーレートセンサ、SE5…加速度センサの一例としての前後方向加速度センサ、Gx…加速度センサ値の一例としての前後方向加速度、Gy…加速度センサ値の一例としての横方向加速度、Gy1_Th…異常判定値、N…演算回数、N_Th…判定回数、T1…経過時間に相当する走行中タイマ、T1_Th…判定時間に相当する判定タイマ値、Yr…ヨーレート、Yr_R…ヨーレートセンサ値、Yr_Z…ヨーゼロ点補正値、θSub…差分、θSub_Th…差分判定値、θ…操舵角演算値、θ_R…操舵角演算値、θ_Z…舵角ゼロ点補正値、θ_Z(M)…今回の舵角ゼロ点補正値、θ_Z(M−1)…前回の舵角ゼロ点補正値。
Claims (5)
- 車両停止時にヨーレートセンサによって検出されるヨーレートセンサ値に基づいてヨーゼロ点補正値を設定するヨーゼロ点設定部と、
車両が直進走行しているときに前記ヨーレートセンサによって検出されるヨーレートセンサ値から前記ヨーゼロ点設定部によって設定されたヨーゼロ点補正値を差し引いたヨーレートに基づいて舵角ゼロ点補正値を演算する舵角ゼロ点演算部と、を備え、
前記舵角ゼロ点演算部は、前記ヨーゼロ点設定部によってヨーゼロ点補正値が設定されてからの車両発進後において同車両の走行状態が走行初期状態であるときには舵角ゼロ点補正値の演算を行い、車両の走行状態が走行初期状態ではないときには舵角ゼロ点補正値の演算を行わない
舵角ゼロ点補正装置。 - 前記ヨーゼロ点設定部によってヨーゼロ点補正値が設定されてからの車両発進後における前記舵角ゼロ点演算部による舵角ゼロ点補正値の演算回数が判定回数未満であるときを、車両の走行状態が走行初期状態であるとする
請求項1に記載の舵角ゼロ点補正装置。 - 前記舵角ゼロ点演算部は、前記ヨーゼロ点設定部によってヨーゼロ点補正値が設定されてからの経過時間が判定時間未満であるときには、舵角ゼロ点補正値の演算を許可する
請求項1又は請求項2に記載の舵角ゼロ点補正装置。 - 車両の加速度センサによって検出される加速度センサ値が異常判定値以上になった場合、その後の車両の直進走行中で前記ヨーレートセンサによって検出されるヨーレートセンサ値から前記ヨーゼロ点設定部によって設定されたヨーゼロ点補正値を差し引いたヨーレートに基づいて舵角ゼロ点補正値を演算する他の舵角ゼロ点演算部をさらに備える
請求項1〜請求項3のうち何れか一項に記載の舵角ゼロ点補正装置。 - 前記他の舵角ゼロ点演算部は、
車両が直進走行しているときに前記ヨーレートセンサによって検出されるヨーレートセンサ値から前記ヨーゼロ点設定部によって設定されたヨーゼロ点補正値を差し引いたヨーレートに基づいて今回の舵角ゼロ点補正値を演算し、
前記加速度センサによって検出される加速度センサ値が前記異常判定値以上となる前に前記舵角ゼロ点演算部によって演算された前回の舵角ゼロ点補正値と前記今回の舵角ゼロ点補正値との差分が差分判定値未満であるときには舵角ゼロ点補正値を前記今回の舵角ゼロ点補正値とし、
前記差分が前記差分判定値以上であるときには舵角ゼロ点補正値を変更しない
請求項4に記載の舵角ゼロ点補正装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013043063A JP2014169055A (ja) | 2013-03-05 | 2013-03-05 | 舵角ゼロ点補正装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013043063A JP2014169055A (ja) | 2013-03-05 | 2013-03-05 | 舵角ゼロ点補正装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2014169055A true JP2014169055A (ja) | 2014-09-18 |
Family
ID=51691803
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2013043063A Pending JP2014169055A (ja) | 2013-03-05 | 2013-03-05 | 舵角ゼロ点補正装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2014169055A (ja) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106029477A (zh) * | 2016-04-07 | 2016-10-12 | 株式会社小松制作所 | 行走车辆及行走车辆的控制方法 |
WO2019016942A1 (ja) * | 2017-07-21 | 2019-01-24 | 三菱電機株式会社 | 運転支援装置、サーバ、および運転支援方法 |
CN115593514A (zh) * | 2022-10-31 | 2023-01-13 | 东风商用车有限公司(Cn) | 转向角度传感器零位标定方法、装置、设备及存储介质 |
WO2023171255A1 (ja) * | 2022-03-11 | 2023-09-14 | 日野自動車株式会社 | ヨーレート較正装置 |
CN116852383A (zh) * | 2023-09-05 | 2023-10-10 | 山东大学 | 一种机械臂零位自动标定装置及方法 |
-
2013
- 2013-03-05 JP JP2013043063A patent/JP2014169055A/ja active Pending
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106029477A (zh) * | 2016-04-07 | 2016-10-12 | 株式会社小松制作所 | 行走车辆及行走车辆的控制方法 |
WO2017175361A1 (ja) * | 2016-04-07 | 2017-10-12 | 株式会社小松製作所 | 走行車両及び走行車両の制御方法 |
JPWO2017175361A1 (ja) * | 2016-04-07 | 2018-04-12 | 株式会社小松製作所 | 走行車両及び走行車両の制御方法 |
US10343717B2 (en) * | 2016-04-07 | 2019-07-09 | Komatsu Ltd. | Travel vehicle and method for controlling travel vehicle |
CN106029477B (zh) * | 2016-04-07 | 2020-06-02 | 株式会社小松制作所 | 行走车辆及行走车辆的控制方法 |
WO2019016942A1 (ja) * | 2017-07-21 | 2019-01-24 | 三菱電機株式会社 | 運転支援装置、サーバ、および運転支援方法 |
WO2023171255A1 (ja) * | 2022-03-11 | 2023-09-14 | 日野自動車株式会社 | ヨーレート較正装置 |
CN115593514A (zh) * | 2022-10-31 | 2023-01-13 | 东风商用车有限公司(Cn) | 转向角度传感器零位标定方法、装置、设备及存储介质 |
CN116852383A (zh) * | 2023-09-05 | 2023-10-10 | 山东大学 | 一种机械臂零位自动标定装置及方法 |
CN116852383B (zh) * | 2023-09-05 | 2023-12-08 | 山东大学 | 一种机械臂零位自动标定装置及方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11066098B2 (en) | Vehicle disturbance detection apparatus | |
JP4636262B2 (ja) | 車両の重心位置横加速度取得装置、及び車両の運動制御装置 | |
JP5431745B2 (ja) | 車両の運動制御装置 | |
JP2014169055A (ja) | 舵角ゼロ点補正装置 | |
JP6106261B2 (ja) | 車両におけるアクティブ操舵システム用の非線形補償制御装置 | |
JP6364675B2 (ja) | 車両制御装置 | |
JP2007515347A (ja) | 摩擦値が不均一な走路でのブレーキ圧の制御方法 | |
CN111746500B (zh) | 车辆行驶控制系统 | |
CN108688668B (zh) | 用于车辆侧向力控制的方法和系统 | |
US10086669B2 (en) | Stabilizer control device | |
JP6819557B2 (ja) | 車両安定制御装置 | |
JP2007106210A (ja) | 車両の挙動制御装置 | |
JP5044000B2 (ja) | 車両用制御装置 | |
CN111152781B (zh) | 车辆行为稳定系统 | |
KR20170114660A (ko) | 차량의 언더스티어 및 오버스티어 보상 제어 방법 | |
WO2018235929A1 (ja) | 走行制御装置 | |
JP2016094112A (ja) | 車両の走行制御装置 | |
JP3987363B2 (ja) | 車両制御装置 | |
JPH07246948A (ja) | 車両運動状態量補正装置 | |
JP5849712B2 (ja) | ステアリングの中立点設定装置 | |
JP4811196B2 (ja) | 車両の操舵制御装置 | |
JP5375088B2 (ja) | 旋回挙動制御装置、旋回挙動制御方法 | |
JP2009192251A (ja) | 異常判定装置及び異常判定方法 | |
JP2010126154A (ja) | 自動軌道補正方法 | |
US20190283734A1 (en) | Vehicle stability control device |