Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP4893531B2 - Driving support system - Google Patents
[go: Go Back, main page]

JP4893531B2 - Driving support system - Google Patents

Driving support system Download PDF

Info

Publication number
JP4893531B2
JP4893531B2 JP2007214735A JP2007214735A JP4893531B2 JP 4893531 B2 JP4893531 B2 JP 4893531B2 JP 2007214735 A JP2007214735 A JP 2007214735A JP 2007214735 A JP2007214735 A JP 2007214735A JP 4893531 B2 JP4893531 B2 JP 4893531B2
Authority
JP
Japan
Prior art keywords
vehicle
obstacle
avoidance
route
avoidance route
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
JP2007214735A
Other languages
Japanese (ja)
Other versions
JP2009046039A (en
Inventor
俊文 鈴木
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Denso Corp
Original Assignee
Denso Corp
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 Denso Corp filed Critical Denso Corp
Priority to JP2007214735A priority Critical patent/JP4893531B2/en
Publication of JP2009046039A publication Critical patent/JP2009046039A/en
Application granted granted Critical
Publication of JP4893531B2 publication Critical patent/JP4893531B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Traffic Control Systems (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Description

本発明は、車両同士が接触した際に、それらの車両の回避経路を形成する走行支援システムに関する。   The present invention relates to a driving support system that forms an avoidance route for vehicles when they come into contact with each other.

従来技術として、道路上に障害物があった場合、障害物を避けて自車が通り抜けられる可能性を判定するものがあった(例えば、特許文献1参照)。これは、イメージセンサによって撮影した自車の前方の画面内に、自車の通り抜けのために必要な空間枠を形成し、この空間枠に基づいて、自車が通り抜けられる可能性を判定している。この従来技術によれば、車両から下車しなくとも、短時間で自車が前方を通り抜けられるかどうかを判定することができ、運転による運転者の疲労の軽減および目的地までの走行時間の短縮を行うことができる。
また、自車に対する車両の車幅感覚(車両を運転中の運転者が、自車の大きさ(特に車両の横幅)を把握して、車両周囲にある物との干渉発生の有無を判断できる感覚)が身についていない初心者の運転者にとっては、自分に代わり車両が障害物と車両との干渉を判定してくれるため、非常に有用であった。
特開平8−221698号公報
As a prior art, when there is an obstacle on the road, there is one that determines the possibility that the vehicle can pass through the obstacle (see, for example, Patent Document 1). This is because a space frame required for passing through the vehicle is formed in the screen in front of the vehicle photographed by the image sensor, and the possibility of the vehicle passing through is determined based on the space frame. Yes. According to this conventional technology, it is possible to determine whether or not the vehicle can pass forward in a short time without getting off the vehicle, reducing the driver's fatigue due to driving and reducing the travel time to the destination. It can be performed.
Also, the sense of vehicle width relative to the vehicle (the driver driving the vehicle can grasp the size of the vehicle (especially the width of the vehicle) and determine whether there is interference with objects around the vehicle. It was very useful for a novice driver who does not have a sense) because the vehicle determines the interference between the obstacle and the vehicle on his behalf.
JP-A-8-221698

しかしながら、上述した従来技術によるものは、運転者に対して障害物の有無および障害物を避けて車両が通り抜けられるか否かの判定結果を知らせるのみで、障害物を避けるように、実際に車両を移動させることができるものではなかった。従って、前述したような運転技術の未熟な初心者にとっては、障害物を避けて車両が通り抜けられるという情報を入手できても、他車や障害物を避けて自車を移動させることは困難であった。
本発明は上記事情に鑑みてなされたものであり、その目的は、道路上において、他車および障害物から容易に回避できる走行支援システムを提供することにある。
However, according to the above-described conventional technology, the vehicle is actually used so as to avoid the obstacle only by notifying the driver of the presence / absence of the obstacle and the determination result of whether or not the vehicle can pass through the obstacle. Could not be moved. Therefore, even for beginners who are unskilled in driving technology as described above, even if it is possible to obtain information that the vehicle can pass through avoiding obstacles, it is difficult to move the vehicle while avoiding other vehicles and obstacles. It was.
The present invention has been made in view of the above circumstances, and an object thereof is to provide a driving support system that can be easily avoided from other vehicles and obstacles on a road.

請求項1記載の走行支援システムによれば、自車が他車と接触した場合に、車両位置検出手段により検出された自車の現在位置および向き、障害物検出手段により検出された自車周囲の障害物の位置、通信手段を介して他車から受信した他車の位置情報、他車の向き情報および他車周囲の障害物の位置情報に基づいて、自車が他車との接触を回避する経路を演算する回避経路演算手段と、回避経路演算手段により形成された回避経路に基づいて自車を移動させる車両移動手段を備える。これにより、道路上において他車と接触した場合、形成された回避経路に基づく車両移動手段の作動によって、他車からの回避が容易に行える。
また、車両移動手段が回避経路演算手段により形成された回避経路に基づいて自車を移動させるために、自車を停止させるとともに、通信手段を介して他車に対し移動指示を行い、自車の回避経路から他車を一旦待避させる。これにより、他車および障害物を避けて、いっそう容易に自車を接触から回避させることができる。
According to the driving support system according to claim 1, when the own vehicle comes into contact with another vehicle, the current position and direction of the own vehicle detected by the vehicle position detecting unit, and the surroundings of the own vehicle detected by the obstacle detecting unit The vehicle makes contact with the other vehicle based on the position of the obstacle, the position information of the other vehicle received from the other vehicle via the communication means, the direction information of the other vehicle, and the position information of the obstacle around the other vehicle. There are provided avoidance route calculation means for calculating a route to be avoided and vehicle movement means for moving the host vehicle based on the avoidance route formed by the avoidance route calculation means. Thereby, when it contacts with another vehicle on a road, the avoidance from another vehicle can be easily performed by the action | operation of the vehicle moving means based on the formed avoidance path | route.
In addition, in order for the vehicle moving means to move the own vehicle based on the avoidance route formed by the avoidance route calculating means, the own vehicle is stopped and a movement instruction is given to the other vehicle via the communication means. The other vehicle is temporarily withdrawn from the avoidance route. As a result, it is possible to avoid the other vehicle and the obstacle and more easily avoid the own vehicle from contact.

請求項2記載の走行支援システムによれば、回避経路演算手段は、自車が障害物検出手段により検出された障害物から、所定距離だけ離れて走行するような経路を演算することにより回避経路を形成する。これにより、障害物を確実に避ける回避経路を、容易に形成することができる According to the driving support system of claim 2, the avoidance route calculation means calculates the avoidance route by calculating a route in which the vehicle travels a predetermined distance away from the obstacle detected by the obstacle detection means. Form. Thereby, the avoidance path | route which avoids an obstruction reliably can be formed easily .

請求項記載の走行支援システムによれば、自車の外周部には、軟質材にて形成され圧力センサが内蔵されたバンパーが取り付けられ、自車と他車とが接触した場合に、バンパーが互いに押圧されて圧力センサが昇圧を検出した時に、回避経路演算手段が回避経路の演算を開始する。これにより、簡単な構成で確実に車両の接触を検出し、回避経路の演算を開始することができる。 According to the driving support system of claim 3, a bumper formed of a soft material and having a built-in pressure sensor is attached to the outer periphery of the own vehicle. When the own vehicle and another vehicle come into contact with each other, the bumper Are mutually pressed and the pressure sensor detects the pressure increase, the avoidance path calculation means starts calculation of the avoidance path. Thereby, the contact of the vehicle can be reliably detected with a simple configuration, and the calculation of the avoidance path can be started.

以下、図1乃至図16に基づいて、本実施形態による走行支援システムについて説明する。図1は、各車両に搭載されているナビゲーション機能を有する車載走行支援装置1の全体構成を示したブロック図である。車載走行支援装置1は、マイコンを主体として構成された制御装置2、車両(図示せず)の現在位置および車両の向きを検出するための位置検出器3、地図データ入力器4、操作スイッチ群5、カメラ6、カメラ6に接続された画像処理部7、障害物検知センサ8、バンパー圧力センサ9、車速センサ10、舵角センサ11、加速度センサ12、シフトスイッチ13、エンジン回転数センサ14、ブレーキ圧センサ15、外部メモリ16、カラー液晶ディスプレイ等からなる表示装置17、スピーカ19が接続された音声コントローラ18、マイクロホン21から入力された音声を認識する音声認識装置20、リモコン23との間でコマンド等の送受信を行うリモコンセンサ22、スロットルアクチュエータ24、シフトアクチュエータ25、操舵アクチュエータ26、ブレーキアクチュエータ27、他車との間で無線通信によりデータ(情報)の送受信を行う車々間通信機28から構成されている。   Hereinafter, the driving support system according to the present embodiment will be described with reference to FIGS. FIG. 1 is a block diagram showing an overall configuration of an in-vehicle travel support apparatus 1 having a navigation function mounted on each vehicle. The in-vehicle travel support device 1 includes a control device 2 mainly composed of a microcomputer, a position detector 3 for detecting the current position and direction of a vehicle (not shown), a map data input device 4, and a group of operation switches. 5, camera 6, image processing unit 7 connected to camera 6, obstacle detection sensor 8, bumper pressure sensor 9, vehicle speed sensor 10, rudder angle sensor 11, acceleration sensor 12, shift switch 13, engine speed sensor 14, Between a brake pressure sensor 15, an external memory 16, a display device 17 including a color liquid crystal display, a voice controller 18 to which a speaker 19 is connected, a voice recognition device 20 for recognizing voice input from a microphone 21, and a remote controller 23. Remote control sensor 22 for transmitting / receiving commands and the like, throttle actuator 24, shift actuator 25 Steering actuator 26, a brake actuator 27, the inter-vehicle communication device 28 for transmitting and receiving data (information) by wireless communication with another vehicle.

位置検出器3は本発明の車両位置検出手段に該当し、車両方位(向き)を検出する地磁気センサ29、車両の回転角速度を検出するジャイロスコープ30、車両の走行距離を検出する距離センサ31、人工衛星からの送信電波に基づいて車両(自車)の現在位置を検出(測位)するGPS(Global Positioning System)のためのGPS受信機32を有している。各センサ29〜32は、それぞれ性質の異なる誤差を有している。このため、制御装置2は、各センサ29〜32の検出値を補間しながら用いることにより、車両の現在位置、進行方向、速度、走行距離、現在時刻等を高精度で検出するようになっている。なお、精度によっては、位置検出器3を上述したセンサ29〜32の一部のみで構成してもよい。また、舵角センサ11や各転動輪の車輪センサ等を用いてもよい。   The position detector 3 corresponds to the vehicle position detection means of the present invention, and includes a geomagnetic sensor 29 that detects the vehicle direction (orientation), a gyroscope 30 that detects the rotational angular velocity of the vehicle, a distance sensor 31 that detects the travel distance of the vehicle, It has a GPS receiver 32 for GPS (Global Positioning System) that detects (positions) the current position of the vehicle (own vehicle) based on the radio wave transmitted from the artificial satellite. Each of the sensors 29 to 32 has an error having a different property. For this reason, the control device 2 detects the current position, traveling direction, speed, travel distance, current time, and the like of the vehicle with high accuracy by using the detected values of the sensors 29 to 32 while interpolating. Yes. Depending on the accuracy, the position detector 3 may be configured by only a part of the sensors 29 to 32 described above. Moreover, you may use the steering angle sensor 11, the wheel sensor of each rolling wheel, etc.

地図データ入力部4は、いくつものノードおよびノード同士をつなぐリンクにより形成された道路地図データ、目印データ、マップマッチング用データ、目的地データ(施設データベース)、交通情報を道路データに変換するためのテーブルデータなどの各種データを記録した地図データ記録メディアからデータを読み出すためのドライブ装置により構成されている。地図データ記録メディアには、DVD等の大容量記憶媒体を用いるのが一般的であるが、メモリカード、ハードディスク装置等の媒体を用いてもよい。   The map data input unit 4 converts road map data, landmark data, map matching data, destination data (facility database), and traffic information formed by a number of nodes and links connecting the nodes into road data. It comprises a drive device for reading data from a map data recording medium that records various data such as table data. As the map data recording medium, a large-capacity storage medium such as a DVD is generally used, but a medium such as a memory card or a hard disk device may be used.

外部操作手段である操作スイッチ群5は、表示装置17の画面の近傍に設けられたメカニカルスイッチや、表示装置17の画面上に設けられるタッチパネルを含んで構成されている。ユーザは、この操作スイッチ群5を用いて、車両の目的地、目的地の検索に必要な情報(目的地検索条件)、表示装置17の画面や表示態様の切り替え(地図縮尺変更、メニュー表示選択、経路探索、経路案内開始、現在位置修正、音量調整等)を行う各種のコマンドの入力を行い、車載走行支援装置1を作動させることができる。一方、リモコン23にも複数の操作スイッチが設けられており、スイッチ操作によりリモコン23からリモコンセンサ22を介して各種の指令信号が制御装置2に送信される。なお、操作スイッチ群5とリモコン23は、何れの操作によっても制御装置2に同様の機能を実行させることができる。   The operation switch group 5 which is an external operation means includes a mechanical switch provided in the vicinity of the screen of the display device 17 and a touch panel provided on the screen of the display device 17. The user uses this operation switch group 5 to change the destination of the vehicle, information necessary for searching for the destination (destination search condition), and the screen and display mode of the display device 17 (map scale change, menu display selection). Various commands for performing route search, route guidance start, current position correction, volume adjustment, etc.) can be input, and the vehicle-mounted travel support device 1 can be operated. On the other hand, the remote controller 23 is also provided with a plurality of operation switches, and various command signals are transmitted from the remote controller 23 to the control device 2 via the remote control sensor 22 by the switch operation. Note that the operation switch group 5 and the remote controller 23 can cause the control device 2 to execute the same function by any operation.

カメラ6は本発明の障害物検出手段に該当し、これに限定されるわけではないが、通常のCCDカメラやCMOSカメラ等が使用されている。カメラ6は車両外部に設置されている家屋、塀、電柱、側溝等の障害物を撮影可能なように、車両側部あるいは下部に取り付けられている。カメラ6には、主に、RAMあるいはROMにより形成されている図示しない画像メモリが内蔵されており、これは、カメラ6が撮影することにより形成された車両外部に関する画像データを記憶保存している。画像処理部7は制御装置2に接続されており、画像メモリに記憶された画像データに基づいて画像処理を行い、車両周囲の障害物を検出する。画像処理部7より処理信号を受信した制御装置2は、車両周囲の障害物の位置を認識することができる。   The camera 6 corresponds to the obstacle detection means of the present invention, and although not limited to this, a normal CCD camera, CMOS camera, or the like is used. The camera 6 is attached to the side or lower part of the vehicle so that obstacles such as houses, fences, utility poles, gutters and the like installed outside the vehicle can be photographed. The camera 6 has a built-in image memory (not shown) formed mainly by a RAM or ROM, which stores and saves image data relating to the outside of the vehicle formed by the camera 6 shooting. . The image processing unit 7 is connected to the control device 2 and performs image processing based on the image data stored in the image memory to detect obstacles around the vehicle. The control device 2 that has received the processing signal from the image processing unit 7 can recognize the position of the obstacle around the vehicle.

障害物検知センサ8は前述のカメラ6とともに、本発明の障害物検出手段に該当し、ソナーあるいはレーダーによって形成されている。障害物検知センサ8は、障害物に衝突して反射した音波あるいは電磁波を受信することにより、車両周囲の障害物の位置を検出している。
バンパー圧力センサ9は、図13に示すように、各車両(自車および他車)の外周部に取り付けられたバンパー33に内蔵されている。バンパー33は車両前端部および後端部に取り付けられ、ウレタン等の可撓性を有する軟質材により形成されているため、他車あるいは障害物と接触しても、一時的に変形することにより破損することなく衝撃を吸収することができる。図14に示すように、バンパー33に他車が接触すると、バンパー33が押圧されて内部の圧力が増大し、内蔵された圧力センサ9により昇圧が検出される。
The obstacle detection sensor 8 corresponds to the obstacle detection means of the present invention together with the camera 6 described above, and is formed by sonar or radar. The obstacle detection sensor 8 detects the position of the obstacle around the vehicle by receiving a sound wave or an electromagnetic wave reflected by the collision with the obstacle.
As shown in FIG. 13, the bumper pressure sensor 9 is built in a bumper 33 attached to the outer peripheral portion of each vehicle (own vehicle and other vehicles). The bumper 33 is attached to the front end portion and the rear end portion of the vehicle, and is formed of a flexible soft material such as urethane. Therefore, even if it comes into contact with another vehicle or an obstacle, the bumper 33 is damaged due to temporary deformation. The shock can be absorbed without doing. As shown in FIG. 14, when another vehicle comes in contact with the bumper 33, the bumper 33 is pressed to increase the internal pressure, and the pressure increase is detected by the built-in pressure sensor 9.

車速センサ10は、図示しない車両のトランスミッションあるいは車輪に設けられ、車両速度を検出している。舵角センサ11は、図示しない車両のステアリングシャフトに取り付けられ、操舵輪の操舵角を検出している。加速度センサ12は車両ボデーに取り付けられ、車両が加速、減速することにより発生する加速度を検出している。シフトスイッチ13は、車両のトランスミッションのシフト位置を検出している。エンジン回転数センサ14は、エンジンのクランクシャフト(図示せず)の所定時間あたりの回転数を検出している。ブレーキ圧センサ15は、車両のマスタシリンダあるいはディスクブレーキ(図示せず)の油圧を検出している。   The vehicle speed sensor 10 is provided on a transmission or a wheel of a vehicle (not shown) and detects the vehicle speed. The steering angle sensor 11 is attached to a steering shaft of a vehicle (not shown) and detects the steering angle of the steered wheels. The acceleration sensor 12 is attached to the vehicle body, and detects acceleration generated by acceleration and deceleration of the vehicle. The shift switch 13 detects the shift position of the vehicle transmission. The engine speed sensor 14 detects the number of revolutions per predetermined time of an engine crankshaft (not shown). The brake pressure sensor 15 detects the hydraulic pressure of a master cylinder or a disc brake (not shown) of the vehicle.

外部メモリ16は、フラッシュメモリカード等から構成されている。この外部メモリ16には、特定のデータ例えば経路案内時に制御装置2が設定した目的地までの経路のデータ、車両が通過した経路のデータ等が記憶される。表示装置17の画面には、車両の位置周辺の地図が各種縮尺で表示されるとともに、その表示に重ね合わせて、車両の現在位置と進行方向とを示す現在地マーク(ポインタ)が表示される。また、目的地までの経路案内の実行時には経路案内用の画面が表示される。さらに、ユーザが目的地の検索に必要な情報等を入力したり、目的地の検索や設定を行うための入力用の画面や、各種のメッセージ等も表示される。   The external memory 16 is composed of a flash memory card or the like. The external memory 16 stores specific data such as route data to the destination set by the control device 2 during route guidance, route data passed by the vehicle, and the like. On the screen of the display device 17, a map around the position of the vehicle is displayed at various scales, and a current position mark (pointer) indicating the current position and the traveling direction of the vehicle is displayed superimposed on the map. In addition, a route guidance screen is displayed when route guidance to the destination is executed. Furthermore, an input screen for inputting information necessary for the user to search for the destination, searching for and setting the destination, various messages, and the like are also displayed.

音声認識装置20は、マイクロホン21を介して入力した音声と内部に記憶する認識用の辞書データとを照合し、入力された音声を認識する。音声コントローラ18は、音声認識装置20を制御して音声認識結果を制御装置2に出力するとともに、認識された音声はスピーカ19を介してトークバック出力する。スピーカ19から出力される音声は、案内に関する音声、操作説明に関する音声、盗難防止機能の動作中であることを報知する音声などである。   The voice recognition device 20 collates the voice input through the microphone 21 with the dictionary data for recognition stored therein, and recognizes the input voice. The voice controller 18 controls the voice recognition device 20 to output the voice recognition result to the control device 2, and the recognized voice is talkback output via the speaker 19. The sound output from the speaker 19 is a sound related to guidance, a sound related to operation explanation, a sound notifying that the anti-theft function is being operated, or the like.

スロットルアクチュエータ24は、制御装置2がエンジン回転数センサ14による検出値に基づいて発信する制御信号に応じて、エンジンのスロットルバルブを必要な開度に調節し、エンジン回転数を変更している。シフトアクチュエータ25は、制御装置2からの制御信号に基づいてオートマチックトランスミッションのシフト位置を変更し、車両の進行方向を変更している。操舵アクチュエータ26は、制御装置2が舵角センサ11による検出値に基づいて発信する制御信号に応じて、操舵輪の向きを変更し、車両の進行方向を変更している。   The throttle actuator 24 adjusts the throttle valve of the engine to a necessary opening degree according to a control signal transmitted from the control device 2 based on a detection value by the engine speed sensor 14, and changes the engine speed. The shift actuator 25 changes the shift position of the automatic transmission based on the control signal from the control device 2 and changes the traveling direction of the vehicle. The steering actuator 26 changes the direction of the steered wheels and changes the traveling direction of the vehicle in accordance with a control signal transmitted from the control device 2 based on the detection value by the steering angle sensor 11.

ブレーキアクチュエータ27は、制御装置2がブレーキ圧センサ15による検出値に基づいて発信する制御信号に応じて、油圧ポンプ(図示せず)を駆動してディスクブレーキにブレーキ圧を発生させ、車両のブレーキ力を調整している。スロットルアクチュエータ24、シフトアクチュエータ25、操舵アクチュエータ26およびブレーキアクチュエータ27は、本発明の車両移動手段に該当する。これらの各アクチュエータについては、特許文献である特開2005−35498号公報、特開2005−75015号公報、特開2007−168545号公報、特開2003−15741号公報等に記載がある。
車々間通信機28は本発明の通信手段に該当し、他車の車々間通信機28との間で、例えば5.8GHzの電波を使用したDSRC(Dedicated Short Range Communication :専用狭域通信)方式により車々間通信を行い、種々の情報を送受信する。
The brake actuator 27 drives a hydraulic pump (not shown) according to a control signal transmitted from the control device 2 based on a detection value by the brake pressure sensor 15 to generate a brake pressure on the disc brake, thereby The power is adjusted. The throttle actuator 24, the shift actuator 25, the steering actuator 26, and the brake actuator 27 correspond to the vehicle moving means of the present invention. These actuators are described in Japanese Patent Application Laid-Open Nos. 2005-35498, 2005-75015, 2007-168545, 2003-15741, and the like.
The inter-vehicle communication device 28 corresponds to the communication means of the present invention. For example, a DSRC (Dedicated Short Range Communication) system using a 5.8 GHz radio wave is used between the inter-vehicle communication devices 28 of other vehicles. Communicate and send / receive various information.

制御装置2を構成するマイコンはCPU、メモリ(RAM、ROM、EEPROM、フラッシュメモリ等)、I/Oなどを備えており、本発明の回避経路演算手段に該当している。制御装置2は、ナビゲーション機能による案内経路に沿って車両が移動可能なように、表示装置17の画面に現在地周辺の道路地図を表示するとともに、車両の現在位置と進行方向を示す現在地マークを道路地図に重ね合わせて表示させる。この場合、車両の走行に伴って現在地の表示は地図上を移動し、地図は車両の位置に応じてスクロール表示される。このとき、車両の現在地を道路上にのせるマップマッチングが行われる。   The microcomputer constituting the control device 2 includes a CPU, a memory (RAM, ROM, EEPROM, flash memory, etc.), I / O, and the like, and corresponds to the avoidance path calculation means of the present invention. The control device 2 displays a road map around the current location on the screen of the display device 17 so that the vehicle can move along the guidance route by the navigation function, and displays the current location mark indicating the current position and traveling direction of the vehicle on the road. Overlay on the map. In this case, the display of the current location moves on the map as the vehicle travels, and the map is scrolled according to the position of the vehicle. At this time, map matching is performed in which the current location of the vehicle is placed on the road.

また、制御装置2は、自車が他車と接触した場合に、位置検出器3により検出された自車の現在位置および向き、カメラ6あるいは障害物検知センサ8により検出された自車周囲の障害物の位置、車々間通信機28を介して他車から受信した他車の現在位置情報、他車の向き情報および他車周囲の障害物の位置情報に基づいて、自車または他車の回避経路を演算する。制御装置2は、スロットルアクチュエータ24、シフトアクチュエータ25、操舵アクチュエータ26およびブレーキアクチュエータ27を作動させ、演算された回避経路に沿って、運転者の操作なしに自車あるいは他車を移動させる(自動運転)。   The control device 2 also detects the current position and orientation of the host vehicle detected by the position detector 3 and the surroundings of the host vehicle detected by the camera 6 or the obstacle detection sensor 8 when the host vehicle contacts another vehicle. Based on the position of the obstacle, the current position information of the other vehicle received from the other vehicle via the inter-vehicle communication device 28, the direction information of the other vehicle, and the position information of the obstacle around the other vehicle, avoidance of the own vehicle or the other vehicle Calculate the route. The control device 2 operates the throttle actuator 24, the shift actuator 25, the steering actuator 26, and the brake actuator 27, and moves the host vehicle or other vehicles along the calculated avoidance path without the driver's operation (automatic driving). ).

次に、図2乃至図9に基づいて、自車が他車と接触した場合の、制御装置2による他車との接触を回避するための経路演算(形成)方法について説明する。図2に示すように、部分的に狭い道路34上において、自車35と他車36が行き違い時にバンパー33同士を接触させた場合を想定する。道路34の側端には、塀あるいは側溝等である障害物37、38がそれぞれ設けられており、これらにより車両35、36の移動が規制されている。自車35は、回避経路の演算開始時点において、位置検出器3、カメラ6、障害物検出センサ8および車々間通信機28により、自車35の位置および向き、他車36の位置および向き、障害物37、38の位置を認識しているものとする(後述)。   Next, a route calculation (formation) method for avoiding contact with the other vehicle by the control device 2 when the own vehicle comes into contact with the other vehicle will be described with reference to FIGS. As shown in FIG. 2, a case is assumed in which bumpers 33 are brought into contact with each other when the own vehicle 35 and another vehicle 36 cross each other on a partially narrow road 34. Obstacles 37 and 38 such as eaves or side grooves are provided at the side ends of the road 34, respectively, and the movement of the vehicles 35 and 36 is restricted by these obstacles. At the time of starting calculation of the avoidance route, the own vehicle 35 uses the position detector 3, the camera 6, the obstacle detection sensor 8, and the inter-vehicle communication device 28 to determine the position and orientation of the own vehicle 35, the position and orientation of the other vehicle 36, It is assumed that the positions of the objects 37 and 38 are recognized (described later).

車両35、36の接触により双方のバンパー33が圧縮され、内蔵された圧力センサ9により、押圧されたバンパー33内部の昇圧が検出されると、制御装置2による自車35の回避経路の演算が開始する。最初に、道路34の左側端に位置する障害物37から、道路34の中央部へ向けて一律に所定幅Dを有する左側緩衝帯39を形成する(図3示)。図4に示すように、左側緩衝帯39は、障害物37の表面に凹凸がある場合、表面形状を滑らかな曲線40に近似した後、近似された曲線40から一律に所定幅Dを有するように形成するとよい。   When both the bumpers 33 are compressed by the contact of the vehicles 35 and 36 and the internal pressure sensor 9 detects the pressure increase in the pressed bumper 33, the control device 2 calculates the avoidance route of the own vehicle 35. Start. First, a left buffer band 39 having a predetermined width D is uniformly formed from the obstacle 37 located at the left end of the road 34 toward the center of the road 34 (shown in FIG. 3). As shown in FIG. 4, the left buffer band 39 has a predetermined width D uniformly from the approximated curve 40 after approximating the surface shape to the smooth curve 40 when the surface of the obstacle 37 is uneven. It is good to form.

左側緩衝帯39の形成後、左側緩衝帯39の右側縁部から、道路34の中央部へ向けて一律に所定距離WL/2だけ離れた位置にある点をつなぎ、自車中心線41を形成する(図5示)。左側緩衝帯39と自車中心線41との間の距離WL/2は、自車35の車幅WLの1/2に値する。次に、自車中心線41から、さらに道路34の中央部へ向けて一律に所定距離WL/2だけ離れた位置にある点をつなぎ、自車外形線42を形成する(図5示)。   After the left buffer band 39 is formed, a point located at a predetermined distance WL / 2 from the right edge of the left buffer band 39 toward the center of the road 34 is connected to form the vehicle center line 41. (Shown in FIG. 5). A distance WL / 2 between the left side buffer zone 39 and the own vehicle center line 41 is equal to ½ of the vehicle width WL of the own vehicle 35. Next, the vehicle outline line 42 is formed by connecting points located at a predetermined distance WL / 2 uniformly from the vehicle center line 41 toward the center of the road 34 (see FIG. 5).

詳細には、左側緩衝帯39の右側縁部上に接線43を形成した後、接線43に対する垂直線44を設け、垂直線44上の接線43との交点からWL/2の距離にある点をつないだものを自車中心線41とし、さらに、WL/2の距離にある点をつないだものを自車外形線42とする(図6示)。また、自車中心線41および自車外形線42の形成後、自車外形線42から、道路34の中央部へ向けて一律に所定幅D/2を有する自車緩衝帯45を形成する(図7示)。   Specifically, after the tangent line 43 is formed on the right edge of the left buffer band 39, a vertical line 44 is provided with respect to the tangent line 43, and a point at a distance of WL / 2 from the intersection with the tangent line 43 on the vertical line 44 is defined. The connected vehicle is the center line 41 of the own vehicle, and further, the one connecting the points at a distance of WL / 2 is defined as the own vehicle outline 42 (shown in FIG. 6). Further, after the formation of the own vehicle center line 41 and the own vehicle outline 42, the own vehicle buffer zone 45 having a predetermined width D / 2 is uniformly formed from the own vehicle outline 42 toward the center of the road 34 ( FIG. 7 shows).

さらに、これまで記してきた方法と同様にして、道路34の右側端に位置する障害物38側にも、右側緩衝帯46、他車中心線47、他車外形線48および他車緩衝帯49が、図8および図9に示すように形成される。これにより、制御装置2による、自車35および他車36の回避経路が完成する。回避経路の形成にあたって、上述した左側緩衝帯39は、自車35と障害物37との間の接触を回避するための余裕間隔、右側緩衝帯46は、他車36と障害物38との間の接触を回避するための余裕間隔、自車緩衝帯45および他車緩衝帯49は、自車35と他車36との間の接触を回避するための余裕間隔である。   Further, in the same manner as described above, the right buffer band 46, the other vehicle center line 47, the other vehicle outline 48 and the other vehicle buffer band 49 are also provided on the obstacle 38 side located at the right end of the road 34. Is formed as shown in FIGS. Thereby, the avoidance path | route of the own vehicle 35 and the other vehicle 36 by the control apparatus 2 is completed. In forming the avoidance path, the left buffer band 39 described above is a margin interval for avoiding contact between the own vehicle 35 and the obstacle 37, and the right buffer band 46 is provided between the other vehicle 36 and the obstacle 38. A margin interval for avoiding the contact of the vehicle, the own vehicle buffer zone 45 and the other vehicle buffer zone 49 are margin intervals for avoiding contact between the own vehicle 35 and the other vehicle 36.

図8および図9において、自車35は車両の中心50を自車中心線41上に置いて、道路34上の左側緩衝帯39と自車緩衝帯45との間を移動していくように制御装置2により自動運転される。また、他車36は車両の中心51を他車中心線47上に置いて、道路34上の右側緩衝帯46と他車緩衝帯49との間を移動していくように、他車36に搭載された車載走行支援装置1の制御装置2により制御される。これにより、自車35のための回避経路は、自車35を障害物37から所定距離Dだけ離れて走行させるようにし、他車36のための回避経路は、他車36を障害物38から所定距離Dだけ離れて走行させるようにしている。   8 and 9, the own vehicle 35 places the center 50 of the vehicle on the own vehicle center line 41 and moves between the left buffer zone 39 and the own vehicle buffer zone 45 on the road 34. The controller 2 is automatically operated. Further, the other vehicle 36 places the center 51 of the vehicle on the other vehicle center line 47 and moves to the other vehicle 36 so as to move between the right buffer zone 46 and the other vehicle buffer zone 49 on the road 34. It is controlled by the control device 2 of the on-vehicle travel support device 1 installed. Thus, the avoidance route for the own vehicle 35 is caused to travel the vehicle 35 away from the obstacle 37 by a predetermined distance D, and the avoidance route for the other vehicle 36 is the distance from the obstacle 38 to the other vehicle 36. The vehicle is made to travel away by a predetermined distance D.

次に、図8乃至図12、図15および図16に基づいて、自車35の制御装置2による、自車35と他車36との間の接触回避方法について説明する。尚、本実施形態による車載走行支援装置1は、自車35および他車36の双方に搭載されている。最初、図15に示したステップS101において、バンパー圧力センサ9がバンパー33内の昇圧を検出することによって、自車35のバンパー33が他の物体に接触した(図2示)と判定されると、自車35の制御装置2はスロットルアクチュエータ24およびブレーキアクチュエータ27を制御し、自車35を停止させる(ステップS102)。この時、接触した相手側が他車36である場合は、他車36の制御装置2により、他車36も停止させられる。ステップS101において、自車35のバンパー33が接触したと判定されない場合、本制御ルーチンは終了する。   Next, a contact avoidance method between the host vehicle 35 and the other vehicle 36 by the control device 2 of the host vehicle 35 will be described with reference to FIGS. 8 to 12, 15, and 16. The in-vehicle travel support device 1 according to the present embodiment is mounted on both the own vehicle 35 and the other vehicle 36. First, in step S101 shown in FIG. 15, when the bumper pressure sensor 9 detects the pressure increase in the bumper 33, it is determined that the bumper 33 of the host vehicle 35 is in contact with another object (shown in FIG. 2). The control device 2 of the host vehicle 35 controls the throttle actuator 24 and the brake actuator 27 to stop the host vehicle 35 (step S102). At this time, if the other party in contact is the other vehicle 36, the other vehicle 36 is also stopped by the control device 2 of the other vehicle 36. In step S101, when it is not determined that the bumper 33 of the own vehicle 35 has come into contact, the present control routine ends.

次に、車々間通信機28を介して、周辺に対し、「自車が接触した。自車が回避経路の演算を行うから、自車と接触した車両があれば返信せよ。」という旨の情報発信を行う(ステップS103)。情報発信は自車35のID番号を添付して行うのがよい。これに対して、他車36から自車35のID番号とともに、「自車(他車36のこと)が接触した。回避経路の演算をしてほしい。」という旨の返信があった場合(ステップS104)、位置検出器3により、自車35の位置および向きを検出するとともに、カメラ6あるいは障害物検知センサ8により、自車35の周囲の障害物の位置を検出する(ステップS105)。この時、他車36においても、同様に他車36の位置等を検出しており、自車35は車々間通信機28によって、他車36に対して位置等に関する情報をリクエストし、これに対して他車36の制御装置2は、車々間通信機28を介して情報を発信する(ステップS106)。他車36に関する情報とは、少なくとも、他車36の位置および向き、他車36の周囲の障害物の位置、他車の車幅WRおよび他車の最小回転半径を含んでいる。   Next, via the inter-vehicle communication device 28, information indicating that “the vehicle has made contact. Since the vehicle has calculated an avoidance route, please reply if there is a vehicle in contact with the vehicle”. A call is made (step S103). The information transmission is preferably performed with the ID number of the vehicle 35 attached. On the other hand, when there is a reply from the other vehicle 36 together with the ID number of the own vehicle 35 that “the own vehicle (the other vehicle 36) is in contact. In step S104), the position detector 3 detects the position and orientation of the host vehicle 35, and the camera 6 or the obstacle detection sensor 8 detects the positions of obstacles around the host vehicle 35 (step S105). At this time, the position of the other vehicle 36 is also detected in the other vehicle 36 in the same manner, and the own vehicle 35 requests the information on the position, etc. from the other vehicle 36 by the inter-vehicle communication device 28. The control device 2 of the other vehicle 36 transmits information via the inter-vehicle communication device 28 (step S106). The information related to the other vehicle 36 includes at least the position and orientation of the other vehicle 36, the position of the obstacle around the other vehicle 36, the vehicle width WR of the other vehicle, and the minimum turning radius of the other vehicle.

