JP4661639B2 - Driving assistance device - Google Patents

Driving assistance device Download PDF

Info

Publication number
JP4661639B2
JP4661639B2 JP2006063191A JP2006063191A JP4661639B2 JP 4661639 B2 JP4661639 B2 JP 4661639B2 JP 2006063191 A JP2006063191 A JP 2006063191A JP 2006063191 A JP2006063191 A JP 2006063191A JP 4661639 B2 JP4661639 B2 JP 4661639B2
Authority
JP
Japan
Prior art keywords
vehicle
travel
image
locus
driving support
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.)
Expired - Fee Related
Application number
JP2006063191A
Other languages
Japanese (ja)
Other versions
JP2007237930A (en
Inventor
俊博 狩野
彰宏 中嶋
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Aisin AW Co Ltd
Original Assignee
Aisin AW Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Aisin AW Co Ltd filed Critical Aisin AW Co Ltd
Priority to JP2006063191A priority Critical patent/JP4661639B2/en
Publication of JP2007237930A publication Critical patent/JP2007237930A/en
Application granted granted Critical
Publication of JP4661639B2 publication Critical patent/JP4661639B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Regulating Braking Force (AREA)
  • Traffic Control Systems (AREA)
  • Fittings On The Vehicle Exterior For Carrying Loads, And Devices For Holding Or Mounting Articles (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Description

本発明は、車両を後退させる際に運転者が行う車両操作を支援する運転支援装置に関し、特に、前進する際の車両の走行履歴に基づいて後退時の車両操作の支援を行うことによって、後退が困難な状況下でのより容易な車両の運転を可能とした運転支援装置に関するものである。   The present invention relates to a driving support device that supports a vehicle operation performed by a driver when the vehicle is moved backward, and in particular, by performing vehicle operation support during backward movement based on a traveling history of the vehicle when moving forward, The present invention relates to a driving support device that enables easier driving of a vehicle under difficult circumstances.

従来より、ナビゲーション装置の地図データから得られる道路情報や、GPS等によって特定される現在位置等の車両の走行に係る各種情報を取得し、ユーザに対する報知や、運転の補助、さらには運転への介入を行う運転支援装置について提案されている。
そして、このような運転支援装置としては、前進時より運転が困難である後退時において運転の支援が行われることが多い。例えば、特開平11−334470号公報には、駐車時に車両の後方環境を撮像したカメラ画像をディスプレイに表示して、車両に対する運転者の駐車操作を支援する駐車支援装置が記載されている。このような駐車支援装置によれば、車両に対して後進方向側の状況を画像表示するとともに、ステアリング舵角センサからの信号に基づいて車両の進行予測曲線を算出し、算出した進行予測曲線を、上述したように撮像したカメラ画像に重畳して表示することによって、車両に対する運転者の駐車操作を支援することが可能となる。
特開平11−334470号公報(第3頁〜第5頁、図13)
Conventionally, the road information obtained from the map data of the navigation device, and various information related to the traveling of the vehicle such as the current position specified by GPS, etc. are acquired, and notification to the user, driving assistance, and further driving A driving assistance device for intervention is proposed.
In such a driving assistance device, driving assistance is often performed at the time of reverse, in which driving is more difficult than at the time of forward movement. For example, Japanese Patent Application Laid-Open No. 11-334470 describes a parking assist device that supports a driver's parking operation with respect to a vehicle by displaying a camera image obtained by imaging a rear environment of the vehicle during parking. According to such a parking assistance device, while displaying an image of the situation in the backward direction with respect to the vehicle, the vehicle progress prediction curve is calculated based on the signal from the steering angle sensor, and the calculated progress prediction curve is By superimposing and displaying on the captured camera image as described above, it is possible to assist the driver's parking operation with respect to the vehicle.
Japanese Patent Laid-Open No. 11-334470 (pages 3 to 5, FIG. 13)

しかしながら、前記した特許文献1に記載された駐車支援装置では、通常の駐車操作を行うには十分であるが、ディスプレイに進行予想曲線を表示するのみであるので、特に後退を行うことが困難な状況下においては運転の支援として不十分であった。ここで、後退を行うことが困難な状況としては、例えば、狭い駐車場に前向きに駐車した後で後退しながら再出発する場合や、細街路や狭い山道等で他車とのすれ違いや行き止まりがあって後退する必要がある場合等がある。上記のような状況下では、車両の後方環境の視認が困難であることに加えて、適切なタイミングでのブレーキ操作やステアリング操作等の車両操作が必要となる。
また、従来においてはカメラで撮像した画像やミリ波レーダ等を用いて路面や障害物の形状や位置を検出し、ステアリングやブレーキを制御することにより運転の支援を行うことについても提案されている。しかし、路面や障害物の形状や位置を検出できたとしても、その検出結果のみからでは後退時に適切な走行を行わせるように車両を制御することは困難であった。
However, the parking assist device described in Patent Document 1 is sufficient for performing a normal parking operation, but only displays a predicted travel curve on the display, so that it is particularly difficult to move backward. Under circumstances, it was insufficient as driving assistance. Here, for example, when it is difficult to retreat, for example, when you park in a narrow parking lot and then start again while retreating, or when you pass or stop with other vehicles on narrow streets or narrow mountain roads, etc. There are cases where it is necessary to retreat. Under the circumstances as described above, in addition to the difficulty of visually recognizing the environment behind the vehicle, vehicle operations such as a brake operation and a steering operation at an appropriate timing are required.
In addition, conventionally, it has been proposed to support driving by detecting the shape and position of a road surface or an obstacle using an image captured by a camera, a millimeter wave radar, or the like, and controlling a steering or a brake. . However, even if the shape and position of the road surface and the obstacle can be detected, it is difficult to control the vehicle so that the vehicle travels appropriately when reversing from only the detection result.

本発明は前記従来における問題点を解消するためになされたものであり、狭い駐車場に前向きに駐車した後で後退しながら再出発する場合や、細街路や狭い山道等で他車とのすれ違いや行き止まりがあって後退する必要がある場合等の後退を行うことが困難な状況での後退時においても、より容易な車両の運転を可能とした運転支援装置を提供することを目的とする。   The present invention has been made in order to solve the above-described conventional problems, and when the vehicle is parked forward in a narrow parking lot and then re-starts while retreating, or passing with another vehicle on a narrow street or a narrow mountain road. An object of the present invention is to provide a driving support device that enables easier driving of a vehicle even when the vehicle travels in a situation where it is difficult to perform reverse operation such as when there is a dead end and it is necessary to reverse.

前記目的を達成するため本願の請求項1に係る運転支援装置(1)は、車両(2)を後退させる際に運転者が行う車両操作を支援する運転支援装置において、車両の周囲にある障害物を検出する障害物検出手段(4)と、前記障害物検出手段により検出された障害物の車両に対する相対位置を検出する位置検出手段(4)と、前記位置検出手段の検出結果に基づいて、車両が前進する際の車両の走行軌跡を検出する走行軌跡検出手段(4)と、前記走行軌跡検出手段により検出された前記車両の走行軌跡を走行履歴として記憶する走行履歴記憶手段(10)と、車両が後退するか否かを判定する後退判定手段(4)と、を有し、前記後退判定手段により車両が後退すると判定された場合に前記走行履歴記憶手段に記憶された前記車両の走行軌跡に基づいて車両操作を支援することを特徴とする In order to achieve the above object, a driving support device (1) according to claim 1 of the present application is a driving support device that supports a vehicle operation performed by a driver when the vehicle (2) is moved backward, and a fault around the vehicle. Based on an obstacle detection means (4) for detecting an object, a position detection means (4) for detecting a relative position of the obstacle detected by the obstacle detection means with respect to the vehicle, and a detection result of the position detection means. A traveling locus detecting means (4) for detecting the traveling locus of the vehicle when the vehicle moves forward, and a traveling history storage means (10) for storing the traveling locus of the vehicle detected by the traveling locus detecting means as a traveling history. If the vehicle has a, a retraction determination means (4) determines whether to retract, when the vehicle is determined to be retracted by the retraction determining means, the vehicle stored in the travel history storing means Traveling Wherein the supporting vehicle operation based on the marks.

また、請求項2に係る運転支援装置(1)は、車両(2)を後退させる際に運転者が行う車両操作を支援する運転支援装置において、車両が前進する際に車両の走行軌跡を検出する走行軌跡検出手段(4)と、前記走行軌跡検出手段により検出された前記車両の走行軌跡を走行履歴として記憶する走行履歴記憶手段(10)と、車両に配置され、車両の周囲を撮像する撮像手段(3)と、車両が後退するか否かを判定する後退判定手段(4)と、前記後退判定手段により車両が後退すると判定された場合に、前記走行軌跡検出手段によって検出された前記車両の走行軌跡を前記撮像手段により撮像された画像に重畳する画像重畳手段(4)と、前記画像重畳手段によって重畳された画像を表示する画像表示手段(5)と、を有することを特徴とする。 Further, the driving support device (1) according to claim 2 is a driving support device that supports a vehicle operation performed by the driver when the vehicle (2) is moved backward, and detects a travel locus of the vehicle when the vehicle moves forward. A traveling locus detection means (4) for performing the above operation, a traveling history storage means (10) for storing the traveling locus of the vehicle detected by the traveling locus detection means as a traveling history, and an image of the surroundings of the vehicle. The imaging means (3), the reverse determination means (4) for determining whether or not the vehicle moves backward, and the road detected by the travel locus detection means when the reverse determination means determines that the vehicle is reverse. characterized in that it has an image superimposing means for superimposing the travel locus of the vehicle on the image captured by the imaging unit (4), and image display means for displaying the superimposed image (5) by the image superposing means, To.

また、請求項3に係る運転支援装置(1)は、請求項1に記載の運転支援装置において、前記後退判定手段(4)により車両が後退すると判定された場合に、前記車両の走行軌跡に沿って後退するように車両を制御する車両制御手段(4)を有することを特徴とする。 Further, the driving support apparatus according to claim 3 (1), in the driving support apparatus according to claim 1, when it is determined that the vehicle is retracted by the retraction determining means (4), the traveling locus of the vehicle It has vehicle control means (4) which controls a vehicle so that it may retreat along .

また、請求項4に係る運転支援装置(1)は、請求項1に記載の運転支援装置において、車両(2)に配置され、車両の周囲を撮像する撮像手段(5)と、前記後退判定手段(4)により車両が後退すると判定された場合に前記走行軌跡検出手段(4)によって検出された前記車両の走行軌跡を前記撮像手段により撮像された画像に重畳する画像重畳手段(4)と、前記画像重畳手段によって重畳された画像を表示する画像表示手段(5)と、を有することを特徴とする。 Further, the driving support apparatus according to claim 4 (1), in the driving support apparatus according to claim 1, disposed on the vehicle (2), and imaging means for imaging the surroundings of the vehicle (5), the backward determination An image superimposing means (4) for superimposing the traveling locus of the vehicle detected by the traveling locus detection means (4) on the image captured by the imaging means when it is determined by the means (4) that the vehicle moves backward; And image display means (5) for displaying the image superimposed by the image superimposing means .

また、請求項5に係る運転支援装置(1)は、請求項1又は請求項3に記載の運転支援装置において、前記走行履歴記憶手段(10)には、車両(2)が前進する際の運転者が行った車両操作の操作内容についても記憶され、前記後退判定手段(4)により車両が後退すると判定された場合に、前記走行履歴記憶手段に記憶された前記操作内容に基づいた車両操作が行われるように車両を制御する車両操作制御手段(4)を有することを特徴とする。 Further, the driving support device (1) according to claim 5 is the driving support device according to claim 1 or 3 , wherein the travel history storage means (10) is provided with a vehicle when the vehicle (2) moves forward. The operation details of the vehicle operation performed by the driver are also stored, and the vehicle operation based on the operation details stored in the travel history storage means when the reverse determination means (4) determines that the vehicle is reverse. It has vehicle operation control means (4) which controls a vehicle so that it may be performed .

また、請求項6に係る運転支援装置(1)は、請求項1乃至請求項5のいずれかに記載の運転支援装置において、車両(2)が細街路又は駐車場内に進入したことを検出する進入検出手段(4)を有し、前記走行軌跡検出手段(4)は、前記進入検出手段によって車両が細街路又は駐車場内に進入したことが検出された場合に前記車両の走行軌跡を検出するとともに車両操作を支援することを特徴とする。 A driving support device (1) according to claim 6 detects in the driving support device according to any one of claims 1 to 5 that a vehicle (2) has entered a narrow street or a parking lot. An entry detecting means (4) is provided, and the traveling locus detecting means (4) detects the traveling locus of the vehicle when the entry detecting means detects that the vehicle has entered a narrow street or a parking lot. In addition, the vehicle operation is supported .

前記構成を有する請求項1の運転支援装置では、車両が前進する際に車両の走行軌跡を検出して走行履歴として記憶するとともに、車両が後退する際に記憶された走行履歴に基づいて運転者の行う車両操作を支援するので、狭い駐車場に前向きに駐車した後で後退しながら再出発する場合や、細街路や狭い山道等で他車とのすれ違いや行き止まりがあって後退する必要がある場合等の後退を行うことが困難な状況での後退時においても、前進時の走行軌跡に基づいた適切な走行を行わせることが可能となる。従って、運転者は後退時において、より容易な車両の運転が可能となる。
また、車両の周囲にある障害物の車両に対する相対位置を検出するとともに、その検出結果に基づいて車両の走行軌跡を検出するので、障害物を利用してより正確な走行軌跡を検出することが可能となる。
In the driving support apparatus according to claim 1 having the above-described configuration , the vehicle travel locus is detected and stored as a travel history when the vehicle moves forward, and the driver is based on the travel history stored when the vehicle moves backward. It is necessary to retreat after retreating after having parked forward in a narrow parking lot, or when there is a passing or dead end with other vehicles on narrow streets or narrow mountain roads, etc. Even when reversing in a situation where it is difficult to perform reversing, it is possible to perform appropriate traveling based on the traveling locus during forward traveling. Therefore, the driver can drive the vehicle more easily when reversing.
In addition, the relative position of the obstacle around the vehicle with respect to the vehicle is detected, and the traveling locus of the vehicle is detected based on the detection result. Therefore, a more accurate traveling locus can be detected using the obstacle. It becomes possible.

また、請求項2の運転支援装置では、車両が前進する際に車両の走行軌跡を検出して走行履歴として記憶するとともに、車両が後退する際に記憶された走行履歴に基づいて運転者の行う車両操作を支援するので、狭い駐車場に前向きに駐車した後で後退しながら再出発する場合や、細街路や狭い山道等で他車とのすれ違いや行き止まりがあって後退する必要がある場合等の後退を行うことが困難な状況での後退時においても、前進時の走行軌跡に基づいた適切な走行を行わせることが可能となる。従って、運転者は後退時において、より容易な車両の運転が可能となる。
特に、請求項2の運転支援装置では、車両の走行軌跡を撮像手段により撮像された画像に重畳し、重畳された画像を表示することにより車両操作を支援するので、運転者は表示された車両の走行軌跡を参照することによって、前進時の走行軌跡に基づいた適切な走行を行うことが可能となる。
In the driving support device according to claim 2, when the vehicle moves forward, the driving locus of the vehicle is detected and stored as a driving history, and the driving is performed by the driver based on the driving history stored when the vehicle moves backward. Supporting vehicle operation, such as when you park again in a narrow parking lot and then start again, or when you need to retreat due to passing or dead ends with other vehicles on narrow streets or narrow mountain roads, etc. Even when reversing in a situation where it is difficult to perform reversing, it is possible to perform appropriate traveling based on the traveling locus during forward traveling. Therefore, the driver can drive the vehicle more easily when reversing.
In particular, in the driving support device according to the second aspect of the invention, the driving trajectory of the vehicle is superimposed on the image captured by the imaging unit, and the vehicle operation is supported by displaying the superimposed image. By referring to the travel trajectory, it is possible to perform appropriate travel based on the travel trajectory during forward travel.

また、請求項3の運転支援装置では、車両の走行軌跡に沿って後退するように車両を制御するので、狭い駐車場に前向きに駐車した後で後退しながら再出発する場合や、細街路や狭い山道等で他車とのすれ違いや行き止まりがあって後退する必要がある場合等の後退を行うことが困難な状況での後退時においても、前進時の走行軌跡に基づいた適切な走行を行わせることが可能となる。従って、運転者は後退時において、より容易な車両の運転が可能となる。 In the driving support device according to the third aspect , the vehicle is controlled so as to move backward along the traveling locus of the vehicle. Therefore, when the vehicle is parked forward in a narrow parking lot and then restarted, Appropriate travel based on the travel trajectory during forward travel is possible even when traveling backwards in situations where it is difficult to perform reverse travel, such as when it is necessary to travel backward due to a passing or dead end with a narrow mountain road. It becomes possible to make it. Therefore, the driver can drive the vehicle more easily when reversing.

また、請求項4の運転支援装置では、車両の走行軌跡を撮像手段により撮像された画像に重畳し、重畳された画像を表示することにより車両操作を支援するので、運転者は表示された車両の走行軌跡を参照することによって、前進時の走行軌跡に基づいた適切な走行を行うことが可能となる。 In the driving support device according to the fourth aspect of the invention, the driving trajectory of the vehicle is superimposed on the image captured by the imaging means and the vehicle operation is supported by displaying the superimposed image. By referring to the travel trajectory, it is possible to perform appropriate travel based on the travel trajectory during forward travel.

また、請求項5の運転支援装置では、前進時に運転者が行った車両操作に基づいた車両操作が行われるように車両を制御するので、狭い駐車場に前向きに駐車した後で後退しながら再出発する場合や、細街路や狭い山道等で他車とのすれ違いや行き止まりがあって後退する必要がある場合等の後退を行うことが困難な状況での後退時においても、前進時の車両操作に基づいた適切な走行を行わせることが可能となる。従って、運転者は後退時において、より容易な車両の運転が可能となる。 In the driving support device according to the fifth aspect , the vehicle is controlled so that the vehicle operation based on the vehicle operation performed by the driver at the time of forward movement is performed. Vehicle operation when moving forward even when going backwards in situations where it is difficult to move backward, such as when leaving or when it is necessary to move backward due to passing or dead ends with narrow streets or narrow mountain roads, etc. It is possible to perform appropriate traveling based on the above. Therefore, the driver can drive the vehicle more easily when reversing.

また、請求項6の運転支援装置では、車両が細街路又は駐車場内に進入した場合に車両の走行軌跡を検出するとともに車両操作を支援するので、後退を行うことが困難な状況での後退時においては前進時の車両操作に基づいた適切な走行を行わせることが可能となるとともに、後退を行うことが困難な状況以外では制御部の処理負担を軽減させることが可能となる。 In the driving support device according to the sixth aspect, when the vehicle enters the narrow street or the parking lot, the driving locus of the vehicle is detected and the vehicle operation is supported. In this case, it is possible to perform an appropriate travel based on the vehicle operation at the time of forward movement, and it is possible to reduce the processing load of the control unit except in a situation where it is difficult to perform the backward movement.

以下、本発明に係る運転支援装置について具体化した第1乃至第3実施形態に基づき図面を参照しつつ詳細に説明する。   Hereinafter, a driving support device according to the present invention will be described in detail with reference to the drawings based on first to third embodiments.

(第1実施形態)
先ず、第1実施形態に係る運転支援装置1の概略構成について図1及び図2を用いて説明する。図1は第1実施形態に係る運転支援装置1の概略構成図、図2は第1実施形態に係る運転支援装置1を構成する車両2の制御系を模式的に示すブロック図である。
図1及び図2に示すように、第1実施形態に係る運転支援装置1は、車両2に対して設置された後方カメラ(撮像手段)3と、運転支援ECU(走行情報検出手段、後退判定手段、障害物検出手段、位置検出手段、走行軌跡検出手段、車両制御手段、画像重畳手段、車両操作制御手段)4と、液晶ディスプレイ(画像表示手段)5と、タッチパネル6と、スピーカ7と、現在地検出部(進入検出手段)8と、車両DB9と、走行履歴DB(走行履歴記憶手段)10と、車両ECU11と、運転支援ECU4に接続された車速センサ12等の各種センサで構成されている。
(First embodiment)
First, a schematic configuration of the driving support device 1 according to the first embodiment will be described with reference to FIGS. 1 and 2. FIG. 1 is a schematic configuration diagram of a driving support apparatus 1 according to the first embodiment, and FIG. 2 is a block diagram schematically showing a control system of a vehicle 2 constituting the driving support apparatus 1 according to the first embodiment.
As shown in FIGS. 1 and 2, the driving assistance apparatus 1 according to the first embodiment includes a rear camera (imaging means) 3 installed on a vehicle 2 and a driving assistance ECU (running information detection means, reverse determination). Means, obstacle detection means, position detection means, travel locus detection means, vehicle control means, image superimposing means, vehicle operation control means) 4, liquid crystal display (image display means) 5, touch panel 6, speaker 7, It comprises various sensors such as a vehicle speed sensor 12 connected to a current position detection unit (entrance detection means) 8, a vehicle DB 9, a travel history DB (travel history storage means) 10, a vehicle ECU 11, and a driving support ECU 4. .

後方カメラ3は、例えばCCD等の固体撮像素子を用いたものであり、車両2の後方に装着されたナンバープレートの上中央付近に取り付けられ、視線方向を水平より45度下方に向けて設置される。そして、後退時に車両2の進行方向となる車両後方を撮像し、その撮像した画像(以下、BGM(バック・ガイド・モニタ)画像とする)はナビゲーション装置の液晶ディスプレイ5に表示される。   The rear camera 3 uses a solid-state image sensor such as a CCD, for example, and is installed near the upper center of the license plate mounted on the rear side of the vehicle 2 and installed with the line of sight 45 degrees below the horizontal. The Then, the rear side of the vehicle, which is the traveling direction of the vehicle 2 when moving backward, is imaged, and the captured image (hereinafter referred to as a BGM (back guide monitor) image) is displayed on the liquid crystal display 5 of the navigation device.

また、運転支援ECU(エレクトロニック・コントロール・ユニット)4は、細街路や駐車場内に車両2が進入した際に、後方カメラ3により撮像した画像から車両2の周囲にある障害物を検出するとともに、検出された障害物の車両2に対する相対位置に基づいて車両2の走行軌跡を検出する処理や、後退時の車両2の予測進路を推定して、その軌跡をBGM画像に重畳させる処理を行う電子制御ユニットである。尚、運転支援ECU4はナビゲーション装置の制御に使用するECUと兼用してもよい。また、運転支援ECU4の詳細な構成については後述する。   The driving support ECU (Electronic Control Unit) 4 detects obstacles around the vehicle 2 from an image captured by the rear camera 3 when the vehicle 2 enters a narrow street or a parking lot. An electronic device that performs a process of detecting a travel locus of the vehicle 2 based on the relative position of the detected obstacle to the vehicle 2 and a process of estimating a predicted course of the vehicle 2 when reversing and superimposing the locus on the BGM image. Control unit. The driving assistance ECU 4 may also be used as an ECU used for controlling the navigation device. The detailed configuration of the driving support ECU 4 will be described later.

液晶ディスプレイ5は、車両2の室内のセンターコンソール又はパネル面に備え付けられ、後退を行う時において後方カメラ3で撮像されたBGM画像に自車の予測進路の軌跡を重畳して表示する。尚、液晶ディスプレイ5はナビゲーション装置に使用するものと兼用してもよい。   The liquid crystal display 5 is provided on the center console or panel surface in the room of the vehicle 2 and superimposes and displays the trajectory of the predicted course of the own vehicle on the BGM image captured by the rear camera 3 when reversing. Note that the liquid crystal display 5 may also be used for a navigation device.

タッチパネル6は、液晶ディスプレイ5の前面に配置され、ユーザにより接触された部分の座標位置を特定し、特定した座標位置情報に基づいてユーザがどこに触れたか、更に、触れた箇所がどの方向に移動したのかを判別することができる。そして、第1実施形態に係る運転支援装置1では、細街路や駐車場内において後退する際に車両2の制御による運転支援を行うか否かを選択したり、運転支援を中断する際に用いられる。尚、タッチパネル6の代わりにキーボード、マウス、遠隔操作用のリモートコントロール装置、ジョイスティック、ライトペン、スタイラスペン等を使用することもできる。   The touch panel 6 is disposed on the front surface of the liquid crystal display 5 and specifies the coordinate position of the part touched by the user, where the user touched based on the specified coordinate position information, and in which direction the touched part moves. Can be determined. And in the driving assistance apparatus 1 which concerns on 1st Embodiment, it is used when selecting whether driving assistance by control of the vehicle 2 is performed when retreating in a narrow street or a parking lot, or interrupting driving assistance. . Instead of the touch panel 6, a keyboard, a mouse, a remote control device for remote operation, a joystick, a light pen, a stylus pen, or the like can be used.

また、スピーカ7は、車両2の室内のセンターコンソール又はパネル面に備え付けられ、運転支援に関する案内音声や警告音等を出力する。例えば、第1実施形態に係る運転支援装置1では、車両が細街路や駐車場内での後退時において前進時の走行軌跡から外れた場合には、「走行軌跡に対して右方向にずれが生じてきます。」との音声を出力する。   The speaker 7 is provided on the center console or the panel surface in the room of the vehicle 2 and outputs a guidance voice, a warning sound, etc. regarding driving support. For example, in the driving support device 1 according to the first embodiment, when the vehicle deviates from the travel locus at the time of forward movement when retreating in a narrow street or a parking lot, “the rightward shift occurs with respect to the travel locus. Will be output. "

また、現在地検出部8は、人工衛星によって発生させられた電波を受信することにより、地球上における車両2の現在地と現在時刻を検出するGPS25と、地磁気を測定することによって車両2の絶対方位を検出する地磁気センサ26と、地図データが格納された地図DB27を備えたものであり(図2参照)、車両2の現在地と進行方向を地図上で特定することが可能となる。   The current location detection unit 8 receives the radio wave generated by the artificial satellite, thereby detecting the current location and current time of the vehicle 2 on the earth, and the absolute direction of the vehicle 2 by measuring the geomagnetism. It comprises a geomagnetic sensor 26 to be detected and a map DB 27 in which map data is stored (see FIG. 2), and the current location and traveling direction of the vehicle 2 can be specified on the map.

また、車両DB9は、車両2の形状設計値やカメラ設計値等の車両に関する各種パラメータ情報が記憶された記憶手段である。車両DB9には、例えば車両2の車輪の半径、車幅、最小旋回半径、後方カメラ3の光軸方向(第1実施形態では下方45度)や車両2に対する後方カメラ3の設置位置等について記憶されている。
そして、運転支援ECU4は後述するように車両DB9に記憶された各種パラメータ情報を用いることによって後方カメラ3で撮像された画像から車両2の走行軌跡を検出し、また、後退時における車両2の予測進路の推定を行う。
The vehicle DB 9 is a storage unit that stores various parameter information related to the vehicle such as the shape design value and camera design value of the vehicle 2. The vehicle DB 9 stores, for example, the wheel radius, vehicle width, minimum turning radius, the optical axis direction of the rear camera 3 (downward 45 degrees in the first embodiment), the installation position of the rear camera 3 with respect to the vehicle 2, and the like. Has been.
Then, the driving assistance ECU 4 detects the travel locus of the vehicle 2 from the image captured by the rear camera 3 by using various parameter information stored in the vehicle DB 9 as will be described later, and also predicts the vehicle 2 when reversing. Estimate the course.

また、走行履歴DB10は細街路や駐車場内に車両2が進入した際において、車両の前進時の走行履歴を記憶するDBである。具体的には、後方カメラ3で撮像した画像から検出した障害物の特徴点の3次元再構成結果、所定時間毎(例えば、1秒毎)の車両2の位置座標及び方向(具体的には、後方カメラ3の位置座標と方向)に関する情報や、運転者がドアミラーの角度や車両2の車高を変更する際に行った車両操作の操作内容(操作種類や操作を行ったタイミング)が累積的に記憶される(図3のS5、S6)。
尚、第1実施形態においては、車両DB9や走行履歴DB10の記憶媒体としてハードディスクが使用されるが、磁気ディスク、メモリーカード、磁気テープ、磁気ドラム、CD、MD、DVD、光ディスク、MO、ICカード、光カード等を外部記憶装置として使用することもできる。
The travel history DB 10 is a DB that stores a travel history when the vehicle moves forward when the vehicle 2 enters a narrow street or a parking lot. Specifically, as a result of the three-dimensional reconstruction of the feature points of the obstacle detected from the image captured by the rear camera 3, the position coordinates and direction of the vehicle 2 (specifically, every second) (specifically, every second) , Information on the position coordinates and direction of the rear camera 3, and the operation details (operation type and timing of operation) of the vehicle operation performed when the driver changes the angle of the door mirror or the vehicle height of the vehicle 2. (S5, S6 in FIG. 3).
In the first embodiment, a hard disk is used as a storage medium for the vehicle DB 9 and the travel history DB 10, but a magnetic disk, memory card, magnetic tape, magnetic drum, CD, MD, DVD, optical disk, MO, IC card. An optical card or the like can also be used as an external storage device.

また、運転支援ECU4には車速センサ(走行距離検出手段)12、アクセルセンサ13、ブレーキセンサ14、ステアリングセンサ15、ジャイロセンサ16、シフトレバースイッチ17の各種センサが接続されている。ここで、車速センサ12は、車両の車輪の回転に応じて車速パルスを発生させ、車両の移動距離や車速を検出するセンサである。アクセルセンサ13は運転者によるアクセルペダルの操作量を検出するセンサである。ブレーキセンサ14は運転者によるブレーキペダルの操作量を検出するセンサである。ステアリングセンサ15は、ステアリング装置の内部に取り付けられており、ステアリングホイールを転舵した場合の舵角を検出するセンサである。ジャイロセンサ16は車両2の旋回角を検出するセンサである。また、シフトレバースイッチ17は、シフトレバー(図示せず)に内蔵され、シフト位置が「P(パーキング)」、「N(ニュートラル)」、「R(リバース)」、「D(ドライブ)」、「2(2速)」、「L(ロー)」のいずれの位置となっているかを検出する。
その結果、運転支援ECU4は車速センサ12の出力信号に基づいて車両2の現在の車速を検出し、アクセルセンサ13及びブレーキセンサ14の出力信号に基づいて運転者のアクセル操作量及びブレーキ操作量を検出し、ステアリングセンサ15の出力信号に基づいて車両2の舵角を検出する。また、ジャイロセンサ16によって検出された旋回角を積分することにより、自車方位を検出する。更に、シフトレバースイッチ17によって車両2の現在のシフト位置を検出する。
The driving assistance ECU 4 is connected with various sensors such as a vehicle speed sensor (travel distance detection means) 12, an accelerator sensor 13, a brake sensor 14, a steering sensor 15, a gyro sensor 16, and a shift lever switch 17. Here, the vehicle speed sensor 12 is a sensor that generates a vehicle speed pulse in accordance with the rotation of the vehicle wheel and detects the travel distance and the vehicle speed of the vehicle. The accelerator sensor 13 is a sensor that detects the amount of operation of the accelerator pedal by the driver. The brake sensor 14 is a sensor that detects the amount of operation of the brake pedal by the driver. The steering sensor 15 is attached to the inside of the steering device, and is a sensor that detects a steering angle when the steering wheel is steered. The gyro sensor 16 is a sensor that detects the turning angle of the vehicle 2. The shift lever switch 17 is built in a shift lever (not shown), and the shift position is “P (parking)”, “N (neutral)”, “R (reverse)”, “D (drive)”, It is detected whether the position is “2 (second speed)” or “L (low)”.
As a result, the driving assistance ECU 4 detects the current vehicle speed of the vehicle 2 based on the output signal of the vehicle speed sensor 12 and determines the driver's accelerator operation amount and brake operation amount based on the output signals of the accelerator sensor 13 and the brake sensor 14. The steering angle of the vehicle 2 is detected based on the output signal of the steering sensor 15. Further, the vehicle direction is detected by integrating the turning angle detected by the gyro sensor 16. Further, the current shift position of the vehicle 2 is detected by the shift lever switch 17.

また、車両ECU11は、エンジン、変速機、ブレーキ等の作動を制御する車両2の電子制御ユニットであり、アクセル18と、ブレーキ19と、ステアリング20と、操作スイッチ21とが接続されている。そして、車両ECU11は運転支援ECU4からの指示に基づいて、アクセル18、ブレーキ19及びステアリング20を操作する。それによって、車両ECU11は後述するように前進時の車両の走行軌跡に沿って後退するように車両を制御することが可能となる。
また、操作スイッチ21は車両2に設けられたドアミラー(図示せず)の角度や車両2の車高を調整する為に運転者が操作を行う操作手段である。そして、車両ECU11は操作スイッチ21の操作情報に基づいてモータ等の駆動源を制御し、ドアミラー(図示せず)の角度や車両2の車高を調整する。
The vehicle ECU 11 is an electronic control unit for the vehicle 2 that controls the operation of the engine, transmission, brake, and the like, and is connected to an accelerator 18, a brake 19, a steering 20, and an operation switch 21. Then, the vehicle ECU 11 operates the accelerator 18, the brake 19 and the steering 20 based on an instruction from the driving support ECU 4. As a result, the vehicle ECU 11 can control the vehicle so as to move backward along the traveling locus of the vehicle when moving forward, as will be described later.
The operation switch 21 is an operation means that is operated by the driver in order to adjust the angle of a door mirror (not shown) provided in the vehicle 2 and the vehicle height of the vehicle 2. Then, the vehicle ECU 11 controls a drive source such as a motor based on the operation information of the operation switch 21 to adjust the angle of the door mirror (not shown) and the vehicle height of the vehicle 2.

次に、運転支援ECU4の詳細について図2を用いて説明すると、運転支援ECU4はCPU31を核として構成されており、CPU31には記憶手段であるROM32及びRAM33が接続されている。そして、ROM32には後方カメラ3で撮像したBGM画像から車両の走行軌跡を検出し、検出された走行軌跡に沿って車両2が後退するように制御する車両制御処理プログラム(図3参照)、その他、液晶ディスプレイ5等の制御上必要な各種のプログラム等が格納されている。また、RAM33はCPU31で演算された各種データを一時的に記憶しておくメモリである。   Next, the details of the driving assistance ECU 4 will be described with reference to FIG. 2. The driving assistance ECU 4 is configured with the CPU 31 as a core, and a ROM 32 and a RAM 33 which are storage means are connected to the CPU 31. The ROM 32 detects a vehicle travel locus from the BGM image captured by the rear camera 3 and controls the vehicle 2 to move backward along the detected travel locus (see FIG. 3). In addition, various programs necessary for controlling the liquid crystal display 5 and the like are stored. The RAM 33 is a memory for temporarily storing various data calculated by the CPU 31.

続いて、前記構成を有する第1実施形態に係る運転支援装置1の運転支援ECU4が実行する車両制御処理プログラムについて図3に基づき説明する。図3は第1実施形態に係る運転支援装置1における車両制御処理プログラムのフローチャートである。ここで、車両制御処理プログラムは、前進時において後方カメラ3で撮像したBGM画像から障害物を検出し、検出した障害物の車両2に対する相対位置に基づいて車両2の走行軌跡を検出するとともに、後退時には前進時に検出された走行軌跡に沿って後退するように車両を制御する処理を行うものである。尚、図3にフローチャートで示されるプログラムは運転支援ECU4が備えているROM32やRAM33に記憶されており、CPU31により所定間隔(例えば4ms毎)で繰り返し実行される。   Next, a vehicle control processing program executed by the driving support ECU 4 of the driving support device 1 according to the first embodiment having the above-described configuration will be described with reference to FIG. FIG. 3 is a flowchart of the vehicle control processing program in the driving support device 1 according to the first embodiment. Here, the vehicle control processing program detects an obstacle from the BGM image picked up by the rear camera 3 at the time of forward movement, detects the traveling locus of the vehicle 2 based on the relative position of the detected obstacle to the vehicle 2, and When the vehicle is moving backward, the vehicle is controlled so as to move backward along the traveling locus detected when moving forward. 3 is stored in the ROM 32 and the RAM 33 provided in the driving support ECU 4, and is repeatedly executed by the CPU 31 at predetermined intervals (for example, every 4 ms).

車両制御処理プログラムでは、先ずステップ(以下、Sと略記する)1において、CPU31はGPS25により検出した自車の現在位置と、地図DB27に記憶された地図データとに基づいてマッチング処理を行い、自車が細街路又は駐車場内に進入したか否かが判定される。尚、後方カメラ3による画像認識結果や、ミリ波レーダの検出結果によって判定することとしても良い。   In the vehicle control processing program, first, in step (hereinafter abbreviated as S) 1, the CPU 31 performs matching processing based on the current position of the vehicle detected by the GPS 25 and the map data stored in the map DB 27. It is determined whether the car has entered a narrow street or a parking lot. The determination may be made based on the image recognition result by the rear camera 3 or the detection result of the millimeter wave radar.

そして、自車が細街路又は駐車場内に進入したと判定された場合(S1:YES)にはS2へと移行する。一方、自車が細街路又は駐車場内に進入していないと判定された場合(S1:NO)には、当該車両制御処理プログラムを終了する。   And when it determines with the own vehicle having entered the narrow street or the parking lot (S1: YES), it transfers to S2. On the other hand, when it is determined that the own vehicle has not entered the narrow street or the parking lot (S1: NO), the vehicle control processing program is terminated.

S2では、後方カメラ3で撮像した画像を解析する画像解析処理が行われる。ここで、画像解析処理は、後方カメラ3によって撮像される車両2の後方環境の画像を取り込んで解析処理を行い、車両2が走行する道路沿いに位置する障害物(例えば、建築物や駐車車両等)を画像中の特徴点により検出する。ここで、特徴点とは障害物のエッジやコーナ等が相当し、後述する画像のシーケンスに沿って追跡可能な特徴を有する対象である。   In S2, an image analysis process for analyzing an image captured by the rear camera 3 is performed. Here, the image analysis processing takes an image of the rear environment of the vehicle 2 captured by the rear camera 3 and performs analysis processing, and an obstacle (for example, a building or a parked vehicle) located along the road on which the vehicle 2 travels. Etc.) are detected from the feature points in the image. Here, the feature point corresponds to an edge of an obstacle, a corner, or the like, and is an object having a feature that can be traced along an image sequence to be described later.

