JP2003054341A

JP2003054341A - 車両用駐車支援装置

Info

Publication number: JP2003054341A
Application number: JP2001244202A
Authority: JP
Inventors: Itsuro Muramoto; 逸朗村本; Takashi Ino; 崇猪野
Original assignee: Nissan Motor Co Ltd
Current assignee: Nissan Motor Co Ltd
Priority date: 2001-08-10
Filing date: 2001-08-10
Publication date: 2003-02-26
Anticipated expiration: 2021-08-10
Also published as: JP4759878B2

Abstract

(57)【要約】【課題】障害物に極端に接近してドライバに不安感を
与えず、これに起因した無用なステアリング操作やシフ
ト操作を無くすようにする。【解決手段】駐車前に車両移動しながら超音波センサ
６で捉えた障害物情報を周囲地図生成部１１で蓄積して
車両周囲の地図を生成し、これをもとに目標駐車位置決
定部１３で目標駐車位置候補を探索、決定する。仮目標
軌道算出部１５で目標駐車位置までの仮目標軌道を算出
して参照位置算出部１４で駐車空間の間口の両角などの
座標を求め、車両特定部位座標算出部１２で自車両上の
基準位置と所定の関係を有する車両特定部位の座標を求
め、両座標から評価距離算出部１６で評価距離を算出す
る。評価関数決定部１７で評価距離の関数として与えら
れる評価関数を、最小、又は最大とするような目標軌道
を目標軌道算出部１８で算出し、車両後方画像へ重畳し
てディスプレイ８に表示する。

Description

【発明の詳細な説明】

【０００１】

【発明の属する技術分野】本発明は、駐車場へ駐車しよ
うとする際にドライバが的確な運転操作を簡単に行うこ
とができるようにドライバへ車両周辺の状況を勘案して
最適な目標軌道情報を提供するようにした駐車支援装置
に関する。

【０００２】

【従来の技術】車両に搭載したＣＣＤカメラで捉えた車
両周囲の画像を利用し、駐車時にドライバの運転操作を
支援するものとして、たとえば特開平２０００−７２０
１８号公報に記載のものが知られている。この技術にお
いては、車体の左右側面と後方に設置されたカメラによ
り得られた周囲の画像を画像処理して車庫枠の白線に対
する車両の位置、姿勢および走路幅を算出し、これら車
庫枠の白線に対する車両の位置、姿勢および道路幅から
車庫に入庫するための目標軌道を計算する。この目標軌
道は、ステアリング操作やシフト操作の回数を最小とす
るように、回転半径と直線からなる軌道で設定するよう
にしている。

【０００３】

【発明が解決しようとする課題】上記従来の技術では、
ステアリング操作やシフト操作の回数が少なくて済む点
では優れているものの、一定操舵で旋回後退するような
場面では、車体前端の張り出し量が大きくなって通路の
壁面との間にほとんど隙間がない位置を車両が通過する
軌道になったり、あるいは車体の内側が障害物のすぐそ
ばを通過する軌道になったりすることがあり、ドライバ
に対し不安感を与え、場合によってはドライバが支援内
容を無視して操作してしまう結果、ステアリング操作や
シフト操作の回数が多くなり、やり直しを含め駐車操作
が複雑になってしまったりすることがある、という改善
すべき問題点があった。

【０００４】上記問題点を具体的に図１７に基づいて説
明する。図１７は、自車両ｉが、一定の操舵角を保った
ままの１回のステアリング操作のみで位置Ｓ_ａから位置
Ｆ_ａまで旋回移動した場合の様子を示している。この場
合、車両ｉの右前端が描く円弧軌道ｌ_１が壁Ｗに極端に
近づくので、ドライバはこのまま後退すると車両が壁Ｗ
に接触するのではないかと不安になる。

【０００５】この例では、操舵回数を減らそうとしたが
故に、張り出し量が大きくなり、接触しそうだと感じる
無用な不安感を与えるおそれがあることに加えて、壁面
の位置によっては、接触を避けるために、無用なステア
リング操作やシフト操作が発生するおそれもある。

【０００６】このため本発明は、駐車時に車両がこの周
囲にある障害物に極端に接近することでドライバに車両
が障害物に接触しそうだと感じる無用の不安感を与える
ことがなく、またこれに起因した無用なステアリング操
作やシフト操作を無くして最適な目標軌道を設定するこ
とができるようにした車両用駐車支援装置を提供するこ
とを目的とする。

【０００７】

【課題を解決するための手段】請求項１の本発明は、操
舵角を検出する操舵角検出手段と、車速を検出する車速
検出手段と、車両周囲の障害物を検出する周囲障害物検
出手段と、操舵角と車速とから車両の２次元平面上での
車両位置及び車体向きを算出する車両運動算出部と、車
両運動算出部で算出された車両運動と、障害物検出手段
により得られた障害物までの相対位置関係とから、車両
周囲の２次元地図を生成する周囲地図生成部と、周囲地
図生成部で生成された周囲地図から駐車可能な空間を見
つけ出し目標駐車位置を決定する目標駐車位置決定部
と、目標駐車位置に関連した特定の参照位置を求める参
照位置算出部と、自車両上の基準位置に対する自車両上
の特定部位の位置座標を求める車両特定部位座標算出部
と、車両の特定部位から参照位置までの距離を算出する
評価距離算出部と、自車両が現在位置から目標駐車位置
に達するまでの評価距離の関数として与えられる評価関
数を、最小、又は最大とするような、現在位置から目標
駐車位置までの位置座標と車体向きで表される目標軌道
を算出する目標軌道算出部とを有するものとする。

【０００８】請求項２の本発明は、車両特定部位座標算
出部が、車体の４角のうちの少なくも１つの座標を算出
し、参照位置算出部が、駐車空間の入口を示す間口の少
なくも１つの座標を算出し、評価算出部が、車両特定部
位座標算出部で得た座標と参照位置算出部で得た座標と
の組合せの中から少なくも１つの距離を算出するように
する。

【０００９】請求項３の本発明は、車両特定部位座標算
出部が、舵角検出手段で得た操舵角により、車体の４角
の中で最も外側通過する車両部位を算出し、参照位置算
出部が、目標位置に車両が到達したときの車両の後面、
又は側面に平行な直線を算出し、評価距離算出部が、車
両部位から直線までの距離を算出するようにする。

【００１０】請求項４の本発明は、車両特定部位座標算
出部が、車体の４角のうちの少なくも１つの座標、及び
舵角検出手段で得た操舵角により、車体の４角の中で最
も外側通過する車両部位を算出し、参照位置算出部が、
駐車空間の入口を示す間口の少なくも１つの座標、及び
目標位置に車両が到達したときの車両の後面、又は側面
に平行な直線を算出し、評価距離算出部が、車体の角か
ら駐車空間間口までの評価距離と、車両部位から直線ま
での評価距離とを算出し、目標軌道算出部が、得られた
評価距離を組み合わせて得た関数を評価関数として、こ
の評価関数を最小、又は最大とする目標軌道を算出する
ようにする。