次に、検出した自車35の位置および向き、自車35の周囲の障害物の位置、当初から制御装置2に保存されている自車35の車幅WLおよび最小回転半径、受信した他車36の位置および向き、他車36の周囲の障害物の位置、他車の車幅WRおよび最小回転半径に基づき、制御装置2は前述したように、自車35と他車36との接触を回避するための、道路34上における回避経路を演算する(ステップS107)。   Next, the detected position and orientation of the own vehicle 35, the positions of obstacles around the own vehicle 35, the vehicle width WL and the minimum turning radius of the own vehicle 35 stored in the control device 2 from the beginning, the received other vehicle Based on the position and orientation of 36, the position of obstacles around the other vehicle 36, the vehicle width WR and the minimum turning radius of the other vehicle, the control device 2 determines the contact between the own vehicle 35 and the other vehicle 36 as described above. An avoidance route on the road 34 to avoid is calculated (step S107).

演算された回避経路が、図8に示されたようなものであった場合、自車35および他車36の回避経路上のすべての位置において、自車35と障害物37との間には左側緩衝帯39が介在し、他車36と障害物38との間には右側緩衝帯46が介在し、さらに自車35と他車36との間には、自車緩衝帯45および他車緩衝帯49が十分確保されている(自車緩衝帯45と他車緩衝帯49との間には、わずかな隙間が存在している)。従って、自車35と他車36は回避経路上を行き違い可能であると判定される(ステップS108)。制御装置2は前述した自動運転により、自車35を回避経路上に位置戻しするとともに、車々間通信機28を介して、他車36に対して位置戻しを実行させるように指示を行う(ステップS109)。自車35および他車36が、互いに接触した位置(図2示)から、位置戻しされた(図8示)後、制御装置2は自動運転により自車35を回避経路上を前進させるとともに、車々間通信機28を介して他車36に対して前進の指示を行う(ステップS110)。   When the calculated avoidance route is as shown in FIG. 8, the vehicle 35 and the obstacle 37 are not located at all positions on the avoidance route of the own vehicle 35 and the other vehicle 36. The left buffer band 39 is interposed, the right buffer band 46 is interposed between the other vehicle 36 and the obstacle 38, and the own vehicle buffer zone 45 and the other vehicle are interposed between the own vehicle 35 and the other vehicle 36. The buffer band 49 is sufficiently secured (a slight gap exists between the own vehicle buffer band 45 and the other vehicle buffer band 49). Therefore, it is determined that the own vehicle 35 and the other vehicle 36 can cross the avoidance route (step S108). The control device 2 returns the position of the host vehicle 35 to the avoidance route by the automatic driving described above, and instructs the other vehicle 36 to return the position via the inter-vehicle communication device 28 (step S109). ). After the own vehicle 35 and the other vehicle 36 are moved back from the positions where they contact each other (shown in FIG. 2) (shown in FIG. 8), the control device 2 advances the own vehicle 35 on the avoidance path by automatic driving, The other vehicle 36 is instructed to move forward via the inter-vehicle communication device 28 (step S110).