以下に、前記S2の画像解析処理について具体例を用いて説明する。図4は細街路を前進する車両2を所定のタイミングで示した斜視図である。図5は図4に示すタイミングで車両2の後方カメラ3により撮像した撮像画像50を示した図である。
図4に示すように、車両2が走行する細街路には道路51沿いに障害物52〜57が位置する。そして、図4に示す車両2の位置58から後方カメラ3により撮像した撮像画像50は、図5に示すように後方バンパ59とともに障害物52〜55が撮像される。そして、前記S2の画像解析処理では、CPU31は行列式による自動相関(automatic correlation)を用いて障害物52〜55の特徴点60を検出する。そして、検出された各特徴点60の撮像画像50内における位置座標(u,v)がRAM33に記憶される。尚、撮像された撮像画像50からの特徴点60の検出方法の詳細については既に公知技術(例えば、特開2004−297808号公報、段落(0041)〜(0042)参照)であるので、その説明は省略する。
Hereinafter, the image analysis process of S2 will be described using a specific example. FIG. 4 is a perspective view showing the vehicle 2 moving forward on the narrow street at a predetermined timing. FIG. 5 is a diagram illustrating a captured image 50 captured by the rear camera 3 of the vehicle 2 at the timing illustrated in FIG. 4.
As shown in FIG. 4, obstacles 52 to 57 are located along the road 51 in the narrow street where the vehicle 2 travels. Then, in the captured image 50 captured by the rear camera 3 from the position 58 of the vehicle 2 illustrated in FIG. 4, the obstacles 52 to 55 are captured together with the rear bumper 59 as illustrated in FIG. 5. In the image analysis process of S2, the CPU 31 detects the feature points 60 of the obstacles 52 to 55 using automatic correlation using a determinant. Then, the position coordinates (u, v) of the detected feature points 60 in the captured image 50 are stored in the RAM 33. The details of the method of detecting the feature point 60 from the captured image 50 are already known techniques (see, for example, Japanese Patent Application Laid-Open No. 2004-297808, paragraphs (0041) to (0042)). Is omitted.

次に、S3では前記S2で検出した障害物の特徴点60について微少時間後の移動量を検出する追跡処理を行う。ここで、特徴点の追跡処理は、サンプリング周期が十分短ければ微小時間後の画像はその輝度値は変化しないと仮定し、微小時間経過後の各特徴点60の変位ベクトルを算出する。そして、その後に車両2から撮像された撮像画像50から検出された特徴点60と比較することにより、特徴点60の追跡が行われる。   Next, in S3, a tracking process for detecting a movement amount after a minute time is performed on the feature point 60 of the obstacle detected in S2. Here, in the feature point tracking process, if the sampling period is sufficiently short, it is assumed that the luminance value of the image after the minute time does not change, and the displacement vector of each feature point 60 after the minute time has elapsed is calculated. Then, the feature point 60 is tracked by comparing with the feature point 60 detected from the captured image 50 captured from the vehicle 2 thereafter.

以下に、前記S3の特徴点の追跡処理について具体例を用いて説明する。図6は車両2が図5に示すタイミングで後方カメラ3により撮像された撮像画像50における特徴点60の微少時間(dt)経過後の変位ベクトル61を示した図である。尚、特徴点60の微小時間経過後における変位ベクトル61の算出方法の詳細については既に公知技術(例えば、特開2004−297808号公報、段落(0043)〜(0045)参照)であるので、その説明は省略する。
そして、微少時間(dt)経過後の車両位置65(図4参照)から後方カメラ3により撮像された新たな撮像画像50における特徴点60を再度検出し、更に、図6に示す算出された特徴点60の変位ベクトル61に沿って特徴点60が位置するか否かを判定することにより、特徴点の追跡が行われる。
Hereinafter, the feature point tracking process of S3 will be described using a specific example. FIG. 6 is a diagram showing a displacement vector 61 after the minute time (dt) of the feature point 60 in the captured image 50 captured by the rear camera 3 at the timing shown in FIG. The details of the method of calculating the displacement vector 61 after the minute time of the feature point 60 has already been known (see, for example, JP-A-2004-297808, paragraphs (0043) to (0045)). Description is omitted.
Then, the feature point 60 in the new captured image 50 captured by the rear camera 3 from the vehicle position 65 (see FIG. 4) after the minute time (dt) has elapsed is detected again, and the calculated feature shown in FIG. The feature point is tracked by determining whether or not the feature point 60 is located along the displacement vector 61 of the point 60.