【００１１】請求項５の本発明は、目標軌道算出部が、
自車両の現在位置から目標駐車位置に至るまでの間の評
価距離の最小値を最大とする関数を評価関数として、目
標軌道を算出するようにする。

【００１２】請求項６の本発明は、目標軌道算出部が、
評価距離の逆数のＮ乗（Ｎ＞０、かつ偶数）を自車両の
現在位置から目標駐車位置に至るまで積分した値を評価
関数とし、評価関数を最小とする目標軌道を算出するよ
うにする。

【００１３】

【発明の効果】請求項１の発明によれば、目標駐車位置
決定部が生成された周囲地図から駐車可能な空間を見つ
け出し目標駐車位置を決定し、参照位置算出部で目標駐
車位置に関連した参照位置を求め、車両特定部位座標算
出部にて自車両の基準位置と所定の関係を有する特定部
位の位置座標を求めるとともに、目標軌道算出部が、評
価距離算出部で算出した、車両特定部位位置から参照位
置までの評価距離の関数として与えられる評価関数を、
最小、又は最大とするような、位置座標と車体向きで表
される目標軌道を算出するようにしたので、車両の周囲
にある障害物に車両が極端に接近するような軌道が算出
されることが無くなり、ドライバに無用の不安感を与え
ることなく駐車スペースに誘導することができるように
なる。また、切り返しを行なうことなく目標駐車位置に
達することができる軌道が存在するにも拘わらず、切り
返しなしには目標駐車位置に達することはできないとド
ライバが判断して、その時の位置から車両を移動し、一
回で入れられる位置を探さなければならなくなるような
不便やステアリング操作等が不要に多くなるのを避ける
ことができる。

【００１４】請求項２の発明によれば、評価距離を車体
の角と駐車スペース間口の角との距離とし、その関数を
評価関数としたので、駐車時に特に注意しなければなら
ない、車体の角と駐車場の入り口の角とが接近しすぎる
ことの無い軌道で誘導される結果、ドライバにとってさ
らに安心感の高い誘導が可能となる。

【００１５】請求項３の発明によれば、転舵時に車体の
角が外側に張り出す量が小さくなるような軌道が得られ
るので、周囲の壁面や他車両などの障害物との距離が極
端に小さくなることを避けることができ、ドライバにと
ってさらに安心感の高い誘導が可能となる。

【００１６】請求項４の発明によれば、評価関数を車体
の角と駐車スペース間口の角との評価距離と、車体の角
と壁面との評価距離との合成関数としたので、車体張り
出しによる壁面との間隔と、車体の角と駐車空間の間口
の角との間隔との両者が、極端に小さくなることの無い
目標軌道が得られ、ドライバにとってさらに安心感の高
い誘導が可能となる。

【００１７】請求項５の発明によれば、接触の可能性が
大きい車体の特定部分と障害物の特定部分との距離の最
小値を最も大きくするような目標軌道が得られるので、
ドライバにとって、最も安心感の高い誘導が可能とな
る。更に、不要な切り返しを行なうこと無く目標駐車位
置に達することができる目標軌道を得ることが可能とな
る。

【００１８】請求項６の発明によれば、評価関数を評価
距離の逆数のＮ乗（Ｎ＞0、且つ、偶数）としたので、
評価関数が、障害物との距離を示す評価距離が最も小さ
くなる時の距離が最大に近い値になった時に最小となる
ような関数となり、その結果として、ドライバにとって
非常に安心感の高い誘導が可能となる。また、不要な切
り返しを行なうこと無く目標駐車位置に達することがで
きる目標軌道を得ることができる。さらに、単純に評価
距離のＮ乗の関数であるので、連続関数であり、且つ、
容易に導関数が求められ、数値計算の際も一般的な手法
を用いることが可能となる。

【００１９】

【発明の実施の形態】以下、本発明の実施例を図に基づ
き説明する。図１は、本駐車支援装置の全体を示すブロ
ック図である。コントロールユニット１は、マイクロコ
ンピュー夕、ＲＯＭ、ＲＡＭ、インターフェイス回路な
どからなり、各スイッチ、各センサからの入力情報を処
理して、ディスプレイ（表示手段）８へ出力するデー夕
を算出する役割を担っている。

【００２０】駐車動作開始スイッチ２は、ドライバが駐
車場所に対して予め決められた位置まで車両を持ってい
った時点で、駐車支援装置を作動させるために操作する
ものである。駐車動作開始スイッチ２が操作されると、
この出力信号がコントロールユニット１へ入力され、駐
車支援装置全体が初期化され、駐車操作支援を開始する
ようになる。

【００２１】駐車方法選択スイッチ３は、ドライバが後
退縦列駐車左右、後退並列駐車左右の４つの駐車方法の
うちどの駐車方法を行いたいのか、を手動で選択するた
めのスイッチである。ここで、左右とは自車両の後方左
側空間、自車両の後方右側空間をそれぞれ意味する。ド
ライバが手動で駐車方法選択スイッチ３を切替選択する
ことで、これらの選択信号がコントロールユニット１へ
入力されるようになっている。

【００２２】操舵角センサ（操舵角検出手段）４は、例
えばステアリングホイールに連動するスリットディスク
を挟んで２組のフォトインタラプタをステアリングコラ
ムチューブに互いに位相差を有して固定して構成する。
ステアリングホイールの回転に応じてスリットディスク
による光の透過・遮断に応じてパルスを発生する。この
パルスをカウントし、ドライバが操作するステアリング
の中立点、操舵角を、また上記位相差により操舵方向を
判別する。得られた操舵角にステアリングギヤ比を乗じ
れば、容易に操舵輪の向いている角度（転舵角）に換算
できる。

【００２３】車速センサ（車速検出手段）５は、例えば
車輪と一体に回転する磁性体のロータの歯に対し、コイ
ルと永久磁石からなるピックアップを適当な空隙を設け
て配置して、車輪の回転に応じてパルス電圧を発生さ
せ、このパルスの時間間隔を計測し、得られた時間間隔
と１パルス当たりの角度、タイヤ半径等の数値から車速
を得るようになっている。

