JP7363469B2 - Positional relationship detection system - Google Patents
Positional relationship detection system Download PDFInfo
- Publication number
- JP7363469B2 JP7363469B2 JP2019235051A JP2019235051A JP7363469B2 JP 7363469 B2 JP7363469 B2 JP 7363469B2 JP 2019235051 A JP2019235051 A JP 2019235051A JP 2019235051 A JP2019235051 A JP 2019235051A JP 7363469 B2 JP7363469 B2 JP 7363469B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- curb
- data
- positional relationship
- measuring device
- 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.)
- Active
Links
Images
Landscapes
- Length Measuring Devices By Optical Means (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Description
本発明は、道路構造物である縁石と自車両との位置関係を検出する位置関係検出システムに関する。 The present invention relates to a positional relationship detection system that detects the positional relationship between a curb, which is a road structure, and a vehicle.
従来、車両の駐車支援などを行う場合、道路上の障害物、および道路構造物と車両の位置関係を把握するために、種々のセンサが車両に取り付けられる。 BACKGROUND ART Conventionally, when providing parking assistance for a vehicle, various sensors are attached to the vehicle in order to understand obstacles on the road and the positional relationship between the vehicle and road structures.
例えば特許文献1には、道路構造物の1つである縁石を検出できるセンサの好適な設置場所として、車両のコーナー部分が記載されている。 For example, Patent Document 1 describes a corner portion of a vehicle as a suitable installation location for a sensor capable of detecting a curb, which is one of the road structures.
しかし、縁石に沿って縁石の近傍に車両を正着制御する場合、車両のコーナーに取り付けられたセンサが縁石を乗り越えてしまい、縁石を見失うために正着制御が続行できない場合があることを見出した。 However, we discovered that when controlling a vehicle to arrive close to a curb, the sensors attached to the corners of the vehicle may run over the curb and lose sight of the curb, making it impossible to continue controlling the vehicle. Ta.
本発明は、上記知見に基づきなされたものであり、正着制御中などにおいても縁石を見失うことなく縁石と車両との位置関係を検出することができる位置関係検出システムの提供を目的とする。 The present invention has been made based on the above findings, and aims to provide a positional relationship detection system that can detect the positional relationship between a curb and a vehicle without losing sight of the curb even during correct arrival control.
上記目的を達成するために、本発明の1つである位置関係検出システムは縁石から車両までの距離を検出する位置関係検出システムであって、前記車両の前後方向において前輪よりも前側、かつ前記車両の幅方向において前記前輪の間に配置され、前記車両の本体の下面に取り付けられ、前記車両の周辺に存在する前記縁石を含む道路構造物の状態を計測する計測装置と、前記計測装置から計測データを取得するデータ取得部と、取得した計測データに基づき前記縁石を示す縁石データを抽出する縁石抽出部と、前記縁石データに基づき前記縁石から前記車両までの距離を算出する位置関係算出部と、を備える。 In order to achieve the above object, a positional relationship detection system that is one aspect of the present invention is a positional relationship detection system that detects the distance from a curb to a vehicle, and is located in front of the front wheels in the longitudinal direction of the vehicle, and a measuring device disposed between the front wheels in the width direction of the vehicle, attached to the lower surface of the main body of the vehicle, and measuring the state of a road structure including the curb existing around the vehicle; a data acquisition unit that acquires measurement data; a curb extraction unit that extracts curb data indicating the curb based on the acquired measurement data; and a positional relationship calculation unit that calculates a distance from the curb to the vehicle based on the curb data. and.
本発明によれば、縁石の近傍に縁石に沿った状態で車両を停止させる正着制御などにおいて縁石と車両との位置関係を適切に検出することができる。 According to the present invention, it is possible to appropriately detect the positional relationship between a curb and a vehicle in a correct arrival control in which a vehicle is stopped near a curb along the curb.
以下に、本発明に係る位置関係検出装置、および位置関係検出方法の実施の形態について、図面を参照しつつ説明する。なお、以下の実施の形態で示される数値、形状、材料、構成要素、構成要素の位置関係、および接続状態、ステップ、ステップの順序などは、一例であり、本発明を限定する主旨ではない。また、以下では複数の発明を一つの実施の形態として説明する場合があるが、請求項に記載されていない構成要素については、その請求項に係る発明に関しては任意の構成要素であるとして説明している。また、図面は、本発明を説明するために適宜強調や省略、比率の調整を行った模式的な図となっており、実際の形状や位置関係、比率とは異なる場合がある。 Embodiments of a positional relationship detection device and a positional relationship detection method according to the present invention will be described below with reference to the drawings. Note that the numerical values, shapes, materials, components, positional relationships of the components, connection states, steps, order of steps, etc. shown in the following embodiments are merely examples, and do not limit the present invention. In addition, although multiple inventions may be described below as one embodiment, constituent elements not stated in a claim will be explained as arbitrary constituent elements with respect to the claimed invention. ing. Further, the drawings are schematic diagrams with appropriate emphasis, omission, and ratio adjustment for explaining the present invention, and may differ from the actual shapes, positional relationships, and ratios.
図1は、本実施の形態に係る位置関係検出システムが搭載された車両、および縁石の位置関係を示す上面図である。図2は、本実施の形態に係る車両、位置関係検出システム、および縁石の位置関係を示す側面図である。図3は、位置関係検出システムの機能構成を示すブロック図である。位置関係検出システム100が搭載される車両200の種類は、特に限定されるものではないが、本実施の形態の場合、縁石210の近傍に設置されるバス停に自動運転によって正着し、次のバス停まで自律走行する自動走行型の路線バスを車両200として例示している。車両200は、右側通行用、左側通行用のいずれでもかまわないが、本実施の形態の場合、左側通行用を例示しており、車両200の幅方向(図中X軸方向)における中央位置C(図1中、一点鎖線で示す)に対し進行方向に向いて右側に操舵部材、シートなどが配置される運転席203が設けられている。
FIG. 1 is a top view showing the positional relationship between a vehicle equipped with a positional relationship detection system according to the present embodiment and a curb. FIG. 2 is a side view showing the positional relationship between the vehicle, the positional relationship detection system, and the curb according to the present embodiment. FIG. 3 is a block diagram showing the functional configuration of the positional relationship detection system. The type of
正着とは、本実施の形態の場合、図1に示すように、縁石210の並び方向(図中Y軸方向)に車両200の前後方向が平行、またはほぼ平行になるように車両200が停車し、縁石210から車両本体202までの距離が10cm以下の状態、例えば縁石210とタイヤとの間隔が4cm±2cmの範囲内に収まる状態を正着としている。正着制御とは、前記正着状態に車両本体202をするための制御を意味している。
In the case of the present embodiment, arriving correctly means that the
位置関係検出システム100は、縁石210から計測装置110までの距離D(図6参照)、および縁石210の並び方向(図中Y軸方向)に対する計測装置110の角度θ(図5参照)を検出するシステムであって、計測装置110と、位置関係検出装置120と、正着制御部130と、を備えている。なお、車両200に対する計測装置110の位置に基づき距離Dを縁石210と車両200との距離、縁石210とタイヤとの距離に換算することができ、車両200に対する計測装置110の姿勢に基づき角度θを縁石210の並び方向と車両200の前後方向との角度に換算することができる。
The positional
計測装置110は、車両200の周辺に存在する縁石210、および路面220を含む道路構造物の状態を計測する装置である。計測装置110は、車両200の車輪を除く車両本体202の下面において、下側に向いて突出状に取り付けられている。計測装置110は、車両200の前後方向(図中Y軸方向)において前輪201よりも前側、かつ車両200の幅方向(図中X軸方向)において前輪201の間に配置されている。本実施の形態の場合、計測装置110は、車両200の幅方向において、前輪201間の中央位置よりも左側通行に対応した車両200の場合は右側、右側通行に対応した車両200の場合は左側(本実施の形態の場合、運転席203側)に配置されている。なお、車両200が完全自動運転であり運転席203が存在しない場合は、左側通行に対応した車両200の場合は、中央位置Cよりも右側、右側通行に対応した車両200の場合は中央位置Cよりも左側に計測装置110が配置されればよい。
The
計測装置110は、車両200のピッチ方向P(図2中X軸周り)において、計測装置110の計測範囲の中心線L(図2、図3参照)が傾くように取付手段111によって車両本体202に取り付けられている。本実施の形態の場合、取付手段111は、いわゆるブラケットであり、車両本体202と計測装置110との間に介在配置され、車両本体202に対し計測装置110を所定角度傾いた状態で固定する。
The
道路構造物の状態を計測する計測装置110とは、縁石210に対する車両200の位置関係が導出できる計測データを出力できる装置である。なお、車両200に対する計測装置110の位置、および車両200の直進方向と計測装置110との関係は、明確であるため、縁石210に対する計測装置110の位置関係がわかれば、縁石210に対する車両200の位置関係は1対1で算出できる。
The
計測装置110の種類は、前記計測データを出力できるものであれば特に限定されるものではない。計測装置110としては例えば、道路構造物の状態を画像として取得する撮像素子およびレンズ系を備えて画像データを計測データとして出力する単数のカメラ、複数のカメラにより道路構造物との距離や姿勢を計測するための複数の画像データを計測データとして出力するステレオカメラ、Time Of Flightの技術を用いて各画素における距離データを含む画像を取得し計測データとして出力するTOFセンサなどを例示することができる。
The type of
本実施の形態の場合、計測装置110としては、360°(全方位)において三次元のイメージングを可能とするLiDAR(Laser Imaging Detection and Ranging)が採用されている。LiDARは、道路構造物にレーザー光を照射して散乱光や反射光を受光し、レーザー光照射から受光までの時間に基づき対象物までの距離や位置関係を計測する。計測装置110は、車両200に取り付けられた計測装置110から道路構造物の各点までの距離、および車両200に対する点の方向、例えば計測装置110を通過する水平面内の所定の基準方向に対する計測装置110を中心とした角度を示す点データF(図4参照)を計測データとして生成する。
In the case of this embodiment, LiDAR (Laser Imaging Detection and Ranging), which enables three-dimensional imaging in 360 degrees (all directions), is employed as the
具体的に計測装置110は、相互に異なる伏角(例えば数°間隔)の複数本のレーザー光、相互に異なる仰角(例えば数°間隔)の複数本のレーザー光を回転させながら走査し、レーザー光源と一緒に回転する受光素子により散乱光や反射光を受光する。計測装置110が取付手段111によらず水平に取り付けられている場合、レーザー光の回転軸は鉛直軸に沿っており(図4の(b)の部分参照)、水平面内を回転するレーザー光が、ピッチ方向の計測範囲の中心線Lとなる。
Specifically, the
本実施の形態の場合、計測装置110は、放射するレーザー光の回転軸がピッチ方向Pにおいて鉛直軸に対し角度E傾くように取付手段111により車両本体202に取り付けられている。角度Eは、10°±7°の範囲から選定されることが好ましい。角度Eが3°未満の場合、縁石210から取得される点データFの数が不足する可能性が高くなる。角度Eが17°より大きい場合、他の道路構造物などの検出精度の低下が無視できなくなる。図4の(a)の部分に示すように、鉛直軸に対する回転軸の傾きの角度Eを10°±7°の範囲から選定される角度に設定することで、比較的背が低い縁石210に対してもレーザー光による走査本数を適切に増加させることができ、縁石210を示す点データFの点数を増加させることができる。
In the case of this embodiment, the
位置関係検出装置120は、計測装置110から取得した計測データに基づき縁石210に対する車両200の位置関係を導出する装置であり、データ取得部121と、平面特定部127と、路面抽出部125と、傾斜導出部128と、縁石抽出部122と、交線算出部126と、位置関係算出部123と、を備えている。
The positional
データ取得部121は、計測装置110から計測データを取得する。本実施の形態の場合、計測装置110は、計測装置110の回転軸周り全周(360°)において縁石210を含む道路構造物の状態を計測する全方位型のLiDARであるため、データ取得部121は、計測装置110から取得した計測データから、図5に示すように、所定の軸(本実施の形態の場合、計測装置110を通過する鉛直軸)周りにおける所定の角度範囲であって、角度範囲の中央線Bが車両200の左右方向に対し左側通行に対応した車両200の場合は左側、右側通行に対応した車両200の場合は右側(本実施の形態の場合、運転席203の反対側)に向いている抽出角度範囲Aに含まれる点データのみを新たな計測データとして抽出する。これにより、位置関係検出装置120が処理するデータ量を削減し、処理速度の向上を図っている。
The
また、抽出角度範囲Aの一端は、左側通行に対応した車両200の場合は左側、右側通行に対応した車両200の場合は右側(本実施の形態の場合、運転席203の反対側)の前輪201と接し、他端は車両200の前後方向における前方に向くように設定されている。これにより、計算に用いる計測データのデータ量を抑制しつつ、縁石210に関する十分な情報を確保することが可能となる。また、計測装置110が全方位型のLiDARであり、取得する計測データが極座標により表現されるため、抽出角度範囲A内の計測データを容易に抽出することが可能である。
Further, one end of the extraction angle range A is the front wheel on the left side in the case of the
計測装置110は、計測装置110の特異方向Sが抽出角度範囲A以外に向くように配置または設定されている。特異方向Sとは、測定の開始方向、および終了方向の少なくも一方であり、全方位型のLiDARに関しては測定の開始方向、および終了方向が一致している。特異方向Sは、計測データの切れ目に該当し、計測データに含まれる角度の基準方向(本実施の形態の場合、0°の方向)に該当している。このように特異方向Sを抽出角度範囲A以外となるように計測装置110を配置または設定することで、データ処理の負荷を抑制し、検出精度の向上を図ることができる。
The measuring
なお、データ取得部121は、所定の角度範囲Aとして所定の距離以下の範囲を新たな計測データとして抽出してもよい。具体的に例えば計測装置110から20m以内の計測データを抽出する場合を例示できる。また、データ取得部121は、角度、および距離の少なくとも一方で計測データを抽出する範囲を制限するのではなく、矩形など所定の形状の領域を用いて計測データを抽出してもかまわない。この場合、選定する領域は、前輪よりも前方の領域が後方の領域よりも大きいことが好ましく、また、車両200の中央位置Cに対し左側通行に対応した車両200の場合は左側、右側通行に対応した車両200の場合は右側(本実施の形態の場合、運転席203の反対側)が左側通行に対応した車両200の場合は右側、右側通行に対応した車両200の場合は左側(本実施の形態の場合、運転席203側)より大きいことが好ましい。
Note that the
平面特定部127は、計測データに含まれる点データの集合である三次元点群から少なくとも二つの平面を特定する。本実施の形態の場合、制限された領域内の計測データに基づき平面が特定される。これにより、道路構造物の内、縁石210、および路面220に関する平面を集中して特定することができる。平面の特定方法は、特に限定されるものではないが、例えば、三次元点群処理のためのソフトウェアライブラリであるPoint Cloud Library(PCL)を用いることを例示できる。具体的例えば、点群データの中からランダムに選んだ点データFの組から法線ベクトルを求め、法線ベクトルの一致度合いに基づき平面を特定する方法を例示することができる。
The
路面抽出部125は、取得した計測データに基づき路面を示す路面データを抽出する。路面抽出部125の路面抽出ロジックは、特に限定されるものではない。例えば計測データがカメラに基づく画像の場合、画像解析により路面データを抽出してもかまわない。
The road
本実施の形態の場合、路面抽出部125は、平面特定部127により特定された複数の平面の中から、計測装置110の基準面(水平面と想定される)との傾きが路面傾斜範囲内、かつ、面積が路面面積閾値以上の平面を路面データとして抽出する。
In the case of the present embodiment, the road
路面傾斜範囲は、特に限定されるものではなく、車両200の最大ロール角度や最大ピッチ角度に基づき設定される。具体的には計測装置110の基準面に対する傾きに対し±10°程度の範囲を路面傾斜範囲として例示できる。
The road surface inclination range is not particularly limited, and is set based on the maximum roll angle and maximum pitch angle of the
なお、面積が路面面積閾値以上か否かの判定において、特定された平面に含まれる点データFの数が所定数以上か否かに基づき判定することも可能である。例えば、少なくとも特定された平面に含まれる点データFの数が50以下の平面は、傾斜に関する判断をすることなく路面データとして抽出しないようにすることも可能である。 Note that in determining whether the area is equal to or greater than the road surface area threshold, it is also possible to determine based on whether the number of point data F included in the identified plane is equal to or greater than a predetermined number. For example, at least a plane in which the number of point data F included in the specified plane is 50 or less can be set not to be extracted as road surface data without making a judgment regarding the slope.
傾斜導出部128は、路面抽出部125により抽出された路面データに基づき、図7の(a)に示すように実際の水平面内の所定の一軸である第一軸231に対する車両200に取り付けられた計測装置110の基準面112の第一傾斜度θ1を導出する。本実施の形態の場合、第一軸231は、車両200の幅方向に沿う軸であって、車両200が位置している路面220に沿う軸である。つまり、第一傾斜度θ1は、車両200のロール方向Rの傾斜度である。また、傾斜導出部128は、図7の(b)に示すように、水平面内において第一軸231に直交する第二軸232に対する計測装置110の基準面112の第二傾斜度θ2も導出する。第二軸232は車両200の前後方向に沿う軸である。つまり、第二傾斜度θ2はピッチ方向Pの傾斜度である。具体的に、傾斜導出部128は、路面抽出部125により抽出された路面データが水平面に平行であるとし、予め定められた計測装置110の基準面112の路面データに対するロール方向R、およびピッチ方向Pの傾斜度を第一傾斜度θ1、および第二傾斜度θ2として導出する。第一傾斜度θ1と第二傾斜度θ2の導出に用いる路面データは、縁石210と路面220の両方を計測した計測データに基づいて抽出されることが好ましい。
Based on the road surface data extracted by the road
縁石抽出部122は、データ取得部121が取得した計測データに基づき縁石210を示す縁石データを抽出する。縁石抽出部122の縁石データを抽出する方法は、特に限定されるものではない。
The
本実施の形態の場合、データ取得部121が取得する計測データには、車両200に対する道路構造物の各点の位置を示す点データFが含まれている。平面特定部127は、点データFの集合である三次元点群から平面を特定している。縁石抽出部122は、縁石210の側面211を示す縁石データの候補として鉛直面に対し縁石傾斜範囲内に含まれる平面を起立データとして抽出し、起立データについて第一傾斜度に基づき補正を行って補正後データを生成している。なお、起立データに対し第二傾斜度を加えて補正後データを生成してもかまわない。
In the case of this embodiment, the measurement data acquired by the
縁石傾斜範囲は、特に限定されるものではなく、普及している実際の縁石の側面の鉛直面に対する傾きに対し±10°程度の範囲を縁石傾斜範囲として例示できる。具体的に例えば、実際の縁石の側面の鉛直面に対する傾きは5.7°、縁石傾斜範囲は5.7°±10°を例示できる。 The curb inclination range is not particularly limited, and the curb inclination range can be exemplified as a range of approximately ±10° with respect to the inclination of the side surface of an actual curb stone with respect to the vertical plane. Specifically, for example, the actual inclination of the side surface of the curb with respect to the vertical plane is 5.7°, and the curb inclination range is 5.7°±10°.
縁石抽出部122はさらに、補正後データに基づき縁石210の側面211を示す縁石データを抽出する。具体的に例えば、縁石抽出部122は、補正後データから、高さが高さ閾値以下の平面を縁石データとして抽出してもよい。また、縁石抽出部122は、補正後データから、面積が縁石面積閾値未満の平面を縁石データから除外してもかまわない。さらに、縁石抽出部122は、補正後データに含まれる点データFの数に対し、高さ閾値より高い点データFの数の割合が比較閾値以上の補正後データを、前記縁石データから除外してもかまわない。
The
高さ閾値は、特に限定されるものではなく、普及している実際の縁石の高さに基づき設定される。具体的に例えば、複数種類の縁石の高さの最低値が20cmとした場合、計測誤差などを考慮した18cmを高さ閾値として例示できる。 The height threshold value is not particularly limited, and is set based on the actual height of the prevailing curbstone. Specifically, for example, if the lowest value of the heights of multiple types of curb stones is 20 cm, 18 cm can be exemplified as the height threshold value in consideration of measurement errors and the like.
縁石面積閾値は、特に限定されるものではない。また、縁石210は、長手方向に並べて配置されるため、縁石210の側面211の面積は、一律に特定できない。従って、縁石面積閾値は、複数個(例えば数個)の縁石210の側面積の合計を下限値として設定してもかまわない。本実施の形態の場合、縁石面積閾値は、抽出された縁石データに含まれる点データFの数としている。これは、縁石210の側面211として計測された点データFの数と縁石210の側面211の面積が比例関係にあることに基づく。
The curb area threshold is not particularly limited. Further, since the
交線算出部126は、路面抽出部125で抽出された路面データと縁石抽出部122で抽出された縁石データとの交線215を示す交線データを算出する。交線データを算出するロジックは、特に限定されるものではない。例えば、路面データを含む仮想的な路面平面方程式、および縁石データを含む仮想的な縁石平面方程式を作成し、これらの二つの平面の交わりを交線データ(交線方程式)とする方法を例示できる。
The intersection
位置関係算出部123は、縁石抽出部122が抽出した縁石データに基づき縁石210から車両200までの距離D、および縁石210の並び方向に対する車両200の角度θを算出する。距離Dおよび角度θの算出方法は、計測装置110が出力する計測データの種類によって異なり、限定されるものではない。例えば、計測データが画像の場合、縁石として抽出された部分の画像内の傾きを角度θに対応付けてもよく、縁石として抽出された部分と直交する線であって画像内の基準点を通過する線の縁石から基準点までの長さを距離Dに対応付けてもかまわない。
The positional
本実施の形態の場合、位置関係算出部123は、算出された交線データに基づき交線215から車両200までの距離D(詳細には縁石210と路面220の交線215から計測装置110までの距離Dが算出される。
In the case of the present embodiment, the positional
正着制御部130は、位置関係算出部123により算出される縁石210から車両200までの距離D、および縁石210の並び方向に対する車両200の角度θに基づき縁石210に沿って正着させるように車両200を制御する。具体的に例えば、正着制御部130は、ステアリング、走行用のモータ(エンジン)、ブレーキなどを統合的に制御して正着制御を行う。なお、正着制御部130は、運転者に対して正着に必要な情報を提示することで車両200を正着制御してもよい。
The correct
次に、縁石210から路面220上の車両200までの距離D、および縁石210の並び方向に対する車両200の前後方向の角度を検出する位置関係検出方法の流れを説明する。図8は、位置関係検出方法の流れを示すフローチャートである。
Next, the flow of the positional relationship detection method for detecting the distance D from the
最初に、計測装置110の較正の必要性が判断される(S101)。例えば、計測装置110の初期設定の段階や計測装置110の使用を開始して所定期間経過の後などのタイミングにおいて計測装置110の較正が行われる(S101:Yes)。具体的には、計測装置110が取り付けられた車両200を水平であることが保証されている路面上まで移動させて配置し、路面抽出部125に路面データを抽出させ、傾斜導出部128に導出させた第一傾斜度が0°となるように計測装置110の基準面を較正する(S102)。なお、計測装置110の特異方向S(図5参照)と、車両200の前後方向などに関して較正してもかまわない。
First, it is determined whether the
次に、自動運転において正着制御が開始されると(S103:Yes)、データ取得部121は、車両200の周辺に存在する縁石210、および路面220を含む道路構造物の状態を計測する計測装置110から計測データを取得する(S104)。本実施の形態の場合、データ取得部121は、取得した計測データから所定の領域内を示す所定領域データを抽出して新たな計測データとし、データ量を削減している(S105)。
Next, when the correct arrival control is started in automatic driving (S103: Yes), the
次に本実施の形態の場合、平面特定部127が削減された所定領域データに基づき複数の平面を特定する(S106)。路面抽出部125は、複数の平面の中から路面220を示す路面データを抽出する(S107)。
Next, in the case of this embodiment, the
抽出した路面データが正しい路面データである場合(S108:Yes)、傾斜導出部128が、抽出された路面データと予め較正された計測装置110の基準面とを比較し、ロール方向の計測装置110の傾きである第一傾斜度、およびピッチ方向の傾きである第二傾斜度を導出する(S109)。
If the extracted road surface data is correct road surface data (S108: Yes), the
次に、縁石抽出部122が、平面特定部127により特定された平面から鉛直面に対し縁石傾斜範囲内に含まれる平面に対応する計測データを起立データとして抽出する(S110)。抽出した起立データに対し、第一傾斜度、および第二傾斜度を用いて補正を実行し補正後データを生成する(S111)。縁石抽出部122は、生成した補正後データに対し高さ閾値、縁石面積閾値などを用いて正しい縁石データを抽出する(S112:Yes)。
Next, the
次に、交線算出部126が、路面抽出部125で抽出された路面データと縁石抽出部122で抽出された縁石データとの交線215を示す交線データを算出する(S113)。次に、位置関係算出部123が、交線データに基づき縁石210から車両200までの距離D、および縁石210の並び方向に対する車両200の角度θを算出する(S114)。距離Dおよび角度θの算出方法は、計測装置110が出力する計測データの種類によって異なり、限定されるものではない。例えば、計測データが画像の場合、縁石として抽出された部分の画像内の傾きを角度θに対応付けてもよく、縁石として抽出された部分と直交する線であって画像内の基準点を通過する線の縁石から基準点までの長さを距離Dに対応付けてもかまわない。
Next, the intersection
本実施の形態の場合、位置関係算出部123が、算出された交線データに基づき交線215から車両200までの距離D(詳細には縁石210と路面220の交線215から計測装置110までの距離Dを算出する(S114)。最後に、位置関係算出部123は、正着制御部130に算出した距離と角度とを出力する(S115)。以上のS104からS116までのフローが正着制御終了(S116:Yes)まで繰り返される(S116:No)。
In the case of this embodiment, the positional
本実施の形態に係る位置関係検出システム100によれば、車両200を縁石210の近くに横付けする正着制御中においては、計測装置110が縁石210を乗り越えることなく、縁石210を検出し続けることができる。従って、位置関係検出装置120により得られる距離Dと角度θとを使用することにより、車両200の正着制御(自動駐車)を途切れることなく安定的に実現させることができる。
According to the positional
なお、本発明は、上記実施の形態に限定されるものではない。例えば、本明細書において記載した構成要素を任意に組み合わせて、また、構成要素のいくつかを除外して実現される別の実施の形態を本発明の実施の形態としてもよい。また、上記実施の形態に対して本発明の主旨、すなわち、請求の範囲に記載される文言が示す意味を逸脱しない範囲で当業者が思いつく各種変形を施して得られる変形例も本発明に含まれる。 Note that the present invention is not limited to the above embodiments. For example, the embodiments of the present invention may be realized by arbitrarily combining the components described in this specification or by excluding some of the components. The present invention also includes modifications obtained by making various modifications to the above-described embodiments that a person skilled in the art can conceive without departing from the gist of the present invention, that is, the meaning of the words written in the claims. It will be done.
例えば、位置関係検出装置120は、平面特定部127を備えていない場合もある。具体的に例えば、計測データが距離データを含む画像データのような場合は、路面220、および縁石210の側面211を、パターンマッチングなどを用いて計測データから路面データ、および縁石データを直接抽出することも可能である。
For example, the positional
また、位置関係検出装置120は、路面抽出部125、傾斜導出部128、交線算出部126を備えていない場合もある。具体的には縁石210の側面211を示す路面データに基づき、縁石210と車両200との距離、および縁石210の並び方向に対する車両200の角度を位置関係算出部123が直接算出してもかまわない。
Furthermore, the positional
また、計測装置110は、所定の軸周りの全周において道路構造物の状態を計測するものばかりでなく、図9に示すような所定の軸周りにおいて所定の角度範囲Aの道路構造物の状態を計測するものであってもかまわない。例えば計測装置110がカメラなどの場合、カメラの画角が角度範囲Aとなる。また、このような計測装置110は、角度範囲Aの中央線Bは、車両200の左右方向に対し左側通行に対応した車両200の場合は左側、右側通行に対応した車両200の場合は右側(本実施の形態の場合、運転席203の反対側)に向くように配置されることが好ましい。
In addition, the measuring
また、データ取得部121は、計測装置110から取得した計測データを所定の角度範囲に限定したが、データ取得部121は、角度範囲、および距離範囲の少なくとも一方により限定してもよい。距離範囲とは具体的に例えば計測装置110から20m以内の計測データのみを抽出することである。
Moreover, although the
また、データ取得部121は、計測装置110から取得した計測データを矩形など任意の閉じた形状の範囲内に限定してもかまわない。
Further, the
またデータ取得部121、縁石抽出部122、位置関係算出部123、および正着制御部130の処理部の一部、または全部の処理をコンピュータに実現させるプログラムであってもかまわない。
Further, the program may be a program that causes a computer to perform some or all of the processing of the
本発明は、乗用車、バス、トラック、農業機械、建設機械などの路面を走行する車両などに利用することができる。 INDUSTRIAL APPLICATION This invention can be utilized for vehicles which run on a road surface, such as a passenger car, a bus, a truck, agricultural machinery, and a construction machine.
100…位置関係検出システム、110…計測装置、111…取付手段、112…基準面、120…位置関係検出装置、121…データ取得部、122…縁石抽出部、123…位置関係算出部、125…路面抽出部、126…交線算出部、127…平面特定部、128…傾斜導出部、130…正着制御部、200…車両、201…前輪、202…車両本体、203…運転席、210…縁石、211…側面、215…交線、220…路面、231…第一軸、232…第二軸
DESCRIPTION OF
Claims (9)
前記車両の前後方向において前輪よりも前側、かつ前記車両の幅方向において前記前輪の間に配置され、前記車両の本体の下面に取り付けられ、前記車両の周辺に存在する前記縁石を含む道路構造物の状態を計測する計測装置と、
前記計測装置から計測データを取得するデータ取得部と、
取得した計測データに基づき前記縁石を示す縁石データを抽出する縁石抽出部と、
前記縁石データに基づき前記縁石から前記車両までの距離を算出する位置関係算出部と、を備え、
前記計測装置は、
前記車両の幅方向において、前記前輪間の中央位置よりも左側通行に対応した前記車両の場合は右側、右側通行に対応した前記車両の場合は左側に配置される
位置関係検出システム。 A positional relationship detection system that detects the distance from a curb to a vehicle,
A road structure including the curb, which is located in front of the front wheels in the longitudinal direction of the vehicle and between the front wheels in the width direction of the vehicle, is attached to the lower surface of the main body of the vehicle, and exists around the vehicle. a measuring device that measures the state of the
a data acquisition unit that acquires measurement data from the measurement device;
a curb extraction unit that extracts curb data indicating the curb based on the acquired measurement data;
a positional relationship calculation unit that calculates a distance from the curb to the vehicle based on the curb data ;
The measuring device includes:
In the width direction of the vehicle, it is located on the right side of the center position between the front wheels if the vehicle is compatible with left-hand traffic, and on the left side if the vehicle is compatible with right-hand traffic.
Positional relationship detection system.
前記縁石データに基づき前記縁石から前記縁石の並び方向に対する前記車両の角度を算出する
請求項1に記載の位置関係検出システム。 The positional relationship calculation unit includes :
The positional relationship detection system according to claim 1, wherein the angle of the vehicle from the curb to the direction in which the curbs are lined up is calculated based on the curb data.
所定の軸周りにおいて所定の角度範囲の前記道路構造物の状態を計測するものであり、前記角度範囲の中央線は、前記車両の前後方向に対し左側通行に対応した前記車両の場合は左側、右側通行に対応した前記車両の場合は右側に向くように配置される
請求項1または2に記載の位置関係検出システム。 The measuring device includes:
The state of the road structure is measured in a predetermined angular range around a predetermined axis, and the center line of the angular range is the left side in the case of the vehicle that is compatible with left-hand traffic in the longitudinal direction of the vehicle; The positional relationship detection system according to claim 1 or 2, wherein the positional relationship detection system is arranged to face to the right when the vehicle is compatible with right-hand traffic.
所定の軸周り全周の前記道路構造物の状態を走査により計測するものであり、前記車両から前記道路構造物の各点までの距離、および前記車両に対する前記点の方向を示す点データを計測データとして生成し、
前記データ取得部は、
取得した計測データから、所定の軸周りにおける所定の角度範囲であって、前記角度範囲の中央線が前記車両の前後方向に対し左側通行に対応した前記車両の場合は左側、右側通行に対応した前記車両の場合は右側に向いている抽出角度範囲に含まれる点データを新たな計測データとして抽出する
請求項1または2に記載の位置関係検出システム。 The measuring device includes:
The state of the road structure all around a predetermined axis is measured by scanning, and point data indicating the distance from the vehicle to each point on the road structure and the direction of the point with respect to the vehicle is measured. Generate as data,
The data acquisition unit includes:
From the acquired measurement data, in a predetermined angular range around a predetermined axis, if the center line of the angular range corresponds to left-hand traffic in the longitudinal direction of the vehicle, it is determined that the vehicle corresponds to left-hand traffic or right-hand traffic. 3. The positional relationship detection system according to claim 1, wherein, in the case of the vehicle, point data included in an extraction angle range facing to the right is extracted as new measurement data.
請求項4に記載の位置関係検出システム。 The positional relationship detection system according to claim 4 , wherein one end of the extraction angle range contacts a front wheel on the opposite side of the driver's seat of the vehicle in the width direction of the vehicle , and the other end faces forward in the longitudinal direction of the vehicle. .
前記抽出角度範囲の外に前記計測装置の特異方向が向くように配置される
請求項4または5に記載の位置関係検出システム。 The measuring device includes:
The positional relationship detection system according to claim 4 or 5 , wherein the measuring device is arranged so that its unique direction faces outside the extraction angle range.
請求項1から6のいずれか一項に記載の位置関係検出システム。 The positional relationship detection system according to any one of claims 1 to 6 , further comprising a right-arrival control unit that controls the vehicle to arrive at the curb based on the distance calculated by the positional relationship calculation unit.
前記車両に取り付けられ、前記車両の周辺に存在する前記縁石を含む道路構造物の状態を計測する計測装置と、
前記計測装置から計測データを取得するデータ取得部と、
取得した計測データに基づき前記縁石を示す縁石データを抽出する縁石抽出部と、
前記縁石データに基づき前記縁石から前記車両までの距離を算出する位置関係算出部と、を備え、
前記計測装置は、
所定の軸周り全周の前記道路構造物の状態を走査により計測するものであり、前記車両から前記道路構造物の各点までの距離、および前記車両に対する前記点の方向を示す点データを計測データとして生成し、
前記データ取得部は、
取得した計測データから、所定の軸周りにおける所定の角度範囲であって、前記角度範囲の中央線が前記車両の前後方向に対し運転席の反対側に向いている抽出角度範囲に含まれる点データを新たな計測データとして抽出し、
前記計測装置は、
前記抽出角度範囲の外に前記計測装置の特異方向が向くように配置される
位置関係検出システム。 A positional relationship detection system that detects the distance from a curb to a vehicle,
a measuring device that is attached to the vehicle and measures the state of road structures including the curb that exist around the vehicle;
a data acquisition unit that acquires measurement data from the measurement device;
a curb extraction unit that extracts curb data indicating the curb based on the acquired measurement data;
a positional relationship calculation unit that calculates a distance from the curb to the vehicle based on the curb data;
The measuring device includes:
The state of the road structure all around a predetermined axis is measured by scanning, and point data indicating the distance from the vehicle to each point on the road structure and the direction of the point with respect to the vehicle is measured. Generate as data,
The data acquisition unit includes:
From the acquired measurement data, point data included in a predetermined angular range around a predetermined axis, where the center line of the angular range is oriented toward the opposite side of the driver's seat with respect to the longitudinal direction of the vehicle. is extracted as new measurement data,
The measuring device includes:
A positional relationship detection system arranged such that the specific direction of the measuring device faces outside the extraction angle range.
前記縁石データに基づき前記縁石から前記縁石の並び方向に対する前記車両の角度を算出する
請求項8に記載の位置関係検出システム。 The positional relationship calculation unit includes :
The positional relationship detection system according to claim 8 , wherein the angle of the vehicle from the curb to the direction in which the curbs are lined up is calculated based on the curb data.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019235051A JP7363469B2 (en) | 2019-12-25 | 2019-12-25 | Positional relationship detection system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019235051A JP7363469B2 (en) | 2019-12-25 | 2019-12-25 | Positional relationship detection system |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2021103143A JP2021103143A (en) | 2021-07-15 |
JP7363469B2 true JP7363469B2 (en) | 2023-10-18 |
Family
ID=76755154
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019235051A Active JP7363469B2 (en) | 2019-12-25 | 2019-12-25 | Positional relationship detection system |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7363469B2 (en) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2016045507A (en) | 2014-08-19 | 2016-04-04 | 日野自動車株式会社 | Driving support system |
JP2018065538A (en) | 2016-10-21 | 2018-04-26 | 日野自動車株式会社 | Steering control apparatus |
-
2019
- 2019-12-25 JP JP2019235051A patent/JP7363469B2/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2016045507A (en) | 2014-08-19 | 2016-04-04 | 日野自動車株式会社 | Driving support system |
JP2018065538A (en) | 2016-10-21 | 2018-04-26 | 日野自動車株式会社 | Steering control apparatus |
Also Published As
Publication number | Publication date |
---|---|
JP2021103143A (en) | 2021-07-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10935643B2 (en) | Sensor calibration method and sensor calibration apparatus | |
RU2703440C1 (en) | Method and device for controlling movement | |
CN102768808B (en) | The apparatus and method of auxiliary driver | |
US20160272203A1 (en) | Vehicle control device | |
JP2023073257A (en) | Output device, control method, program, and storage medium | |
JP2022552293A (en) | Lidar sensor calibration | |
US20180086381A1 (en) | System and method for autonomous perpendicular parking of a vehicle | |
US20090122136A1 (en) | Object detection device | |
EP3306429A1 (en) | Position estimation device and position estimation method | |
JP6822815B2 (en) | Road marking recognition device | |
US20180299545A1 (en) | Method and apparatus for analysis of a vehicle environment, and vehicle equipped with such a device | |
WO2018207782A1 (en) | Parking space detection device | |
US11243308B2 (en) | Axial deviation detection device and vehicle | |
WO2018164203A1 (en) | Scanner, working machine, and wheel stopper detecting device | |
JP7123167B2 (en) | External recognition device | |
JP6781535B2 (en) | Obstacle determination device and obstacle determination method | |
KR101894204B1 (en) | Realtime container truck monitoring method and system | |
CN112581771B (en) | Driving control device, parking target, and driving control system for automatic driving vehicle | |
JP7363469B2 (en) | Positional relationship detection system | |
JP2021103132A (en) | Positional relationship detection system | |
JP7347204B2 (en) | Positional relationship detection device and positional relationship detection method | |
JP7380196B2 (en) | Positional relationship detection device | |
CN113486836B (en) | Automatic driving control method for low-pass obstacle | |
JP5821274B2 (en) | Moving body position detection device | |
JP7216695B2 (en) | Surrounding vehicle monitoring device and surrounding vehicle monitoring method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20221117 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20230630 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20230725 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230824 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20230905 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230918 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7363469 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |