JP2018162041A - Rotatable area detection method, rotatable area detection device using the same, and program - Google Patents

Rotatable area detection method, rotatable area detection device using the same, and program Download PDF

Info

Publication number
JP2018162041A
JP2018162041A JP2017061851A JP2017061851A JP2018162041A JP 2018162041 A JP2018162041 A JP 2018162041A JP 2017061851 A JP2017061851 A JP 2017061851A JP 2017061851 A JP2017061851 A JP 2017061851A JP 2018162041 A JP2018162041 A JP 2018162041A
Authority
JP
Japan
Prior art keywords
vehicle
circuit
boundary curve
travel path
unit
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.)
Pending
Application number
JP2017061851A
Other languages
Japanese (ja)
Inventor
豊治 黒田
Toyoji Kuroda
豊治 黒田
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.)
Panasonic Intellectual Property Management Co Ltd
Original Assignee
Panasonic Intellectual Property Management 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 Panasonic Intellectual Property Management Co Ltd filed Critical Panasonic Intellectual Property Management Co Ltd
Priority to JP2017061851A priority Critical patent/JP2018162041A/en
Publication of JP2018162041A publication Critical patent/JP2018162041A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Traffic Control Systems (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide a technique for improving detection accuracy of a rotatable area.SOLUTION: A detection part 60 for detecting a turning passage extending from a travel route in a direction different from the travel route on the basis of information of an obstacle present at a periphery of the vehicle 100 travelling along the travel route. A setting part 62 sets a boundary curve including an arc like trajectory passing through the inside of the vehicle 100 when the vehicle 100 turns between the travel route and the turning passage detected by the detection part 60. A determination part 66 determines that turning of the vehicle 100 in the turning passage is available when the obstacle, on a side of the turning passage in the travel route, is not present close to a side of the vehicle 100 than the boundary curve set by the setting part 62.SELECTED DRAWING: Figure 2

Description

本発明は、転回可能領域検出方法およびそれを利用した転回可能領域検出装置、プログラムに関する。   The present invention relates to a turnable area detection method, a turnable area detection apparatus using the same, and a program.

車両の安全性の向上を図るために運転者の運転操作を支援する運転支援装置が開発されている。この運転支援装置は、袋小路から引き返す際のガイドを提供するために、車両に搭載したセンサからの入力に基づき作成した2次元マップと車種毎に設定された矩形の転回エリア(例えば8m×10m)から転回可能な領域の有無を検知する。   In order to improve the safety of the vehicle, a driving support device that supports a driver's driving operation has been developed. This driving support device provides a guide for returning from a bag path, a two-dimensional map created based on input from a sensor mounted on the vehicle, and a rectangular turning area set for each vehicle type (for example, 8 m × 10 m) The presence or absence of a turnable area is detected.

特開2002−352397号公報JP 2002-352397 A

矩形の転回エリアでは、実際に転回可能な領域よりも大きな領域しか検出できない。そのため、実際は転回可能な領域であっても、転回不可能と判定されてしまうことがある。   In the rectangular turning area, only an area larger than the actually turnable area can be detected. For this reason, even in an area in which turning is actually possible, it may be determined that turning is impossible.

本発明はこうした状況に鑑みなされたものであり、その目的は、転回可能領域の検出精度を向上する技術を提供することにある。   The present invention has been made in view of such circumstances, and an object thereof is to provide a technique for improving the detection accuracy of a turnable region.

上記課題を解決するために、本発明のある態様の転回可能領域検出装置は、走行路に沿って走行する車両の周囲に存在する障害物の情報をもとに、走行路とは異なった方向に走行路から延びる転回路を検出する検出部と、走行路と検出部により検出された転回路との間で車両が転回する場合に車両の内側が通過する円弧状の軌跡が含まれた境界曲線を設定する設定部と、走行路における転回路側の障害物が、設定部において設定した境界曲線よりも車両側に非存在である場合、転回路における車両の転回が可能であると判定する判定部と、を備える。   In order to solve the above-mentioned problem, a turnable area detection device according to an aspect of the present invention is based on information on obstacles existing around a vehicle traveling along a traveling road, and in a direction different from that of the traveling road. A boundary including an arc-shaped locus through which the inside of the vehicle passes when the vehicle turns between the traveling path and the rolling circuit detected by the detecting unit. Determination that determines that the turning of the vehicle in the turn circuit is possible when the setting part for setting the curve and the obstacle on the turn circuit side on the road are not present on the vehicle side than the boundary curve set in the setting part A section.

本発明の別の態様は、転回可能領域検出方法である。この方法は、走行路に沿って走行する車両の周囲に存在する障害物の情報をもとに、走行路とは異なった方向に走行路から延びる転回路を検出するステップと、走行路と検出された転回路との間で車両が転回する場合に車両の内側が通過する円弧状の軌跡が含まれた境界曲線を設定するステップと、走行路における転回路側の障害物が、設定した境界曲線よりも車両側に非存在である場合、転回路における車両の転回が可能であると判定するステップと、を備える。   Another aspect of the present invention is a method for detecting a turnable region. The method includes a step of detecting a rolling circuit extending from the travel path in a direction different from the travel path based on information on an obstacle existing around the vehicle traveling along the travel path, and the detection of the travel path. The step of setting a boundary curve including an arc-shaped trajectory through which the inside of the vehicle passes when the vehicle turns with the turned turning circuit, and the obstacle on the turning circuit side in the traveling path Determining that the vehicle can be turned in the turn circuit when the vehicle is not present on the vehicle side.

なお、以上の構成要素の任意の組合せ、本発明の表現を装置、システム、方法、プログラム、プログラムを記録した記録媒体、本装置を搭載した車両などの間で変換したものもまた、本発明の態様として有効である。   An arbitrary combination of the above components, the expression of the present invention converted between an apparatus, a system, a method, a program, a recording medium recording the program, a vehicle equipped with the apparatus, and the like are also included in the present invention. It is effective as an embodiment.

本発明によれば、転回可能領域の検出精度を向上できる。   According to the present invention, the detection accuracy of the turnable region can be improved.

実施の形態に係る車両が走行する駐車場の構成を示す図である。It is a figure which shows the structure of the parking lot where the vehicle which concerns on embodiment drive | works. 図1の車両の構成を示す図である。It is a figure which shows the structure of the vehicle of FIG. 図2の第1受付部における処理概要を示す図である。It is a figure which shows the process outline | summary in the 1st reception part of FIG. 図2のマップ生成部において生成した地図を示す図である。It is a figure which shows the map produced | generated in the map production | generation part of FIG. 図5(a)−(b)は、図2の検出部における処理概要を示す図である。FIGS. 5A to 5B are diagrams illustrating an outline of processing in the detection unit of FIG. 図6(a)−(b)は、図2の分類部における処理概要を示す図である。FIGS. 6A to 6B are diagrams illustrating an outline of processing in the classification unit of FIG. 図7(a)−(b)は、図2の分類部における分類結果に応じた処理を示す図である。FIGS. 7A and 7B are diagrams illustrating processing according to the classification result in the classification unit of FIG. 図8(a)−(b)は、図2の設定部における処理概要を示す図である。FIGS. 8A to 8B are diagrams illustrating an outline of processing in the setting unit in FIG. 図9(a)−(b)は、図2の設定部における処理概要を示す図である。FIGS. 9A and 9B are diagrams illustrating an outline of processing in the setting unit in FIG. 図2の駐車支援装置による保存手順を示すフローチャートである。It is a flowchart which shows the preservation | save procedure by the parking assistance apparatus of FIG. 図2の駐車支援装置による掲示手順を示すフローチャートである。It is a flowchart which shows the posting procedure by the parking assistance apparatus of FIG.

本発明を具体的に説明する前に、概要を述べる。本実施の形態は、車両の駐車を支援する駐車支援装置に関する。ここでは、駐車場において空きの駐車領域を探索しながら走行路を走行し、走行路が袋小路となる部分において空きの駐車領域を見つけた状況を前提とする。そのような空き駐車領域に車両の前方から進入して駐車することは困難であるので、車両には、走行路を後退で引き返し、転回してから、空きの駐車領域に後退で向かうことによって、空き駐車領域に車両の後方から進入して駐車することが求められる。このような一連の動作において、駐車支援装置は、車両の転回可能な領域(以下、「転回可能領域」という)を検出する。その際、矩形の転回エリアを規定し、転回エリアを確保可能な領域を転回可能領域として検出する場合、車両が実際に転回できる領域よりも大きな領域しか検出できない。本実施の形態は、転回可能領域の検出精度を向上することを目的とする。   Before describing the present invention in detail, an outline will be described. The present embodiment relates to a parking support apparatus that supports parking of a vehicle. Here, it is assumed that the vehicle travels on the road while searching for an empty parking area in the parking lot, and an empty parking area is found in a portion where the road is a bag path. Since it is difficult to enter and park in such an empty parking area from the front of the vehicle, the vehicle is turned backward on the traveling path, turned and then moved backward to the empty parking area, It is required to enter the parking area from behind the vehicle and park. In such a series of operations, the parking assistance device detects an area in which the vehicle can turn (hereinafter referred to as “turnable area”). At this time, when a rectangular turning area is defined and an area where the turning area can be secured is detected as a turnable area, only an area larger than an area where the vehicle can actually turn can be detected. The purpose of this embodiment is to improve the detection accuracy of the turnable region.

以下、本発明の実施の形態について、図面を参照して詳細に説明する。なお、以下に説明する実施の形態は一例であり、本発明は実施の形態により限定されるものではない。   Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings. The embodiment described below is an example, and the present invention is not limited to the embodiment.

図1は、実施の形態に係る車両100が走行する駐車場200の構成を示す。駐車場200には、駐車領域210と総称される第1駐車領域210aから第9駐車領域210iが配置される。特に、第1駐車領域210aから第4駐車領域210dと、第5駐車領域210eから第9駐車領域210iとの間には走行路220が配置され、走行路220は図1の縦方向に延びる。また、第3駐車領域210cと第4駐車領域210dとの間には転回路222が配置される。転回路222は、走行路220とは異なった方向、つまり図1の横方向に走行路220から延びる。第1駐車領域210aから第8駐車領域210hには、第1他車両110aから第8他車両110hがそれぞれ駐車されており、第9駐車領域210iには他車両110が駐車されていない。車両100は、空きの駐車領域210を見つけるために、走行路220を走行方向120に走行する。   FIG. 1 shows a configuration of a parking lot 200 in which a vehicle 100 according to an embodiment travels. In the parking lot 200, a first parking area 210a to a ninth parking area 210i collectively referred to as a parking area 210 are arranged. In particular, a traveling path 220 is disposed between the first parking area 210a to the fourth parking area 210d and the fifth parking area 210e to the ninth parking area 210i, and the traveling path 220 extends in the vertical direction of FIG. Further, a rolling circuit 222 is disposed between the third parking area 210c and the fourth parking area 210d. The rolling circuit 222 extends from the travel path 220 in a direction different from the travel path 220, that is, in the lateral direction of FIG. The first other vehicle 110a to the eighth other vehicle 110h are parked in the first parking area 210a to the eighth parking area 210h, and the other vehicle 110 is not parked in the ninth parking area 210i. The vehicle 100 travels in the travel direction 120 on the travel path 220 in order to find an empty parking area 210.

車両100の乗員は、空きの第9駐車領域210iを見つけるが、車両100の前方から第9駐車領域210iに進入できないので、転回することによって車両100の後方から第9駐車領域210iに進入すべきであることを認識する。そのため、車両100は、転回するために、走行方向120とは逆向きに走行路220を後退する。ここで、車両100が転回路222で転回可能であれば、車両100は転回路222で転回して、車両100の後方から第9駐車領域210iに進入することが可能になる。本実施の形態に係る駐車支援装置は、車両100に搭載され、転回路222が転回可能領域であるかを判定する。   The occupant of the vehicle 100 finds an empty ninth parking area 210i, but cannot enter the ninth parking area 210i from the front of the vehicle 100, so it should enter the ninth parking area 210i from behind the vehicle 100 by turning. Recognize that. Therefore, the vehicle 100 moves backward on the traveling path 220 in the direction opposite to the traveling direction 120 in order to turn. Here, if the vehicle 100 can be turned by the turning circuit 222, the vehicle 100 can turn by the turning circuit 222 and can enter the ninth parking area 210i from the rear of the vehicle 100. The parking assistance apparatus according to the present embodiment is mounted on vehicle 100 and determines whether or not turn circuit 222 is a turnable area.

図2は、車両100の構成を示す。車両100は、センサ10と総称される第1センサ10a、第2センサ10b、位置情報取得部12、シフトECU(Electronic Control Unit)14、駐車支援装置20、報知装置22を含む。駐車支援装置20は、第1受付部30、マップ生成部32、転回可能領域検出部34、記憶部36、制御部40、第2受付部50、処理部52を含む。また、転回可能領域検出部34は、検出部60、設定部62、分類部64、判定部66を含む。   FIG. 2 shows the configuration of the vehicle 100. The vehicle 100 includes a first sensor 10 a, a second sensor 10 b, a position information acquisition unit 12, a shift ECU (Electronic Control Unit) 14, a parking assistance device 20, and a notification device 22 that are collectively referred to as a sensor 10. The parking assistance device 20 includes a first reception unit 30, a map generation unit 32, a turnable area detection unit 34, a storage unit 36, a control unit 40, a second reception unit 50, and a processing unit 52. Further, the turnable area detection unit 34 includes a detection unit 60, a setting unit 62, a classification unit 64, and a determination unit 66.

第1センサ10aと第2センサ10bは、車両100の両側面に搭載され、車外の障害物、例えば、他車両110との距離を測定する。センサ10として、レーザレーダ、カメラ、超音波センサ等が使用される。レーザレーダは、レーザ光を用いるレーダであり、パルス状のレーザを発光し、障害物からの反射光や散乱光によって距離を測定する。レーザレーダの一例はLIDAR(Light Detection and Ranging、Laser Imaging Detection and Ranging)である。カメラは、車外の状況を撮像し、撮像した画像に対する画像認識処理により障害物との距離を測定する。画像認識処理には公知の技術が使用されればよいので、ここでは説明を省略する。超音波センサは、送波器により超音波を障害物に向け発信し、その反射波を受波器で受信することにより、障害物の有無や対象物までの距離を検出する。第1センサ10aと第2センサ10bとは測定結果を第1受付部30に出力する。   The first sensor 10a and the second sensor 10b are mounted on both side surfaces of the vehicle 100, and measure the distance from an obstacle outside the vehicle, for example, the other vehicle 110. As the sensor 10, a laser radar, a camera, an ultrasonic sensor, or the like is used. The laser radar is a radar that uses laser light, emits a pulsed laser, and measures a distance by reflected light or scattered light from an obstacle. An example of the laser radar is LIDAR (Light Detection and Ranging, Laser Imaging Detection and Ranging). The camera images the situation outside the vehicle and measures the distance from the obstacle by image recognition processing on the captured image. Since a known technique may be used for the image recognition processing, description thereof is omitted here. The ultrasonic sensor detects the presence or absence of an obstacle and the distance to the target object by transmitting an ultrasonic wave toward the obstacle with a transmitter and receiving the reflected wave with a receiver. The first sensor 10 a and the second sensor 10 b output measurement results to the first reception unit 30.

位置情報取得部12は、GNSS(Global Navigation Satellite System(s))受信機から車両100の現在位置を取得する。また、位置情報取得部12は、ステアリング角度、車輪速パルス等も使用して現在位置を取得してもよい。位置情報取得部12は、現在位置を位置情報として制御部40に出力する。   The position information acquisition unit 12 acquires the current position of the vehicle 100 from a GNSS (Global Navigation Satellite System (s)) receiver. Further, the position information acquisition unit 12 may acquire the current position using a steering angle, a wheel speed pulse, or the like. The position information acquisition unit 12 outputs the current position to the control unit 40 as position information.

第1受付部30は、第1センサ10a、第2センサ10bから測定結果を受けつけるとともに、制御部40を介して位置情報取得部12から位置情報を受けつける。第1受付部30は、測定結果と位置情報を対応付ける。図3は、第1受付部30における処理概要を示し、ここでは図1の一部を説明の対象にする。車両100の前方部分の左側方には第1センサ10aが搭載されており、右側方には第2センサ10bが搭載されている。第1センサ10aと第2センサ10bによる測定結果は障害物座標230と示される。また、位置情報取得部12による位置情報は車両原点130と示される。ここで、車両原点130に対応付けられる新たな障害物座標230は、P1、P2と示される。   The first reception unit 30 receives measurement results from the first sensor 10 a and the second sensor 10 b and also receives position information from the position information acquisition unit 12 via the control unit 40. The 1st reception part 30 matches a measurement result and position information. FIG. 3 shows an outline of processing in the first receiving unit 30, and here, a part of FIG. A first sensor 10a is mounted on the left side of the front portion of the vehicle 100, and a second sensor 10b is mounted on the right side. The measurement results by the first sensor 10a and the second sensor 10b are indicated as obstacle coordinates 230. The position information obtained by the position information acquisition unit 12 is indicated as a vehicle origin 130. Here, the new obstacle coordinates 230 associated with the vehicle origin 130 are indicated as P1 and P2.

車両100は、走行路220を走行方向120に進行するので、既に取得された障害物座標230も履歴として示される。新たな障害物座標230と、障害物座標230との履歴によって障害物座標230の集まりが形成される。第1センサ10aによって取得された障害物座標230の集まりによって、第5他車両110e、第6他車両110f、第7他車両110gの先頭部分の位置が示される。また、第2センサ10bによって取得された障害物座標230の集まりによって、第4他車両110d、第3他車両110cの先頭部分の位置が示される。図1に戻る。   Since the vehicle 100 travels along the traveling path 220 in the traveling direction 120, the already acquired obstacle coordinates 230 are also shown as a history. A collection of obstacle coordinates 230 is formed by the history of new obstacle coordinates 230 and obstacle coordinates 230. The positions of the leading portions of the fifth other vehicle 110e, the sixth other vehicle 110f, and the seventh other vehicle 110g are indicated by the collection of obstacle coordinates 230 acquired by the first sensor 10a. Further, the positions of the leading portions of the fourth other vehicle 110d and the third other vehicle 110c are indicated by the collection of obstacle coordinates 230 acquired by the second sensor 10b. Returning to FIG.

車両100が走行方向120を進行するとともに、車両原点130が更新され、新たな障害物座標230が追加される。ここでは、所定の間隔毎、例えば、10cm毎に車両原点130が更新され、新たな障害物座標230が追加されるものとする。このような所定間隔毎になされる処理の管理は、制御部40においてなされており、以下では、所定のポイント、例えば、最新の車両原点130に対する第1受付部30から記憶部36の処理を説明する。   As the vehicle 100 travels in the traveling direction 120, the vehicle origin 130 is updated and new obstacle coordinates 230 are added. Here, the vehicle origin 130 is updated every predetermined interval, for example, every 10 cm, and new obstacle coordinates 230 are added. Management of processing performed at such predetermined intervals is performed in the control unit 40, and in the following, processing of the storage unit 36 from the first reception unit 30 to a predetermined point, for example, the latest vehicle origin 130 will be described. To do.

マップ生成部32は、第1受付部30において対応付けた測定結果と位置情報をもとに、駐車場200の地図を生成する。図4は、マップ生成部32において生成した地図を示す。これは、図3において示された障害物座標230の集まりに相当する。図1に戻る。マップ生成部32は、生成した地図を転回可能領域検出部34に出力する。   The map generation unit 32 generates a map of the parking lot 200 based on the measurement result and position information associated with each other in the first reception unit 30. FIG. 4 shows a map generated by the map generation unit 32. This corresponds to the collection of obstacle coordinates 230 shown in FIG. Returning to FIG. The map generation unit 32 outputs the generated map to the turnable area detection unit 34.

検出部60は、マップ生成部32において生成された地図に示された障害物座標230をもとに、転回路222を検出する。ここでは、検出部60の処理を具体的に説明するために図5(a)−(b)を使用する。図5(a)−(b)は、検出部60における処理概要を示す。図5(a)は、地図上に設定される路判定範囲F240、路判定範囲R242、路判定範囲L244を示す。検出部60は、車両原点130を中心として、走行方向120に路判定範囲F240を設定する。路判定範囲F240は、走行方向120に垂直の方向において、車両100の車幅以上の長さを有する矩形状の範囲である。   The detection unit 60 detects the rolling circuit 222 based on the obstacle coordinates 230 shown in the map generated by the map generation unit 32. Here, FIGS. 5A to 5B are used to specifically describe the processing of the detection unit 60. 5A to 5B show an outline of processing in the detection unit 60. FIG. FIG. 5A shows a road determination range F240, a road determination range R242, and a road determination range L244 set on the map. The detection unit 60 sets a road determination range F240 in the traveling direction 120 around the vehicle origin 130. The road determination range F240 is a rectangular range having a length equal to or greater than the vehicle width of the vehicle 100 in a direction perpendicular to the traveling direction 120.

また、検出部60は、車両原点130に対して右側に路判定範囲R242を設定する。路判定範囲R242は、走行方向120において、車両100の車幅以上の長さを有する矩形状の範囲である。さらに、検出部60は、車両原点130に対して左側に路判定範囲L244を設定する。路判定範囲L244は、走行方向120において、車両100の車幅以上の長さを有する矩形状の範囲である。検出部60は、路判定範囲F240、路判定範囲R242、路判定範囲L244のそれぞれに障害物座標230が含まれるか否かを確認する。   Further, the detection unit 60 sets a road determination range R242 on the right side with respect to the vehicle origin 130. The road determination range R242 is a rectangular range having a length equal to or greater than the vehicle width of the vehicle 100 in the traveling direction 120. Furthermore, the detection unit 60 sets a road determination range L244 on the left side with respect to the vehicle origin 130. The road determination range L244 is a rectangular range having a length equal to or greater than the vehicle width of the vehicle 100 in the traveling direction 120. The detection unit 60 checks whether or not the obstacle coordinates 230 are included in each of the road determination range F240, the road determination range R242, and the road determination range L244.

図5(b)は、検出部60において記憶されるテーブルを示す。テーブルでは、路判定範囲F240、路判定範囲R242、路判定範囲L244のそれぞれに障害物が含まれるか否かの組合せと、各組合せに対応した交差点のパターンが示される。例えば、図5(a)では、路判定範囲F240と路判定範囲R242とに障害物が含まれず、路判定範囲L244に障害物が含まれるので、検出部60は交差点のパターンを「2」と判定する。これは、走行路220から右方向に延びる転回路222を検出したことに相当する。一方、路判定範囲L244に障害物が含まれない場合は、走行路220から左方向に延びる転回路222を検出したことに相当する。図1に戻る。検出部60は、検出した交差点のパターンを設定部62、分類部64に出力する。   FIG. 5B shows a table stored in the detection unit 60. In the table, combinations of whether or not an obstacle is included in each of the road determination range F240, the road determination range R242, and the road determination range L244, and the intersection pattern corresponding to each combination are shown. For example, in FIG. 5A, since the road determination range F240 and the road determination range R242 do not include an obstacle and the road determination range L244 includes an obstacle, the detection unit 60 sets the intersection pattern to “2”. judge. This corresponds to the detection of the rolling circuit 222 extending rightward from the travel path 220. On the other hand, when no obstacle is included in the road determination range L244, this corresponds to detection of the rolling circuit 222 extending leftward from the travel road 220. Returning to FIG. The detection unit 60 outputs the detected intersection pattern to the setting unit 62 and the classification unit 64.

分類部64は、検出部60において検出した交差点のパターンに対して、マップ生成部32において生成された地図をもとに、転回路222を分類する。図6(a)−(b)は、分類部64における処理概要を示す。ここでは、図5(a)と同様に、走行路220から右方向に転回路222が延びる場合を説明に使用する。図6(a)は、走行路220の幅員Wを導出するための計算処理を示す。分類部64は、走行路220の左側に並んだ複数の障害物座標230の横方向の平均値A1を計算する。また、分類部64は、走行路220の右側に並んだ複数の障害物座標230の横方向の平均値A2を計算する。さらに、分類部64は、平均値A1と平均値A2との違いを計算することによって幅員Wを導出する。図6(b)は、転回路222の幅員Lを導出するための計算処理を示す。検出部60は、転回路222を挟んで配置される2点の障害物座標230、具体的にはB1とB2とを取得する。分類部64は、B1とB2との違いを計算することによって幅員Lを導出する。図1に戻る。   The classification unit 64 classifies the transfer circuit 222 based on the map generated by the map generation unit 32 with respect to the intersection pattern detected by the detection unit 60. 6A to 6B show an outline of processing in the classification unit 64. FIG. Here, as in FIG. 5A, the case where the rolling circuit 222 extends rightward from the travel path 220 is used for description. FIG. 6A shows a calculation process for deriving the width W of the travel path 220. The classification unit 64 calculates an average value A1 in the horizontal direction of the plurality of obstacle coordinates 230 arranged on the left side of the traveling path 220. Further, the classification unit 64 calculates an average value A2 in the horizontal direction of the plurality of obstacle coordinates 230 arranged on the right side of the traveling path 220. Furthermore, the classification unit 64 derives the width W by calculating the difference between the average value A1 and the average value A2. FIG. 6B shows a calculation process for deriving the width L of the transfer circuit 222. The detection unit 60 acquires two obstacle coordinates 230, specifically B1 and B2, which are arranged with the rolling circuit 222 interposed therebetween. The classification unit 64 derives the width L by calculating the difference between B1 and B2. Returning to FIG.

分類部64は、走行路220の幅員Wと転回路222の幅員Lとを比較し、幅員W≧幅員Lである場合(以下、「状態履歴1」という)と、幅員W<幅員Lである場合(以下、「状態履歴2」という)とに分類する。これは、転回路222を走行路220より広いか否かで分類することに相当する。   The classification unit 64 compares the width W of the traveling path 220 with the width L of the rolling circuit 222. When the width W ≧ the width L (hereinafter referred to as “state history 1”), the width W <the width L. Into the case (hereinafter referred to as “state history 2”). This corresponds to classifying the turning circuit 222 based on whether or not it is wider than the travel path 220.

分類部64は、状態履歴1であるか、状態履歴2であるかに応じて車両100の転回のパターンを特定する。図7(a)−(b)は、分類部64における分類結果に応じた処理を示す。図7(a)は状態履歴1の場合の転回のパターンを示す。車両100は(i)走行方向120の逆方向に後退しながら後方から転回路222に進入する。続いて、車両100は、(ii)転回路222から走行路220に、走行方向120の逆方向に向かって前進し、(iii)走行方向120に向かって後退する。図7(b)は状態履歴2の場合の転回のパターンを示す。車両100は(i)走行方向120の逆方向に後退し、(ii)走行方向120の方向に前進しながら前方から転回路222に進入する。続いて、車両100は、(iii)転回路222から走行路220に、走行方向120に向かって後退する。図1に戻る。   The classification unit 64 specifies the turning pattern of the vehicle 100 depending on whether the state history 1 or the state history 2 is set. 7A to 7B show processing according to the classification result in the classification unit 64. FIG. FIG. 7A shows a turn pattern in the case of the state history 1. The vehicle 100 (i) enters the rolling circuit 222 from behind while moving backward in the direction opposite to the traveling direction 120. Subsequently, the vehicle 100 (ii) moves forward from the rolling circuit 222 to the traveling path 220 in the direction opposite to the traveling direction 120 and (iii) moves backward in the traveling direction 120. FIG. 7B shows a turn pattern in the case of the state history 2. The vehicle 100 (i) moves backward in the direction opposite to the traveling direction 120 and (ii) enters the rolling circuit 222 from the front while moving forward in the direction of the traveling direction 120. Subsequently, the vehicle 100 (iii) moves backward from the rolling circuit 222 to the traveling path 220 in the traveling direction 120. Returning to FIG.

設定部62は、検出部60において転回路222が検出された場合に、当該転回路222が転回可能領域であるか否かを判定するために、マップ生成部32において生成した地図上の障害物座標230と比較するための境界曲線を設定する。ここでは、境界曲線を説明するために、図8(a)−(b)を使用する。図8(a)−(b)は、設定部62における処理概要を示す。ここでも、図5(a)と同様に、走行路220から右方向に転回路222が延びる場合を説明に使用する。設定部62は、車両100の走行方向120に向かって転回路222の前側に配置される第1境界曲線270aと、車両100の走行方向120に向かって転回路222の後側に配置される第2境界曲線270bとを設定する。ここで、第2境界曲線270bは、転回路222を挟みながら第1境界曲線270aに対向する。   The setting unit 62, when the detecting circuit 60 detects the turning circuit 222, determines whether the turning circuit 222 is a turnable region or not on the map generated by the map generating unit 32. A boundary curve for comparison with the coordinates 230 is set. Here, FIGS. 8A to 8B are used to describe the boundary curve. FIGS. 8A and 8B show an outline of processing in the setting unit 62. FIG. Here, as in FIG. 5A, the case where the rolling circuit 222 extends from the travel path 220 in the right direction is used for the description. The setting unit 62 includes a first boundary curve 270 a disposed on the front side of the rolling circuit 222 toward the traveling direction 120 of the vehicle 100 and a first boundary curve 270 a disposed on the rear side of the rolling circuit 222 toward the traveling direction 120 of the vehicle 100. A two-boundary curve 270b is set. Here, the second boundary curve 270b faces the first boundary curve 270a with the transfer circuit 222 interposed therebetween.

第1境界曲線270a、第2境界曲線270bは、境界曲線270と総称され、境界曲線270には、走行路220と転回路222の間で車両100が転回する場合に車両100の内側が通過する円弧状の軌跡が含まれる。なお、転回路222に対して、第1境界曲線270aと第2境界曲線270bが配置される位置は、検出部60において検出された交差点のパターンに応じて変えられる。交差点のパターンが「1」である場合、4つの境界曲線270が車両原点130の周囲に配置される。   The first boundary curve 270a and the second boundary curve 270b are collectively referred to as the boundary curve 270, and the inside of the vehicle 100 passes through the boundary curve 270 when the vehicle 100 turns between the traveling road 220 and the rolling circuit 222. An arc-shaped trajectory is included. Note that the positions at which the first boundary curve 270a and the second boundary curve 270b are arranged with respect to the transfer circuit 222 are changed according to the intersection pattern detected by the detection unit 60. When the intersection pattern is “1”, four boundary curves 270 are arranged around the vehicle origin 130.

第1境界曲線270aに含まれる円弧状の軌跡は第1軌跡円弧中心266aを中心とし、第2境界曲線270bに含まれる円弧状の軌跡は第2軌跡円弧中心266bを中心とする。ここでは、第1軌跡円弧中心266a、第2軌跡円弧中心266bの設定を説明する。設定部62は、車両100の車両原点130から、走行路220の幅方向に沿って転回路222とは逆側の縁部に移動した第1中間点246を導出する。次に、設定部62は、第1中間点246から、走行路220の幅方向に沿って転回路222の方へ第1距離進んだ第2中間点248を導出する。さらに、設定部62は、第2中間点248から走行方向120に向かって第2距離進んだ点に第1軌跡円弧中心266aを設定する。また、設定部62は、第2中間点248から走行方向120とは反対方向に向かって第2距離進んだ点に第2軌跡円弧中心266bを設定する。   The arc-shaped trajectory included in the first boundary curve 270a is centered on the first trajectory arc center 266a, and the arc-shaped trajectory included in the second boundary curve 270b is centered on the second trajectory arc center 266b. Here, the setting of the first locus arc center 266a and the second locus arc center 266b will be described. The setting unit 62 derives a first intermediate point 246 that has moved from the vehicle origin 130 of the vehicle 100 to the edge on the opposite side of the rolling circuit 222 along the width direction of the travel path 220. Next, the setting unit 62 derives from the first intermediate point 246 a second intermediate point 248 that has traveled a first distance toward the rolling circuit 222 along the width direction of the travel path 220. Furthermore, the setting unit 62 sets the first trajectory arc center 266a at a point advanced by a second distance from the second intermediate point 248 toward the traveling direction 120. In addition, the setting unit 62 sets the second locus arc center 266 b at a point advanced from the second intermediate point 248 by a second distance in the direction opposite to the traveling direction 120.

ここで、第1距離は、車両100の最小回転半径250以上となるように、具体的には、最小回転半径250と外マージン252との和になるように設定される。また、第2距離は、車両100が転回する場合に車両100の内側が通過する円弧の直径と車両100のトレッド260との和を2で除算した値以上となるように第2距離を設定する。車両100の内側が通過する円弧の直径は、2倍の軌跡円弧半径264に相当する。そのため、第2距離は、トレッド260の1/2と内マージン262と軌跡円弧半径264との和と示される。   Here, the first distance is set to be equal to or greater than the minimum turning radius 250 of the vehicle 100, specifically, the sum of the minimum turning radius 250 and the outer margin 252. Further, the second distance is set so that the second distance is equal to or larger than a value obtained by dividing the sum of the diameter of the arc passing through the inside of the vehicle 100 and the tread 260 of the vehicle 100 by 2 when the vehicle 100 turns. . The diameter of the arc through which the inside of the vehicle 100 passes corresponds to a double trajectory arc radius 264. Therefore, the second distance is indicated as the sum of 1/2 of the tread 260, the inner margin 262, and the locus arc radius 264.

図8(b)は、外マージン252、内マージン262、横マージン282を説明するための図である。内マージン262は、「(車両100の車幅−トレッド260)/2」よりも大きくされる。ここで、車両100の車幅にはサイドミラーが含まれない。横マージン282は、「(ミラーの飛び出しを含む車両100の最大幅−トレッド260)/2」よりも大きくされる。外マージン252は、「旋回の中心点から最も遠い車体の点と中心点との距離−最小回転半径250」よりも大きくされる。ここで、最小回転半径250を「R」、ホイルベース280を「B」、トレッド260を「T」、内マージン262を「m」と示す場合、軌跡円弧半径264である「r」は次のように示される。
r=√(R−B)−T−m
FIG. 8B is a diagram for explaining the outer margin 252, the inner margin 262, and the horizontal margin 282. The inner margin 262 is made larger than “(vehicle width of the vehicle 100−tread 260) / 2”. Here, the vehicle width of the vehicle 100 does not include a side mirror. The lateral margin 282 is made larger than “(maximum width of the vehicle 100 including the protrusion of the mirror−tread 260) / 2”. The outer margin 252 is set larger than “distance between the point of the vehicle body farthest from the turning center point and the center point—the minimum turning radius 250”. Here, when the minimum turning radius 250 is “R”, the wheel base 280 is “B”, the tread 260 is “T”, and the inner margin 262 is “m”, the locus arc radius 264 “r” is as follows: Shown in
r = √ (R 2 −B 2 ) −T−m

状態履歴2である場合、つまり幅員W<幅員Lである場合、設定部62は、次のように境界曲線270を設定してもよい。その際、設定部62は、図9(a)のような境界曲線270を設定する。図9(a)−(b)は、設定部62における処理概要を示す。図9(a)は、図8(a)と同様に示されるが、境界曲線270には、車両100が転回する場合に車両100の外側が通過する円弧状の軌跡も考慮される。そのため、境界曲線270は、車両100の内側が通過する円弧状の軌跡の一部が、車両100の外側が通過する円弧状の軌跡に置き換えられた形状を有する。つまり、2種類の円弧状況の軌跡が連結されることによって境界曲線270が形成される。   When the state history is 2, that is, when the width W <the width L, the setting unit 62 may set the boundary curve 270 as follows. At that time, the setting unit 62 sets a boundary curve 270 as shown in FIG. FIGS. 9A and 9B show an outline of processing in the setting unit 62. FIG. FIG. 9A is shown in the same manner as FIG. 8A, but the boundary curve 270 also considers an arcuate trajectory through which the outside of the vehicle 100 passes when the vehicle 100 turns. Therefore, the boundary curve 270 has a shape in which a part of the arc-shaped trajectory through which the inside of the vehicle 100 passes is replaced with an arc-shaped trajectory through which the outside of the vehicle 100 passes. In other words, the boundary curve 270 is formed by connecting two types of circular arc trajectories.

図9(b)は、境界曲線270を形成する2種類の円弧状の軌跡の関係を示す。境界曲線270の一部は、前述のごとく、軌跡円弧中心266から軌跡円弧半径264を有する円弧状の軌跡である。また、境界曲線270の残りは、最小回転半径250を有する円弧状の軌跡である。図1に戻る。   FIG. 9B shows the relationship between two types of arc-shaped trajectories that form the boundary curve 270. A part of the boundary curve 270 is an arc-shaped locus having a locus arc radius 264 from the locus arc center 266 as described above. The remainder of the boundary curve 270 is an arcuate locus having a minimum turning radius 250. Returning to FIG.

判定部66は、検出部60において検出した交差点のタイプに応じて、マップ生成部32において生成した地図上の障害物座標230から、転回路222側の障害物座標230を選択する。これは、図8(a)において、第1軌跡円弧中心266aと第2軌跡円弧中心266bとが配置された側の障害物座標230を選択することに相当する。判定部66は、選択した障害物座標230と、設定部62において設定した境界曲線270とを比較する。判定部66は、障害物座標230が境界曲線270よりも車両100側に存在しない場合、転回路222における車両100の転回が可能であると判定する。一方、判定部66は、障害物座標230が境界曲線270よりも車両100側に存在する場合、転回路222における車両100の転回が不可能であると判定する。   The determination unit 66 selects the obstacle coordinates 230 on the transfer circuit 222 side from the obstacle coordinates 230 on the map generated by the map generation unit 32 according to the type of intersection detected by the detection unit 60. This corresponds to selecting the obstacle coordinates 230 on the side where the first locus arc center 266a and the second locus arc center 266b are arranged in FIG. 8A. The determination unit 66 compares the selected obstacle coordinates 230 with the boundary curve 270 set in the setting unit 62. The determination unit 66 determines that the turning of the vehicle 100 in the turning circuit 222 is possible when the obstacle coordinates 230 do not exist on the vehicle 100 side with respect to the boundary curve 270. On the other hand, when the obstacle coordinates 230 are present on the vehicle 100 side with respect to the boundary curve 270, the determination unit 66 determines that the turning of the vehicle 100 in the turning circuit 222 is impossible.

図8(a)においては、障害物座標230が第1境界曲線270aよりも車両原点130側に存在しない場合であり、かつ第2境界曲線270bよりも車両原点130側に存在しない場合、転回路222における車両100の転回が可能であると判定される。これは、第1境界曲線270aと第2境界曲線270bをそれぞれ形成する円弧状の軌跡を含む円の外に障害物座標230が存在しない場合であるといえる。   In FIG. 8A, when the obstacle coordinate 230 does not exist on the vehicle origin 130 side with respect to the first boundary curve 270a and does not exist on the vehicle origin 130 side with respect to the second boundary curve 270b, It is determined that the vehicle 100 can be turned at 222. This can be said to be a case where the obstacle coordinates 230 do not exist outside a circle including arc-shaped trajectories that respectively form the first boundary curve 270a and the second boundary curve 270b.

この処理のために、例えば、図8(a)において、第1境界曲線270aと第2境界曲線270bをそれぞれ形成する円弧状の軌跡を含む円の内側が白色に着色され、円弧状の軌跡を含む円の外側が黒色に着色される。また、白色の地図上に、選択された障害物座標230だけが黒色に着色される。判定部66は、これらを重ね合せ、黒色と黒色とが重なった場合だけ黒色になり、残りの組合せで白色になる演算、つまり論理積演算を実行する。判定部66は、論理積演算の結果、すべて白色になる場合、転回路222における車両100の転回が可能であると判定する。一方、判定部66は、黒色が含まれる場合、転回路222における車両100の転回が不可能であると判定する。   For this process, for example, in FIG. 8A, the inside of a circle including the arc-shaped trajectory forming the first boundary curve 270a and the second boundary curve 270b is colored white, and the arc-shaped trajectory is The outside of the containing circle is colored black. Further, only the selected obstacle coordinates 230 are colored black on the white map. The determination unit 66 superimposes these, and performs an operation that turns black only when black and black overlap each other and turns white when the remaining combination is performed, that is, a logical product operation. If the result of the AND operation is all white, the determination unit 66 determines that the turning of the vehicle 100 in the turn circuit 222 is possible. On the other hand, when black is included, determination unit 66 determines that turning of vehicle 100 in turn circuit 222 is impossible.

判定部66は、所定間隔毎に、車両原点130の座標、車両100の転回が可能である転回路222かの情報を対応付けて記憶部36に記憶させる。ここで、車両100の転回が可能である転回路222かの情報は、車両100の転回が可能である転回路222でない場合、「状態履歴0」とされる。一方、車両100の転回が可能である転回路222である場合、分類部64において分類された「状態履歴1」あるいは「状態履歴2」であるとされる。さらに、「状態履歴1」あるいは「状態履歴2」である場合、検出部60において検出された交差点のタイプも対応付けて記憶される。これらの処理は、前述のごとく、車両100が走行方向120に走行する場合、制御部40の制御によって所定間隔毎に繰り返し実行される。   The determination unit 66 causes the storage unit 36 to store the coordinates of the vehicle origin 130 and information about the turning circuit 222 that can turn the vehicle 100 at predetermined intervals. Here, the information on the turning circuit 222 that can turn the vehicle 100 is “state history 0” when the turning circuit 222 is not capable of turning the vehicle 100. On the other hand, when the rolling circuit 222 is capable of turning the vehicle 100, the “state history 1” or “state history 2” classified by the classification unit 64 is assumed. Further, in the case of “state history 1” or “state history 2”, the type of intersection detected by the detection unit 60 is also stored in association with each other. As described above, these processes are repeatedly executed at predetermined intervals under the control of the control unit 40 when the vehicle 100 travels in the traveling direction 120.

シフトECU14は、車両100のシフト制御を実行する。シフトECU14については公知の技術が使用されればよいが、ここでは、前進あるいは後退のみを説明の対象にする。図1において、車両100の乗員が空きの第9駐車領域210iを見つけるまで車両100は前進する。その際、シフトECU14は車両100のシフト制御として前進を選択する。一方、車両100の乗員が空きの第9駐車領域210iを見つけた後、車両100は後退する。その際、シフトECU14は車両100のシフト制御として後退を選択する。シフトECU14は、選択している前進あるいは後退に関する情報(以下、「シフト情報」という)を第2受付部50に出力する。   Shift ECU 14 performs shift control of vehicle 100. A known technique may be used for the shift ECU 14, but here, only forward or backward movement will be described. In FIG. 1, the vehicle 100 moves forward until an occupant of the vehicle 100 finds an empty ninth parking area 210i. At that time, the shift ECU 14 selects forward as the shift control of the vehicle 100. On the other hand, after the occupant of the vehicle 100 finds an empty ninth parking area 210i, the vehicle 100 moves backward. At that time, the shift ECU 14 selects reverse as the shift control of the vehicle 100. The shift ECU 14 outputs information relating to the selected forward or backward movement (hereinafter referred to as “shift information”) to the second reception unit 50.

第2受付部50は、シフトECU14からシフト情報を受けつける。シフト情報が前進から後退に切りかわった場合、つまり図1において車両100の乗員が空きの第9駐車領域210iを見つけて前進から後退に切りかえた場合、第2受付部50は、転回可能な転回路222の掲示を処理部52に指示する。   The second reception unit 50 receives shift information from the shift ECU 14. When the shift information is switched from forward to backward, that is, when the occupant of the vehicle 100 finds an empty ninth parking area 210i and switches from forward to backward in FIG. The processing unit 52 is instructed to post the path 222.

処理部52は、第2受付部50からの指示を受けつけると、制御部40を介して、記憶部36の記憶内容を確認する。前述のごとく、記憶部36における記憶内容は所定間隔毎に追加されている。処理部52は、記憶部36に記憶された記憶内容における「状態履歴」を新しい方から順に検索する。ここでは、「状態履歴1」あるいは「状態履歴2」を見つけるまで、検索が続けられる。「状態履歴1」あるいは「状態履歴2」を見つけた場合、処理部52は、それに対応した車両原点130の座標、交差点のタイプを記憶部36から取得する。処理部52は、ナビゲーションシステムで使用している地図画像、例えば俯瞰画像上における車両原点130の座標に、転回可能な転回路222が存在することを示すアイコンを重畳した画像を生成する。なお、転回可能な転回路222が存在することは、アイコン以外の表示によって示されてもよい。処理部52は、生成した画像を報知装置22に表示させる。   When the processing unit 52 receives an instruction from the second reception unit 50, the processing unit 52 confirms the storage contents of the storage unit 36 via the control unit 40. As described above, the contents stored in the storage unit 36 are added at predetermined intervals. The processing unit 52 searches the “state history” in the stored contents stored in the storage unit 36 in order from the newest one. Here, the search is continued until “status history 1” or “status history 2” is found. When the “state history 1” or “state history 2” is found, the processing unit 52 acquires the coordinates of the vehicle origin 130 and the type of the intersection corresponding thereto from the storage unit 36. The processing unit 52 generates an image in which an icon indicating that the turning circuit 222 that can be turned exists is superimposed on the coordinates of the vehicle origin 130 on the map image used in the navigation system, for example, the overhead view image. The presence of the turn circuit 222 that can be turned may be indicated by a display other than an icon. The processing unit 52 causes the notification device 22 to display the generated image.

報知装置22は、車両100の走行あるいは駐車に関する情報を乗員に報知する。報知装置2は、例えば、車内に設置されているカーナビゲーションシステム、ヘッドアップディスプレイ、センターディスプレイである。報知装置22は、処理部52から出力された画像を表示することによって、転回可能な転回路222が存在することを乗員に掲示する。   The notification device 22 notifies the occupant of information related to traveling or parking of the vehicle 100. The notification device 2 is, for example, a car navigation system, a head-up display, or a center display installed in the vehicle. The notification device 22 displays to the occupant that there is a turn circuit 222 that can be turned by displaying the image output from the processing unit 52.

以上の構成による駐車支援装置20の動作を説明する。図10は、駐車支援装置20による保存手順を示すフローチャートである。制御部40は履歴カウンタを初期化する(S10)。センサ10は左右の障害物を測距し(S12)、障害物の座標を保存させる(S14)。転回領域がなければ(S16のN)、記憶部36は、状態履歴に0を保存する(S18)。一方、転回領域があり(S16のY)、幅員W≧幅員Lであれば(S20のY)、記憶部36は、状態履歴に1を保存する(S22)。幅員W≧幅員Lでなければ(S20のN)、記憶部36は、状態履歴に2を保存する(S24)。記憶部36は座標履歴に自己位置を保存し、制御部40は履歴カウンタを1加算する(S26)。ギアがRでなく(S28のN)、所定距離前進しなければ(S30のN)、ステップ28に戻る。所定距離前進すれば(S30のY)、ステップ12に戻る。ギアがRであれば(S28のY)、図11に進む。   Operation | movement of the parking assistance apparatus 20 by the above structure is demonstrated. FIG. 10 is a flowchart showing a storage procedure by the parking assistance device 20. The control unit 40 initializes the history counter (S10). The sensor 10 measures the distance between the left and right obstacles (S12), and stores the coordinates of the obstacles (S14). If there is no turning area (N in S16), the storage unit 36 stores 0 in the state history (S18). On the other hand, if there is a turning area (Y in S16) and the width W ≧ the width L (Y in S20), the storage unit 36 stores 1 in the state history (S22). If the width W is not greater than the width L (N in S20), the storage unit 36 stores 2 in the state history (S24). The storage unit 36 stores its own position in the coordinate history, and the control unit 40 adds 1 to the history counter (S26). If the gear is not R (N in S28) and does not advance a predetermined distance (N in S30), the process returns to step 28. If the vehicle has advanced a predetermined distance (Y in S30), the process returns to step 12. If the gear is R (Y in S28), the process proceeds to FIG.

図11は、駐車支援装置20による掲示手順を示すフローチャートであり、図10からの続きである。制御部40は履歴カウンタを1減算する(S50)。状態履歴が0であれば(S52のN)、ステップ50に戻る。状態履歴が0でなければ(S52のY)、処理部52は、掲示座標を読み出し(S54)、ナビゲーション掲示を実行する(S56)。自己位置と掲示座標との距離が5m以内でなく(S58のN)、所定距離後退しなければ(S60のN)、待機する。所定距離後退すれば(S60のY)、ステップ56に戻る。自己位置と掲示座標との距離が5m以内であれば(S58のY)、処理は終了される。   FIG. 11 is a flowchart showing a posting procedure by the parking assistance device 20 and is a continuation from FIG. The controller 40 decrements the history counter by 1 (S50). If the state history is 0 (N in S52), the process returns to step 50. If the status history is not 0 (Y in S52), the processing unit 52 reads the posted coordinates (S54) and executes navigation posting (S56). If the distance between the self-position and the posted coordinates is not within 5 m (N in S58) and does not move backward by a predetermined distance (N in S60), the process waits. If the vehicle has moved back a predetermined distance (Y in S60), the process returns to step 56. If the distance between the self position and the posted coordinates is within 5 m (Y in S58), the process is terminated.

本実施の形態によれば、走行路と転回路の間で車両が転回する場合に車両の内側が通過する円弧状の軌跡が含まれた境界曲線をもとに、転回路における車両の転回が可能であるか否かを判定するので、境界曲線で囲まれる領域を小さくできる。また、境界曲線で囲まれる領域が小さくなるので、狭くても、転回路における車両の転回が可能であるか否かを判定できる。また、狭くても、転回路における車両の転回が可能であるか否かが判定されるので、転回可能領域の検出精度を向上できる。また、転回路を挟みながら第1境界曲線と第2境界曲線とを設定するので、実際の転回の状況に適合した設定を実行できる。また、車両の最小回転半径、車両が転回する場合に車両の内側が通過する円弧の直径、車両のトレッドをもとに、第1境界曲線および第2境界曲線の中心を設定するので、転回可能かの判定に適した第1境界曲線および第2境界曲線を設定できる。また、幅員に応じて転回路を分類するので、幅員に応じた処理を実行できる。   According to the present embodiment, when the vehicle turns between the traveling road and the turning circuit, the turning of the vehicle in the turning circuit is based on the boundary curve including the arc-shaped locus through which the inside of the vehicle passes. Since it is determined whether or not it is possible, the area surrounded by the boundary curve can be reduced. In addition, since the area surrounded by the boundary curve becomes small, it can be determined whether or not the vehicle can be turned in the turn circuit even if it is narrow. Even if it is narrow, since it is determined whether or not the vehicle can be turned in the turning circuit, the detection accuracy of the turnable region can be improved. In addition, since the first boundary curve and the second boundary curve are set while sandwiching the turning circuit, the setting suitable for the actual turning situation can be executed. In addition, the center of the first boundary curve and the second boundary curve is set based on the minimum turning radius of the vehicle, the diameter of the arc that the inside of the vehicle passes when the vehicle turns, and the tread of the vehicle, so that the turning is possible. A first boundary curve and a second boundary curve suitable for such determination can be set. Moreover, since the circuit is classified according to the width, processing according to the width can be executed.

以上、本発明に係る実施の形態について図面を参照して詳述してきたが、上述した装置や各処理部の機能は、コンピュータプログラムにより実現されうる。上述した機能をプログラムにより実現するコンピュータは、ボタンやジョイスティック、ジョグダイヤル、タッチパッドなどの入力装置、ディスプレイやスピーカなどの出力装置、CPU(Central Processing Unit)、ROM、RAM、ハードディスク装置やSSD(Solid State Drive)などの記憶装置、DVD−ROM(Digital Versatile Disk Read Only Memory)やUSBメモリなどの記録媒体から情報を読み取る読取装置、ネットワークを介して通信を行うネットワークカードなどを備え、各部はバスにより接続される。   As mentioned above, although embodiment concerning this invention has been explained in full detail with reference to drawings, the function of the apparatus mentioned above and each processing part may be realized by a computer program. A computer that realizes the above-described functions by a program includes an input device such as a button, a joystick, a jog dial, and a touch pad, an output device such as a display and a speaker, a CPU (Central Processing Unit), a ROM, a RAM, a hard disk device, and an SSD (Solid State). Drive) and other storage devices, DVD-ROM (Digital Versatile Disk Read Only Memory), a reader that reads information from a recording medium such as a USB memory, and a network card that communicates via a network. Is done.