自車35および他車36の移動に伴い、ステップS111において、自車35または他車36が障害物37、38に接近した否か、あるいは自車35および他車36が互いに接近したか否かが判定される。自車35または他車36が障害物37、38に接近せず、また、自車35および他車36が互いに接近していないと判定された場合、ステップS112において、自車35および他車36の接触回避が完了したか否かが判定される。接触回避が完了した(図9示)と判定されると、本制御フローチャートは終了する。接触回避が完了していないと判定されると、ステップS110へと戻り、自車35および他車36の前進が継続される。   With the movement of the host vehicle 35 and the other vehicle 36, whether or not the host vehicle 35 or the other vehicle 36 approaches the obstacles 37, 38 or whether the host vehicle 35 and the other vehicle 36 approach each other in step S111. Is determined. When it is determined that the own vehicle 35 or the other vehicle 36 does not approach the obstacles 37 and 38 and the own vehicle 35 and the other vehicle 36 are not approaching each other, the own vehicle 35 and the other vehicle 36 are determined in step S112. It is determined whether or not contact avoidance has been completed. When it is determined that the contact avoidance has been completed (shown in FIG. 9), this control flowchart ends. If it is determined that the contact avoidance is not completed, the process returns to step S110, and the forward movement of the host vehicle 35 and the other vehicle 36 is continued.

