JP5380926B2 - Parking assistance device and parking assistance method - Google Patents
Parking assistance device and parking assistance method Download PDFInfo
- Publication number
- JP5380926B2 JP5380926B2 JP2008172772A JP2008172772A JP5380926B2 JP 5380926 B2 JP5380926 B2 JP 5380926B2 JP 2008172772 A JP2008172772 A JP 2008172772A JP 2008172772 A JP2008172772 A JP 2008172772A JP 5380926 B2 JP5380926 B2 JP 5380926B2
- Authority
- JP
- Japan
- Prior art keywords
- parking
- vehicle
- host vehicle
- icon
- image
- 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.)
- Active
Links
Images
Landscapes
- Closed-Circuit Television Systems (AREA)
- Traffic Control Systems (AREA)
Description
本発明は、進入路に沿って縦、若しくは左右横方向に配置された駐車枠に駐車しようとする際に、駐車操作の案内をする駐車支援装置及び駐車支援方法に関する。 The present invention relates to a parking assistance device and a parking assistance method for guiding a parking operation when attempting to park in a parking frame arranged vertically or horizontally in a horizontal direction along an approach path.
駐車枠への駐車を容易とするための駐車支援装置として、従来、特許文献の特許第3632632号公報に開示されたものがある。 Conventionally, as a parking assistance device for facilitating parking in a parking frame, there is one disclosed in Japanese Patent No. 3632632 of Patent Literature.
これは、目標の駐車枠への縦列駐車に際して、まず自車両を目標の駐車枠と平行でかつ目標の駐車枠に隣接する前方の駐車枠の後端ラインに運転席が並ぶ位置に停止させて、この位置を基準位置として互いに外接する円弧を組み合わせた軌跡に沿って設定した第1〜第4位置を経て目標駐車位置へ案内するようにしたものである。
しかしながら、上記従来の装置は駐車案内開始の基準位置を目標の駐車枠と平行でかつ前方の駐車枠の後端ラインに運転席が並ぶ位置に限定しているので、駐車支援がとくに求められる初心者にとっては、この基準位置の条件を満たすこと自体が困難であり、目標駐車位置へ駐車することが難しい。 However, the above-mentioned conventional apparatus limits the reference position for starting the parking guidance to a position parallel to the target parking frame and a position where the driver's seat is lined up on the rear end line of the front parking frame. Therefore, it is difficult to satisfy the condition of the reference position, and it is difficult to park at the target parking position.
したがって本発明は、駐車のため停止する位置が任意位置であっても、容易に目標駐車位置への駐車が可能となる駐車支援装置及び駐車支援方法を提供することを目的とする。 Therefore, an object of this invention is to provide the parking assistance apparatus and parking assistance method which can be easily parked to a target parking position, even if the position stopped for parking is arbitrary positions.
このため本発明は、車両の複数位置に設置されたカメラで自車両周囲を撮像し、その撮像信号をカメラ光軸を路面に垂直にした視点からの画像信号へ変換合成して俯瞰画像を作成し、俯瞰画像における自車両の現在位置に基づく案内指標を設定して、俯瞰画像に案内指標を配置した重畳画像を作成し、この重畳画像を表示手段に表示し、俯瞰画像から駐車枠を検出し、検出された駐車枠と表示手段に表示された自車両アイコンとの接触を判断し、接触の判断結果に基づいて、表示手段に表示される案内指標を表示制御し、駐車枠の枠線と自車両アイコンの一部とが接触したと判断された場合には、駐車枠の枠線と自車両アイコンの一部とが接触したと判断されたときに表示手段に表示されていた重畳画像から自車両前方側の案内指標を削除し、駐車枠の枠線と自車両アイコンの一部とが接触したと判断されたときに表示していた重畳画像から自車両前方側の案内指標が削除された重畳画像を表示手段に表示することを特徴とする。 For this reason, the present invention creates an overhead view image by imaging the surroundings of the host vehicle with cameras installed at a plurality of positions of the vehicle, and converting and synthesizing the imaged signal to an image signal from a viewpoint with the camera optical axis perpendicular to the road surface. Then, setting a guidance index based on the current position of the vehicle in the overhead image, creating a superimposed image in which the guidance index is arranged on the overhead image, displaying the superimposed image on the display means, and detecting a parking frame from the overhead image And determining the contact between the detected parking frame and the vehicle icon displayed on the display means, and controlling the display of the guidance index displayed on the display means based on the contact determination result. and when a part of the vehicle icon is determined to be contacted, borders of the parking frame and a part of the vehicle icon has been displayed on the display means when it is determined that the contact superimposed Delete the guide indicator in front of the vehicle from the image That borders the parking space and a part of the vehicle icon is displayed on the display means a superimposed image in which the guide index from superimposed image displayed vehicle front side is deleted when it is determined that the contact Features.
本発明によれば、自車両周囲を撮像して得られた撮像信号を変換合成して俯瞰画像を作成し、俯瞰画像における自車両の現在位置に基づく案内指標を設定し、俯瞰画像に案内指標を配置して作成された重畳画像を表示することで、運転者は表示された案内指標を参照することで駐車枠への進入位置を容易に把握することができる。 According to the present invention, a bird's-eye view image is created by converting and synthesizing imaging signals obtained by imaging the surroundings of the host vehicle, a guide indicator based on the current position of the host vehicle in the bird's-eye view image is set, and the guide indicator is displayed on the bird's-eye view image. By displaying the superimposed image created by arranging the symbols, the driver can easily grasp the approach position to the parking frame by referring to the displayed guidance index.
以下、本発明の実施の形態を実施例1〜5により詳細に説明する。 Hereinafter, embodiments of the present invention will be described in detail with reference to Examples 1 to 5.
図1は実施例1に係る駐車支援装置1Bの構成を示すブロック図である。
FIG. 1 is a block diagram illustrating a configuration of a
駐車支援装置1Bは、コントロールユニット10Bに対して、カメラ2(2a、2b、2c、2d)、駐車支援起動スイッチ3B、モニタ8、が接続されて構成される。
The
カメラ2は車両の4隅または4辺にそれぞれ設置された複数台からなり、自車両周囲の所定距離範囲、例えば5mの範囲の路面を撮像して、撮像信号をコントロールユニット10Bに出力する。
The
駐車支援起動スイッチ3Bは車室内インストメントパネル(インパネ)、若しくは、ステアリングに設置されており、図2に示すような駐車の方向や方式を運転者が選択できるようになっている。
The parking
図2において、自車両アイコン31は自車両を表し、スイッチノブ32〜36は自車両の方向に対して、いずれの方向の駐車枠へ駐車しようとしているのかを選択するスイッチとなっている。具体的に、スイッチノブ32は自車両の左方向に位置する駐車枠に対して前進して並列駐車を行う場合、スイッチノブ33は自車両の右方向に位置する駐車枠に対して前進して並列駐車を行う場合、スイッチノブ34は自車両の左方向に位置する駐車枠に対して後退して並列駐車を行う場合、スイッチノブ35は自車両の右方向に位置する駐車枠に対して後退して並列駐車を行う場合、スイッチノブ36は自車両の左方向に位置する駐車枠に対して後退して縦列駐車を行う場合に操作する。
In FIG. 2, the
駐車支援起動スイッチ3Bは、駐車支援表示の開始をコントロールユニット10Bへ出力すると共に、描画制御部20Bに運転者に選択された駐車方式を出力する。
The parking
モニタ8は、インストルメントパネルに設置され、コントロールユニット10Bの出力により支援情報を画像表示する。モニタ8としては液晶やCRTなど適宜選択可能である。
The
コントロールユニット10Bは、内部メモリを備えたCPUで構成され、以下の機能部位を有する。
The
すなわち、視点変換部11Bは、カメラ2からの画像信号による画像フレームが、カメラ光軸を路面に垂直にした視点からの画像フレームになるように、画素を並べ替えた画像信号へ変換する。
That is, the
俯瞰画像作成部12Bは、各カメラ2の視点変換された画像信号をもとに画像合成して、自車両の直上から見た自車両周囲の俯瞰画像を作成する。図5に自車両アイコンMcで表される自車両の側方に駐車枠Sを区画する枠線Hがある場合の俯瞰画像例を示す。枠線Hは、駐車枠Sの並びを示す駐車枠線、壁面、あるいは駐車車両の列を象徴化して示している。自車両周囲の俯瞰画像は重畳画像合成部13Bへ送られる。
The bird's-eye view
メモリ29には、モニタ8に表示する自車両アイコンMc、ならびに運転者に駐車を支援する際の案内指標(アイコン)の画像データが格納されている。
The
図3にこれらの画像データに基づく案内指標の一例を示す。 FIG. 3 shows an example of the guidance index based on these image data.
図3(a)は縦列後退駐車用の案内指標で、前部最外周の案内指標44と後部最外周の案内指標46からなり、前部最外周の案内指標44は自車両(自車両アイコンMc)の右側の旋回中心点Pcrを中心(要)として、自車両(自車両アイコンMc)の車体の左前端を通る旋回円軌跡の1/4の円弧を外縁とする扇形状をなしている。後部最外周の案内指標46は、同図に示すように、同じ旋回中心点Pcrを中心(要)として、自車両後端部を通る旋回円軌跡の1/4の円弧を外縁とする扇形状をなしている。
FIG. 3 (a) is a guide index for parallel reverse parking, which is composed of a front outermost
なお、後部最外周の案内指標46は、旋回時の自車両車体後部の通過領域を示すものであるから、その外縁は、前部最外周の案内指標44と同様に車体の左後端を通るものとしてもよいが、ここでは簡単のため左後輪Wlの接地点を通るものとしている。したがって、外縁が旋回外側の後輪の接地点から左後端の間を通る円上の円弧であれば後部最外周の案内指標46として適当である。
The rear
前部最外周の案内指標44と後部最外周の案内指標46は、それぞれ外縁部分が強調されるように、要から外縁へ向かうほどに濃くなるようにグラデーションが施されているとともに、半透明で他の画像の上に重なったときでも当該他の画像も認識可能となるように設定される。
The front
また、上記案内指標44,46は、旋回中心点を右側としているが、左側を旋回中心点Pclとした場合でも、左右を逆にすることで同様に案内指標が設定される。
In addition, although the
図3(b)は並列後退駐車用の案内指標で、同図(a)に示す案内指標に対して、自車両(自車両アイコンMc)の左側の旋回中心点Pclを基準にして後部最内周の案内指標47を追加したものである。後部最内周の案内指標47は、同じ旋回中心点Prlを中心として、自車両後端部を通る旋回円軌跡の1/4の円弧をなしている。
FIG. 3B is a guide index for parallel reverse parking. The guide index shown in FIG. 3A is based on the turning center point Pcl on the left side of the host vehicle (the host vehicle icon Mc) and is located at the innermost rear part. A
なお、後部最内周の案内指標47と後部最外周の案内指標46の外縁で囲まれた領域では、旋回時の自車両車体後部の通過領域を示すものであるから、案内指標47は、前部最外周の案内指標44と同様に車体の右後端を通るものとしてもよいが、ここでは簡単のため左後輪Wlの接地点を通るものとしている。したがって、案内指標47は旋回内側の後輪の接地点から左後端の間を通る円上の円弧であれば後部最内周の案内指標として適当である。
Note that the area surrounded by the outer edges of the rear
後部最内周の案内指標47と後部最外周の案内指標46の外縁で囲まれた領域は、前部最外周の案内指標44や後部最外周の案内指標46と同様に、それぞれ外縁部分が強調されるように、要から外縁へ向かうほどに濃くなるようにグラデーションが施されているとともに、半透明で他の画像の上に重なったときでも当該他の画像も認識可能となるように設定される。
The area surrounded by the outer edges of the rear
図3(b)では自車両の左方向に存在する駐車枠に対して、後退並列駐車を行う場合の案内指標の例を説明したが、駐車支援起動スイッチ3Bで右方向の並列後退駐車が選択された場合には、右側の旋回中心点Pcrを中心(要)として左右方向を反転した案内指標を表示する。
In FIG. 3 (b), an example of the guidance index in the case of performing reverse parallel parking on the parking frame existing in the left direction of the host vehicle has been described, but the parallel reverse parking in the right direction is selected by the parking
図3(c)は並列前進駐車用の案内指標で、最大転舵状態で前進し、自車両の向きが略90°変化するまでの前進自車両軌跡を示すものである。具体的に、案内指標80は自車両の左側の旋回中心点Pclを中心にして自車両外側(右)前端が前進時に描く軌跡を表し、案内指標81は同条件で自車両内側(左)後輪が描く軌跡を表し、案内指標82は自車両が略90°変化するまで前進した時の位置における自車両前部(略自車両大)を表し、案内指標83は案内指標82と同様に前進した時の位置おける自車両の側部(略自車両大)を表し、案内指標84は自車両を表し、案内指標80〜83で囲まれた領域で、外縁部分が強調され、且つ半透明で他の画像の上に重なったときでも当該他の画像も認識可能となるように設定される。
FIG. 3C is a guide index for parallel forward parking, and shows a forward own vehicle trajectory until the vehicle advances in the maximum turning state and the direction of the own vehicle changes by approximately 90 °. Specifically, the
なお、案内指標81は旋回時の自車両車体後部の通過領域を示すものであるから、その外縁は車体端を通るものとしてもよいが、ここでは簡単のため左後輪Wlの接地点を通るものとしている。したがって、外縁が旋回内側の後輪の接地点から左後端の間を通る円上の円弧であれば案内指標として適当である。
Since the
図3(c)では自車両の左方向に存在する駐車枠に対して、前進並列駐車を行う場合の案内指標の例を説明したが、駐車支援起動スイッチ3Bで右方向の並列前進駐車が選択された場合には、右側の旋回中心点Pcrを中心に左右方向を反転した案内指標を表示する。
Although FIG. 3C illustrates an example of the guidance index when performing forward parallel parking with respect to the parking frame existing in the left direction of the host vehicle, the parallel forward parking in the right direction is selected by the parking
図3において、モニタ8の画面に表示される現在旋回中心点(右側はPcr、左側はPcl)の現在旋回中心点アイコンは、点をイメージさせる小径の円形状である。自車両の形状、サイズや上記案内指標のサイズ等は、車両の仕様によって定まる固有のものであるから、各アイコンの画像データは予め設定されてメモリ29に格納されている。
In FIG. 3, the current turning center point icon of the current turning center point (Pcr on the right side and Pcl on the left side) displayed on the screen of the
図1に戻り、描画制御部20Bは、駐車支援起動スイッチ3Bがオンされたときに起動し、運転者によって選択された方式の駐車支援表示用の案内指標をメモリ29に格納された案内指標の画像データの中から呼び出し、重畳画像合成部13Bへ送る。更に、描画制御部20Bは現在旋回中心点Prの情報に基づいて各案内指標の配置を制御する。
Returning to FIG. 1, the
重畳画像合成部13Bは、俯瞰画像作成部12B、描画制御部20Bに接続され、自車両周囲の俯瞰画像上に、上記自車両アイコンMcや案内指標を重ねた重畳画像を作成し、モニタ8に当該重畳画像を表示させる。
The superimposed
図4はコントロールユニット10Bにおける制御処理の流れを示すフローチャートである。図4に示す制御手順は、運転者が駐車枠を視認して任意の位置で停車し、駐車支援起動スイッチ3Bがオンされることにより開始する。最初の停車位置は厳密でなくてよい。
FIG. 4 is a flowchart showing the flow of control processing in the
まず、ステップ300において、カメラ2を撮像開始させ、路面を撮像させる。
First, in
ステップ301では、俯瞰画像作成部12Bが、視点変換部11Bを経た撮像信号(画像信号)をもとに自車両周囲の俯瞰画像を作成する。
In
ステップ302で、現在位置における自車両の最小回転半径に基づくの現在旋回中心点Pcを設定する。
In
ステップ303において、描画制御部20Bがメモリ29から自車両アイコン、運転者のスイッチ操作によって選択された案内指標、現在旋回中心点アイコンの画像データを読み出し、ステップ304において、重畳画像合成部13Bに対して俯瞰画像へのアイコン重畳を行なわせる。
In
これにより、モニタ8には駐車支援のための画像として、自車両周囲の俯瞰画像に自車両等のアイコンが重畳されて表示される。
Thereby, the
ステップ305において、駐車支援起動スイッチ3Bがオフされたか否かを監視し、オフされた場合にはステップ306で自車両アイコン、及び、現在旋回中心点アイコンの表示を消して処理を終了する。一方、ステップ305において、駐車支援起動スイッチ3Bがオフされない場合には処理を継続する。
In
なお、俯瞰画像はカメラ2で撮像した自車両の周囲であるから、モニタ8では自車両アイコンを画面中央に位置させて表示するのが画像処理上は簡便であるが、駐車支援起動スイッチ3Bがオンされた時点で最初に生成される俯瞰画像における駐車枠Sを含む周囲画像を固定し、モニタ画面では相対的に現在位置の自車両アイコンの位置が変化する表示としてもよい。
Since the bird's-eye view image is around the host vehicle imaged by the
図6のモニタ画面に示すように、前部最外周の案内指標44はその扇形状の要を現在位置の自車両アイコンMcの左右後輪(Ml,Mr)の接地点を通る直線K上にある現在旋回中心点Prに一致させ、扇形状の左辺を上記直線Kにそわせて配置される。また、後部最外周の案内指標46は扇形状の要を現在旋回中心点Prに一致させ、扇形状の右辺を上記直線Kにそわせて配置される。前部最外周の案内指標44と後部最外周の案内指標46は半透明であるから、自車両アイコンMcは透過視認できる。
As shown in the monitor screen of FIG. 6, the
次に、各駐車方法についてのアイコンの使い方を説明する。 Next, how to use icons for each parking method will be described.
先ず図5〜図10を参照して、駐車支援起動スイッチ3Bの縦列後退駐車用のスイッチノブ36が操作された場合の使い方を説明する。
First, with reference to FIG. 5 to FIG. 10, how to use the parking assist activation switch 3 </ b> B when the
図5は駐車枠Hに対して、駐車枠Sが存在して(Sは駐車枠線で囲まれた領域でもよいし、又は前後の停車車両間のギャップであってもよい)、該駐車枠Sの手前で自車両(自車両アイコンMc)が、停車している様子を俯瞰画像にして、車室内のモニタ8へ表示したものである。
In FIG. 5, a parking frame S is present with respect to the parking frame H (S may be a region surrounded by a parking frame line or a gap between front and rear stopped vehicles). A state in which the own vehicle (own vehicle icon Mc) stops before S is displayed on the
図6は図5の車両位置において、駐車支援起動スイッチ3Bの縦列後退駐車用のスイッチノブ36を操作した様子を示す。具体的には、自車両アイコンMcに対して、図3(a)で説明した案内指標44,46が付加された状態で、該案内指標44,46は自車両アイコンMc側に固定されるため、以降自車両位置が変化した場合でも、モニタ8内での自車両アイコンMcの位置が変化しない表示方式においては、案内指標の位置も変化しないので、モニタ8内の駐車枠Hや駐車枠S等の撮像側が変化するのみとなる。
FIG. 6 shows a state in which the
図7は図6の位置から前進し、縦列後退駐車を開始する位置へ移動した様子を示す。駐車枠Sの大きさにもよるが、目安として、案内指標の前部と後部との境界(後輪車軸の延長線)が駐車枠Sの上部を越える位置まで前進する。 FIG. 7 shows a state where the vehicle has moved forward from the position of FIG. 6 and moved to a position at which parallel reverse parking is started. Although it depends on the size of the parking frame S, as a guide, the boundary between the front portion and the rear portion of the guide indicator (extension line of the rear wheel axle) moves forward to a position exceeding the upper portion of the parking frame S.
図8は図6の位置から左方向へ最大転舵してから後退した様子を示す。最大転舵後退の目安としては、以降の操作を含めて、前部の案内指標44が駐車枠Sの上部と接触せず、且つ後部の案内指標46が駐車枠Sの左側面と接触しない両条件を満足する位置へ、直進後退で到達可能となる位置(角度)まで後退する。
FIG. 8 shows a state in which the vehicle turns backward from the position shown in FIG. As a guide for the maximum turning backward, including the following operations, the
図9は図8の位置からハンドルを中立位置に戻してから真っ直ぐに後退した様子を示す。 上記図5〜図9においては、真っ直ぐに後退することによって、前部の案内指標44が駐車枠Sの上部と接触しない程度に接近し、且つ後部の案内指標46が駐車枠左側面と接触しない程度に接近する両条件を成立させるよう説明したが、特に真っ直ぐ後退せずとも、図8に示す最大転舵後退で、上記の両条件を満たすことができれば、図7に示す工程は不要となり、省略してもかまわない。
FIG. 9 shows a state in which the handle is returned straight from the position shown in FIG. 8 and then retracted straight. In FIGS. 5 to 9, by moving backward straight, the
図10は図9の位置から右方向へ最大転舵してから後退した様子を示す。最大転舵状態で後退する位置の目安は、自車両と駐車枠Sとの角度が平行で、且つ自車両後部が駐車枠Sの後部からはみ出さない位置である。また、後退する時にも、自車両の最も外周となる左前部の描く軌跡と、後退時の進行方向前側になる左後部(若しくは左後輪部)の軌跡とが、図7に示す状態と同じであるため、図7において駐車枠Sと案内指標44とが接触しない状態であれば、そのまま最大転舵後退しても駐車枠Sと接触することはない。
FIG. 10 shows a state in which the vehicle turns backward from the position shown in FIG. The standard of the position to move backward in the maximum steered state is a position where the angle between the host vehicle and the parking frame S is parallel and the rear part of the host vehicle does not protrude from the rear part of the parking frame S. Further, even when the vehicle is reversing, the locus drawn by the left front portion that is the outermost periphery of the host vehicle and the locus of the left rear portion (or left rear wheel portion) that is the front side in the traveling direction at the time of reversing are the same as the state shown in FIG. Therefore, as long as the parking frame S and the
但し、自車両の後部と駐車枠Sの下部分との接触については、運転者自身が注意して停車位置を決定する必要がある。同様に、駐車枠Sと自車両とが平行になった以降も、更に後退を行った場合も、自車両後部と駐車枠Sの下部分、及び自車両の左前部と駐車枠Sの側面とが接触する可能性もでてくるので、運転者自身による注意が必要である。 However, for the contact between the rear part of the host vehicle and the lower part of the parking frame S, it is necessary for the driver to determine the stop position with caution. Similarly, after the parking frame S and the host vehicle become parallel, when the vehicle further moves backward, the rear portion of the host vehicle and the lower portion of the parking frame S, the left front portion of the host vehicle, and the side surface of the parking frame S Since there is a possibility of contact, it is necessary to be careful by the driver himself.
次に、図11〜図14を参照して、上記と同様に駐車支援起動スイッチ3Bの縦列後退駐車用のスイッチノブ36が操作された場合の他の使い方を説明する。なお、図11は図6、図13は図9、図14は図10と同様なのでその説明は省略する。
Next, with reference to FIGS. 11 to 14, another usage when the
図12は図11に示す車両位置から、先の図5〜図10で説明した直進前進→最大転舵後退のように移動するのではなく、駐車枠Sの手前から一気に図12に示す位置へ、右旋回しながら前進する様子を示す。このように、直進前進→最大転舵後退の二つのタスクを、右旋回しながら前進の一つのタスクに置き換えることができるため、操作の負荷が低減できる。更に、上記で最大転舵後退タスクは特に初心者においては負荷が高く、上手くいかない場合には何度も切り返すといった難易度の高いタスクを、初心者でも容易に行える前進タスクに置き換えられるので、更なる操作負荷の低減を行うことができる。 FIG. 12 does not move from the vehicle position shown in FIG. 11 in the manner of straight forward advancement → maximum steering reverse described in FIGS. 5 to 10 above, but immediately before the parking frame S to the position shown in FIG. , Showing the vehicle moving forward while turning right. In this way, the two tasks of straight forward advance → maximum steering reverse can be replaced with one forward task while turning right, so that the operation load can be reduced. Furthermore, the maximum turning / retracting task described above has a high load especially for beginners, and if it does not work well, it can replace difficult tasks such as turning over many times with forward tasks that even beginners can easily do. The operation load can be reduced.
次に、図15〜図20を参照して、駐車支援起動スイッチ3Bの並列後退駐車用のスイッチノブ34、または35が操作された場合の使い方を説明する。
Next, with reference to FIG. 15 to FIG. 20, how to use the parking assist activation switch 3 </ b> B when the
図15は駐車枠71(駐車枠線で囲まれた領域でもよいし、又は左右の停車車両間のギャップであってもよい)に対して、該駐車枠71の手前で自車両(自車両アイコンMc)が、停車している様子を俯瞰画像にして、車室内のモニタ8に表示したものである。また、立体の障害物70は駐車枠71に対向して存在する立体の障害物で、例えば壁や対向駐車枠に駐車された車両の前端のようなものを表している。
FIG. 15 shows the vehicle (own vehicle icon) in front of the
図16は図15の車両位置において、駐車支援起動スイッチ3Bの並列後退駐車用のスイッチノブ34を操作した様子を示す。具体的には、自車両アイコンMcに対して、図3(b)で説明した案内指標47が付加された状態を示す。
FIG. 16 shows a state in which the switch knob 34 for parallel reverse parking of the parking assist
図17は図16の位置から前進し、並列後退駐車を開始する位置へ移動した様子を示す。駐車枠71と障害物70との距離にもよるが、目安として、前部の案内指標44が障害物70と接触せず、且つ後部の案内指標の旋回内側の案内指標47が駐車枠71の左側に一致する位置まで前進する。
FIG. 17 shows a state where the vehicle has moved forward from the position of FIG. 16 and moved to a position where parallel reverse parking is started. Although it depends on the distance between the
図18〜図19は図17の位置から左方向へ最大転舵してから後退した様子を示す。最大転舵後退の目安としては、自車両と駐車枠71との角度が平行で、且つ自車両後部が駐車枠71からはみ出さない位置である。また、後退する時にも、自車両の最も外周となる右前部の描く軌跡と、後退時の進行方向前側になる左右後部(若しくは左右後輪部)の軌跡とが、図17、図18ならびに図19の状態とで同じであるため、図17において駐車枠71と後部の案内指標46,47とが接触しない状態であれば、そのまま最大転舵後退しても駐車枠71と接触することはない。
18 to 19 show a state in which the vehicle has turned backward from the position shown in FIG. As an indication of the maximum turning backward, the angle between the host vehicle and the
以上は駐車支援起動スイッチ3Bのスイッチノブ34が操作された場合で説明してきたが、図20はスイッチノブ35が操作された場合のアイコン表示を示す。具体的には、スイッチノブ34が操作された時の案内指標に対して、車両前後方向の中心軸を基準にして左右勝手違いである。但し、右方向転舵時の最小回転半径と、左方向転舵時の最小回転半径とが異なる車両については、図3で説明した条件を満足するような旋回方向毎の案内指標を個別に用意する必要がある。
Although the above has been described with respect to the case where the switch knob 34 of the parking
次に、図21〜図26を参照して、駐車支援起動スイッチ3Bの並列前進駐車用のスイッチノブ32,33が操作された場合の使い方を説明する。
Next, with reference to FIG. 21 to FIG. 26, the usage when the switch knobs 32 and 33 for parallel forward parking of the parking
図21は最も端の駐車枠71(駐車枠線で囲まれた領域でもよいし、又は停車車両と障害物間とのギャップであってもよい)に対して、該駐車枠71の手前で自車両(自車両アイコンMc)が、停車している様子を俯瞰画像にして、車室内のモニタ8に表示したものである。また、立体の障害物70は先と同様である。
FIG. 21 shows the
図22は図21の車両位置において、駐車支援起動スイッチ3Bの並列前進駐車用のスイッチノブ32を操作した様子を示す。具体的には、自車両アイコンMcに対して、図3(c)で説明した案内指標が付加された状態である。
FIG. 22 shows a state where the
図23は図22の位置から前進し、並列前進駐車を開始する位置へ移動した様子を示す。駐車枠71と障害物70との距離にもよるが、案内指標の先端部にある略自車大の案内指標82、83が駐車枠71の左右枠線に接触せず、且つ前部の案内指標80が障害物70と接触しない位置まで前進する。
FIG. 23 shows a state where the vehicle has moved forward from the position of FIG. 22 and moved to a position where parallel forward parking is started. Although it depends on the distance between the
図24〜図25は図23の位置から左方向へ最大転舵してから前進した様子を示す。最大転舵前進の目安としては、自車両と駐車枠71との角度が平行になる位置である。即ち、図23で駐車枠71にセットした案内指標の先端部にある略自車大の案内指標82、83の位置に自車両が到達するまでの位置である。
24 to 25 show a state in which the vehicle has advanced from the position shown in FIG. As a guide for the maximum turning forward, it is a position where the angle between the host vehicle and the
また、前進する時にも、自車両の最も外周となる右前部の描く軌跡と、障害物70との位置関係とが、図23、図24ならびに図25の状態とで同じであるため、図23において障害物70と案内指標80とが接触しない状態であれば、そのまま最大転舵前進しても、障害物70と接触することはない。
Further, when moving forward, the locus drawn by the right front portion, which is the outermost periphery of the host vehicle, and the positional relationship with the
以上は駐車支援起動スイッチ3Bのスイッチノブ32が操作された場合で説明してきたが、図26はスイッチノブ33が操作された場合のアイコン表示を示す。具体的には、スイッチノブ32が操作された時の案内指標に対して、車両前後方向の中心軸を基準にして左右勝手違いである。但し、右方向転舵時の最小回転半径と、左方向転舵時の最小回転半径とが異なる車両については、図3で説明した条件を満足するような旋回方向毎の案内指標を個別に用意する必要がある。
Although the above has been described with respect to the case where the
後述する実施例4の図56(a)に示すように、縦列後退駐車用の案内指標では、モニタ8の画面において、駐車枠Sの前端側における枠線Hの角部と前部最外周の案内指標44とが干渉している場合、または自車両が同図(b)に示すように、駐車枠Sの側壁と後部最外周の案内指標46とが干渉しているような場合は、このまま最大転舵状態で後退して枠線Hの角部、若しくは駐車枠Sの側壁と干渉することが把握できるため、両案内指標が接触しないよう再度前進して後退(位置へ切り返し)する。
As shown in FIG. 56A of Example 4 described later, in the guide index for parallel reverse parking, on the screen of the
同様に、図27に示すように、並列後退駐車用の案内指標では、前部の案内指標44が駐車車両(図示せず)、若しくは障害物70に干渉している場合や、後部の案内指標46、47が既駐車車両(図示せず)に干渉したり、駐車枠線を跨いだ状態の場合は、現在位置からでは駐車枠71に収めることができないことを容易に把握することができる。
Similarly, as shown in FIG. 27, in the guide indicator for parallel reverse parking, when the
一方、図28に示す並列前進駐車用の案内指標では、前部の案内指標44が駐車車両(図示せず)、若しくは障害物70に干渉している場合は、現在位置からでは駐車枠71に収めることができないことを容易に把握することができる。
On the other hand, in the guide index for parallel forward parking shown in FIG. 28, when the
上記に説明したように、現在位置からでは他車両や周囲障害物に干渉しないで駐車することができない状態であることが容易に把握できるため、最大転舵を開始する位置をずらし、各案内指標が障害物と干渉しない位置まで移動するように、運転者自身が駐車戦略(駐車の仕方)を変更するようになる。 As explained above, since it is easy to grasp that it is impossible to park without interfering with other vehicles and surrounding obstacles from the current position, the position where the maximum turning is started is shifted, and each guide indicator The driver himself changes the parking strategy (parking method) so that the vehicle moves to a position where the vehicle does not interfere with the obstacle.
本実施例1においては、図4のフローチャートにおけるステップ301が俯瞰画像作成手段を構成し、ステップ303、304が重畳画像合成手段を構成し、モニタ8が表示手段に相当する。
In the first embodiment,
本実施例1は以上のように構成され、カメラ2で撮像した自車両周囲状況を真上から見た俯瞰画像としてモニタ8に表示するとともに、現在位置における自車両Mcの最小回転半径での右側(進入路側)の現在旋回中心点Pcを求め、俯瞰画像にそれぞれ扇形状の要を現在旋回中心点Pcにおいた各案内指標44,46,47,80〜84を駐車方法に応じて適切に選択して俯瞰画像に重畳して表示するので、駐車枠S内まで他との干渉なしに進入可能であるか否かをモニタ8の画面上で容易に確認することができる。これにより、運転者は並列や縦列といった駐車の仕方に応じた適切な案内指標の案内指標を選択して参照することで、運転者は容易に駐車を行うことが可能となる。したがって、本実施例1の装置においては、運転者に対して的確かつ十分に駐車支援を行うことができる。
The first embodiment is configured as described above, and displays the situation around the host vehicle captured by the
次に、本発明の実施例2について説明する。 Next, Example 2 of the present invention will be described.
図29は実施例2に係る駐車支援装置の構成を示すブロック図である。 FIG. 29 is a block diagram illustrating the configuration of the parking assistance apparatus according to the second embodiment.
この実施例2で採用した駐車支援装置1Cのコントロールユニット10Cは、先の実施例1におけるコントロールユニット10Bに対して、駐車枠検出部14、駐車枠接触検出部40、ならびに描画制御部20Bに代えて描画制御部20Cを備えた点が異なる。
The control unit 10C of the parking assist device 1C employed in the second embodiment is replaced with the parking
そして、メモリ29には自車両アイコンMc、実施例1で説明した各種の案内指標(44、46、47、80〜84)に加えて、本実施例2で用いる現在旋回中心点アイコン56の各画像データが格納される。各アイコンの画像データは予め設定されてメモリ29に格納されている。
In addition to the host vehicle icon Mc and the various guidance indicators (44, 46, 47, 80 to 84) described in the first embodiment, the
駐車枠検出部14は、俯瞰画像作成部12Bに接続されて、俯瞰画像を画像処理して枠線Hを抽出して枠線Hで区画される駐車枠Sを検出する。
The parking
駐車枠接触検出部40には、駐車枠検出部14とメモリ29が接続され、駐車枠検出部14で検出された駐車枠Sに、俯瞰画像に表示された自車両アイコンMcの一部が入ったことを検出し、描画制御部20Cへ送信する。
The parking frame
描画制御部20Cは、駐車支援起動スイッチ3Bがオンされたときに起動し、メモリ29に格納された画像データを重畳画像合成部13Bへ送るとともに、その画像データに基づくアイコンの配置を制御する。更に、描画制御部20Cは、駐車枠接触検出部40で自車両アイコンMcと駐車枠Sとの接触が検出された場合には、自車両前方の一部の案内指標をモニタ8の画面表示から削除する。
The drawing control unit 20C is activated when the parking
他の構成は、図1に示した実施例1と同様である。 Other configurations are the same as those of the first embodiment shown in FIG.
図30はコントロールユニット10Cにおける制御処理の流れを示すフローチャートである。 FIG. 30 is a flowchart showing the flow of control processing in the control unit 10C.
まず、ステップ400において、カメラ2を撮像開始させ、路面を撮像させる。
First, in
ステップ401では、俯瞰画像作成部12Bが、視点変換部11Bを経た撮像信号(画像信号)をもとに自車両周囲の俯瞰画像を作成する。
In
ステップ402では、駐車枠検出部14が、俯瞰画像を画像処理して駐車枠Sを検出する。
In
ステップ403では、現在位置における自車両の最小回転半径に基づく右側の現在旋回中心点Prを設定する。
In
ステップ404では、描画制御部20Cがメモリ29から自車両アイコンMc、運転者のスイッチ操作によって選択された案内指標、現在旋回中心点アイコン56の画像データを読み出し、ステップ405において、重畳画像合成部13Bに対して俯瞰画像へのアイコン重畳を行なわせる。これにより、モニタ8には駐車支援のための画像として、自車両周囲の俯瞰画像に自車両等のアイコンが重畳されて表示される。
In
ステップ406では、ステップ402で検出した駐車枠Sと、ステップ405で重畳した自車両アイコンMcとの位置関係を監視し、駐車枠Sの左右線の間に自車両アイコンMcの一部が入った(接触)か否かを判断する。判別の結果、自車両アイコンMcが駐車枠Sと接触した場合には、ステップ407へ進み、接触していない場合にはステップ406を繰り返して両者の接触を監視する。
In
ステップ407では、自車両の一部が駐車枠Sに入っているため、周囲との接触確認が不要となった案内指標(44、若しくは82、83、84)をモニタ8の表示から削除する。
In
ステップ408では、駐車支援起動スイッチ3Bがオフされたか否かを監視し、オフされた場合にはステップ409で自車両アイコンMc、及び現在旋回中心点アイコン56の表示を消して処理を終了する。一方、ステップ408において、駐車支援起動スイッチ3Bがオフされない場合には処理を継続する。
In
次に、図31〜図33を参照して、駐車支援起動スイッチ3Bの並列後退駐車用のスイッチノブ34が操作された場合の使い方を説明する。
Next, with reference to FIG. 31 to FIG. 33, how to use the parking assist
先ず、先の図15〜図17に示すと同様の状態を経た後、図31は自車両の位置から駐車枠検出部14で検出した駐車枠(左右の駐車枠線からなる長方形)と、自車両アイコンMcとが接触した状態を示す。即ち、駐車枠71の左右駐車枠線端を結ぶ直線と、自車両アイコンMcとが接触(若しくは、所定画素数以上が上記直線を超えた)したことを、駐車枠接触検出部40によって検出された状態である。
First, after going through the same state as shown in FIGS. 15 to 17, FIG. 31 shows the parking frame (rectangle formed by the left and right parking frame lines) detected by the parking
図32は図31と同じ自車両位置ではあるが、前部の案内指標44をモニタ表示から消した状態を示す。自車両の後部が左右の駐車枠線間に入ったため、それまで注意していた前部の案内指標44については障害物をパスした状態となる、ゆえに、以降の操作で注意資源を投入すべき個所としての後部の案内指標46に注力させる意味をこめて、前部の案内指標44を表示から消して、後部の案内指標46のみを表示させる。
FIG. 32 shows the same vehicle position as in FIG. 31, but with the
図33は図32の位置から更に後退した状態で駐車枠線と平行になり停車した状態を示す。 FIG. 33 shows a state in which the vehicle further stops from the position of FIG. 32 in parallel with the parking frame line.
次に、図34〜図37を参照して、駐車支援起動スイッチ3Bの並列前進駐車用のスイッチノブ32が操作された場合の使い方を説明する。
Next, with reference to FIG. 34 to FIG. 37, how to use the parking assist
先ず、先の図21〜図23に示すと同様の状態を経た後、図34は図21に示す自車両位置から前進し、駐車枠検出部14で検出した駐車枠(左右の駐車枠線からなる長方形)と、自車両アイコンMcとが接触した状態を示す。即ち、駐車枠71の左右駐車枠線端を結ぶ直線と、自車両アイコンMcとが接触(若しくは、所定画素数以上が上記直線を超えた)したことを、駐車枠接触検出部40によって検出された状態である。
First, after going through the same state as shown in FIGS. 21 to 23, FIG. 34 advances from the own vehicle position shown in FIG. 21, and the parking frame detected by the parking frame detection unit 14 (from the left and right parking frame lines). A rectangle) and the vehicle icon Mc are in contact with each other. That is, the parking frame
図35は図34と同じ自車両位置ではあるが、前部の案内指標82、83、84をモニタ表示から消し、自車両端部の破線で表示された案内指標80、81を実線で表示された案内指標90、91に変更した状態を示す。
FIG. 35 shows the same vehicle position as in FIG. 34, but the
並列前進駐車用の案内指標については、先端部に自車両大の形状があるため、自車両の前進に伴って駐車枠71に設定した自車両大の案内指標82〜84も移動してしまい停車部位がわかりずらくなる。ゆえに、前進時に障害物との接触を確認するための軌跡線となる案内指標90、91はモニタ表示に残して、停車位置がわかりずらくなる原因となる案内指標82〜84をモニタ表示から削除する。
As for the guide indicator for parallel forward parking, since the vehicle has a large shape at the tip, the large
図36、図37は先の図24、図25と同じ自車両位置ではあるが、自車両大の案内指標82〜84を表示しない状態を示す。 FIG. 36 and FIG. 37 show the state where the own vehicle position is not displayed, although the vehicle position is the same as that of FIG. 24 and FIG. 25.
本実施例2は以上のように構成され、カメラ2で撮像した自車両周囲状況を真上から見た俯瞰画像としてモニタ8に表示するとともに、現在位置における自車両の最小回転半径での右側(進入路側)の現在旋回中心点Prを求め、俯瞰画像にそれぞれ扇形状の要を現在旋回中心点Prにおいた各種の案内指標を俯瞰画像に重畳して表示するので、駐車枠S内まで他との干渉なしに進入可能であるか否かをモニタ8の画面上で容易に確認することができる。
The second embodiment is configured as described above, and displays the surrounding situation of the host vehicle captured by the
これにより、運転者は並列や縦列といった駐車の形態に応じた適切な案内指標の案内指標を選択して参照することで、運転者は容易に駐車を行うことが可能となる。したがって、本実施例2の装置においては、運転者に対して的確かつ十分に駐車支援を行うことができる。 Thus, the driver can easily park the vehicle by selecting and referring to an appropriate guide index of the guide index corresponding to the parking mode such as parallel or column. Therefore, in the apparatus according to the second embodiment, parking assistance can be accurately and sufficiently performed for the driver.
また、駐車枠の位置を検出し、自車両アイコンが駐車枠に接触しているか否かを監視することで、駐車枠に自車両が移動する状況を的確かつ詳細に運転者に認知させることが可能となり、駐車支援能力を向上させることができる。 In addition, by detecting the position of the parking frame and monitoring whether or not the own vehicle icon is in contact with the parking frame, it is possible to make the driver recognize the situation where the own vehicle moves to the parking frame accurately and in detail. It becomes possible, and the parking support capability can be improved.
さらに、駐車支援の過程において、不要になった案内指標をモニタ画面から消去することで、運転者の注意をモニタ画面に表示されて今後の駐車支援に有用となる案内指標に集中させることが可能となり、駐車支援能力を向上させることができる。 Furthermore, in the process of parking assistance, by eliminating unnecessary guidance indicators from the monitor screen, it is possible to concentrate the driver's attention on the guidance indicators that are displayed on the monitor screen and are useful for future parking assistance. Thus, the parking support ability can be improved.
次に、本発明の実施例3について説明する。 Next, Embodiment 3 of the present invention will be described.
図38は実施例3に係る駐車支援装置の構成を示すブロック図である。 FIG. 38 is a block diagram illustrating the configuration of the parking assistance apparatus according to the third embodiment.
この実施例3で採用した駐車支援装置1Dのコントロールユニット10Dは、先の実施例1におけるコントロールユニット10Bに対して、舵角センサ4ならびに最大転舵判断部23、ならびに描画制御部20Bに代えて描画制御部20Dを備えた点が異なる。
The
舵角センサ4は不図示のステアリングシャフトに付設されて、ステアリングハンドルの操舵方向と操舵角を検出する。
The
最大転舵判断部23には舵角センサ4が接続され、ハンドルが右、若しくは、左一杯に操舵されたことを検出して、描画制御部20Dへ送信する。
The
描画制御部20Dは、駐車支援起動スイッチ3Bがオンされたときに起動し、メモリ29に格納された画像データを重畳画像合成部13Bへ送るとともに、その画像データに基づくアイコンの配置を制御する。
The drawing control unit 20D is activated when the parking
更に、最大転舵判断部23でハンドルが右、若しくは、左一杯に操舵されたことが検出された場合には、自車両前方の一部の案内指標をモニタ8から消す。
Further, when the maximum
他の構成は、図1に示した実施例1と同様である。 Other configurations are the same as those of the first embodiment shown in FIG.
図39はコントロールユニット10Dにおける制御処理の流れを示すフローチャートである。
FIG. 39 is a flowchart showing the flow of control processing in the
まず、ステップ500において、カメラ2を撮像開始させ、路面を撮像させる。
First, in
ステップ501では、俯瞰画像作成部12Bが、視点変換部11Bを経た撮像信号(画像信号)をもとに自車両周囲の俯瞰画像を作成する。
In
ステップ502では、現在位置における自車両の最小回転半径に基づく右側の現在旋回中心点Prを設定する。
In
ステップ503では、描画制御部20Dがメモリ29から自車両アイコン、運転者のスイッチ操作によって選択された案内指標、現在旋回中心点アイコン56の画像データを読み出し、ステップ504において、重畳画像合成部13Bに対して俯瞰画像へのアイコン重畳を行なわせる。これにより、モニタ8には駐車支援のための画像として、自車両周囲の俯瞰画像に自車両等のアイコンが重畳されて表示される。
In
ステップ505では、最大転舵判断部23が舵角センサ4の出力を監視する。
In
ステップ506では、最大転舵判断部23でハンドルが右、若しくは、左一杯に操舵されたか否かを判断する。判別の結果、最大転舵が検出された場合はステップ507へ進み、最大転舵が検出されない場合には、ステップ506を繰り返し最大転舵に操作されるのを監視する。
In
ステップ507では、駐車したい駐車枠71に設定され、且つそちらへ向けた最大転舵操作が行われた状態であるため、周囲との接触確認が不要となった案内指標(82、83、84)をモニタ表示から消す。
In
ステップ508では、駐車支援起動スイッチ3Bがオフされたか否かを監視し、オフされた場合にはステップ509で自車両アイコンMc、及び現在旋回中心点アイコン56の表示を消して処理を終了する。一方、ステップ508において、駐車支援起動スイッチ3Bがオフされない場合には処理を継続する。
In
次に、図40〜図43を参照して、駐車支援起動スイッチ3Bの並列前進駐車用のスイッチノブ32が操作された場合の使い方を説明する。
Next, with reference to FIGS. 40 to 43, a description will be given of how to use the parking assist
先ず、先の図21〜図22に示すのと同様の状態を経た後、図40は図22で示す位置からハンドルを中立状態に保持したまま前進し、停車した状態を示す。 First, after passing through the same state as shown in FIGS. 21 to 22, FIG. 40 shows a state where the steering wheel is advanced from the position shown in FIG.
図41は図40の車両位置と同じではあるが、図40の位置に停車した状態でハンドルを左いっぱいに切った状態、即ち、舵角センサ4を監視する最大転舵判断部23が最大転舵であることを検出した状態を示す。最大転舵を検出した描画制御部20Dは前部の案内指標の先端部で略自車大の案内指標82、83、84をモニタ表示から消し、自車両端部の案内指標については、破線表示の案内指標80、81を実線表示の案内指標90、91に変更した状態を示す。
41 is the same as the vehicle position shown in FIG. 40, but the steering wheel is turned to the left when the vehicle is stopped at the position shown in FIG. 40, that is, the maximum
並列前進駐車用の案内指標については、先端部に自車両大の形状があるため、自車両の前進に伴って駐車枠に設定した自車両大の案内指標も移動してしまい停車部位がわかりずらくなる。なお、先の実施例2では自車両アイコンMcが駐車枠線間に接触する迄のわずかな間でも自車両大の案内指標が移動し、最終駐車位置を設定したにも関わらず、該目標位置が動いてしまい煩わしかった。 As for the guide indicator for parallel forward parking, the size of the host vehicle is large at the tip, so the guide indicator of the host vehicle size set in the parking frame moves as the host vehicle moves forward, and the stop part is unknown. It becomes easy. In the second embodiment, the target position of the host vehicle is moved even though the host vehicle icon Mc is in contact with the parking frame line and the final parking position is set. Moved and was bothersome.
ゆえに、本実施例3では、前進時に障害物との接触を確認するための案内指標90、91はモニタ表示に残して、停車位置がわかりずらくなる原因となる自車両大の案内指標80〜84をモニタ8の表示画面から削除した。
Therefore, in the third embodiment, the
図42は図36、図43は図37と同様であり、自車両大の案内指標を表示しない状態を示す。 FIG. 42 is the same as FIG. 36 and FIG. 43 is the same as FIG.
本実施例3は以上のように構成され、カメラ2で撮像した自車両周囲状況を真上から見た俯瞰画像としてモニタ8に表示するとともに、現在位置における自車両Mcの最小回転半径での右側(進入路側)の現在旋回中心点Prを求め、俯瞰画像にそれぞれ案内指標を俯瞰画像に重畳して表示するので、駐車枠S内まで他との干渉なしに進入可能であるか否かをモニタ8の画面上で容易に確認することができる。
The third embodiment is configured as described above, and displays the surrounding situation of the host vehicle captured by the
これにより、運転者は並列や縦列といった駐車の形態に応じた適切な案内指標の案内指標を選択して参照することで、運転者は容易に駐車を行うことが可能となる。したがって、本実施例3の装置においては、運転者に対して的確かつ十分に駐車支援を行うことができる。 Thus, the driver can easily park the vehicle by selecting and referring to an appropriate guide index of the guide index corresponding to the parking mode such as parallel or column. Therefore, in the apparatus according to the third embodiment, parking assistance can be accurately and sufficiently performed for the driver.
また、自車両の舵角により最大転舵を判別し、その判別結果に基づいて今後の駐車支援に不要となる案内指標をモニタ画面から削除するようにしたので、モニタ画面に表示されて今後の駐車支援に必要となる案内指標に運転者の注意を集中させることが可能となり、駐車支援能力を向上させることができる。 In addition, the maximum steering is determined based on the steering angle of the vehicle, and the guidance index that is unnecessary for future parking support is deleted from the monitor screen based on the determination result. It is possible to concentrate the driver's attention on the guidance index required for parking support, and the parking support capability can be improved.
次に、本発明の実施例4について説明する。 Next, a fourth embodiment of the present invention will be described.
図44は、実施例4に係る駐車支援装置1の構成を示すブロック図である。
FIG. 44 is a block diagram illustrating the configuration of the
駐車支援装置1は、コントロールユニット10に対して、カメラ2(2a、2b、2c、2d)、駐車支援起動スイッチ3、舵角センサ4、インヒビタスイッチ5、ヨーレートセンサ6、車輪速センサ7、モニタ8、およびスピーカ9が接続されて構成され、特に縦列駐車を支援する。
The
カメラ2は車両の4隅または4辺にそれぞれ設置された複数台からなり、自車両周囲の所定距離範囲、例えば5mの範囲の路面を撮像して、撮像信号をコントロールユニット10へ出力する。
The
舵角センサ4は不図示のステアリングシャフトに付設されて、ステアリングハンドルの操舵方向と操舵角を検出する。
The
インヒビタスイッチ5は不図示のシフトレバーの操作に連動して、シフトポジションを検出する。
The
ヨーレートセンサ6は自車両が旋回するときの車両前後方向軸の角度変化速度を検出する。 The yaw rate sensor 6 detects the angle change speed of the vehicle longitudinal axis when the host vehicle turns.
車輪速センサ7は車輪あるいはプロペラシャフト周辺に設置されて、車輪回転速度を検出するが、その出力を基に自車両の前進、後退の別、および進行距離を求めることができる。 The wheel speed sensor 7 is installed around the wheel or the propeller shaft and detects the wheel rotation speed. Based on the output of the wheel speed sensor 7, it is possible to determine whether the host vehicle is moving forward or backward, and the traveling distance.
モニタ8は、インストルメントパネルに設置され、スピーカ9は車室内に設置されて、それぞれコントロールユニット10の出力により支援情報を画像表示、音声出力する。モニタ8としては液晶やCRTなど適宜選択可能である。
The
コントロールユニット10は、内部メモリを備えたCPUで構成され、以下の機能部位を有する。
The
すなわち、視点変換部11は、カメラ2からの画像信号による画像フレームが、カメラ光軸を路面に垂直にした視点からの画像フレームになるように、画素を並べ替えた画像信号へ変換する。
That is, the
俯瞰画像作成部12は各カメラ2の視点変換された画像信号をもとに画像合成して、自車両の直上から見た自車両周囲の俯瞰画像を作成する。
The bird's-eye view
図45は自車両の側方に駐車枠Sを区画する枠線Hがある場合の俯瞰画像例を示す。 FIG. 45 shows an example of an overhead image when there is a frame line H that partitions the parking frame S on the side of the host vehicle.
なお、本実施例4は、自車両の進行方向に対して左側の駐車枠に駐車しようとする場合について説明する。 In addition, the present Example 4 demonstrates the case where it is going to park in the left parking frame with respect to the advancing direction of the own vehicle.
枠線Hは、駐車枠Sの並びを示す駐車枠線、壁面、あるいは駐車車両の列を象徴化して示している。破線で示した領域は自車両の位置であり、ここには後述する自車両アイコンが重畳される。 The frame line H symbolizes and shows the parking frame line which shows the arrangement of the parking frames S, the wall surface, or the row | line | column of a parked vehicle. A region indicated by a broken line is a position of the host vehicle, and a host vehicle icon to be described later is superimposed thereon.
自車両周囲の俯瞰画像は重畳画像合成部13へ送られる。
The bird's-eye view image around the host vehicle is sent to the superimposed
俯瞰画像作成部12には駐車枠検出部14が接続され、俯瞰画像を画像処理して枠線Hを抽出し、枠線Hで区画される駐車枠Sを検出する。
A parking
駐車位置設定部15は、検出された駐車枠S内に自車両が最終的に位置すべき最終駐車位置を設定する。ここで最終駐車位置は、自車両の車両前後方向軸を基準にして、車体後端を駐車枠の後端から例えば10〜20cmに位置させ、車両前後方向軸を駐車枠Sの幅中央に位置させるように設定される。
The parking
最終旋回中心設定部16は、図46に示すように駐車枠Sに最終的に位置したときの、すなわち最終駐車位置の自車両(Mf)の最小回転半径に基づく最終旋回中心点Pfを設定する。最終旋回中心点Pfは自車両の後輪アクスルの延長線上に位置し、路面上では、左右の後輪Wl、Wrの接地点を通る直線上に位置する。
46, the final turning
俯瞰画像作成部12にはさらに、自車位置検出部17を経て旋回中心検出部18が接続されている。
Further, a turning
自車両の現在位置は俯瞰画像の基準位置であるが、最終旋回中心点を基準としたときの移動する自車両およびその現在旋回中心点の位置を定めるため、自車位置検出部17は俯
瞰画像上の最終旋回中心点に対する自車両の相対的な位置を検出する。
Although the current position of the host vehicle is the reference position of the overhead view image, the host vehicle
旋回中心検出部18は、図46に示すように、現在位置における自車両(Mc)の最小回転半径に基づく右側の現在旋回中心点Pcrを検出する。
As shown in FIG. 46, the turning
現在旋回中心点Pcrも自車両の左右後輪の接地点を通る直線上に位置する。 The current turning center point Pcr is also located on a straight line passing through the ground contact points of the left and right rear wheels of the host vehicle.
旋回角度演算部19は最終旋回中心点Pfと現在旋回中心点Pcrの情報を描画制御部20へ転送するとともに、図46に示すように、最終旋回中心点Pfと現在旋回中心点Pcrを結ぶ直線50’を演算し、その直線50’と現在位置における自車両の車両前後方向軸CLとの角度差αを求めてヨー角変化監視部21へ出力する。
The turning
メモリ29には、モニタ8に表示する自車両、自車両の車両前後方向軸線、前部最外周のシールドおよび後部最外周のシールド、最終旋回中心点と現在旋回中心点の各アイコンの画像データが格納されている。
The
図47にこれらの画像データに基づくアイコン例を示す。 FIG. 47 shows an example of icons based on these image data.
車両前後方向軸線アイコン51は、(a)に示すように、自車両Mの車幅中央位置を通る直線である。
The vehicle
前部最外周の案内指標44は、(b)に示すように、自車両の右側の旋回中心点prを中心(要)として、自車両Mの車体の左前端を通る旋回円軌跡の1/4の円弧を外縁とする扇形状をなしている。
As shown in (b), the front
後部最外周の案内指標46は、(c)に示すように、同じ旋回中心点prを中心(要)として、自車両後端部を通る旋回円軌跡の1/4の円弧を外縁とする扇形状をなしている。
As shown in (c), the rear outermost
なお、後部最外周の案内指標46は旋回時の自車両車体後部の通過領域を示すものであるから、その外縁は、前部最外周の案内指標44と同様に車体の左後端を通るものとしてもよいが、ここでは簡単のため左後輪Wlの接地点を通るものとしている。したがって、外縁が旋回外側の後輪の接地点から左後端の間を通る円上の円弧であれば後部最外周の案内指標として適当である。
Since the rear
前部最外周の案内指標44と後部最外周の案内指標46は、それぞれ外縁部分が強調されるように、要から外縁へ向かうほどに濃くなるようにグラデーションが施されているとともに、半透明で他の画像の上に重なったときでも当該他の画像も認識可能となるように設定される。
The front
最終旋回中心点アイコン54と現在旋回中心点アイコン56(図51参照)は、それぞれ点をイメージさせる小径の円形状である。
The final turning
自車両の形状、サイズや上記案内指標のサイズ等は、車両の仕様によって定まる固有のものであるから、各アイコンの画像データは予め設定されてメモリ29に格納されている。
Since the shape and size of the host vehicle, the size of the guidance indicator, and the like are unique depending on the specifications of the vehicle, the image data of each icon is set in advance and stored in the
図44に戻り、描画制御部20は、駐車支援起動スイッチ3がオンされたときに起動し、メモリ29に格納されたアイコンの画像データを重畳画像合成部13へ送るとともに、旋回角度演算部19を経て入力される最終旋回中心点と現在旋回中心点の情報に基づいて各アイコンの配置を制御する。
Returning to FIG. 44, the
重畳画像合成部13は、俯瞰画像作成部12、描画制御部20および後述のメッセージ制御部30に接続され、自車両周囲の俯瞰画像上に、上記自車両アイコンや案内指標、および後述の支援メッセージを重ねた重畳画像を作成し、モニタ8に当該重畳画像を表示させる。
The superimposed
ヨー角変化監視部21は、ヨーレートセンサ6および車輪速センサ7からの出力に基づいて、旋回角度演算部19で求められた直線50’と自車両の車両前後方向軸CLとの角度関係を監視し、自車両の移動に伴って重畳画像における上記直線50’と車両前後方向軸CLの角度が一致するタイミングを監視する。
The yaw angle
アイコン状態判断部22は、重畳画像において最終旋回中心点Pfに配置された最終旋回中心点アイコン54と現在旋回中心点Pcrに配置された現在旋回中心点アイコン56が重なったかどうか、最終駐車位置の自車両アイコンMfに現在位置の自車両アイコンMcが重なったかどうかを判断する。アイコン状態判断部22はまた、所定のタイミングで前部最外周のシールドおよび後部最外周の案内指標44、46と枠線Hとの接触状態を判断する。
The icon
ヨー角変化監視部21およびアイコン状態判断部22における監視、判断検出結果はメッセージ制御部30へ送られる。
The monitoring and determination detection results in the yaw angle
最大転舵判断部23は、舵角センサ4の出力を監視し、自車両が最大転舵状態、すなわち最小回転半径で前進または後退可能になった状態とその転舵方向を判断して、メッセージ制御部30へ判断結果を送る。
The maximum
メッセージ制御部30は、ヨー角変化監視部21による角度関係、アイコン状態判断部22によるアイコン状態、最大転舵判断部23による最大転舵状態か否か、およびインヒビタスイッチ5からのシフトポジション等に基づいて、所定のタイミングで、重畳画像合成部13へ支援情報としての支援メッセージを送り、モニタ8の画像に支援メッセージを重畳表示させる。メッセージ制御部30はまた音声提示に適した支援メッセージをスピーカ9に送って音声出力させる。
The
なお、支援メッセージは本実施の形態を通じて、以下、単にメッセージと略称する。 In the following description, the support message is simply referred to as a message throughout the present embodiment.
図48、図49、図50はコントロールユニット10における制御処理の流れを示すフローチャートである。
48, 49 and 50 are flowcharts showing the flow of control processing in the
制御は、運転者が駐車枠を視認して車両後部が駐車枠の前端付近になる位置で停車し、駐車支援起動スイッチ3がオンされることにより開始する。最初の停車位置は厳密でなくてよい。 The control is started when the driver visually recognizes the parking frame, stops at a position where the rear portion of the vehicle is near the front end of the parking frame, and the parking assist activation switch 3 is turned on. The initial stop position need not be exact.
まず、ステップ100において、カメラ2を撮像開始させ、路面を撮像させる。
First, in
ステップ101では、俯瞰画像作成部12が、視点変換部11を経た撮像信号(画像信号)をもとに自車両周囲の俯瞰画像を作成する。
In
ステップ102では、駐車枠検出部14が、俯瞰画像を画像処理して駐車枠Sを検出する。
In
続いて、ステップ103において、駐車位置設定部15が駐車枠Sにおける最終駐車位置を設定する。
Subsequently, in
そして、ステップ104において、最終旋回中心設定部16が、検出された駐車枠Sにおける最終駐車位置での最小回転半径に基づく車両の右側(進入路側)の最終旋回中心点Pfを設定する。
In
ステップ105において、自車位置検出部が最終旋回中心点Pfに対する自車両の位置を検出して、ステップ106で、旋回中心検出部18が現在位置における自車両の最小回転半径に基づく右側の現在旋回中心点Pcrを設定する。
In
ステップ107では、旋回角度演算部19が、先の図46に示すように、最終旋回中心点Pfと現在旋回中心点Pcrを通る直線50’を演算し、現在位置における自車両の車両前後方向軸CLとの角度差αを算出する。なお、図46には理解を容易にするためアイコンと同形状の自車両(Mc)を示している。
In
ステップ108において、描画制御部20がメモリ29から自車両アイコン、車両前後方向軸線アイコン、最終旋回中心点アイコンと現在旋回中心点アイコンの画像データを読み出し、ステップ109において、重畳画像合成部13に対して俯瞰画像へのアイコン重畳を行なわせる。また、最終旋回中心点Pfと現在旋回中心点Pcrの間を結ぶガイド直線50を重畳させる。これにより、モニタ8には駐車支援のための画像として、自車両周囲の俯瞰画像に自車両等のアイコンが重畳されて表示される。
In step 108, the
図51は、このときのモニタ8の画面表示を示す。
FIG. 51 shows a screen display of the
すなわち、枠線Hで区画された駐車枠Sを示す俯瞰画像において、実線で示すように現在位置での自車両アイコンMcが表示されるとともに、駐車枠Sの最終駐車位置に位置したとしたときの自車両アイコンMfが破線で表示される。 That is, in the bird's-eye view image showing the parking frame S partitioned by the frame line H, the vehicle icon Mc at the current position is displayed as shown by the solid line, and the vehicle is positioned at the final parking position of the parking frame S. The own vehicle icon Mf is displayed with a broken line.
現在位置での自車両アイコンMcには車両前後方向軸線アイコン51が重ねられる。
A vehicle
なお、最終駐車位置に位置する自車両アイコンMfは図示の破線のほか、細線あるいは低濃度で現在位置での自車両アイコンMcと識別可能に表示されてもよい。 The host vehicle icon Mf located at the final parking position may be displayed in a thin line or at a low concentration so as to be distinguishable from the host vehicle icon Mc at the current position in addition to the illustrated broken line.
そして、現在位置での自車両アイコンMcの最小回転半径での右側の現在旋回中心点Pcrに現在旋回中心点アイコン56が表示されるとともに、最終駐車位置に位置したとしたときの自車両アイコンMfの最小回転半径での右側の最終旋回中心点Pfに最終旋回中心点アイコン54が表示され、現在旋回中心点アイコン56と最終旋回中心点アイコン54間がガイド直線50で結ばれている。
Then, the current turning
なお、旋回中心点アイコン54、56を自車両アイコンMf、Mcの後輪に図示のように破線等でつなぐと、旋回中心点であることがわかりやすい。
If the turning
続くステップ110において、メッセージ制御部30が「停止してください」との音声メッセージをスピーカ9から出力させる。また、音声メッセージと同時に、重畳画像合成部13を介して同趣旨の文字メッセージをモニタ8の画面に表示させる。
In
なお、以下では、メッセージの出力先であるモニタ8とスピーカ9についてはとくに個別に言及せず、単に「メッセージを出力させる」旨、簡単に記載する。
In the following description, the
ステップ111では、ヨー角変化監視部21が、車輪速センサ7の出力をチェックして、自車両が停止していることを確認すると、その旨をメッセージ制御部30へ通知する。
In
ヨー角変化監視部21はこの時点において旋回角度演算部19で算出された直線50’と車両前後方向軸CLとの角度差αを保持する。
The yaw angle
ステップ112において、メッセージ制御部30が、ステップ110で出力させたメッセージを消し、「右いっぱいにハンドルを切ってください」など、右最大転舵を行なうべき旨のメッセージを出力させる。
In
ステップ113において、メッセージ制御部30は最大転舵判断部23からの出力により自車両が左方向の最大転舵状態になっているかどうかをチェックする。
In
上記チェックを繰り返して、最大転舵状態になると、ステップ114へ進んで、メッセージ制御部30は、先のメッセージをモニタ8から消して、「前進してください」のメッセージを出力させる。
When the above check is repeated and the maximum steering state is reached, the process proceeds to step 114 where the
これらメッセージを受けて運転者は右最大転舵で自車両を前進させる。運転者は、モニタ画面において、自車両の車両前後方向軸線アイコン51の向きが現在旋回中心点アイコン56と最終旋回中心点アイコン54間のガイド直線50に近づいていくのを確認することができる。
In response to these messages, the driver moves his vehicle forward with maximum right steering. On the monitor screen, the driver can confirm that the direction of the vehicle
ステップ115において、ヨー角変化監視部21は、ヨーレートセンサ6から出力される角速度を時間積分して自車両の車両前後方向軸CLの角度変化量を求め、その角度変化
量が自車両が停止しているときに保持した角度差αに至った(現在位置での角度差=0)かどうかをチェックする。
In
前進による角度変化量が上記角度差に至るまで上記チェックを繰り返し、角度変化量が角度差に一致したときに、ステップ116へ進む。 The above check is repeated until the angle change amount due to the forward movement reaches the angle difference. When the angle change amount matches the angle difference, the process proceeds to step 116.
このときのモニタ画面の表示は図52に示すようになる。 The display on the monitor screen at this time is as shown in FIG.
なお、俯瞰画像はカメラ2で撮像した自車両の周囲であるから、モニタ8では自車両アイコンMcを画面中央に位置させて表示するのが画像処理上は簡便であるが、駐車支援起動スイッチ3がオンされた時点で最初に生成される俯瞰画像における駐車枠Sを含む周囲画像を固定し、モニタ画面では相対的に現在位置の自車両アイコンMcの位置が変化する表示としてもよい。
Since the bird's-eye view image is around the host vehicle imaged by the
図52では、図51のモニタ画面に対して理解を容易とするため周囲画像を固定して示している。実施の形態を通じて、以下同様である。 In FIG. 52, the surrounding image is shown fixed for easy understanding on the monitor screen of FIG. The same applies throughout the embodiments.
ステップ116では、メッセージ制御部30が、ステップ113で出力させたメッセージを消し、「停止してください」のメッセージを出力させる。
In step 116, the
次のステップ117において、ヨー角変化監視部21が、車輪速センサ7の出力をチェックして、自車両が停止していることを確認すると、その旨をメッセージ制御部30へ通知する。
In the
これに応じて、ステップ118では、メッセージ制御部30が、ステップ116で出力させたメッセージを消し、「ハンドルを中立位置にして後退してください」など、中立転舵後後退すべき旨のメッセージを出力させる。
In response to this, in
この際、モニタ8の画面に重畳表示されたガイド直線50は後退方向の指標となる。
At this time, the guide
ステップ119において、メッセージ制御部30は、インヒビタスイッチ5の出力からRレンジ(後退)のシフトポジションが選択されたかどうかをチェックする。
In
Rレンジが選択されて自車両が後退すると、図53に示すように、現在旋回中心点Pcrは最終旋回中心点Pfに近づいてゆき、最終旋回中心点Pf(最終旋回中心点アイコン54)と現在旋回中心点Pcr(現在旋回中心点アイコン56)を結ぶガイド直線50は俯瞰画像上において短くなっていく。
When the R range is selected and the host vehicle moves backward, as shown in FIG. 53, the current turning center point Pcr approaches the final turning center point Pf, and the final turning center point Pf (final turning center point icon 54) and the current turning center point Pf. The guide
上記チェックを繰り返して、Rレンジの選択状態になると、ステップ120へ進み、メッセージ制御部30は、アイコン状態判断部22の出力により、重畳画像における現在旋回中心点アイコン56が最終旋回中心点アイコン54に重なったかをチェックする。
When the above check is repeated and the R range is selected, the process proceeds to step 120, and the
現在旋回中心点アイコン56と最終旋回中心点アイコン54が重なれば、現在旋回中心点Pcrと最終旋回中心点Pfが重なったことを意味し、この位置からは最終旋回中心点Pfまわりに最小回転半径で旋回すれば最終駐車位置へ到達可能となる。
If the current turning
現在旋回中心点アイコン56が最終旋回中心点アイコン54に重なるまで上記のチェックを繰り返し、図54に示すように両アイコンが重なると、ステップ121において、メッセージ制御部30は、ステップ118で出力させたメッセージを消し、「停止してください」のメッセージを出力させる。
The above check is repeated until the current turning
また、ステップ122では、描画制御部20が、上記両アイコン54、56が重なった旨のアイコン状態判断部22からの出力に応じて、車両前後方向軸線アイコン51と最終旋回中心点アイコン54の表示を消す。なお、両アイコンが重なった時点において、ガイド直線50も消えている。
In
続いてステップ123において、描画制御部20はメモリ29から前部最外周の案内指標44と後部最外周の案内指標46の画像データを読み出し、ステップ124において、駐車枠S周囲との干渉有無の確認のため、重畳画像合成部13に対して俯瞰画像へのアイコン重畳を行なわせる。
Subsequently, in
ここでは、図55のモニタ画面に示すように、前部最外周の案内指標44はその扇形状の要を現在位置の自車両アイコンMcの左右後輪の接地点を通る直線K上にある現在旋回中心点Pcrに一致させ、扇形状の左辺を上記直線Kにそわせて配置される。また、後部最外周の案内指標46は扇形状の要を現在旋回中心点Pcrに一致させ、扇形状の右辺を上記直線Kにそわせて配置される。
Here, as shown in the monitor screen of FIG. 55, the front outermost
前部最外周の案内指標44と後部最外周の案内指標46は半透明であるから、自車両アイコンMc、Mfは透過視認できる。
Since the front outermost
つぎのステップ125では、アイコン状態判断部22が、駐車枠Sを区画する枠線Hと前部最外周の案内指標44または後部最外周の案内指標46とが干渉する(重なる)かどうかを判断し、判断結果をメッセージ制御部30へ出力する。
In the
図56の(a)に示すように、モニタ画面において、駐車枠Sの前端側における枠線Hの角部と前部最外周の案内指標44とが干渉している場合、または自車両Mcがガイド直線50と平行に移動しなかったなどの原因で、現在旋回中心点アイコン56と最終旋回中心点アイコン54とは重なったが、現在旋回中心点Pcrが最終旋回中心点Pfからずれて、(b)に示すように、駐車枠Sの側壁と後部最外周の案内指標46とが干渉しているような場合は、ステップ134へ進んで、メッセージ制御部30は、ステップ121で出力させたメッセージを消して、「この駐車枠には駐車案内できません」など、駐車案内不可のメッセージを出力させる。
As shown to (a) of FIG. 56, when the corner | angular part of the frame line H in the front end side of the parking frame S interferes with the guidance parameter |
このあとは後述するステップ135へ進む。 Thereafter, the process proceeds to Step 135 described later.
一方、ステップ125の判断において、図55のように、前部最外周の案内指標44および後部最外周の案内指標46のいずれも枠線Hと干渉しない場合は、ステップ126へ進む。
On the other hand, if it is determined in
ステップ126では、メッセージ制御部30が、ステップ121で出力させたメッセージを消して、「右いっぱいにハンドルを切ってください」など、右最大転舵を行なうべき旨のメッセージを出力させる。
In
ステップ127において、メッセージ制御部30は、最大転舵判断部23からの出力により自車両が右方向の最大転舵状態になっているかどうかをチェックする。
In
上記チェックを繰り返して、最大転舵状態になると、ステップ128へ進んで、メッセージ制御部30は、ステップ126で出力させたメッセージをモニタ8から消して、「後退してください」のメッセージを出力させる。併せて、ステップ129において、メッセージ制御部30からの指示に基づいて、描画制御部20が重畳画像合成部13に対して、前部最外周の案内指標44と後部最外周の案内指標46の表示を消させる。
When the above check is repeated and the maximum turning state is reached, the process proceeds to step 128 where the
ステップ130では、メッセージ制御部30は、あらためてインヒビタスイッチ5の出力からRレンジ(後退)のシフトポジションが選択されたかどうかをチェックする。
In
Rレンジが選択されて後退していくと、自車両は駐車枠S内の最終駐車位置へ近づいていくことになる。 When the R range is selected and the vehicle moves backward, the host vehicle approaches the final parking position in the parking frame S.
上記チェックを繰り返して、Rレンジの選択状態になったあと、ステップ131では、メッセージ制御部30はアイコン状態判断部22の出力により、自車両が最終駐車位置に位置したかどうかをチェックする。
After the above check is repeated and the R range is selected, in
後退に伴って、モニタ8には駐車枠S内へ進入していく自車両アイコンMcが表示されるので、運転者は、図57に示すように、駐車枠S内に位置した破線の自車両アイコンMfに実線の自車両アイコンMcが重なったモニタ表示からも、駐車枠Sの最終駐車位置に到達したことを知ることができる。
Since the host vehicle icon Mc entering the parking frame S is displayed on the
自車両が最終駐車位置に到達すると、ステップ132において、メッセージ制御部30は、ステップ128で出力させたメッセージをモニタ8から消して、「駐車が完了しました」のメッセージを出力させる。
When the host vehicle reaches the final parking position, in
このとき、さらに自車両アイコンMcの表示色を変えたり、あるいは点滅させてもよい。 At this time, the display color of the host vehicle icon Mc may be changed or blinked.
このあと、ステップ133へ進んで、こんどはPレンジ(パーキング)のシフトポジションが選択されたかどうかをチェックする。これは、運転者が車両停止させたことを確認するものである。 Thereafter, the routine proceeds to step 133, where it is checked whether or not the shift position of the P range (parking) has been selected. This confirms that the driver has stopped the vehicle.
Pレンジ選択状態になるまでステップ133を繰り返したあと、ステップ135において、メッセージ制御部30が、重畳画像合成部13を制御して、モニタ8の全表示を消して処理を終了する。
After
また上記フローのどの段階でも駐車支援起動スイッチ3がオフされると処理は中止され、駐車支援の制御は終了する。 Further, when the parking assistance activation switch 3 is turned off at any stage of the above flow, the processing is stopped and the parking assistance control is ended.
本実施例4おいては、図48〜図50のフローチャートにおけるステップ101が発明における俯瞰画像作成手段を構成し、ステップ102が駐車枠検出手段を、ステップ103が最終駐車位置設定手段を、ステップ104が第1旋回点設定手段を、ステップ105が現在位置検出手段を、そしてステップ106が第2旋回点設定手段を構成している。
In the fourth embodiment,
最終旋回中心点が第1の旋回点に該当し、現在旋回中心点が第2の旋回点に該当する。 The final turning center point corresponds to the first turning point, and the current turning center point corresponds to the second turning point.
ガイド直線50が第1の旋回点と第2の旋回点を通る直線に該当し、車両前後方向軸線アイコン51が車両前後方向軸を示す画像に該当する。
The guide
また、ステップ108、109、122〜124、129が重畳画像合成手段を構成し、ステップ107が角度差演算手段を、ステップ115がヨー角変化監視手段を、ステップ120が旋回点状態判断手段を、そしてステップ110〜114、116〜118、121、126〜128、130〜132、134が支援情報制御手段を構成している。
モニタ8とスピーカ9がメッセージ提示手段に該当する。
The
本実施例4は以上のように構成され、カメラ2で撮像した自車両周囲状況を真上から見た俯瞰画像としてモニタ8に表示するとともに、俯瞰画像から検出した駐車枠S内に自車両が最終的に位置すべき最終駐車位置を設定して、最終駐車位置における自車両Mfの最小回転半径での右側(進入路側)の最終旋回中心点Pfを求め、また現在位置における自車両Mcの最小回転半径での右側(進入路側)の現在旋回中心点Pcrを求め、俯瞰画像に最終旋回中心点Pfと現在旋回中心点Pcrを結ぶガイド直線50を重畳合成するものとしたので、運転者はモニタ画面のガイド直線50を参照して、駐車枠Sへの進入角度を容易に把握することができる。
The fourth embodiment is configured as described above, and displays the situation around the host vehicle captured by the
また、自車両Mcの車両前後方向軸線アイコン51も俯瞰画像に重畳させることにより、車両前後方向軸線アイコン51を参照して自車両をガイド直線50と平行にもっていく操作が容易となり、駐車枠Sへ向かう間の方向保持の確認も容易となる。
Further, by superimposing the vehicle
とくに、自車両の車両前後方向軸CL(車両前後方向軸線アイコン51)と直線50’(ガイド直線50)が平行になった位置において、中立転舵のうえ後退させるメッセージを出力するので、転舵のタイミングがいっそう正確となる。
In particular, in a position where the vehicle longitudinal axis CL (vehicle longitudinal axis icon 51) and the
また、その後、最終旋回中心点アイコン54と現在旋回中心点アイコン56が重なった位置において、現在旋回中心点Pcrを旋回中心とする方向に最大転舵のうえ後退させる旨の支援メッセージを出力するので、最終段階移動として、最小回転半径で最終駐車位置へ到達することができる。
In addition, after that, at the position where the final turning
さらに、最終旋回中心点アイコン54と現在旋回中心点アイコン56が重なったときに、最終駐車位置への最終段階移動開始の後退をさせる前、すなわち最大転舵のうえ後退させるメッセージを出力する前に、それぞれ扇形状の要を現在旋回中心点Pcrにおいた前部最外周の案内指標44と後部最外周の案内指標46を俯瞰画像に重畳して表示するので、駐車枠S内の最終駐車位置まで他との干渉なしに進入可能であるかをモニタ画面上で容易に確認することができる。
Further, when the final turning
なお、俯瞰画像に重畳されるガイド直線50は最終旋回中心点アイコン54と現在旋回中心点アイコン56の間を結ぶものとしたが、これに限定されず、適宜両方向に延ばしてもよい。
In addition, although the guide
車両前後方向軸線アイコン51の長さも同様に任意に設定してよい。
Similarly, the length of the vehicle
また、制御フローのステップ120では、現在旋回中心点Pcrと最終旋回中心点Pfが重なったことを、現在旋回中心点アイコン56と最終旋回中心点アイコン54の重なりを判断するアイコン状態判断部22の出力によりチェックするものとしたが、アイコンの重なりではなく、旋回角度演算部19を介して得られる現在旋回中心点Pcrと最終旋回中心点Pfの直接情報を用いてこれらの旋回中心点が一致するタイミングを判断するようにしてもよい。
In
次に、本発明の実施例5について説明する。 Next, a fifth embodiment of the present invention will be described.
図58は、実施例5に係る駐車支援装置の構成を示すブロック図である。 FIG. 58 is a block diagram illustrating the configuration of the parking assistance apparatus according to the fifth embodiment.
駐車支援装置1Aのコントロールユニット10Aは、先の実施例4におけるコントロールユニット10に対して、旋回中心検出部18、描画制御部20、ヨー角変化監視部21、アイコン状態判断部22、メッセージ制御部30の代わりに、それぞれ旋回中心検出部18A、描画制御部20A、ヨー角変化監視部21A、アイコン状態判断部22A、メッセージ制御部30Aを備える点が異なる。
The
さらに、旋回角度演算部19の代わりに進入角度演算部26を備え、最終旋回中心設定部16と進入角度演算部26の間に接線演算部25、旋回中心検出部18Aと接線演算部25の間に円弧設定部24を有している。
Further, an approach
そして、メモリ29には第1の実施例におけると同じ自車両アイコンMc、Mf、前部最外周の案内指標44および後部最外周の案内指標46、車両前後方向軸線アイコン51、最終旋回中心点アイコン54および現在旋回中心点アイコン56と、さらに円弧アイコン60の各画像データが格納される。
In the
各アイコンの画像データは予め設定されてメモリ29に格納されている。
The image data of each icon is set in advance and stored in the
描画制御部20Aは、駐車支援起動スイッチ3がオンされたときに起動し、メモリ29に格納された画像データを重畳画像合成部13へ送るとともに、その画像データに基づくアイコンの配置を制御する。
The
また、旋回中心検出部18Aは、現在位置での左右の現在旋回中心点PclとPcrを検出する。
Further, the turning
円弧設定部24は、図59に示すように、自車両(Mc)の最小回転半径に基づく左側(駐車枠側)の現在旋回中心点Pclと右側(進入路側)の現在旋回中心点Pcr間の距離を半径とする円の1/2の円弧60’を設定するもので、左側の現在旋回中心点Pclを中心とした右側の現在旋回中心点Pcrの旋回軌跡を表わしている。円弧設定部24は円弧60’が現在旋回中心点Pcrを始点として後方へ延びるように設定する。
As shown in FIG. 59, the
メモリ29に画像データが格納される円弧アイコン60はこの円弧60’に対応するものである。
An
接線演算部25は、最終旋回中心点Pfを通り円弧60’に接する接線52’を演算し、当該接線52’と円弧60’との接点Gの位置を算出する。
The
進入角度演算部26は、接線52’の傾きを駐車枠Sへの進入角度として演算する。また、接線演算部25を介して入手した最終旋回中心点Pf、現在旋回中心点Pcl、Pcrや円弧60’の設定位置、接点Gの位置などの情報を描画制御部20Aへ転送する。
The approach
ヨー角変化監視部21Aは、ヨーレートセンサ6および車輪速センサ7からの出力に基づいて、進入角度演算部26で求められた接線52’と自車両の車両前後方向軸CLとの角度関係を監視し、自車両の移動に伴って重畳画像における上記接線52’と車両前後方向軸CLの角度が一致するタイミングを監視する。
Based on the outputs from the yaw rate sensor 6 and the wheel speed sensor 7, the yaw angle
ヨー角変化監視部21Aにおける監視結果はメッセージ制御部30Aへ送られる。
The monitoring result in the yaw angle
メッセージ制御部30A、アイコン状態判断部22Aの動作については、後述の制御処理において説明する。
The operations of the message control unit 30A and the icon
他の構成は図44に示した実施例4と同じである。 Other configurations are the same as those of the fourth embodiment shown in FIG.
図60、図61、図62はコントロールユニット10Aにおける制御処理の流れを示すフローチャートである。
60, 61, and 62 are flowcharts showing the flow of control processing in the
ステップ200〜205、225〜237は、実施例4の図48〜図50におけるステップ100〜105、123〜135と同じである。
ステップ206では、現在位置での左右の現在旋回中心点Pcl、Pcrが検出、設定される。
In
ステップ207では、円弧設定部24が、先の図59に示すように、自車両(Mc)の左側の旋回中心点Pclを中心として左側の旋回中心点Pclと右側の旋回中心点Pcr間の距離を半径とする円弧60’を、その始点を右側の旋回中心点Pcrに置いて設定する。
In
ステップ208において、接線演算部25は最終旋回中心点Pfを通り円弧60’に接する接線52’を演算し、当該接線52’と円弧60’との接点Gを算出する。
In step 208, the
そして、ステップ209において、進入角度演算部26は、接線52’の傾きを駐車枠Sへの進入角度として演算し、現在位置における自車両の車両前後方向軸CLとの角度差βを算出する。
In
ステップ210において、描画制御部20Aがメモリ29から自車両アイコンMc、Mf、車両前後方向軸線アイコン51、最終旋回中心点アイコン54と右側の現在旋回中心点アイコン56、円弧アイコン60の画像データを読み出す。
In
そして、ステップ211において、重畳画像合成部13に対して俯瞰画像へのアイコン重畳を行なわせる。描画制御部20Aは進入角度演算部26からの情報に基づいて各アイコンの配置を制御し、さらに接線52’と円弧60’との接点Gと最終旋回中心点Pfの間を結ぶガイド接線52を重畳させる。
In
これにより、モニタ8には駐車支援のための画像として、図63に示すように、自車両周囲の俯瞰画像に自車両等のアイコンが重畳されて表示される。
As a result, as shown in FIG. 63, the
モニタ8に各アイコンが重畳表示されると、ステップ212において、メッセージ制御部30Aが「停止してください」とのメッセージを出力させる。
When the icons are displayed in a superimposed manner on the
そして、ステップ213において、ヨー角変化監視部21Aが、車輪速センサ7の出力をチェックして、自車両が停止していることを確認すると、その旨をメッセージ制御部30Aへ通知する。
In
ヨー角変化監視部21Aはこの時点において進入角度演算部26で算出された接線
52’と車両前後方向軸CLとの角度差βを保持する。
The yaw angle
ステップ214において、メッセージ制御部30Aは、ステップ212で出力させたメッセージを消し、「左いっぱいにハンドルを切ってください」など、左最大転舵を行なうべき旨のメッセージを出力させる。
In
ステップ215では、メッセージ制御部30Aは最大転舵判断部23からの出力により自車両が左方向の最大転舵状態になっているかどうかをチェックする。
In
上記チェックを繰り返して、最大転舵状態になると、ステップ216へ進んで、メッセージ制御部30Aは、先のメッセージをモニタ8から消して、「後退してください」のメッセージを出力させる。
When the above check is repeated and the maximum steering state is reached, the process proceeds to step 216, where the message control unit 30A deletes the previous message from the
これらのメッセージを受けて運転者は左最大転舵で自車両を後退させる。運転者は、モニタ画面において、自車両Mcの車両前後方向軸線アイコン51の向きが接点Gと最終旋回中心点アイコン54間のガイド接線52に近づいていくのを確認することができる。
In response to these messages, the driver moves the vehicle backward with maximum left steering. The driver can confirm on the monitor screen that the direction of the vehicle
つぎに、ステップ217において、ヨー角変化監視部21Aは、ヨーレートセンサ6から出力される角速度を時間積分して自車両の車両前後方向軸CLの角度変化量を求め、その角度変化量が自車両が停止しているときに保持した接線52’との角度差βに至った(現在位置での角度差=0)かどうかをチェックする。
Next, in
後退による角度変化量が上記角度差に至るまで上記チェックを繰り返し、角度変化量が角度差に一致したときに、ステップ218へ進む。 The above check is repeated until the amount of angle change due to retraction reaches the angle difference. When the amount of angle change matches the angle difference, the process proceeds to step 218.
このときのモニタ画面の表示は図64に示すようになる。円弧60の始点(Pcr)が円弧60とガイド接線52の接点Gに到達し、現在旋回中心点アイコン56が接点Gの位置に重なる。
The display on the monitor screen at this time is as shown in FIG. The starting point (Pcr) of the
ステップ218では、メッセージ制御部30Aは、ステップ216で出力させたメッセージを消し、「停止してください」のメッセージを出力させる。
In
次のステップ219において、ヨー角変化監視部21が、車輪速センサ7の出力をチェックして、自車両が停止していることを確認すると、その旨をメッセージ制御部30Aへ通知する。
In the
これに応じて、ステップ220では、メッセージ制御部30が、ステップ218で出力させたメッセージを消し、「ハンドルを中立位置にして後退してください」など、中立転舵後後退すべき旨のメッセージを出力させる。
In response to this, in step 220, the
この際、モニタ8の画面に重畳表示されたガイド接線52は後退方向の指標となる。
At this time, the guide
このとき、さらにガイド接線52と旋回中心点アイコン54、56の表示色を変えたり、あるいは点滅させて、運転者の注意を喚起するようにしてもよい。
At this time, the display color of the
ステップ221では、メッセージ制御部30Aは、インヒビタスイッチ5の出力からRレンジ(後退)のシフトポジションが選択されたかどうかをチェックする。
In
上記チェックを繰り返して、Rレンジの選択状態になると、ステップ222へ進む。 When the above check is repeated and the R range is selected, the routine proceeds to step 222.
Rレンジが選択されて自車両が後退すると、ガイド接線52は自車両の車両前後方向軸CLと平行になっているから、モニタ画面上、現在旋回中心点アイコン56はガイド接線52にそって最終旋回中心点アイコン54へ近づいていく。
When the R range is selected and the host vehicle moves backward, the guide
この間、アイコン状態判断部22Aは現在旋回中心点アイコン56と最終旋回中心点アイコン54の位置関係を監視している。
During this time, the icon
ステップ222では、メッセージ制御部30Aが、アイコン状態判断部22Aの出力により、重畳画像における現在旋回中心点アイコン56(接点G)が最終旋回中心点アイコン54に重なったかをチェックする。
In
上記チェックを繰り返し、図65のモニタ画面に示すように、現在旋回中心点アイコン56が最終旋回中心点アイコン54に重なった時点で、ステップ223へ進む。
The above check is repeated, and when the current turning
ステップ223では、メッセージ制御部30Aが、「停止してください」のメッセージを出力させる。 In step 223, the message control unit 30A outputs a “Please stop” message.
また、ステップ224では、描画制御部20Aが、現在旋回中心点アイコン56と最終旋回中心点アイコン54が重なった旨のアイコン状態判断部22Aの出力を受けて、車両前後方向軸線アイコン51、最終旋回中心点アイコン54、および円弧アイコン60の表示を消させる。なお、この時点でガイド接線52も消えている。
In
続いて描画制御部20Aは、ステップ225において、メモリ29から前部最外周の案内指標44と後部最外周の案内指標46の画像データを読み出し、ステップ226において、重畳画像合成部13に対して俯瞰画像へのアイコン重畳を行なわせる。
Subsequently, in
このあとのステップ227〜237は、実施例4おける図55〜図57を参照した処理ステップ125〜135と同じである。
The
すなわち、枠線Hと前部最外周の案内指標44または後部最外周の案内指標46のいずれかとの干渉の有無をチェックして、干渉する場合には駐車案内不可のメッセージを出力させ、干渉しない場合は、右最大転舵後、後退を行なわせることにより、自車両は旋回中心点アイコン54(Pf)を中心として旋回して、図57に示されるように、駐車枠Sの最終駐車位置へ到達できる。
In other words, the presence or absence of interference between the frame line H and the front outermost
したがって、以降のステップの詳細説明は省略する。 Therefore, detailed description of the subsequent steps is omitted.
実施例2においては、図60〜図62のフローチャートにおけるステップ201が俯瞰画像作成手段を構成し、ステップ202が駐車枠検出手段を、ステップ203が最終駐車位置設定手段を、ステップ204が第1旋回点設定手段を、ステップ205が現在位置検出手段を、そしてステップ206〜208が第2旋回点設定手段を構成している。
In the second embodiment,
最終旋回中心点Pfが第1の旋回点に該当し、接点Gが第2の旋回点に該当する。 The final turning center point Pf corresponds to the first turning point, and the contact point G corresponds to the second turning point.
車両前後方向軸線アイコン51が車両前後方向軸を示す画像に該当し、ガイド接線52が第1の旋回点と第2の旋回点を通る直線に、円弧アイコン60が円弧を示す画像に該当する。
The vehicle
また、ステップ210、211、224〜226、231が重畳画像合成手段を構成し、ステップ212〜216、218〜220、223、228〜230、232〜234、236が支援情報制御手段を構成している。
また、モニタ8とスピーカ9がメッセージ提示手段に該当する。
The
実施例5は以上のように構成され、カメラ2で撮像した自車両周囲状況を真上から見た俯瞰画像としてモニタ8に表示するとともに、俯瞰画像から検出した駐車枠S内に自車両が最終的に位置すべき最終駐車位置を設定して、最終駐車位置における自車両の最小回転半径での右側(進入路側)の最終旋回中心点Pfを求め、現在位置における自車両の左側の旋回中心点Pclを中心として左側の旋回中心点Pclと右側の旋回中心点Pcr間の距離を半径とする円弧60’を設定して、最終旋回中心点Pfを通り円弧60’に接点Gで接するガイド接線52を俯瞰画像に重畳するものとしたので、運転者はモニタ画面のガイド接線52を参照して、駐車枠Sへの進入角度を容易に把握することができる。
The fifth embodiment is configured as described above, and displays the surrounding situation of the host vehicle captured by the
また、自車両Mcの車両前後方向軸線アイコン51も俯瞰画像に重畳させることにより、車両前後方向軸線アイコン51を参照して自車両をガイド接線52と平行にもっていく操作が容易となり、駐車枠Sへ向かう間の方向保持の確認も容易となる。
In addition, by superimposing the vehicle
さらには、左側の旋回中心点Pclを中心とする円弧アイコン60も俯瞰画像に重畳させるので、運転者は自車両をガイド接線52と平行にもっていくための転舵方向を直感的に認識することができる。
Furthermore, since the
とくに、自車両の車両前後方向軸CL(車両前後方向軸線アイコン51)と接線52’(ガイド接線52)が平行になった位置において、中立転舵のうえ後退させるメッセージを出力するので、転舵のタイミングがいっそう正確となる。 In particular, in a position where the vehicle longitudinal axis CL (vehicle longitudinal axis icon 51) and the tangent 52 ′ (guide tangent 52) of the host vehicle are parallel to each other, a message to reverse the neutral steering is output. Will be more accurate.
また、その後、最終旋回中心点アイコン54と現在旋回中心点アイコン56が重なった位置において、現在旋回中心点Pcrを旋回中心とする方向に最大転舵のうえ後退させる旨の支援メッセージを出力するので、最終段階移動として、最小回転半径で最終駐車位置へ到達することができる。
In addition, after that, at the position where the final turning
さらに、最終旋回中心点アイコン54と現在旋回中心点アイコン56が重なったときに、最終駐車位置への最終段階移動開始の後退をさせる前、すなわち最大転舵のうえ後退させるメッセージを出力する前に、それぞれ扇形状の要を現在旋回中心点Pcrにおいた前部最外周の案内指標44と後部最外周の案内指標46を俯瞰画像に重畳して表示するので、駐車枠S内の最終駐車位置まで他との干渉なしに進入可能であるかをモニタ画面上で容易に確認することができる。
Further, when the final turning
なお、俯瞰画像に重畳されるガイド接線52は最終旋回中心点アイコン54と接点Gの間を結ぶものとしたが、これに限定されず、適宜両方向に延ばしてもよい。
The guide
車両前後方向軸線アイコン51の長さも同様に任意に設定してよい。
Similarly, the length of the vehicle
また、制御フローのステップ217では、自車両の車両前後方向軸CLの向きが接線52’と平行になったことを確認するのに、ヨー角変化監視部21Aによりヨーレートセンサ6の出力を用いた角度変化量を監視して行なうものとしたが、このほか、進入角度演算部26を介して得られる情報を用いて、現在旋回中心点Pcrが接点Gに重なったこと、あるいは現在旋回中心点Pcrが接線52’と接触したことから判断することもできる。
In
あるいはまた、現在旋回中心点アイコン56が接点Gに重なったこと、または現在旋回中心点アイコン56がガイド接線52と接触したことを、アイコン状態判断部22Aで判断するようにしてもよい。
Alternatively, the icon
さらに、ステップ222では、現在旋回中心点Pcrと最終旋回中心点Pfが重なったことを、現在旋回中心点アイコン56と最終旋回中心点アイコン54の重なりを判断するアイコン状態判断部22Aの出力によりチェックするものとしたが、アイコンの重なりではなく、進入角度演算部26を介して得られる現在旋回中心点Pcrと最終旋回中心点Pfの直接情報を用いてこれらの旋回中心点が一致するタイミングを判断するようにしてもよい。
Further, in
また、ステップ224において、車両前後方向軸線アイコン51とともに、円弧アイコン60の表示を消させるものとしたが、円弧アイコン60はこれより前の接線52’と車両前後方向軸CLの角度差が0となったあとならいつでも消してよい。
In
上記実施例4,5では、最終駐車位置への最終段階移動開始に先立って、自車両の通過領域を示す案内指標44、46を俯瞰画像に重畳して、枠線Hとの干渉がないことを確認した後は、後退の教示に続いてステップ129(ステップ231)で案内指標を消すものとしているが、最終駐車位置に至るまで案内指標を重畳したままとして最後まで確認を行えるようにしてもよい。
In the fourth and fifth embodiments, prior to the start of the final stage movement to the final parking position, the
実施例4,5ではまた、ステップ131、132(ステップ233、234)でメッセージ制御部30(30A)がアイコン状態判断部22(22A)の出力により、自車両が最終駐車位置に位置したことをチェックして、駐車完了のメッセージを出力させるものとしたが、駐車枠Sの最終駐車位置に到達したかどうかは実際の車両周囲状況あるいはモニタ8の画面からも運転者が確認できるので、装置自体としては上記チェックおよびメッセージ処理を省略して、例えばステップ133(ステップ235)のチェックで、Pレンジ(パーキング)のシフトポジションが選択されたことにより、最終駐車位置に到達したものとして支援の制御処理を終了するものとしてもよい。
In the fourth and fifth embodiments, the message control unit 30 (30A) in
なお、案内指標44、46と枠線Hが干渉した場合には、駐車案内不可としてモニタ8の表示を消して制御処理を終了するものとしたが、運転者が支援に頼らずに同じ駐車枠への駐車操作を行う際の参考となるように、駐車支援起動スイッチ3がオフされるまでは現在位置における自車両アイコンMcを重畳した俯瞰画像の表示を継続するようにしてもよい。
When the
実施例4,5では、自車両の進行方向に対して左側の駐車枠に駐車しようとする場合について説明したが、進行方向に対して右側の駐車枠に駐車しようとする場合は、上記説明における左右を反転させればよい。 In the fourth and fifth embodiments, the case where parking is attempted in the left parking frame with respect to the traveling direction of the host vehicle has been described. What is necessary is just to reverse right and left.
1、1A、1B、1C、1D 駐車支援装置
2、2a、2b、2c、2d カメラ
3、3B 駐車支援起動スイッチ
4 舵角センサ
5 インヒビタスイッチ
6 ヨーレートセンサ
7 車輪速センサ
8 モニタ
9 スピーカ
10、10A、10B、10C、10D コントロールユニット
11、11B 視点変換部
12、12B 俯瞰画像作成部
13、13B 重畳画像合成部
14 駐車枠検出部
15 駐車位置設定部
16 最終旋回中心設定部
17 自車位置検出部
18、18A 旋回中心検出部
19 旋回角度演算部
20、20A、20B、20C、20D 描画制御部
21、21A ヨー角変化監視部
22、22A アイコン状態判断部
23 最大転舵判断部
24 円弧設定部
25 接線演算部
26 進入角度演算部
29 メモリ
30、30A メッセージ制御部
40 駐車枠接触検出部
44 前部最外周の案内指標
46 後部最外周の案内指標
50 ガイド直線
50’ 直線
51 車両前後方向軸線アイコン
52 ガイド接線
52’ 接線
54 最終旋回中心点アイコン
56 現在旋回中心点アイコン
60 円弧アイコン
60’ 円弧
81〜84 並列駐車用の案内指標
CL 車両前後方向軸
G 接点
H 枠線
Mc、Mf 自車両アイコン
Pc、Pcl、Pcr 現在旋回中心点
Pf 最終旋回中心点
S 駐車枠
Wl、Wr 後輪
1, 1A, 1B, 1C, 1D Parking support device 2, 2a, 2b, 2c, 2d Camera 3, 3B Parking support start switch 4 Rudder angle sensor 5 Inhibitor switch 6 Yaw rate sensor 7 Wheel speed sensor 8 Monitor 9 Speaker 10 10A 10B, 10C, 10D Control unit 11, 11B View point conversion unit 12, 12B Overhead image creation unit 13, 13B Superimposed image composition unit 14 Parking frame detection unit 15 Parking position setting unit 16 Final turning center setting unit 17 Own vehicle position detection unit 18, 18A Turning center detection unit 19 Turning angle calculation unit 20, 20A, 20B, 20C, 20D Drawing control unit 21, 21A Yaw angle change monitoring unit 22, 22A Icon state determination unit 23 Maximum steering determination unit 24 Arc setting unit 25 Tangent calculation unit 26 Approach angle calculation unit 29 Memory 30, 30A Message system Control unit 40 Parking frame contact detection unit 44 Front outermost periphery guide indicator 46 Rear outermost periphery guide indicator 50 Guide straight line 50 ′ straight line 51 Vehicle longitudinal axis icon 52 Guide tangent line 52 ′ tangent line 54 Final turning center point icon 56 Current turning Center point icon 60 Arc icon 60 'Arc 81-84 Parallel parking guidance indicator CL Vehicle longitudinal axis G Contact point H Frame line Mc, Mf Own vehicle icon Pc, Pcl, Pcr Current turning center point Pf Final turning center point S Parking Frame Wl, Wr Rear wheel
Claims (8)
前記カメラからの撮像信号を、カメラ光軸を路面に垂直にした視点からの画像信号へ変換合成して、俯瞰画像を作成する俯瞰画像作成手段と、
前記俯瞰画像作成手段で作成された俯瞰画像に、運転者に駐車を支援し、前記車両の前端が通る軌跡と前記車両の後端が通る軌跡を含む案内指標を設定する指標設定手段と、
前記俯瞰画像作成手段で作成された俯瞰画像に前記指標設定手段で設定された案内指標を重畳して重畳画像を作成する重畳画像合成手段と、
前記重畳画像合成手段で作成された重畳画像を表示する表示手段と、
前記俯瞰画像作成手段で作成された俯瞰画像から駐車枠を検出する駐車枠検出手段と、
前記駐車枠検出手段で検出された駐車枠と、前記表示手段に表示された自車両アイコンとの接触を判断する接触判断手段と、
前記接触判断手段の判断結果に基づいて、前記表示手段に表示される前記案内指標を表示制御する表示制御手段とを有し、
前記接触判断手段により前記駐車枠の枠線と自車両アイコンの一部とが接触したと判断された場合には、前記表示制御手段は、前記接触判断手段により前記駐車枠の枠線と自車両アイコンの一部とが接触したと判断されたときに前記表示手段に表示されていた重畳画像から自車両前方側の案内指標を削除し、前記表示手段は、前記接触判断手段により前記駐車枠の枠線と自車両アイコンの一部とが接触したと判断されたときに表示していた重畳画像から自車両前方側の案内指標が削除された重畳画像を表示する
ことを特徴とする駐車支援装置。 A camera that is installed at multiple positions of the vehicle and images the surroundings of the host vehicle;
An overhead view image creating means for creating an overhead view image by converting and synthesizing an imaging signal from the camera into an image signal from a viewpoint with the camera optical axis perpendicular to the road surface
Index setting means for assisting parking to the driver in the overhead image created by the overhead image creating means, and setting a guidance index including a trajectory through which the front end of the vehicle passes and a trajectory through which the rear end of the vehicle passes;
Superimposed image composition means for creating a superimposed image by superimposing the guidance index set by the index setting means on the overhead image created by the overhead image creation means;
Display means for displaying the superimposed image created by the superimposed image synthesis means;
Parking frame detecting means for detecting a parking frame from the overhead image created by the overhead image creating means;
Contact determination means for determining contact between the parking frame detected by the parking frame detection means and the host vehicle icon displayed on the display means;
Display control means for controlling display of the guide indicator displayed on the display means based on the determination result of the contact determination means;
If a portion of the border and the vehicle icon of the parking space is determined to be contacted by the contact determination unit, wherein the display control unit, the self and borders of the parking space by the contact determination means When it is determined that a part of the vehicle icon is in contact, the guidance indicator on the front side of the host vehicle is deleted from the superimposed image displayed on the display unit, and the display unit is configured to display the parking frame by the contact determination unit. Parking assistance characterized by displaying a superimposed image in which the guidance index on the front side of the host vehicle is deleted from the superimposed image displayed when it is determined that the frame line of the vehicle and a part of the host vehicle icon are in contact with each other apparatus.
ことを特徴とする請求項1に記載の駐車支援装置。 The guide indicator requires a turning center point on the opposite side of the approach path at the minimum turning radius of the host vehicle, and has a fan shape having an outer edge as an arc passing through the front end on the outer side of the host vehicle, and a rear side outside the host vehicle turning. The parking assist device according to claim 1, wherein the parking assistance device is configured in a shape of a fan shape having an arc passing through the end as an outer edge.
ことを特徴とする請求項1に記載の駐車支援装置。 The guidance indicator requires a turning center point on the approach road side with the minimum turning radius of the host vehicle, and a fan-shaped first region having an outer edge as an arc passing through the front end on the outer side of the host vehicle, and the turning of the host vehicle. 2. The parking assist device according to claim 1, wherein the parking assist device is configured by a second area surrounded by an arc passing through the outer rear end and an arc passing through the rear inner end. .
ことを特徴とする請求項1に記載の駐車支援装置。 The guide indicator requires a turning center point on the approach road side at the minimum turning radius of the host vehicle, and is surrounded by an arc passing through the front end on the outer side of the host vehicle and an arc passing through the front end on the inner side of the turn. 2. The parking assist according to claim 1, wherein the parking assistance is configured by a shape of a front portion of the own vehicle and a side shape inside the turning of the own vehicle, and a shape of a trajectory rotated by a quarter turn with a minimum turning radius. apparatus.
ことを特徴とする請求項2〜4のいずれか1項に記載の駐車支援装置。 The parking assistance device according to any one of claims 2 to 4, wherein the guide indicator is displayed translucently on the display means.
ことを特徴とする請求項2〜4のいずれか1項に記載の駐車支援装置。 The parking assistance device according to any one of claims 2 to 4, wherein a length of the guide indicator is ¼ of a circumference.
ことを特徴とする請求項2〜4のいずれか1項に記載の駐車支援装置。 The parking assistance device according to any one of claims 2 to 4, wherein the guide indicator is displayed on the display unit with a gradation that increases from the main point toward the outer edge.
前記撮像で得られた撮像信号を、カメラ光軸を路面に垂直にした視点からの画像信号へ変換合成して俯瞰画像を作成し、
記作成された俯瞰画像に対して運転者に駐車を支援する案内指標を設定し、
前記作成された俯瞰画像に前記設定された案内指標を重畳して重畳画像を作成し、
前記作成された重畳画像を表示手段に表示し、
前記作成された俯瞰画像から駐車枠を検出し、
前記検出された駐車枠と、前記表示手段に表示された自車両アイコンとの接触を判断し、
前記接触の判断結果に基づいて、前記表示手段に表示される前記案内指標を表示制御し、
前記駐車枠の枠線と前記自車両アイコンの一部とが接触したと判断された場合には、前記駐車枠の枠線と自車両アイコンの一部とが接触したと判断されたときに前記表示手段に表示されていた重畳画像から自車両前方側の案内指標を削除し、前記表示手段は、前記駐車枠の枠線と自車両アイコンの一部とが接触したと判断されたときに表示していた重畳画像から自車両前方側の案内指標が削除された重畳画像を表示する
ことを特徴とする駐車支援方法。 Take an image of the surroundings of your vehicle with cameras installed at multiple locations on the vehicle,
The imaging signal obtained by the imaging is converted and synthesized to an image signal from a viewpoint in which the camera optical axis is perpendicular to the road surface to create an overhead image,
Set a guidance index to assist the driver in parking the created overhead image,
A superimposed image is created by superimposing the set guide indicator on the created overhead view image,
Displaying the created superimposed image on a display means;
A parking frame is detected from the created overhead image,
Determining contact between the detected parking frame and the vehicle icon displayed on the display means;
Based on the contact determination result, display control of the guidance index displayed on the display means,
When the when the parking frame borders and the part of the vehicle icon is determined to be contacted, and a portion of the border and the vehicle icon of the parking space is determined to be contacted When the guidance index on the front side of the host vehicle is deleted from the superimposed image displayed on the display unit, and the display unit determines that the frame line of the parking frame and a part of the host vehicle icon are in contact with each other A parking assistance method, comprising: displaying a superimposed image in which a guidance index on the front side of the host vehicle is deleted from the displayed superimposed image .
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008172772A JP5380926B2 (en) | 2008-07-01 | 2008-07-01 | Parking assistance device and parking assistance method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008172772A JP5380926B2 (en) | 2008-07-01 | 2008-07-01 | Parking assistance device and parking assistance method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2010012836A JP2010012836A (en) | 2010-01-21 |
JP5380926B2 true JP5380926B2 (en) | 2014-01-08 |
Family
ID=41699383
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008172772A Active JP5380926B2 (en) | 2008-07-01 | 2008-07-01 | Parking assistance device and parking assistance method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5380926B2 (en) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5618138B2 (en) * | 2010-09-13 | 2014-11-05 | アイシン精機株式会社 | Parking assistance device |
JP5454934B2 (en) | 2010-09-21 | 2014-03-26 | アイシン精機株式会社 | Driving assistance device |
JP5691339B2 (en) * | 2010-09-21 | 2015-04-01 | アイシン精機株式会社 | Driving assistance device |
JP5857527B2 (en) * | 2011-08-23 | 2016-02-10 | 日産自動車株式会社 | Parking assistance device |
JP5786833B2 (en) * | 2012-09-12 | 2015-09-30 | 株式会社デンソー | Parking assistance device |
JP6107168B2 (en) * | 2013-01-25 | 2017-04-05 | 日産自動車株式会社 | Parking assistance device and parking assistance method |
JP5872517B2 (en) * | 2013-10-04 | 2016-03-01 | 本田技研工業株式会社 | Vehicle periphery display device |
EP3086994B1 (en) * | 2013-12-23 | 2018-03-28 | ADC Automotive Distance Control Systems GmbH | Parking assistance system and method for parking a vehicle in a parking garage |
JP6404637B2 (en) * | 2014-08-20 | 2018-10-10 | 日野自動車株式会社 | Driving support device and driving support system |
JP6747349B2 (en) * | 2017-03-23 | 2020-08-26 | 株式会社Jvcケンウッド | Driving support device, driving support method and program |
WO2022153788A1 (en) * | 2021-01-18 | 2022-07-21 | 古野電気株式会社 | Ar piloting system and ar piloting method |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3445197B2 (en) * | 1998-10-08 | 2003-09-08 | 松下電器産業株式会社 | Driving operation assist device |
JP2000339598A (en) * | 1999-03-19 | 2000-12-08 | Yazaki Corp | Monitor device for vehicle |
JP2001010432A (en) * | 1999-04-28 | 2001-01-16 | Matsushita Electric Ind Co Ltd | Parking aiding device and parking aiding method |
JP2004114879A (en) * | 2002-09-27 | 2004-04-15 | Clarion Co Ltd | Parking assisting device, and image display device |
JP2004252837A (en) * | 2003-02-21 | 2004-09-09 | Denso Corp | Vehicle periphery display device and vehicle periphery display program |
JP4863791B2 (en) * | 2006-07-05 | 2012-01-25 | アルパイン株式会社 | Vehicle peripheral image generation apparatus and image switching method |
JP4793171B2 (en) * | 2006-08-25 | 2011-10-12 | 株式会社デンソー | Parking assistance device |
-
2008
- 2008-07-01 JP JP2008172772A patent/JP5380926B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2010012836A (en) | 2010-01-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5380926B2 (en) | Parking assistance device and parking assistance method | |
EP2786917B1 (en) | Birds-eye view parking assist system and method | |
JP3927512B2 (en) | Parking assistance device | |
KR101375944B1 (en) | Parking assistance system | |
JP5429514B2 (en) | Parking assistance device | |
JP5104171B2 (en) | Parking assistance device and parking assistance method | |
JP4061219B2 (en) | Parking assistance device | |
US20100019934A1 (en) | Parking assistance apparatus and parking assistance method | |
JP6096155B2 (en) | Driving support device and driving support system | |
JP2001180405A (en) | Steering support device | |
JP5182137B2 (en) | Vehicle periphery display device | |
JP2005329915A (en) | Parking support device | |
JP5446139B2 (en) | Parking assistance device and parking assistance method | |
WO2013024523A1 (en) | Parking assistance device | |
WO2011105105A1 (en) | Parking assistance device | |
JP4946745B2 (en) | Parallel parking assistance device | |
JP2008302711A (en) | Start support device | |
JP4507872B2 (en) | Parking assistance device | |
JP4946755B2 (en) | Parallel parking assistance device | |
WO2019073872A1 (en) | Parking assistance device | |
CN107792175B (en) | Auxiliary device for delivery | |
JP5136291B2 (en) | Parking assistance device and parking assistance method | |
JP5075674B2 (en) | Parking assistance device | |
JP5151803B2 (en) | Parking assistance device and parking assistance method | |
JP2011057139A (en) | Driving support device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20110628 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20120711 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20120731 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120927 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20130402 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130625 |
|
A911 | Transfer of reconsideration by examiner before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20130702 |
|
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: 20130903 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20130916 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5380926 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |