JP7066041B2

JP7066041B2 - 車両制御装置

Info

Publication number: JP7066041B2
Application number: JP2021501720A
Authority: JP
Inventors: 知靖坂口; 大司清宮; 至貴深澤
Original assignee: Hitachi Astemo Ltd
Current assignee: Hitachi Astemo Ltd
Priority date: 2019-02-22
Filing date: 2020-01-21
Publication date: 2022-05-12
Anticipated expiration: 2040-01-21
Also published as: CN113424066B; WO2020170688A1; US20220084330A1; CN113424066A; DE112020000257T5; US12008845B2; JPWO2020170688A1

Description

本発明は、車両の自動運転、自動駐車、カーナビゲーション等の自車位置推定に用いることが可能な、車輪速センサによる車輪回転方向の推定に関する。

自動運転や自動駐車等で使用される自車位置推定において車輪速センサを使用する場合に、車輪の回転方向を知ることが重要である。車輪速センサを使用する自車位置推定は、例えば、自車の移動量を左右後輪の平均回転量、自車の旋回量を左右後輪の回転量差から推定する（旋回量は操舵角を使用する場合もある）。回転量は車輪速パルスのカウントから算出され、車輪の回転方向は車両のギアポジション（Ｄレンジ／Ｒレンジなど）から算出される。

走行中の車輪の回転方向は、ギアポジション等から容易に判定できる。しかし、車両の停車間際や車両が段差等に衝突したときの車輪の回転方向は、制動の反動や跳ね返りの影響でギアポジション等と異なることがあり、その判定が難しい。車輪の回転方向を出力する車輪速センサもあるが、回転方向の変化を検出することが遅れることもある。車輪の回転方向を間違えた状態で、車輪速センサの情報を使用すると、自車の移動量と自車の旋回量が不正確になり、自車位置推定の精度が低下する。これは、特に、数ｃｍ程度の精度が重要になる自動駐車システムなどでは、影響が大きい。

車輪速センサによる回転量測定は、車輪が回転によって特定の回転角度位置を通過する毎にカウントされるカウンタの値を使用することが多い。例えば、車輪が１回転する間に１００回のカウントがあるとすると、１カウント当り約３．６度の回転量であり、車輪の１回転当りの走行距離が既知ならば１カウント当りの車輪の走行距離を推定することができる。

しかし、このカウンタは、車輪の回転方向には関係なくカウントされることが知られている。回転方向が変化するときには、車輪が特定の回転角度位置を通過した後、すぐに車輪が逆回転して当該特定角度位置の回転角度位置を通過して、カウンタが再度カウントされることがあり得る。例えば、通常は１カウント当り３．６度の回転量が必要なところで、最初のカウント後に０．１度順回転したところで逆回転が始まり、０．１度逆回転したところでカウンタが再度カウントされることがある。

このとき、逆回転によるカウントを順回転によるカウントと取り違えると、本来車輪は０．１度進み０．１度戻ったところを、３．６度進んだものと推定することになる。これは車輪の推定位置を３．６度分間違うことになる。これを自車位置推定にそのまま反映すると、移動量と旋回量の推定精度を低下させ、その結果、自車位置推定の精度が低下する。

特許文献１は、車輪の回転量をカウント値として取得し、自車位置推定に使用することを開示しているが、カウント値のインクリメント毎にそのインクリメントがどちらの回転方向の回転によるものなのか、判定していない。

特開平１０－０３８５８５号公報

以下において、車輪速センサによって車輪が特定の回転角度位置を通過することを検知することを回転検知と呼ぶものとする。車輪速センサによる回転検知の回数をカウントしたときに、例えば車両停車際の車両揺り戻しや段差での跳ね返り等により、車輪が逆回転したときにカウントした回転検知を、正しく逆回転によるカウントであると判定することが重要である。

本開示の一態様は、複数の車輪を含む車両において、前記複数の車輪の各車輪が所定の回転角度位置を通過する毎に各車輪の回転を検知するセンサによって、前記複数の車輪に含まれる車輪の回転方向を判定する車両制御装置であって、前記センサによる各車輪の回転検知をカウントする、カウント部と、前記カウント部による各車輪の前記回転検知のカウント値に基づき、選択した判定対象車輪の回転方向を判定する回転判定部と、を含み、前記車両の所定位置の移動距離を基準として、各車輪で回転検知してから次に回転検知するまでの移動距離は、各車輪の回転検知走行距離と定義され、前記回転判定部は、選択した第１の判定対象車輪が２回回転検知される間に、前記第１の判定対象車輪の回転検知走行距離以下の回転検知走行距離を有する第１の参照車輪において、１回も回転検知がないとき、前記第１の判定対象車輪の２回目に検知した回転の回転方向は、１回目に検知した回転の回転方向と逆方向と判定する、ことを特徴とする車両制御装置である。