また、読取装置は、上記プログラムを記録した記録媒体からそのプログラムを読み取り、記憶装置に記憶させる。あるいは、ネットワークカードが、ネットワークに接続されたサーバ装置と通信を行い、サーバ装置からダウンロードした上記各装置の機能を実現するためのプログラムを記憶装置に記憶させる。また、CPUが、記憶装置に記憶されたプログラムをRAMにコピーし、そのプログラムに含まれる命令をRAMから順次読み出して実行することにより、上記各装置の機能が実現される。また、障害物として、他のロードユーザを含めてもよい。例えば、バイク(二輪車)と自転車(に人が乗っている)は他車両扱いで、自転車を押す人やスケートボードに乗る人は歩行者扱いとしてもよい。   The reading device reads the program from the recording medium on which the program is recorded, and stores the program in the storage device. Or a network card communicates with the server apparatus connected to the network, and memorize | stores the program for implement | achieving the function of said each apparatus downloaded from the server apparatus in a memory | storage device. Further, the function of each device is realized by the CPU copying the program stored in the storage device to the RAM and sequentially reading out and executing the instructions included in the program from the RAM. Moreover, you may include other road users as an obstruction. For example, a motorcycle (two-wheeled vehicle) and a bicycle (with a person on them) may be treated as other vehicles, and a person pushing a bicycle or riding a skateboard may be treated as a pedestrian.

本発明の一態様の概要は、次の通りである。本発明のある態様の転回可能領域検出装置は、走行路に沿って走行する車両の周囲に存在する障害物の情報をもとに、走行路とは異なった方向に走行路から延びる転回路を検出する検出部と、走行路と検出部により検出された転回路との間で車両が転回する場合に車両の内側が通過する円弧状の軌跡が含まれた境界曲線を設定する設定部と、走行路における転回路側の障害物が、設定部において設定した境界曲線よりも車両側に非存在である場合、転回路における車両の転回が可能であると判定する判定部と、を備える。   The outline of one embodiment of the present invention is as follows. A turnable area detecting device according to an aspect of the present invention includes a rolling circuit extending from a traveling path in a direction different from the traveling path based on information on obstacles around the vehicle traveling along the traveling path. A detection unit for detecting, and a setting unit for setting a boundary curve including an arcuate trajectory through which the inside of the vehicle passes when the vehicle turns between the traveling path and the turning circuit detected by the detection unit; And a determination unit that determines that the vehicle can turn on the turn circuit when the obstacle on the turn circuit side on the travel path is not present on the vehicle side with respect to the boundary curve set in the setting unit.

この態様によると、走行路と転回路の間で車両が転回する場合に車両の内側が通過する円弧状の軌跡が含まれた境界曲線をもとに、転回路における車両の転回が可能であるか否かを判定するので、転回可能領域の検出精度を向上できる。   According to this aspect, when the vehicle turns between the traveling road and the turning circuit, the turning of the vehicle in the turning circuit is possible based on the boundary curve including the arc-shaped locus through which the inside of the vehicle passes. Therefore, the detection accuracy of the turnable region can be improved.

設定部は、境界曲線として、車両の走行方向に向かって転回路の前側に配置される第1境界曲線と、車両の走行方向に向かって転回路の後側に、転回路を挟みながら第1境界曲線に対向して配置される第2境界曲線とを設定し、判定部は、走行路における転回路側の障害物が、設定部において設定した第1境界曲線よりも車両側に非存在であり、かつ設定部において設定した第2境界曲線よりも車両側に非存在である場合、転回路における車両の転回が可能であると判定する。この場合、転回路を挟みながら第1境界曲線と第2境界曲線とを設定するので、実際の転回の状況に適合した設定を実行できる。   The setting unit includes, as a boundary curve, a first boundary curve arranged on the front side of the rolling circuit toward the traveling direction of the vehicle, and a first while sandwiching the rolling circuit on the rear side of the rolling circuit toward the traveling direction of the vehicle. The second boundary curve arranged opposite to the boundary curve is set, and the determination unit is configured such that the obstacle on the transfer circuit side in the traveling road is not present on the vehicle side than the first boundary curve set in the setting unit. And when it does not exist in the vehicle side rather than the 2nd boundary curve set in the setting part, it determines with the turning of the vehicle in a turning circuit being possible. In this case, since the first boundary curve and the second boundary curve are set while sandwiching the turning circuit, setting suitable for the actual turning situation can be executed.

