JP2011028609A - Traveling support device and traveling support method - Google Patents

Traveling support device and traveling support method Download PDF

Info

Publication number
JP2011028609A
JP2011028609A JP2009175103A JP2009175103A JP2011028609A JP 2011028609 A JP2011028609 A JP 2011028609A JP 2009175103 A JP2009175103 A JP 2009175103A JP 2009175103 A JP2009175103 A JP 2009175103A JP 2011028609 A JP2011028609 A JP 2011028609A
Authority
JP
Japan
Prior art keywords
trajectory
host vehicle
vehicle
turning
locus
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.)
Granted
Application number
JP2009175103A
Other languages
Japanese (ja)
Other versions
JP5556077B2 (en
Inventor
Yoshinori Kusayanagi
佳紀 草柳
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.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor 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 Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP2009175103A priority Critical patent/JP5556077B2/en
Publication of JP2011028609A publication Critical patent/JP2011028609A/en
Application granted granted Critical
Publication of JP5556077B2 publication Critical patent/JP5556077B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Traffic Control Systems (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To cause a driver to recognize an optimum route for passing a narrow part. <P>SOLUTION: For passage of the narrow part, a first trajectory in a case where an own vehicle advances from a current position while maintaining a current steering angle, a steering angle change point for stopping the vehicle in the front of the position of the narrow part to change the steering angle, and a second trajectory in a case in which the own vehicle advances from the steering angle change point while maintaining the steering angle changed at the steering angle change point are calculated, and route information for the passage of the narrow part composed of the first trajectory, the steering angle change point and the second trajectory is superimposed on an overhead image of the circumference of the own vehicle or the like, and displayed as a support image on a monitor. <P>COPYRIGHT: (C)2011,JPO&INPIT

Description

本発明は、車両の走行を支援する走行支援装置及び走行支援方法に関し、特に、道路上に障害物等が存在することで通過可能な道幅が狭くなっている箇所(以下、狭部と呼ぶ。)を自車両が適切に通過できるように支援する走行支援装置及び走行支援方法に関する。   The present invention relates to a driving support device and a driving support method that support driving of a vehicle, and in particular, a place where a road width that can be passed due to an obstacle or the like on a road is narrow (hereinafter referred to as a narrow portion). ) To a travel support device and a travel support method for assisting the own vehicle to pass appropriately.

狭部における自車両の走行を支援する走行支援装置としては、例えば特許文献1に記載されたものが知られている。この特許文献1に記載の走行支援装置は、運転者前方のヘッドアップディスプレイに、自車両前方の道路の走行可能幅や自車の舵角に応じたタイヤ軌跡などの車幅情報を重畳表示させることで、運転者に対して脱輪や障害物との接触可能性などを判断するための指標を与えるようにしている。   As a driving support device that supports driving of the host vehicle in a narrow part, for example, the one described in Patent Document 1 is known. The driving support apparatus described in Patent Literature 1 displays vehicle width information such as a tire traveling path of a road ahead of the host vehicle and a tire locus according to the steering angle of the host vehicle on a head-up display in front of the driver. In this way, the driver is provided with an index for judging the possibility of wheel removal and contact with an obstacle.

特開2005−78414号公報JP 2005-78414 A

しかしながら、前記特許文献1に記載の技術では、自車両が現在の舵角を維持して走行したときに脱輪や障害物との接触が生じるかどうかを運転者に認識させることはできるものの、どのような経路で狭部を通過するのが望ましいかを運転者に認識させることはできず、走行支援としては不十分であった。   However, in the technique described in Patent Document 1, although the driver can recognize whether or not the vehicle is derailed or contacted with an obstacle when the vehicle travels while maintaining the current steering angle, It was not possible for the driver to recognize what route it is desirable to pass through the narrow part, and it was insufficient as driving support.

本発明は、以上の従来技術の問題点に鑑みて創案されたものであって、狭部を通過するための最適な経路を運転者に認識させることができる走行支援装置及び走行支援方法を提供することを目的としている。   The present invention has been made in view of the above-described problems of the prior art, and provides a driving support device and a driving support method that allow a driver to recognize an optimal route for passing through a narrow portion. The purpose is to do.

本発明は、自車両が現在位置から現在の舵角を維持して進行したときの第1軌跡と、狭部位置の手前で自車両を停車させて舵角を変更する舵角変更ポイントと、自車両が前記舵角変更ポイントから当該舵角変更ポイントで変更した後の舵角を維持して進行したときの第2軌跡とを算出して、第1軌跡と舵角変更ポイントと第2軌跡とからなる狭部通過の経路を示す経路情報を表示手段に表示することにより、上述した課題を解決する。   The present invention includes a first trajectory when the host vehicle travels from the current position while maintaining the current steering angle, a steering angle change point that changes the steering angle by stopping the host vehicle before the narrow position, A first locus, a steering angle change point, and a second locus are calculated by calculating a second locus when the host vehicle travels while maintaining the rudder angle after changing from the rudder angle change point to the rudder angle change point. The above-described problem is solved by displaying on the display means route information indicating the route of the narrow portion consisting of

本発明によれば、舵角の変更を含む一連の経路を示す経路情報を表示手段に表示するようにしているので、狭部を通過するための最適な経路を運転者に的確に認識させることができる。   According to the present invention, the route information indicating the series of routes including the change of the steering angle is displayed on the display means, so that the driver can accurately recognize the optimum route for passing through the narrow portion. Can do.

第1の実施形態に係る走行支援装置の構成図である。It is a lineblock diagram of the run support device concerning a 1st embodiment. 第1の実施形態に係る走行支援装置のコントロールユニットによる処理の概要を示すフローチャートである。It is a flowchart which shows the outline | summary of the process by the control unit of the driving assistance device which concerns on 1st Embodiment. 経路算出の具体例を説明する図であり、狭部位置を検出する様子を示す図である。It is a figure explaining the example of path | route calculation, and is a figure which shows a mode that a narrow part position is detected. 経路算出の具体例を説明する図であり、中間点を算出する様子を示す図である。It is a figure explaining the example of path | route calculation, and is a figure which shows a mode that an intermediate point is calculated. 経路算出の具体例を説明する図であり、操舵連動軌跡を算出する様子を示す図である。It is a figure explaining the example of a route calculation, and is a figure which shows a mode that a steering interlocking locus is calculated. 経路算出の具体例を説明する図であり、舵角変更ポイント(中間点)を基準点とする自車両の予測到達位置を算出する様子を示す図である。It is a figure explaining the example of path | route calculation, and is a figure which shows a mode that the predicted arrival position of the own vehicle which uses a steering angle change point (middle point) as a reference point is calculated. 経路算出の具体例を説明する図であり、反転軌跡を算出する様子を示す図である。It is a figure explaining the example of path | route calculation, and is a figure which shows a mode that a reverse locus | trajectory is calculated. 経路算出の具体例を説明する図であり、反転軌跡の終点を基準点とする自車両の予測到達位置を算出する様子を示す図である。It is a figure explaining the example of route calculation, and is a figure which shows a mode that the predicted arrival position of the own vehicle which uses the end point of a reverse locus as a reference point is calculated. 経路算出の具体例を説明する図であり、旋回外周側前端部の軌跡及び旋回内周側後輪の軌跡を算出する様子を示す図である。It is a figure explaining the example of path | route calculation, and is a figure which shows a mode that the locus | trajectory of a turning outer peripheral side front end part and the locus | trajectory of a turning inner peripheral side rear wheel are calculated. 経路算出の具体例を説明する図であり、自車両の走行領域を算出する様子を示す図である。It is a figure explaining the example of route calculation, and is a figure which shows a mode that the driving | running | working area | region of the own vehicle is calculated. 現在位置における自車両の舵角が変更された場合の予測到達位置の変化を示す図である。It is a figure which shows the change of the prediction arrival position when the steering angle of the own vehicle in a present position is changed. 経路算出の他の具体例を説明する図であり、狭部位置を検出する様子を示す図である。It is a figure explaining the other specific example of path | route calculation, and is a figure which shows a mode that a narrow part position is detected. 経路算出の他の具体例を説明する図であり、中間点を算出する様子を示す図である。It is a figure explaining the other specific example of path | route calculation, and is a figure which shows a mode that an intermediate point is calculated. 経路算出の他の具体例を説明する図であり、操舵連動軌跡を算出する様子を示す図である。It is a figure explaining the other specific example of route calculation, and is a figure which shows a mode that a steering interlocking locus is calculated. 経路算出の他の具体例を説明する図であり、舵角変更ポイント(中間点)を基準点とする自車両の予測到達位置を算出する様子を示す図である。It is a figure explaining the other specific example of route calculation, and is a figure which shows a mode that the predicted arrival position of the own vehicle which uses a steering angle change point (intermediate point) as a reference point is calculated. 経路算出の他の具体例を説明する図であり、反転軌跡を算出する様子を示す図である。It is a figure explaining the other specific example of path | route calculation, and is a figure which shows a mode that a reverse locus | trajectory is calculated. 経路算出の他の具体例を説明する図であり、反転軌跡の終点を基準点とする自車両の予測到達位置を算出する様子を示す図である。It is a figure explaining the other specific example of path | route calculation, and is a figure which shows a mode that the predicted reach | attainment position of the own vehicle which uses the end point of a reverse locus as a reference point is calculated. 経路算出の他の具体例を説明する図であり、旋回外周側前端部の軌跡及び旋回内周側後輪の軌跡を算出する様子を示す図である。It is a figure explaining the other specific example of path | route calculation, and is a figure which shows a mode that the locus | trajectory of a turning outer peripheral side front end part and the locus | trajectory of a turning inner peripheral side rear wheel are calculated. 経路算出の他の具体例を説明する図であり、自車両の走行領域を算出する様子を示す図である。It is a figure explaining the other specific example of route calculation, and is a figure which shows a mode that the driving | running | working area | region of the own vehicle is calculated. 現在位置における自車両の舵角が変更された場合の予測到達位置の変化を示す図である。It is a figure which shows the change of the prediction arrival position when the steering angle of the own vehicle in a present position is changed. モニタに表示する支援画像の他の表示形態を示す図である。It is a figure which shows the other display form of the assistance image displayed on a monitor. 図21の支援画像のベースとなる画像を撮像するための車載カメラの具体的な設置位置を示す図である。It is a figure which shows the specific installation position of the vehicle-mounted camera for imaging the image used as the base of the assistance image of FIG. 第2の実施形態に係る走行支援装置の構成図である。It is a block diagram of the driving assistance device which concerns on 2nd Embodiment. 第2の実施形態に係る走行支援装置のコントロールユニットによる処理の概要を示すフローチャートである。It is a flowchart which shows the outline | summary of the process by the control unit of the driving assistance apparatus which concerns on 2nd Embodiment. 経路算出の具体例を説明する図であり、狭部位置を検出する様子を示す図である。It is a figure explaining the example of path | route calculation, and is a figure which shows a mode that a narrow part position is detected. 経路算出の具体例を説明する図であり、回避ポイントを設定してこの回避ポイントを通って所定舵角の旋回円に接する直線を算出する様子を示す図である。It is a figure explaining the example of a route calculation, and is a figure which shows a mode that a straight line which sets an avoidance point and touches the turning circle of a predetermined steering angle through this avoidance point is calculated. 経路算出の具体例を説明する図であり、舵角変更ポイントを算出する様子を示す図である。It is a figure explaining the example of path | route calculation, and is a figure which shows a mode that a steering angle change point is calculated. 経路算出の具体例を説明する図であり、一対の直線軌跡線を算出する様子を示す図である。It is a figure explaining the example of a route calculation, and is a figure which shows a mode that a pair of linear locus line is calculated. 経路算出の具体例を説明する図であり、自車両の現在の舵角に応じた一対の旋回軌跡線を算出する様子を示す図である。It is a figure explaining the example of route calculation, and is a figure which shows a mode that a pair of turning locus line according to the present steering angle of the own vehicle is calculated. 経路算出の具体例を説明する図であり、一対の直線軌跡線と現在の舵角に応じた一対の旋回軌跡線とを俯瞰画像上に重畳した様子を示す図である。It is a figure explaining the example of path | route calculation, and is a figure which shows a mode that a pair of turning locus line according to a present steering angle was superimposed on a bird's-eye view image. 経路算出の具体例を説明する図であり、運転者がステアリングを操作して自車両の舵角を変更することで直線軌跡線と旋回軌跡線とが繋がって一連の経路となった様子を示す図である。It is a figure explaining the specific example of route calculation, and shows a mode that a straight locus line and a turning locus line were connected, and a driver changed the rudder angle of the own vehicle by operating steering. FIG. モニタに表示する支援画像の他の表示形態を示す図であり、自車両が舵角変更ポイントの手前を走行している際にモニタに表示される支援画像の画像例を示す図である。It is a figure which shows the other display form of the assistance image displayed on a monitor, and is a figure which shows the example of an image of the assistance image displayed on a monitor, when the own vehicle is drive | working before the steering angle change point. モニタに表示する支援画像の他の表示形態を示す図であり、自車両が舵角変更ポイントを越えた位置を走行している際にモニタに表示される支援画像の画像例を示す図である。It is a figure which shows the other display form of the assistance image displayed on a monitor, and is a figure which shows the example of an image of the assistance image displayed on a monitor, when the own vehicle is drive | working the position exceeding the steering angle change point. .

以下、本発明の具体的な実施形態について、図面を参照しながら詳細に説明する。   Hereinafter, specific embodiments of the present invention will be described in detail with reference to the drawings.

[第1の実施形態]
<構成>
図1は、本発明の第1の実施形態に係る走行支援装置の構成図である。本実施形態の走行支援装置は、装置全体の動作を統合的に制御するコントローラ10を中心に構成される。このコントローラ10には、4つの車載カメラ1a〜1dと、起動スイッチ2と、舵角センサ3と、車輪速センサ4と、経路決定スイッチ5と、モニタ6と、スピーカ7とが接続される。
[First Embodiment]
<Configuration>
FIG. 1 is a configuration diagram of a travel support apparatus according to the first embodiment of the present invention. The travel support apparatus according to the present embodiment is configured around a controller 10 that integrally controls the operation of the entire apparatus. Connected to the controller 10 are four in-vehicle cameras 1a to 1d, a start switch 2, a steering angle sensor 3, a wheel speed sensor 4, a route determination switch 5, a monitor 6, and a speaker 7.

車載カメラ1a〜1dは、例えば180度程度の画角を有する広角のCCDカメラ或いはCMOSカメラよりなり、これら4つの車載カメラ1a〜1dで自車両の周囲を囲む全ての領域を撮像できるように、自車両の前後左右に各々設置されている。これらの車載カメラ1a〜1dは、例えば自車両の車体の一部を含む画像を撮像し、撮像した画像のデータをコントロールユニット10に随時出力する。   The in-vehicle cameras 1a to 1d are, for example, wide-angle CCD cameras or CMOS cameras having an angle of view of about 180 degrees, and these four in-vehicle cameras 1a to 1d can capture all the areas surrounding the host vehicle. It is installed on each side of the vehicle. These in-vehicle cameras 1 a to 1 d capture an image including a part of the body of the host vehicle, for example, and output data of the captured image to the control unit 10 as needed.

起動スイッチ2は、本実施形態の走行支援装置を起動するために自車両の運転者により操作されるスイッチであり、自車両のステアリング若しくはインストゥルメントパネル付近に設置される。この起動スイッチ2は、運転者によりスイッチ操作されると、コントロールユニット10に対して走行支援処理の開始指令を出力する。   The start switch 2 is a switch that is operated by the driver of the host vehicle to start the driving support device of the present embodiment, and is installed near the steering or the instrument panel of the host vehicle. The start switch 2 outputs a start command for driving support processing to the control unit 10 when operated by the driver.

舵角センサ3は、自車両のステアリングシャフトに設置され、ステアリング操作に応じた自車両の舵角を検出して舵角信号をコントロールユニット10に出力する。   The steering angle sensor 3 is installed on the steering shaft of the host vehicle, detects the steering angle of the host vehicle according to the steering operation, and outputs a steering angle signal to the control unit 10.

車輪速センサ4は、自車両の車輪付近に設置され、車輪の回転数を検出して、この車輪回転数に対応する車速パルス信号をコントロールユニット10に出力する。   The wheel speed sensor 4 is installed near the wheel of the host vehicle, detects the rotational speed of the wheel, and outputs a vehicle speed pulse signal corresponding to the rotational speed of the wheel to the control unit 10.

経路決定スイッチ5は、コントロールユニット10により計算された経路を自車両の経路として確定するために運転者により操作されるスイッチであり、自車両のステアリング若しくはインストゥルメントパネル付近に設置される。この経路決定スイッチ5は、運転者によりスイッチ操作されると、コントロールユニット10に対して経路確定の指令を出力する。   The route determination switch 5 is a switch operated by the driver to determine the route calculated by the control unit 10 as the route of the host vehicle, and is installed near the steering or the instrument panel of the host vehicle. The route determination switch 5 outputs a route determination command to the control unit 10 when operated by the driver.

モニタ6は、例えば自車両のセンターコンソールなどに設置された液晶ディスプレイ等からなり、コントロールユニット10により生成された走行支援のための画像(以下、支援画像という。)を表示する。また、スピーカ7は、走行支援のための各種ガイド音声を出力するものであり、車両に一般的に搭載されているオーディオ用のスピーカなどが用いられる。   The monitor 6 is composed of, for example, a liquid crystal display or the like installed on the center console of the host vehicle, and displays an image for driving support (hereinafter referred to as a support image) generated by the control unit 10. The speaker 7 outputs various guide sounds for driving support, and an audio speaker or the like generally mounted on a vehicle is used.

コントロールユニット10は、例えば、所定の処理プログラムに従って動作するマイクロコンピュータを備えた電子制御ユニット(ECU)からなり、マイクロコンピュータのCPUで処理プログラムが実行されることによって、走行支援のための各種の制御機能を実現する。コントロールユニット10により実現される各種の制御機能は、図1に示すように、視点変換部11、俯瞰画像生成部12、画像処理部13、狭部位置検出部14、中間点演算部15、操舵連動軌跡演算部16、旋回外周側前端部軌跡演算部17、旋回内周側後輪軌跡演算部18、軌跡反転演算部19、走行領域演算部20、旋回軌跡記憶部21、自車両アイコン記憶部22、自車両情報記憶部23、移動量演算部24、画像更新部25、画像合成部26、音声ガイド生成部27、の各機能構成として捉えることができる。このうち、旋回軌跡記憶部21と自車両アイコン記憶部22と自車両情報記憶部23は、コントロールユニット10内部のメモリにより実現される。   The control unit 10 includes, for example, an electronic control unit (ECU) including a microcomputer that operates according to a predetermined processing program. Various processings for driving support are performed by the processing program being executed by the CPU of the microcomputer. Realize the function. As shown in FIG. 1, various control functions realized by the control unit 10 include a viewpoint conversion unit 11, an overhead image generation unit 12, an image processing unit 13, a narrow portion position detection unit 14, an intermediate point calculation unit 15, and steering. Interlocking locus calculation unit 16, turning outer periphery side front end locus calculation unit 17, turning inner periphery side rear wheel locus calculation unit 18, locus reversal calculation unit 19, travel area calculation unit 20, turning locus storage unit 21, host vehicle icon storage unit 22, the vehicle information storage unit 23, the movement amount calculation unit 24, the image update unit 25, the image synthesis unit 26, and the voice guide generation unit 27. Among these, the turning locus storage unit 21, the host vehicle icon storage unit 22, and the host vehicle information storage unit 23 are realized by a memory inside the control unit 10.

視点変換部11は、各車載カメラ1a〜1dからの出力画像を、自車両の真上を視点とした画像に視点変換(各画素の並べ替え)する。   The viewpoint conversion unit 11 converts the output images from the in-vehicle cameras 1a to 1d into images with the viewpoint directly above the host vehicle (rearrangement of each pixel).

俯瞰画像生成部12は、視点変換部11から出力される個別の視点変換された画像を合成し、自車両を略中心としてその周囲を真上から見下ろした俯瞰画像を生成する。   The bird's-eye view image generation unit 12 synthesizes the individual viewpoint-converted images output from the viewpoint conversion unit 11 and generates a bird's-eye view image with its own vehicle as a substantial center and the surrounding area looking down from directly above.

画像処理部13は、俯瞰画像生成部12から出力された俯瞰画像に対してエッジ検出などの画像処理を行って、自車両前方の障害物、具体的には道路の左右に存在する壁や植え込み、電柱などの立体障害物を検出する。なお、画像処理部13は、俯瞰画像に変換される前の車載カメラ1a〜1dの撮像画像に対して画像処理を行うことで電柱などの立体障害物を検出するようにしてもよい。   The image processing unit 13 performs image processing such as edge detection on the bird's-eye view image output from the bird's-eye view image generation unit 12, and obstacles ahead of the host vehicle, specifically, walls and implants existing on the left and right sides of the road Detect three-dimensional obstacles such as utility poles. The image processing unit 13 may detect a three-dimensional obstacle such as a utility pole by performing image processing on the captured images of the in-vehicle cameras 1a to 1d before being converted into the overhead view image.

狭部位置検出部14は、画像処理部13の出力に基づいて自車両前方の道路上で通行可能な道幅が狭くなっている狭部位置を特定し、その狭部位置までの距離を算出する。具体的には、狭部位置検出部14は、車載カメラ1a〜1dの焦点距離と各1画素あたりの距離から、画像処理部13により検出された立体障害物までの距離を、俯瞰画像上での自車両の正面(前後方向=Y軸方向)における距離として算出する。なお、自車両にレーザレンジファインダ等の他の物体検出装置が搭載されている場合には、この物体検出装置の検出信号を用いて狭部位置の特定及び距離の算出を行うようにしてもよい。   Based on the output of the image processing unit 13, the narrow part position detection unit 14 specifies a narrow part position where the road width that can be passed on the road ahead of the host vehicle is narrow, and calculates the distance to the narrow part position. . Specifically, the narrow part position detection unit 14 calculates the distance from the focal length of the in-vehicle cameras 1a to 1d and the distance per pixel to the three-dimensional obstacle detected by the image processing unit 13 on the overhead view image. Is calculated as a distance in front of the vehicle (front-rear direction = Y-axis direction). If another object detection device such as a laser range finder is mounted on the host vehicle, the position of the narrow portion may be specified and the distance may be calculated using the detection signal of the object detection device. .

中間点演算部15は、自車両の現在位置から狭部位置までの距離(つまり、電柱などの立体障害物までの距離)の中間点を演算する。なお、ここでの中間点は、自車両の基準点(例えば後輪車軸中心点)を通る自車両の車幅方向(=X軸方向)の直線に対して平行な直線上の任意の点として演算され、具体的な中間点の座標位置は、後述する操舵連動軌跡演算部16で算出される操舵連動軌跡とこの直線との交点となる。つまり、最終的な中間点の位置は操舵連動軌跡演算部16で算出される操舵連動軌跡の終点となり、この中間点が、詳細を後述するように、狭部位置の手前で自車両を停車させて舵角を変更する位置である舵角変更ポイントとなる。   The midpoint calculator 15 calculates the midpoint of the distance from the current position of the host vehicle to the narrow position (that is, the distance to a three-dimensional obstacle such as a utility pole). The intermediate point here is an arbitrary point on a straight line parallel to a straight line in the vehicle width direction (= X-axis direction) of the host vehicle passing through the reference point of the host vehicle (for example, the center point of the rear wheel axle). The calculated coordinate position of the intermediate point is the intersection of this straight line with the steering interlocking trajectory calculated by the steering interlocking trajectory calculating unit 16 described later. In other words, the final intermediate point position becomes the end point of the steering interlocking locus calculated by the steering interlocking locus calculating unit 16, and this intermediate point stops the vehicle in front of the narrow portion position, as will be described in detail later. The steering angle change point is a position where the steering angle is changed.

操舵連動軌跡演算部16は、舵角センサ3の出力に基づいて、自車両が現在位置から現在の舵角を維持して進行したときに自車両の基準点(例えば後輪車軸中心点)が辿る中間点までの軌跡(以下、操舵連動軌跡という。)を算出する。   Based on the output of the steering angle sensor 3, the steering interlocking track calculation unit 16 determines the reference point (for example, the rear wheel axle center point) of the host vehicle when the host vehicle travels from the current position while maintaining the current steering angle. A trajectory up to the intermediate point to be traced (hereinafter referred to as a steering interlocking trajectory) is calculated.

旋回外周側前端部軌跡演算部17は、舵角センサ3の出力に基づいて、自車両が現在位置から現在の舵角を維持して(つまり、操舵連動軌跡に沿って)進行したときの旋回外周側の前端部(右旋回時は左前端部、左旋回時は右前端部)が辿る軌跡を算出する。   Based on the output of the steering angle sensor 3, the turning outer peripheral side front end locus calculation unit 17 turns when the host vehicle advances from the current position while maintaining the current steering angle (that is, along the steering interlocking locus). The trajectory followed by the front end on the outer peripheral side (the left front end during right turn and the right front end during left turn) is calculated.

旋回内周側後輪軌跡演算部18は、舵角センサ3の出力に基づいて、自車両が現在位置から現在の舵角を維持して(つまり、操舵連動軌跡に沿って)進行したときの旋回内周側の後輪(右旋回時は右側後輪、左旋回時は左側後輪)が辿る軌跡を算出する。   Based on the output of the steering angle sensor 3, the turning inner periphery side rear wheel locus calculation unit 18 maintains the current steering angle from the current position (that is, along the steering interlocking locus). A trajectory followed by the rear wheel on the inner periphery side of the turn (right rear wheel when turning right and left rear wheel when turning left) is calculated.

軌跡反転演算部19は、操舵連動軌跡演算部16で算出した中間点までの操舵連動軌跡を中間点を中心として180度回転させることによって、舵角変更ポイントとなる中間点から狭部位置までの軌跡(以下、反転軌跡という。)を算出する。また、軌跡反転演算部19は、旋回外周側前端部軌跡演算部17で算出した中間点までの旋回外周側前端部の軌跡と、旋回内周側後輪軌跡演算部18で算出した中間点までの旋回内周側後輪の軌跡とを、自車両の現在位置における前後方向軸(Y軸)を基準に反転し、且つ、中間点における自車両角度の変化量分だけ旋回方向に回転させるとともに平行移動して、舵角変更ポイントとなる中間点から狭部位置までの旋回外周側前端部の軌跡と旋回内周側後輪の軌跡とを算出する。   The trajectory reversal calculation unit 19 rotates the steering interlocking trajectory up to the intermediate point calculated by the steering interlocking trajectory calculating unit 16 by 180 degrees around the intermediate point, so that the intermediate point from the steering angle change point to the narrow part position is rotated. A trajectory (hereinafter referred to as a reverse trajectory) is calculated. In addition, the trajectory reversal calculation unit 19 includes the trajectory of the turning outer peripheral side front end up to the intermediate point calculated by the turning outer peripheral side front end trajectory calculating unit 17 and the intermediate point calculated by the turning inner peripheral side rear wheel trajectory calculating unit 18. The trajectory of the turning inner peripheral rear wheel is reversed with respect to the longitudinal axis (Y axis) at the current position of the host vehicle, and rotated in the turning direction by the amount of change in the host vehicle angle at the intermediate point. By moving in parallel, the trajectory of the turning outer peripheral side front end and the trajectory of the turning inner peripheral side rear wheel from the intermediate point serving as the steering angle change point to the narrow portion position are calculated.

走行領域演算部20は、操舵連動軌跡演算部16の出力と、旋回外周側前端部軌跡演算部17の出力と、旋回内周側後輪軌跡演算部18の出力と、軌跡反転演算部19の出力と、自車両の大きさとに基づいて、自車両が操舵連動軌跡及び反転軌跡に沿って進行したときに自車両の車体全体が辿る軌跡を自車両の走行領域として算出する。   The travel area calculation unit 20 outputs the steering interlocking track calculation unit 16, the output of the turning outer periphery side front end track calculation unit 17, the output of the turning inner periphery side rear wheel track calculation unit 18, and the track reversal calculation unit 19. Based on the output and the size of the host vehicle, a track that the entire vehicle body follows when the host vehicle travels along the steering interlocking track and the reversing track is calculated as a travel region of the host vehicle.

旋回軌跡記憶部21は、自車両の舵角に応じた各部(左右前端や後輪位置)における軌跡線に関する情報(旋回円の半径や自車両の基準位置に対する旋回円中心の相対位置など)を記憶する。   The turning trajectory storage unit 21 stores information (such as the radius of the turning circle and the relative position of the center of the turning circle with respect to the reference position of the own vehicle) on each portion (left and right front ends and rear wheel position) corresponding to the steering angle of the own vehicle. Remember.

自車両アイコン記憶部22は、俯瞰画像生成部12で生成された俯瞰画像上に表示する自車両アイコンのデザインと大きさ(全長及び全幅)などの情報を記憶する。   The own vehicle icon storage unit 22 stores information such as the design and size (full length and full width) of the own vehicle icon displayed on the overhead view image generated by the overhead view image generation unit 12.

自車両情報記憶部23は、自車両の全長と、全幅と、自車両の旋回時に最外周端部となる左右前端部の位置、及び、後輪の接地位置等の情報を記憶する。   The host vehicle information storage unit 23 stores information such as the total length and width of the host vehicle, the positions of the left and right front end portions that are the outermost peripheral ends when the host vehicle is turning, and the ground contact position of the rear wheels.

移動量演算部24は、舵角センサ3の出力と、車輪速センサ4の出力とに基いて、自車両の移動量(前後方向、左右方向、ヨー角変化量)を演算する。   The movement amount calculation unit 24 calculates the movement amount of the host vehicle (front-rear direction, left-right direction, and yaw angle change amount) based on the output of the steering angle sensor 3 and the output of the wheel speed sensor 4.

画像更新部25は、経路決定スイッチ5の操作により運転者によって決定された経路に関する経路情報(例えば、自車両が操舵連動軌跡及び反転軌跡に沿って走行したときの走行領域を示す画像)が、環境(つまり、俯瞰画像として表示される自車両周囲の背景)側に固定されてモニタ6に表示されるように、移動量演算部24により算出される自車両の移動量に応じて、モニタ6の表示画面上における経路情報の表示位置を更新する。   The image update unit 25 includes route information on the route determined by the driver by operating the route determination switch 5 (for example, an image showing a travel region when the host vehicle travels along a steering interlocking track and a reverse track). Depending on the movement amount of the host vehicle calculated by the movement amount calculation unit 24, the monitor 6 is fixed to the environment (that is, the background around the host vehicle displayed as a bird's-eye view image) and displayed on the monitor 6. The display position of the route information on the display screen is updated.

画像合成部26は、俯瞰画像生成部12により生成された俯瞰画像上に、経路決定スイッチ5の操作により運転者によって決定された経路に関する経路情報(例えば、自車両が操舵連動軌跡及び反転軌跡に沿って走行したときの走行領域を示す画像)と、自車両アイコン記憶部22に記憶された自車両アイコンとを重畳した画像を生成して、モニタ6へ出力する。なお、本実施形態では、自車両が操舵連動軌跡及び反転軌跡に沿って走行したときの走行領域を示す画像を経路情報として自車両周囲の俯瞰画像上に重畳してモニタ6に表示しているが、俯瞰画像上に重畳してモニタ6に表示する経路情報は、自車両の走行領域の画像に限定されるものではなく、例えば、旋回外周側前端部の軌跡や旋回内周側後輪の軌跡を操舵連動軌跡及び反転軌跡と組み合わせたものを経路情報として俯瞰画像上に重畳してモニタ6に表示するようにしてもよいし、走行領域の外縁を示すアウトラインのみを経路情報として俯瞰画像上に重畳してモニタ6に表示するようにしてもよい。   The image composition unit 26 displays route information on the route determined by the driver by operating the route determination switch 5 on the overhead image generated by the overhead image generation unit 12 (for example, the host vehicle is turned into a steering interlocking locus and a reversal locus). An image showing a traveling region when traveling along the vehicle) and a host vehicle icon stored in the host vehicle icon storage unit 22 are generated and output to the monitor 6. In the present embodiment, an image indicating a travel region when the host vehicle travels along the steering interlocking track and the reversal track is superimposed on the overhead image around the host vehicle and displayed on the monitor 6 as route information. However, the route information superimposed on the bird's-eye view image and displayed on the monitor 6 is not limited to the image of the traveling area of the host vehicle. For example, the trajectory of the turning outer peripheral side front end and the turning inner peripheral side rear wheel A combination of the trajectory with the steering interlocking trajectory and the reversal trajectory may be superimposed on the overhead image as route information and displayed on the monitor 6, or only the outline indicating the outer edge of the travel area may be displayed as the route information on the overhead image. May be displayed on the monitor 6 in a superimposed manner.

音声ガイド生成部27は、移動量演算部24により算出される自車両の移動量に基づいて、経路決定スイッチ5の操作により決定された経路上での自車両の位置を特定し、必要な運転操作を運転者に教示するためのガイド音声を生成して、スピーカ7に出力する。   The voice guide generation unit 27 specifies the position of the host vehicle on the route determined by the operation of the route determination switch 5 based on the movement amount of the host vehicle calculated by the movement amount calculation unit 24, and performs necessary driving. A guide voice for teaching the operation to the driver is generated and output to the speaker 7.

<コントロールユニットによる処理>
次に、以上のように構成される本実施形態の走行支援装置のコントロールユニット10による処理の概要について、図2のフローチャートを参照しながら説明する。この図2のフローチャートで示す一連の処理は、自車両の運転者により走行支援装置の起動スイッチ2が操作されることによって開始される。
<Processing by control unit>
Next, an outline of processing by the control unit 10 of the driving support apparatus of the present embodiment configured as described above will be described with reference to the flowchart of FIG. A series of processes shown in the flowchart of FIG. 2 is started when the driver of the host vehicle operates the start switch 2 of the driving support device.

起動スイッチ2の操作により走行支援処理の開始指令が入力されると、コントロールユニット10は、まずステップS101において、車載カメラ1a〜1dで撮像された自車両周囲の画像をもとに俯瞰画像を生成する。そして、ステップS102において、ステップS101で生成した俯瞰画像に対してエッジ検出などの画像処理を行って、自車両前方の狭部位置を検出する。なお、本実施形態では俯瞰画像に対する画像処理により狭部位置を検出する例を例示しているが、車載カメラ1a〜1dの撮像画像に対する画像処理により狭部位置を検出するようにしてもよいし、レーザレンジファインダ等の他の物体検出装置を用いて狭部位置を検出するようにしてもよい。   When a start command for driving support processing is input by operating the start switch 2, the control unit 10 first generates a bird's-eye view image based on the images of the surroundings of the host vehicle taken by the in-vehicle cameras 1a to 1d in step S101. To do. In step S102, image processing such as edge detection is performed on the overhead view image generated in step S101 to detect a narrow portion position in front of the host vehicle. In this embodiment, an example in which the narrow portion position is detected by image processing on the overhead image is illustrated, but the narrow portion position may be detected by image processing on the captured images of the in-vehicle cameras 1a to 1d. The narrow portion position may be detected using another object detection device such as a laser range finder.

次に、コントロールユニット10は、ステップS103において、自車両の現在位置からステップS102で検出した狭部位置までの中間点を算出する。ここでの中間点は、上述したように、自車両の現在位置と狭部位置との間のX軸方向に沿った直線上の任意の点として求められる。   Next, in step S103, the control unit 10 calculates an intermediate point from the current position of the host vehicle to the narrow position detected in step S102. As described above, the intermediate point here is obtained as an arbitrary point on a straight line along the X-axis direction between the current position and the narrow position of the host vehicle.

次に、コントロールユニット10は、ステップS104において、舵角センサ3の出力を読み込む。そして、ステップS105において、ステップS104で読み込んだ舵角センサ3の出力に対応した旋回半径の軌跡線を旋回軌跡記憶部21から読み出し、自車両が現在の舵角を維持して現在位置から進行したときの操舵連動軌跡を算出する。なお、この操舵連動軌跡の始点は自車両の現在位置であり、終点はステップS103で算出した直線との交点となる中間点である。   Next, the control unit 10 reads the output of the steering angle sensor 3 in step S104. In step S105, the trajectory line of the turning radius corresponding to the output of the rudder angle sensor 3 read in step S104 is read from the turning trajectory storage unit 21, and the host vehicle proceeds from the current position while maintaining the current rudder angle. The steering interlocking locus at the time is calculated. The starting point of the steering interlocking locus is the current position of the host vehicle, and the ending point is an intermediate point that is an intersection with the straight line calculated in step S103.

次に、コントロールユニット10は、ステップS106において、ステップS105で算出した操舵連動軌跡の終点となる中間点を中心にして、ステップS105で算出した操舵連動軌跡を180度回転させて、中間点から狭部位置までの軌跡である反転軌跡を算出する。   Next, in step S106, the control unit 10 rotates the steering interlock locus calculated in step S105 by 180 degrees around the intermediate point that is the end point of the steering interlock locus calculated in step S105, and narrows it from the intermediate point. A reverse trajectory that is a trajectory to the part position is calculated.

次に、コントロールユニット10は、ステップS107において、自車両がステップS105で算出した操舵連動軌跡に沿って進行したときに自車両の旋回外周側前端部が辿る軌跡と、旋回内周側後輪が辿る軌跡とを求め、これを中間点までの旋回外周側前端部軌跡及び旋回内周側後輪軌跡とする。   Next, in step S107, the control unit 10 determines that the trajectory followed by the front end of the turning outer periphery of the host vehicle and the rear wheel on the turning inner periphery when the host vehicle travels along the steering interlocking track calculated in step S105. The trajectory to be traced is obtained, and this is set as the trajectory outer peripheral side front end trajectory and the traverse inner peripheral side rear wheel trajectory up to the intermediate point.

次に、コントロールユニット10は、ステップS108において、自車両の現在位置に対する中間点(ステップS105で算出した操舵連動軌跡の終点となる中間点)での自車両のヨー角変化量を算出する。   Next, in step S108, the control unit 10 calculates the yaw angle change amount of the host vehicle at an intermediate point with respect to the current position of the host vehicle (an intermediate point that is the end point of the steering interlocking locus calculated in step S105).

次に、コントロールユニット10は、ステップS109において、ステップS107で算出した中間点までの旋回外周側前端部の軌跡と旋回内周側後輪の軌跡とを、自車両の現在位置における前後方向軸(Y軸)を基準に反転し、且つ、ステップS108で算出したヨー角変化量分だけ旋回方向に回転させるとともに平行移動した軌跡を求め、この軌跡を自車両がステップS106で算出した反転軌跡に沿って進行したときの旋回外周側前端部の軌跡及び旋回内周側後輪の軌跡とする。   Next, in step S109, the control unit 10 uses the trajectory of the turning outer peripheral side front end and the trajectory of the turning inner peripheral side rear wheel up to the intermediate point calculated in step S107 to determine the longitudinal axis ( (Y-axis) as a reference and rotated in the turning direction by the amount of yaw angle change calculated in step S108, and a parallel trajectory is obtained. This trajectory follows the reverse trajectory calculated by the host vehicle in step S106. And the trajectory of the turning outer peripheral side front end and the trajectory of the turning inner peripheral side rear wheel.

次に、コントロールユニット10は、ステップS110において、ステップS107及びステップ109で算出した旋回外周側前端部軌跡及び旋回内周側後輪軌跡と、自車両情報記憶部23に記憶されている自車両の大きさの情報とに基づいて、自車両が操舵連動軌跡及び反転軌跡に沿って進行したときに自車両の車体全体が辿る軌跡を自車両の走行領域として算出する。   Next, in step S110, the control unit 10 determines the turning outer periphery side front end locus and the turning inner periphery rear wheel locus calculated in steps S107 and step 109, and the own vehicle information stored in the own vehicle information storage unit 23. Based on the size information, the trajectory followed by the entire vehicle body of the host vehicle when the host vehicle travels along the steering interlocking track and the reversal track is calculated as the travel region of the host vehicle.

次に、コントロールユニット10は、ステップS111において、ステップS110で算出した走行領域を表す画像をステップS101で生成した自車両周囲の俯瞰画像上に重畳してモニタ6に表示させる。なお、このとき、操舵連動軌跡の始点となる自車両の現在位置と、操舵連動軌跡の終点で且つ反転軌跡の始点となる中間点と、反転軌跡の終点とには、自車両アイコンを重畳表示することが望ましい。   Next, in step S111, the control unit 10 causes the monitor 6 to display an image representing the travel area calculated in step S110 on the overhead image around the host vehicle generated in step S101. At this time, the host vehicle icon is superimposed on the current position of the host vehicle that is the starting point of the steering interlocking track, the intermediate point that is the end point of the steering interlocking track and the starting point of the reversing track, and the end point of the reversing track. It is desirable to do.

次に、コントロールユニット10は、ステップS112において、自車両の運転者により経路決定スイッチ5が操作されたか否かを監視し、自車両の運転者により経路決定スイッチ5が操作された場合にはステップS114に進む。一方、経路決定スイッチ5が操作されない場合は、ステップS113において、舵角の変更がなされたか否か(舵角センサ3の出力が変化したか否か)を監視し、舵角が変更された場合はステップS104に戻ってステップS104以降の処理を繰り返す。つまり、自車両の運転者は、モニタ6に表示されている支援画像を見ながら現在の舵角に応じた狭部位置通過の経路を把握して、現在の舵角に応じた経路が適切であれば経路決定スイッチ5を操作して経路を確定させるが、現在の舵角に応じた経路では電柱などの立体障害物に接触する虞があると判断すれば、ステアリングを操作して舵角を変更し、最適な経路を探索する。   Next, in step S112, the control unit 10 monitors whether or not the route determination switch 5 has been operated by the driver of the host vehicle. If the route determination switch 5 has been operated by the driver of the host vehicle, the control unit 10 steps. Proceed to S114. On the other hand, if the route determination switch 5 is not operated, it is monitored in step S113 whether or not the rudder angle has been changed (whether or not the output of the rudder angle sensor 3 has changed), and the rudder angle has been changed. Returns to step S104 and repeats the processing after step S104. That is, the driver of the host vehicle grasps the route through the narrow position according to the current rudder angle while looking at the support image displayed on the monitor 6, and the route according to the current rudder angle is appropriate. If there is, the route determination switch 5 is operated to determine the route. However, if it is determined that there is a possibility of contact with a three-dimensional obstacle such as a power pole in the route according to the current steering angle, the steering angle is adjusted by operating the steering. Change and search for the best route.

次に、コントロールユニット10は、ステップS114において、自車両の現在の舵角に応じて算出された操舵連動軌跡を通り、中間点(舵角変更ポイント)にて舵角を変更して旋回方向を反転させて反転軌跡を通る経路を、狭部位置を通過するための自車両の経路として確定し、モニタ6に表示している走行領域の画像を、俯瞰画像として表示されている環境側に固定(ロックオン)する。   Next, in step S114, the control unit 10 passes the steering interlocking locus calculated according to the current steering angle of the host vehicle, changes the steering angle at the intermediate point (steering angle change point), and changes the turning direction. The route that is reversed and passes through the reversing trajectory is determined as the route of the host vehicle for passing through the narrow position, and the image of the traveling area displayed on the monitor 6 is fixed to the environment side displayed as the overhead image. (Lock on).

次に、コントロールユニット10は、ステップS115において、現在の舵角を維持した状態で自車両を前進させる旨を運転者に教示するためのガイド音声をスピーカ7から出力させる。なお、ガイド音声の出力に代えて或いはガイド音声の出力とともに、上記内容のメッセージ文をモニタ6に表示させるようにしてもよい。   Next, in step S115, the control unit 10 causes the speaker 7 to output a guide sound for instructing the driver to advance the host vehicle while maintaining the current steering angle. Note that the message text having the above contents may be displayed on the monitor 6 instead of outputting the guide voice or together with the output of the guide voice.

次に、コントロールユニット10は、ステップS116において、車輪速センサ4の出力に基づいて自車両の移動量を算出し、ステップS117において、ステップS116で算出される自車両の移動量を監視しながら、自車両がステップS105で算出した操舵連動軌跡の終点となる中間点に到達したか否かを判定する。そして、自車両が中間点に到達したら、ステップS118において、自車両を停車させてステアリングを逆方向に回して舵角を同じ角度だけ反転させる旨を運転者に教示するためのガイド音声をスピーカ7から出力させる。なお、この場合にも、ガイド音声の出力に代えて或いはガイド音声の出力とともに、上記内容のメッセージ文をモニタ6に表示させるようにしてもよい。   Next, in step S116, the control unit 10 calculates the movement amount of the host vehicle based on the output of the wheel speed sensor 4, and in step S117, monitoring the movement amount of the host vehicle calculated in step S116, It is determined whether or not the host vehicle has reached an intermediate point that is the end point of the steering interlocking trajectory calculated in step S105. When the host vehicle reaches the intermediate point, in step S118, the speaker 7 gives a guide voice for teaching the driver that the host vehicle is stopped and the steering is turned in the opposite direction to reverse the steering angle by the same angle. Output from. In this case as well, the message text having the above contents may be displayed on the monitor 6 instead of outputting the guide voice or together with the output of the guide voice.

次に、コントロールユニット10は、ステップS119において、舵角センサ3の出力を監視しながら、自車両の舵角がステップS118で運転者に教示した舵角となったかどうかを判定する。そして、自車両の舵角が運転者に教示した舵角となったら、ステップS120において、現在の舵角を維持した状態で自車両を前進させる旨を運転者に教示するためのガイド音声を、再度、スピーカ7から出力させる。なお、この場合にも、ガイド音声の出力に代えて或いはガイド音声の出力とともに、上記内容のメッセージ文をモニタ6に表示させるようにしてもよい。   Next, in step S119, the control unit 10 determines whether or not the steering angle of the host vehicle has reached the steering angle taught to the driver in step S118 while monitoring the output of the steering angle sensor 3. When the steering angle of the host vehicle becomes the steering angle taught to the driver, a guide voice for teaching the driver to advance the host vehicle while maintaining the current steering angle in step S120, The signal is output from the speaker 7 again. In this case as well, the message text having the above contents may be displayed on the monitor 6 instead of outputting the guide voice or together with the output of the guide voice.

次に、コントロールユニット10は、ステップS121において、車輪速センサ4の出力に基づいて自車両の移動量を算出し、ステップS122において、ステップS121で算出される自車両の移動量を監視しながら、自車両がステップS106で算出した反転軌跡の終点となる狭部位置に到達したか否かを判定する。そして、自車両が狭部位置に到達したら、図2のフローチャートで示す一連の処理を終了する。   Next, in step S121, the control unit 10 calculates the amount of movement of the host vehicle based on the output of the wheel speed sensor 4, and in step S122, while monitoring the amount of movement of the host vehicle calculated in step S121, It is determined whether or not the host vehicle has reached the narrow position that is the end point of the reverse trajectory calculated in step S106. And if the own vehicle reaches | attains a narrow part position, a series of processes shown with the flowchart of FIG. 2 will be complete | finished.

<狭部通過のための経路算出の具体例1>
次に、具体的なシーンを想定しながら、コントロールユニット10による狭部通過のための経路の算出方法についてさらに詳しく説明する。
<Specific example 1 of route calculation for passing through narrow part>
Next, a method for calculating a path for passing through a narrow portion by the control unit 10 will be described in more detail while assuming a specific scene.

ここでは、図3に示すように、左右両側が側壁101,102により区画された幅狭の道路を自車両が走行しようとしており、しかも、自車両の左前方には障害物となる電柱103が道路上に設置されているシーンを想定する。このような走行シーンでは、電柱103の脇を通過する際に通過可能な道幅が最も狭くなるので、この電柱103が存在する道路位置を狭部位置とする。なお、ここでの狭部位置は、図3に示すように、電柱103の自車両側に向いた端面に接し、自車両の現在位置Vにおける前後方向(Y軸方向)に対して垂直な方向(X軸方向)の直線104により定義される位置とする。また、自車両の位置は、自車両の後輪車軸中心105を基準点としたY軸方向の直線106により定義される位置とする。なお、ここではアッカーマン旋回モデルで軌跡を演算するのに適しているとの理由で後輪車軸中心を自車両の位置の基準点としているが、例えば、自車両の左右前端部などの他の部位を自車両の位置の基準点とすることも可能である。   Here, as shown in FIG. 3, the own vehicle is going to travel on a narrow road that is partitioned by side walls 101 and 102 on both the left and right sides, and an electric pole 103 serving as an obstacle is located on the left front side of the own vehicle. Assume a scene installed on a road. In such a traveling scene, the road width that can be passed when passing by the side of the utility pole 103 is the narrowest, so the road position where the utility pole 103 exists is defined as the narrow position. Note that the narrow portion here is in contact with the end face of the utility pole 103 facing the own vehicle as shown in FIG. 3 and is perpendicular to the front-rear direction (Y-axis direction) at the current position V of the own vehicle. The position is defined by the straight line 104 in the (X-axis direction). The position of the host vehicle is a position defined by a straight line 106 in the Y-axis direction with the rear wheel axle center 105 of the host vehicle as a reference point. Here, the center of the rear wheel axle is used as the reference point for the position of the own vehicle because it is suitable for calculating the trajectory in the Ackermann turning model, but other parts such as the left and right front ends of the own vehicle are used. Can be used as a reference point for the position of the vehicle.

図3に示すシーンにおいては、コントロールユニット10は以下のような方法で狭部通過のための経路を算出する。すなわち、まず、車載カメラ1a〜1dの撮像画像を用いて生成した俯瞰画像上で自車両前方の電柱103を検出し、電柱103が存在する道路位置を狭部位置として認識して、当該狭部位置を示す直線104を求める。また、自車両の後輪車軸中心105を基準点とした自車両の現在位置Vを示す直線106を求める。そして、自車両の現在位置Vを示す直線106から狭部位置を示す直線104までの距離L1を算出する。   In the scene shown in FIG. 3, the control unit 10 calculates a route for passing through the narrow portion by the following method. That is, first, the utility pole 103 in front of the host vehicle is detected on the overhead image generated using the captured images of the in-vehicle cameras 1a to 1d, the road position where the utility pole 103 is present is recognized as the narrow position, and the narrow section A straight line 104 indicating the position is obtained. Further, a straight line 106 indicating the current position V of the host vehicle is obtained with the rear wheel axle center 105 of the host vehicle as a reference point. And the distance L1 from the straight line 106 which shows the present position V of the own vehicle to the straight line 104 which shows a narrow part position is calculated.

次に、自車両の現在位置Vから狭部位置までの中間点を算出する。ここでの中間点は、図4に示すように、自車両の現在位置Vを示す直線106及び狭部位置を示す直線104に平行で、且つ、自車両の現在位置Vを示す106からの距離L2と狭部位置を示す直線104からの距離L3とが等しくなる直線107により定義される位置とする。ここで、中間点を直線107により定義したのは、後述する操舵連動軌跡が自車両の舵角に応じて変動する軌跡であり、この段階では中間点を1つの点として特定できないからである。   Next, an intermediate point from the current position V of the host vehicle to the narrow position is calculated. As shown in FIG. 4, the intermediate point here is parallel to the straight line 106 indicating the current position V of the host vehicle and the straight line 104 indicating the narrow position, and is a distance from 106 indicating the current position V of the host vehicle. The position is defined by a straight line 107 in which L2 and the distance L3 from the straight line 104 indicating the narrow portion position are equal. Here, the reason why the intermediate point is defined by the straight line 107 is that a steering interlocking trajectory described later varies depending on the steering angle of the host vehicle, and at this stage, the intermediate point cannot be specified as one point.

次に、舵角センサ3の出力に基づき、自車両が現在位置Vから現在の舵角を維持して進行したときの操舵連動軌跡を算出する。この操舵連動軌跡は、例えば図5に示すように、自車両の位置の基準点となる後輪車軸中心105が辿る軌跡108として求め、この操舵連動軌跡108と上記の中間点を示す直線107との交点を、操舵連動軌跡108の終点となる中間点(舵角変更ポイント)109とする。   Next, based on the output of the rudder angle sensor 3, a steering interlocking trajectory when the host vehicle travels from the current position V while maintaining the current rudder angle is calculated. For example, as shown in FIG. 5, the steering interlocking locus is obtained as a locus 108 followed by the rear wheel axle center 105 serving as a reference point of the position of the host vehicle, and the steering interlocking locus 108 and a straight line 107 indicating the intermediate point described above are obtained. Is an intermediate point (steering angle change point) 109 that is the end point of the steering interlocking locus 108.

次に、図6に示すように、自車両が操舵連動軌跡108に沿って進行して舵角変更ポイント109に到達したときの車両位置及び姿勢を求め、この舵角変更ポイント109を基準点とする位置を、自車両の予測到達位置V1とする。なお、この舵角変更ポイント109を基準点とする予測到達位置V1は、自車両を停車させて舵角を変更する位置となるため、上述したように、モニタ6に表示する俯瞰画像上の該当する位置には自車両アイコンを重畳表示して、停車及び舵角の変更を運転者に促すことが望ましい。   Next, as shown in FIG. 6, the vehicle position and posture when the host vehicle travels along the steering interlocking locus 108 and reaches the rudder angle change point 109 are obtained, and the rudder angle change point 109 is used as a reference point. The position to be used is set as the predicted arrival position V1 of the host vehicle. Note that the predicted arrival position V1 with the rudder angle change point 109 as a reference point is a position where the host vehicle is stopped and the rudder angle is changed, so that as described above, the corresponding on the overhead view image displayed on the monitor 6 It is desirable to superimpose and display the own vehicle icon at the position where the vehicle is to stop and to prompt the driver to change the stop and the steering angle.

次に、図7に示すように、操舵連動軌跡108を舵角変更ポイント109を中心として180度回転させた軌跡を求め、この軌跡を反転軌跡110とする。この反転軌跡110は、舵角変更ポイント109を基準点とする予測到達位置V1にて舵角を反対方向に同じ角度だけ反転させて進行したときの後輪車軸中心105が辿る軌跡であり、その始点は舵角変更ポイント109となり、終点は狭部位置を示す直線104上の点111となる。   Next, as shown in FIG. 7, a trajectory obtained by rotating the steering interlocking trajectory 180 by 180 degrees around the rudder angle change point 109 is obtained, and this trajectory is set as an inverted trajectory 110. The reverse trajectory 110 is a trajectory followed by the rear wheel axle center 105 when the steering angle is reversed by the same angle in the opposite direction at the predicted arrival position V1 with the rudder angle change point 109 as a reference point. The starting point is the steering angle change point 109, and the end point is the point 111 on the straight line 104 indicating the narrow portion position.

次に、図8に示すように、自車両が反転軌跡110に沿って旋回して終点111に到達したときの車両位置及び姿勢を求め、この反転軌跡110の終点111を基準点とする位置を、自車両の予測到達位置V2とする。なお、この反転軌跡110の終点111を基準点とする予測到達位置V2は、狭部を適切に通過させるための支援動作が終了する位置となるため、上述したように、モニタ6に表示する俯瞰画像上の該当する位置には自車両アイコンを重畳表示して、支援動作の終了位置を運転者に明示することが望ましい。   Next, as shown in FIG. 8, the vehicle position and posture when the host vehicle turns along the reversing trajectory 110 and reaches the end point 111 are obtained, and a position with the end point 111 of the reversing trajectory 110 as a reference point is obtained. The vehicle's predicted arrival position V2. Note that the predicted arrival position V2 with the end point 111 of the reversal trajectory 110 as a reference point is a position at which the support operation for appropriately passing through the narrow portion ends, and thus, as described above, an overhead view displayed on the monitor 6 It is desirable that the vehicle icon is superimposed on the corresponding position on the image and the end position of the support operation is clearly indicated to the driver.

次に、自車両が操舵連動軌跡108及び反転軌跡110に沿って進行したときに自車両の車体全体が辿る軌跡を走行領域として算出する。俯瞰画像上に操舵連動軌跡108や反転軌跡110を重畳し、さらに俯瞰画像上の予測到達位置V1,V2に自車両アイコンを重畳してモニタ6に表示すれば、コントロールユニット10により計算された経路の概要を運転者にある程度把握させることは可能であるが、このコントローラ10により計算された経路が、実際に自車両が側壁101,102や電柱103に接触することなく進行できる経路であるかを運転者に確実に把握させるには、自車両の車体全体が辿る走行領域を求めて、この走行領域を表す画像を俯瞰画像上に重畳して表示することが望ましい。つまり、自車両の走行領域を表す画像が俯瞰画像上で側壁101,102や電柱103と重なって表示されていれば、コントローラ10により計算された経路ではこれらの障害物に接触すると容易に認識できる。このような観点から、本実施形態の走行支援装置では、自車両が操舵連動軌跡108及び反転軌跡110に沿って進行したときに自車両の車体全体が辿る走行領域を算出し、この走行領域を表す画像を経路情報として俯瞰画像上に重畳してモニタ6に表示するようにしている。   Next, a trajectory followed by the entire vehicle body of the host vehicle when the host vehicle travels along the steering interlocking track 108 and the reversal track 110 is calculated as a travel region. The route calculated by the control unit 10 can be obtained by superimposing the steering interlocking trajectory 108 and the reversal trajectory 110 on the overhead view image and further superimposing the own vehicle icon on the predicted arrival positions V1 and V2 on the overhead view image and displaying them on the monitor 6. It is possible for the driver to grasp the outline of the vehicle to a certain extent, but whether the route calculated by the controller 10 is a route on which the own vehicle can actually travel without contacting the side walls 101, 102 or the utility pole 103. In order to make the driver surely grasp, it is desirable to obtain a travel area that the entire body of the host vehicle follows, and to display an image representing the travel area superimposed on the overhead image. That is, if an image representing the traveling area of the host vehicle is displayed on the overhead image so as to overlap the side walls 101 and 102 and the utility pole 103, it can be easily recognized that the obstacle calculated by the controller 10 is in contact with these obstacles. . From this point of view, the travel support device according to the present embodiment calculates a travel region that the entire vehicle body follows when the host vehicle travels along the steering interlocking track 108 and the reversal track 110, and calculates the travel region. The image to be displayed is superimposed on the overhead image as route information and displayed on the monitor 6.

車両の特性(アッカーマン旋回)を考えると、車両旋回時における旋回外周側の後輪の軌跡は車体全体の軌跡の内側に位置する。同様に、旋回内周側前端部の軌跡は移動後の車体全体の軌跡の内側に位置する。このため、自車両の走行領域を算出する上で、これら旋回外周側後輪の軌跡や旋回内周側前端部の軌跡は不要であり、必要となるのは、旋回外周側前端部の軌跡と旋回内周側後輪の軌跡である。   Considering the characteristics of the vehicle (Ackermann turning), the trajectory of the rear wheel on the outer periphery of the turning when the vehicle is turning is located inside the trajectory of the entire vehicle body. Similarly, the trajectory of the front end portion on the inner periphery side of the turn is located inside the trajectory of the entire vehicle body after movement. For this reason, in calculating the traveling area of the host vehicle, the trajectory of the turning outer peripheral side rear wheel and the trajectory of the turning inner peripheral side front end are unnecessary, and the trajectory of the turning outer peripheral side front end is required. This is the locus of the rear wheel on the inner circumference side of the turn.

そこで、まずは、自車両が操舵連動軌跡108に沿って舵角変更ポイント109(予測到達位置V1)に到達するまでの間の旋回外周側前端部の軌跡と旋回内周側後輪の軌跡とを演算する。具体的には、操舵連動軌跡108(半径が所定値の円周の一部)の旋回中心を求め、その旋回中心を中心として、現在位置V及び予測到達位置V1における自車両の旋回外周側前端部を通る円の円周と、現在位置V及び予測到達位置V1における旋回内側周後輪の位置を通る円の円周とを求める。そして、図9に示すように、前者の円周から、現在位置Vにおける自車両の旋回外周側前端部と予測到達位置V1における自車両の旋回外周側前端部との間の円弧を抽出することで、操舵連動軌跡108に対応した旋回外周側前端部の軌跡112を求めることができる。同様に、後者の円周から、現在位置Vにおける自車両の旋回内周側後輪の位置と予測到達位置V1における自車両の旋回内周側後輪の位置との間の円弧を抽出することで、操舵連動軌跡108に対応した旋回内周側後輪の軌跡113を求めることができる。   Therefore, first, the trajectory of the turning outer peripheral side front end and the trajectory of the turning inner peripheral side rear wheel until the host vehicle reaches the steering angle change point 109 (predicted arrival position V1) along the steering interlocking trajectory 108 are obtained. Calculate. Specifically, the turning center of the steering interlocking locus 108 (a part of the circumference having a predetermined radius) is obtained, and the turning outer peripheral side front end of the vehicle at the current position V and the predicted arrival position V1 with the turning center as the center. The circumference of the circle passing through the section and the circumference of the circle passing through the position of the rear wheel on the inner turning side at the current position V and the predicted arrival position V1 are obtained. Then, as shown in FIG. 9, from the former circumference, an arc between the turning outer peripheral front end of the host vehicle at the current position V and the turning outer peripheral front end of the host vehicle at the predicted arrival position V1 is extracted. Thus, the trajectory 112 of the front end of the turning outer periphery corresponding to the steering interlocking trajectory 108 can be obtained. Similarly, from the circumference of the latter, an arc between the position of the turning inner periphery side rear wheel of the host vehicle at the current position V and the position of the turning inner periphery side rear wheel of the host vehicle at the predicted arrival position V1 is extracted. Thus, the trajectory 113 of the turning inner peripheral side rear wheel corresponding to the steering interlocking trajectory 108 can be obtained.

次に、自車両が反転軌跡110に沿って予測到達位置V2に到達するまでの間の旋回外周側前端部の軌跡と旋回内周側後輪の軌跡とを演算する。具体的には、上記のように演算した操舵連動軌跡108に対応した旋回外周側前端部の軌跡112を、現在位置Vにおける自車両の前後方向(Y軸方向)を基準に左右反転し、更に、舵角変更ポイント109(予測到達位置V1)でのヨー角変化量に応じた角度だけ旋回方向に回転させる。そして、この軌跡を、図9に示すように、予測到達位置V1における旋回外周側前端部と予測到達位置V2における旋回外周側前端部との間を接続するようにX軸方向及びY軸方向に平行移動することで、反転軌跡110に対応した旋回外周側前端部の軌跡114を求めることができる。同様に、上記のように演算した操舵連動軌跡108に対応した旋回内周側後輪の軌跡113を、現在位置Vにおける自車両の前後方向(Y軸方向)を基準に左右反転し、更に、舵角変更ポイント109(予測到達位置V1)でのヨー角変化量に応じた角度だけ旋回方向に回転させる。そして、この軌跡を、予測到達位置V1における旋回内周側後輪の位置と予測到達位置V2における旋回内周側後輪の位置との間を接続するようにX軸方向及びY軸方向に平行移動することで、反転軌跡110に対応した旋回内周側後輪の軌跡115を求めることができる。   Next, the trajectory of the turning outer peripheral side front end and the trajectory of the turning inner peripheral side rear wheel until the host vehicle reaches the predicted arrival position V2 along the reverse trajectory 110 are calculated. Specifically, the trajectory 112 at the front end of the turning outer periphery corresponding to the steering interlocking trajectory 108 calculated as described above is reversed left and right with reference to the front-rear direction (Y-axis direction) of the host vehicle at the current position V, and Then, the vehicle is rotated in the turning direction by an angle corresponding to the yaw angle change amount at the steering angle change point 109 (predicted arrival position V1). Then, as shown in FIG. 9, the trajectory is connected in the X axis direction and the Y axis direction so as to connect the turning outer peripheral side front end portion at the predicted arrival position V1 and the turning outer periphery side front end portion at the predicted arrival position V2. By moving in parallel, the trajectory 114 of the turning outer peripheral front end corresponding to the reversal trajectory 110 can be obtained. Similarly, the trajectory 113 of the turning inner periphery side rear wheel corresponding to the steering interlocking trajectory 108 calculated as described above is reversed left and right with reference to the front-rear direction (Y-axis direction) of the host vehicle at the current position V, and The vehicle is rotated in the turning direction by an angle corresponding to the amount of yaw angle change at the steering angle change point 109 (predicted arrival position V1). Then, this trajectory is parallel to the X-axis direction and the Y-axis direction so as to connect between the position of the turning inner periphery side rear wheel at the predicted arrival position V1 and the position of the turning inner periphery side rear wheel at the predicted arrival position V2. By moving, the trajectory 115 of the turning inner periphery side rear wheel corresponding to the reversal trajectory 110 can be obtained.

次に、以上のように求めた操舵連動軌跡108に対応した旋回外周側前端部の軌跡112及び旋回内周側後輪の軌跡113と、反転軌跡110に対応した旋回外周側前端部の軌跡114及び旋回内周側後輪の軌跡115と、自車両の大きさとに基づいて、自車両が操舵連動軌跡108及び反転軌跡110に沿って進行したときに自車両の車体全体が辿る走行領域を算出する。具体的には、図10に示すように、現在位置Vにおける自車両のアウトラインと、予測到達位置V1における自車両のアウトラインと、予測到達位置V2における自車両のアウトラインと、操舵連動軌跡108に対応した旋回外周側前端部の軌跡112及び旋回内周側後輪の軌跡113と、反転軌跡110に対応した旋回外周側前端部の軌跡114及び旋回内周側後輪の軌跡115とにより囲まれる領域を、自車両が操舵連動軌跡108及び反転軌跡110に沿って進行したときに自車両の車体全体が辿る走行領域116として算出する。   Next, a trajectory outer peripheral front end trajectory 112 and a traverse inner peripheral rear wheel trajectory 113 corresponding to the steering interlock trajectory 108 obtained as described above, and a turning outer peripheral front end trajectory 114 corresponding to the reverse trajectory 110. Based on the trajectory 115 of the turning inner periphery side rear wheel and the size of the host vehicle, the travel region that the entire vehicle body of the host vehicle follows when the host vehicle travels along the steering interlocking track 108 and the reverse track 110 is calculated. To do. Specifically, as shown in FIG. 10, it corresponds to the outline of the own vehicle at the current position V, the outline of the own vehicle at the predicted arrival position V1, the outline of the own vehicle at the predicted arrival position V2, and the steering interlocking locus 108. The region surrounded by the trajectory 112 of the turning outer peripheral side front end and the trajectory 113 of the turning inner peripheral rear wheel, and the trajectory 114 of the turning outer peripheral side front end corresponding to the reverse trajectory 110 and the trajectory 115 of the turning inner peripheral side rear wheel. Is calculated as a travel region 116 that the entire vehicle body follows when the host vehicle travels along the steering interlocking track 108 and the reversing track 110.

コントロールユニット10は、以上のように自車両の走行領域116を算出すると、この走行領域116を表す画像を経路情報として俯瞰画像上に重畳してモニタ6に表示させる。これにより、自車両の運転者は、モニタ6に表示される支援画像を参照することで、現在の舵角に応じて計算された経路が狭部通過の経路として最適な経路であるかどうかを的確に判断することができる。そして、最適な経路ではないと判断したら、モニタ6に表示される支援画像を見ながらステアリングを操作して舵角を変更することで、最適な経路を探索することが可能となる。   When the control unit 10 calculates the travel region 116 of the host vehicle as described above, the control unit 10 superimposes an image representing the travel region 116 on the overhead image as route information and displays it on the monitor 6. Thereby, the driver of the own vehicle refers to the support image displayed on the monitor 6 to determine whether the route calculated according to the current steering angle is the optimum route as the narrow passage route. Can be judged accurately. If it is determined that the route is not the optimum route, the optimum route can be searched by changing the steering angle by operating the steering wheel while viewing the support image displayed on the monitor 6.

図11は、現在位置Vにおける自車両の舵角が変更された場合の予測到達位置V1,V2の変化を示している。ここでは、操舵方向は右方向で、舵角をθ1、θ2、θ3(θ1>θ2>θ3)の3種類で切り替えた場合を例示しており、舵角θ1のときの予測到達位置V1,V2を破線、舵角θ2のときの予測到達位置V1,V2を一点鎖線、舵角θ3のときの予測到達位置V1,V2を実線でそれぞれ示している。この図11に示す例では、現在位置Vにおける自車両の舵角がθ1の場合やθ2の場合には、電柱103を避けることはできるものの自車両の右前端部が右側の側壁102に接触してしまうが、現在位置Vにおける自車両の舵角をθ3とすることで、側壁102にも電柱103にも接触することなく狭部位置を通過可能となる。自車両の運転者は、以上のように、現在位置Vにおける自車両の舵角に応じた側壁102や電柱103への接触有無を確認することで、最適な経路を探索することができる。   FIG. 11 shows changes in the predicted arrival positions V1, V2 when the steering angle of the host vehicle at the current position V is changed. In this example, the steering direction is the right direction, and the steering angle is switched between three types of θ1, θ2, and θ3 (θ1> θ2> θ3). The predicted arrival positions V1, V2 at the steering angle θ1 are illustrated. Is a broken line, predicted arrival positions V1 and V2 at the steering angle θ2 are shown by alternate long and short dash lines, and predicted arrival positions V1 and V2 at the steering angle θ3 are shown by solid lines, respectively. In the example shown in FIG. 11, when the steering angle of the host vehicle at the current position V is θ1 or θ2, the utility pole 103 can be avoided, but the right front end of the host vehicle contacts the right side wall 102. However, by setting the steering angle of the vehicle at the current position V to θ3, it is possible to pass through the narrow portion position without contacting the side wall 102 or the power pole 103. As described above, the driver of the host vehicle can search for an optimum route by checking the presence or absence of contact with the side wall 102 or the utility pole 103 according to the steering angle of the host vehicle at the current position V.

なお、以上の例では、最適な経路かどうかの判定を自車両の運転者に委ねるようにしているが、例えば、俯瞰画像に対する画像処理などにより側壁101,102や電柱103などの障害物に接触することなく移動できる通行可能領域を検出する手段を設け、自車両の走行領域の一部が通行可能領域からはみ出していた場合に当該経路は最適な経路ではないと自動判定して表示を中断したり、自車両の運転者に舵角変更を促すガイド音声などを出力するようにしてもよい。   In the above example, the determination of whether the route is optimal is left to the driver of the host vehicle. However, for example, contact with obstacles such as the side walls 101 and 102 and the power pole 103 by image processing on the overhead view image is performed. A means for detecting a passable area that can be moved without being provided is provided, and if a part of the travel area of the host vehicle protrudes from the passable area, the route is automatically determined to be not the optimal route and the display is interrupted. Alternatively, a guide voice that prompts the driver of the host vehicle to change the rudder angle may be output.

また、以上の例では、自車両前方の道路上に1つの狭部位置のみを検出した場合を説明したが、複数の狭部位置が検出される場合は、自車両に近い狭部位置を通過した後に、次の狭部位置を対象として同様の処理を繰り返すようにすればよい。   In the above example, the case where only one narrow portion position is detected on the road ahead of the host vehicle has been described. However, when a plurality of narrow portion positions are detected, the vehicle passes through the narrow portion position close to the host vehicle. After that, the same processing may be repeated for the next narrow position.

<狭部通過のための経路算出の具体例2>
次に、図12に示すように、左右両側が側壁101,102により区画された幅狭の道路上で自車両の左前方に電柱103が設置されている場合であって、自車両の現在位置における姿勢が道路に対して斜めになっている場合の経路算出方法について説明する。
<Specific example 2 of route calculation for passing through narrow part>
Next, as shown in FIG. 12, when the utility pole 103 is installed on the left front side of the host vehicle on a narrow road partitioned by the side walls 101 and 102 on the left and right sides, the current position of the host vehicle A route calculation method in the case where the posture in FIG.

コントロールユニット10は、上述した例と同様に、車載カメラ1a〜1dの撮像画像を用いて生成した俯瞰画像上で自車両前方の電柱103を検出し、電柱103が存在する道路位置を狭部位置として認識する。そして、電柱103の自車両側に向いた端面に接し、自車両の現在位置Vにおける前後方向(Y軸方向)に対して垂直な方向(X軸方向)の直線204を、狭部位置を示す直線として求める。また、自車両の後輪車軸中心205を基準点とした自車両の現在位置Vを示す直線206を求める。そして、自車両の現在位置Vを示す直線206から狭部位置を示す直線204までの距離L21を算出する。   As in the example described above, the control unit 10 detects the utility pole 103 in front of the host vehicle on the overhead view image generated using the captured images of the in-vehicle cameras 1a to 1d, and determines the road position where the utility pole 103 exists as the narrow position. Recognize as A straight line 204 in the direction (X-axis direction) perpendicular to the front-rear direction (Y-axis direction) at the current position V of the own vehicle is in contact with the end surface of the utility pole 103 facing the own vehicle side, indicating the position of the narrow portion. Calculate as a straight line. Further, a straight line 206 indicating the current position V of the host vehicle is obtained with the rear wheel axle center 205 of the host vehicle as a reference point. And the distance L21 from the straight line 206 which shows the present position V of the own vehicle to the straight line 204 which shows a narrow part position is calculated.

次に、図13に示すように、自車両の現在位置Vを示す直線206及び狭部位置を示す直線204に平行で、且つ、自車両の現在位置Vを示す206からの距離L22と狭部位置を示す直線204からの距離L23とが等しくなる直線207を求め、この直線207を自車両の現在位置Vから狭部位置までの中間点を示す直線とする。   Next, as shown in FIG. 13, the distance L22 from the straight line 206 indicating the current position V of the host vehicle and the straight line 204 indicating the narrow position and the distance L22 from the 206 indicating the current position V of the own vehicle and the narrow portion. A straight line 207 having the same distance L23 from the straight line 204 indicating the position is obtained, and this straight line 207 is defined as a straight line indicating an intermediate point from the current position V of the host vehicle to the narrow position.

次に、図14に示すように、自車両が現在位置Vから現在の舵角を維持して進行したときに自車両の位置の基準点となる後輪車軸中心205が辿る軌跡208を、操舵連動軌跡として求める。そして、この操舵連動軌跡208と上記の中間点を示す直線207との交点を、操舵連動軌跡208の終点となる中間点(舵角変更ポイント)209とする。   Next, as shown in FIG. 14, when the host vehicle travels from the current position V while maintaining the current steering angle, a trajectory 208 followed by the rear axle center 205 serving as a reference point for the position of the host vehicle is steered. Obtained as an interlocked trajectory. Then, an intersection point between the steering interlocking locus 208 and the straight line 207 indicating the intermediate point is set as an intermediate point (steering angle changing point) 209 that is an end point of the steering interlocking locus 208.

次に、図15に示すように、自車両が操舵連動軌跡208に沿って進行して舵角変更ポイント209に到達したときの車両位置及び姿勢を求め、この舵角変更ポイント209を基準点とする位置を、自車両の予測到達位置V1とする。   Next, as shown in FIG. 15, the vehicle position and orientation when the host vehicle travels along the steering interlocking locus 208 and reaches the rudder angle change point 209 is obtained, and this rudder angle change point 209 is used as a reference point. The position to be used is assumed to be the predicted arrival position V1 of the host vehicle.

次に、図16に示すように、操舵連動軌跡208を舵角変更ポイント209を中心として180度回転させた軌跡を求め、この軌跡を反転軌跡210とする。この反転軌跡210は、舵角変更ポイント209を基準点とする予測到達位置V1にて舵角を反対方向に同じ角度だけ反転させて進行したときの後輪車軸中心205が辿る軌跡であり、その始点は舵角変更ポイント209となり、終点は狭部位置を示す直線204上の点211となる。   Next, as shown in FIG. 16, a trajectory obtained by rotating the steering interlocking trajectory 208 by 180 degrees around the rudder angle change point 209 is obtained, and this trajectory is set as an inverted trajectory 210. The reverse trajectory 210 is a trajectory followed by the rear wheel axle center 205 when the steering angle is reversed by the same angle in the opposite direction at the predicted arrival position V1 with the rudder angle change point 209 as a reference point. The start point is the steering angle change point 209, and the end point is the point 211 on the straight line 204 indicating the narrow position.

次に、図17に示すように、自車両が反転軌跡210に沿って旋回して終点211に到達したときの車両位置及び姿勢を求め、この反転軌跡210の終点211を基準点とする位置を、自車両の予測到達位置V2とする。   Next, as shown in FIG. 17, the vehicle position and posture when the host vehicle turns along the reversing trajectory 210 and reaches the end point 211 are obtained, and a position with the end point 211 of the reversing trajectory 210 as a reference point is obtained. The vehicle's predicted arrival position V2.

次に、図18に示すように、自車両が操舵連動軌跡208に沿って進行したときの自車両の旋回外周側前端部の軌跡212及び旋回内周側後輪の軌跡213と、自車両が反転軌跡210に沿って進行したときの自車両の旋回外周側前端部の軌跡214及び旋回内周側後輪の軌跡215とを求める。具体的には、操舵連動軌跡208の旋回中心と、現在位置V及び予測到達位置V1における自車両の旋回外周側前端部の位置とに基づいて、操舵連動軌跡208に対応した旋回外周側前端部の軌跡212を求める。同様に、操舵連動軌跡208の旋回中心と、現在位置V及び予測到達位置V1における自車両の旋回内周側後輪の位置とに基づいて、操舵連動軌跡208に対応した旋回内周側後輪の軌跡213を求める。また、操舵連動軌跡208に対応した旋回外周側前端部の軌跡212を現在位置Vにおける自車両の前後方向を基準に左右反転し、更に、舵角変更ポイント209(予測到達位置V1)でのヨー角変化量も応じた角度だけ旋回方向に回転させたものをX軸方向及びY軸方向に平行移動することで、反転軌跡210に対応した旋回外周側前端部の軌跡214を求める。同様に、操舵連動軌跡208に対応した旋回外周側前端部の軌跡214を現在位置Vにおける自車両の前後方向を基準に左右反転し、更に、舵角変更ポイント209(予測到達位置V1)でのヨー角変化量に応じた角度だけ旋回方向に回転させたものをX軸方向及びY軸方向に平行移動することで、反転軌跡210に対応した旋回外周側前端部の軌跡215を求める。   Next, as shown in FIG. 18, the trajectory 212 of the turning outer peripheral side front end and the trajectory 213 of the turning inner peripheral side rear wheel when the host vehicle travels along the steering interlocking trajectory 208, and the host vehicle A trajectory 214 of the turning outer peripheral side front end and a trajectory 215 of the turning inner peripheral side rear wheel of the host vehicle when traveling along the reverse trajectory 210 are obtained. Specifically, based on the turning center of the steering interlocking locus 208 and the position of the turning outer peripheral front end of the host vehicle at the current position V and the predicted arrival position V1, the turning outer peripheral front end corresponding to the steering interlocking locus 208 is obtained. The trajectory 212 is obtained. Similarly, based on the turning center of the steering interlocking locus 208 and the position of the turning inner peripheral rear wheel of the host vehicle at the current position V and the predicted arrival position V1, the turning inner peripheral rear wheel corresponding to the steering interlocking locus 208 is used. The trajectory 213 is obtained. Further, the trajectory 212 of the turning outer peripheral side front end corresponding to the steering interlocking trajectory 208 is reversed left and right with reference to the front-rear direction of the host vehicle at the current position V, and the yaw at the steering angle change point 209 (predicted arrival position V1). A trajectory 214 at the front end of the turning outer periphery corresponding to the reversing trajectory 210 is obtained by translating the rotation in the turning direction by an angle corresponding to the angle change amount in the X-axis direction and the Y-axis direction. Similarly, the trajectory 214 of the turning outer peripheral side front end corresponding to the steering interlocking trajectory 208 is reversed left and right with reference to the front-rear direction of the host vehicle at the current position V, and further at the steering angle change point 209 (predicted arrival position V1). A trajectory 215 of the turning outer peripheral side front end corresponding to the reversing trajectory 210 is obtained by translating an object rotated in the turning direction by an angle according to the yaw angle change amount in the X-axis direction and the Y-axis direction.

次に、図19に示すように、現在位置Vにおける自車両のアウトラインと、予測到達位置V1における自車両のアウトラインと、予測到達位置V2における自車両のアウトラインと、操舵連動軌跡208に対応した旋回外周側前端部の軌跡212及び旋回内周側後輪の軌跡213と、反転軌跡210に対応した旋回外周側前端部の軌跡214及び旋回内周側後輪の軌跡215とにより囲まれる領域を、自車両が操舵連動軌跡208及び反転軌跡210に沿って進行したときに自車両の車体全体が辿る走行領域216として算出する。   Next, as shown in FIG. 19, the outline of the host vehicle at the current position V, the outline of the host vehicle at the predicted arrival position V1, the outline of the host vehicle at the predicted arrival position V2, and the turn corresponding to the steering interlocking locus 208 A region surrounded by a trajectory 212 of the outer peripheral side front end portion and a trajectory 213 of the turning inner peripheral side rear wheel, and a trajectory 214 of the turning outer peripheral side front end portion corresponding to the reverse trajectory 210 and a trajectory 215 of the turning inner peripheral side rear wheel, This is calculated as a travel region 216 that the entire vehicle body follows when the host vehicle travels along the steering interlocking track 208 and the reversal track 210.

コントロールユニット10は、以上のように自車両の走行領域216を算出すると、この走行領域216を表す画像を経路情報として俯瞰画像上に重畳してモニタ6に表示させる。これにより、自車両の運転者は、モニタ6に表示される支援画像を参照することで、現在の舵角に応じて計算された経路が狭部通過の経路として最適な経路であるかどうかを的確に判断することができる。そして、最適な経路ではないと判断したら、モニタ6に表示される支援画像を見ながらステアリングを操作して舵角を変更することで、最適な経路を探索することが可能となる。   When the control unit 10 calculates the travel region 216 of the host vehicle as described above, the control unit 10 superimposes an image representing the travel region 216 on the bird's-eye view image as route information and displays it on the monitor 6. Thereby, the driver of the own vehicle refers to the support image displayed on the monitor 6 to determine whether the route calculated according to the current steering angle is the optimum route as the narrow passage route. Can be judged accurately. If it is determined that the route is not the optimum route, the optimum route can be searched by changing the steering angle by operating the steering wheel while viewing the support image displayed on the monitor 6.

図20は、現在位置Vにおける自車両の舵角が変更された場合の予測到達位置V1,V2の変化を示している。ここでは、操舵方向は右方向で、舵角をθ1、θ2、θ3(θ1>θ2>θ3)の3種類で切り替えた場合を例示しており、舵角θ1のときの予測到達位置V1,V2を破線、舵角θ2のときの予測到達位置V1,V2を一点鎖線、舵角θ3のときの予測到達位置V1,V2を実線でそれぞれ示している。この図20に示す例では、現在位置Vにおける自車両の舵角がθ1の場合には、電柱103を避けることはできるものの自車両の右前端部が右側の側壁102に接触してしまうことになり、現在位置Vにおける自車両の舵角がθ3の場合には、電柱103を避けた後の自車両の左前端部が左側の側壁101に接触してしまうことになるが、現在位置Vにおける自車両の舵角をθ2とすることで、側壁101,102にも電柱103にも接触することなく狭部位置を通過可能となる。自車両の運転者は、以上のように、現在位置Vにおける自車両の舵角に応じた側壁101,102や電柱103への接触有無を確認することで、最適な経路を探索することができる。   FIG. 20 shows changes in the predicted arrival positions V1, V2 when the steering angle of the host vehicle at the current position V is changed. In this example, the steering direction is the right direction, and the steering angle is switched between three types of θ1, θ2, and θ3 (θ1> θ2> θ3). The predicted arrival positions V1, V2 at the steering angle θ1 are illustrated. Is a broken line, predicted arrival positions V1 and V2 at the steering angle θ2 are shown by alternate long and short dash lines, and predicted arrival positions V1 and V2 at the steering angle θ3 are shown by solid lines, respectively. In the example shown in FIG. 20, when the steering angle of the host vehicle at the current position V is θ1, the right pole end of the host vehicle contacts the right side wall 102 although the utility pole 103 can be avoided. Thus, when the steering angle of the host vehicle at the current position V is θ3, the left front end of the host vehicle after avoiding the utility pole 103 comes into contact with the left side wall 101, but at the current position V By setting the steering angle of the host vehicle to θ2, it is possible to pass through the narrow portion position without contacting the side walls 101, 102 and the power pole 103. As described above, the driver of the host vehicle can search for the optimum route by checking the presence or absence of contact with the side walls 101 and 102 and the utility pole 103 according to the steering angle of the host vehicle at the current position V. .

<支援画像の他の表示形態>
ところで、以上の説明では、コントロールユニット10が車載カメラ1a〜1dにより撮像された画像を用いて自車両の周囲を真上から見下ろした俯瞰画像を生成し、この俯瞰画像上に自車両の走行領域を表す画像を重畳したものを支援画像としてモニタ6に表示することとしているが、自車両の周囲を真上から見下ろした俯瞰画像は運転者が実際に目で見る風景との差異が大きいため、運転者によっては実際の風景との対応付けが困難となることも想定される。このような観点から、例えば図21に示すように、運転者の視点位置から見た自車両前方の実際の風景に近い画像をベースとして、この画像上に自車両の走行領域を表す画像などの経路情報を重畳したものを支援画像としてモニタ6に表示するようにしてもよい。
<Other display forms of support images>
By the way, in the above description, the control unit 10 uses the images taken by the on-vehicle cameras 1a to 1d to generate a bird's-eye view of the surroundings of the host vehicle from directly above, and the traveling area of the host vehicle is displayed on the bird's-eye view image. However, since the overhead image obtained by looking down the surroundings of the host vehicle from directly above is greatly different from the scenery that the driver actually sees, It may be difficult for some drivers to associate with the actual scenery. From such a viewpoint, as shown in FIG. 21, for example, an image representing the traveling area of the host vehicle is displayed on the image based on an image close to the actual scenery in front of the host vehicle viewed from the viewpoint position of the driver. A superimposition of route information may be displayed on the monitor 6 as a support image.

図21に示すような支援画像をモニタ6に表示するには、自車両の運転者の視点位置に近い車体上部位置から自車両のフード先端部Fを含む自車両前方の画像を車載カメラにより撮像し、この車載カメラにより撮像された自車両前方の画像上に、上述した自車両の走行領域を表す画像を、車載カメラの視点位置から見た画像に変換して重畳すればよい。   In order to display the support image as shown in FIG. 21 on the monitor 6, an in-vehicle camera captures an image of the front of the host vehicle including the hood tip F of the host vehicle from an upper body position close to the viewpoint position of the driver of the host vehicle. Then, the image representing the traveling region of the host vehicle described above may be converted into an image viewed from the viewpoint position of the onboard camera and superimposed on the image ahead of the host vehicle captured by the onboard camera.

図22は、図21に示すような支援画像のベースとなる画像(運転者の視点位置から見た自車両前方の実際の風景に近い画像)を撮像するための車載カメラ1の具体的な設置位置を示す図である。運転者の視点位置から見た自車両前方の実際の風景に近い画像を、自車両に設置された車載カメラ1により撮像するには、車載カメラ1を自車両ピラーのルーフ側付け根付近に設置するのが最適である。この位置は、X−Y平面(自車両の前後方向及び車幅方向)では運転者の視点位置に近く、且つ、Z軸方向(自車両の高さ方向)では、運転者の視点位置よりも高い位置で自車両のフードが見下ろせる位置となるためである。   FIG. 22 shows a specific installation of the in-vehicle camera 1 for capturing an image (an image close to the actual scenery in front of the host vehicle viewed from the viewpoint position of the driver) as a base of the support image as shown in FIG. It is a figure which shows a position. In order to capture an image close to the actual scenery in front of the host vehicle viewed from the viewpoint position of the driver by the in-vehicle camera 1 installed in the own vehicle, the in-vehicle camera 1 is installed near the roof side base of the own vehicle pillar. Is the best. This position is close to the driver's viewpoint position in the XY plane (the front-rear direction and the vehicle width direction of the host vehicle), and more than the driver's viewpoint position in the Z-axis direction (the height direction of the host vehicle). This is because the hood of the host vehicle can be looked down at a high position.

また、車載カメラ1のカメラ光軸Lの角度は、X−Y平面においては、自車両のフードの左右前端位置に向けられることが望ましい。したがって、図21に示す例では、車載カメラ1を2つ用いて、一方の車載カメラ1の光軸Lをフードの左前端位置に向け、他方の車載カメラ1の光軸Lをフードの右前端位置に向けるようにしており、これら2つの車載カメラ1で撮像した画像を左右方向で合成するようにしている。   The angle of the camera optical axis L of the in-vehicle camera 1 is preferably directed to the left and right front end positions of the hood of the host vehicle in the XY plane. Therefore, in the example shown in FIG. 21, two in-vehicle cameras 1 are used, the optical axis L of one in-vehicle camera 1 is directed to the left front end position of the hood, and the optical axis L of the other in-vehicle camera 1 is directed to the right front end of the hood. The images taken by these two in-vehicle cameras 1 are combined in the left-right direction.

また、車載カメラ1のカメラ光軸LのZ軸方向の角度は、撮像した画像に自車両フードが映り込み、且つ、自車両の左右側面の前方向への延長線がイメージ出来る程度の長さ、具体的には画像の上下方向で、下端から1/4〜1/3程度、フードが映り込むような角度とすることが望ましい。また、自車両左右端の前方(奥)方向につては、車速や幅員にもよるが、約20m程度先の路面までが画像内に映り込むようにすることが望ましい。   Further, the angle of the camera optical axis L of the in-vehicle camera 1 in the Z-axis direction is such a length that the own vehicle hood is reflected in the captured image and an extension line in the forward direction of the left and right side surfaces of the own vehicle can be imagined. Specifically, it is desirable that the angle is such that the hood is reflected by about ¼ to 下端 from the lower end in the vertical direction of the image. Further, regarding the front (back) direction of the left and right ends of the host vehicle, it is desirable that the road surface about 20 m ahead is reflected in the image, depending on the vehicle speed and width.

なお、以上の条件を満足する画像が得られるのであれば、車載カメラ1の設置位置やカメラ光軸Lの角度は図22の例に特に限定されるものではなく、例えば、異なる位置に設置された車載カメラ1の焦点距離や画角などを調整し、この車載カメラ1で撮像された画像から必要な部分の画像のみを切り出して用いるようにしてもよい。さらに、上述したように、俯瞰画像を生成するために自車両の前後左右の4箇所に設置された広角の車載カメラ1a〜1dを用い、これら車載カメラ1a〜1dの撮像画像から必要箇所の画素を抽出して、運転者の視点位置付近からの画像に視点変換したものを用いるようにしてもよい。   If an image satisfying the above conditions can be obtained, the installation position of the in-vehicle camera 1 and the angle of the camera optical axis L are not particularly limited to the example of FIG. 22, and are installed at different positions, for example. The focal length and the angle of view of the in-vehicle camera 1 may be adjusted, and only a necessary part of the image captured from the in-vehicle camera 1 may be cut out and used. Furthermore, as described above, in order to generate a bird's-eye view image, the wide-angle vehicle-mounted cameras 1a to 1d installed at four locations on the front, rear, left, and right sides of the host vehicle are used, and pixels at necessary positions are taken from the captured images of these vehicle-mounted cameras 1a to 1d May be extracted and converted into an image from the vicinity of the driver's viewpoint position.

<第1の実施形態による効果>
以上、具体的な例を挙げながら詳細に説明したように、本実施形態の走行支援装置によれば、操舵連動軌跡と舵角変更ポイントと反転軌跡とからなる一連の経路を算出して、この経路を示す自車両の走行領域の画像などの経路情報をモニタ6に表示するようにしているので、狭部を通過するための最適な経路を運転者に的確に認識させることができ、運転に不慣れな初心者でも安心して狭部を通過できるように車両の走行を支援することができる。
<Effects of First Embodiment>
As described above in detail with specific examples, according to the travel support device of the present embodiment, a series of routes including a steering interlocking locus, a steering angle change point, and a reversing locus are calculated, and this Since the route information such as the image of the traveling area of the host vehicle indicating the route is displayed on the monitor 6, the driver can accurately recognize the optimum route for passing through the narrow portion, and driving Even an unfamiliar beginner can support driving of the vehicle so that it can pass through the narrow part with peace of mind.

また、本実施形態の走行支援装置によれば、現在位置から舵角変更ポイントまでの舵角連動軌跡を、舵角変更ポイントとなる中間点を中心として180°回転させた反転軌跡を求め、これら舵角連動軌跡と反転軌跡とを繋げた経路を狭部通過の経路として算出するようにしているので、経路を算出するための演算負荷を低減することができる。   Further, according to the travel support device of the present embodiment, reverse trajectories obtained by rotating the steering angle interlocking trajectory from the current position to the steering angle change point by 180 ° around the intermediate point serving as the steering angle change point are obtained. Since the route connecting the rudder angle interlocking locus and the reversing locus is calculated as the narrow passage route, the calculation load for calculating the route can be reduced.

また、本実施形態の走行支援装置によれば、自車両が操舵連動軌跡及び反転軌跡に沿って進行したときに自車両の車体全体が辿る軌跡を自車両の走行領域として算出し、この自車両の走行領域を表す画像を経路情報としてモニタ6に表示するようにしているので、自車両の現在の舵角に応じて計算される経路が最適な経路かどうかを運転者に一目で把握させることができる。なお、自車両の走行領域を表す画像以外にも、自車両が操舵連動軌跡及び反転軌跡に沿って進行したときの自車両の旋回外周側前端部の軌跡や、自車両が操舵連動軌跡及び反転軌跡に沿って進行したときの自車両の旋回内周側後輪の軌跡などを経路情報としてモニタ6に表示するようにしても、同様の効果を得ることができる。   Further, according to the driving support device of the present embodiment, the trajectory that the entire vehicle body follows when the host vehicle travels along the steering interlocking track and the reversing track is calculated as the traveling region of the host vehicle. Since the image representing the traveling area of the vehicle is displayed on the monitor 6 as route information, the driver can grasp at a glance whether the route calculated according to the current steering angle of the host vehicle is the optimum route. Can do. In addition to the image representing the travel area of the host vehicle, the track of the front end of the turning outer periphery of the host vehicle when the host vehicle travels along the steering interlock trajectory and the reverse trajectory, A similar effect can be obtained by displaying the trajectory of the turning inner periphery side rear wheel of the host vehicle when traveling along the trajectory on the monitor 6 as route information.

また、本実施形態の走行支援装置によれば、操舵連動軌跡に対応した旋回外周側前端部の軌跡や旋回内周側後輪の軌跡を反転し、舵角変更ポイントでの自車両の角度変化量分だけ回転させて平行移動したものを、反転軌跡に対応した旋回外周側前端部の軌跡や旋回内周側後輪の軌跡としても求めるようにしているので、旋回外周側前端部の軌跡や旋回内周側後輪の軌跡を算出するための演算負荷を低減することができる。   Further, according to the travel support device of the present embodiment, the trajectory of the turning outer peripheral side front end corresponding to the steering interlocking trajectory and the trajectory of the turning inner peripheral side rear wheel are reversed to change the angle of the host vehicle at the steering angle change point. As the result of rotating and moving in parallel is calculated as the trajectory of the turning outer peripheral side front end corresponding to the reverse trajectory and the trajectory of the turning inner peripheral side rear wheel, the trajectory of the turning outer peripheral side front end It is possible to reduce a calculation load for calculating the trajectory of the turning inner peripheral side rear wheel.

また、本実施形態の走行支援装置によれば、運転者による経路決定スイッチ5の操作によって経路が確定されるとこの経路を示す経路情報を環境側に固定して、モニタ6の表示画面上における経路情報の表示位置を自車両の移動量に応じて更新するようにしているので、自車両が走行を開始した後にも経路情報をモニタ6に正しく表示することができる。   Further, according to the driving support device of the present embodiment, when the route is determined by the driver's operation of the route determination switch 5, the route information indicating this route is fixed to the environment side and is displayed on the display screen of the monitor 6. Since the display position of the route information is updated according to the amount of movement of the host vehicle, the route information can be correctly displayed on the monitor 6 even after the host vehicle starts running.

また、本実施形態の走行支援装置によれば、車載カメラ1a〜1dで撮像された画像を用いて自車両の周囲を真上から見下ろした俯瞰画像を生成し、この俯瞰画像上に経路情報を重畳したものを支援画像としてモニタ6に表示することにより、狭部を通過するための経路を大局的に運転者に認識させることができる。一方、車載カメラ1で運転者の視点位置に近い車体上部位置から自車両フードの左右先端部を含む自車両前方の画像を撮像して、この画像上に経路情報を重畳したものを支援画像としてモニタ6に表示するようにした場合には、狭部を通過するための経路を実際の風景と対応付けて運転者に認識させることができる。   Moreover, according to the driving assistance apparatus of this embodiment, the overhead image which looked down the circumference | surroundings of the own vehicle from directly above using the image imaged with vehicle-mounted camera 1a-1d is produced | generated, and route information is shown on this overhead image. By displaying the superimposed image on the monitor 6 as a support image, it is possible to make the driver recognize the route for passing through the narrow portion globally. On the other hand, an in-vehicle camera 1 captures an image of the front of the host vehicle including the left and right front end portions of the host vehicle hood from the upper position of the vehicle body close to the driver's viewpoint, and the route information superimposed on this image is used as a support image. When displayed on the monitor 6, the driver can recognize the route for passing through the narrow portion in association with the actual landscape.

[第2の実施形態]
<構成>
図23は、本発明の第2の実施形態に係る走行支援装置の構成図である。本実施形態の走行支援装置は、コントロールユニット10における狭部通過のための経路算出の手法及びモニタ6に表示される支援画像の内容が、上述した第1の実施形態とは異なるものである。装置の構成は、基本的な部分は上述した第1の実施形態と同様であるが、コントロールユニット10にて実現される機能構成が第1の実施形態とは異なっている。以下、本実施形態に特徴的なコントロールユニット10の構成について説明する。なお、第1の実施形態と共通の構成要素については、同一の符号を用いることとする。
[Second Embodiment]
<Configuration>
FIG. 23 is a configuration diagram of a travel support apparatus according to the second embodiment of the present invention. The driving support device of the present embodiment is different from the first embodiment described above in the method of calculating a route for passing through a narrow portion in the control unit 10 and the content of the support image displayed on the monitor 6. The basic configuration of the apparatus is the same as that of the first embodiment described above, but the functional configuration realized by the control unit 10 is different from that of the first embodiment. Hereinafter, the configuration of the control unit 10 characteristic of the present embodiment will be described. Note that the same reference numerals are used for the components common to the first embodiment.

本実施形態の走行支援装置におけるコントロールユニット10は、第1の実施形態と同様に、所定の処理プログラムに従って動作するマイクロコンピュータを備えた電子制御ユニット(ECU)からなり、マイクロコンピュータのCPUで処理プログラムが実行されることによって、走行支援のための各種の制御機能を実現する。コントロールユニット10により実現される各種の制御機能は、図23に示すように、視点変換部11、俯瞰画像生成部12、画像処理部13、狭部位置検出部14、舵角変更ポイント演算部31、直線軌跡線演算部32、旋回軌跡線演算部33、旋回軌跡記憶部21、自車両情報記憶部23、移動量演算部24、自車位置判断部34、表示制御部35、画像更新部25、画像合成部26、音声ガイド生成部27、の各機能構成として捉えることができる。このうち、旋回軌跡記憶部21と自車両情報記憶部23は、コントロールユニット10内部のメモリにより実現される。   As in the first embodiment, the control unit 10 in the travel support apparatus according to the present embodiment includes an electronic control unit (ECU) including a microcomputer that operates according to a predetermined processing program. Is executed to realize various control functions for driving support. As shown in FIG. 23, various control functions realized by the control unit 10 include a viewpoint conversion unit 11, an overhead image generation unit 12, an image processing unit 13, a narrow position detection unit 14, and a steering angle change point calculation unit 31. , Straight trajectory line calculation unit 32, turning trajectory line calculation unit 33, turning trajectory storage unit 21, host vehicle information storage unit 23, movement amount calculation unit 24, host vehicle position determination unit 34, display control unit 35, image update unit 25 , The image synthesizing unit 26 and the voice guide generating unit 27. Among these, the turning locus storage unit 21 and the own vehicle information storage unit 23 are realized by a memory inside the control unit 10.

視点変換部11は、各車載カメラ1a〜1dからの出力画像を、自車両の真上を視点とした画像に視点変換(各画素の並べ替え)する。   The viewpoint conversion unit 11 converts the output images from the in-vehicle cameras 1a to 1d into images with the viewpoint directly above the host vehicle (rearrangement of each pixel).

俯瞰画像生成部12は、視点変換部11から出力される個別の視点変換された画像を合成し、自車両を略中心としてその周囲を真上から見下ろした俯瞰画像を生成する。   The bird's-eye view image generation unit 12 synthesizes the individual viewpoint-converted images output from the viewpoint conversion unit 11 and generates a bird's-eye view image with its own vehicle as a substantial center and the surrounding area looking down from directly above.

画像処理部13は、俯瞰画像生成部12から出力された俯瞰画像に対してエッジ検出などの画像処理を行って、自車両前方の障害物、具体的には道路の左右に存在する壁や植え込み、電柱などの立体障害物を検出する。なお、画像処理部13は、俯瞰画像に変換される前の車載カメラ1a〜1dの撮像画像に対して画像処理を行うことで電柱などの立体障害物を検出するようにしてもよい。   The image processing unit 13 performs image processing such as edge detection on the bird's-eye view image output from the bird's-eye view image generation unit 12, and obstacles ahead of the host vehicle, specifically, walls and implants existing on the left and right sides of the road Detect three-dimensional obstacles such as utility poles. The image processing unit 13 may detect a three-dimensional obstacle such as a utility pole by performing image processing on the captured images of the in-vehicle cameras 1a to 1d before being converted into the overhead view image.

狭部位置検出部14は、画像処理部13の出力に基づいて自車両前方の道路上で通行可能な道幅が狭くなっている狭部位置を特定し、その狭部位置に存在する電柱などの立体障害物までの距離までの距離を算出する。また、狭部位置検出部14は、自車両に対する車載カメラ1a〜1dの設置位置及び角度と電柱などの立体障害物の位置とから、自車両前後方向(Y軸方向)に対する立体障害物の角度も算出する。なお、自車両にレーザレンジファインダ等の他の物体検出装置が搭載されている場合には、この物体検出装置の検出信号を用いて狭部位置の特定及び距離や角度の算出を行うようにしてもよい。   Based on the output of the image processing unit 13, the narrow part position detection unit 14 specifies a narrow part position where the road width that can be passed on the road ahead of the host vehicle is narrow, and a power pole or the like that exists in the narrow part position. The distance to the distance to the three-dimensional obstacle is calculated. In addition, the narrow position detection unit 14 determines the angle of the three-dimensional obstacle with respect to the front-rear direction of the own vehicle (Y-axis direction) from the installation position and angle of the on-vehicle cameras 1a to 1d with respect to the own vehicle and the position of the three-dimensional obstacle such as a utility pole. Is also calculated. If another object detection device such as a laser range finder is mounted on the host vehicle, use the detection signal of this object detection device to specify the narrow part position and calculate the distance and angle. Also good.

舵角変更ポイント演算部31は、狭部位置検出部14で検出された狭部位置の手前で自車両を停車させて舵角を変更する位置である舵角変更ポイントを算出する。具体的には、舵角変更ポイント演算部31は、狭部位置に存在する電柱などの立体障害物に対して所定のマージン(例えば、電柱1本分の距離)をとった位置に、立体障害物回避の基準となる回避ポイントを設定する。また、自車両が現在位置から所定舵角(例えば、ステアリングをフル切りしたときの舵角)で旋回したときに旋回外周側後輪が辿る旋回円(例えば最小旋回円)を求める。そして、この旋回円に接し、且つ、設定した回避ポイントを通る直線を求めて、この直線に対して自車両の旋回外周側側面が一致する位置を舵角変更ポイントとして算出する。   The rudder angle change point calculation unit 31 calculates a rudder angle change point that is a position where the host vehicle is stopped before the narrow portion position detected by the narrow portion position detection unit 14 and the rudder angle is changed. Specifically, the rudder angle change point calculation unit 31 has a three-dimensional obstacle at a position where a predetermined margin (for example, a distance corresponding to one utility pole) is taken with respect to a three-dimensional obstacle such as a utility pole existing at a narrow position. Set an avoidance point that is a standard for avoiding objects. Further, a turning circle (for example, a minimum turning circle) that the turning outer peripheral rear wheel follows when the host vehicle turns at a predetermined steering angle (for example, a steering angle when the steering wheel is fully turned) from the current position is obtained. Then, a straight line that is in contact with the turning circle and passes through the set avoidance point is obtained, and a position where the turning outer peripheral side surface of the host vehicle matches the straight line is calculated as a steering angle change point.

直線軌跡線演算部32は、舵角変更ポイント演算部31で算出した直線をもとに、自車両が舵角変更ポイントに到達したときの旋回外周側前端部の位置を起点として狭部位置方向に延びる線分を求めるとともに、当該線分に対して平行で、且つ、この線分に対して自車両の車幅相当分の距離だけ離間した位置にあり、自車両が舵角変更ポイントに到達したときの旋回外周側前端部の位置を起点として狭部位置方向に延びる線分を求め、これら一対の線分を、舵角変更ポイントから狭部位置に至る自車両の直線軌跡線として算出する。   The straight locus line calculation unit 32 is based on the straight line calculated by the steering angle change point calculation unit 31 and starts from the position of the front end of the turning outer periphery when the host vehicle reaches the steering angle change point. And the vehicle is parallel to the line segment and at a distance from the line segment by a distance corresponding to the vehicle width of the host vehicle, and the host vehicle reaches the steering angle change point. The line segment extending in the narrow part position direction is obtained from the position of the front end of the turning outer periphery when the vehicle is turned, and the pair of line segments is calculated as a straight trajectory line of the host vehicle from the steering angle change point to the narrow part position. .

旋回軌跡線演算部33は、舵角センサ3の出力に基づいて、自車両が現在位置から現在の舵角を維持して進行したときに自車両の左右前端部が辿る一対の旋回円を、自車両の舵角に応じた旋回軌跡線として算出する。   Based on the output of the steering angle sensor 3, the turning trajectory line calculation unit 33 calculates a pair of turning circles that the left and right front ends of the host vehicle follow when the host vehicle travels from the current position while maintaining the current steering angle. It is calculated as a turning trajectory line according to the steering angle of the host vehicle.

旋回軌跡記憶部21は、自車両の舵角に応じた各部(左右前端や後輪位置)における軌跡線に関する情報(旋回円の半径や自車両の基準位置に対する旋回円中心の相対位置など)を記憶する。   The turning trajectory storage unit 21 stores information (such as the radius of the turning circle and the relative position of the center of the turning circle with respect to the reference position of the own vehicle) on each portion (left and right front ends and rear wheel position) corresponding to the steering angle of the own vehicle. Remember.

自車両情報記憶部23は、自車両の全長と、全幅と、自車両の旋回時に最外周端部となる左右前端部の位置、及び、後輪の接地位置等の情報を記憶する。   The host vehicle information storage unit 23 stores information such as the total length and width of the host vehicle, the positions of the left and right front end portions that are the outermost peripheral ends when the host vehicle is turning, and the ground contact position of the rear wheels.

移動量演算部24は、舵角センサ3の出力と、車輪速センサ4の出力とに基いて、自車両の移動量(前後方向、左右方向、ヨー角変化量)を演算する。   The movement amount calculation unit 24 calculates the movement amount of the host vehicle (front-rear direction, left-right direction, and yaw angle change amount) based on the output of the steering angle sensor 3 and the output of the wheel speed sensor 4.

自車位置判断部34は、移動量演算部24で算出された自車両の移動量に基づいて、自車両が舵角変更ポイントの手前側を走行しているのか、或いは舵角変更ポイントを越えた位置を走行しているのかを判断し、判断結果を後述する表示制御部35に出力する。   Based on the travel amount of the host vehicle calculated by the travel amount calculation unit 24, the host vehicle position determination unit 34 determines whether the host vehicle is traveling in front of the rudder angle change point or exceeds the rudder angle change point. It is determined whether the vehicle is traveling in the selected position, and the determination result is output to the display control unit 35 described later.

表示制御部35は、自車位置判断部34により自車両が舵角変更ポイントの手前側を走行していると判断された場合は、旋回軌跡線演算部33により算出された現在の舵角に応じた旋回軌跡線と、直線軌跡線演算部32により算出された自車幅相当の直線軌跡線との双方の情報を画像更新部25に出力し、自車位置判断部34により自車両が舵角変更ポイントを越えた位置を走行していると判断された場合は、直線軌跡線演算部32により算出された自車幅相当の直線軌跡線の情報のみを画像更新部25に出力する。   When the host vehicle position determination unit 34 determines that the host vehicle is traveling in front of the steering angle change point, the display control unit 35 sets the current steering angle calculated by the turning trajectory line calculation unit 33. Information on both the corresponding turning trajectory line and the straight trajectory line corresponding to the own vehicle width calculated by the straight trajectory line calculation unit 32 is output to the image updating unit 25, and the own vehicle position determination unit 34 steers the own vehicle. When it is determined that the vehicle is traveling at a position beyond the corner change point, only the information on the straight locus line corresponding to the vehicle width calculated by the straight locus line calculation unit 32 is output to the image update unit 25.

画像更新部25は、直線軌跡線演算部32により算出された自車幅相当の直線軌跡線が、環境(俯瞰画像として表示される自車両周囲の背景)側に固定されてモニタ6に表示されるように、移動量演算部24により算出される自車両の移動量に応じて、モニタ6の表示画面上における直線軌跡線の表示位置を更新する。   In the image updating unit 25, the straight locus line corresponding to the own vehicle width calculated by the straight locus line calculating unit 32 is fixed to the environment (background around the own vehicle displayed as a bird's-eye view image) and displayed on the monitor 6. As described above, the display position of the straight locus line on the display screen of the monitor 6 is updated according to the movement amount of the host vehicle calculated by the movement amount calculation unit 24.

画像合成部26は、俯瞰画像生成部12により生成された俯瞰画像上に、旋回軌跡線演算部33により算出された自車両の現在の舵角に応じた旋回軌跡線と、直線軌跡線演算部32により算出された自車幅相当の直線軌跡線と、舵角変更ポイントに到達したときの自車両の左右前端部位置を示すポール形状のアイコン(以下、ポールアイコンという。)とを重畳した支援画像を生成して、モニタ6へ出力する。   The image compositing unit 26 includes a turning trajectory line corresponding to the current steering angle of the host vehicle calculated by the turning trajectory line calculation unit 33 and a straight trajectory line calculation unit on the overhead image generated by the overhead image generation unit 12. Assistance in which a straight locus line corresponding to the vehicle width calculated by 32 and a pole-shaped icon (hereinafter referred to as a pole icon) indicating the left and right front end positions of the vehicle when the steering angle change point is reached are superimposed. An image is generated and output to the monitor 6.

音声ガイド生成部27は、移動量演算部24により算出される自車両の移動量に基づいて、狭部通過のための経路上における自車両の位置を特定し、必要な運転操作を運転者に教示するためのガイド音声を生成して、スピーカ7に出力する。   The voice guide generation unit 27 specifies the position of the host vehicle on the route for passing through the narrow part based on the amount of movement of the host vehicle calculated by the movement amount calculation unit 24, and performs a necessary driving operation to the driver. A guide voice for teaching is generated and output to the speaker 7.

<コントロールユニットによる処理>
次に、以上のように構成される本実施形態の走行支援装置のコントロールユニット10による処理の概要について、図24のフローチャートを参照しながら説明する。図24のフローチャートで示す一連の処理は、自車両の運転者により走行支援装置の起動スイッチ2が操作されることによって開始される。
<Processing by control unit>
Next, an outline of processing by the control unit 10 of the driving support apparatus of the present embodiment configured as described above will be described with reference to the flowchart of FIG. A series of processes shown in the flowchart of FIG. 24 is started when the driver of the host vehicle operates the start switch 2 of the driving support device.

起動スイッチ2の操作により走行支援処理の開始指令が入力されると、コントロールユニット10は、まずステップS201において、車載カメラ1a〜1dで撮像された自車両周囲の画像をもとに俯瞰画像を生成する。そして、ステップS202において、ステップS201で生成した俯瞰画像に対してエッジ検出などの画像処理を行って、自車両前方の狭部位置を検出する。なお、本実施形態では俯瞰画像に対する画像処理により狭部位置を検出する例を例示しているが、車載カメラ1a〜1dの撮像画像に対する画像処理により狭部位置を検出するようにしてもよいし、レーザレンジファインダ等の他の物体検出装置を用いて狭部位置を検出するようにしてもよい。   When a start command for driving support processing is input by operating the start switch 2, the control unit 10 first generates an overhead view image based on images around the own vehicle taken by the in-vehicle cameras 1a to 1d in step S201. To do. In step S202, image processing such as edge detection is performed on the bird's-eye view image generated in step S201 to detect a narrow portion position in front of the host vehicle. In this embodiment, an example in which the narrow portion position is detected by image processing on the overhead image is illustrated, but the narrow portion position may be detected by image processing on the captured images of the in-vehicle cameras 1a to 1d. The narrow portion position may be detected using another object detection device such as a laser range finder.

次に、コントロールユニット10は、ステップS203において、ステップS202で検出した狭部位置に存在する電柱などの立体障害物に対して所定のマージンをとった位置に回避ポイントを設定する。   Next, in step S203, the control unit 10 sets an avoidance point at a position where a predetermined margin is taken with respect to a three-dimensional obstacle such as a utility pole existing at the narrow position detected in step S202.

次に、コントロールユニット10は、ステップS204において、自車両が現在位置から所定舵角(例えば、ステアリングをフル切りしたときの舵角)で旋回したときに旋回外周側後輪が辿る旋回円(例えば最小旋回円)を求め、この旋回円に接し、且つ、ステップS203で設定した回避ポイントを通る直線を求めて、この直線に対して自車両の旋回外周側側面が一致する位置を舵角変更ポイントとして算出する。   Next, in step S204, the control unit 10 turns a turning circle (for example, the outer wheel on the turning outer periphery follows when the host vehicle turns from the current position at a predetermined steering angle (for example, the steering angle when the steering is fully turned)). Minimum turning circle), a straight line that touches this turning circle and passes through the avoidance point set in step S203 is obtained, and the position at which the turning outer peripheral side surface of the vehicle coincides with this straight line is the steering angle change point. Calculate as

次に、コントロールユニット10は、ステップS205において、ステップS204で求めた直線をもとに、舵角変更ポイントから狭部位置を通過するまでの自車両の直線軌跡線を算出する。   Next, in step S205, the control unit 10 calculates a straight trajectory line of the host vehicle from the rudder angle change point to passing through the narrow position based on the straight line obtained in step S204.

次に、コントロールユニット10は、ステップS206において、舵角センサ3の出力を検出し、ステップS207において、ステップS206で検出した舵角センサ3の出力に対応した旋回半径の軌跡線(自車両の左右前端部が辿る一対の軌跡線)を旋回軌跡記憶部21から読み出して、自車両の現在の舵角に応じた旋回軌跡線とする。   Next, the control unit 10 detects the output of the rudder angle sensor 3 in step S206, and in step S207, the trajectory line of the turning radius corresponding to the output of the rudder angle sensor 3 detected in step S206 (left and right of the host vehicle). A pair of trajectory lines followed by the front end portion) is read out from the trajectory trajectory storage unit 21 and used as a trajectory trajectory line corresponding to the current steering angle of the host vehicle.

次に、コントロールユニット10は、ステップS208において、ステップS205で算出した直線軌跡線と、ステップS207で算出した旋回軌跡線と、自車両が舵角変更ポイントに到達したときの左右前端部位置を示すポールアイコンとを、ステップS201で生成した自車両周囲の俯瞰画像上に重畳してモニタ6に表示させる。   Next, in step S208, the control unit 10 indicates the straight trajectory line calculated in step S205, the turning trajectory line calculated in step S207, and the left and right front end positions when the host vehicle reaches the rudder angle change point. The pole icon is displayed on the monitor 6 so as to be superimposed on the overhead view image around the host vehicle generated in step S201.

次に、コントロールユニット10は、ステップS209において、モニタ6に表示されている画像上の旋回軌跡線がポールアイコンの位置で直線軌跡線と交わるまでステアリングを操作する旨を運転者に教示するためのガイド音声をスピーカ7から出力させる。なお、ガイド音声の出力に代えて或いはガイド音声の出力とともに、上記内容のメッセージ文をモニタ6に表示させるようにしてもよい。   Next, in step S209, the control unit 10 teaches the driver that the steering is operated until the turning locus line on the image displayed on the monitor 6 intersects the linear locus line at the position of the pole icon. Guide voice is output from the speaker 7. Note that the message text having the above contents may be displayed on the monitor 6 instead of outputting the guide voice or together with the output of the guide voice.

次に、コントロールユニット10は、ステップS210において、舵角の変更がなされたか否か(舵角センサ3の出力が変化したか否か)を監視し、舵角が変更された場合はステップS206に戻ってステップS206以降の処理を繰り返し、舵角の変更が終了した段階で(舵角の変更がない場合はそのまま)次のステップS211に進む。   Next, in step S210, the control unit 10 monitors whether or not the steering angle has been changed (whether or not the output of the steering angle sensor 3 has changed). If the steering angle has been changed, the control unit 10 proceeds to step S206. Returning to step S206 and subsequent steps are repeated, and when the change of the steering angle is completed (if there is no change in the steering angle), the process proceeds to the next step S211.

次に、コントロールユニット10は、ステップS211において、舵角センサ3の出力に基づいて、自車両の現在の舵角が舵角変更ポイント算出の基準とした所定舵角(例えば、ステアリングをフル切りしたときの舵角)となっているかどうかを確認する。そして、自車両の現在の舵角が所定舵角となっていれば、ステップS212において、現在の舵角を維持した状態で自車両を前進させる旨を運転者に教示するためのガイド音声をスピーカ7から出力させる。なお、この場合にも、ガイド音声の出力に代えて或いはガイド音声の出力とともに、上記内容のメッセージ文をモニタ6に表示させるようにしてもよい。   Next, in step S211, based on the output of the steering angle sensor 3, the control unit 10 determines a predetermined steering angle (for example, fully turns the steering) based on the current steering angle of the host vehicle as a reference for calculating the steering angle change point. To see if it is at the rudder angle). If the current rudder angle of the host vehicle is a predetermined rudder angle, in step S212, a guide voice for instructing the driver to advance the own vehicle while maintaining the current rudder angle is displayed as a speaker. 7 to output. In this case as well, the message text having the above contents may be displayed on the monitor 6 instead of outputting the guide voice or together with the output of the guide voice.