本開示の他の態様は、複数の車輪を含む車両において、前記複数の車輪の各車輪が所定の回転角度位置を通過する毎に各車輪の回転を検知するセンサによって、前記複数の車輪に含まれる車輪の回転方向を判定する車両制御装置であって、前記センサによる各車輪の回転検知をカウントする、カウント部と、前記カウント部による各車輪の前記回転検知のカウント値に基づき、選択した判定対象車輪の回転方向を判定する回転判定部と、を含み、前記車両の所定位置の移動距離を基準として、各車輪で回転検知してから次に回転検知するまでの移動距離は、各車輪の回転検知走行距離と定義され、前記回転判定部は、選択した第１の判定対象車輪が２回回転検知される間に、前記第１の判定対象車輪の回転検知走行距離よりも回転検知走行距離が長い第１の参照車輪において、偶数回の回転検知があったとき、前記第１の判定対象車輪の２回目に検知された回転の回転方向は１回目に検知された回転の回転方向と逆方向と判定する、ことを特徴とする車両制御装置である。

本発明の一態様によれば、車両停車間際の車両揺り戻しや段差での車両跳ね返りによる車輪速センサの逆回転カウントを検出できる。

車輪逆転検知システムを備えた車両制御システムの一例を示す全体構成図である。車輪逆転検知システムを備えた車両制御システムの一例を示す論理構成図である。ＡＢＳ／ＥＳＣＥＣＵの車輪速パルスカウント部の一例を示す概略論理構成図である。車輪速センサの仕組みの一例について説明する図である。波形整形部で生成された二つのパルス信号波形例を示す。車両の進行方向が変化したときの車輪速パルスカウントのインクリメントの様子を説明する図である。車両の進行方向が変化したときの車輪速パルスカウントのインクリメントの様子を説明する図である。車両の進行方向が変化したときの車輪速パルスカウントのインクリメントの様子を説明する図である。車両の進行方向が変化したときの車輪速パルスカウントのインクリメントの様子を説明する図である。インクリメント間インクリメント数を演算するためのカウンタの構成を示している。図８のカウンタ構成を使用して、各車輪間のカウント間カウント数を演算する手順を具体的に説明するフローチャートである。車両の走行距離と各車輪の位置関係から、回転検知走行距離の概念を説明する図である。車輪の回転検知が逆回転によるものか否か判定するための処理を示すフローチャートである。旋回する車両における、基準点及び車輪の旋回半径の関係を示す。

以下、本発明の実施例を図面を用いて説明する。なお、各図中、同一の作用または機能を有する部材または要素には同一の符号を付し、重複した説明を適宜省略する。

図１は、実施例に係る車輪逆転検知システムを備えた車両制御システム１の一例を示す全体構成図である。車輪逆転検知システムは、車輪それぞれに対応する車輪速センサ１６Ａ～１６Ｄと、車輪速センサ１６Ａ～１６Ｄと接続しているＡＢＳ（Ａｎｔｉ－ｌｏｃｋＢｒａｋｅＳｙｓｔｅｍ）／ＥＳＣ（ＥｌｅｃｔｒｏｎｉｃＳｔａｂｉｌｉｔｙＣｏｎｔｒｏｌ）ＥＣＵ（ＥｌｅｃｔｒｏｎｉｃｃｏｎｔｒｏｌＵｎｉｔ）３０とを備えている。

車輪速センサ１６Ａ～１６Ｄは、それぞれ、対応する車輪１２Ａ～１２Ｄの回転検知を行う。回転検知は、車輪が特定の回転角度位置を通過することを検知する。車輪速センサの構成の詳細は、図４を参照して後述する。ＡＢＳ／ＥＳＣＥＣＵ３０は、車輪速センサ１６Ａ～１６Ｄそれぞれによる車輪の回転検知の回数をカウントする。

車輪逆転検知システムは、さらに、変速機１５内のギアポジションセンサ（図１において不図示）と接続している変速機ＥＣＵ２０と、ステアリング機構１４内のステアリング角度センサ（図１において不図示）と接続しているステアリングＥＣＵ５０と、自動駐車コントローラ４０を備えている。変速機ＥＣＵ２０、ＡＢＳ／ＥＳＣＥＣＵ３０、自動駐車コントローラ４０及びステアリングＥＣＵ５０は、通信ネットワーク（ＮＷ）１７に接続されている。自動駐車コントローラ４０は、変速機ＥＣＵ２０からギアポジション（Ｄレンジ／Ｒレンジなど）の情報を、ＡＢＳ／ＥＳＣＥＣＵ３０からの車輪検知の情報を、そして、ステアリングＥＣＵ５０から舵角の情報を、ＮＷ１７を介して取得する。

図２は、実施例に係る車輪逆転検知システムを備えた車両制御システム１の一例を示す論理構成図である。変速機ＥＣＵ２０は、ギアポジション検出センサ１５１からの信号に基づき、ギアポジションを検出するギアポジション検出部２１を含む。ＡＢＳ／ＥＳＣＥＣＵ３０は、車輪速センサ１６Ａ～１６Ｄからの車輪速パルスをカウントする車輪速パルスカウント部３１（カウント部の例）を含む。

車輪速パルスカウント部３１は、車輪速センサ１６Ａ～１６Ｄそれぞれによる車輪の回転検知の回数をカウントする。自動駐車コントローラ４０は、自車位置を推定する自車位置推定部４１（回転判定部の例）を含む。ステアリングＥＣＵ５０は、ステアリング角度検出センサ１４１からの信号に基づき、ステアリングの操舵角を検出する操舵角検出部５１を含む。

