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 PDFInfo
- 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
Links
Images
Landscapes
- Traffic Control Systems (AREA)
Abstract
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.
矩形の転回エリアでは、実際に転回可能な領域よりも大きな領域しか検出できない。そのため、実際は転回可能な領域であっても、転回不可能と判定されてしまうことがある。 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.
本発明を具体的に説明する前に、概要を述べる。本実施の形態は、車両の駐車を支援する駐車支援装置に関する。ここでは、駐車場において空きの駐車領域を探索しながら走行路を走行し、走行路が袋小路となる部分において空きの駐車領域を見つけた状況を前提とする。そのような空き駐車領域に車両の前方から進入して駐車することは困難であるので、車両には、走行路を後退で引き返し、転回してから、空きの駐車領域に後退で向かうことによって、空き駐車領域に車両の後方から進入して駐車することが求められる。このような一連の動作において、駐車支援装置は、車両の転回可能な領域(以下、「転回可能領域」という)を検出する。その際、矩形の転回エリアを規定し、転回エリアを確保可能な領域を転回可能領域として検出する場合、車両が実際に転回できる領域よりも大きな領域しか検出できない。本実施の形態は、転回可能領域の検出精度を向上することを目的とする。 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
車両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
図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
第1センサ10aと第2センサ10bは、車両100の両側面に搭載され、車外の障害物、例えば、他車両110との距離を測定する。センサ10として、レーザレーダ、カメラ、超音波センサ等が使用される。レーザレーダは、レーザ光を用いるレーダであり、パルス状のレーザを発光し、障害物からの反射光や散乱光によって距離を測定する。レーザレーダの一例はLIDAR(Light Detection and Ranging、Laser Imaging Detection and Ranging)である。カメラは、車外の状況を撮像し、撮像した画像に対する画像認識処理により障害物との距離を測定する。画像認識処理には公知の技術が使用されればよいので、ここでは説明を省略する。超音波センサは、送波器により超音波を障害物に向け発信し、その反射波を受波器で受信することにより、障害物の有無や対象物までの距離を検出する。第1センサ10aと第2センサ10bとは測定結果を第1受付部30に出力する。
The
位置情報取得部12は、GNSS(Global Navigation Satellite System(s))受信機から車両100の現在位置を取得する。また、位置情報取得部12は、ステアリング角度、車輪速パルス等も使用して現在位置を取得してもよい。位置情報取得部12は、現在位置を位置情報として制御部40に出力する。
The position information acquisition unit 12 acquires the current position of the
第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
車両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
車両100が走行方向120を進行するとともに、車両原点130が更新され、新たな障害物座標230が追加される。ここでは、所定の間隔毎、例えば、10cm毎に車両原点130が更新され、新たな障害物座標230が追加されるものとする。このような所定間隔毎になされる処理の管理は、制御部40においてなされており、以下では、所定のポイント、例えば、最新の車両原点130に対する第1受付部30から記憶部36の処理を説明する。
As the
マップ生成部32は、第1受付部30において対応付けた測定結果と位置情報をもとに、駐車場200の地図を生成する。図4は、マップ生成部32において生成した地図を示す。これは、図3において示された障害物座標230の集まりに相当する。図1に戻る。マップ生成部32は、生成した地図を転回可能領域検出部34に出力する。
The map generation unit 32 generates a map of the
検出部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
また、検出部60は、車両原点130に対して右側に路判定範囲R242を設定する。路判定範囲R242は、走行方向120において、車両100の車幅以上の長さを有する矩形状の範囲である。さらに、検出部60は、車両原点130に対して左側に路判定範囲L244を設定する。路判定範囲L244は、走行方向120において、車両100の車幅以上の長さを有する矩形状の範囲である。検出部60は、路判定範囲F240、路判定範囲R242、路判定範囲L244のそれぞれに障害物座標230が含まれるか否かを確認する。
Further, the
図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
分類部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
分類部64は、走行路220の幅員Wと転回路222の幅員Lとを比較し、幅員W≧幅員Lである場合(以下、「状態履歴1」という)と、幅員W<幅員Lである場合(以下、「状態履歴2」という)とに分類する。これは、転回路222を走行路220より広いか否かで分類することに相当する。
The
分類部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
設定部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
第1境界曲線270a、第2境界曲線270bは、境界曲線270と総称され、境界曲線270には、走行路220と転回路222の間で車両100が転回する場合に車両100の内側が通過する円弧状の軌跡が含まれる。なお、転回路222に対して、第1境界曲線270aと第2境界曲線270bが配置される位置は、検出部60において検出された交差点のパターンに応じて変えられる。交差点のパターンが「1」である場合、4つの境界曲線270が車両原点130の周囲に配置される。
The
第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
ここで、第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
図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=√(R2−B2)−T−m
FIG. 8B is a diagram for explaining the
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
図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
判定部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
図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
この処理のために、例えば、図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
判定部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
シフト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
第2受付部50は、シフトECU14からシフト情報を受けつける。シフト情報が前進から後退に切りかわった場合、つまり図1において車両100の乗員が空きの第9駐車領域210iを見つけて前進から後退に切りかえた場合、第2受付部50は、転回可能な転回路222の掲示を処理部52に指示する。
The
処理部52は、第2受付部50からの指示を受けつけると、制御部40を介して、記憶部36の記憶内容を確認する。前述のごとく、記憶部36における記憶内容は所定間隔毎に追加されている。処理部52は、記憶部36に記憶された記憶内容における「状態履歴」を新しい方から順に検索する。ここでは、「状態履歴1」あるいは「状態履歴2」を見つけるまで、検索が続けられる。「状態履歴1」あるいは「状態履歴2」を見つけた場合、処理部52は、それに対応した車両原点130の座標、交差点のタイプを記憶部36から取得する。処理部52は、ナビゲーションシステムで使用している地図画像、例えば俯瞰画像上における車両原点130の座標に、転回可能な転回路222が存在することを示すアイコンを重畳した画像を生成する。なお、転回可能な転回路222が存在することは、アイコン以外の表示によって示されてもよい。処理部52は、生成した画像を報知装置22に表示させる。
When the
報知装置22は、車両100の走行あるいは駐車に関する情報を乗員に報知する。報知装置2は、例えば、車内に設置されているカーナビゲーションシステム、ヘッドアップディスプレイ、センターディスプレイである。報知装置22は、処理部52から出力された画像を表示することによって、転回可能な転回路222が存在することを乗員に掲示する。
The
以上の構成による駐車支援装置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
図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
本実施の形態によれば、走行路と転回路の間で車両が転回する場合に車両の内側が通過する円弧状の軌跡が含まれた境界曲線をもとに、転回路における車両の転回が可能であるか否かを判定するので、境界曲線で囲まれる領域を小さくできる。また、境界曲線で囲まれる領域が小さくなるので、狭くても、転回路における車両の転回が可能であるか否かを判定できる。また、狭くても、転回路における車両の転回が可能であるか否かが判定されるので、転回可能領域の検出精度を向上できる。また、転回路を挟みながら第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
本実施の形態において車両100は、乗員の操作によって運転、駐車がなされている。しかしながらこれに限らず例えば、車両100は、自動運転制御、自動駐車制御を実行してもよい。この場合、空きの駐車領域210が検出された場合に、車両100の後退が開始される。その際、車両100が転回可能であると判定された転回路222までの走行経路に沿って車両100が後退する。本実施例によれば、適用範囲を拡大できる。
In the present embodiment,
本発明によれば、転回可能領域の検出精度を向上できる。 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境界曲線よりも前記車両側に非存在であり、かつ前記設定部において設定した第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.
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)
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 |
-
2017
- 2017-03-27 JP JP2017061851A patent/JP2018162041A/en active Pending
Cited By (1)
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 |