設定部は、車両の位置から、走行路の幅方向に沿って転回路とは逆側の縁部に移動した第1中間点から、走行路の幅方向に沿って転回路へ第1距離進んだ第2中間点を導出し、第2中間点から車両の走行方向に向かって第2距離進んだ点に第1境界曲線における円弧状の軌跡の中心を設定し、第2中間点から車両の走行方向とは反対方向に向かって第2距離進んだ点に第2境界曲線における円弧状の軌跡の中心を設定し、設定部は、車両の最小回転半径以上となるように第1距離を設定し、車両が転回する場合に車両の内側が通過する円弧の直径と車両のトレッドとの和を2で除算した値以上となるように第2距離を設定する。この場合、車両の最小回転半径、車両が転回する場合に車両の内側が通過する円弧の直径、車両のトレッドをもとに、第1境界曲線および第2境界曲線の中心を設定するので、転回可能かの判定に適した第1境界曲線および第2境界曲線を設定できる。   The setting unit travels a first distance from the vehicle position to the turning circuit along the width direction of the traveling road from the first intermediate point moved to the edge opposite to the rolling circuit along the width direction of the traveling road. The second intermediate point is derived, and the center of the arc-shaped trajectory in the first boundary curve is set at a point advanced by a second distance from the second intermediate point in the vehicle traveling direction. The center of the arc-shaped locus in the second boundary curve is set at a point advanced by a second distance in the direction opposite to the traveling direction, and the setting unit sets the first distance so as to be equal to or greater than the minimum turning radius of the vehicle. Then, when the vehicle turns, the second distance is set to be equal to or larger than a value obtained by dividing the sum of the diameter of the arc passing through the inside of the vehicle and the tread of the vehicle by 2. In this case, the center of the first boundary curve and the second boundary curve is set based on the minimum turning radius of the vehicle, the diameter of the arc that the inside of the vehicle passes when the vehicle turns, and the tread of the vehicle. It is possible to set the first boundary curve and the second boundary curve suitable for determining whether or not they are possible.