ＥＣＵの機能部は、それぞれ、ハードウェアまたはハードウェアとソフトウェアの協働により実現できる。例えば、機能部は、プログラムに従って動作するプロセッサ及び／または特定のＬＳＩ（Ｌａｒｇｅ－ＳｃａｌｅＩｎｔｅｇｒａｔｉｏｎ）により実現することができる。

自車位置推定部４１は、車輪速パルスカウント値を自車位置推定に使用する。自車位置推定部４１は、車輪速パルスカウント部３１による各車輪の回転検知のカウント値に基づき、選択した車輪の回転方向を判定する。例えば、自車位置推定部４１は、車輪速パルスカウント部３１が出力する４輪の車輪速パルスカウント値、ギアポジション検出部が出力するギアポジション、及び操舵角検出部５１が出力する操舵角に基づき、車輪速パルスカウント値のインクリメントについて、回転方向を判定（推定）し、自車位置推定の計算に反映する。

図３は、実施例に係るＡＢＳ／ＥＳＣＥＣＵ３０の車輪速パルスカウント部３１の一例を示す概略論理構成図である。車輪速パルスカウント部３１は、は、車輪速センサ１６で検出された信号を整形してパルス信号を生成し、そのパルス信号の電圧変化の回数をカウントして記録する。車輪速センサ１６は、車輪速センサ１６Ａ～１６Ｄの任意の一つを示す。

具体的には、車輪速パルスカウント部３１は、波形整形部３１１、回転検知部３１２及び記録部３１３を含む。波形整形部３１１は、車輪速センサ１６Ａ～１６Ｄで検出された信号を整形してパルス信号を生成する。回転検知部３１２は、波形整形部３１１で生成されたパルス信号が立ち上り閾値を低電位側から高電位側に抜けた時と、パルス信号の電圧が立ち下り閾値を高電位側から低電位側に抜けた時に、車輪の回転を検知する。記録部３１３は、回転検知部３１２で検知された車輪それぞれの回転検知の回数をカウントして内部メモリに記録する。

図４は、車輪速センサ１６の仕組みの一例について説明する図である。車輪速センサ１６は、車輪に取り付けられているロータが所定量回転したことを逐次検出してこれを電気信号に変換する装置。図４に示すように、ロータ１３は、周方向に等間隔に配された凸部１３１と凹部１３２を複数有し、例えば、車軸に取り付けられたている。

図４は、電磁ピックアップ式の車輪速センサ１６の構成例を示しており、車輪速センサ１６は、磁化された電極１６１を先端に有する。車輪速センサ１６は、電極１６１の軸１６２の方向がロータ１３の径方向に一致するように、かつ、電極１６１の先端がロータ１３の外周面に近接するように配置されている。

車輪速センサ１６は、ロータ１３の回転中にロータ１３上の凸部１３１と凹部１３２が車輪速センサ１６の電極１６１の近傍を通過する際に発生する電圧の変化を電気信号として出力する。なお、車輪速センサ１６の検出方式は、ロータ１３の回転中の凸部１３１と凹部１３２の通過を検出可能なものであればよく、例えば他のホ一ル素子式、ＭＲＥ（ＭａｇｎｅｔｉｃＲｅｓｉｓｔａｎｃｅＥｌｅｍｅｎｔ：磁気抵抗素子）式などでもよい。

このような仕組みによる回転検知では、車輪の１回転当りの回転検知回数がロータの凹凸数から決まり、また、車輪の１回転当りの走行距離も決まっている。従って、各車輪の回転検知１回当りの走行距離（回転検知長と呼ぶものとする）は、回転検知長＝（車輪の１回転当りの走行距離）／（車輪の１回転当りの回転検知回数）として求めることができる。この回転検知長と回転検知回数を使って車輪の走行距離が算出でき、この回転検知長と回転検知の時間間隔を使用して車輪の走行速度を算出することができる。

図５は、波形整形部３１１で生成された二つのパルス信号波形例を示す。図５において、横軸は経過時間を示し、縦軸は電圧を示す。波形５５１Ａは、ロータ１３が一定方向で回転している場合のパルス信号を示す。波形５５１Ｂは、ロータ１３の回転方向が途中で逆転した場合のパルス信号を示す。波形５５１Ｂに示すように、パルス信号は回転方向の変化に係わらず立ち上りと立ち下りを交互に繰り返す。パルス信号の立ち上りと立ち下りの時間間隔は、通常では、回転検知長／回転速度から求めることができるが、回転方向の変化があったときには、これより短くなることがある。

図６Ａ及び６Ｂは、車両の進行方向が変化したときの車輪速パルスカウントのインクリメントの様子を説明する図である。図６Ａ及び６Ｂのグラフは、それぞれ、ギアポジション及び四つの車輪の車輪速パルスカウント値の時間変化を示す。車両は前進状態から停車し、その後に運転者はギアポジションを前進用ギアから後退用ギアに切り替え、後退を開始している。