次に、コントロールユニット10は、ステップS213において、車輪速センサ4の出力に基づいて自車両の移動量を算出し、ステップS214において、ステップS213で算出される自車両の移動量を監視しながら、自車両がステップS204で算出した操舵変更ポイントに到達したか否かを判定する。そして、自車両が舵角変更ポイントに到達したら、ステップS215において、自車両の現在の舵角に応じた旋回軌跡線を非表示に切り替えて、俯瞰画像上に直線軌跡線のみを重畳した画像をモニタ6に表示させる。また、コントロールユニット10は、ステップS216において、自車両を停車させてステアリングを中立状態に戻す旨を運転者に教示するためのガイド音声をスピーカ7から出力させる。なお、この場合にも、ガイド音声の出力に代えて或いはガイド音声の出力とともに、上記内容のメッセージ文をモニタ6に表示させるようにしてもよい。   Next, in step S213, the control unit 10 calculates the movement amount of the host vehicle based on the output of the wheel speed sensor 4, and in step S214, while monitoring the movement amount of the host vehicle calculated in step S213, It is determined whether or not the host vehicle has reached the steering change point calculated in step S204. Then, when the host vehicle reaches the rudder angle change point, in step S215, the turning trajectory line corresponding to the current rudder angle of the host vehicle is switched to non-display, and an image in which only the straight trajectory line is superimposed on the overhead image is displayed. It is displayed on the monitor 6. Further, in step S216, the control unit 10 causes the speaker 7 to output a guide voice for teaching the driver to stop the host vehicle and return the steering to the neutral state. In this case as well, the message text having the above contents may be displayed on the monitor 6 instead of outputting the guide voice or together with the output of the guide voice.

次に、コントロールユニット10は、ステップS217において、舵角センサ3の出力を監視しながら、自車両の舵角がステアリング中立状態の舵角となったかどうかを判定する。そして、自車両の舵角が中立状態の舵角となったら、ステップS218において、ステアリングを中立状態に維持したまま自車両を前進させる旨を運転者に教示するためのガイド音声を、再度、スピーカ7から出力させる。なお、この場合にも、ガイド音声の出力に代えて或いはガイド音声の出力とともに、上記内容のメッセージ文をモニタ6に表示させるようにしてもよい。   Next, in step S217, the control unit 10 determines whether or not the steering angle of the host vehicle has become the steering angle in the steering neutral state while monitoring the output of the steering angle sensor 3. When the steering angle of the host vehicle reaches the neutral steering angle, in step S218, a guide voice for teaching the driver to advance the host vehicle while maintaining the steering in the neutral state is again transmitted to the speaker. 7 to output. In this case as well, the message text having the above contents may be displayed on the monitor 6 instead of outputting the guide voice or together with the output of the guide voice.

次に、コントロールユニット10は、ステップS219において、車輪速センサ4の出力に基づいて自車両の移動量を算出し、ステップS220において、ステップS219で算出される自車両の移動量を監視しながら、自車両が狭部位置に到達したか否かを判定する。そして、自車両が狭部位置に到達したら、図24のフローチャートで示す一連の処理を終了する。   Next, in step S219, the control unit 10 calculates the amount of movement of the host vehicle based on the output of the wheel speed sensor 4, and in step S220, while monitoring the amount of movement of the host vehicle calculated in step S219, It is determined whether or not the host vehicle has reached the narrow position. And if the own vehicle reaches | attains a narrow part position, a series of processes shown by the flowchart of FIG. 24 will be complete | finished.

<狭部通過のための経路算出の具体例>
次に、図25に示すように、左右両側が側壁301,302により区画された幅狭の道路上で自車両の左前方に電柱303が設置されている場合を例に挙げて、本実施形態の走行支援装置のコントロールユニット10による経路算出方法の具体例を説明する。
<Specific example of route calculation for passing through narrow part>
Next, as shown in FIG. 25, the present embodiment will be described by taking as an example a case where a utility pole 303 is installed on the left front side of the host vehicle on a narrow road divided on both left and right sides by side walls 301 and 302. A specific example of the route calculation method by the control unit 10 of the driving support apparatus will be described.

図25に示すシーンにおいては、コントロールユニット10は、以下のような方法で狭部通過のための経路を算出する。すなわち、まず、車載カメラ1a〜1dの撮像画像を用いて生成した俯瞰画像上で自車両の現在位置Vの左前方にある電柱303を検出し、電柱303が存在する道路位置を狭部位置として認識する。   In the scene shown in FIG. 25, the control unit 10 calculates a route for passing through the narrow portion by the following method. That is, first, a power pole 303 located on the left front side of the current position V of the host vehicle is detected on a bird's-eye view image generated using captured images of the in-vehicle cameras 1a to 1d, and a road position where the power pole 303 exists is set as a narrow position. recognize.