【００２４】超音波センサ（周囲障害物検出手段）６
は、例えばピエゾ圧電素子を利用したトランスミッタか
ら超音波を発射し、この超音波が障害物に当たって反射
してくるのを同じくピエゾ圧電素子を利用したレシーバ
で検知するもので、車両の周囲に設置されており、車体
座標系における障害物までの距離及びその方位を検出す
るものである。障害物までの距離は、超音波の発射から
反射して返ってくるまでの時間を計測し超音波の速度を
乗じて得るようになっている。ここでは、車両前端に真
横方向に向けて設置されている。

【００２５】カメラ（車両周囲撮影手投）７は、例えば
ＣＣＤカメラを用い、これを車両後部上方に設置するこ
とで車両の後方を撮影する。このカメラ７による画像信
号は、コントロールユニット１へ入力される。ディス
プレイ８は、例えば、いわゆるバックモニタやナビゲー
ション装置等で使われている液晶製のモニタディスプレ
イを用い、コントロールユニット１から出力される画像
信号が入力されカメラ７が捉えた画像等を表示すること
で、ドライバが後退しながら駐車する際の参考情報を視
覚的に提供するものである。

【００２６】図２は、コントロールユニット１の機能ブ
ロック図である。車両運動算出部１０は、操舵角センサ
４から得られる前輪の転舵角と、車速センサ５から得ら
れる車速と、前進か後退かを識別するために変速機に設
けた図外のシフトポジションセンサから得られるシフト
ポジションに基づいて、例えば、下記の状態方程式か
ら、車両の位置、車体の向き等の車両運動情報を求め
る。この場合、初期位置は駐車動作開始スイッチ２をド
ライバが操作した時点のものとする。

【数１】ここで、（ｘ，ｙ）は初期位置を原点としたときの後輪
車軸中心点の座標、θは車体の向き、Ｌ_ｗｂは車両のホ
イールベース、Φは操舵角センサ４から得られる前輪の
転舵角である。

【００２７】周囲地図生成部１１は、超音波センサ６で
得られた障害物までの距離及び方位に、車両運動算出部
１０で求められた車両運動情報を加味しながら、車両周
囲の障害物位置をマッピングして記憶していく。この結
果、ここで得られる２次元の周囲地図は、車両が移動す
るに従い、超音波センサ６で検出したすべての障害物と
自車両との応対位置関係を蓄積・記憶することにより、
広域の地図が得られることとなる。したがって、超音波
センサ６等で検出した情報は、駐車場に入って検出し始
めた分から蓄積・記憶されている。車両特定部位座標算
出部１２は、目標軌道計算時に基準となる車体部位と、
車両の特定部位との相対位置座標を算出するものであ
る。

【００２８】目標駐車位置決定部１３は、駐車方法選択
スイッチ３により選択された駐車方法（例えば、後退縦
列駐車左右、後退並列駐車左右の４通りのうちから選択
した一つ）を参考に、周囲地図生成部１１で作成された
周囲地図の中から駐車空間として最も適切なものを探し
出すとともに、目標駐車位置としての目標後輪車軸中心
点の座標、及び目標車体方向を決定する。参照位置算出
部１４は、目標駐車位置算出部１３で求められた目標駐
車位置に対して、予め定められた位置関係にある特定の
部位を参照部位として決定し、周囲地図生成部１１から
の地図情報を用いて、その位置座標を算出するものであ
る。

【００２９】仮目標軌道算出部１５は、車両運動算出部
１０で求めた車両の現在位置から、目標駐車位置決定部
１３で決定された目標駐車位置までの仮の目標軌道を算
出するものである。仮目標軌道としては、上記運動方程
式を満たしながら、現在位置から目標駐車位置まで到達
できるような、ｘ、ｙ、θ、Φのデータを与えればよ
い。なお、これらのデータは、上記運動方程式を厳密に
満たさなくても、たとえば、位置座標データとして現在
位置から目標駐車位置までを直線的に移動するようにし
たｘ、ｙを、また、その間の車体向きθ、及び前輪転舵
角をゼロとしてもよい。

【００３０】評価距離算出部１６は、参照位置算出部１
４で算出された参照位置座標と、車両特定部位座標算出
部１２で算出された各特定部位座標とから、評価距離を
算出するものである。評価関数決定部１７は、上記評価
距離算出部１６で求められた評価距離を用いて、予め定
められた評価関数を求めるものである。目標軌道算出部
１８は、仮目標軌道算出部１５で与えられた仮目標軌道
をベースにして、評価関数決定部１７で求められた評価
関数の値を最小にするような目標軌道を求めるものであ
る。評価関数を最小にするような目標軌道の算出方法と
しては、例えば、最急降下法などの数値計算法を用い
る。

【００３１】画像合成部１９は、カメラ７により撮影さ
れた車両周囲画像（本実施例では車両後方の画像を上方
からみたように座標変換した画像とする）上に、目標軌
道算出部１８で算出された目標軌道と、周囲地図生成部
１１で得られた地図情報とを重畳し、得られた合成画像
をディスプレイ８へと出力するものである。

【００３２】次に、図３を用いて、本発明に係る駐車支
援装置の動作を、車両が左後方の駐車空間に後退並列駐
車する場合につき説明する。ここでは、前輪を操舵する
車両を考えているので、車両位置は後輪車軸の中心点位
置を基準として考える。座標系は、適当な位置を原点と
する地上座標系として、例えば、駐車位置で車体前方へ
向けてｘ軸を、またこの左横方向へ向けてｙ軸をとるこ
ととし、車体向きは、ｘ軸に対する車体の向きを指すも
のとする。周囲地図生成部１１では、超音波センサ６を
利用して他車両７０、８０や壁９０といった障害物を線
分ａにて生成する。目標駐車位置決定部１３は、上記周
囲地図をもとに、駐車場所として適切な空間を探索し、
例えば、他車両７０、８０間の空間を目標駐車位置と
し、そのときの後輪車軸中心点ｂを求める。

【００３３】一方、参照位置算出部１４は、障害物とし
ての線分ａにあって、目標駐車位置の間口の角となる、
他車両７０の右前端位置、及び他車両８０の左前端位置
をそれぞれ参照位置ｃ_１、ｃ_２とし、その座標を算出す
る。自車両ｉは現在の車両位置にあってその後輪車軸中
心点がｄにあり、車両運動算出部１０でその座標を算出
する。車両特定部位座標算出部１２は、自車両ｉの基準
位置と特定の関係にある車両特定部位（ここでは、車両
の左右後端である）ｅ_１、ｅ_２を算出する。