ステップS111において、自車35または他車36が障害物37、38に接近したか、あるいは、自車35および他車36が互いに接近したと判定された場合、自車35のスロットルアクチュエータ24およびブレーキアクチュエータ27を制御し、自車35を停止させるとともに、車々間通信機28を介して他車36に対して停止の指示を行う(ステップS113)。その後、ステップS105へと戻り、再び、自車35の位置等の検出を行って回避経路を演算する。   In step S111, when it is determined that the own vehicle 35 or the other vehicle 36 approaches the obstacles 37, 38, or the own vehicle 35 and the other vehicle 36 approach each other, the throttle actuator 24 and the brake of the own vehicle 35 are determined. The actuator 27 is controlled to stop the host vehicle 35 and to stop the other vehicle 36 via the inter-vehicle communication device 28 (step S113). Thereafter, the process returns to step S105, and the position of the host vehicle 35 is detected again to calculate the avoidance route.

上述したステップS108において、演算された回避経路に基づいて、自車35と他車36との行き違いが不可能と判定されるとステップS114へと進み、自車35の後退が可能か否かが判定される。図10に示すように、回避経路の演算において、自車35と障害物37との間に左側緩衝帯39を確保し、他車36と障害物38との間に右側緩衝帯46を確保すると、道路34上の他車36が位置する場所(図10の中央部から上寄り)において、自車緩衝帯45と他車緩衝帯49とがオーバラップしている場合、あるいは自車35の回避経路と他車36の回避経路とがオーバラップしている場合は、自車35および他車36が同時に前進すると互いに接触する恐れが高い。   In step S108 described above, if it is determined that the vehicle 35 and the other vehicle 36 cannot be misplaced based on the calculated avoidance route, the process proceeds to step S114, and whether or not the vehicle 35 can be moved backward is determined. Determined. As shown in FIG. 10, in the calculation of the avoidance route, if the left buffer band 39 is secured between the own vehicle 35 and the obstacle 37 and the right buffer band 46 is secured between the other vehicle 36 and the obstacle 38. In the place where the other vehicle 36 is located on the road 34 (upward from the center of FIG. 10), when the own vehicle buffer zone 45 and the other vehicle buffer zone 49 overlap, or avoiding the own vehicle 35 If the route and the avoidance route of the other vehicle 36 overlap, there is a high possibility that the host vehicle 35 and the other vehicle 36 will come into contact with each other if they advance simultaneously.

一方、自車35が位置する場所(図10の下寄り)においては、自車緩衝帯45と他車緩衝帯49とが十分間隔を保持して形成されており、自車35が後退可能と判定される(ステップS114)。この場合、制御装置2により形成された回避経路に基づいて他車36を前進させるために、他車36の回避経路から自車35を一旦待避させるために、自車35を自動運転により後退させるとともに、車々間通信機28を介して他車36に停止指示を与える(ステップS117)。   On the other hand, in the place where the own vehicle 35 is located (lower side in FIG. 10), the own vehicle buffer zone 45 and the other vehicle buffer zone 49 are formed with a sufficient interval, and the own vehicle 35 can be moved backward. Determination is made (step S114). In this case, in order to move the other vehicle 36 forward based on the avoidance route formed by the control device 2, the own vehicle 35 is moved backward by automatic driving in order to temporarily retract the own vehicle 35 from the avoidance route of the other vehicle 36. At the same time, a stop instruction is given to the other vehicle 36 via the inter-vehicle communication device 28 (step S117).

ステップS118において、カメラ6あるいは障害物検知センサ8により、後退中に自車35が障害物37に接近したと判定されると、ステップS113へと進んで自車35および他車36を停止させた後、ステップS105へと戻り、自車35の位置、向き、障害物37の検出からやり直す。ステップS118において、自車35が障害物37に接近したと判定されない場合、位置検出器3の検出結果に基づき、自車35が自車緩衝帯45と他車緩衝帯49とが重なっていない場所まで移動し、後退が完了したか否かが判定される(ステップS119)。自車35の後退が完了していないと判定された場合、ステップS117へと戻り、自車35の後退が継続される。自車35の後退が完了したと判定されると、車々間通信機28を介して他車36に前進する指示を与える(ステップS120、図10示)。   In step S118, if it is determined by the camera 6 or the obstacle detection sensor 8 that the host vehicle 35 has approached the obstacle 37 during reverse, the process proceeds to step S113, and the host vehicle 35 and the other vehicle 36 are stopped. Thereafter, the process returns to step S105, and the process starts again from the detection of the position and orientation of the own vehicle 35 and the obstacle 37. If it is not determined in step S118 that the vehicle 35 has approached the obstacle 37, based on the detection result of the position detector 3, the vehicle 35 does not overlap the vehicle buffer zone 45 and the other vehicle buffer zone 49. It is determined whether or not the backward movement is completed (step S119). If it is determined that the backward movement of the host vehicle 35 has not been completed, the process returns to step S117, and the backward movement of the host vehicle 35 is continued. If it is determined that the backward movement of the host vehicle 35 is completed, an instruction to move forward to the other vehicle 36 is given via the inter-vehicle communication device 28 (step S120, shown in FIG. 10).