続いて、S4では撮像画像50における特徴点60の位置座標(u,v)に基づいて、車両2の後方カメラ3の位置に対する特徴点60の3次元座標(x,y,z)を算出し、更に、前記S3で算出された特徴点60の変位ベクトル61を考慮して、複数回取得した撮像画像上の特徴点60のトラックに対応する3次元特徴点の再構成を行う。その結果、車両2の後方カメラ3に対する相対的な特徴点60の位置が特定され、更に、特徴点60の位置を用いて車両2の走行した正確な走行軌跡が検出されることとなる。尚、特徴点60のトラックに対応する3次元特徴点の再構成処理については既に公知技術(例えば、特開2004−297808号公報、段落(0047)〜(0064)参照)であるので、その説明は省略する。また、上記S2及びS3の処理が障害物検出手段の処理に相当し、上記S4の処理が位置検出手段及び走行軌跡検出手段の処理に相当し、S2乃至S4の処理が走行情報検出手段の処理に相当する。   Subsequently, in S4, based on the position coordinates (u, v) of the feature point 60 in the captured image 50, the three-dimensional coordinates (x, y, z) of the feature point 60 with respect to the position of the rear camera 3 of the vehicle 2 are calculated. Further, in consideration of the displacement vector 61 of the feature point 60 calculated in S3, a three-dimensional feature point corresponding to the track of the feature point 60 on the captured image acquired a plurality of times is reconstructed. As a result, the position of the feature point 60 relative to the rear camera 3 of the vehicle 2 is specified, and an accurate travel locus traveled by the vehicle 2 is detected using the position of the feature point 60. Note that the reconstruction process of the three-dimensional feature point corresponding to the track of the feature point 60 is already known technology (see, for example, Japanese Patent Application Laid-Open No. 2004-297808, paragraphs (0047) to (0064)). Is omitted. Further, the processing of S2 and S3 corresponds to the processing of the obstacle detection means, the processing of S4 corresponds to the processing of the position detection means and the travel locus detection means, and the processing of S2 to S4 is the processing of the travel information detection means. It corresponds to.

次に、S5でCPU31は前記S4における3次元特徴点の再構成結果をRAM33に保存するとともに、時間毎(例えば、1秒毎)の車両2(具体的には、後方カメラ3)の位置と方向をGPS25及び地磁気センサ26により検出し、RAM33に保存する。それにより、車両2の前進時における走行軌跡(走行情報)が走行履歴として保存されることとなる。   Next, in S5, the CPU 31 stores the reconstruction result of the three-dimensional feature points in S4 in the RAM 33, and also determines the position of the vehicle 2 (specifically, the rear camera 3) for each time (for example, every second). The direction is detected by the GPS 25 and the geomagnetic sensor 26 and stored in the RAM 33. As a result, a travel locus (travel information) when the vehicle 2 moves forward is stored as a travel history.