【００３４】仮目標軌道算出部１５は、車両運動算出部
１０で求めた自車両ｉの現在位置と目標駐車位置決定部
１３で決定した目標駐車位置とから、図３中に点線で示
される仮目標軌道ｇを算出する。この仮目標軌道ｇは、
最初に与えられる適当な目標軌道であって、ここでは、
初期位置と目標駐車位置を結んだ直線で与えている。車
体向きは、例えば、初期位置での車体向きから、目標駐
車位置における車体向きまで一定の割合で変化するもの
を与え、前輪転舵角にはゼロを与えている。この仮目標
軌道は、必ずしも軌道全体に渡って、上記の運動方程式
を満たしてはいないが、評価距離算出部１６〜目標軌道
算出部１８によって、目標軌道を算出する際の数値計算
の過程で条件を満たすものに修正されていく。この計算
方法は、最適制御と呼ばれる分野で提案されている数値
計算法を用いればよく、ここでは詳細な説明は省くが、
参考文献として、加藤寛一郎著「工学的最適制御」（東
京大学出版会）をあげておく。

【００３５】評価距離算出部１６は、各参照位置と、こ
れらに対応する車両特定部位との距離ｃ_１〜ｅ_１、ｃ_２
〜ｅ_２を求め、これらを評価距離ｆ_１、ｆ_２とする。評
価関数決定部１７は、上記で得た評価距離から後述の評
価関数を決定する。この評価関数をもとに目標軌道算出
部１８で目標軌道ｈを得る。この目標軌道ｈは、例え
ば、車両が初期位置での後輪車軸中心点ｂから駐車位置
での後輪車軸中心点ｂまで移動する際の、評価距離ｆ_１
又はｆ_２の最小値を最大にする軌道、すなわち、車両が
周囲障害物から、最も大きな距離を保ちながら目標駐車
位置に到達する軌道である。

【００３６】以上の処理の流れを図４のゼネラルフロー
チャート、及び図５〜図９のサブルーチンのフローチャ
ートを用いて、詳細に説明する。これらのプログラム処
理は、コントロールユニット１のマイクロコンピュー夕
により所定の制御周期毎に繰り返し実行される。また、
図４のゼネラルフローを実行する際には、これと並行し
て周囲地図生成部１１により周囲地図が生成されている
ものとする。

【００３７】駐車動作開始スイッチ２が操作されると、
コントロールユニット１で以下の処理が開始される。ス
テップ１００では、駐車動作開始フラグがセットされて
いるか否かを調べる。セットされていればステップ２０
０へ、セットされていなければステップ１５０へ進んで
駐車動作開始フラグをセットする。ステップ２００で
は、車両運動算出部１０が、操舵角センサ４から操舵角
を、また車速センサ５からの車速をそれぞれ読み込む。
ここでの読み込み処理の詳細は、図５を用いて、後で説
明する。

【００３８】ステップ２５０では、目標駐車位置決定部
１３において、目標駐車位置決定フラグがセットされて
いるか否かを調べる。セットされていればステップ６０
０へ、セットされていなければステップ３００へ進む。
ステップ３００では、目標駐車位置決定部１３が、周囲
地図生成部１１で生成されている周囲地図をもとに駐車
空間として適切な場所を抽出し、その目標駐車位置と、
その時の車体の向きを算出、設定する。ここでの目標駐
車位置決定処理の詳細は、図６、図７を用いて後で説明
する。

【００３９】ステップ４００では、目標駐車位置決定フ
ラグをセットする。ステップ４５０では、参照位置算出
部１４が、目標駐車位置決定部１３で決定した目標駐車
位置と、周囲地図生成部１１で得た周囲地図情報とか
ら、参照位置を決定する。参照位置としては、例えば、
目標駐車位置の入口の間口の角を選定する。

【００４０】ステップ５００では、車両運動算出部１０
が、駐車動作開始フラグがセットされた時点での後輪車
軸中心点を原点として、車両の運動に従い、車両の位置
座標（ｘ，ｙ）、車両の向きθを算出する。ここでの自
車両の位置座標・車体向き算出処理の詳細は、図８を用
いて、後で説明する。ステップ６００では、仮目標軌道
算出部１５が、変速機のシフト位置を調べる。リバース
に入っていればステップ７００へ、リバースに入ってい
なければ本処理から抜ける。

【００４１】ステップ７００では、仮目標軌道算出部１
５が、シフト位置がリバースにされた時点の車両位置か
ら、ステップ３００で目標駐車位置決定部１３にて設定
した目標駐車位置へ到る仮目標軌道を算出する。この仮
目標軌道算出方法の詳細は、図９を用いて、後で説明す
る。ステップ７１０では、車両特定部位座標算出部１２
が、車両運動算出部１０で求めた自車両情報を基準にこ
れと所定の関係にある車両特定部位の位置座標を算出す
る。この車両特定部位の位置座標の算出方法について
は、図１３を用いて、後で説明する。

【００４２】ステップ７５０では、評価距離算出部１６
が、車両特定部位座標算出部１２で求めた車両特定部位
の座標と、参照位置算出部１４で求めた参照位置の座標
とから評価距離を算出する。ステップ７７０では、評価
関数決定部１７が、評価距離算出部１６で算出した評価
距離に基づき評価関数を決定する。

【００４３】ステップ８００では、目標軌道算出部１８
が、仮目標軌道算出部１５で得た仮目標軌道と、評価関
数決定部１７で決定した評価関数とに基づき、目標軌道
を算出する。ここでの目標軌道算出方法の詳細は、図１
４〜図１６を用いて後で説明する。ステップ９００で
は、画像合成部１９が、目標軌道算出部１８が求めた目
標軌道と、周囲地図生成部１１で得た周囲地図情報と
を、カメラ７で撮像した後部の撮影画像に重畳合成し、
ディスプレイ８ヘ、予め定められたフォーマットで転送
する。ステップ１０００では、コントロールユニット１
が、駐車動作開始フラグ、目標駐車位置決定フラグ等の
本処理に係わるフラグをリセットする。

【００４４】図５は、図４のゼネラルフローチャートで
のステップ２００におけるセンサ信号読み込み処理の詳
細な流れを示したフローチャートである。ステップ２１
０では、車両運動算出部１０が車速センサ５から車速を
読み込む。ステップ２２０では、車両運動算出部１０
が、操舵角センサ４からステアリングの操舵角を読み込
む。ステップ２３０では、ステップ１２０で読み込んだ
操舵角に、ステアリングのギヤ比Ｇ１を乗じることで、
前輪転舵角を算出する。

【００４５】図６、図７は、図４のゼネラルフローチャ
ートでのステップ３００における、目標駐車位置決定処
理の詳細な流れを示したフローチャートである。ステッ
プ３１０では、目標駐車位置決定部１３が、駐車方法選
択スイッチ３で後退並列駐車と後退縦列駐車のどちらが
選択されているかを調べる。後退並列駐車側が選択され
ていればステップ３１５へ、また後退縦列駐車側が選択
されていればステップ３２０へ進む。ステップ３１５で
は、フラグｆｌｇ＿ｐ１をセットし、ステップ３２０で
は、フラグｆｌｇ＿ｐ１をリセットする。

【００４６】続くステップ３２５では、駐車方法選択ス
イッチ３で左右のどちらの駐車空間が選択されているか
を調べる。左側が選択されていればステップ３３０へ、
右側が選択されていればステップ３３５へと進む。ステ
ップ３３０では、フラグｆｌｇ＿ｐ２をセットし、ステ
ップ３３５では、フラグｆｌｇ＿ｐ２をリセットする。

【００４７】ステップ３４０では、後退並列駐車か後退
縦列駐車かを認識するため、フラグフラグｆｌｇ＿ｐ１
を調べて、これが１であれば、ステップ３４５へ、１で
なければステップ３７０へ進む。ステップ３４５では、
左右いずれの駐車空間が選択されたか認識するため、フ
ラグｆｌｇ＿ｐ２を調べて、これが１でなければステッ
プ３５０へ進み、１であればステップ３６０へ進む。ス
テップ３７０でも、同様にフラグｆｌｇ＿ｐ２を調べ
て、これが１であればステップ３８０へ進み、１でなけ
ればステップ３９０へ進む。

【００４８】ステップ３５０では、周囲地図生成部１１
で得た周囲地図情報に基づき、右後方で後退並列駐車可
能な駐車空間を探索する。なお、周囲地図生成部１１に
おける周囲地図の生成要領については、図１０〜図１２
を用いて後で説明する。続くステップ３５５では、上記
目標駐車空間から、目標とする後輪車軸中心点の座標
（ｘ_ｂ，ｙ_ｂ）と、目標とする車体向きθ_ｂを算出す
る。

【００４９】一方、ステップ３６０では、周囲地図生成
部１１で得た周囲地図情報に基づき、左後方で後退並列
駐車可能な駐車空間を探索する。続くステップ３６５で
は、上記目標駐車空間から、目標とする後輪車軸中心点
の座標（ｘ_ｂ，ｙ_ｂ）と、目標とする車体向きθ_ｂを算
出する。また、ステップ３８０では、周囲地図生成部１
１で得た周囲地図情報に基づき、左後方で後退縦列駐車
可能な駐車空間を探索する。続くステップ３８５では、
上記目標駐車空間から、目標とする後輪車軸中心点の座
標（ｘ_ｂ，ｙ_ｂ）と、目標とする車体向きθ_ｂを算出す
る。一方、ステップ３９０では、周囲地図生成部１１で
得た周囲地図情報に基づき、右後方で後退縦列駐車可能
な駐車空間を探索する。続くステップ３９５では、上記
目標駐車空間から、目標とする後輪車軸中心点の座標
（ｘ_ｂ，ｙ_ｂ）と、目標とする車体向きθ_ｂを算出す
る。

【００５０】図８は、図４のゼネラルフローチャートで
のステップ５００における、車両の位置座標、車体の方
向を算出する車両位置算出処理の詳細な流れを示したフ
ローチャートである。ステップ５０５では、車両運動
算出部１０が、自車両の位置座標、車体方向を算出する
際、それらの初期化が行われているか否かにつき、車両
位置初期化フラグを調べて判断する。車両位置初期化フ
ラグがセットされていればステップ５４０へ、リセット
されていればステップ５１０へ進む。

【００５１】ステップ５１０では、車両位置初期化フラ
グをセットする。続くステップ５１５では、車体向きを
初期化してθ_１＝π／２とする。ステップ５２０では、
後輪車軸中心点のｘ座標を初期化し、ｘ_１＝０とする。
ステップ５３０では、後輪車軸中心点のｙ座標を初期化
し、ｙ_１＝０とする。

【００５２】次いで、ステップ５４０では、Ｔ_ｓをサン
プリング時間として、１サンプル前の車体向きθ_１と、
その周期で計測した車速Ｖ、前輪切れ角（転舵角）Φか
ら、車体向きθ_２を求める。 θ_２＝（Ｔ_ｓ・Ｖ／Ｌ_ｗｂ）・ｔａｎΦ＋θ_１

【００５３】ステップ５５０では、Ｔ_ｓをサンプリング
時間として、1サンプル前の後輪車軸中心点のｘ座標ｘ
_１と、車体向きθ_１と、その周期で計測した車速Ｖとか
ら、後輪車軸中心点のｘ座標ｘ_２を求める。ｘ_２＝Ｔ_ｓ・Ｖ・ｃｏｓθ_１＋ｘ_１

【００５４】ステップ５６０では、Ｔ_ｓをサンプリング
時間として、１サンプル前の後輪車軸中心点のｙ座標ｙ
_１と、車体向きθ_１と、その周期で計測した車速Ｖとか
ら、後輪車軸中心点のｙ座標ｙ_２を求める。ｙ_２＝Ｔ_ｓ・Ｖ・ｓｉｎθ_１＋ｙ_１

【００５５】ステップ５７０では、θ_１＝θ_２として、
ステップ５４０で求めた新たな車体の向きを、このサン
プルでの車体の向きとする。ステップ５８０では、ｘ_１
＝ｘ_２として、ステップ５５０で求めた新たな後輪車軸
中心点のｘ座標を、このサンプルでの車体の向きとす
る。ステップ５９０では、ｙ_１＝ｙ_２として、ステップ
５６０で求めた新たな後輪車紬中心点のｙ座標を、この
サンプルでの車体の向きとする。

【００５６】図９は、図４のゼネラルフローチャートで
のステップ７００における仮目標軌道算出処理の詳細な
流れを示したフローチャートである。ここで、軌道の算
出に関しては、上述の状態方程式を用いることから、位
置座標ｘ、ｙ、車体向きθ、前輪転舵角Φを求める。ス
テップ７１０では、仮目標軌道算出部１５が、車両運動
算出部１０で求めた自車両位置情報と、目標駐車位置決
定部１３で求めた目標駐車位置情報とから、目標駐車位
置でのあるべき車体の状態を読み込む。すなわち、地図
情報を利用して求められた位置座標ｘ＝ｘ_ｆ、ｙ＝
ｙ_ｆ、その時の車体の向きθ＝θ_ｆ、及び目標駐車位置
に到達したときには例えばタイヤの向きは中立状態にす
るとして、前輪転舵角Φ＝Φ_ｆ＝０を読み込む。

【００５７】ステップ７２０では、車両運動算出部１０
から現在の車体の状態を読み込む。すなわち、周囲地図
情報を利用して求められた位置座標ｘ＝ｘ_ｓ、ｙ＝
ｙ_ｓ、現在の車体の向きθ＝θ_ｓ、及び、現在の前輪転
舵角Φ＝Φ_ｓを読み込む。ステップ７３０では、ステッ
プ７２０で得た現在の位置座標ｘ＝ｘ_ｓ、ｙ＝ｙ _ｓ、及
び、ステップ７１０で得られた目標駐車位置座標ｘ＝ｘ
_ｆ、ｙ＝ｙ_ｆから、現在位置と目標駐車位置とを結ぶ直
線を、例えば、予め定められた個数ｎに分割したときの
ｎ＋１個の位置座標群（（ｘ_０，ｙ_０），（ｘ_１，
ｙ_１），…，（ｘ_ｎ，ｙ_ｎ））を仮目標軌道における位
置座標列として求める。ここで、（ｘ_０，ｙ_０）＝（ｘ
_ｓ，ｙ_ｓ）、（ｘ_ｎ，ｙ_ｎ）＝（ｘ_ｆ，ｙ_ｆ）である。

【００５８】ステップ７４０では、ステップ７２０で得
られた現在の車体の向きθ＝θ_ｓと、ステップ７１０で
得られた目標駐車位置での車体向きθ＝θ_ｆから、両者
を結ぶ直線を、ｎ分割したときのｎ＋１個の車体向きデ
ータ群（θ_０，θ_１，…，θ _ｎ）を仮目標軌道における
位置座標列として求める。ここで、θ_０＝θ_ｓ、θ_ｎ＝
θ_ｆである。ステップ７５０では、ステップ７２０で得
られた現在の前輪転舵角Φ＝Φ_ｓと、ステップ７１０で
得られた目標駐車位置での前輪転舵角Φ＝Φ_ｆとから、
両者を結ぶ直線を、ｎ分割したときのｎ＋１個の前輪転
舵角データ群（Φ_０，Φ_１，…，Φ_ｎ）を仮目標軌道に
おける位置座標列として求める。ここで、Φ_０＝Φ_ｓ、
Φ_ｎ＝Φ_ｆである。

【００５９】次に、周囲地図の生成方法につき、図１０
〜図１２に基づき、説明する。図１０は、自車両ｉが図
の右方から左方位置まで移動して来る間、車体左前方に
横向きに取り付けた超音波センサ６で車両左側を測距
し、その後、図の位置で一旦停止して、ドライバが車両
進行方向に対し左側後方に後退並列駐車しようとする場
合を示す。周囲地図生成部１１は、超音波センサ６から
の測距出力を受けて、車両が駐車列（他車両７０、８
０）及び壁９０に沿って前進するに従い、これらを逐次
サンプリングしていった測距結果、及び車両ｉの移動量
を考慮して２次元平面上に障害物をサンプリング点によ
りマッピングする。

【００６０】このサンプリング結果は、例えば図１０に
示すように、壁９０についてのサンプリング点９１〜９
９、２台の他車両７０、８０についてそれぞれのサンプ
リング点７１〜７５、８１〜８６として得られる。周囲
地図生成部１１では、図１１に示すように、上記サンプ
リング点をグルーピングして、サンプリング点７１〜７
４、サンプリング点８２〜８６、及びサンプリング点９
１〜９９をそれぞれ一塊として、他車両７０、８０にそ
れぞれ対応する２本の直線１０１、１０２、及び壁９０
に対応する１本の直線１０３で直線近似する。グルーピ
ングは、例えば隣接している点間の距離が所定値より短
いか否かで判断し、短ければグルーピングする。これに
より、ここでは、駐車中の他車両７０、８０の前面が２
本の直線１０１、１０２で、これら他車両の間にある壁
９０が１本の直線１０３でそれぞれ表されることにな
る。

【００６１】目標駐車位置決定部１３は、この直線近似
して抽出された左側車両、後方の壁、および右側車両の
障害物の線分データを参照して、前述のとおり制御フロ
ーのステップ３００において駐車スペースを探索し、目
標とする後輪車軸中心点の座標と、車体の向きを算出す
る。この直線近似の線分データで表わされる周囲地図は
画像合成部へ送られ、ディスプレイ８に表示される。図
１２は、車両後方画像に、上記直線近似して抽出された
障害物がそれぞれ線分１０１、１０２、１０３として重
畳表示された状態を示す。なお、ディスプレイ８には、
表示枠１００内のみが映し出される。

【００６２】次いで、図４のゼネラルフローチャートに
おけるステップ７１０における車両特定部位座標算出方
法につき、図１３に基づき詳細に説明する。ここでは、
図３に示した駐車のケースを考え、車両上の基準位置を
それぞれ表す車体の側面に沿う直線ｌ_１、ｌ_２と車体後
面に沿う直線ｌ_３とが公差する点、すなわち車体左後端
の座標（ｘ_ｒｌ，ｙ_ｒｌ）と車体右後端の座標
（ｘ_ｒｒ，ｙ _ｒｒ）との各点の座標を車両特定部位座標
とする。車体が座標系の原点にあり、ｘ軸方向に対する
車体向きがゼロであったとすると、

【数２】

【数３】である。ここで、Ｒ_ｏｈは車体のリアオーバーハング、
Ｗは車幅である。従って、車両の後輪車軸中心点の位置
が（ｘ_ｋ，ｙ_ｋ）、車体向きがθ_ｋであるときの車体左
後端と車体右後端のそれぞれの座標は、後輪車軸中心点
が原点Ｏにある車両ｉ’の位置でθ_ｋだけ回転し、それ
を車両位置座標分、平行移動すればよい。従って、０〜
ｎ番目までのうちにおけるｋ番目の座標は、それぞれ、
以下の式で与えられる。

【数４】

【数５】

【００６３】次に、図４のジェネラルフローチャート
におけるステップ７５０、７７０における評価距離及び
評価関数の算出方法につき、詳細に説明する。図３に示
した参照位置ｃ_１、ｃ_２の位置座標を（ｘ_ｃｌ，
ｙ_ｃｌ）、（ｘ_ｃ２，ｙ_ｃ２）、また車両の特定位置ｅ
_１、ｅ_２の座標を（ｘ_ｒｌ，ｙ_ｒｌ）、（ｘ _ｒｒ，
_ｙｒｒ）とすると、評価距離ｆ_１、ｆ_２は、それぞれ、

【数６】

【数７】となる。これらの評価距離を用いて、評価関数Ｉとして
は、例えば、次式のものを与える。

【数８】すなわち、ここでＩ_１は、車両が現在位置から目標位置
まで移動した際における評価距離の最小値を評価関数と
している。そして、このＩ_１が最大となるような軌道を
目標軌道とする。

【００６４】以上で説明したように、本実施例では、駐
車開始前から超音波センサ９により車両移動しながら測
距したデータをもとに周囲地図生成部１１で生成した周
囲地図を利用し、目標駐車位置を決定して仮目標軌道を
算出する一方、車両の基準位置と所定の関係を有する車
両特定部位と、周囲地図情報及び目標駐車位置情報から
求めた参照位置とに基づき評価距離を算出し、これをも
とに評価関数を用いて最適な目標軌道を算出するように
構成したので、駐車操作中、車両が車両周囲の障害物に
極端に接近するような軌道が算出されることが無くなる
結果、ドライバに車両が障害物に接触するかもしれない
といった無用の不安感を与えることがなくなる。この結
果、不安に起因した不要なステアリング操作やシフト操
作などをしなくて済み、スムーズに駐車することが可能
となる。

【００６５】なお、上記実施例にあっては、評価関数Ｉ
に、車両が現在位置から目標位置まで移動した際におけ
る評価距離の最小値とするＩ_１を用いたが、これに代え
て下記の評価関数Ｉ_２〜Ｉ_４などを用いても良い。たと
えば、評価関数Ｉとして、次式のように、車両が現在位
置から目標位置まで移動した際における評価距離の逆数
を合計しこれの偶数乗の合計値とする評価関数Ｉ_２を用
いてもよい。

【数９】（ただし、ｍは偶数）このＩ_２が最小となるような軌道が目標軌道となる。

【００６６】上記評価関数Ｉ_２を用い、後退並列駐車で
左後方の駐車空間に駐車するケースにつき、ｍ＝８とし
て演算した結果（現在位置から目標駐車位置まで移動し
た際における車両ｉの位置と車体向きの変化）を図１４
に示す。ここで、座標軸は、駐車位置での車体の前方を
ｘ軸、その左側横方向をｙ軸とする。また、車両ｉの駐
車開始の位置をｉ_ｄ、駐車位置での位置ｉ_ｂ、他車両や
壁などの障害物Ｗ_１、Ｗ_２間にある駐車空間の間口の角
Ｗ_Ａ、Ｗ_Ｂの座標をそれぞれ（ｘ_Ａ，ｙ_Ａ）、（ｘ_Ｂ，
ｙ_Ｂ）とする。参照位置としての左側の角Ｗ_Ａから車両
特定部位としての車体左後端までの距離、参照位置とし
ての右側の角Ｗ_Ｂから車両特定部位としての車体右後端
までの距離が、それぞれ評価距離ｆ_ａ、ｆ_ｂである。こ
れらの評価距離を用いて評価関数Ｉ_２により得た上記目
標軌道に沿って車両を移動させた結果は、図示のように
角Ｗ_Ａ、Ｗ_Ｂと車両ｉの特定部位との間隔が極端に大き
くならず、ドライバにとって安心して駐車操作を実行で
きる。また、この場合、評価関数には評価距離のＮ乗の
連続関数を用いているので、この導関数を容易に算出で
き、数値計算にあっても一般的な手法で済み、演算が容
易になる。

【００６７】ここで、上記効果が得られる理由を、図１
５に基づき説明する。同図において、ここでは車両ｉが
位置Ａからスタートして、位置Ｂに駐車する場合を考え
る。この時、軌道は、ほぼ同図（ａ）に示すように変化
し、評価距離Ｒ_ｉ（ここでｉは０〜１０）は、位置C付
近での評価距離Ｒ_５が最小値になるようにＲ_０〜Ｒ_１０
へと変化する。

【００６８】ここで、評価距離Ｒ_ｉそのものに等しい値
ｆ_１の積分であるＧ_１が評価関数である場合、これを最
小にしようとすると、Ｒ_ｉが小さくなった方がＧ_１が小
さくなるので、最小距離はゼロになった方がよいことに
なる。そこで、評価距離の逆数１／Ｒ_ｉである値ｆ_２の
積分Ｇ_２を評価関数とすると、Ｒ_ｉが大きくなった方が
Ｇ_２が小さくなり、特に、評価距離が最小となるＲ_５の
増減が最も大きくＧ_２の増減に影響するので、求めたい
軌道に近いものが得られる。

【００６９】しかしながら、この場合は、Ｒ_５に近い別
の評価距離（例えばＲ_４、Ｒ_６等）の増減も評価関数Ｇ
_２の増減に大きく影響するという問題がある。そこで、
評価関数のＮ乗（同図（ｂ）では４乗）の逆数である値
ｆ_３の積分を評価関数Ｇ_３とすると、評価距離が最小に
なる部分（この図（ｂ）ではＲ_５）の増減が、Ｇ_３の増
減に極端に大きく影響するようになる。このようにする
ことで、近似的に、現在位置から目標駐車位置に至るま
での間の評価距離の最小値を最大とする関数を評価関数
として得た目標軌道に近い解が得られることになる。な
お、最小値を求めるためには、Ｎを偶数とし、値ｆ_３が
下に凸の関数となることが必要である。

【００７０】次に、さらに別の評価関数として、車体の
張り出し量をできるだけ小さくするような軌道を求める
ため、下記の評価関数Ｉ_３あるいはＩ_４を用いるように
してもよい。ここで、ｘ_ｆｒは、評価距離としての張り
出し量であり、例えば図１６のようにｘ方向の張り出し
量（距離Ｌ_０）を求めることとなる。

【数１０】あるいは

【数１１】（ただしmは偶数）上記評価関数にあっては、Ｉ_３を最大、Ｉ_４を最小にす
る軌道を求め目標軌道とする。

【００７１】図１６は、上記評価関数Ｉ_４を用い、後退
並列駐車で左後方の駐車空間に駐車するケースにつき、
ｍ＝８として演算した結果（現在位置から目標駐車位置
まで移動した際における車両ｉの位置と車体向きの変
化）を示す。ここで、座標軸は、駐車位置での車体の前
方をｘ軸、その左側横方向をｙ軸とする。車両ｉの駐車
開始の位置をｉ_ｄ、駐車位置での位置をｉ_ｂ、そして車
体左前端、車体右前端、車体左後端、車体右後端の各座
標をそれぞれ（ｘ_ＦＬ，ｙ_Ｆ _Ｌ）、（ｘ_ＦＲ，
ｙ_ＦＲ）、（ｘ_ＲＬ，ｙ_ＲＬ）、（ｘ_ＲＲ，ｙ_ＲＲ）と
する。そして、駐車位置での後車輪軸中心点から所定距
離（ここでは１ｍ）離れｙ軸に平行な線Ｌ_ｍから、ｘ軸
に平行に車体右前端（ｘ_ＦＲ，ｙ_ＦＲ）までの距離Ｌ _０
（図示位置ではｘ_ｆｒ（０））を各車両位置ごとに算出
比較し、距離Ｌ_０を最小化する。このようにしても、ド
ライバが障害物への接触の不安を覚えずに駐車操作でき
る目標軌道を容易に算出できる。