ステップS121において、車々間通信機28を介して、前進中に他車36が自車35あるいは障害物38に接近したという情報を受信したと判定されると、ステップS113へと進んで他車36を停止させた後、ステップS105へと戻り、前述の場合と同様に、回避経路の演算をやり直す。ステップS121において、他車36が障害物38等に接近したと判定されない場合、車々間通信機28を介して、他車36が自車緩衝帯45と他車緩衝帯49とが重なっていない場所まで移動し、自車35と他車36との接触回避が完了したか否かが判定される(ステップS122)。自車35と他車36との接触回避が完了していないと判定された場合、ステップS120へと戻り、他車36の前進が継続される。自車35と他車36との接触回避が完了したと判定されると、本制御フローチャートは終了する。   In step S121, if it is determined that information indicating that the other vehicle 36 has approached the own vehicle 35 or the obstacle 38 during forward traveling is received via the inter-vehicle communication device 28, the process proceeds to step S113 and the other vehicle 36 is moved. After stopping, the process returns to step S105, and the calculation of the avoidance route is performed again as in the case described above. If it is not determined in step S121 that the other vehicle 36 has approached the obstacle 38 or the like, the other vehicle 36 has reached the place where the own vehicle buffer zone 45 and the other vehicle buffer zone 49 do not overlap via the inter-vehicle communication device 28. It moves and it is determined whether the contact avoidance with the own vehicle 35 and the other vehicle 36 was completed (step S122). If it is determined that contact avoidance between the host vehicle 35 and the other vehicle 36 is not completed, the process returns to step S120, and the other vehicle 36 continues to advance. When it is determined that the contact avoidance between the own vehicle 35 and the other vehicle 36 has been completed, this control flowchart ends.

一方、ステップS114において、自車35が後退不可能と判定された場合、ステップS115へと進み、他車36が後退可能か否かが判定される。図11に示すように、回避経路の演算において、自車35と障害物37との間に左側緩衝帯39を確保し、他車36と障害物38との間に右側緩衝帯46を確保すると、道路34上の自車35が位置する場所(図11の中央部から下寄り)において、自車緩衝帯45と他車緩衝帯49とがオーバラップしている場合、あるいは自車35の回避経路と他車36の回避経路とがオーバラップしている場合は、自車35および他車36が同時に前進すると互いに接触する恐れが高い。   On the other hand, when it is determined in step S114 that the own vehicle 35 cannot be moved backward, the process proceeds to step S115, and it is determined whether or not the other vehicle 36 can be moved backward. As shown in FIG. 11, in the calculation of the avoidance route, if the left buffer band 39 is secured between the own vehicle 35 and the obstacle 37 and the right buffer band 46 is secured between the other vehicle 36 and the obstacle 38. In the place where the own vehicle 35 is located on the road 34 (downward from the center of FIG. 11), the own vehicle buffer zone 45 and the other vehicle buffer zone 49 overlap, or the own vehicle 35 is avoided. If the route and the avoidance route of the other vehicle 36 overlap, there is a high possibility that the host vehicle 35 and the other vehicle 36 will come into contact with each other if they advance simultaneously.

一方、他車36が位置する場所(図11の上寄り)においては、自車緩衝帯45と他車緩衝帯49とが十分間隔を保持して形成されており、他車36が後退可能と判定される(ステップS115)。この場合、制御装置2により形成された回避経路に基づいて自車35を前進させるために、自車35の回避経路から他車36を一旦待避させるために、自車35を停止させるとともに、車々間通信機28を介して他車36に後退指示を与える(ステップS123)。その後、他車36の後退が完了したと判定されると(ステップS125)、自車35を前進させる(ステップS126)。この場合は、前述した場合に対し、自車35と他車36のうち後退させる車両と前進させる車両を入れ換えた関係にあるため、詳細な説明は省略する。   On the other hand, in the place where the other vehicle 36 is located (upward in FIG. 11), the own vehicle buffer zone 45 and the other vehicle buffer zone 49 are formed with a sufficient distance therebetween, so that the other vehicle 36 can move backward. Determination is made (step S115). In this case, in order to move the own vehicle 35 forward based on the avoidance route formed by the control device 2, the own vehicle 35 is stopped in order to temporarily retract the other vehicle 36 from the avoidance route of the own vehicle 35. A reverse instruction is given to the other vehicle 36 via the communication device 28 (step S123). Thereafter, when it is determined that the reverse of the other vehicle 36 has been completed (step S125), the host vehicle 35 is advanced (step S126). In this case, in contrast to the case described above, the vehicle 35 and the other vehicle 36 are replaced with the vehicle to be moved backward and the vehicle to be moved forward, and thus detailed description thereof is omitted.

また、ステップS115において、他車36も後退不可能と判定された場合、ステップS116へと進み、表示装置17あるいはそれに加えてスピーカ19により、自車35の運転者に対して接触回避が不可能であることを通知する。また、車々間通信機28を介して、他車36に対しても接触回避が不可能であることを通知する。図12に示すように、回避経路の演算において、自車35と障害物37との間に左側緩衝帯39を確保し、他車36と障害物38との間に右側緩衝帯46を確保すると、道路34上の全領域に渡って、自車緩衝帯45と他車緩衝帯49とがオーバラップしている場合は、自車35と他車36との接触を回避することができない。この場合は、自車35および他車36のそれぞれの運転者が運転操作することにより、両車35、36の接触を回避する。   If it is determined in step S115 that the other vehicle 36 cannot be moved backward, the process proceeds to step S116, and it is impossible to avoid contact with the driver of the host vehicle 35 by the display device 17 or in addition to the speaker 19. Notify that. Further, the inter-vehicle communication device 28 notifies the other vehicle 36 that contact avoidance is impossible. As shown in FIG. 12, in the calculation of the avoidance route, if the left buffer band 39 is secured between the own vehicle 35 and the obstacle 37 and the right buffer band 46 is secured between the other vehicle 36 and the obstacle 38. When the host vehicle buffer zone 45 and the other vehicle buffer zone 49 overlap over the entire area on the road 34, contact between the host vehicle 35 and the other vehicle 36 cannot be avoided. In this case, the driver of each of the own vehicle 35 and the other vehicle 36 operates to avoid contact between the vehicles 35 and 36.

上述したステップS104において、他車36からの返信を受信しなかった場合、自車35単独で障害物37等に接触したと考えられる。この場合は、ステップS201(図16示)へと進み、位置検出器3により、自車35の位置および向きを検出するとともに、カメラ6あるいは障害物検知センサ8により周囲の障害物の位置を検出し、検出した自車35の位置、向き、自車35の周囲の障害物の位置、当初から制御装置2に保存されている自車35の車幅WLおよび最小回転半径に基づき、自車35と障害物37等との接触を回避するための、道路34上における自車35単独の回避経路を演算する(ステップS202)。   In step S104 described above, when a reply from the other vehicle 36 is not received, it is considered that the vehicle 35 alone has touched the obstacle 37 or the like. In this case, the process proceeds to step S201 (shown in FIG. 16), where the position detector 3 detects the position and orientation of the host vehicle 35, and the camera 6 or the obstacle detection sensor 8 detects the position of surrounding obstacles. Then, based on the detected position and orientation of the own vehicle 35, the positions of obstacles around the own vehicle 35, the vehicle width WL and the minimum turning radius of the own vehicle 35 stored in the control device 2 from the beginning, the own vehicle 35 The avoidance route of the vehicle 35 alone on the road 34 for avoiding contact with the obstacle 37 and the like is calculated (step S202).