走行路の幅員と転回路の幅員とを比較し、比較結果に応じて転回路を分類する分類部をさらに備える。この場合、幅員に応じて転回路を分類するので、幅員に応じた処理を実行できる。   A classifying unit that compares the width of the traveling path with the width of the transfer circuit and classifies the transfer circuit according to the comparison result is further provided. In this case, since the transfer circuits are classified according to the width, processing according to the width can be executed.

本発明の別の態様は、転回可能領域検出方法である。この方法は、走行路に沿って走行する車両の周囲に存在する障害物の情報をもとに、走行路とは異なった方向に走行路から延びる転回路を検出するステップと、走行路と検出された転回路との間で車両が転回する場合に車両の内側が通過する円弧状の軌跡が含まれた境界曲線を設定するステップと、走行路における転回路側の障害物が、設定した境界曲線よりも車両側に非存在である場合、転回路における車両の転回が可能であると判定するステップと、を備える。   Another aspect of the present invention is a method for detecting a turnable region. The method includes a step of detecting a rolling circuit extending from the travel path in a direction different from the travel path based on information on an obstacle existing around the vehicle traveling along the travel path, and the detection of the travel path. The step of setting a boundary curve including an arc-shaped trajectory through which the inside of the vehicle passes when the vehicle turns with the turned turning circuit, and the obstacle on the turning circuit side in the traveling path Determining that the vehicle can be turned in the turn circuit when the vehicle is not present on the vehicle side.