更に、S6では操作スイッチ21の操作によってミラーの操作や車両2の車高を変更する操作等の車両操作が行われた場合に、操作時点での自車の現在位置(具体的には、後方カメラ3の位置)に対応付けて、車両操作の操作内容(例えば、ドアミラーを30度開く、車高を10cm上げる等)が走行履歴として保存される。   Further, in S6, when a vehicle operation such as a mirror operation or an operation for changing the vehicle height of the vehicle 2 is performed by operating the operation switch 21, the current position of the vehicle at the time of operation (specifically, the rear In association with the position of the camera 3, operation details of the vehicle operation (for example, opening the door mirror by 30 degrees, raising the vehicle height by 10 cm, etc.) are stored as a travel history.

その後、S7でCPU31はGPS25により検出した自車の現在位置と、地図DB27に記憶された地図データとに基づいて、自車が細街路又は駐車場から脱出したか否かが判定される。尚、後方カメラ3による画像認識結果やミリ波レーダの検出結果に基づいて判定することとしても良い。   Thereafter, in S7, the CPU 31 determines whether or not the own vehicle has escaped from the narrow street or the parking lot based on the current position of the own vehicle detected by the GPS 25 and the map data stored in the map DB 27. The determination may be based on the image recognition result by the rear camera 3 or the detection result of the millimeter wave radar.

そして、自車が細街路又は駐車場から脱出したと判定された場合(S7:YES)には、前記S5やS6でRAM33に記憶された車両2の走行履歴をクリア(S8)して当該車両制御処理プログラムを終了する。   If it is determined that the vehicle has escaped from the narrow street or the parking lot (S7: YES), the travel history of the vehicle 2 stored in the RAM 33 in S5 or S6 is cleared (S8), and the vehicle The control processing program is terminated.

一方、自車が細街路又は駐車場を継続して走行中であると判定された場合(S7:NO)には、S9でCPU31は、シフトレバースイッチ17の検出結果に基づいて車両2のシフトレバーがリバースとなったか否か、即ち、細街路又は駐車場内で車両2を後退したか否かを判定する。尚、上記S9の処理が後退判定手段の処理に相当する。   On the other hand, if it is determined that the vehicle is traveling on the narrow street or the parking lot (S7: NO), the CPU 31 shifts the vehicle 2 based on the detection result of the shift lever switch 17 in S9. It is determined whether or not the lever is reverse, that is, whether or not the vehicle 2 has moved backward in the narrow street or the parking lot. Note that the process of S9 corresponds to the process of the reverse determination means.

そして、車両2のシフトレバーがリバースでないと判定された場合(S9:NO)にはS2へと戻り、再び車両2の走行情報を検出するとともに検出された走行情報を走行履歴としてRAM33に保存する。一方、リバースとなったと判定された場合(S9:YES)には、保存された走行履歴に基づく後退時の車両2の制御(即ち、運転者の車両操作の支援)を行うか否かのアシスト実行確認画面70を液晶ディスプレイ5に対して表示する(S10)。
ここで、図7は液晶ディスプレイ5に表示されたアシスト実行確認画面70を示した図である。アシスト実行確認画面70は、図7に示すように「後退時のアシストを行いますか?」との文字71が中央部に表示され、更にアイコン72、73が文字71の下方に表示される。そして、運転者は保存された走行履歴に基づく後退時の車両2の制御が行われることを希望する場合には、アイコン72をタッチパネル6により選択する。一方、保存された走行履歴に基づく後退時の車両2の制御が行われることを希望しない場合には、アイコン73をタッチパネル6により選択する。
If it is determined that the shift lever of the vehicle 2 is not reverse (S9: NO), the process returns to S2, and the travel information of the vehicle 2 is detected again and the detected travel information is stored in the RAM 33 as a travel history. . On the other hand, if it is determined that the vehicle is reverse (S9: YES), whether or not to perform control of the vehicle 2 at the time of reverse based on the saved travel history (that is, assistance to the driver's vehicle operation) is determined. An execution confirmation screen 70 is displayed on the liquid crystal display 5 (S10).
Here, FIG. 7 is a diagram showing an assist execution confirmation screen 70 displayed on the liquid crystal display 5. On the assist execution confirmation screen 70, as shown in FIG. 7, a character 71 “Would you like to assist when reversing?” Is displayed in the center, and icons 72 and 73 are displayed below the character 71. When the driver desires to perform control of the vehicle 2 at the time of reverse based on the saved traveling history, the driver selects the icon 72 with the touch panel 6. On the other hand, when it is not desired that the control of the vehicle 2 at the time of reverse based on the saved travel history is desired, the icon 73 is selected by the touch panel 6.

次に、S11では運転者によるアイコン72、73の選択に基づいて、保存された走行履歴に基づく後退時の車両2の制御(即ち、運転者の車両操作の支援)を行うか否かが判定される。その結果、車両2の制御を行わないと判定された場合(S11:NO)、即ちアシスト実行確認画面70においてアイコン73が選択された場合には、前記S5やS6でRAM33に記憶された車両2の走行履歴をクリア(S8)して当該車両制御処理プログラムを終了する。   Next, in S11, based on the selection of the icons 72 and 73 by the driver, it is determined whether or not to control the vehicle 2 at the time of reverse based on the saved travel history (that is, assisting the driver to operate the vehicle). Is done. As a result, when it is determined not to control the vehicle 2 (S11: NO), that is, when the icon 73 is selected on the assist execution confirmation screen 70, the vehicle 2 stored in the RAM 33 in S5 or S6. Is cleared (S8) and the vehicle control processing program is terminated.

一方、車両2の制御を行うと判定された場合(S11:YES)、即ちアシスト実行確認画面70においてアイコン72が選択された場合には、S12へと移行する。
S12では後方カメラ3で撮像した画像を解析する画像解析処理が行われ、更に、S13では前記S12で検出した障害物の特徴点60について微少時間後の移動量を検出する追跡処理を行う。そして、S14では前記S13で算出された特徴点60の変位ベクトル61を考慮して、複数回取得した撮像画像上の特徴点60のトラックに対応する3次元特徴点の再構成を行う。尚、S12乃至S14の処理は細街路又は駐車場内を前進する際に行われる前記S2乃至S4の処理と同様であるので、ここではその説明は省略する。
On the other hand, when it is determined that the vehicle 2 is to be controlled (S11: YES), that is, when the icon 72 is selected on the assist execution confirmation screen 70, the process proceeds to S12.
In S12, an image analysis process for analyzing an image captured by the rear camera 3 is performed, and in S13, a tracking process for detecting a movement amount after a minute time is performed on the feature point 60 of the obstacle detected in S12. In S14, the three-dimensional feature point corresponding to the track of the feature point 60 on the captured image acquired a plurality of times is reconstructed in consideration of the displacement vector 61 of the feature point 60 calculated in S13. Note that the processing of S12 to S14 is the same as the processing of S2 to S4 that is performed when moving forward in a narrow street or a parking lot, and thus the description thereof is omitted here.

次に、S15ではCPU31は前記S14で行われた3次元特徴点の再構成結果と、車両2の前進時において前記S5で保存された3次元特徴点の再構成結果を比較するとともに、更に、前進時においてRAM33に保存された車両2の位置及び方向に対する車両の現在の位置及び方向を比較する。それによって、前進時の走行軌跡に対する後退時の車両2の位置及び方向(具体的には後方カメラ3の位置及び方向)のずれを算出する(S16)。その後、CPU31は算出された位置及び方向のずれをなくす為のアクセル18、ブレーキ19、ステアリング20の作動量を算出し、車両ECU11に対して制御の指示を送信する(S17)。その結果、前進時の走行軌跡に沿って後退するように車両2の制御が行われる。
また、前記S6で車両操作の操作内容が記憶されている場合には、前進時と対応する自車位置で、対応する車両操作が行われるように制御する。例えば、前進時の所定地点でドアミラーを30度閉じる操作が行われていた場合には、後退時の同地点でドアミラーを30度開く操作を行うように制御する。また、前進時の所定地点で車高を10cm下げる操作が行われていた場合には、後退時の同地点で車高を10cm上げる操作を行うように制御する。尚、上記S17の処理が車両制御手段及び車両操作制御手段の処理に相当する。
Next, in S15, the CPU 31 compares the reconstruction result of the three-dimensional feature point performed in S14 with the reconstruction result of the three-dimensional feature point stored in S5 when the vehicle 2 moves forward. When the vehicle is moving forward, the current position and direction of the vehicle are compared with the position and direction of the vehicle 2 stored in the RAM 33. Thereby, a deviation of the position and direction of the vehicle 2 when traveling backward (specifically, the position and direction of the rear camera 3) with respect to the traveling locus when traveling forward is calculated (S16). Thereafter, the CPU 31 calculates the operation amounts of the accelerator 18, the brake 19 and the steering 20 for eliminating the displacement of the calculated position and direction, and transmits a control instruction to the vehicle ECU 11 (S17). As a result, the control of the vehicle 2 is performed so that the vehicle 2 moves backward along the traveling locus during forward movement.
When the operation details of the vehicle operation are stored in S6, control is performed so that the corresponding vehicle operation is performed at the own vehicle position corresponding to the time of forward movement. For example, when an operation of closing the door mirror 30 degrees at a predetermined point at the time of forward movement is performed, control is performed so as to perform an operation of opening the door mirror 30 degrees at the same point at the time of backward movement. Further, when an operation for lowering the vehicle height by 10 cm is performed at a predetermined point during forward travel, control is performed so as to perform an operation for increasing the vehicle height by 10 cm at the same point during backward travel. The process of S17 corresponds to the process of the vehicle control means and the vehicle operation control means.

ここで、図8及び図9を用いて前記S15〜S17の処理について具体的に説明する。図8は図4に示す細街路を後退する車両2を所定のタイミングで示した斜視図、図9は同じタイミングで図4に示す細街路を後退する車両2を示した上面図である。
前記S12乃至S14の処理により特徴点60のトラックに対応する3次元特徴点の再構成を行うと、図8に示すように車両2が後方カメラ3により撮像した画像に基づいて特徴点60が検出される。そして、図9に示すように車両2の前進時の車両方向θ1と後退時の車両方向θ2とから車両方向のずれを算出する。また、前進時の走行軌跡75と後退時の車両2の現在位置(具体的には後方カメラ3の位置)との間隔dから、車両位置のずれを算出する。そして算出された車両方向と車両位置のずれを無くすように車両の制御が行われる。
Here, the processing of S15 to S17 will be specifically described with reference to FIGS. FIG. 8 is a perspective view showing the vehicle 2 retreating the narrow street shown in FIG. 4 at a predetermined timing, and FIG. 9 is a top view showing the vehicle 2 retreating the narrow street shown in FIG. 4 at the same timing.
When the three-dimensional feature point corresponding to the track of the feature point 60 is reconstructed by the processing of S12 to S14, the feature point 60 is detected based on the image captured by the vehicle 2 with the rear camera 3 as shown in FIG. Is done. Then, as shown in FIG. 9, the deviation in the vehicle direction is calculated from the vehicle direction θ1 when the vehicle 2 moves forward and the vehicle direction θ2 when the vehicle moves backward. Further, the deviation of the vehicle position is calculated from the distance d between the travel locus 75 when moving forward and the current position of the vehicle 2 when moving backward (specifically, the position of the rear camera 3). Then, the vehicle is controlled so as to eliminate the deviation between the calculated vehicle direction and the vehicle position.

次に、S18でCPU31は、前記S5及びS6で保存された前進時の車両2の走行履歴と異なる車両操作が行われたか否かを判定する。ここで、前進時の車両2の走行履歴と異なる車両操作が行われる場合とは、例えば、前進時には所定地点で直進しているのに対して、後退時に同地点で右折又は左折を行った場合等がある。   Next, in S18, the CPU 31 determines whether or not a vehicle operation different from the traveling history of the vehicle 2 during forward movement stored in S5 and S6 has been performed. Here, the case where the vehicle operation different from the traveling history of the vehicle 2 at the time of forward is performed is, for example, when the vehicle travels straight at a predetermined point when traveling forward, but makes a right turn or a left turn at the same point when traveling backward Etc.

そして、走行履歴と異なる車両操作が行われたと判定した場合(S18:YES)には、運転者は前進時と異なる走行経路を走行すると判定し、車両の制御を中止する。そして、前記S5やS6でRAM33に記憶された車両2の走行履歴をクリア(S8)して当該車両制御処理プログラムを終了する。   When it is determined that a vehicle operation different from the travel history has been performed (S18: YES), the driver determines that the vehicle travels on a travel route different from the forward travel time, and stops the control of the vehicle. Then, the traveling history of the vehicle 2 stored in the RAM 33 in S5 or S6 is cleared (S8), and the vehicle control processing program is terminated.

一方、走行履歴と異なる車両操作が行われない場合(S18:NO)には、更に、S19でCPU31はGPS25により検出した自車の現在位置と、地図DB27に記憶された地図データとに基づいて、自車が細街路又は駐車場から脱出したか否かが判定される。尚、後方カメラ3による画像認識結果やミリ波レーダの検出結果に基づいて判定することとしても良い。   On the other hand, when the vehicle operation different from the travel history is not performed (S18: NO), the CPU 31 further determines based on the current position of the vehicle detected by the GPS 25 in S19 and the map data stored in the map DB 27. It is determined whether the vehicle has escaped from the narrow street or the parking lot. The determination may be based on the image recognition result by the rear camera 3 or the detection result of the millimeter wave radar.

そして、自車が細街路又は駐車場から脱出したと判定された場合(S19:YES)には、前記S5やS6でRAM33に記憶された車両2の走行履歴をクリア(S8)して当該車両制御処理プログラムを終了する。   If it is determined that the vehicle has escaped from the narrow street or the parking lot (S19: YES), the travel history of the vehicle 2 stored in the RAM 33 in S5 or S6 is cleared (S8), and the vehicle The control processing program is terminated.

一方、自車が細街路又は駐車場を継続して走行中であると判定された場合(S19:NO)にはS12へと戻り、再度、後方カメラ3で撮像した画像から3次元特徴点の再構成処理を行い、前進時との走行軌跡とのずれを算出する。   On the other hand, when it is determined that the vehicle is continuously traveling on the narrow street or the parking lot (S19: NO), the process returns to S12, and again, the three-dimensional feature point is detected from the image captured by the rear camera 3. A reconstruction process is performed to calculate a deviation from the travel locus when the vehicle is moving forward.

以上詳細に説明した通り、第1実施形態に係る運転支援装置1では車両2が細街路又は駐車場内に進入した際に、後方カメラ3で撮像した撮像画像50から障害物の特徴点60を検出するとともに検出結果に基づいて車両2の走行軌跡75を検出して保存し(S2〜S5)、車両2が細街路又は駐車場内で後退を行う際には、保存された走行軌跡75に沿って車両2が後退するように車両の制御を行う(S17)ので、狭い駐車場に前向きに駐車した後で後退しながら再出発する場合や、細街路や狭い山道等で他車とのすれ違いや行き止まりがあって後退する必要がある場合等の後退を行うことが困難な状況での後退時においても、前進時の車両の走行軌跡75に基づいた適切な走行を行わせることが可能となる。従って、運転者は後退時において、より容易な車両2の運転が可能となる。
また、後方カメラ3によって障害物の特徴点60を検出し、自車位置に対する特徴点60の相対位置に基づいて車両2の前進時の走行軌跡を検出するので、GPSや地図データに基づいて走行軌跡を検出する場合と比較して、正確な走行軌跡の検出が可能となる。
更に、車両2が細街路又は駐車場内に進入した場合のみに車両2の走行情報を検出するとともに車両操作を支援するので、後退を行うことが困難な状況以外では運転支援ECU4の処理負担を軽減させることが可能となる。
As described above in detail, in the driving support device 1 according to the first embodiment, when the vehicle 2 enters the narrow street or the parking lot, the feature point 60 of the obstacle is detected from the captured image 50 captured by the rear camera 3. At the same time, the travel locus 75 of the vehicle 2 is detected and stored based on the detection result (S2 to S5), and when the vehicle 2 moves backward in the narrow street or the parking lot, it follows the saved travel locus 75. Since the vehicle is controlled so that the vehicle 2 moves backward (S17), when the vehicle is parked forward in a narrow parking lot and then departs while retreating, or when the vehicle 2 passes or stops on a narrow street or a narrow mountain road. Even when reversing in a situation where it is difficult to retreat, such as when there is a need to retreat, it is possible to perform appropriate traveling based on the traveling locus 75 of the vehicle during forward traveling. Therefore, the driver can drive the vehicle 2 more easily when reversing.
Further, the feature point 60 of the obstacle is detected by the rear camera 3, and the traveling locus of the vehicle 2 when the vehicle 2 moves forward is detected based on the relative position of the feature point 60 with respect to the own vehicle position. Compared with the case of detecting the locus, it is possible to detect the traveling locus more accurately.
Further, since the travel information of the vehicle 2 is detected and the vehicle operation is supported only when the vehicle 2 enters the narrow street or the parking lot, the processing load of the driving support ECU 4 is reduced except when it is difficult to move backward. It becomes possible to make it.

(第2実施形態)
次に、第2実施形態に係る運転支援装置について図10乃至図12に基づいて説明する。尚、以下の説明において上記図1乃至図9の第1実施形態に係る運転支援装置1の構成と同一符号は、前記第1実施形態に係る運転支援装置1等の構成と同一あるいは相当部分を示すものである。
(Second Embodiment)
Next, the driving support device according to the second embodiment will be described with reference to FIGS. In the following description, the same reference numerals as those of the driving support apparatus 1 according to the first embodiment in FIGS. 1 to 9 denote the same or corresponding parts as those of the driving support apparatus 1 according to the first embodiment. It is shown.

この第2実施形態に係る運転支援装置の概略構成は、第1実施形態に係る運転支援装置1とほぼ同じ構成である。また、各種制御処理も第1実施形態に係る運転支援装置1とほぼ同じ制御処理である。
ただし、第1実施形態に係る運転支援装置1が、前進時の走行軌跡を保存し、前進時の走行軌跡に沿った後退を行うように車両を制御することにより運転者の運転支援を行うのに対し、第2実施形態に係る運転支援装置では、前進時の走行軌跡を保存し、BGM画像に前進時の走行軌跡を重畳して表示することにより運転者の運転支援を行う点で前記第1実施形態に係る運転支援装置1と異なっている。
The schematic configuration of the driving support apparatus according to the second embodiment is substantially the same as that of the driving support apparatus 1 according to the first embodiment. Various control processes are also substantially the same as the driving support apparatus 1 according to the first embodiment.
However, the driving assistance device 1 according to the first embodiment saves the traveling locus at the time of forward travel, and performs driving assistance of the driver by controlling the vehicle so as to move backward along the traveling locus at the time of forward travel. On the other hand, in the driving support device according to the second embodiment, the driving trajectory at the time of forward is stored, and the driving trajectory at the time of forward is superimposed on the BGM image to display the driving assistance of the driver. This is different from the driving support device 1 according to the embodiment.

以下に、第2実施形態に係る運転支援装置の運転支援ECU4が実行する車両制御処理プログラムについて図10に基づき説明する。図10は第2実施形態に係る運転支援装置における車両制御処理プログラムのフローチャートである。尚、図10にフローチャートで示されるプログラムは運転支援ECU4が備えているROM32やRAM33に記憶されており、CPU31により所定間隔(例えば4ms毎)で繰り返し実行される。   Below, the vehicle control processing program which driving assistance ECU4 of the driving assistance device which concerns on 2nd Embodiment performs is demonstrated based on FIG. FIG. 10 is a flowchart of a vehicle control processing program in the driving support apparatus according to the second embodiment. Note that the program shown in the flowchart of FIG. 10 is stored in the ROM 32 and RAM 33 provided in the driving support ECU 4 and is repeatedly executed by the CPU 31 at predetermined intervals (for example, every 4 ms).

ここで、第2実施形態に係る運転支援装置で実行される車両制御処理プログラムのS101〜S110の処理は、前記第1実施形態に係る運転支援装置1で実行される車両制御処理プログラムのS1〜S5、S7〜S11の処理と同様であるので、ここではその説明は省略する。   Here, the processes of S101 to S110 of the vehicle control processing program executed by the driving support device according to the second embodiment are the same as S1 of the vehicle control processing program executed by the driving support device 1 of the first embodiment. Since it is the same as the process of S5 and S7-S11, the description is abbreviate | omitted here.

次に、S111においてCPU31は後方カメラ3で撮像したBGM画像に対して、前記S104で3次元特徴点の再構成結果と車両の位置情報に基づいて検出されるとともに、前記S105でRAM33に対して保存された前進時の走行軌跡を重畳させる。尚、上記S111の処理が画像重畳手段の処理に相当する。   Next, in S111, the CPU 31 detects a BGM image captured by the rear camera 3 in S104 based on the reconstruction result of the three-dimensional feature points and the vehicle position information, and in S105, the RAM 31 detects the BGM image. Superimpose the saved travel trajectory during forward travel. The process of S111 corresponds to the process of the image superimposing means.

更に、S112でCPU31は車両DB9に記憶された車両2に関する情報や、車速センサ12、ステアリングセンサ15及びジャイロセンサ16の各種センサの検出結果に基づいて、車両2の後退時の予測進路を算出する。   Further, in S112, the CPU 31 calculates a predicted course when the vehicle 2 moves backward based on information related to the vehicle 2 stored in the vehicle DB 9 and detection results of various sensors of the vehicle speed sensor 12, the steering sensor 15, and the gyro sensor 16. .

続いて、S113においてCPU31は後方カメラ3で撮像したBGM画像に対して、前記S112で算出された車両2の後退時の予測進路を重畳させる。   Subsequently, in S113, the CPU 31 superimposes the predicted course when the vehicle 2 moves backward in S112 on the BGM image captured by the rear camera 3.

そして、S114では車両2の前進時の走行軌跡と後退時の予測進路とが重畳されたBGM画像を液晶ディスプレイ5に対して表示する。ここで、図11及び図12は車両2の後退時に液晶ディスプレイ5に対して表示されるBGM画像101を示した図である。
BGM画像101は、後方カメラ3により撮像された車両2の後方環境が表示されるものであり、例えば、図11及び図12では車両2の右斜め後方に対して存在する障害物102等が表示される。また、第2実施形態に係る運転支援装置では、BGM画像101には車両2の前進時の走行軌跡103と後退時の予測進路104とがそれぞれ異なる種類の線(例えば、走行軌跡103が破線で予測進路104が実線)によって表示される。特に、図11は走行軌跡103に対して予測進路104が外れている場合を示すものであり、図12は運転者がステアリング20を操作することによって、走行軌跡103に対して予測進路104を一致させた場合を示すものである。
従って、運転者はBGM画像101を参照することにより、前進時に走行した走行軌跡103を容易に把握することが可能であり、更に、ステアリング20を操作して車両2の後退時の予測進路104を走行軌跡103に一致させる(図12参照)ことにより、前進時の走行軌跡に沿った適切な走行を行うことが可能となる。
In S <b> 114, a BGM image in which the traveling locus when the vehicle 2 moves forward and the predicted course when moving backward is superimposed is displayed on the liquid crystal display 5. Here, FIGS. 11 and 12 are views showing a BGM image 101 displayed on the liquid crystal display 5 when the vehicle 2 moves backward.
The BGM image 101 displays the rear environment of the vehicle 2 captured by the rear camera 3. For example, in FIG. 11 and FIG. Is done. Further, in the driving support apparatus according to the second embodiment, the BGM image 101 includes different types of lines (for example, the traveling locus 103 is a broken line) in the traveling path 103 when the vehicle 2 moves forward and the predicted course 104 when the vehicle moves backward. The predicted course 104 is indicated by a solid line). In particular, FIG. 11 shows a case where the predicted course 104 is deviated from the travel locus 103, and FIG. 12 shows that the predicted course 104 matches the travel locus 103 when the driver operates the steering wheel 20. It shows the case where it was made to do.
Therefore, by referring to the BGM image 101, the driver can easily grasp the traveling locus 103 that has traveled when moving forward, and further, by operating the steering wheel 20, the predicted course 104 when the vehicle 2 moves backward is displayed. By making it coincide with the traveling locus 103 (see FIG. 12), it is possible to perform an appropriate traveling along the traveling locus during forward movement.

次に、S115でCPU31は、前記S105で保存された前進時の車両2の走行履歴と異なる車両操作が行われたか否かを判定する。ここで、前進時の車両2の走行履歴と異なる車両操作が行われる場合とは、例えば、前進時には所定地点で直進しているのに対して、後退時に同地点で右折又は左折を行った場合等がある。   Next, in S115, the CPU 31 determines whether or not a vehicle operation different from the traveling history of the vehicle 2 at the time of advance stored in S105 has been performed. Here, the case where the vehicle operation different from the traveling history of the vehicle 2 at the time of forward is performed is, for example, when the vehicle travels straight at a predetermined point when traveling forward, but makes a right turn or a left turn at the same point when traveling backward Etc.

そして、走行履歴と異なる車両操作が行われたと判定した場合(S115:YES)には、運転者は前進時と異なる走行経路を走行すると判定し、BGM画像101において前進時の走行軌跡103の表示を中止する。そして、前記S105でRAM33に記憶された車両2の走行履歴をクリア(S107)して当該車両制御処理プログラムを終了する。   If it is determined that a vehicle operation different from the travel history is performed (S115: YES), the driver determines that the vehicle travels on a travel route different from the forward travel time, and the travel trajectory 103 during forward travel is displayed in the BGM image 101. Cancel. Then, the traveling history of the vehicle 2 stored in the RAM 33 in S105 is cleared (S107), and the vehicle control processing program is terminated.

一方、走行履歴と異なる車両操作が行われない場合(S115:NO)には、更に、S116でCPU31はGPS25により検出した自車の現在位置と、地図DB27に記憶された地図データとに基づいて、自車が細街路又は駐車場から脱出したか否かが判定される。尚、後方カメラ3による画像認識結果やミリ波レーダの検出結果に基づいて判定することとしても良い。   On the other hand, if a vehicle operation different from the travel history is not performed (S115: NO), the CPU 31 further determines in S116 based on the current position of the vehicle detected by the GPS 25 and the map data stored in the map DB 27. It is determined whether the vehicle has escaped from the narrow street or the parking lot. The determination may be based on the image recognition result by the rear camera 3 or the detection result of the millimeter wave radar.

そして、自車が細街路又は駐車場から脱出したと判定された場合(S116:YES)には、BGM画像101において前進時の走行軌跡103の表示を中止するとともに前記S105でRAM33に記憶された車両2の走行履歴をクリア(S107)して当該車両制御処理プログラムを終了する。   If it is determined that the vehicle has escaped from the narrow street or the parking lot (S116: YES), the display of the traveling locus 103 during forward movement is stopped in the BGM image 101 and stored in the RAM 33 in S105. The travel history of the vehicle 2 is cleared (S107), and the vehicle control processing program ends.

一方、自車が細街路又は駐車場を継続して走行中であると判定された場合(S116:NO)にはS112へと戻り、再度、車両2の後退時の予測進路を算出し、BGM画像101に対して新たに算出された予測進路を表示する。   On the other hand, when it is determined that the host vehicle is continuously traveling on the narrow street or the parking lot (S116: NO), the process returns to S112, and the predicted course when the vehicle 2 moves backward is calculated again. A newly calculated predicted course is displayed for the image 101.

以上詳細に説明した通り、第2実施形態に係る運転支援装置では、車両2が細街路又は駐車場内に進入した際に、後方カメラ3で撮像した撮像画像50から障害物の特徴点60を検出するとともに検出結果に基づいて車両2の走行軌跡103を検出して保存し(S102〜S105)、車両2が細街路又は駐車場内で後退を行う際には、保存された走行軌跡103を後退時の予測進路104とともにBGM画像101に対して表示する(S114)ので、運転者は表示された車両2の走行軌跡103を参照することによって、前進時の走行軌跡103に基づいた適切な走行を行うことが可能となる。従って、狭い駐車場に前向きに駐車した後で後退しながら再出発する場合や、細街路や狭い山道等で他車とのすれ違いや行き止まりがあって後退する必要がある場合等の後退を行うことが困難な状況での後退時においても、前進時の車両の走行軌跡103に基づいた適切な走行を行わせることが可能となる。
また、後方カメラ3によって障害物の特徴点60を検出し、自車位置に対する特徴点60の相対位置に基づいて車両2の前進時の走行軌跡を検出するので、GPSや地図データに基づいて走行軌跡を検出する場合と比較して、正確な走行軌跡の検出が可能となる。
更に、車両2が細街路又は駐車場内に進入した場合のみに車両2の前進時の走行軌跡をBGM画像101に重畳させて表示を行うので、後退を行うことが困難な状況以外では運転支援ECU4の処理負担を軽減させることが可能となる。
As described above in detail, in the driving support device according to the second embodiment, when the vehicle 2 enters the narrow street or the parking lot, the feature point 60 of the obstacle is detected from the captured image 50 captured by the rear camera 3. At the same time, the traveling locus 103 of the vehicle 2 is detected and stored based on the detection result (S102 to S105). When the vehicle 2 moves backward in the narrow street or the parking lot, the saved traveling locus 103 is moved backward. Is displayed on the BGM image 101 together with the predicted course 104 (S114), so that the driver refers to the travel locus 103 of the displayed vehicle 2 to appropriately travel based on the travel locus 103 during forward travel. It becomes possible. Therefore, when you park in a narrow parking lot and then start again while retreating, or when you need to retreat due to a passing or dead end with other cars on narrow streets or narrow mountain roads, etc. Even when the vehicle is traveling backward in a difficult situation, it is possible to perform appropriate traveling based on the traveling locus 103 of the vehicle when traveling forward.
Further, the feature point 60 of the obstacle is detected by the rear camera 3, and the traveling locus of the vehicle 2 when the vehicle 2 moves forward is detected based on the relative position of the feature point 60 with respect to the own vehicle position. Compared with the case of detecting the locus, it is possible to detect the traveling locus more accurately.
Furthermore, since the traveling locus of the vehicle 2 when the vehicle 2 moves forward is superimposed on the BGM image 101 and displayed only when the vehicle 2 enters the narrow street or the parking lot, the driving assistance ECU 4 is used except when it is difficult to move backward. It is possible to reduce the processing load.

(第3実施形態)
次に、第3実施形態に係る運転支援装置について図13に基づいて説明する。尚、以下の説明において上記図1乃至図9の第1実施形態に係る運転支援装置1の構成と同一符号は、前記第1実施形態に係る運転支援装置1等の構成と同一あるいは相当部分を示すものである。
(Third embodiment)
Next, the driving assistance apparatus which concerns on 3rd Embodiment is demonstrated based on FIG. In the following description, the same reference numerals as those of the driving support apparatus 1 according to the first embodiment in FIGS. 1 to 9 denote the same or corresponding parts as those of the driving support apparatus 1 according to the first embodiment. It is shown.

この第3実施形態に係る運転支援装置の概略構成は、第1実施形態に係る運転支援装置1とほぼ同じ構成である。また、各種制御処理も第1実施形態に係る運転支援装置1とほぼ同じ制御処理である。
ただし、第1実施形態に係る運転支援装置1が、後方カメラ3で撮像した撮像画像による3次元特徴点の再構成処理結果と自車位置及び自車方向とに基づいて検出された前進時の走行軌跡を保存し、前進時の走行軌跡に沿った後退を行うように車両を制御することにより運転者の運転支援を行うのに対し、第3実施形態に係る運転支援装置では、前進時に所定距離間隔で後方カメラ3により撮像した画像と、後退時に同じ所定距離間隔で後方カメラ3により撮像した画像とを比較することにより前進時と後退時の車両の位置や方向のずれを検出し、前進時と同じ軌跡で後退するように車両を制御することにより運転者の運転支援を行う点で前記第1実施形態に係る運転支援装置1と異なっている。
The schematic configuration of the driving support apparatus according to the third embodiment is substantially the same as that of the driving support apparatus 1 according to the first embodiment. Various control processes are also substantially the same as the driving support apparatus 1 according to the first embodiment.
However, the driving support apparatus 1 according to the first embodiment is configured to detect the forward movement detected based on the reconstruction process result of the three-dimensional feature points based on the captured image captured by the rear camera 3, the own vehicle position, and the own vehicle direction. The driving support is provided by controlling the vehicle so as to store the traveling locus and to move backward along the traveling locus at the time of forward travel, whereas in the drive assistance device according to the third embodiment, the predetermined amount of time is determined at the time of forward travel. By comparing the image captured by the rear camera 3 at a distance interval and the image captured by the rear camera 3 at the same predetermined distance interval at the time of backward movement, a shift in the position and direction of the vehicle at the time of forward movement and backward movement is detected, and forward movement This is different from the driving support apparatus 1 according to the first embodiment in that the driving assistance of the driver is performed by controlling the vehicle so as to move backward along the same locus as the time.

以下に、第3実施形態に係る運転支援装置の運転支援ECU4が実行する車両制御処理プログラムについて図13に基づき説明する。図13は第3実施形態に係る運転支援装置における車両制御処理プログラムのフローチャートである。尚、図13にフローチャートで示されるプログラムは運転支援ECU4が備えているROM32やRAM33に記憶されており、CPU31により所定間隔(例えば4ms毎)で繰り返し実行される。   Below, the vehicle control processing program which driving assistance ECU4 of the driving assistance device which concerns on 3rd Embodiment performs is demonstrated based on FIG. FIG. 13 is a flowchart of a vehicle control processing program in the driving support apparatus according to the third embodiment. 13 is stored in the ROM 32 or RAM 33 provided in the driving support ECU 4, and is repeatedly executed by the CPU 31 at predetermined intervals (for example, every 4 ms).

先ず、S201においてCPU31はGPS25により検出した自車の現在位置と、地図DB27に記憶された地図データとに基づいてマッチング処理を行い、自車が細街路又は駐車場内に進入したか否かが判定される。尚、後方カメラ3による画像認識結果や、ミリ波レーダの検出結果によって判定することとしても良い。   First, in S201, the CPU 31 performs matching processing based on the current position of the vehicle detected by the GPS 25 and the map data stored in the map DB 27, and determines whether or not the vehicle has entered a narrow street or a parking lot. Is done. The determination may be made based on the image recognition result by the rear camera 3 or the detection result of the millimeter wave radar.

そして、自車が細街路又は駐車場内に進入したと判定された場合(S201:YES)にはS2へと移行する。一方、自車が細街路又は駐車場内に進入していないと判定された場合(S201:NO)には、当該車両制御処理プログラムを終了する。   And when it determines with the own vehicle having entered into a narrow street or a parking lot (S201: YES), it transfers to S2. On the other hand, when it is determined that the own vehicle has not entered the narrow street or the parking lot (S201: NO), the vehicle control processing program ends.

続いて、S202でCPU31は、車速センサ12から発生された車速パルスを検出したか否かを判定する。ここで、車速パルスは車両が200mm走行する度に車速センサ12より発生されるので、前記S201では車両が所定距離間隔を走行したか否かが判定されることとなる。   Subsequently, in S202, the CPU 31 determines whether or not a vehicle speed pulse generated from the vehicle speed sensor 12 has been detected. Here, since the vehicle speed pulse is generated by the vehicle speed sensor 12 every time the vehicle travels 200 mm, it is determined in S201 whether or not the vehicle has traveled a predetermined distance interval.

その結果、車速パルスを検出したと判定された場合(S202:YES)には、後方カメラ3により車両後方のBGM画像(以下、前進時撮像画像という)を撮像する(S203)。そして、撮像した前進時撮像画像をRAM33に保存する(S204)。それにより、車両2の前進時における所定距離間隔(具体的には200mm間隔)の前進時撮像画像が走行履歴として保存されることとなる。一方、車速パルスを検出しないと判定された場合(S202:NO)には、検出されるまで待機する。   As a result, when it is determined that a vehicle speed pulse has been detected (S202: YES), the rear camera 3 captures a BGM image behind the vehicle (hereinafter referred to as a forward-time captured image) (S203). Then, the captured forward-time captured image is stored in the RAM 33 (S204). As a result, forward-time captured images at predetermined distance intervals (specifically, 200 mm intervals) when the vehicle 2 moves forward are saved as a travel history. On the other hand, when it is determined that the vehicle speed pulse is not detected (S202: NO), the process waits until it is detected.

また、S205では操作スイッチ21の操作によってミラーの操作や車両2の車高を変更する操作等の車両操作が行われた場合に、前記S203で保存した前進時撮像画像に対応付けて、車両操作の操作内容(例えば、ドアミラーを30度開く、車高を10cm上げる等)が走行履歴として保存される。   In S205, when a vehicle operation such as a mirror operation or an operation for changing the vehicle height of the vehicle 2 is performed by operating the operation switch 21, the vehicle operation is performed in association with the forward-time captured image stored in S203. (For example, opening the door mirror 30 degrees, raising the vehicle height by 10 cm, etc.) is stored as a travel history.

その後、S206でCPU31はGPS25により検出した自車の現在位置と、地図DB27に記憶された地図データとに基づいて、自車が細街路又は駐車場から脱出したか否かが判定される。尚、後方カメラ3による画像認識結果やミリ波レーダの検出結果に基づいて判定することとしても良い。   Thereafter, in S206, the CPU 31 determines whether or not the own vehicle has escaped from the narrow street or the parking lot based on the current position of the own vehicle detected by the GPS 25 and the map data stored in the map DB 27. The determination may be based on the image recognition result by the rear camera 3 or the detection result of the millimeter wave radar.

そして、自車が細街路又は駐車場から脱出したと判定された場合(S206:YES)には、前記S204やS205でRAM33に記憶された車両2の走行履歴をクリア(S207)して当該車両制御処理プログラムを終了する。   If it is determined that the vehicle has escaped from the narrow street or the parking lot (S206: YES), the travel history of the vehicle 2 stored in the RAM 33 in S204 or S205 is cleared (S207), and the vehicle The control processing program is terminated.

一方、自車が細街路又は駐車場を継続して走行中であると判定された場合(S206:NO)には、S208でCPU31は、シフトレバースイッチ17の検出結果に基づいて車両2のシフトレバーがリバースとなったか否か、即ち、細街路又は駐車場内で車両2が後退を開始したか否かを判定する。   On the other hand, if it is determined that the vehicle is traveling on the narrow street or the parking lot (S206: NO), the CPU 31 shifts the vehicle 2 based on the detection result of the shift lever switch 17 in S208. It is determined whether or not the lever is reverse, that is, whether or not the vehicle 2 has started retreating in a narrow street or a parking lot.

そして、車両2のシフトレバーがリバースでないと判定された場合(S208:NO)にはS202へと戻り、再び車速パルスの検出に基づいて撮像した前進時撮像画像を走行履歴としてRAM33に保存する。一方、リバースとなったと判定された場合(S208:YES)には、保存された走行履歴に基づく後退時の車両2の制御(即ち、運転者の車両操作の支援)を行うか否かのアシスト実行確認画面70を液晶ディスプレイ5に対して表示する(S209)。   If it is determined that the shift lever of the vehicle 2 is not reverse (S208: NO), the process returns to S202, and the forward-time captured image captured based on the detection of the vehicle speed pulse is stored in the RAM 33 as a travel history again. On the other hand, if it is determined that the vehicle is reverse (S208: YES), whether or not to perform control of the vehicle 2 at the time of reversing based on the saved travel history (that is, assistance for driver's vehicle operation) is determined. An execution confirmation screen 70 is displayed on the liquid crystal display 5 (S209).

次に、S210では運転者による選択に基づいて、保存された走行履歴に基づく後退時の車両2の制御(即ち、運転者の車両操作の支援)を行うか否かが判定される。その結果、車両2の制御を行わないと判定された場合(S210:NO)には、前記S204やS205でRAM33に記憶された車両2の走行履歴をクリア(S207)して当該車両制御処理プログラムを終了する。   Next, in S210, based on the selection by the driver, it is determined whether or not to control the vehicle 2 at the time of reverse based on the saved travel history (that is, support for the driver's vehicle operation). As a result, if it is determined that the vehicle 2 is not to be controlled (S210: NO), the traveling history of the vehicle 2 stored in the RAM 33 in S204 or S205 is cleared (S207), and the vehicle control processing program Exit.

一方、車両2の制御を行うと判定された場合(S210:YES)には、S211へと移行する。そして、S211でCPU31は、車速センサ12から発生された車速パルスを検出したか否かを判定する。ここで、車速パルスは車両が200mm走行する度に車速センサ12より発生されるので、前記S211では車両が後退時に所定距離間隔を走行したか否かが判定されることとなる。   On the other hand, when it is determined to control the vehicle 2 (S210: YES), the process proceeds to S211. In S211, the CPU 31 determines whether or not a vehicle speed pulse generated from the vehicle speed sensor 12 has been detected. Here, since the vehicle speed pulse is generated from the vehicle speed sensor 12 every time the vehicle travels 200 mm, it is determined in S211 whether or not the vehicle has traveled a predetermined distance interval when reversing.

その結果、車速パルスを検出したと判定された場合(S211:YES)には、後方カメラ3により車両後方のBGM画像(以下、後退時撮像画像という)を撮像する(S212)。そして、前記S212で撮像した後退時撮像画像をRAM33に記憶された前進時撮像画像の内、後退開始地点からの距離が同じ地点で撮像された前進時撮像画像と比較する(S213)。ここで、本実施形態に係る運転支援装置1は前進時及び後退時において車両2が200mm走行する度に後方カメラ3によりBGM画像を撮像するので、前記S208で車両が後退すると判断された時点から所定枚数前に撮像した画像と同枚数後に撮像した画像は、後退開始地点からの距離が同じ地点で撮像された画像となる。尚、S213の画像比較では前進時撮像画像と後退時撮像画像での特徴点を検出するとともに、検出された特徴点の内、対応する特徴点の位置をそれぞれ比較することにより行う。
一方、車速パルスを検出しないと判定された場合(S211:NO)には、検出されるまで待機する。
As a result, when it is determined that the vehicle speed pulse has been detected (S211: YES), the rear camera 3 captures a BGM image behind the vehicle (hereinafter referred to as a reverse captured image) (S212). Then, the backward captured image captured in S212 is compared with the forward captured image captured at the same distance from the backward start point in the forward captured image stored in the RAM 33 (S213). Here, since the driving support device 1 according to the present embodiment captures a BGM image by the rear camera 3 every time the vehicle 2 travels 200 mm at the time of forward movement and backward movement, from the time when it is determined in S208 that the vehicle moves backward. An image taken after the same number of images taken before the predetermined number is an image taken at the same distance from the reverse start point. Note that the image comparison in S213 is performed by detecting feature points in the forward picked-up image and the reverse picked-up image and comparing the positions of corresponding feature points among the detected feature points.
On the other hand, when it is determined that the vehicle speed pulse is not detected (S211: NO), the process waits until it is detected.

次に、S214でCPU31は、前記S213の画像の比較結果に基づいて前進時の走行軌跡に対する後退時の車両2の位置及び方向(具体的には後方カメラ3の位置及び方向)のずれを算出する。その後、CPU31は算出された位置及び方向のずれをなくす為のアクセル18、ブレーキ19、ステアリング20の作動量を算出し、車両ECU11に対して制御の指示を送信する(S215)。その結果、前進時の走行軌跡に沿って後退するように車両2の制御が行われる。
また、前記S205で車両操作の操作内容が記憶されている場合には、前進時と対応する自車位置で、対応する車両操作が行われるように制御する。例えば、前進時の所定地点でドアミラーを30度閉じる操作が行われていた場合には、後退時の同地点でドアミラーを30度開く操作を行うように制御する。また、前進時の所定地点で車高を10cm下げる操作が行われていた場合には、後退時の同地点で車高を10cm上げる操作を行うように制御する。
Next, in S214, the CPU 31 calculates the deviation of the position and direction of the vehicle 2 when traveling backward (specifically, the position and direction of the rear camera 3) with respect to the traveling locus when traveling based on the comparison result of the image of S213. To do. Thereafter, the CPU 31 calculates the operation amounts of the accelerator 18, the brake 19 and the steering 20 for eliminating the displacement of the calculated position and direction, and transmits a control instruction to the vehicle ECU 11 (S215). As a result, the control of the vehicle 2 is performed so that the vehicle 2 moves backward along the traveling locus during forward movement.
When the operation details of the vehicle operation are stored in S205, control is performed so that the corresponding vehicle operation is performed at the own vehicle position corresponding to the forward time. For example, when an operation of closing the door mirror 30 degrees at a predetermined point at the time of forward movement is performed, control is performed so as to perform an operation of opening the door mirror 30 degrees at the same point at the time of backward movement. Further, when an operation for lowering the vehicle height by 10 cm is performed at a predetermined point during forward travel, control is performed so as to perform an operation for increasing the vehicle height by 10 cm at the same point during backward travel.

次に、S216でCPU31は、前記S204及びS205で保存された前進時の車両2の走行履歴と異なる車両操作が行われたか否かを判定する。ここで、前進時の車両2の走行履歴と異なる車両操作が行われる場合とは、例えば、前進時には所定地点で直進しているのに対して、後退時に同地点で右折又は左折を行った場合等がある。   Next, in S216, the CPU 31 determines whether or not a vehicle operation different from the traveling history of the vehicle 2 during forward movement stored in S204 and S205 has been performed. Here, the case where the vehicle operation different from the traveling history of the vehicle 2 at the time of forward is performed is, for example, when the vehicle travels straight at a predetermined point when traveling forward, but makes a right turn or a left turn at the same point when traveling backward Etc.

そして、走行履歴と異なる車両操作が行われたと判定した場合(S216:YES)には、運転者は前進時と異なる走行経路を走行すると判定し、車両の制御を中止する。そして、前記S204やS205でRAM33に記憶された車両2の走行履歴をクリア(S207)して当該車両制御処理プログラムを終了する。   If it is determined that a vehicle operation different from the travel history has been performed (S216: YES), the driver determines that the vehicle travels on a travel route different from the forward travel time, and stops the control of the vehicle. Then, the traveling history of the vehicle 2 stored in the RAM 33 in S204 or S205 is cleared (S207), and the vehicle control processing program is terminated.

一方、走行履歴と異なる車両操作が行われない場合(S216:NO)には、更に、S217でCPU31はGPS25により検出した自車の現在位置と、地図DB27に記憶された地図データとに基づいて、自車が細街路又は駐車場から脱出したか否かが判定される。尚、後方カメラ3による画像認識結果やミリ波レーダの検出結果に基づいて判定することとしても良い。   On the other hand, if a vehicle operation different from the travel history is not performed (S216: NO), the CPU 31 further determines based on the current position of the vehicle detected by the GPS 25 in S217 and the map data stored in the map DB 27. It is determined whether the vehicle has escaped from the narrow street or the parking lot. The determination may be based on the image recognition result by the rear camera 3 or the detection result of the millimeter wave radar.

そして、自車が細街路又は駐車場から脱出したと判定された場合(S217:YES)には、前記S204やS205でRAM33に記憶された車両2の走行履歴をクリア(S207)して当該車両制御処理プログラムを終了する。   If it is determined that the vehicle has escaped from the narrow street or the parking lot (S217: YES), the travel history of the vehicle 2 stored in the RAM 33 in S204 or S205 is cleared (S207), and the vehicle The control processing program is terminated.

一方、自車が細街路又は駐車場を継続して走行中であると判定された場合(S217:NO)にはS211へと戻り、再度、後方カメラ3で撮像した画像から前進時との走行軌跡とのずれを算出する。   On the other hand, if it is determined that the host vehicle continues to travel on the narrow street or the parking lot (S217: NO), the process returns to S211 and travels again from the image captured by the rear camera 3 when traveling forward. The deviation from the locus is calculated.

以上詳細に説明した通り、第3実施形態に係る運転支援装置では、車両2が細街路又は駐車場内に進入した際に、所定走行距離間隔で後方カメラ3により前進時撮像画像を撮像して(S203)走行履歴としてRAM33に保存する(S204)とともに、車両が後退を開始した後には同じ距離間隔で後方カメラ3により撮像した後退時撮像画像をRAM33に記憶された前進時撮像画像の内、後退開始地点からの距離が同じ地点で撮像された前進時撮像画像と比較し(S213)、前進時の走行軌跡に沿って車両2が後退するように車両の制御を行う(S215)ので、狭い駐車場に前向きに駐車した後で後退しながら再出発する場合や、細街路や狭い山道等で他車とのすれ違いや行き止まりがあって後退する必要がある場合等の後退を行うことが困難な状況での後退時においても、前進時の車両の走行軌跡75に基づいた適切な走行を行わせることが可能となる。従って、運転者は後退時において、より容易な車両2の運転が可能となる。また、後方カメラ3で撮像した画像に基づいて前進時の走行軌跡を算出するので、前進時の正確な車両位置や周辺状況を検出することが可能となる。
後退開始地点からの距離が同じ地点から撮像された前進時撮像画像と後退時撮像画像との比較結果に基づいて車両操作を支援するので、撮像画像に基づいてより正確に前進時と後退時の車両位置や周辺状況を比較し、最適な車両支援を行うことが可能となる。
As described above in detail, in the driving support device according to the third embodiment, when the vehicle 2 enters the narrow street or the parking lot, the rear camera 3 captures a forward-time captured image at a predetermined travel distance ( S203) The travel history is saved in the RAM 33 (S204), and after the vehicle starts to move backward, the backward captured image captured by the rear camera 3 at the same distance interval is included in the backward captured image stored in the RAM 33. Compared with the forward-captured image captured at the same distance from the start point (S213), the vehicle is controlled so that the vehicle 2 moves backward along the travel locus during forward travel (S215). Carry out a retreat when you parked forward in the parking lot and start again while retreating, or when you need to retreat on narrow streets or narrow mountain roads due to passing or dead ends with other cars. Even when retracted that in difficult situations, it is possible to perform appropriate driving based on the traveling locus 75 of the forward-movement of the vehicle. Therefore, the driver can drive the vehicle 2 more easily when reversing. In addition, since the travel locus at the time of forward movement is calculated based on the image captured by the rear camera 3, it is possible to detect the accurate vehicle position and the surrounding situation at the time of forward movement.
Since the vehicle operation is supported based on the comparison result between the forward image and the reverse image captured from the same distance from the reverse start point, it is more accurate based on the captured image. It becomes possible to compare the vehicle position and the surrounding situation and to perform the optimum vehicle support.

尚、本発明は前記実施形態に限定されるものではなく、本発明の要旨を逸脱しない範囲内で種々の改良、変形が可能であることは勿論である。
例えば、第1実施形態及び第2実施形態では、後方カメラ3によって障害物の特徴点60を検出し、自車位置に対する特徴点60の相対位置に基づいて車両2の前進時の走行軌跡を検出するが、GPSや地図データのみに基づいて走行軌跡を検出するようにしても良い。
Note that the present invention is not limited to the above-described embodiment, and various improvements and modifications can be made without departing from the scope of the present invention.
For example, in the first embodiment and the second embodiment, the feature point 60 of the obstacle is detected by the rear camera 3, and the traveling locus when the vehicle 2 moves forward is detected based on the relative position of the feature point 60 with respect to the vehicle position. However, the traveling locus may be detected based only on GPS and map data.

また、第1実施形態乃至第3実施形態では、車両2が走行履歴と異なる車両操作がなされた場合や細街路又は駐車場を脱出した場合に、走行履歴に基づく車両の制御やBGM画像の表示を終了するように制御しているが、制御中止ボタンを設け、制御中止ボタンが押下された場合に、走行履歴に基づく車両の制御やBGM画像の表示を終了するように制御しても良い。更に、後退時に前進時と異なる障害物(例えば、歩行者)を検出した場合に、走行履歴に基づく車両の制御やBGM画像の表示を終了するように制御しても良い。   Further, in the first to third embodiments, when the vehicle 2 is operated in a vehicle different from the travel history, or when the vehicle 2 escapes the narrow street or the parking lot, the vehicle control based on the travel history and the display of the BGM image are performed. However, a control stop button may be provided, and when the control stop button is pressed, control of the vehicle based on the travel history and display of the BGM image may be ended. Furthermore, when an obstacle (for example, a pedestrian) different from that at the time of forward movement is detected during reverse, control of the vehicle based on the travel history and display of the BGM image may be terminated.

また、第1実施形態及び第2実施形態では、後方カメラ3により撮像した撮像画像に基づいて3次元特徴点の再構成処理を行い、自車位置に対する特徴点60の位置座標を検出するようにしていたが、後方カメラを車両2に対して所定間隔で2台設置し、立体視させることによって特徴点60の位置座標を検出するようにしても良い。   In the first and second embodiments, the three-dimensional feature point reconstruction process is performed based on the captured image captured by the rear camera 3 to detect the position coordinates of the feature point 60 with respect to the vehicle position. However, two rear cameras may be installed at a predetermined interval with respect to the vehicle 2, and the position coordinates of the feature point 60 may be detected by stereoscopic viewing.

第1実施形態に係る運転支援装置の概略構成図である。It is a schematic structure figure of a driving support device concerning a 1st embodiment. 第1実施形態に係る運転支援装置を構成する車両の制御系を模式的に示すブロック図である。It is a block diagram showing typically a control system of vehicles which constitute a driving support device concerning a 1st embodiment. 第1実施形態に係る運転支援装置における車両制御処理プログラムのフローチャートである。It is a flowchart of the vehicle control processing program in the driving assistance device concerning a 1st embodiment. 細街路を前進する車両を所定のタイミングで示した斜視図である。It is the perspective view which showed the vehicle which advances ahead on a narrow street at the predetermined timing. 図4に示すタイミングで車両の後方カメラにより撮像した撮像画像を示した図であるIt is the figure which showed the picked-up image imaged with the rear camera of the vehicle at the timing shown in FIG. 車両が図5に示すタイミングで後方カメラにより撮像された撮像画像における特徴点の微少時間経過後の変位ベクトルを示した図である。It is the figure which showed the displacement vector after the micro time progress of the feature point in the picked-up image imaged with the rear camera at the timing shown in FIG. 液晶ディスプレイに表示されたアシスト実行確認画面を示した図である。It is the figure which showed the assist execution confirmation screen displayed on the liquid crystal display. 図4に示す細街路を後退する車両を所定のタイミングで示した斜視図である。It is the perspective view which showed the vehicle which reverses the narrow street shown in FIG. 4 at the predetermined timing. 図4に示す細街路を後退する車両を所定のタイミングで示した上面図である。It is the top view which showed the vehicle which reverses the narrow street shown in FIG. 4 at the predetermined timing. 第2実施形態に係る運転支援装置における車両制御処理プログラムのフローチャートである。It is a flowchart of the vehicle control processing program in the driving assistance device which concerns on 2nd Embodiment. 車両の前進時の走行軌跡に対して後退時の予測進路が外れている場合に、液晶ディスプレイに対して表示されるBGM画像を示した図である。It is the figure which showed the BGM image displayed with respect to a liquid crystal display, when the prediction course at the time of reverse is deviating from the driving locus at the time of advance of vehicles. 車両の前進時の走行軌跡に対して後退時の予測進路が一致している場合に、液晶ディスプレイに対して表示されるBGM画像を示した図である。It is the figure which showed the BGM image displayed with respect to a liquid crystal display, when the predicted course at the time of reverse | coincidence with the driving | running | working locus at the time of the vehicle forward. 第3実施形態に係る運転支援装置における車両制御処理プログラムのフローチャートである。It is a flowchart of the vehicle control processing program in the driving assistance device which concerns on 3rd Embodiment.

1 運転支援装置
2 車両
3 後方カメラ
4 運転支援ECU
5 液晶ディスプレイ
8 現在地検出部
10 走行履歴DB
11 車両ECU
31 CPU
32 ROM
33 RAM
52〜57 障害物
60 特徴点
DESCRIPTION OF SYMBOLS 1 Driving assistance apparatus 2 Vehicle 3 Rear camera 4 Driving assistance ECU
5 Liquid crystal display 8 Current location detection unit 10 Travel history DB
11 Vehicle ECU
31 CPU
32 ROM
33 RAM
52-57 Obstacles 60 Features

Claims (6)

車両を後退させる際に運転者が行う車両操作を支援する運転支援装置において、
車両の周囲にある障害物を検出する障害物検出手段と、
前記障害物検出手段により検出された障害物の車両に対する相対位置を検出する位置検出手段と、
前記位置検出手段の検出結果に基づいて、車両が前進する際の車両の走行軌跡を検出する走行軌跡検出手段と、
前記走行軌跡検出手段により検出された前記車両の走行軌跡を走行履歴として記憶する走行履歴記憶手段と、
車両が後退するか否かを判定する後退判定手段と、を有し、
前記後退判定手段により車両が後退すると判定された場合に前記走行履歴記憶手段に記憶された前記車両の走行軌跡に基づいて車両操作を支援することを特徴とする運転支援装置。
In a driving support device that supports a vehicle operation performed by a driver when the vehicle is moved backward,
Obstacle detection means for detecting obstacles around the vehicle;
Position detecting means for detecting a relative position of the obstacle detected by the obstacle detecting means with respect to the vehicle;
A travel locus detecting means for detecting a travel locus of the vehicle when the vehicle moves forward based on a detection result of the position detection means;
Travel history storage means for storing the travel locus of the vehicle detected by the travel locus detection means as a travel history;
Reverse determination means for determining whether or not the vehicle moves backward,
The retracted when the vehicle is determined to be retracted by the determining means, the driving support device, characterized in that to support the vehicle operation based on the travel locus of the vehicle stored in the travel history storing means.
車両を後退させる際に運転者が行う車両操作を支援する運転支援装置において、In a driving support device that supports a vehicle operation performed by a driver when the vehicle is moved backward,
車両が前進する際に車両の走行軌跡を検出する走行軌跡検出手段と、Traveling locus detection means for detecting the traveling locus of the vehicle when the vehicle moves forward;
前記走行軌跡検出手段により検出された前記車両の走行軌跡を走行履歴として記憶する走行履歴記憶手段と、Travel history storage means for storing the travel locus of the vehicle detected by the travel locus detection means as a travel history;
車両に配置され、車両の周囲を撮像する撮像手段と、An imaging means disposed in the vehicle for imaging the surroundings of the vehicle;
車両が後退するか否かを判定する後退判定手段と、Reverse determination means for determining whether or not the vehicle reverses;
前記後退判定手段により車両が後退すると判定された場合に、前記走行軌跡検出手段によって検出された前記車両の走行軌跡を前記撮像手段により撮像された画像に重畳する画像重畳手段と、An image superimposing unit that superimposes the traveling locus of the vehicle detected by the traveling locus detection unit on the image captured by the imaging unit when the backward determining unit determines that the vehicle is reversing;
前記画像重畳手段によって重畳された画像を表示する画像表示手段と、を有することを特徴とする運転支援装置。A driving support apparatus comprising: an image display unit configured to display an image superimposed by the image superimposing unit.
前記後退判定手段により車両が後退すると判定された場合に、前記車両の走行軌跡に沿って後退するように車両を制御する車両制御手段を有することを特徴とする請求項1に記載の運転支援装置。The driving support device according to claim 1, further comprising a vehicle control unit that controls the vehicle so as to move backward along a travel locus of the vehicle when the vehicle is determined to move backward by the reverse determination unit. . 車両に配置され、車両の周囲を撮像する撮像手段と、An imaging means disposed in the vehicle for imaging the surroundings of the vehicle;
前記後退判定手段により車両が後退すると判定された場合に前記走行軌跡検出手段によって検出された前記車両の走行軌跡を前記撮像手段により撮像された画像に重畳する画像重畳手段と、An image superimposing unit that superimposes the traveling locus of the vehicle detected by the traveling locus detection unit on the image captured by the imaging unit when the backward determination unit determines that the vehicle moves backward;
前記画像重畳手段によって重畳された画像を表示する画像表示手段と、を有することを特徴とする請求項1に記載の運転支援装置。The driving support apparatus according to claim 1, further comprising: an image display unit that displays an image superimposed by the image superimposing unit.
前記走行履歴記憶手段には、車両が前進する際の運転者が行った車両操作の操作内容についても記憶され、The travel history storage means also stores the operation details of the vehicle operation performed by the driver when the vehicle moves forward,
前記後退判定手段により車両が後退すると判定された場合に、前記走行履歴記憶手段に記憶された前記操作内容に基づいた車両操作が行われるように車両を制御する車両操作制御手段を有することを特徴とする請求項1又は請求項3に記載の運転支援装置。And a vehicle operation control means for controlling the vehicle so that a vehicle operation based on the operation content stored in the travel history storage means is performed when the reverse determination means determines that the vehicle is going backward. The driving support device according to claim 1 or 3.
車両が細街路又は駐車場内に進入したことを検出する進入検出手段を有し、Having an entry detecting means for detecting that the vehicle has entered a narrow street or a parking lot;
前記走行軌跡検出手段は、前記進入検出手段によって車両が細街路又は駐車場内に進入したことが検出された場合に前記車両の走行軌跡を検出するとともに車両操作を支援することを特徴とする請求項1乃至請求項5のいずれかに記載の運転支援装置。The travel trajectory detection means detects the travel trajectory of the vehicle and assists vehicle operation when the entry detection means detects that the vehicle has entered a narrow street or a parking lot. The driving assistance device according to any one of claims 1 to 5.
JP2006063191A 2006-03-08 2006-03-08 Driving assistance device Expired - Fee Related JP4661639B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2006063191A JP4661639B2 (en) 2006-03-08 2006-03-08 Driving assistance device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2006063191A JP4661639B2 (en) 2006-03-08 2006-03-08 Driving assistance device

Publications (2)

Publication Number Publication Date
JP2007237930A JP2007237930A (en) 2007-09-20
JP4661639B2 true JP4661639B2 (en) 2011-03-30

Family

ID=38583881

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2006063191A Expired - Fee Related JP4661639B2 (en) 2006-03-08 2006-03-08 Driving assistance device

Country Status (1)

Country Link
JP (1) JP4661639B2 (en)

Families Citing this family (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5699670B2 (en) * 2011-02-18 2015-04-15 日産自動車株式会社 Travel route generation device and travel route generation method
EP3344519B1 (en) 2015-09-02 2020-06-24 Volvo Truck Corporation A device and a method for reversing an articulated vehicle combination
KR102464484B1 (en) * 2015-12-08 2022-11-07 현대모비스 주식회사 Assistant system and assistant method for backward driving of vehicle
JP6694710B2 (en) 2015-12-25 2020-05-20 株式会社デンソーテン Parking assistance device, parking assistance method, and parking assistance system
WO2017123876A1 (en) 2016-01-14 2017-07-20 Continental Automotive Systems, Inc. Trailer towing assistant for tight spot reversal
KR102233901B1 (en) 2016-10-13 2021-03-31 닛산 지도우샤 가부시키가이샤 Magnetic position estimation method and magnetic position estimation device
CN108437981B (en) * 2018-03-01 2020-02-21 东软集团股份有限公司 Automatic reversing method and device
JP7129282B2 (en) * 2018-08-29 2022-09-01 日産自動車株式会社 Obstacle section estimation method and obstacle section estimation device
KR102574289B1 (en) * 2018-10-08 2023-09-05 주식회사 에이치엘클레무브 Reverse drive control apparatus and everse drive control method thereof
KR102593422B1 (en) * 2018-10-17 2023-10-26 현대모비스 주식회사 Backward driving assist apparatus of vehicle and control method thereof
KR102356469B1 (en) * 2018-10-17 2022-01-28 현대모비스 주식회사 Backward driving assist apparatus and method of vehicle
US10974758B2 (en) * 2018-11-19 2021-04-13 GM Global Technology Operations LLC Method and apparatus that direct lateral control during backward motion
JP7218172B2 (en) * 2018-12-25 2023-02-06 フォルシアクラリオン・エレクトロニクス株式会社 In-vehicle processing device and control method for in-vehicle processing device
JP2020142793A (en) * 2020-04-27 2020-09-10 ボルボトラックコーポレーション Device and method for retreating connection type vehicle coupling body
JP7422691B2 (en) 2021-01-21 2024-01-26 ダイムラー トラック エージー Driving support device
CN113734154A (en) * 2021-07-26 2021-12-03 岚图汽车科技有限公司 Automatic reversing method and system
CN115214717B (en) * 2022-04-08 2024-04-16 广州汽车集团股份有限公司 Path recording method, tracking reversing method, device and equipment

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001043498A (en) * 1999-07-28 2001-02-16 Honda Motor Co Ltd Traveling device in single file
JP2005254865A (en) * 2004-03-09 2005-09-22 Clarion Co Ltd Parking auxiliary device, parking auxiliary method, and program for parking auxiliary

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001043498A (en) * 1999-07-28 2001-02-16 Honda Motor Co Ltd Traveling device in single file
JP2005254865A (en) * 2004-03-09 2005-09-22 Clarion Co Ltd Parking auxiliary device, parking auxiliary method, and program for parking auxiliary

Also Published As

Publication number Publication date
JP2007237930A (en) 2007-09-20

Similar Documents

Publication Publication Date Title
JP4661639B2 (en) Driving assistance device
KR101990257B1 (en) Parking Assist Device and Parking Assistance Method
EP2581272B1 (en) Parking assistance device and method
JP4670463B2 (en) Parking space monitoring device
US10268905B2 (en) Parking assistance apparatus
US9043083B2 (en) Parking assistance apparatus
JP6747179B2 (en) Parking assistance method and parking assistance device
JP4765213B2 (en) Parking assistance device for vehicles
JP2003072495A (en) Parking support device and parking support method
JP2011051586A (en) Method of assisting driver
JP5446139B2 (en) Parking assistance device and parking assistance method
JP2003063336A (en) Parking supporting device
JP2001180405A (en) Steering support device
JP2006290051A (en) Parking assisting device and parking assisting method
KR20040038880A (en) Parking support device
JP4052011B2 (en) Parking assistance device
JP5400316B2 (en) Parking assistance device
JP2011098614A (en) Drive assist device, drive assist method, and drive assist program
JP4576772B2 (en) Parking assistance device
JP2012023505A (en) Driving support device
JP2009149249A (en) Image display device and image display program, and driving assist system using image display device
KR20150028492A (en) Method for controlling steering wheel and System therefor
JP2007323178A (en) Merge support device and merge support method
JP5012670B2 (en) Parking assistance device, parking assistance method, and computer program
JP5136291B2 (en) Parking assistance device and parking assistance method

Legal Events

Date Code Title Description
RD03 Notification of appointment of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7423

Effective date: 20070615

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20080225

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20100210

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20100223

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20100416

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: 20101207

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20101220

R150 Certificate of patent or registration of utility model

Ref document number: 4661639

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140114

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20150114

Year of fee payment: 4

LAPS Cancellation because of no payment of annual fees