【００７２】なお、上記実施例の超音波センサに代え、
レーザー、マイクロ波、ミリ波等を利用したレーダを用
いるようにしてもよい。また、車両後方を撮影するカメ
ラは、車体後部上方に装着した１台に限ることなく、車
体後端付近に２台のカメラを装着させるようにしてもよ
い。このようにすれば、これらで撮影した画像を合成す
ることで、車両の後端も含んだ画像を容易に得ることが
できる。

【００７３】また、実施例では、目標駐車位置決定部１
３が周囲地図から駐車スペースとして適切な場所を抽出
し、目標駐車位置と車体向きを算出・設定するものとし
たが、そのほか、例えばディスプレイ８にタッチパネル
機能を持たせておき、先の図１１に示すようなディスプ
レイ８に表示された周囲地図の画像を見ながら、ドライ
バが目標駐車位置Ｂを指で押して指定することにより、
目標駐車位置決定部１３ではただちに当該指定位置の座
標を決定する構成とすることもできる。

【図面の簡単な説明】

【図１】本発明に係る駐車支援装置の全体を示すブロッ
ク図である。

【図２】コントロールユニットの機能ブロック図であ
る。

【図３】本発明に係る駐車支援装置の動作を示す説明図
である。

【図４】実施例における制御の流れを示すゼネラルフロ
ーチャートである。

【図５】センサ信号を検出するサブルーチンの詳細を示
すフローチャートである。

【図６】目標駐車位置を決定するサブルーチンの詳細を
示すフローチャートである。

【図７】目標駐車位置を決定するサブルーチンの詳細を
示すフローチャートである。

【図８】車両の位置座標、車体の向きを算出するサブル
ーチンの詳細を示すフローチャートである。

【図９】仮目標軌道を算出するサブルーチンの詳細を示
すフローチャートである。

【図１０】周囲地図生成の要領を示す説明図である。

【図１１】周囲地図生成の要領を示す説明図である。

【図１２】ディスプレイ上の周囲地図の表示態様を示す
説明図である。

【図１３】車両特定部位座標の算出方法の要領を示す説
明図である。

【図１４】評価距離と評価関数を利用した目標軌道の算
出結果を示す図である。

【図１５】評価関数Ｉ_２を用いた場合の効果の理由を示
す説明図である。

【図１６】他の評価距離と評価関数を利用した目標軌道
の算出結果を示す図である。

【図１７】従来技術の問題点を示す説明図である。

【符号の説明】

１コントロールユニット２駐車動作開始スイッチ３駐車方法選択スイッチ４操舵角センサ（操舵角検出手段）５車速センサ（車速検出手段）６超音波センサ（周囲障害物検出手段）７カメラ（撮影手段）８ディスプレイ（表示手段）１０車両運動算出部１１周囲地図生成部１２車両特定部位座標算出部１３目標駐車位置決定部１４参照位置算出部１５仮目標軌道算出部１６評価距離算出部１７評価関数決定部１８目標軌道算出部１９画像合成部

Claims

【特許請求の範囲】

【請求項１】操舵角を検出する操舵角検出手段と、車
速を検出する車速検出手段と、車両周囲の障害物を検出
する周囲障害物検出手段と、前記操舵角と前記車速とか
ら車両の２次元平面上での車両位置及び車体向きを算出
する車両運動算出部と、該車両運動算出部で算出された
車両運動と、前記障害物検出手段により得られた障害物
までの相対位置関係とから、車両周囲の２次元地図を生
成する周囲地図生成部と、該周囲地図生成部で生成され
た前記周囲地図から駐車可能な空間を見つけ出し目標駐
車位置を決定する目標駐車位置決定部と、前記目標駐車
位置に関連した特定の参照位置を求める参照位置算出部
と、自車両上の基準位置に対する自車両上の特定部位の
位置座標を求める車両特定部位座標算出部と、該車両特
定部位から前記参照位置までの距離を算出する評価距離
算出部と、自車両が現在位置から目標駐車位置に達する
までの評価距離の関数として与えられる評価関数を、最
小、又は最大とするような、現在位置から目標駐車位置
までの位置座標と車体向きで表される目標軌道を算出す
る目標軌道算出部とを有することを特徴とする車両用駐
車支援装置。
【請求項２】前記車両特定部位座標算出部は、車体の
４角のうちの少なくも１つの座標を算出し、前記参照位
置算出部は、駐車空間の入口を示す間口の少なくも１つ
の座標を算出し、前記評価距離算出部は、前記車両特定
部位座標算出部で得た座標と前記参照位置算出部で得た
座標との組合せの中から少なくも１つの距離を算出する
ようにしたことを特徴とする請求項１に記載の車両用駐
車支援装置。
【請求項３】前記車両特定部位座標算出部は、前記舵
角検出手段で得た操舵角により、車体の４角の中で最も
外側を通過する車両部位を算出し、前記参照位置算出部
は、前記目標駐車位置に車両が到達したときの車両の後
面、又は側面に平行な直線を算出し、前記評価距離算出
部は、前記車両部位から前記直線までの距離を算出する
ようにしたことを特徴とする請求項１に記載の車両用駐
車支援装置。
【請求項４】前記車両特定部位座標算出部は、車体の
４角のうちの少なくも１つの座標と前記舵角検出手段で
得た操舵角により、車体の４角の中で最も外側を通過す
る車両部位を算出し、前記参照位置算出部は、駐車空間
の入口を示す間口の少なくも１つの座標と、前記目標駐
車位置に車両が到達したときの車両の後面、又は側面に
平行な直線とを算出し、前記評価距離算出部は、車体の
角から駐車空間間口までの評価距離、及び前記車両部位
から前記直線までの評価距離を算出し、前記目標軌道算
出部は、前記評価距離を組み合わせて得た関数を評価関
数として、該評価関数を最小、又は最大とする目標軌道
を算出するようにしたことを特徴とする請求項１に記載
の車両用駐車支援装置。
【請求項５】前記目標軌道算出部は、自車両の現在位
置から目標駐車位置に至るまでの間の評価距離の最小値
を最大とする関数を評価関数として、目標軌道を算出す
るようにしたことを特徴とする請求項１から４のいずれ
かに記載の車両用駐車支援装置。
【請求項６】前記目標軌道算出部は、前記評価距離の
逆数のＮ乗（Ｎ＞０、かつ偶数）を自車両の現在位置か
ら目標駐車位置に至るまで積分した値を評価関数とし、
該評価関数を最小とする目標軌道を算出するようにした
ことを特徴とする請求項１から４のいずれかに記載の車
両用駐車支援装置。