以上、本発明を実施の形態をもとに説明した。これらの実施の形態は例示であり、それらの各構成要素や各処理プロセスの組合せにいろいろな変形例が可能なこと、またそうした変形例も本発明の範囲にあることは当業者に理解されるところである。   The present invention has been described based on the embodiments. It is understood by those skilled in the art that these embodiments are exemplifications, and that various modifications can be made to combinations of the respective constituent elements and processing processes, and such modifications are also within the scope of the present invention. By the way.

本実施の形態における判定部66は、境界曲線270よりも車両100側に障害物座標230が存在するか否かに応じて、転回路222における車両100の転回が可能であるか否かを判定する。しかしながらこれに限らず例えば、判定部66は、障害物座標230の配置から障害物の角あるいは特徴点を推定し、境界曲線270よりも車両100側に障害物の角あるいは特徴点が存在するか否かに応じて、転回路222における車両100の転回が可能であるか否かを判定してもよい。本変形例によれば、構成の自由度を向上できる。   The determination unit 66 according to the present embodiment determines whether or not the vehicle 100 can be turned in the turning circuit 222 according to whether or not the obstacle coordinate 230 exists on the vehicle 100 side with respect to the boundary curve 270. To do. However, the present invention is not limited to this. For example, the determination unit 66 estimates the corner or feature point of the obstacle from the arrangement of the obstacle coordinates 230, and whether the corner or feature point of the obstacle exists on the vehicle 100 side from the boundary curve 270. Depending on whether or not, it is possible to determine whether or not the turning of the vehicle 100 in the turning circuit 222 is possible. According to this modification, the degree of freedom of configuration can be improved.

本実施の形態において車両100は、乗員の操作によって運転、駐車がなされている。しかしながらこれに限らず例えば、車両100は、自動運転制御、自動駐車制御を実行してもよい。この場合、空きの駐車領域210が検出された場合に、車両100の後退が開始される。その際、車両100が転回可能であると判定された転回路222までの走行経路に沿って車両100が後退する。本実施例によれば、適用範囲を拡大できる。   In the present embodiment, vehicle 100 is driven and parked by an occupant's operation. However, the present invention is not limited to this. For example, the vehicle 100 may execute automatic driving control and automatic parking control. In this case, when an empty parking area 210 is detected, the vehicle 100 starts to move backward. At that time, the vehicle 100 moves backward along the travel route to the rolling circuit 222 that is determined that the vehicle 100 can turn. According to the present embodiment, the applicable range can be expanded.

本発明によれば、転回可能領域の検出精度を向上できる。   According to the present invention, the detection accuracy of the turnable region can be improved.

10 センサ、 12 位置情報取得部、 14 シフトECU、 20 駐車支援装置、 22 報知装置、 30 第1受付部、 32 マップ生成部、 34 転回可能領域検出部、 36 記憶部、 40 制御部、 50 第2受付部、 52 処理部、 60 検出部、 62 設定部、 64 分類部、 66 判定部、 100 車両。   DESCRIPTION OF SYMBOLS 10 sensor, 12 position information acquisition part, 14 shift ECU, 20 parking assistance apparatus, 22 alerting | reporting apparatus, 30 1st reception part, 32 map production | generation part, 34 turnable area | region detection part, 36 memory | storage part, 40 control part, 50th 2 reception units, 52 processing units, 60 detection units, 62 setting units, 64 classification units, 66 determination units, 100 vehicles.