次に、図26に示すように、この狭部位置に存在する電柱303に対して所定のマージンをとった位置に回避ポイント304を設定する。また、自車両が現在位置Vから所定舵角(例えば、ステアリングを右側にフル切りしたときの舵角)で旋回したときに旋回外周側後輪が辿る旋回円(例えば、最小旋回円)305を求める。そして、この旋回円305に接し、且つ、回避ポイント304を通る直線306を求める。   Next, as shown in FIG. 26, an avoidance point 304 is set at a position where a predetermined margin is taken with respect to the utility pole 303 existing at the narrow position. Further, a turning circle (for example, a minimum turning circle) 305 followed by the rear wheel on the turning outer periphery when the vehicle turns at a predetermined steering angle (for example, a steering angle when the steering wheel is fully turned to the right) from the current position V Ask. Then, a straight line 306 in contact with the turning circle 305 and passing through the avoidance point 304 is obtained.

次に、図27に示すように、自車両が旋回円に沿って旋回する過程で旋回外周側の側面部が直線306と一致する位置を求め、この位置を舵角変更ポイントV11とする。また、自車両がこの舵角変更ポイントV11に位置するときの自車両左前端部の位置307と、自車両右前端部の位置308とをそれぞれ求める。   Next, as shown in FIG. 27, in the process of turning the vehicle along a turning circle, a position where the side surface portion on the turning outer peripheral side coincides with the straight line 306 is obtained, and this position is set as a steering angle change point V11. Also, the position 307 of the left front end of the host vehicle and the position 308 of the right front end of the host vehicle when the host vehicle is positioned at the steering angle change point V11 are obtained.

