(57)【要約】車両の停車位置精度を向上させる。目標停車位置への車両の駐車を支援する駐車支援装置であって、車輪速パルスに基づいて前記車両の走行距離を演算する、走行距離演算部と、前記走行距離に基づいて前記目標停車位置までの残距離を決定し、前記残距離が所定値以下の値になったときに、前記車両の制動力の制御をフィードバック制御からフィードフォワード制御に切り替える、制駆動力演算部と、を含む。
2020095636.tif 000002
【特許請求の範囲】
【請求項１】
目標停車位置への車両の駐車を支援する駐車支援装置であって、
車輪速パルスに基づいて前記車両の走行距離を演算する、走行距離演算部と、
前記走行距離に基づいて前記目標停車位置までの残距離を決定し、前記残距離が所定値以下の値になったときに、前記車両の制動力の制御をフィードバック制御からフィードフォワード制御に切り替える、制駆動力演算部と、を含む駐車支援装置。
【請求項２】
請求項１に記載の駐車支援装置であって、
前記所定値は、１車輪速パルス間隔距離以上であり、２車輪速パルス間隔距離以下である、駐車支援装置。
【請求項３】
請求項１に記載の駐車支援装置であって、
前記車輪速パルスに基づいて前記車両の車速を演算する、車速演算部をさらに含み、
制駆動力演算部は、前記フィードフォワード制御において、前記残距離と、前記フィードバック制御から前記フィードフォワード制御への切り替え時の前記車速演算部により演算された車速と、に基づいて、前記車両の制動力を決定する、駐車支援装置。
【請求項４】
請求項３に記載の駐車支援装置であって、
前記フィードフォワード制御により決定される制御力は、前記目標停車位置まで一定である、駐車支援装置。
【請求項５】
請求項３に記載の駐車支援装置であって、
前記制駆動力演算部は、前記フィードバック制御における目標車速と前記車速演算部により演算された車速との間の差に基づいて、前記フィードフォワード制御における前記車両の制動力を決定する、駐車支援装置。
【請求項６】
請求項１に記載の駐車支援装置であって、
前記制駆動力演算部は、前記フィードフォワード制御において、目標制動力値を決定し、前記車両の制動力を、前記フィードバック制御による値から、前記目標制動力値に徐々に変化させる、駐車支援装置。
【請求項７】
請求項６に記載の駐車支援装置であって、
前記制駆動力演算部は、前記フィードフォワード制御において、前記目標停車位置の手前から前記目標停車位置まで、前記制動力を前記目標制動力値から徐々に減少させる、駐車支援装置。
【請求項８】
請求項１に記載の駐車支援装置であって、
前記制駆動力演算部は、前記車両が前記目標停車位置を通過したことを検知した場合、前記車両の制動力を増加させる、駐車支援装置。
【請求項９】
請求項８に記載の駐車支援装置であって、
前記制駆動力演算部は、前記車両の制動力をシステム上限値まで増加させる、駐車支援装置。
【請求項１０】
請求項８に記載の駐車支援装置であって、
前記制駆動力演算部は、前記目標停車位置で停車できなかったことを検知した時点での車速に基づいて算出した増加率において徐々に前記車両の制動力を増加させる、駐車支援装置。
【請求項１１】
目標停車位置への車両の駐車を支援する方法であって、
車輪速パルスに基づいて前記車両の走行距離を演算し、
前記走行距離に基づいて前記目標停車位置までの残距離を決定し、
前記残距離が所定値以下の値になったときに、前記車両の制動力の制御をフィードバック制御からフィードフォワード制御に切り替える、ことを含む方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、駐車支援装置及び駐車支援方法に関する。
【背景技術】
【０００２】
駐車支援装置の例として、特許文献１に記載の技術がある。特許文献１に記載の駐車支援装置は、車輪速パルスを用いて自車両の走行距離と車速を演算し、目標車速に追従するようにＰＩ制御で加減速制御を行っている。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２０１４−８９３９号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
自動駐車中において、乗車人数による車重変化や勾配等の外乱対策のために、目標車速と車速検知値の差を用いたフィードバック制御で制動力制御を行う技術が知られている。
しかし、車輪速パルスを用いて車速を検知している場合、駐車支援装置は、停車間際の極低車速では、車輪速パルスの入力間隔が長いため車速検知の更新ができず車速を高く誤認識し、目標位置より手前で自車両を停車させる可能性がある。【０００５】
図６に具体的な動作を示す。図６はフィードバック制御のみで制動力制御した時の距離に対する車速と制動力のグラフである。車速のグラフにおいて、横軸は駐車支援を開始してからの距離を示し、縦軸は車速を示す。制動力のグラフにおいて、横軸は駐車支援を開始してからの距離を示し、縦軸は制動力を示す。破線は目標車速プロファイル、二点鎖線は車速検知値、実線は実車速を示す。【０００６】
距離Ｌ０からＬ１までは、車速検知値が目標車速より小さいため、加速のフィードバック制御が働き、制動力は０となる。距離Ｌ１からＬ２までは車速検知値が目標車速より大きいため、フィードバック制御が働き、制動力が増加する。距離Ｌ２にて車輪速パルスを検知することで車速検知値が更新され、車速検知値と目標車速の差が小さくなるため制動力が減少する。距離Ｌ２から目標駐車位置までは車速検知値が目標車速より大きいため、フィードバック制御が働き、制動力が増加する。【０００７】
このように距離Ｌ２から目標駐車位置までの間では車輪速パルス検知が無いため、車速検知値が更新されない。その結果、目標車速と車速検知値の差が大きくなるに伴い制動力が大きくなることで、車両が目標位置の手前に停車してしまう可能性がある。
【課題を解決するための手段】
【０００８】
本発明の代表的な一例は、目標停車位置への車両の駐車を支援する駐車支援装置であって、車輪速パルスに基づいて前記車両の走行距離を演算する、走行距離演算部と、前記走行距離に基づいて前記目標停車位置までの残距離を決定し、前記残距離が所定値以下の値になったときに、前記車両の制動力の制御をフィードバック制御からフィードフォワード制御に切り替える、制駆動力演算部と、を含む。
【発明の効果】
【０００９】
本発明の代表的な一例によれば、車両の停車位置精度を向上させることができる。
【図面の簡単な説明】
【００１０】
【図１】駐車支援装置を適用した車両の構成図。
【図２】駐車支援ＥＣＵの内部構成の概略図。
【図３】駐車支援ＥＣＵの内部の機能ブロック構成図。
【図４】制動力制御ブロック図。
【図５】実施形態１におけるフローチャート。
【図６】比較例に係る、フィードバック制御のみで制動力制御した時の距離に対する車速と制動力のグラフ。
【図７】残距離が所定値以下の値になった時に、制動力制御をフィードバック制御からフィードフォワード制御に切り替えた場合の、距離に対する車速と制動力のグラフ。
【図８】残距離が所定値以下の値になった時に、制動力制御をフィードバック制御からフィードフォワード制御に切り替え、制動力を所定の増加率で増加させ、一定の制動力を維持した場合の、距離に対する車速と制動力のグラフ。
【図９】残距離が所定値以下の値になった時に、制動力制御をフィードバック制御からフィードフォワード制御に切り替え、制動力を所定の増加率で増加させ、一定の制動力を維持した場合の、距離に対する車速と制動力のグラフ。
【図１０】残距離が所定値以下の値になった時に、制動力制御をフィードバック制御からフィードフォワード制御に切り替え、制動力を所定の増加率で増加させ、一定の制動力を維持した後、所定の減少率で制動力を減少させた場合の、距離に対する車速と制動力のグラフ。
【図１１】残距離が所定値以下の値になった時に、制動力制御をフィードバック制御からフィードフォワード制御に切り替えた後、自車両が目標駐車位置を通過したことを検知したことに対して制動力をシステム上限まで増加させた場合の、距離に対する車速と制動力のグラフ。
【図１２】残距離が所定値以下の値になった時に、制動力制御をフィードバック制御からフィードフォワード制御に切り替えた後、自車両が目標駐車位置を通過したことを検知したことに対して制動力をシステム上限まで所定の増加率で増加させた場合の、距離に対する車速と制動力のグラフ。
【図１３】制動力制御をフィードバック制御からフィードフォワード制御に切り替える所定値を、パルス入力が１パルスで車両が進む距離に設定した時の距離に対する車速のグラフ。
【図１４】制動力制御をフィードバック制御からフィードフォワード制御に切り替える条件を示す所定値を、２車輪速パルスで車両が進む距離に設定した場合の、距離に対する車速のグラフ。
【発明を実施するための形態】
【００１１】
以下、実施形態を、図面を用いて説明する。以下に説明する実施形態は特許請求の範囲にかかる発明を限定するものではなく、また実施形態の中で説明されている特長の組み合わせの全てが発明の解決手段に必須であるとは限らない。
【００１２】
＜実施形態１＞
図１は、一実施形態に係る駐車支援装置を概略的に示す。駐車支援装置は、車両１００に搭載され、車両前方に搭載された前方カメラ２Ｆ、車両右方に搭載された右方カメラ２Ｒ、車両後方に搭載された後方カメラ２Ｂ、車両左方に搭載された左方カメラ２Ｌ、ソナー３、及び電動パワーステアリング装置６を含む。駐車支援装置は、さらに、右前車輪７ＦＲの車輪速を検知する右前車輪速センサ８ＦＲ、右後車輪７ＲＲの車輪速を検知する右後車輪速センサ８ＲＲ、左後車輪７ＲＬの車輪速を検知する左後車輪速センサ８ＲＬ、左前車輪７ＦＬの車輪速を検知する左前車輪速センサ８ＦＬ、車載表示装置９、駐車支援ＥＣＵ（Ｅｌｅｃｔｒｏｎｉｃ  Ｃｏｎｔｒｏｌ  Ｕｎｉｔ）１０、車両制御ＥＣＵ１１等を含む。
【００１３】
前方カメラ２Ｆ、右方カメラ２Ｒ、後方カメラ２Ｂ、及び左方カメラ２Ｌは、それぞれ、レンズと撮像素子を含み、自車両１００の周辺環境を撮像できるように適切に配置されている。各カメラ２Ｆ、２Ｒ、２Ｂ、２Ｌの撮像画像は、駐車支援ＥＣＵ１０に送信されて画像処理が行われる。以下、特に区別しない場合は、カメラ２Ｆ、２Ｒ、２Ｂ、２Ｌそれぞれを、カメラ２と呼ぶ。カメラ２は、単眼カメラでもよいし、ステレオカメラでもよい。
【００１４】
複数のソナー３が、車両１の前部、後部、側面部に設置されている。各ソナー３は、超音波を送信するとともに、上記超音波が周囲の障害物から反射した反射波を受信することにより、車両１００とその周辺の障害物との距離を測定する。その測定結果は、駐車支援ＥＣＵ１０に送信される。駐車支援ＥＣＵ１０は、各ソナー３から送信された測定結果である自車両１００周辺の障害物情報を記憶する。
【００１５】
カメラ２及びソナー３は、自車両１００周辺の外界情報を取得するための外界情報取得部を構成する。なお、カメラ２及びソナー３以外のセンシング装置、例えば、ＬＩＤＡＲ（ＬＩｇｈｔ  Ｄｅｔｅｃｔｉｏｎ  Ａｎｄ  Ｒａｎｇｉｎｇ）やＲＡＤＡＲを用いて、自車両１００周辺の外界情報を取得してもよい。
【００１６】
車両１００の車体の前後左右には、右前車輪７ＦＲ、右後車輪７ＲＲ、左後車輪７ＲＬ、左前車輪７ＦＬがそれぞれ配置されている。各車輪７ＦＲ、７ＲＲ、７ＲＬ、７ＦＬには、右前車輪速センサ８ＦＲ、右後車輪速センサ８ＲＲ、左後車輪速センサ８ＲＬ、左前車輪速センサ８ＦＬがそれぞれ設けられている。車輪速センサ８ＦＲ、８ＲＲ、８ＲＬ、８ＦＬは、それぞれの車輪速を検知し、各車輪速を駐車支援ＥＣＵ１０に送信する。
【００１７】
駐車支援ＥＣＵ１０は、各車輪速の情報をもとに自車両１００の速度を演算する。以下、特に区別しない場合、右前車輪７ＦＲ、右後車輪７ＲＲ、左後車輪７ＲＬ、左前車輪７ＦＬそれぞれを車輪７と呼ぶ。また、右前車輪速センサ８ＦＲ、右後車輪速センサ８ＲＲ、左後車輪速センサ８ＲＬ、左前車輪速センサ８ＦＬそれぞれを車輪速センサ８と呼ぶ。
車輪速センサ８は、車輪７が規定距離（１車輪速パルス間隔距離）進む（回転する）毎に、車輪速パルスを出力する。パルス間隔は、例えば、数ｃｍである。
【００１８】
電動パワーステアリング装置６は、自車両１００の運転室内に設けられたステアリングホイール１８の操作量（操舵角）に応じて、車輪７の向きを変える。電動パワーステアリング装置６は、例えばステアリングホイール１８の操舵角を検知する操舵角センサ、各車輪７の向きを変えるトルクとなる操舵トルクを補助するモータ、操舵トルクを制御する電動パワーステアリングＥＣＵ（いずれも不図示）を含む。
【００１９】
電動パワーステアリング装置６は、運転者のステアリングホイール１８の操作を補助するように操舵トルクを制御して車輪７の向きを変える。電動パワーステアリング装置６の操舵角センサにより検知された操舵角は、駐車支援ＥＣＵ１０に送信される。駐車支援ＥＣＵ１０は、操舵角の情報をもとに自車両１００の進行方向を演算する。
【００２０】
車載表示装置９は、自車両１００の運転室内に設けられており、運転者に対して各種情報を提供する。運転者へ提供される情報は、例えば、カメラ２により撮像されて駐車支援ＥＣＵ１０によって処理された画像等を含む。さらに、後述のように、車載表示装置９は、１以上の駐車目標候補位置（駐車可能な場所又は位置）を運転者に提示する。
【００２１】
車載表示装置９は、例えば、ディスプレイと入力装置とが一体化したタッチパネルとして構成してもよいし、カーナビゲーションシステムの一部であってもよいし、ヘッドアップディスプレイとして構成してもよい。車載表示装置９は、例えばキーボード、音声指示装置、スイッチなどの情報入力装置を含んでもよい。例えば、車載表示装置９の画面には感圧式または静電式のタッチパネルが搭載されており、各種の入力操作を可能とする。運転者はタッチパネルで入力操作を行うことにより、入力内容を駐車支援ＥＣＵ１０に送信することができる。
【００２２】
駐車支援ＥＣＵ１０は、カメラ２及びソナー３（外界情報取得部）から受信した外界情報をもとに、自車両１００が１以上の駐車目標候補位置を演算するとともに、周辺の障害物情報を演算する。１以上の駐車目標候補位置は車載表示装置９に送信される。
【００２３】
車載表示装置９は、駐車支援ＥＣＵ１０から送信された１以上の駐車目標候補位置を、表示中の自車両１００周囲情報に重畳して表示する。運転者は、表示された１以上の駐車目標候補位置から目標停車位置（駐車可能な場所から選択された目標とする駐車位置）を選択し、当該目標停車位置に対して駐車支援を受けることができる。
【００２４】
次に、運転者は、自車両１００の停車後に、車載表示装置９の入力装置を操作して、車載表示装置９に表示されている１以上の駐車目標候補位置から、目標停車位置を選択する。駐車支援ＥＣＵ１０では、目標停車位置の情報及び上記障害物情報をもとに、現在の自車両位置（自車両１００の停車位置）から上記選択された目標停車位置までの駐車経路を演算し、演算した駐車経路を車両制御ＥＣＵ１１に送信する。
【００２５】
ここで、駐車支援ＥＣＵ１０は、自車両１００のセンサが取得した障害物情報の確からしさ(以降、確信度)をもとに、駐車経路を演算する。これにより、障害物と衝突することのない安全な駐車経路を演算可能であるとともに、障害物との距離を不必要にあける必要がなく、自車両１００の運転者が車両挙動に不自然さを感じることがなくなる。
【００２６】
車両制御ＥＣＵ１１は、駐車支援ＥＣＵ１０から送信された駐車経路に基づき、自車両１００の目標停車位置までの誘導を支援するために、運転者のステアリングホイール操作、アクセル操作、ブレーキ操作等のうちの特定の操作または全ての操作を支援する。
【００２７】
例えば、車両制御ＥＣＵ１１は、電動パワーステアリング装置６に目標とする舵角情報を出力することにより自車両１００の舵角を制御する。または、車両制御ＥＣＵ１１は、自車両１００の駆動力を制御する駆動力制御ＥＣＵ（図示省略）に要求駆動力を出力し、自車両１００の制動力を制御する制動力制御ＥＣＵ（図示省略）に要求制動力を出力することにより、自車両１００の速度を制御する。
【００２８】
または、車両制御ＥＣＵ１１は、自動変速機のシフトレンジを制御するシフトバイワイヤ制御装置（図示省略）にドライブレンジ、リバースレンジまたはパーキングレンジの要求を出力することにより、自車両１００のシフトレンジを制御する。車両制御ＥＣＵ１１が自車両１００を制御することにより、運転者は、目標停車位置に駐車するための適切な駐車支援を受けることができる。
【００２９】
図２は、図１に示す駐車支援ＥＣＵ１０の内部構成の一例を概略的に示し、図１に示す駐車支援ＥＣＵ１０の入出力信号の関係を示すブロック線図である。駐車支援ＥＣＵ１０は、プロセッサ１５、プロセッサが実行するプログラム及びプログラムに参照又は処理されるデータ（ソフトウェア）を格納するメモリ１６、及びＡ／Ｄ変換器を含むI／ＯＬＳＩ１７を含む。これらは、バスを介して互いに通信可能である。
【００３０】
前術したように、カメラ２、ソナー３、電動パワーステアリング装置６、車輪速センサ８、及び車載表示装置９から信号が駐車支援ＥＣＵ１０に入力される。駐車支援ＥＣＵ１０は、所定の演算処理にて、駐車可能な駐車目標候補位置を車載表示装置９に送信して、当該車載表示装置９がその結果を表示する。自車両１００の運転者は、上記表示内容により駐車支援を実施するか否かを判断する。
【００３１】
図３は、図１に示す駐車支援ＥＣＵ１０の内部の機能ブロック構成を示す。このような機能ブロックは、ハードウェア、ソフトウェア、又はこれらを組み合わせたものによって実現される。以下に説明する例において、駐車支援ＥＣＵ１０は、ステアリングホイール操作、アクセル操作、ブレーキ操作を自動で行うとする。
【００３２】
図３に示すように、駐車支援ＥＣＵ１０は、駐車目標候補提示部１０１、駐車経路生成部１０２、目標操舵角演算部１０３、車速演算部１０４、目標車速演算部１０５、走行距離演算部１０６、制駆動力演算部１０７、及び操舵角制御部１０８を含む。
【００３３】
駐車目標候補提示部１０１は、カメラ２で検知した白線位置や障害物位置から駐車目標候補位置を作成し、車載表示装置９などのＨＭＩを通じて、運転者へ１以上の駐車目標候補位置を提示する。運転者は、駐車目標候補提示部１０１に提示された駐車目標候補位置から目標停車位置を選択する。駐車経路生成部１０２は、カメラ２で検知した障害物位置と運転者が選択した目標停車位置に基づいて、現在の自車両位置から目標停車位置への駐車経路を生成する。
【００３４】
目標車速演算部１０５は、駐車経路生成部１０２に生成された駐車経路の経路長に基づいて目標車速プロファイルを生成する。走行距離演算部１０６は、車輪速センサ８から入力される車輪速パルスの数に基づいて自動駐車開始後の自車両１００の走行距離を演算する。車速演算部１０４は、車輪速パルスに基づいて自車両１００の車速を演算する。具体的には、車速演算部１０４は、車輪速センサ８から入力される単位時間当たりの車輪速パルス数に基づいて現在の自車両１００の車速を演算する。
【００３５】
制駆動力演算部１０７は、目標車速演算部１０５が生成した目標車速プロファイル、走行距離演算部１０６が算出した走行距離、及び車速演算部１０４が算出した車速に基づいて、制動力または駆動力（これらを制駆動力と総称する）を算出する。制駆動力演算部１０７は、算出した制駆動力に基づいて、車両制御ＥＣＵ１１を介して、ブレーキ２２または駆動モータ２１を制御する。
【００３６】
目標操舵角演算部１０３は、駐車経路に自車両を追従させる操舵角プロファイルを演算する。操舵角制御部１０８は、走行距離演算部１０６が算出した走行距離、目標操舵角演算部１０３が生成した操舵角プロファイル、及び操舵角センサ６１からのセンサ値に基づいて、車両制御ＥＣＵ１１を介して、ステアリング２３を制御する。なお、障害物検知はカメラの代わりにソナーやＬＩＤＡＲやＲＡＤＥＲを使用してもよく、駆動モータの代わりに内燃機関でもよい。
【００３７】
図４は、駐車支援ＥＣＵ１０における制動力制御の論理構成例を示すブロック図である。制駆動力演算部１０７は、ＦＢ（Ｆｅｅｄ  Ｂａｃｋ）制動力演算部１７１、ＦＦ（Ｆｅｅｄ  Ｆｏｒｗａｒｄ）制動力演算部１７２、切り替え判定部１７３、及びスイッチ部１７４を含む。
【００３８】
走行距離演算部１０６は、車輪速パルスに基づいて、自動駐車開始時からの自車両１００の走行距離を演算する。切り替え判定部１７３は、走行距離演算部１０６に算出された走行距離に基づいて、目標停車位置までの残距離を算出し、残距離に基づいて切り替え判定フラグを変更する。以下において、残距離が所定値より大きい場合に切り替え判定フラグは「０」であり、残距離が所定値以下の場合に切り替え判定フラグは「１」であるとする。所定値は、パルス入力の間隔距離（１車輪速パルス間隔距離）に応じて予め設定されている。
【００３９】
残距離が所定値より長く、切り替え判定フラグが「０」の間は、ＦＢ制動力演算部１７１が、車両制御ＥＣＵ１１を介して、ブレーキ２２をフィードバック制御する。具体的には、ＦＢ制動力演算部１７１は、目標車速演算部１０５に生成された目標車速プロファイルと車速演算部１０４が演算した車速との間の差に基づいて、制動力を算出する。ＦＢ制動力演算部１７１は、次の車輪パルスまでの制動力プロファイルを決定する。スイッチ部１７４は、ＦＢ制動力演算部１７１が算出した制動力を示す情報を、車両制御ＥＣＵ１１に出力する。
【００４０】
残距離が短くなり、特定の車輪速パルスに応じてから計算された残距離が所定値以下である場合、切り替え判定部１７３は、切り替え判定フラグを「０」から「１」に変化させる。切り替え判定フラグに変更に応答して、スイッチ部１７４は、入力をＦＢ制動力演算部１７１からＦＦ制動力演算部１７２に切り替える。これにより、ＦＦ制動力演算部１７２による、車両制御ＥＣＵ１１を介した、ブレーキ２２のフィードフォワード制御が開始する。
【００４１】
ＦＦ制動力演算部１７２は、切り替え判定フラグが「１」となった車輪速パルスでの、目標停車位置までの残距離と車速検知値とに基づき、制動力（プロファイル）を演算する。これにより、適切に制動力を決定できる。ＦＦ制動力演算部１７２は、算出した制動力に応じて、車両制御ＥＣＵ１１を介して、ブレーキ２２（制動力）をフィードフォワード制御する。スイッチ部１７４は、ＦＦ制動力演算部１７２が算出した制動力を示す情報を、車両制御ＥＣＵ１１に出力する。なお、ＦＦ制動力演算部１７２のフィードフォワード制御に使用される車輪速パルスは、切り替え判定フラグを変更する車輪速パルスより後であってもよい。
【００４２】
具体的には、ＦＦ制動力演算部１７２は、走行距離演算部１０６が算出した走行距離により目標停車位置までの残距離を算出し、車速演算部１０４から車速を取得し、それらの値に基づき制動力を決定する。ＦＦ制動力演算部１７２は、目標車速と車速検知値とを比較することなく制動力を決定し、また、制御開始後の実際の車速と独立に（参照することなく）、開始時に決定された制動力に応じてブレーキ２２を制御する。
【００４３】
図５は、駐車支援ＥＣＵ１０による駐車支援処理のフローチャートである。まず、駐車目標候補提示部１０１は、目標停車位置を決定する（Ｓ１０１）。具体的には、駐車目標候補提示部１０１は、カメラ２で検知した白線位置や障害物位置から１以上の駐車目標候補位置を作成し、車載表示装置９などのＨＭＩを通じて運転者へ以上の駐車目標候補位置を提示する。運転者は駐車目標候補提示部１０１に提示された駐車目標候補位置から目標位置を選択し、駐車目標候補提示部１０１は選択された駐車目標候補位置を、目標停車位置と決定する。
【００４４】
目標停車位置決定後、駐車経路生成部１０２は、カメラ２で検知した障害物位置と運転者が選択した目標停車位置に基づいて、現在の自車両位置から目標位置への駐車経路を生成する（Ｓ１０２）。目標車速演算部１０５は、駐車経路生成部１０２に生成された駐車経路の経路長に基づいて、目標車速プロファイルを生成する（Ｓ１０３）。その後、駐車支援ＥＣＵ１０は、自動駐車を開始し、車両１００が移動を開始する（Ｓ１０４）。
【００４５】
自車両１００の移動開始後、車輪速パルスを検知すると（Ｓ１０５：ＹＥＳ）、車速演算部１０４は、自車両１００の車速を算出する（Ｓ１０６）。走行距離演算部１０６は、自動駐車開始時からの自車両の走行距離を演算する（Ｓ１０７）。切り替え判定部１７３は、走行距離演算部１０６に算出された走行距離に基づいて、目標停車位置までの残距離を算出する（Ｓ１０８）。
【００４６】
残距離が所定値よりも大きい場合は（Ｓ１０９：ＮＯ）、切り替え判定フラグは駐車支援の開始時に設定された「０」である。スイッチ部１７４は、ＦＢ制動力演算部１７１から出力を選択している。ＦＢ制動力演算部１７１は、目標車速プロファイルが示す目標車速と検知された自車速に基づいて、制動力を演算し、車両制御ＥＣＵ１１を介して、ブレーキ２２による制動力をフィードバック制御する（Ｓ１１０）。
【００４７】
車輪速度パルスにより計算される残距離が所定値以下の値になると（Ｓ１０９：ＹＥＳ）、切り替え判定部１７３は、切り替え判定フラグを「０」から「１」に変化させる。スイッチ部１７４は、入力をＦＢ制動力演算部１７１の出力からＦＦ制動力演算部１７２の出力に切り替える。
【００４８】
ＦＦ制動力演算部１７２は、切り替え判定フラグが「１」となった車輪速パルスから演算される自車速と残距離とに基づいて、制動力を演算する。ＦＦ制動力演算部１７２は、演算された制動力に応じて、車両制御ＥＣＵ１１を介して、ブレーキ２２（制動力）をフィードフォワード制御し（Ｓ１１１）、目標停車位置に自車両１００を停車させる（Ｓ１１２：ＮＯ）。自車両１００が目標停車位置で停止しない場合（Ｓ１１２：ＹＥＳ）のステップＳ１１３の詳細は後述する。
【００４９】
図７は、残距離が所定値以下であり、検知された自車速と残距離に基づいて制動力を演算しフィードフォワード制御したときの、距離に対する車速と制動力のグラフである。車速のグラフにおいて、横軸は駐車支援を開始してからの距離を示し、縦軸は車速を示す。
制動力のグラフにおいて、横軸は駐車支援を開始してからの距離を示し、縦軸は制動力を示す。破線は目標車速プロファイル、二点鎖線は車速検知値、実線は実車速を示す。
【００５０】
図７の例において、距離Ｌ０からＬ１までは、車速検知値が目標車速より小さいため、加速のフィードバック制御が働き、制動力は０となる。距離Ｌ１からＬ２までは車速検知値が目標車速より大きいため、フィードバック制御が働き、制動力が増加する。距離Ｌ３の位置から目標停車位置までの残距離が、所定値であるとする。
【００５１】
目標停車位置までの残距離が所定値以下になると、制動力制御が、ＦＢ制動力演算部１７１からＦＦ制動力演算部１７２に切り替わる。図７の例において、残距離が所定値以下になった後の最初の車輪速パルスが、距離Ｌ２の位置において検知される。ＦＦ制動力演算部１７２は、その位置（距離Ｌ２）での車輪速パルスにより演算される車速検知値と残距離に基づいて、一定の制動力で目標停車位置に停車するための目標制動力を演算し、制動力をフィードフォワード制御する。図７の例において目標制動力は一定であり、シンプルな制御が可能である。なお、図７の例における目標制動力を基準力とも呼ぶ。
【００５２】
ＦＦ制動力演算部１７２に制御により、車両１００は、目標駐車位置により近い位置で停車できる。また、図６を参照して説明した比較例よりも、車速の傾きを緩やかにすることができて、乗り心地を改善できる。
【００５３】
他の例において、ＦＢ制動力演算部１７１は、フィードバック制御中の目標車速プロファイルへの追従性に応じて、フィードフォワード制御のための制動力を補正してもよい。
ＦＢ制動力演算部１７１は、フィードバック制御における目標車速と車速検知値との間の差に基づいて、フィードフォワード制御における制動力を決定する。例えば、ＦＢ制動力演算部１７１は、フィードバック制御中の制動力が０より大きい１又は複数の車輪速パルスにおける目標車速と車速検知値の差を取得し、平均値や積分値等の統計値を決定する。
ＦＢ制動力演算部１７１は、統計値に基づいて、図７を参照して説明した一定制動力の値を補正する。なお、単一車輪速パルスにおける差の統計値は、その差と一致する。
【００５４】
例えば、ＦＢ制動力演算部１７１は、統計値が、車速検知値が目標車速よりも大きいことを示す場合、差（の絶対値）が大きくなるにつれて、制動力が大きくなるように制動力を補正してもよい。逆に、車速検知値が目標車速よりも小さい場合、ＦＢ制動力演算部１７１は、差（の絶対値）が大きくなるにつれて、制動力が小さくなるように制動力を補正してもよい。本例により、自車両１００のブレーキ特性を考慮してフィードフォワード制御できるため、車重やブレーキの摩擦特性の変化に対して、停車精度を向上させることができる。
【００５５】
＜実施形態２＞
図８は、フィードフォワード制御の一例の距離に対する車速と制動力のグラフである。
以下において、図７との相違点を主に説明する。図７の例において、フィードフォワード制御開始地点での制動力の変化は、目標制動力へのステップ変化である。これにより、シンプルな制御が実現される。図８の例において、制動力は、フィードフォワード制御開始地点から徐々に増加する。例えば、制動力は、時間に対して一定の増加率で増加する。制動力の増加がステップ変化ではなく、徐々の増加であることで、乗り心地が改善できる。
【００５６】
図９は、フィードフォワード制御の他の例の距離に対する車速と制動力のグラフである。以下において、図８との相違点を主に説明する。図８の例においては、制動力が不足し、車両１００は、目標停車位置で停車することができない。ＦＦ制動力演算部１７２は、図７に示すように制動力をステップ変化によって目標値に増加させる場合と比較して、同一条件での目標制動力（制動力の増加量）を大きくしてもよい。図９は、徐々に制動力を増加させる例において、図７に示すステップ変化よりも制動力の増加量を大きくする例を示す。
【００５７】
図１０は、フィードフォワード制御の他の例の距離に対する車速と制動力のグラフである。以下において、図９との相違点を主に説明する。図１０の例において、ＦＦ制動力演算部１７２は、に示す停車際で制動力を徐々に減少させる。例えば、時間に対する制動力の減少率は一定である。これにより、乗り心地が改善できる。図７、９及び１０の例においては、車両１００は目標停車位置に停車している。これらの図において、距離Ｌ２の位置から目標停車位置までの制動力と横軸で囲まれた領域の面積（制動力の仕事）は同一である。
【００５８】
図８、９及び１０を参照して説明した例において、ＦＦ制動力演算部１７２は、制動力を、フィードバック制御における直前の値から増加させる。フィードバック制御からフィードフォワード制御への切り替えの地点において、車速が低い場合、ＦＦ制動力演算部１７２は、制動力を減少させる。つまり、目標制動力は直前のフィードバック制御における制動力より小さい。ＦＦ制動力演算部１７２は、図８、９及び１０を参照した説明した例において、フィードフォワード制御の開始から徐々に制動力を減少させる。
【００５９】
＜実施形態３＞
以下において、車両１００が、目標停車位置で停止することができずに通過した場合に対する制御を説明する。例えば、目標駐車位置までの残距離が所定値以下になり、制動力制御をフィードバック制御からフィードフォワード制御に切り替えた後、勾配などの外乱により、車両１００が目標駐車位置に到達しても停車できないことがある。以下に説明する例において、駐車支援ＥＣＵ１０は、車両１００が目標駐車位置で停車できず通過したことを検知した場合に、制動力をシステム上限値まで増加させる。
【００６０】
図１１は、フィードフォワード制御の一例の、距離に対する車速と制動力のグラフである。以下においては、図７との相違点を主に説明する。図１１の例において、残距離が所定位置以下になり、駐車支援ＥＣＵ１０が制動力制御をフィードフォワード制御に切り替えた後、車両１００が目標駐車位置で停車できていない。駐車支援ＥＣＵ１０は、停車できなかったことが判明した時点で制動力をシステム上限値まで増加させる。
【００６１】
ＦＦ制動力演算部１７２は、自車両１００が目標位置で停車できた場合は検知されない車輪速パルスを検知した時、自車両１００が目標位置で停車できなかったと判定する。ＦＦ制動力演算部１７２は、制動力をシステム上限値まで増加させる。これにより、実際の停車位置と目標停車位置の誤差を小さくすることができる。
【００６２】
図１２は、フィードフォワード制御の他の例の、距離に対する車速と制動力のグラフである。以下においては、図１１との相違点を主に説明する。ＦＦ制動力演算部１７２は、目標停止位置を過ぎて車輪速パルスを検知した時、車輪速パルスを用いて自車両１００の車速を演算する。図１１に示すステップ変化に代えて、ＦＦ制動力演算部１７２は、車輪速パルスを用いて演算した自車両１００の車速に応じた増加率で、制動力を徐々に増加させる。ＦＦ制動力演算部１７２は、例えば、時間に対して一定の増加率で制動力を増加させてもよい。徐々に制動力を増加させることで、乗り心地を改善できる。
【００６３】
なお、ＦＦ制動力演算部１７２は、制動力を、システム上限値よりも小さい値に増加させてもよい。これも、目標停車位置と実際の停車位置との誤差を小さくできる。システム上限値まで増加させることで、特に、目標停車位置と実際の停車位置との誤差を小さくできる。ＦＦ制動力演算部１７２は、目標停車位置より先の位置で検出された車輪速パルスから決まる車速に応じて、制動力の増加量（増加後の制動力）を決定してもよい。
【００６４】
＜実施形態４＞
以下において、制動力の制御方法を切り替えるタイミングを説明する。駐車支援ＥＣＵ１０は、目標停車位置までの残距離が１車輪速パルス間隔距離以下となるまでに、制動力制御をフィードバック制御からフィードフォワード制御に切り替える。フィードフォワード制御は、切り替え時点での車輪速パルスから決定される残距離と車速検知値から、目標停車位置で停車するための制動力を演算する。
【００６５】
制動力の制御方法の切り替え判定に用いる所定値の一例は、１車輪速パルス間隔距離以上であり、２車輪速パルス間隔距離以下である。１車輪速パルス間隔距離は、連続する車輪速パルスの間で車両１００が進む距離である。
【００６６】
図１３は、所定値を１車輪速パルス間隔距離に設定した時の距離に対する制動力のグラフである。制御を切り替える位置から目標停車位置までの距離は、１車輪速パルス間隔距離以下である。図１３の例においては、残距離が所定値以下となり制動力制御をフィードバック制御からフィードフォワード制御に切り替えた時点での残距離が短いために、目標停車位置で停車するための制動力が大きく、車速の変化が急になっている。
【００６７】
一方、図１４は所定値を２車輪速パルス間隔距離に設定した時の距離に対する制動力のグラフである。制御を切り替える位置から目標停車位置までの距離は、１車輪速パルス間隔距離以上、２車輪速パルス間隔距離以下である。
【００６８】
残距離が所定値以下となり制動力制御をフィードバック制御からフィードフォワード制御に切り替えた時点での残距離が少なくとも１車輪速パルス間隔距離ある。図１３の場合と比較して、目標駐車位置で停車するための制動力は小さく、車速の変化もなだらかにできて、乗り心地向上が実現できる。なお、所定値を大きくすると、車速の変化をなだらかにできて、乗り心地が向上するが、フィードフォワード制御の距離が長くなり、勾配などの外乱により停車精度が悪化する。従って、所定値をフィードバック制御及びフィードフォワード制御の精度の観点から、適切に設定することが必要である。
【００６９】
なお、本発明は上記した実施形態に限定されるものではなく、様々な変形例が含まれる。例えば、上記した実施形態は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、ある実施形態の構成の一部を他の実施形態の構成に置き換えることが可能であり、また、ある実施形態の構成に他の実施形態の構成を加えることも可能である。また、各実施形態の構成の一部について、他の構成の追加・削除・置換をすることが可能である。
【００７０】
また、上記の各構成、機能、処理部、処理手段等は、それらの一部又は全部を、例えば集積回路で設計する等によりハードウェアで実現してもよい。また、上記の各構成、機能等は、プロセッサがそれぞれの機能を実現するプログラムを解釈し、実行することによりソフトウェアで実現してもよい。各機能を実現するプログラム、テーブル、ファイル等の情報は、メモリや、ハードディスク、ＳＳＤ（ＳｏｌｉＤ  ＳｔＡｔｅ  Ｄｒｉｖｅ）等の記録装置、または、ＩＣカード、ＳＤカード等の記録媒体に置くことができる。
【００７１】
また、制御線や情報線は説明上必要と考えられるものを示しており、製品上必ずしも全ての制御線や情報線を示しているとは限らない。実際には殆ど全ての構成が相互に接続されていると考えてもよい。
【符号の説明】
【００７２】
２  カメラ、３  ソナー、６  電動パワーステアリング装置、７ＦＲ、７ＲＲ、７ＲＬ、７ＦＬ  車輪、８ＦＲ、８ＲＲ、８ＲＬ、８ＦＬ  車輪速センサ、９  車載表示装置、１０  駐車支援ＥＣＵ、１１  車両制御ＥＣＵ、１８  ステアリングホイール、１００  車両
【図１】
2020095636.tif 000003
【図２】
2020095636.tif 000004
【図３】
2020095636.tif 000005
【図４】
2020095636.tif 000006
【図５】
2020095636.tif 000007
【図６】
2020095636.tif 000008
【図７】
2020095636.tif 000009
【図８】
2020095636.tif 000010
【図９】
2020095636.tif 000011
【図１０】
2020095636.tif 000012
【図１１】
2020095636.tif 000013
【図１２】
2020095636.tif 000014
【図１３】
2020095636.tif 000015
【図１４】
2020095636.tif 000016
【手続補正書】
【提出日】令和3年4月21日(2021.4.21)
【手続補正１】
【補正対象書類名】明細書
【補正対象項目名】００２２
【補正方法】変更
【補正の内容】
【００２２】
駐車支援ＥＣＵ１０は、カメラ２及びソナー３（外界情報取得部）から受信した外界情報をもとに、自車両１００の１以上の駐車目標候補位置を演算するとともに、周辺の障害物情報を演算する。１以上の駐車目標候補位置は車載表示装置９に送信される。
【手続補正２】
【補正対象書類名】明細書
【補正対象項目名】００５２
【補正方法】変更
【補正の内容】
【００５２】
ＦＦ制動力演算部１７２の制御により、車両１００は、目標駐車位置により近い位置で停車できる。また、図６を参照して説明した比較例よりも、車速の傾きを緩やかにすることができて、乗り心地を改善できる。
【手続補正３】
【補正対象書類名】明細書
【補正対象項目名】００５７
【補正方法】変更
【補正の内容】
【００５７】
図１０は、フィードフォワード制御の他の例の距離に対する車速と制動力のグラフである。以下において、図９との相違点を主に説明する。図１０の例において、ＦＦ制動力演算部１７２は、停車際で制動力を徐々に減少させる。例えば、時間に対する制動力の減少率は一定である。これにより、乗り心地が改善できる。図７、９及び１０の例においては、車両１００は目標停車位置に停車している。これらの図において、距離Ｌ２の位置から目標停車位置までの制動力と横軸で囲まれた領域の面積（制動力の仕事）は同一である。
【手続補正４】
【補正対象書類名】明細書
【補正対象項目名】００６０
【補正方法】変更
【補正の内容】
【００６０】
図１１は、フィードフォワード制御の一例の、距離に対する車速と制動力のグラフである。以下においては、図７との相違点を主に説明する。図１１の例において、残距離が所定値以下になり、駐車支援ＥＣＵ１０が制動力制御をフィードフォワード制御に切り替えた後、車両１００が目標駐車位置で停車できていない。駐車支援ＥＣＵ１０は、停車できなかったことが判明した時点で制動力をシステム上限値まで増加させる。
【手続補正５】
【補正対象書類名】特許請求の範囲
【補正対象項目名】全文
【補正方法】変更
【補正の内容】
【特許請求の範囲】
【請求項１】
目標停車位置への車両の駐車を支援する駐車支援装置であって、
車輪速パルスに基づいて前記車両の走行距離を演算する、走行距離演算部と、
前記走行距離に基づいて前記目標停車位置までの残距離を決定し、前記残距離が所定値以下の値になったときに、前記車両の制動力の制御をフィードバック制御からフィードフォワード制御に切り替える、制駆動力演算部と、を含む駐車支援装置。
【請求項２】
請求項１に記載の駐車支援装置であって、
前記所定値は、１車輪速パルス間隔距離以上であり、２車輪速パルス間隔距離以下である、駐車支援装置。
【請求項３】
請求項１に記載の駐車支援装置であって、
前記車輪速パルスに基づいて前記車両の車速を演算する、車速演算部をさらに含み、
前記制駆動力演算部は、前記フィードフォワード制御において、前記残距離と、前記フィードバック制御から前記フィードフォワード制御への切り替え時の前記車速演算部により演算された車速と、に基づいて、前記車両の制動力を決定する、駐車支援装置。
【請求項４】
請求項３に記載の駐車支援装置であって、
前記フィードフォワード制御により決定される制動力は、前記目標停車位置まで一定である、駐車支援装置。
【請求項５】
請求項３に記載の駐車支援装置であって、
前記制駆動力演算部は、前記フィードバック制御における目標車速と前記車速演算部により演算された車速との間の差に基づいて、前記フィードフォワード制御における前記車両の制動力を決定する、駐車支援装置。
【請求項６】
請求項１に記載の駐車支援装置であって、
前記制駆動力演算部は、前記フィードフォワード制御において、目標制動力値を決定し、前記車両の制動力を、前記フィードバック制御による値から、前記目標制動力値に徐々に変化させる、駐車支援装置。
【請求項７】
請求項６に記載の駐車支援装置であって、
前記制駆動力演算部は、前記フィードフォワード制御において、前記目標停車位置の手前から前記目標停車位置まで、前記制動力を前記目標制動力値から徐々に減少させる、駐車支援装置。
【請求項８】
請求項１に記載の駐車支援装置であって、
前記制駆動力演算部は、前記車両が前記目標停車位置を通過したことを検知した場合、前記車両の制動力を増加させる、駐車支援装置。
【請求項９】
請求項８に記載の駐車支援装置であって、
前記制駆動力演算部は、前記車両の制動力をシステム上限値まで増加させる、駐車支援装置。
【請求項１０】
請求項８に記載の駐車支援装置であって、
前記制駆動力演算部は、前記目標停車位置で停車できなかったことを検知した時点での車速に基づいて算出した増加率において徐々に前記車両の制動力を増加させる、駐車支援装置。
【請求項１１】
目標停車位置への車両の駐車を支援する方法であって、
車輪速パルスに基づいて前記車両の走行距離を演算し、
前記走行距離に基づいて前記目標停車位置までの残距離を決定し、
前記残距離が所定値以下の値になったときに、前記車両の制動力の制御をフィードバック制御からフィードフォワード制御に切り替える、ことを含む方法。
【国際調査報告】
2020095636.tif 000017
2020095636.tif 000018
2020095636.tif 000019
2020095636.tif 000020