車両は図における速度ゼロの時点で速度がゼロとなり、その直後に減速の反動によって僅かに逆方向（後方）に動いたものとする。速度ゼロの直前にインクリメントがありそのインクリメントから速度ゼロの時点まで僅かの回転量しかない車輪は、逆方向に僅かに回転するだけで再度インクリメントされる。

回転方向が一定の場合には一定の回転量毎（１カウント回転量）にインクリメントされる。一方、このように進行方向の切替わりの近傍では、最後のインクリメント時点と進行方向切り替わり時点の回転量差以上の逆方向の回転量があれば再度インクリメントされる。車両の進行方向が一定の場合には各車輪のカウントの間隔は各車輪の動線における走行距離による回転量と１カウント回転量から計算することができ、各車輪の車輪速パルスカウント値のインクリメントの順番を推定することができる。車両の進行方向の切替わりの近傍では、進行方向の切替わりの近傍でインクリメントされた車輪の車輪速パルスカウント値が、連続で再度インクリメントされる。

車輪速カウントをその回転方向とともに自車位置推定に利用するとき、前進用ギアのときのインクリメントは車輪の前進方向の回転によるインクリメントと判定し、後退用ギアのときのインクリメントは車輪の後退方向の回転によるインクリメントと判定する、とする。図６Ａの例において、各車輪が僅かに逆回転したものの逆回転によるインクリメントがなかったため自車位置推定に影響はない。一方、図６Ｂでは逆回転によるインクリメントが発生しており、後退方向の回転のインクリメントが、前進方向の回転のインクリメントと誤って認識される。これは自車位置推定の推定精度に悪影響を与える。

図７Ａ及び７Ｂは、車両の進行方向が変化したときの車輪速パルスカウントのインクリメントの様子を説明する図である。図７及び７Ｂのグラフは、それぞれ、ギアポジション及び四つの車輪の車輪速パルスカウント値の時間変化を示す。図６Ａ及び６Ｂを参照した説明に加えて、更に説明を追加する。

図６Ａ及び６Ｂを参照して、車両の進行方向が切り替わる速度ゼロの時点の近傍で車輪の逆回転インクリメントが連続インクリメントとして発生することについて説明した。逆にこの正常インクリメントと逆回転インクリメントの連続インクリメントの間では、進行方向の切替わりが発生している。したがって、図７Ａに示すように、これ以降の各車輪の車輪速パルスカウント値のインクリメントは全て逆回転インクリメントと見なすことができる。

また、進行方向の切替わり時点の近傍では正常インクリメントと逆回転インクリメントは対になっており、ある車輪の正常インクリメントと逆回転インクリメントの間に別の車輪のインクリメントがある場合には、上記ある車輪のインクリメントの間において、上記別の車輪の正常インクリメントと逆回転インクリメントとが対になっており、偶数回のインクリメントとなる。

ある車輪のインクリメントとの間に、別の車輪のインクリメントの回数が偶数ではない場合、その別の車輪の進行方向は逆転しておらず、上記ある車輪の進行方向も逆転していない。従って、図７Ｂに示すように、各車輪のインクリメント間のインクリメント回数が奇数の場合には、車両の進行方向の切替わりは発生していない。

図８及び９は、各車輪のインクリメント間の他の車輪のインクリメント数（インクリメント間インクリメント数と呼ぶものとする）を演算する方法を説明する図である。図８は、インクリメント間インクリメント数を演算するためのカウンタの構成を示している。この表の行は、その行に示される車輪で回転検知があったとき、その行に属するカウンタのリセット（初期値（０）へ戻す）を実行することを意味する。

この表の列は、その列に示される車輪で回転検知があったとき、その列に属するカウンタのインクリメントを実行することを意味する。例えば、右前輪で回転検知があったとき、カウンタＣｎｔＡＢ、ＣｎｔＡＣ、ＣｎｔＡＤはゼロにリセットされ、カウンタＣｎｔＢＡ、ＣｎｔＣＡ、ＣｎｔＤＡはインクリメントされる。このカウンタ構成によって、ある車輪において回転検知があってから次の回転検知までの間の当該車輪以外の車輪の回転検知回数をカウントすることができる。

図９は、図８のカウンタ構成を使用して、各車輪間のカウント間カウント数を演算する手順を具体的に説明するフローチャートである。本フローチャートに示す手順は、例えば、車輪速パルスカウント部３１によってシステムの制御周期毎に実施される。

まず、車輪速パルスカウント部３１は、図８のカウンタ構成と同様の構成で前回値を保持するためのカウンタ（それぞれ今回値カウンタと前回値カウンタと呼ぶものとする）に、その時点の今回値カウンタの各カウント値を複製する（Ｓ１１）。具体的には、今回値カウンタＣｎｔｘｙに対応する前回値カウンタＣｎｔｘｙ＿ｚを規定する。ここでｘ及びｙは、それぞれ、Ａ、Ｂ、Ｃ又はＤのいずれかであって、互いに異なる。車輪速パルスカウント部３１は、Ｃｎｔｘｙ＿ｚ＝Ｃｎｔｘｙを全てのｘとｙの組み合わせについて実施する。