次に、図28に示すように、直線306の一部をなす線分であって、自車両が舵角変更ポイントV11に位置するときの自車両左前端部の位置307を起点とし、狭部位置の方向に延びる所定長さの線分309を求める。また、この線分309に対して平行で自車両の車幅相当分の距離だけ離間した線分、つまり、自車両が舵角変更ポイントV11に位置するときの自車両右前端部の位置308を起点とし、狭部位置の方向に延びる所定長さの線分310を求める。そして、これら一対の線分309,310を、舵角変更ポイントV11から狭部位置に至る自車両の直線軌跡線とする。   Next, as shown in FIG. 28, a line segment that forms part of the straight line 306, starting from the position 307 of the left front end of the host vehicle when the host vehicle is positioned at the steering angle change point V11, A line segment 309 having a predetermined length extending in the direction of the position is obtained. Further, a line segment parallel to the line segment 309 and separated by a distance corresponding to the vehicle width of the host vehicle, that is, the position 308 of the right front end of the host vehicle when the host vehicle is positioned at the steering angle change point V11. A line segment 310 having a predetermined length extending in the direction of the narrow portion position is obtained as a starting point. Then, the pair of line segments 309 and 310 is set as a straight trajectory line of the host vehicle from the steering angle change point V11 to the narrow portion position.