次に、回避経路の演算結果に基づき、接触回避が可能であるか否かが判定される(ステップS203)。回避経路の演算において、自車35と障害物37との間に左側緩衝帯39を確保すると、自車35と他の障害物との間において十分な緩衝帯がとれないと判定され場合、ステップS208へと進み、表示装置17あるいはそれに加えてスピーカ19により、自車35の運転者に対して接触回避が不可能であることを通知する(ステップS208)。   Next, based on the calculation result of the avoidance route, it is determined whether or not contact avoidance is possible (step S203). If it is determined in the calculation of the avoidance route that the left buffer zone 39 is secured between the own vehicle 35 and the obstacle 37, it is determined that a sufficient buffer zone cannot be taken between the own vehicle 35 and another obstacle. Proceeding to S208, the display device 17 or additionally the speaker 19 notifies the driver of the vehicle 35 that contact avoidance is impossible (step S208).

一方、自車35と障害物37との間に左側緩衝帯39を確保しても、自車35と他の障害物との間に十分な緩衝帯がとれると判定された場合は、演算された回避経路に基づいて、自動運転による自車35の移動が開始される(ステップS204)。その後、ステップS205において、カメラ6あるいは障害物検知センサ8により、移動中に自車35が障害物37等に接近したと判定されると、ステップS207へと進んで自車35を停止させた後、ステップS201へと戻り、自車35の位置、向き、障害物37の検出からやり直す。ステップS205において、自車35が障害物37等に接近したと判定されない場合、位置検出器3の検出結果に基づき、自車35が障害物37等から離れて、接触回避が完了したか否かが判定される(ステップS206)。自車35の接触回避が完了していないと判定された場合、ステップS204へと戻り、自車35の移動が継続される。自車35の接触回避が完了したと判定されると、本制御フローチャートは終了する。   On the other hand, if it is determined that a sufficient buffer band can be secured between the vehicle 35 and other obstacles even if the left buffer band 39 is secured between the vehicle 35 and the obstacle 37, the calculation is performed. Based on the avoidance route, the movement of the vehicle 35 by the automatic driving is started (step S204). Thereafter, in step S205, when the camera 6 or the obstacle detection sensor 8 determines that the own vehicle 35 has approached the obstacle 37 or the like during movement, the process proceeds to step S207 and the own vehicle 35 is stopped. Then, the process returns to step S201 and starts again from the detection of the position and orientation of the own vehicle 35 and the obstacle 37. In step S205, if it is not determined that the vehicle 35 has approached the obstacle 37 or the like, whether or not the vehicle 35 has left the obstacle 37 or the like and contact avoidance has been completed based on the detection result of the position detector 3 or not. Is determined (step S206). If it is determined that the contact avoidance of the own vehicle 35 is not completed, the process returns to step S204, and the movement of the own vehicle 35 is continued. If it is determined that the contact avoidance of the host vehicle 35 has been completed, the control flowchart ends.

本実施形態によれば、自車35が他車36と接触した場合に、自車35の現在位置、自車35の向き、自車35の周囲の障害物37の位置、他車36から受信した他車36の現在位置情報、他車36の向き情報および他車36の周囲の障害物38の位置情報に基づいて、自車35が他車との接触を回避する経路を演算し、形成された回避経路に基づいて自車35を移動させる。これにより、道路34上において他車36と接触した場合、形成された回避経路に基づく自車35の移動によって、他車36からの回避が容易に行える。   According to this embodiment, when the own vehicle 35 comes into contact with the other vehicle 36, the current position of the own vehicle 35, the direction of the own vehicle 35, the position of the obstacle 37 around the own vehicle 35, and the reception from the other vehicle 36. Based on the current position information of the other vehicle 36, the direction information of the other vehicle 36, and the position information of the obstacle 38 around the other vehicle 36, a route for the host vehicle 35 to avoid contact with the other vehicle is calculated and formed. The own vehicle 35 is moved based on the avoided route. Thereby, when it contacts with the other vehicle 36 on the road 34, the avoidance from the other vehicle 36 can be easily performed by the movement of the own vehicle 35 based on the formed avoidance route.

また、制御装置2は、自車35および他車36が、カメラ6あるいは障害物検出センサ8により検出された障害物37、38から、所定距離Dだけ離れて走行するような経路を演算することにより回避経路を形成する。これにより、障害物37、38を確実に避ける回避経路を、容易に形成することができる。
また、制御装置2により形成された回避経路に基づいて自車35を移動させる場合、車々間通信装置28を介して、他車36に対し移動指示を行い、自車35の回避経路から他車36を一旦待避させるために後退させる。これにより、他車36および障害物37、38を避けて、いっそう容易に自車35を接触から回避させることができる。
Further, the control device 2 calculates a route in which the host vehicle 35 and the other vehicle 36 travel away from the obstacles 37 and 38 detected by the camera 6 or the obstacle detection sensor 8 by a predetermined distance D. Thus, an avoidance path is formed. Thereby, the avoidance path | route which avoids the obstructions 37 and 38 reliably can be formed easily.
Further, when the host vehicle 35 is moved based on the avoidance route formed by the control device 2, the other vehicle 36 is instructed to move via the inter-vehicle communication device 28, and the other vehicle 36 is moved from the avoidance route of the host vehicle 35. Retreat to temporarily save. Thereby, the other vehicle 36 and the obstacles 37 and 38 can be avoided, and the own vehicle 35 can be more easily avoided from contact.

また、自車35および他車36の外周面には、軟質材にて形成され圧力センサ9が内蔵されたバンパー33が取り付けられ、自車35と他車36とが接触した場合に、バンパー33が互いに押圧されて圧力センサ9が昇圧を検出した時に、制御装置2が回避経路を演算する。これにより、簡単な構成で確実に車両35、36の接触を検出し、回避経路の演算を開始することができる。   Further, a bumper 33 formed of a soft material and including the pressure sensor 9 is attached to the outer peripheral surfaces of the own vehicle 35 and the other vehicle 36. When the own vehicle 35 and the other vehicle 36 come into contact with each other, the bumper 33 Are pressed together and the pressure sensor 9 detects the pressure increase, the control device 2 calculates the avoidance path. Thereby, the contact of the vehicles 35 and 36 can be reliably detected with a simple configuration, and the calculation of the avoidance route can be started.

<他の実施形態>
本発明は、上述した実施形態に限定されるものではなく、次のように変形または拡張することができる。
自車35と他車36または障害物37、38との接触を回避する経路の演算方法については、自車35が障害物37、38に挟まれた道路34上の幅方向中央部を走行するようにして経路を形成する方法、あるいはそれ以外の方法を使用してもよい。
図8および図9に示したように、自車35と他車36がともに前進して行き違いを行う場合、他車36は運転者の操作により前進させるようにしてもよい。
自車35と他車36とが接触したことは、接触により自車35に発生する衝撃(加速度)を検出する方法、あるいはそれ以外の方法により検出するようにしてもよい。
<Other embodiments>
The present invention is not limited to the above-described embodiments, and can be modified or expanded as follows.
Regarding the calculation method of the route for avoiding contact between the own vehicle 35 and the other vehicle 36 or the obstacles 37 and 38, the own vehicle 35 travels in the center in the width direction on the road 34 sandwiched between the obstacles 37 and 38. Thus, a method of forming a path or other methods may be used.
As shown in FIGS. 8 and 9, when both the own vehicle 35 and the other vehicle 36 move forward and make a mistake, the other vehicle 36 may be moved forward by the operation of the driver.
You may make it detect that the own vehicle 35 and the other vehicle 36 contacted by the method of detecting the impact (acceleration) which generate | occur | produces in the own vehicle 35 by contact, or other methods.

本実施形態による車載走行支援装置の構成を示すブロック図The block diagram which shows the structure of the vehicle-mounted driving assistance apparatus by this embodiment. 自車と他車とが接触したところを示した平面図A plan view showing where your vehicle and other vehicles have come into contact 道路上に左側緩衝帯が形成されたところを示した平面図Top view showing where the left buffer zone is formed on the road 図3の要部拡大図3 is an enlarged view of the main part of FIG. 道路上に自車中心線および自車外形線が形成されたところを示した平面図The top view which showed the place where the own car center line and the own car outline were formed on the road 自車中心線および自車外形線を形成する方法を説明するための図5の要部拡大図The principal part enlarged view of FIG. 5 for demonstrating the method of forming the own vehicle center line and the own vehicle outline 道路上に自車緩衝帯が形成されたところを示した平面図Plan view showing where the vehicle buffer zone is formed on the road 回避経路に基づき、自車と他車とが行き違う前の状態を示した平面図Plan view showing the state before the vehicle and other vehicles cross each other based on the avoidance route 自車と他車とが行き違った後の状態を示した平面図The top view which showed the state after the own vehicle and other vehicles crossed 他車を前進させる前に、自車を一旦後退させたところを示した平面図A plan view showing the vehicle once retracted before moving another vehicle forward 自車を前進させる前に、他車を一旦後退させたところを示した平面図A plan view showing the other vehicle once retracted before moving its own vehicle forward 演算された回避経路に基づいた場合、行き違いが不可能であるところを示した平面図Plan view showing where a crossing is impossible based on the calculated avoidance route バンパーに圧力センサが内蔵されたところを示した平面図Plan view showing the pressure sensor built in the bumper 図13に示したバンパーが他車のバンパーと接触したところを示した平面図The top view which showed the place where the bumper shown in FIG. 13 contacted the bumper of the other vehicle 制御装置による車載走行支援装置のメイン制御フローチャートMain control flowchart of in-vehicle travel support device by control device 車載走行支援装置のサブ制御フローチャートSub-control flowchart for in-vehicle travel support device