次に、車輪速パルスカウント部３１は、各車輪の回転検知有無を調べ、今回値カウンタについて、回転検知があった車輪の行のカウント値をリセットしてゼロに戻す（Ｓ１２）。次に、車輪速パルスカウント部３１は、今回値カウンタと前回値カウンタの両方について、回転検知があった車輪の列のカウント値を一つインクリメントする（Ｓ１３）。

これによって、自車位置推定部４１は、その制御周期においてある車輪で回転検知があったときには当該車輪の行に属する前回値カウンタを参照すれば、当該車輪が２回回転検知する間に、他の車輪が回転検知した回数を得ることができる。

なお、この車両制御システムの制御周期が単位時間（例えば１０ｍｓ）で決まっているなら、同じ時間内（同じ制御タイミング）に複数の車輪で回転検知があった場合には時間的前後関係は識別できない。図８及び９を参照した説明では、当該車輪の２回の回転検知の間の他の車輪の回転検知回数は、当該車輪の回転検知と同じ制御タイミングで他の車輪が回転検知された回数も含む。これは、実際より多くの他の車輪の回転をカウントする可能性がある。

一方、それらを含めない場合には、実際より少ない他の車輪の回転をカウントする可能性がある。これはすなわち、逆回転を順回転と誤判定したり、順回転を逆回転と誤判定したりすることを意味するが、どちらの誤判定がシステムに影響が大きいかで、同じ制御タイミングの回転検知を含めるか含めないかを予め決めておけばよい。

図１０は、車両の走行距離と各車輪の位置関係から、回転検知走行距離の概念を説明する図である。車両の走行距離を、車両上の一点（基準点（所定位置）：例えば、後輪車軸中心）の移動距離（進行距離）と定義する。車両の走行距離と、各車輪の走行距離（転がる距離）とは、直進時以外では一致しない。車両の旋回中には、車両の走行距離及び各車輪の走行距離は、それぞれの位置での旋回半径に比例する。旋回時に後輪車軸中心より外側を通る車輪では、直進時よりも車両の走行距離当りの回転検知回数が増加する。旋回時に後輪車軸中心より内側を通る車輪では、直進時よりも車両の走行距離当りの回転検知回数が減少する。

ここで、車輪の回転検知１回当りの車両の走行距離を、回転検知走行距離と定義する。
回転検知走行距離＝回転検知長＊車両の基準点の走行距離／車輪の走行距離となる。車両の旋回中には、回転検知走行距離＝回転検知長＊車両の基準点の旋回半径／車輪の旋回半径とすることができる。

具体的な計算方法は例えば、以下である。図１０に示すように、車両の基準点を後輪車軸中心点６０とする。操舵角θのときの車両旋回半径、つまり、基準点６０の旋回半径を、Ｒ（θ）と表わす。操舵角θのときの右前輪１２Ａ、左前輪１２Ｂ、右後輪１２Ｃ、及び左後輪１２Ｄそれぞれの位置での旋回半径を、ｒＡ（θ）、ｒＢ（θ）、ｒＣ（θ）、及びｒＤ（θ）と表わす。車輪１２ｘ（ｘはＡからＤのいずれか）の回転検知長さをＬｘ、旋回半径をｒｘ（θ）と表わす。

車輪１２ｘの回転検知走行距離Ｌｐｘは、次の数式で表わされる。
Ｌｐｘ＝Ｌｘ＊Ｒ（θ）／ｒｘ（θ）

上記例において旋回半径は操舵角θの関数であるが、これらは例えば、ＧＰＳ（ＧｌｏｂａｌＰｏｓｉｔｉｏｎｉｎｇＳｙｓｔｅｍ）、加速度センサ、ヨーレートセンサ等の値の関数であってもよい。また、旋回半径は、直前の車両車速と各車輪の回転検知間隔（時間）から、推定してもよい。

これらの関係から、以下のことが導出される。２つの車輪１２ｘ、１２ｙ（ｘ、ｙはそれぞれＡ、Ｂ、ＣまたはＤであり、互いに異なる）について、両輪がどちらも一定方向に回転しているとする。車輪１２ｘの回転検知走行距離Ｌｐｘが、車輪１２ｙの回転検知走行距離Ｌｐｙ以上である場合（Ｌｐｘ＞＝Ｌｐｙ）、車輪１２ｘが２回回転検知される間に、車輪１２ｙは必ず１回以上回転検知される。そうでない場合、車輪１２ｘの２回目の回転検知は、図６Ａ及び６Ｂを参照して説明したような逆回転による回転検知である。

また、２つの車輪１２ｘ、１２ｙについて、両輪がどちらも一定方向に回転しているとする。車輪１２ｘの回転検知走行距離Ｌｐｘが、車輪１２ｙの回転検知走行距離Ｌｐｙより小さい場合（Ｌｐｘ＜Ｌｐｙ）、車輪１２ｘが２回回転検知される間に、車輪１２ｙは０回か１回回転検知され、２回以上の回転検知はありえない。そうでない場合、車輪１２ｘの２回目の回転検知は、図７Ａ及び７Ｂを参照して説明したような、逆回転による回転検知である。

さらに、Ｌｐｘ＜Ｌｐｙの場合において、車輪１２ｘの２回の回転検知の間に、車輪１２ｙの３回以上の回転検知も、車輪が振動的に動くことで起こり得る。車輪１２ｙのこれらの回転検知は、車輪１２ｙの同一角度位置を検知している。例えば、車輪１２ｘの回転検知後の車輪１２ｙの回転検知の１回目及び３回目は順回転による回転検知、２回目及び４回目の回転検知が逆回転による回転検知である。

すなわち、車輪１２ｙの回転検知の奇数回目が順回転による回転検知、偶数回目が逆回転による回転検知である。車輪１２ｙが順回転した後の車輪１２ｘの回転検知は、順回転による回転検知であり、車輪１２ｙが逆回転した後の車輪１２ｘの回転検知は、逆回転による回転検知である。

したがって、Ｌｐｘ＜Ｌｐｙであり、車輪１２ｘが２回回転検知される間に、車輪１２ｙが偶数回（ゼロ含まず）回転検知されたとき、車輪１２ｘの２回目の回転検知は、逆回転による回転検知である。また、Ｌｐｘ＜Ｌｐｙであり、車輪１２ｘが２回回転検知される間に、車輪１２ｙが奇数回回転検知されたとき、車輪１２ｘの２回目の回転検知は、順回転による回転検知である。

このうち後者の判定論理は、Ｌｐｘ＞＝Ｌｐｙのときの判定論理を合わせて、以下のように拡張することができる。車輪１２ｘが２回回転検知される間に、車輪１２ｙが奇数回回転検知されたとき、車輪１２ｘの２回目の回転検知は、順回転による回転検知である。

図１１は、車輪の回転検知が逆回転によるものか否か判定するための処理を示すフローチャートである。本フローチャートに示す処理は、いずれかの車輪で回転検知があった場合に実施され、図９を参照して説明した処理が実施された後に実施される。逆回転が発生し得るのが、低速走行のみの場合には、予め設定された車速未満の低速走行時のみ実施することとしてもよい。

まず、自車位置推定部４１は、図１０を参照して説明した方法で、各車輪の回転検知走行距離ＬｐＡ、ＬｐＢ、ＬｐＣ、ＬｐＤを計算する（Ｓ２１）。基準点及び各車輪の旋回半径は、例えば、操舵角の関数で予め定義されており、自車位置推定部４１は、操舵角の情報を、操舵角検出部５１から取得することができる。

次に、自車位置推定部４１は、車輪の逆回転の有無を以下のロジックに基づき判定する。自車位置推定部４１は、車輪速パルスカウント部３１から、車輪の回転検知の通知を受ける。車輪１２ｘの回転検知があった場合、以下の方法によって、車輪１２ｘ（選択された判定対象車輪）の回転方向を判定する（Ｓ２２）。自車位置推定部４１は、車輪１２ｘの回転方向に基づき自車位置を推定する。

具体的には、Ｃｎｔｘｙ＿ｚ（ｙ≠ｘ）について、Ｌｐｘ＞＝ＬｐｙかつＣｎｔｘｙ＿ｚ＝０のとき、自車位置推定部４１は、車輪１２ｘのその回転検知は逆回転による回転検知と判定する。Ｌｐｘ＜ＬｐｙかつＣｎｔｘｙ＿ｚ＝偶数のとき、自車位置推定部４１は、車輪１２ｘのその回転検知は逆回転による回転検知と判定する。Ｃｎｔｘｙ＿ｚ＝奇数のとき、自車位置推定部４１は、車輪１２ｘのその回転検知は順回転による回転検知と判定する。それ以外の場合、自車位置推定部４１は、車輪１２ｘの回転方向は不定と判定する。

自車位置推定部４１は、カウンタ値を、車輪速パルスカウント部３１から取得することができる。自車位置推定部４１は、例えば、ＬｐｙがＬｐｘに対して上記条件を満たす一つの車輪１２ｙを選択し、その車輪１２ｙのカウンタ値に基づき車輪１２ｘの回転方向を判定する。

上述のように、自車位置推定部４１は、選択した判定対象車輪１２ｘが２回回転検知される間に、判定対象車輪１２ｘの回転検知走行距離以下の回転検知走行距離を有する参照車輪１２ｙにおいて（Ｌｐｘ＞＝Ｌｐｙ）、１回も回転検知がないとき、判定対象車輪１２ｘの２回目に検知した回転の回転方向は、１回目に検知した回転の回転方向と逆方向と判定する。

また、自車位置推定部４１は、選択した判定対象車輪１２ｘが２回回転検知される間に、判定対象車輪１２ｘの回転検知走行距離よりも回転検知走行距離が長い参照車輪１２ｙにおいて（Ｌｐｘ＜Ｌｐｙ）、偶数回の回転検知があったとき、判定対象車輪１２ｘの２回目に検知された回転の回転方向は１回目に検知された回転の回転方向と逆方向と判定する。