次に、図29に示すように、自車両が現在の舵角を維持して旋回したときに自車両の左右前端部が辿る一対の軌跡311,312を求め、これら一対の軌跡311,312を、自車両の現在の舵角に応じた旋回軌跡線とする。   Next, as shown in FIG. 29, when the host vehicle turns while maintaining the current steering angle, a pair of trajectories 311 and 312 that the left and right front ends of the host vehicle follow are obtained. A turning locus line corresponding to the current steering angle of the host vehicle is used.

コントロールユニット10は、以上のようにして直線軌跡線309,310と、旋回軌跡線311,312を算出すると、図30に示すように、これら直線軌跡線309,310及び旋回軌跡線311,312と、自車両が舵角変更ポイントV11に位置するときの自車両左右前端部の位置307,308を示すポールアイコンとを俯瞰画像上に重畳してモニタ6に表示させる。そして、この図30のような支援画像をモニタ6に表示させた状態で、スピーカ7からのガイド音声の出力などにより、モニタ6に表示されている画像上の旋回軌跡線311,312がポールアイコンの位置で直線軌跡線309,310と交わるまでステアリングを操作する旨を運転者に教示する。   When the control unit 10 calculates the straight locus lines 309 and 310 and the turning locus lines 311 and 312 as described above, as shown in FIG. 30, the straight locus lines 309 and 310 and the turning locus lines 311 and 312 The pole icon indicating the positions 307 and 308 of the left and right front ends of the host vehicle when the host vehicle is positioned at the steering angle change point V11 is superimposed on the overhead image and displayed on the monitor 6. Then, in a state where the support image as shown in FIG. 30 is displayed on the monitor 6, the turning trajectory lines 311 and 312 on the image displayed on the monitor 6 are pole icons by the output of the guide voice from the speaker 7. The driver is instructed to operate the steering wheel until it intersects the straight locus lines 309 and 310 at the position.

ここで、自車両の運転者がステアリングを操作すると、俯瞰画像上に重畳されている旋回軌跡線311,312が操舵に連動して変化することとなり、所定舵角(例えばフル切り)までステアリングが操作されると、図31に示すように、旋回軌跡線311,312がポールアイコンの位置で直線軌跡線309,310と交わる。そして、このときの旋回軌跡線311,312と直線軌跡線309,310とを繋いだ経路が、狭部通過のための最適経路となる。   Here, when the driver of the host vehicle operates the steering, the turning trajectory lines 311 and 312 superimposed on the overhead view image change in conjunction with the steering, and the steering is performed up to a predetermined steering angle (for example, full turn). When operated, as shown in FIG. 31, the turning trajectory lines 311 and 312 intersect the straight trajectory lines 309 and 310 at the position of the pole icon. And the path | route which connected the turning trace lines 311 and 312 and the linear trace lines 309 and 310 at this time becomes an optimal path | route for narrow part passage.

<支援画像の他の表示形態>
ところで、以上の説明では、コントロールユニット10が車載カメラ1a〜1dにより撮像された画像を用いて自車両の俯瞰画像を生成し、この俯瞰画像上に、旋回軌跡線309,310及び直線軌跡線311,312とポールアイコンとを重畳したものを支援画像としてモニタ6に表示することとしているが、第1の実施形態と同様、実際の風景との対応付けを容易にするとの観点から、図32及び図33に示すように、運転者の視点位置から見た自車両前方の実際の風景に近い画像をベースとして、この画像上に旋回軌跡線309,310や直線軌跡線311,312、ポールアイコンPを重畳したものを支援画像としてモニタ6に表示するようにしてもよい。なお、図32の画像例は、自車両が舵角変更ポイントの手前を走行している際にモニタ6に表示される支援画像であり、図33の画像例は、自車両が舵角変更ポイントを越えた位置を走行している際にモニタ6に表示される支援画像である。
<Other display forms of support images>
By the way, in the above description, the control unit 10 generates a bird's-eye view image of the host vehicle using images captured by the in-vehicle cameras 1a to 1d, and the turning locus lines 309 and 310 and the straight locus line 311 are formed on the bird's-eye view image. , 312 and a pole icon superimposed on each other are displayed on the monitor 6 as a support image. From the viewpoint of facilitating the association with the actual landscape, as in the first embodiment, FIG. As shown in FIG. 33, based on an image close to the actual scenery in front of the host vehicle viewed from the viewpoint position of the driver, turning trajectory lines 309 and 310, straight trajectory lines 311 and 312 and a pole icon P are displayed on this image. May be displayed on the monitor 6 as a support image. Note that the image example in FIG. 32 is a support image displayed on the monitor 6 when the host vehicle is traveling in front of the rudder angle change point, and the image example in FIG. It is the support image displayed on the monitor 6 when driving | running | working the position beyond.

自車両の運転者は、図32のような支援画像をモニタ6で確認することにより、所定舵角を維持しながら旋回軌跡線311,312に沿って走行している状態から、次に直進走行に切り替えるためにステアリング操作を行う位置(舵角変更ポイント)を実際の風景と対応付けながら把握できる。このため、舵角変更ポイントまでの距離感をつかみやすく、ステアリング操作の遅れなどを未然に防止することができる。また、自車両の位置が舵角変更ポイントに到達した後は、旋回軌跡線311,312は自車両の後方となるため、図33に示すように、旋回軌跡線311,312は非表示にして、モニタ6では直進軌跡線309,310のみを表示する。このように、不要な情報を非表示にすることで、左右の直線軌跡線309,310に自車両のフード先端部を合わせるための操舵に注力することができ、表示された軌跡をトレースしやすくなる。   The driver of the own vehicle checks the support image as shown in FIG. 32 on the monitor 6 and then travels straight ahead from the state of traveling along the turning trajectory lines 311 and 312 while maintaining a predetermined steering angle. It is possible to grasp the position (steering angle change point) at which the steering operation is performed for switching to the actual scenery while associating it with the actual scenery. For this reason, it is easy to grasp the sense of distance to the rudder angle change point, and it is possible to prevent the steering operation from being delayed. Further, after the position of the host vehicle reaches the rudder angle change point, the turning trajectory lines 311 and 312 are behind the own vehicle, so the turning trajectory lines 311 and 312 are not displayed as shown in FIG. The monitor 6 displays only the straight trajectory lines 309 and 310. In this way, by hiding unnecessary information, it is possible to focus on steering for aligning the front end of the hood of the host vehicle with the left and right straight locus lines 309 and 310, and it is easy to trace the displayed locus. Become.

図32及び図33に示すような支援画像をモニタ6に表示するには、例えば図22に例示した設置位置及びカメラ光軸角度となるように車載カメラ1を設置し、この車載カメラ1により自車両の運転者の視点位置に近い車体上部位置から自車両のフード先端部Fを含む自車両前方の画像を撮像して、この車載カメラ1により撮像された自車両前方の画像上に、旋回軌跡線309,310や直線軌跡線311,312、ポールアイコンPを、車載カメラ1の視点位置から見た画像に変換して重畳すればよい。   In order to display the support image as shown in FIGS. 32 and 33 on the monitor 6, for example, the in-vehicle camera 1 is installed so that the installation position and the camera optical axis angle illustrated in FIG. An image in front of the host vehicle including the hood tip F of the host vehicle is captured from the upper position of the vehicle body near the viewpoint position of the driver of the vehicle, and a turning locus is displayed on the image in front of the host vehicle captured by the in-vehicle camera 1. The lines 309 and 310, the linear locus lines 311 and 312 and the pole icon P may be converted into an image viewed from the viewpoint position of the in-vehicle camera 1 and superimposed.

<第2の実施形態による効果>
以上、具体的な例を挙げながら詳細に説明したように、本実施形態の走行支援装置によれば、旋回軌跡と舵角変更ポイントと直線軌跡とからなる一連の経路を算出して、この経路を示す旋回軌跡線や直線軌跡線などの経路情報をモニタ6に表示するようにしているので、狭部を通過するための最適な経路を運転者に的確に認識させることができ、運転に不慣れな初心者でも安心して狭部を通過できるように車両の走行を支援することができる。
<Effects of Second Embodiment>
As described above in detail with specific examples, according to the travel support device of the present embodiment, a series of routes including a turning locus, a steering angle change point, and a linear locus are calculated, and this route is calculated. Is displayed on the monitor 6 such as a turning trajectory line or a straight trajectory line indicating that it is possible for the driver to accurately recognize the optimal route for passing through the narrow part, and is unfamiliar with driving. Even beginners can assist in driving the vehicle so that they can pass through narrow spaces with peace of mind.

また、本実施形態の走行支援装置によれば、舵角変更ポイントに到達したときの自車両の左右前端部位置を示すポールアイコンを経路情報の1つとしてモニタ6に表示するようにしているので、自車両の舵角に応じた旋回軌跡を直線軌跡に合わせるための運転者によるステアリング操作を容易なものとすることができる。   Further, according to the driving support device of the present embodiment, the pole icon indicating the left and right front end positions of the host vehicle when the steering angle change point is reached is displayed on the monitor 6 as one piece of route information. Thus, the steering operation by the driver for matching the turning trajectory according to the steering angle of the host vehicle to the straight trajectory can be facilitated.

また、本実施形態の走行支援装置によれば、自車両が走行を開始した後はその走行位置を確認しながら、自車両の走行位置が舵角変更ポイントの手前であれば旋回軌跡線と直線軌跡線の双方をモニタ6に表示し、自車両の走行位置が舵角変更ポイントを越えた場合は、直線軌跡線のみをモニタ6に表示するようにしているので、不要な表示に運転者の注意が向くことを未然に防止して、運転操作に注力させることができる。   In addition, according to the travel support device of the present embodiment, after the host vehicle starts traveling, while confirming the travel position, if the travel position of the host vehicle is in front of the rudder angle change point, a straight line with the turning trajectory line Since both the trajectory lines are displayed on the monitor 6 and the travel position of the host vehicle exceeds the rudder angle change point, only the straight trajectory lines are displayed on the monitor 6, so that the driver's unnecessary display is displayed. It is possible to focus attention on driving operations by preventing attention.

また、本実施形態の走行支援装置によれば、狭部通過の経路を示す旋回軌跡線や直線軌跡線、ポールアイコンなどの環境情報を環境側に固定して、モニタ6の表示画面上における経路情報の表示位置を自車両の移動量に応じて更新するようにしているので、自車両が走行を開始した後にも経路情報をモニタ6に正しく表示することができる。   Further, according to the driving support device of the present embodiment, environmental information such as a turning trajectory line, a straight trajectory line, and a pole icon indicating the path of narrow passage is fixed to the environment side, and the path on the display screen of the monitor 6 Since the display position of the information is updated according to the movement amount of the host vehicle, the route information can be correctly displayed on the monitor 6 even after the host vehicle starts running.

また、本実施形態の走行支援装置によれば、車載カメラ1a〜1dで撮像された画像を用いて自車両の周囲を真上から見下ろした俯瞰画像を生成し、この俯瞰画像上に旋回軌跡線や直線軌跡線、ポールアイコンなどの経路情報を重畳したものを支援画像としてモニタ6に表示することにより、狭部を通過するための経路を大局的に運転者に認識させることができる。一方、車載カメラ1で運転者の視点位置に近い車体上部位置から自車両フードの左右先端部を含む自車両前方の画像を撮像して、この画像上に上記の経路情報を重畳したものを支援画像としてモニタ6に表示するようにした場合には、狭部を通過するための経路を実際の風景と対応付けて運転者に認識させることができる。   Moreover, according to the driving assistance apparatus of this embodiment, the overhead image which looked down on the circumference | surroundings of the own vehicle from right above using the image imaged with the vehicle-mounted cameras 1a-1d is produced | generated, and a turning locus line on this overhead image By displaying on the monitor 6 as a support image an overlay of route information such as a straight locus line, a pole icon, etc., it is possible to make the driver recognize the route for passing through the narrow part in a global manner. On the other hand, the on-vehicle camera 1 captures an image of the front of the host vehicle including the left and right tip portions of the host vehicle hood from the upper position of the vehicle body close to the driver's viewpoint, and supports the above-described route information superimposed on the image. When the image is displayed on the monitor 6, the driver can recognize the route for passing through the narrow portion in association with the actual landscape.

以上、本発明の具体的な実施形態として第1の実施形態及び第2の実施形態を説明したが、これらの各実施形態は本発明の一適用例を例示的に示したものであり、本発明の技術的範囲がこれらの実施形態として開示した内容に限定されることを意図するものではない。つまり、本発明の技術的範囲は、上述した各実施形態で開示した具体的な技術事項に限らず、この開示から容易に導きうる様々な変形、変更、代替技術なども含むものである。   As described above, the first embodiment and the second embodiment have been described as specific embodiments of the present invention. However, each of these embodiments is an example of application of the present invention, and It is not intended that the technical scope of the invention be limited to the content disclosed as these embodiments. That is, the technical scope of the present invention is not limited to the specific technical items disclosed in the above-described embodiments, but includes various modifications, changes, alternative techniques, and the like that can be easily derived from this disclosure.

1(1a〜1d) 車載カメラ(撮像手段)
3 舵角センサ(舵角検出手段)
6 モニタ(表示手段)
10 コントロールユニット
11 視点変換部
12 俯瞰画像生成部(俯瞰画像生成手段)
13 画像処理部
14 狭部位置検出部(狭部位置検出手段)
15 中間点演算部(舵角変更ポイント算出手段)
16 操舵連動軌跡演算部(第1軌跡算出手段)
17 旋回外周側前端部軌跡演算部(外周端部軌跡算出手段)
18 旋回内周側後輪軌跡演算部(内周後輪軌跡算出手段)
19 軌跡反転演算部(第2軌跡算出手段)
20 走行領域演算部(走行領域算出手段)
24 移動量演算部(移動量検出手段)
25 画像更新部
26 画像合成部
31 舵角変更ポイント演算部(舵角変更ポイント算出手段)
32 直線軌跡線演算部(第2軌跡算出手段)
33 旋回軌跡線演算部(第1軌跡算出手段)
34 自車位置判断部(判定手段)
35 表示制御部
1 (1a-1d) In-vehicle camera (imaging means)
3 Rudder angle sensor (steering angle detection means)
6 Monitor (display means)
DESCRIPTION OF SYMBOLS 10 Control unit 11 Viewpoint conversion part 12 Overhead image generation part (Overhead image generation means)
13 Image processing unit 14 Narrow part position detection unit (narrow part position detection means)
15 Intermediate point calculation part (steering angle change point calculation means)
16 Steering interlocking locus calculation unit (first locus calculating means)
17 Turning outer periphery side front end locus calculation unit (outer periphery end locus calculation means)
18 Turning inner circumference side rear wheel locus calculation unit (inner circumference rear wheel locus calculation means)
19 Trajectory reversal calculation unit (second trajectory calculation means)
20 Traveling area calculation unit (traveling area calculation means)
24 Movement amount calculation unit (movement amount detection means)
25 Image update unit 26 Image composition unit 31 Rudder angle change point calculation unit (steer angle change point calculation means)
32 Straight locus line calculation unit (second locus calculation means)
33 Turning locus line calculation unit (first locus calculating means)
34 Self-vehicle position determination unit (determination means)
35 Display controller

Claims (15)

自車両前方の道幅が狭くなっている狭部位置を検出する狭部位置検出手段と、
自車両の舵角を検出する舵角検出手段と、
自車両が現在位置から現在の舵角を維持して進行したときの第1軌跡を算出する第1軌跡算出手段と、
前記狭部位置の手前で自車両を停車させて舵角を変更する舵角変更ポイントを算出する舵角変更ポイント算出手段と、
自車両が前記舵角変更ポイントから当該舵角変更ポイントで変更した後の舵角を維持して進行したときの第2軌跡を算出する第2軌跡算出手段と、
前記第1軌跡と前記舵角変更ポイントと前記第2軌跡とからなる狭部通過の経路を示す経路情報を表示する表示手段と、を備えることを特徴とする走行支援装置。
Narrow part position detecting means for detecting a narrow part position where the road width in front of the host vehicle is narrow;
Rudder angle detection means for detecting the rudder angle of the host vehicle;
First trajectory calculating means for calculating a first trajectory when the host vehicle travels from the current position while maintaining the current steering angle;
Rudder angle change point calculating means for calculating a rudder angle change point for changing the rudder angle by stopping the host vehicle before the narrow part position;
Second trajectory calculation means for calculating a second trajectory when the host vehicle travels while maintaining the rudder angle after changing from the rudder angle change point to the rudder angle change point;
A driving support device, comprising: display means for displaying route information indicating a route through a narrow portion composed of the first locus, the steering angle change point, and the second locus.
前記舵角変更ポイント算出手段は、自車両の現在位置から前記狭部位置までの中間点を前記舵角変更ポイントとして算出し、
前記第2軌跡算出手段は、前記第1軌跡を前記中間点を中心として180度回転させた軌跡を前記第2軌跡として算出することを特徴とする請求項1に記載の走行支援装置。
The rudder angle change point calculating means calculates an intermediate point from the current position of the host vehicle to the narrow portion position as the rudder angle change point,
2. The travel support apparatus according to claim 1, wherein the second trajectory calculation unit calculates a trajectory obtained by rotating the first trajectory by 180 degrees about the intermediate point as the second trajectory.
自車両が前記第1軌跡及び前記第2軌跡に沿って進行したときの旋回外周側前端部の軌跡を算出する外周端部軌跡算出手段をさらに備え、
前記表示手段は、前記経路情報の1つとして前記旋回外周側前端部の軌跡を表示することを特徴とする請求項2に記載の走行支援装置。
An outer peripheral end locus calculating means for calculating a trajectory of the front end portion of the turning outer periphery when the host vehicle travels along the first locus and the second locus;
The travel support apparatus according to claim 2, wherein the display unit displays a trajectory of the front end of the turning outer periphery as one of the route information.
自車両が前記第1軌跡及び前記第2軌跡に沿って進行したときの旋回内周側後輪の軌跡を算出する内周後輪軌跡算出手段をさらに備え、
前記表示手段は、前記経路情報の1つとして前記旋回内周側後輪の軌跡を表示することを特徴とする請求項2又は3に記載の走行支援装置。
An inner periphery rear wheel trajectory calculating means for calculating a trajectory of the turning inner peripheral rear wheel when the host vehicle travels along the first trajectory and the second trajectory;
The travel support apparatus according to claim 2 or 3, wherein the display means displays a trajectory of the turning inner peripheral rear wheel as one of the route information.
自車両が前記第1軌跡及び前記第2軌跡に沿って進行したときの旋回外周側前端部の軌跡を算出する外周端部軌跡算出手段と、
自車両が前記第1軌跡及び前記第2軌跡に沿って進行したときの旋回内周側後輪の軌跡を算出する内周後輪軌跡算出手段と、
前記旋回外周側前端部の軌跡と前記旋回内周側後輪の軌跡と自車両の大きさとに基づいて、自車両が前記第1軌跡及び前記第2軌跡に沿って進行したときに自車両の車体全体が辿る走行領域を算出する走行領域算出手段と、をさらに備え、
前記表示手段は、前記経路情報の1つとして前記走行領域を表示することを特徴とする請求項2に記載の走行支援装置。
An outer peripheral end locus calculating means for calculating a trajectory of the front end portion of the turning outer periphery when the host vehicle travels along the first locus and the second locus;
An inner peripheral rear wheel trajectory calculating means for calculating a trajectory of the turning inner peripheral rear wheel when the host vehicle travels along the first trajectory and the second trajectory;
Based on the trajectory of the turning outer peripheral side front end, the trajectory of the turning inner peripheral rear wheel, and the size of the host vehicle, the host vehicle travels along the first trajectory and the second trajectory. A travel area calculating means for calculating a travel area that the entire vehicle body follows,
The travel support apparatus according to claim 2, wherein the display unit displays the travel area as one of the route information.
前記外周端部軌跡算出手段は、自車両が現在位置から現在の舵角を維持して進行したときに旋回外周側前端部が辿る軌跡を前記第1軌跡に対応する旋回外周側前端部の軌跡として算出するとともに、当該軌跡を現在位置における自車両前後方向軸を基準に反転し、且つ、前記中間点における自車両角度の変化量分だけ旋回方向に回転させるとともに平行移動した軌跡を、前記第2軌跡に対応する旋回外周側前端部の軌跡として算出することを特徴とする請求項3又は5に記載の走行支援装置。   The outer peripheral end locus calculating means is a trajectory of the turning outer peripheral front end corresponding to the first trajectory that follows the trajectory followed by the turning outer peripheral front end when the host vehicle advances from the current position while maintaining the current steering angle. The trajectory is reversed with respect to the vehicle longitudinal axis at the current position as a reference, rotated in the turning direction by the amount of change in the vehicle angle at the intermediate point, and the trajectory translated in parallel is The travel support device according to claim 3 or 5, wherein the travel support device is calculated as a trajectory of the front end portion on the outer periphery of the turn corresponding to two trajectories. 前記内周端部軌跡算出手段は、自車両が現在位置から現在の舵角を維持して進行したときに旋回内周側後輪が辿る軌跡を前記第1軌跡に対応する旋回内周側後輪の軌跡として算出するとともに、当該軌跡を現在位置における自車両前後方向軸を基準に反転し、且つ、前記中間点における自車両角度の変化量分だけ旋回方向に回転させるとともに平行移動した軌跡を、前記第2軌跡に対応する旋回内周側後輪の軌跡として算出することを特徴とする請求項4又は5に記載の走行支援装置。   The inner peripheral end locus calculating means is configured to determine a trajectory followed by the turning inner peripheral rear wheel when the host vehicle travels from the current position while maintaining the current steering angle. The trajectory of the wheel is calculated as a trajectory of the wheel, reversed with respect to the vehicle longitudinal axis at the current position as a reference, rotated in the turning direction by the amount of change in the vehicle angle at the intermediate point, and moved in parallel. The travel support device according to claim 4, wherein the travel assist device calculates the trajectory of the inner peripheral rear wheel corresponding to the second trajectory. 前記舵角変更ポイント算出手段は、自車両が現在位置から所定舵角で旋回したときに旋回外周側後輪が辿る旋回円に接し、且つ、前記前記狭部位置に基づいて設定される回避ポイントを通る直線に対して自車両の旋回外周側側面が一致する位置を、前記舵角変更ポイントとして算出し、
前記第2軌跡算出手段は、前記直線とこの直線に平行で自車幅分離間した直線とからなる一対の直線軌跡を前記第2軌跡として算出し、
前記表示手段は、前記経路情報として前記第1軌跡を示す軌跡線と前記第2軌跡を示す軌跡線とを表示することを特徴とする請求項1に記載の走行支援装置。
The rudder angle change point calculating means is an avoidance point that is in contact with a turning circle followed by a turning outer wheel on the outer periphery side when the host vehicle turns at a predetermined rudder angle from a current position and is set based on the narrow portion position. The position at which the turning outer peripheral side surface of the vehicle coincides with the straight line passing through is calculated as the rudder angle change point,
The second trajectory calculating means calculates a pair of straight trajectories consisting of the straight line and a straight line parallel to the straight line and separated by the vehicle width as the second trajectory,
The travel support apparatus according to claim 1, wherein the display unit displays a trajectory line indicating the first trajectory and a trajectory line indicating the second trajectory as the route information.
前記表示手段は、前記第1軌跡を示す軌跡線及び前記第2軌跡を示す軌跡線とともに、前記舵角変更ポイントにおける自車両の左右前端部の位置を示すアイコンを表示することを特徴とする請求項8に記載の走行支援装置。   The said display means displays the icon which shows the position of the left-right front end part of the own vehicle in the said steering angle change point with the locus line which shows the said 1st locus | trajectory, and the locus line which shows the said 2nd locus | trajectory. Item 9. The driving support device according to Item 8. 自車両の走行位置が前記舵角変更ポイントの手前位置か前記舵角変更ポイントを越えた位置かを判定する判定手段をさらに備え、
前記表示手段は、自車両が前記舵角変更ポイントの手前側を走行している場合は前記第1軌跡を示す軌跡線と前記第2軌跡を示す軌跡線の双方を表示し、自車両が前記舵角変更ポイントを越えた位置を走行している場合は前記第2軌跡を示す軌跡線のみを表示することを特徴とする請求項8又は9に記載の走行支援装置。
A determination means for determining whether the traveling position of the host vehicle is a position in front of the rudder angle change point or a position beyond the rudder angle change point;
The display means displays both a trajectory line indicating the first trajectory and a trajectory line indicating the second trajectory when the host vehicle is traveling in front of the rudder angle change point. 10. The travel support apparatus according to claim 8, wherein when the vehicle travels at a position beyond the rudder angle change point, only the trajectory line indicating the second trajectory is displayed.
自車両の移動量を検出する移動量検出手段をさらに備え、
前記表示手段は、前記経路情報の表示画面上における表示位置を自車両の移動量に応じて更新することを特徴とする請求項1乃至10のいずれか一項に記載の走行支援装置。
It further comprises movement amount detection means for detecting the movement amount of the host vehicle,
The travel support apparatus according to any one of claims 1 to 10, wherein the display unit updates a display position of the route information on a display screen according to a movement amount of the host vehicle.
自車両周囲の画像を撮像する撮像手段をさらに備え、
前記表示手段は、前記撮像手段により撮像された画像上、又は、前記撮像手段により撮像された画像を画像処理して得られる画像上に、前記経路情報を重畳して表示することを特徴とする請求項1乃至11のいずれか一項に記載の走行支援装置。
It further comprises imaging means for imaging an image around the host vehicle,
The display means superimposes and displays the route information on an image picked up by the image pickup means or an image obtained by image processing of an image picked up by the image pickup means. The driving assistance device according to any one of claims 1 to 11.
前記撮像手段により撮像された画像を自車両上方の仮想視点から見下ろした俯瞰画像に変換する俯瞰画像生成手段をさらに備え、
前記表示手段は、前記俯瞰画像上に前記経路情報を重畳して表示することを特徴とする請求項12に記載の走行支援装置。
Further comprising an overhead image generation means for converting an image captured by the imaging means into an overhead image looking down from a virtual viewpoint above the host vehicle;
The travel support apparatus according to claim 12, wherein the display unit displays the route information superimposed on the overhead image.
前記撮像手段は、自車両の運転者の視点位置に近い車体上部位置から自車両フードの左右先端部を含む自車両前方の画像を撮像し、
前記表示手段は、前記撮像手段により撮像された画像上に前記経路情報を重畳して表示することを特徴とする請求項12に記載の走行支援装置。
The imaging means captures an image of the front of the host vehicle including the left and right front end portions of the host vehicle hood from the upper body position close to the viewpoint position of the driver of the host vehicle;
The travel support apparatus according to claim 12, wherein the display unit superimposes and displays the route information on an image captured by the imaging unit.
自車両が現在位置から現在の舵角を維持して進行したときの第1軌跡と、自車両前方の道幅が狭くなっている狭部位置の手前で自車両を停車させて舵角を変更する舵角変更ポイントと、自車両が前記舵角変更ポイントから当該舵角変更ポイントで変更した後の舵角を維持して進行したときの第2軌跡とを算出して、前記第1軌跡と前記舵角変更ポイントと前記第2軌跡とからなる狭部通過の経路を示す経路情報を表示手段に表示することを特徴とする走行支援方法。   Change the rudder angle by stopping the own vehicle in front of the first trajectory when the own vehicle advances from the current position while maintaining the current rudder angle and the narrow position where the road width in front of the own vehicle is narrow. A steering angle change point and a second trajectory when the host vehicle travels while maintaining the rudder angle after changing from the rudder angle change point to the rudder angle change point are calculated, and the first trajectory and the A driving support method, comprising: displaying on a display means route information indicating a narrow portion passing route composed of a steering angle change point and the second trajectory.
JP2009175103A 2009-07-28 2009-07-28 Driving support device Active JP5556077B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2009175103A JP5556077B2 (en) 2009-07-28 2009-07-28 Driving support device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2009175103A JP5556077B2 (en) 2009-07-28 2009-07-28 Driving support device

Publications (2)

Publication Number Publication Date
JP2011028609A true JP2011028609A (en) 2011-02-10
JP5556077B2 JP5556077B2 (en) 2014-07-23

Family

ID=43637259

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2009175103A Active JP5556077B2 (en) 2009-07-28 2009-07-28 Driving support device

Country Status (1)

Country Link
JP (1) JP5556077B2 (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2815951A3 (en) * 2013-06-18 2015-03-11 Samsung Electronics Co., Ltd. Method and device for providing travel route of portable medical diagnosis apparatus
JPWO2013094242A1 (en) * 2011-12-19 2015-04-27 日産自動車株式会社 Three-dimensional object detection device
KR101678448B1 (en) * 2015-06-24 2016-11-23 (주)캠시스 Driving monitoring system for providing guide information
US10011258B2 (en) 2016-02-22 2018-07-03 Fuji Xerox Co., Ltd. Monitoring apparatus and monitoring system
WO2018173581A1 (en) * 2017-03-21 2018-09-27 株式会社デンソー Driving assistance device
JP2018158709A (en) * 2017-03-21 2018-10-11 株式会社デンソー Driving support device
EP3648005B1 (en) * 2018-10-30 2024-05-08 Beijing Xiaomi Mobile Software Co., Ltd. Passage determination method and device

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1139598A (en) * 1997-07-17 1999-02-12 Fuji Heavy Ind Ltd Collision preventing device for vehicle
JP2001109999A (en) * 1999-10-13 2001-04-20 Fuji Heavy Ind Ltd Driving support device for vehicle
JP2009083806A (en) * 2007-10-03 2009-04-23 Aisin Aw Co Ltd Parking supporting device, parking supporting method and computer program

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1139598A (en) * 1997-07-17 1999-02-12 Fuji Heavy Ind Ltd Collision preventing device for vehicle
JP2001109999A (en) * 1999-10-13 2001-04-20 Fuji Heavy Ind Ltd Driving support device for vehicle
JP2009083806A (en) * 2007-10-03 2009-04-23 Aisin Aw Co Ltd Parking supporting device, parking supporting method and computer program

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPWO2013094242A1 (en) * 2011-12-19 2015-04-27 日産自動車株式会社 Three-dimensional object detection device
EP2815951A3 (en) * 2013-06-18 2015-03-11 Samsung Electronics Co., Ltd. Method and device for providing travel route of portable medical diagnosis apparatus
US9766072B2 (en) 2013-06-18 2017-09-19 Samsung Electronics Co., Ltd. Method and device for providing travel route of mobile medical diagnosis apparatus
KR101678448B1 (en) * 2015-06-24 2016-11-23 (주)캠시스 Driving monitoring system for providing guide information
US10011258B2 (en) 2016-02-22 2018-07-03 Fuji Xerox Co., Ltd. Monitoring apparatus and monitoring system
WO2018173581A1 (en) * 2017-03-21 2018-09-27 株式会社デンソー Driving assistance device
JP2018158709A (en) * 2017-03-21 2018-10-11 株式会社デンソー Driving support device
CN110462704A (en) * 2017-03-21 2019-11-15 株式会社电装 Drive supporting device
CN110462704B (en) * 2017-03-21 2021-08-31 株式会社电装 Driving support device
EP3648005B1 (en) * 2018-10-30 2024-05-08 Beijing Xiaomi Mobile Software Co., Ltd. Passage determination method and device

Also Published As

Publication number Publication date
JP5556077B2 (en) 2014-07-23

Similar Documents

Publication Publication Date Title
EP3650285B1 (en) Parking assistance method and parking assistance device
JP7103753B2 (en) Collision avoidance device
JP4769625B2 (en) Parking assistance device and parking assistance method
JP5556077B2 (en) Driving support device
US10179608B2 (en) Parking assist device
WO2012039256A1 (en) Driving assistance device
JP5104171B2 (en) Parking assistance device and parking assistance method
JP5446139B2 (en) Parking assistance device and parking assistance method
JP5549235B2 (en) Driving assistance device
JP5380994B2 (en) Parking assistance device and parking assistance method
JP5644477B2 (en) Driving support display device
JP2006298208A (en) Parking support method and parking support device
JP2014189097A (en) Parking support device
EP3800111A1 (en) Periphery monitoring device
JP5400316B2 (en) Parking assistance device
JP2012076551A (en) Parking support device, parking support method, and parking support system
JP4769631B2 (en) Vehicle driving support device and vehicle driving support method
JP4595902B2 (en) Vehicle periphery image display system and vehicle periphery image display method
JP2007168560A (en) Parking support apparatus
JP2004203068A (en) Mobile body periphery monitor device
JP2010195266A (en) Device and method for supporting parking
JP5617396B2 (en) Driving assistance device
JP2008213647A (en) Parking assist method and parking assist system
JP2011003117A (en) Backward visual recognition support system
JP2009220592A (en) On-vehicle parallel parking assistant device and program for on-vehicle parallel parking assistant device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20120525

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20130930

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20131008

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20131128

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20140520

R151 Written notification of patent or utility model registration

Ref document number: 5556077

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151