Claims (6)

走行路に沿って走行する車両の周囲に存在する障害物の情報をもとに、前記走行路とは異なった方向に前記走行路から延びる転回路を検出する検出部と、
前記走行路と前記検出部により検出された前記転回路との間で前記車両が転回する場合に前記車両の内側が通過する円弧状の軌跡が含まれた境界曲線を設定する設定部と、
前記走行路における前記転回路側の障害物が、前記設定部において設定した境界曲線よりも前記車両側に非存在である場合、前記転回路における前記車両の転回が可能であると判定する判定部と、
を備える転回可能領域検出装置。
A detection unit for detecting a rolling circuit extending from the travel path in a direction different from the travel path based on information on an obstacle existing around the vehicle traveling along the travel path;
A setting unit for setting a boundary curve including an arcuate trajectory through which the inside of the vehicle passes when the vehicle turns between the travel path and the rolling circuit detected by the detection unit;
A determination unit that determines that the vehicle can turn in the turn circuit when an obstacle on the turn circuit side in the travel path is not present on the vehicle side with respect to the boundary curve set in the setting unit; ,
A rollable area detection device comprising:
前記設定部は、前記境界曲線として、前記車両の走行方向に向かって前記転回路の前側に配置される第1境界曲線と、前記車両の走行方向に向かって前記転回路の後側に、前記転回路を挟みながら前記第1境界曲線に対向して配置される第2境界曲線とを設定し、
前記判定部は、前記走行路における前記転回路側の障害物が、前記設定部において設定した第1境界曲線よりも前記車両側に非存在であり、かつ前記設定部において設定した第2境界曲線よりも前記車両側に非存在である場合、前記転回路における前記車両の転回が可能であると判定する、
請求項1に記載の転回可能領域検出装置。
The setting unit includes, as the boundary curve, a first boundary curve arranged on the front side of the rolling circuit toward the traveling direction of the vehicle, and a rear side of the rolling circuit toward the traveling direction of the vehicle, A second boundary curve disposed opposite to the first boundary curve while sandwiching a rotation circuit,
The determination unit is configured such that an obstacle on the transfer circuit side in the traveling road is not present on the vehicle side than the first boundary curve set in the setting unit, and from the second boundary curve set in the setting unit. If the vehicle is not present on the vehicle side, it is determined that the vehicle can be turned in the turn circuit.
The turnable region detection device according to claim 1.
前記設定部は、
前記車両の位置から、前記走行路の幅方向に沿って前記転回路とは逆側の縁部に移動した第1中間点から、前記走行路の幅方向に沿って前記転回路へ第1距離進んだ第2中間点を導出し、
前記第2中間点から前記車両の走行方向に向かって第2距離進んだ点に第1境界曲線における円弧状の軌跡の中心を設定し、
前記第2中間点から前記車両の走行方向とは反対方向に向かって第2距離進んだ点に第2境界曲線における円弧状の軌跡の中心を設定し、
前記設定部は、前記車両の最小回転半径以上となるように前記第1距離を設定し、前記車両が転回する場合に前記車両の内側が通過する円弧の直径と前記車両のトレッドとの和を2で除算した値以上となるように前記第2距離を設定する、
請求項2に記載の転回可能領域検出装置。
The setting unit
A first distance from the position of the vehicle to the rolling circuit along the width direction of the traveling path from a first intermediate point moved to the edge opposite to the rolling circuit along the width direction of the traveling path. Deriving the advanced second waypoint,
A center of an arc-shaped locus in the first boundary curve is set at a point advanced by a second distance from the second intermediate point toward the traveling direction of the vehicle;
A center of an arc-shaped locus in the second boundary curve is set at a point advanced by a second distance from the second intermediate point in a direction opposite to the traveling direction of the vehicle;
The setting unit sets the first distance to be equal to or greater than a minimum turning radius of the vehicle, and calculates a sum of a diameter of an arc passing through the inside of the vehicle and a tread of the vehicle when the vehicle turns. Setting the second distance to be greater than or equal to the value divided by 2;
The turnable region detecting device according to claim 2.
前記走行路の幅員と前記転回路の幅員とを比較し、比較結果に応じて前記転回路を分類する分類部をさらに備える、
請求項1から3のいずれかに記載の転回可能領域検出装置。
It further comprises a classification unit that compares the width of the travel path with the width of the rolling circuit and classifies the rolling circuit according to a comparison result.
The turnable region detecting device according to any one of claims 1 to 3.
走行路に沿って走行する車両の周囲に存在する障害物の情報をもとに、前記走行路とは異なった方向に前記走行路から延びる転回路を検出するステップと、
前記走行路と検出された前記転回路との間で前記車両が転回する場合に前記車両の内側が通過する円弧状の軌跡が含まれた境界曲線を設定するステップと、
前記走行路における前記転回路側の障害物が、設定した境界曲線よりも前記車両側に非存在である場合、前記転回路における前記車両の転回が可能であると判定するステップと、
を備える転回可能領域検出方法。
Detecting a rolling circuit extending from the travel path in a direction different from the travel path based on information on obstacles existing around the vehicle traveling along the travel path;
Setting a boundary curve including an arcuate trajectory through which the inside of the vehicle passes when the vehicle turns between the travel path and the detected turning circuit;
A step of determining that the turning of the vehicle in the turning circuit is possible when the obstacle on the turning circuit side in the travel path is not present on the vehicle side with respect to a set boundary curve;
A method for detecting a turnable area.
走行路に沿って走行する車両の周囲に存在する障害物の情報をもとに、前記走行路とは異なった方向に前記走行路から延びる転回路を検出するステップと、
前記走行路と検出された前記転回路との間で前記車両が転回する場合に前記車両の内側が通過する円弧状の軌跡が含まれた境界曲線を設定するステップと、
前記走行路における前記転回路側の障害物が、設定した境界曲線よりも前記車両側に非存在である場合、前記転回路における前記車両の転回が可能であると判定するステップとをコンピュータに実行させるためのプログラム。
Detecting a rolling circuit extending from the travel path in a direction different from the travel path based on information on obstacles existing around the vehicle traveling along the travel path;
Setting a boundary curve including an arcuate trajectory through which the inside of the vehicle passes when the vehicle turns between the travel path and the detected turning circuit;
When the obstacle on the rolling circuit side in the travel path is not present on the vehicle side with respect to the set boundary curve, the computer is caused to execute a step of determining that the vehicle can turn in the rolling circuit. Program for.
JP2017061851A 2017-03-27 2017-03-27 Rotatable area detection method, rotatable area detection device using the same, and program Pending JP2018162041A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2017061851A JP2018162041A (en) 2017-03-27 2017-03-27 Rotatable area detection method, rotatable area detection device using the same, and program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017061851A JP2018162041A (en) 2017-03-27 2017-03-27 Rotatable area detection method, rotatable area detection device using the same, and program

Publications (1)

Publication Number Publication Date
JP2018162041A true JP2018162041A (en) 2018-10-18

Family

ID=63859339

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017061851A Pending JP2018162041A (en) 2017-03-27 2017-03-27 Rotatable area detection method, rotatable area detection device using the same, and program

Country Status (1)

Country Link
JP (1) JP2018162041A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020044660A1 (en) 2018-08-30 2020-03-05 日本電気株式会社 State identification system, state identification device, state identification method, and non-transitory computer readable medium

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020044660A1 (en) 2018-08-30 2020-03-05 日本電気株式会社 State identification system, state identification device, state identification method, and non-transitory computer readable medium

Similar Documents

Publication Publication Date Title
CN107339997B (en) Autonomous vehicle path planning device and method
JP6269546B2 (en) Automatic driving device
JP6507862B2 (en) Peripheral monitoring device and driving support device
CN111226267B (en) Driving control method and driving control device for driving support vehicle
JP6269534B2 (en) Travel control device
US10239528B2 (en) Vehicle and method of controlling the vehicle
JP4421450B2 (en) Vehicle departure determination device
JP6269606B2 (en) Vehicle control device
JP4765213B2 (en) Parking assistance device for vehicles
JPWO2018047222A1 (en) Delivery support method and device
CN104276178B (en) Apparatus and method for detecting vehicle front narrow road
JP6323063B2 (en) Traveling lane identification device, lane change support device, traveling lane identification method
JP2017013644A (en) Automatic operation control apparatus
JP2017138817A (en) Vehicle attention calling device
JP4442520B2 (en) Course estimation device for vehicle
US20210284162A1 (en) Method and apparatus for determination of optimal cruising lane in an assisted driving system
JP6658235B2 (en) Lane keeping device
JP2020175857A (en) Parking support device, and method of controlling parking support device
JP6365402B2 (en) Travel control device
JP2016112911A (en) Vehicular travel control device
JP5771930B2 (en) Traveling track creation device
JP5012669B2 (en) Parking assistance device, parking assistance method, and computer program
JP2012234373A (en) Driving support device
JP2006131072A (en) Travel safety device for vehicle
JP2018162041A (en) Rotatable area detection method, rotatable area detection device using the same, and program

Legal Events

Date Code Title Description
RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20180417