また、自車位置推定部４１は、判定対象車輪１２ｘが２回回転検知される間に、参照車輪１２ｙで奇数回の回転検知があったとき、判定対象車輪１２ｘの２回目に検知された回転の回転方向は、１回目に検知された回転の回転方向と同一方向と判定する。

回転方向不定の場合、自車位置推定部４１は、その他の判定条件に基づき、車輪１２ｘの回転方向を判定することができる。その他の判定条件は、例えば、駆動トルク方向、勾配方向、加速度センサ値、過去の実績データなどである。

２つの車輪の回転検知長が等しいとき、つまりＬｘ＝Ｌｙのとき、自車位置推定部４１は、Ｌｐｘ＞＝ＬｐｙかＬｐｘ＜Ｌｐｙか、は旋回方向だけで判定可能である。旋回によって車輪１２ｘが車輪１２ｙより内側の場合、Ｌｐｘ＞＝Ｌｐｙであり、車輪１２ｘが車輪１２ｙより外側である場合、Ｌｐｘ＜Ｌｐｙである。

自車位置推定部４１は、旋回方向の情報として、ステアリング角度検出センサ１４１の情報以外にも、左右輪の走行距離差や加速度センサ、ヨーレートセンサ等の情報を用いてもよい。一般的には、前輪の左と右、後輪の左と右とでは回転検知長は等しく、前輪同士、後輪同士に本方法を適用可能である。

上記観点から、自車位置推定部４１は、車両の直進時、参照車輪１２ｙの回転検知走行距離が判定対象車輪１２ｘの回転検知走行距離以下であり、車両の旋回において参照車輪が判定対象車輪１２ｘよりも外側を通っているとき、旋回において、参照車輪１２ｙの回転検知走行距離は判定対象車輪１２ｘの回転検知走行距離よりもが短いと判定する。

図１２は、旋回する車両における、基準点６０及び車輪の旋回半径の関係を示す。車輪１２ｘが後輪（または非操舵輪）で、車輪１２ｙが車輪１２ｘと車両の直進時には略同一の軌跡となる関係の前輪（または操舵輪）のとき、車輪１２ｙは車両の旋回方向がどちらであっても車輪１２ｘより旋回半径が小さくなることがない。従って、Ｌｘ＞＝ＬｙであるならＬｐｘ＞＝Ｌｐｙである。例えば、右側の後輪１２Ｃと右側の前輪１２Ａのペア、または、左側の後輪１２Ｄと左側の前輪１２Ｂのペアが、この関係を満たす。この場合、ステアリング角度センサなど、旋回状態に関する情報は不要となる。

上記観点から、自車位置推定部４１は、操舵輪と非操舵輪とが、車両の直進時において略同一の軌跡を有し、車両の直進時における操舵輪の回転検知走行距離が非操舵輪の回転検知走行距離以下であるとき、車両の旋回方向に係わらず、操舵輪の回転検知走行距離は非操舵輪の回転検知走行距離以下であると判定する。

以上のように、本実施例は、逆回転によるカウントを検出したい車輪に着目し、当該車輪の２回の回転検知の間の他の車輪の回転検出パターンから、当該車輪の２回の回転検知について回転方向が互いに同一方向か逆方向かを判別する。これにより、例えば、車両停車間際の車両揺り戻しや段差での車両跳ね返り等による、車輪速センサの逆回転カウントを検出できる。車両揺り戻しや車両跳ね返りを自車位置推定に反映することで、自車位置推定精度を向上することができる。

なお、本発明は上記した実施例に限定されるものではなく、様々な変形例が含まれる。
例えば、上記した実施例は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明したすべての構成を備えるものに限定されるものではない。また、ある実施例の構成の一部を他の実施例の構成に置き換えることが可能であり、また、ある実施例の構成に他の実施例の構成を加えることも可能である。また、各実施例の構成の一部について、他の構成の追加・削除・置換をすることが可能である。

また、上記の各構成・機能・処理部等は、それらの一部又は全部を、例えば集積回路で設計する等によりハードウェアで実現してもよい。また、上記の各構成、機能等は、プロセッサがそれぞれの機能を実現するプログラムを解釈し、実行することによりソフトウェアで実現してもよい。各機能を実現するプログラム、テーブル、ファイル等の情報は、メモリや、ハードディスク、ＳＳＤ（ＳｏｌｉｄＳｔａｔｅＤｒｉｖｅ）等の記録装置、または、ＩＣカード、ＳＤカード等の記録媒体に置くことができる。

また、制御線や情報線は説明上必要と考えられるものを示しており、製品上必ずしもすべての制御線や情報線を示しているとは限らない。実際には殆どすべての構成が相互に接続されていると考えてもよい。

１車両制御システム、１２Ａ-１２Ｄ車輪、１６、１６Ａ-１６Ｄ車輪速センサ、１２Ａ－１２Ｄ車輪、１２ｘ判定対象車輪、１２ｙ参照車輪、１３ロータ、１４ステアリング機構、１５変速機、２１ギアポジション検出部、３１車輪速パルスカウント部、４０自動駐車コントローラ、４１自車位置推定部、５１操舵角検出部、６０基準点、１３１凸部、１３２凹部、１４１ステアリング角度検出センサ、１５１ギアポジション検出センサ、１６１電極、１６２軸、３１１波形整形部、３１２回転検知部、３１３記録部

Claims

複数の車輪を含む車両において、前記複数の車輪の各車輪が所定の回転角度位置を通過する毎に各車輪の回転を検知するセンサによって、前記複数の車輪に含まれる車輪の回転方向を判定する車両制御装置であって、
前記センサによる各車輪の回転検知をカウントする、カウント部と、
前記カウント部による各車輪の前記回転検知のカウント値に基づき、選択した判定対象車輪の回転方向を判定する回転判定部と、を含み、
前記車両の所定位置の移動距離を基準として、各車輪で回転検知してから次に回転検知するまでの移動距離は、各車輪の回転検知走行距離と定義され、
前記回転判定部は、
選択した第１の判定対象車輪が２回回転検知される間に、前記第１の判定対象車輪の回転検知走行距離以下の回転検知走行距離を有する第１の参照車輪において、１回も回転検知がないとき、前記第１の判定対象車輪の２回目に検知した回転の回転方向は、１回目に検知した回転の回転方向と逆方向と判定する、ことを特徴とする車両制御装置。
請求項１に記載の車両制御装置であって、
前記回転判定部は、選択した第２の判定対象車輪が２回回転検知される間に、前記第２の判定対象車輪と異なる第２の参照車輪で奇数回の回転検知があったとき、前記第２の判定対象車輪の２回目に検知された回転の回転方向は、１回目に検知された回転の回転方向と同一方向と判定する、車両制御装置。
請求項１に記載の車両制御装置であって、
前記回転判定部は、前記第１の判定対象車輪及び前記第１の参照車輪の、直進時における回転検知走行距離と旋回半径とに基づき、前記第１の判定対象車輪と前記第１の参照車輪の旋回時の回転検知走行距離を決定する、車両制御装置。
請求項１に記載の車両制御装置であって、
前記回転判定部は、前記車両の直進時、前記第１の参照車輪の回転検知走行距離が前記第１の判定対象車輪の回転検知走行距離以下であり、前記車両の旋回において前記第１の参照車輪が前記第１の判定対象車輪よりも外側を通っているとき、前記旋回において、前記第１の参照車輪の回転検知走行距離は前記第１の判定対象車輪の回転検知走行距離よりもが短いと判定する、車両制御装置。
請求項１に記載の車両制御装置であって、
前記第１の参照車輪が操舵輪であり、前記第１の判定対象車輪が非操舵輪であり、前記第１の参照車輪と前記第１の判定対象車輪とが、前記車両の直進時において略同一の軌跡を有し、前記車両の直進時における前記第１の参照車輪の回転検知走行距離が前記第１の判定対象車輪の回転検知走行距離以下であるとき、前記回転判定部は、前記車両の旋回方向に係わらず、前記第１の参照車輪の回転検知走行距離は前記第１の判定対象車輪の回転検知走行距離以下であると判定する、車両制御装置。
複数の車輪を含む車両において、前記複数の車輪の各車輪が所定の回転角度位置を通過する毎に各車輪の回転を検知するセンサによって、前記複数の車輪に含まれる車輪の回転方向を判定する車両制御装置であって、
前記センサによる各車輪の回転検知をカウントする、カウント部と、
前記カウント部による各車輪の前記回転検知のカウント値に基づき、選択した判定対象車輪の回転方向を判定する回転判定部と、を含み、
前記車両の所定位置の移動距離を基準として、各車輪で回転検知してから次に回転検知するまでの移動距離は、各車輪の回転検知走行距離と定義され、
前記回転判定部は、選択した第１の判定対象車輪が２回回転検知される間に、前記第１の判定対象車輪の回転検知走行距離よりも回転検知走行距離が長い第１の参照車輪において、偶数回の回転検知があったとき、前記第１の判定対象車輪の２回目に検知された回転の回転方向は１回目に検知された回転の回転方向と逆方向と判定する、ことを特徴とする車両制御装置。
請求項６に記載の車両制御装置であって、
前記回転判定部は、選択した第２の判定対象車輪が２回回転検知される間に、前記第２の判定対象車輪と異なる第２の参照車輪で奇数回の回転検知があったとき、前記第２の判定対象車輪の２回目に検知された回転の回転方向は、１回目に検知された回転の回転方向と同一方向と判定する、車両制御装置。
請求項６に記載の車両制御装置であって、
前記回転判定部は、前記第１の判定対象車輪及び前記第１の参照車輪の、直進時における回転検知走行距離と旋回半径とに基づき、前記第１の判定対象車輪と前記第１の参照車輪の旋回時の回転検知走行距離を決定する、車両制御装置。
請求項６に記載の車両制御装置であって、
前記回転判定部は、前記車両の直進時、前記第１の判定対象車輪の回転検知走行距離が前記第１の参照車輪の回転検知走行距離以下であり、前記車両の旋回において前記第１の判定対象車輪が前記第１の参照車輪よりも外側を通っているとき、前記旋回において、前記第１の判定対象車輪の回転検知走行距離は前記第１の参照車輪の回転検知走行距離よりもが短いと判定する、車両制御装置。