符号の説明Explanation of symbols

図面中、1は車載走行支援装置、2は制御装置(回避経路演算手段)、3は位置検出器(車両位置検出手段)、6はカメラ(障害物検出手段)、8は障害物検知センサ(障害物検出手段)、9はバンパー圧力センサ、24はスロットルアクチュエータ(車両移動手段)、25はシフトアクチュエータ(車両移動手段)、26は操舵アクチュエータ(車両移動手段)、27はブレーキアクチュエータ(車両移動手段)、28は車々間通信機(通信手段)、33はバンパー、35は自車、36は他車、37、38は障害物を示す。   In the drawings, 1 is an in-vehicle travel support device, 2 is a control device (avoidance route calculation means), 3 is a position detector (vehicle position detection means), 6 is a camera (obstacle detection means), and 8 is an obstacle detection sensor ( Obstacle detection means), 9 is a bumper pressure sensor, 24 is a throttle actuator (vehicle movement means), 25 is a shift actuator (vehicle movement means), 26 is a steering actuator (vehicle movement means), and 27 is a brake actuator (vehicle movement means). ), 28 is an inter-vehicle communication device (communication means), 33 is a bumper, 35 is a host vehicle, 36 is another vehicle, and 37 and 38 are obstacles.

Claims (3)

各車両が、
自車の現在位置および向きを検出する車両位置検出手段と、
自車周囲の障害物の位置を検出する障害物検出手段と、
自車の周辺にある他車との間で送受信を行う通信手段と、
自車が他車と接触した場合に、前記車両位置検出手段により検出された自車の現在位置および向き、前記障害物検出手段により検出された自車周囲の障害物の位置、前記通信手段を介して他車から受信した他車の現在位置情報、他車の向き情報および他車周囲の障害物の位置情報に基づいて、自車が他車との接触を回避する経路を演算する回避経路演算手段と、
前記回避経路演算手段により形成された回避経路に基づいて自車を移動させる車両移動手段を備え
前記車両移動手段が前記回避経路演算手段により形成された前記回避経路に基づいて自車を移動させるために、自車を停止させるとともに、前記通信手段を介して他車に対し移動指示を行い、自車の前記回避経路から他車を一旦待避させることを特徴とする走行支援システム。
Each vehicle
Vehicle position detection means for detecting the current position and direction of the vehicle;
Obstacle detection means for detecting the position of obstacles around the vehicle;
A communication means for transmitting and receiving to and from other vehicles around the vehicle;
When the own vehicle comes into contact with another vehicle, the current position and direction of the own vehicle detected by the vehicle position detecting unit, the position of the obstacle around the own vehicle detected by the obstacle detecting unit, and the communication unit An avoidance route that calculates a route for the host vehicle to avoid contact with the other vehicle based on the current position information of the other vehicle, the direction information of the other vehicle, and the position information of obstacles around the other vehicle via Computing means;
Vehicle moving means for moving the host vehicle based on the avoidance path formed by the avoidance path calculation means ;
In order for the vehicle moving means to move the own vehicle based on the avoidance route formed by the avoidance route calculating means, the own vehicle is stopped and a movement instruction is given to another vehicle via the communication means, A travel support system that temporarily retracts another vehicle from the avoidance route of the host vehicle .
前記回避経路演算手段は、自車が前記障害物検出手段により検出された前記障害物から、所定距離だけ離れて走行するような経路を演算することにより前記回避経路を形成することを特徴とする請求項1記載の走行支援システム。   The avoidance route calculation means forms the avoidance route by calculating a route in which the vehicle travels a predetermined distance away from the obstacle detected by the obstacle detection means. The driving support system according to claim 1. 自車の外周部には、軟質材にて形成され圧力センサが内蔵されたバンパーが取り付けられ、自車と他車とが接触した場合に、前記バンパーが押圧されて前記圧力センサが昇圧を検出した時に、前記回避経路演算手段が前記回避経路の演算を開始することを特徴とする請求項1または2記載の走行支援システム。 A bumper that is made of a soft material and has a built-in pressure sensor is attached to the outer periphery of the host vehicle. When the host vehicle and another vehicle come into contact with each other, the bumper is pressed and the pressure sensor detects a pressure increase. 3. The driving support system according to claim 1 , wherein the avoidance route calculation means starts calculation of the avoidance route .
JP2007214735A 2007-08-21 2007-08-21 Driving support system Expired - Fee Related JP4893531B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2007214735A JP4893531B2 (en) 2007-08-21 2007-08-21 Driving support system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2007214735A JP4893531B2 (en) 2007-08-21 2007-08-21 Driving support system

Publications (2)

Publication Number Publication Date
JP2009046039A JP2009046039A (en) 2009-03-05
JP4893531B2 true JP4893531B2 (en) 2012-03-07

Family

ID=40498689

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2007214735A Expired - Fee Related JP4893531B2 (en) 2007-08-21 2007-08-21 Driving support system

Country Status (1)

Country Link
JP (1) JP4893531B2 (en)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI599787B (en) 2016-08-01 2017-09-21 明泰科技股份有限公司 Mobile navigation method and system
JP7166766B2 (en) * 2017-07-28 2022-11-08 パナソニック インテレクチュアル プロパティ コーポレーション オブ アメリカ Information processing device, information processing method and program
JP6994982B2 (en) * 2018-02-27 2022-01-14 本田技研工業株式会社 Vehicle control systems, vehicle control methods, and programs
KR102833876B1 (en) * 2020-04-16 2025-07-16 현대모비스 주식회사 Reverse driving assistance device and reverse driving method using the same
KR102795011B1 (en) * 2020-04-16 2025-04-16 현대모비스 주식회사 Reverse driving assistance device and reverse driving method using the same
JP7479226B2 (en) * 2020-07-08 2024-05-08 株式会社Soken Route confirmation device and program

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3436207B2 (en) * 1999-01-12 2003-08-11 トヨタ自動車株式会社 Vehicle-to-vehicle communication device
JP2005326963A (en) * 2004-05-12 2005-11-24 Fujitsu Ten Ltd Operation supporting device
JP4297045B2 (en) * 2004-12-14 2009-07-15 株式会社デンソー Display control apparatus and program for head-up display
JP4626295B2 (en) * 2004-12-21 2011-02-02 日産自動車株式会社 Driving support system and driving support device
JP2006199233A (en) * 2005-01-24 2006-08-03 Advics:Kk Vehicle safety control device
JP2006327426A (en) * 2005-05-26 2006-12-07 Sumitomo Electric Ind Ltd Collision mitigation device
JP2007091028A (en) * 2005-09-28 2007-04-12 Toyota Motor Corp Vehicle alarm system

Also Published As

Publication number Publication date
JP2009046039A (en) 2009-03-05

Similar Documents

Publication Publication Date Title
CN105835886B (en) Drive assistance device
KR101916515B1 (en) Method for guiding parking mode in remote automatic parking assist system
US9796416B2 (en) Automated driving apparatus and automated driving system
JP6361567B2 (en) Automated driving vehicle system
EP4026756B1 (en) Automated valet parking system, control method for an automated valet parking system, and autonomous driving vehicle
US9682725B2 (en) Lane change assistance apparatus
US9914463B2 (en) Autonomous driving device
KR100946525B1 (en) Vehicle automatic driving system
US20160355178A1 (en) Surroundings monitoring apparatus and drive assistance apparatus
US20190084579A1 (en) Autonomous driving assistance device and computer program
US20100332080A1 (en) Method and apparatus for parking assistance
CN106314419A (en) Automatic driving control device
JP6532170B2 (en) Vehicle control system, vehicle control method, and vehicle control program
JP2005041433A (en) Vehicle guidance device and route determination program
EP4046883B1 (en) Automated valet parking system, control method of automated valet parking system, and autonomous driving vehicle
JP4893531B2 (en) Driving support system
JP2016112911A (en) Vehicular travel control device
US12509147B2 (en) Driving support device, driving support method, and storage medium
JP2008213741A (en) Driving assistance device
JP2005138623A (en) Vehicle travel support device
JP2018083481A (en) Parking support method and parking support device
JP7681715B2 (en) Vehicle control device
CN112455442A (en) Method and device for assisting voice-controlled steering in a driving vehicle
JP2017073059A (en) Lane change support device
JP6575451B2 (en) Driving support device and driving support program

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20091124

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20110830

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20111028

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

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

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20111205

R151 Written notification of patent or utility model registration

Ref document number: 4893531

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

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

Free format text: PAYMENT UNTIL: 20150106

Year of fee payment: 3

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees