JP6627021B2 - Lane change steering control system - Google Patents
Lane change steering control system Download PDFInfo
- Publication number
- JP6627021B2 JP6627021B2 JP2015181749A JP2015181749A JP6627021B2 JP 6627021 B2 JP6627021 B2 JP 6627021B2 JP 2015181749 A JP2015181749 A JP 2015181749A JP 2015181749 A JP2015181749 A JP 2015181749A JP 6627021 B2 JP6627021 B2 JP 6627021B2
- Authority
- JP
- Japan
- Prior art keywords
- lane
- point
- interest
- received light
- light intensity
- 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
Description
本発明は、車線変更操舵制御システムに関する。 The present invention relates to a lane change steering control system.
従来、自車線を走行する車両を隣接車線へ車線変更させる操舵制御を行う車線変更操舵制御システムが知られている。このような車線変更操舵制御システムに採用される技術として、例えば特許文献1には、カメラで撮影した画像に基づいて隣接車線の区画線の位置を検出する検出装置が記載されている。 2. Description of the Related Art Conventionally, a lane change steering control system that performs steering control for changing a vehicle traveling in a lane to an adjacent lane has been known. As a technique adopted in such a lane change steering control system, for example, Patent Document 1 discloses a detection device that detects a position of a lane marking of an adjacent lane based on an image captured by a camera.
上述した車線変更操舵制御システムでは、カメラで撮影した画像に基づいて隣接車線の区画線の位置を検出することから、例えば、車両が夜間に走行する場合、車両がトンネルを走行する場合、又は路面が濡れている場合等には、隣接車線の区画線の位置検出が困難となるおそれがある。よって、車両を隣接車線へ車線変更させる操舵制御を確実に行うことができない可能性がある。 In the above-described lane change steering control system, since the position of the lane marking of the adjacent lane is detected based on the image taken by the camera, for example, when the vehicle travels at night, when the vehicle travels through a tunnel, or on the road surface If the vehicle is wet, it may be difficult to detect the position of the lane marking of the adjacent lane. Therefore, there is a possibility that the steering control for changing the lane to the adjacent lane cannot be reliably performed.
本発明は、車両を隣接車線へ車線変更させる操舵制御を確実に行うことができる車線変更操舵制御システムを提供することを目的とする。 SUMMARY OF THE INVENTION It is an object of the present invention to provide a lane change steering control system capable of reliably performing steering control for changing a vehicle to an adjacent lane.
本発明に係る車線変更操舵制御システムは、自車線を走行する車両を自車線と隣接する隣接車線へ車線変更させる操舵制御を行う車線変更操舵制御システムであって、車両の周囲において、少なくとも隣接車線を含む路面上にレーザ光を出射し、出射したレーザ光の反射光を受光するレーザセンサと、レーザセンサの検出結果に基づいて、隣接車線における自車線と反対側の区画線の位置を検出する検出部と、検出部で検出した区画線の位置に基づいて操舵制御を実行する制御部と、を備える。 A lane change steering control system according to the present invention is a lane change steering control system that performs a steering control for changing a lane traveling in the own lane to an adjacent lane adjacent to the own lane, and at least around an adjacent lane around the vehicle. A laser sensor that emits laser light on the road surface including the reflected light of the emitted laser light, and detects a position of a lane marking in the adjacent lane opposite to the own lane based on a detection result of the laser sensor. A detection unit; and a control unit that performs steering control based on the position of the lane marking detected by the detection unit.
この車線変更操舵制御システムでは、レーザセンサの検出結果に基づき隣接車線における反対側の区画線(以下、単に「隣接車線の区画線」ともいう)の位置を検出し、その隣接車線の区画線の位置に基づき操舵制御を行っている。これにより、例えば、車両が夜間に走行する場合、車両がトンネルを走行する場合、及び路面が濡れている場合であっても、隣接車線の区画線の位置を確実に検出することができる。その結果、車両を隣接車線へ車線変更させる操舵制御を確実に行うことが可能となる。 In this lane change steering control system, the position of a lane marking on the opposite side in an adjacent lane (hereinafter, also simply referred to as “lane lane marking”) is detected based on the detection result of the laser sensor, and the lane marking of the adjacent lane is detected. Steering control is performed based on the position. Thus, for example, even when the vehicle travels at night, when the vehicle travels in a tunnel, and when the road surface is wet, the position of the lane marking of the adjacent lane can be reliably detected. As a result, it is possible to reliably perform the steering control for changing the vehicle to the adjacent lane.
本発明に係る車線変更操舵制御システムにおいて、レーザセンサは、路面上の複数の測定点における位置及び受光強度に関する情報を検出し、検出部は、車線幅方向の位置に関する複数の測定点の受光強度分布において、区画線の幅に対応する幅を有するピーク部が存在する場合、当該ピーク部の測定点の少なくとも一部を候補点として抽出し、抽出した候補点の位置に基づいて区画線の位置を検出してもよい。この構成によれば、例えば路面上に受光強度が高い他物体が存在していたとしても、この他物体を隣接車線の区画線と誤検出してしまうことを抑制することができる。その結果、隣接車線の区画線の位置を一層確実に検出することが可能となる。 In the lane change steering control system according to the present invention, the laser sensor detects information on the position and the received light intensity at a plurality of measurement points on the road surface, and the detecting unit detects the received light intensity of the plurality of measurement points regarding the position in the lane width direction. In the distribution, when there is a peak having a width corresponding to the width of the lane marking, at least a part of the measurement points of the peak is extracted as candidate points, and the position of the lane marking is determined based on the position of the extracted candidate point. May be detected. According to this configuration, even if, for example, another object having a high light receiving intensity exists on the road surface, it is possible to prevent the other object from being erroneously detected as a lane marking of an adjacent lane. As a result, it is possible to more reliably detect the position of the lane marking of the adjacent lane.
本発明に係る車線変更操舵制御システムにおいて、検出部で検出した区画線の位置を記憶する記憶部を更に備え、記憶部は、走行方向後方の走行区間を車両が走行した際に検出部で検出した区画線の位置を、区画線の既検出位置として記憶し、検出部は、記憶部に記憶された区画線の既検出位置と候補点の位置とに基づいて、区画線の位置を検出してもよい。この構成によれば、記憶部に記憶された区画線の既検出位置を利用して、隣接車線の区画線の位置を一層確実に検出することが可能となる。 The lane change steering control system according to the present invention further includes a storage unit that stores the position of the lane marking detected by the detection unit, wherein the storage unit detects the position of the lane marking detected by the detection unit when the vehicle travels in a traveling section behind the traveling direction. The detected lane marking position is stored as a lane marking already detected position, and the detecting unit detects the lane marking position based on the lane marking detected position and the candidate point position stored in the storage unit. You may. According to this configuration, it is possible to more reliably detect the position of the lane marking of the adjacent lane by using the detected position of the lane marking stored in the storage unit.
本発明に係る車線変更操舵制御システムにおいて、検出部は、複数の測定点のうち一の測定点を基準点に設定し、複数の測定点のうち、基準点に対して車線の幅方向の一方側に区画線の幅の1/2よりも小さい第1距離離れた測定点を、第1着目点に設定し、複数の測定点のうち、基準点に対して車線の幅方向の他方側に区画線の幅の1/2よりも小さい第2距離離れた測定点を、第2着目点に設定し、複数の測定点のうち、基準点に対して車線の幅方向の一方側に区画線の幅の1/2よりも大きい第3距離離れた測定点を、第3着目点に設定し、複数の測定点のうち、基準点に対して車線の幅方向の他方側に区画線の幅の1/2よりも大きい第4距離離れた測定点を、第4着目点に設定し、第1着目点の受光強度と第2着目点の受光強度との差の絶対値が第1閾値よりも小さく、第1着目点の受光強度と第3着目点の受光強度との差が第2閾値よりも大きく、かつ第2着目点の受光強度と第4着目点の受光強度との差が第3閾値よりも大きい場合に、又は、第1着目点の受光強度と第2着目点の受光強度との差の絶対値が第1閾値よりも小さく、第1着目点の受光強度と第4着目点の受光強度との差が第2閾値よりも大きく、かつ第2着目点の受光強度と第3着目点の受光強度との差が第3閾値よりも大きい場合に、基準点を候補点として抽出してもよい。この構成によれば、基準点と複数の着目点とを設定し、当該着目点における受光強度を相対的に比較することで、基準点を候補点として抽出することができる。 In the lane change steering control system according to the present invention, the detection unit sets one of the plurality of measurement points as a reference point, and one of the plurality of measurement points in the lane width direction with respect to the reference point. A measurement point that is a first distance smaller than half of the width of the lane marking is set as a first point of interest, and among a plurality of measurement points, the other side in the lane width direction with respect to a reference point is set. A measurement point separated by a second distance smaller than 1/2 of the width of the lane marking is set as a second point of interest, and a lane marking is located on one side in the lane width direction with respect to the reference point among a plurality of measurement points. A measurement point that is a third distance larger than 1/2 of the width of the lane is set as the third point of interest, and the width of the dividing line is set to the other side of the lane width direction with respect to the reference point among the plurality of measurement points. A fourth measurement point larger than 1/2 of the distance is set as the fourth point of interest, and the light reception intensity of the first point of interest and the light reception intensity of the second point of interest are determined. The absolute value of the difference is smaller than the first threshold, the difference between the received light intensity of the first point of interest and the received light intensity of the third point of interest is larger than the second threshold, and the received light intensity of the second point of interest and the fourth focused When the difference between the received light intensity of the point is larger than the third threshold, or when the absolute value of the difference between the received light intensity of the first target point and the received light intensity of the second target point is smaller than the first threshold, The difference between the received light intensity at the point of interest and the received light intensity at the fourth point of interest is greater than the second threshold, and the difference between the received light intensity at the second point of interest and the received light intensity at the third point of interest is greater than the third threshold. In such a case, the reference point may be extracted as a candidate point. According to this configuration, the reference point can be extracted as a candidate point by setting the reference point and a plurality of points of interest and relatively comparing the light receiving intensities at the points of interest.
本発明によれば、車両を隣接車線へ車線変更させる操舵制御を確実に行うことができる車線変更操舵制御システムを提供することが可能となる。 ADVANTAGE OF THE INVENTION According to this invention, it becomes possible to provide the lane change steering control system which can perform the steering control which changes a vehicle to an adjacent lane reliably.
以下、本発明に係る好適な実施形態について、図面を参照しつつ詳細に説明する。なお、同一又は相当要素には同一符号を付し、重複する説明を省略する。 Hereinafter, preferred embodiments according to the present invention will be described in detail with reference to the drawings. The same or corresponding elements are denoted by the same reference numerals, and redundant description will be omitted.
図1は、実施形態に係る車線変更操舵制御システムを示す概略ブロック図である。図2は、図1の車線変更操舵制御システムが搭載された車両を示す概略側面図である。図3は、レーザセンサによって検出される測定点を説明する概略図である。図3において、方向DFは、車両Vの進行方向であり、ここでは車線に沿っている。方向DWは、方向DFと直交する方向であり、ここでは車線幅方向である。なお、これらの方向は説明のための便宜的なものである。 FIG. 1 is a schematic block diagram illustrating a lane change steering control system according to the embodiment. FIG. 2 is a schematic side view showing a vehicle equipped with the lane change steering control system of FIG. FIG. 3 is a schematic diagram illustrating measurement points detected by the laser sensor. In FIG. 3, the direction DF is the traveling direction of the vehicle V, and here, is along the lane. The direction DW is a direction orthogonal to the direction DF, and here is the lane width direction. Note that these directions are for convenience of explanation.
車線変更操舵制御システム1は、車両Vに搭載され、自車線31を走行する車両Vを自車線31と隣接する隣接車線33へ車線変更させる操舵制御を行う。また、車線変更操舵制御システム1は、自車線31を区画する左右一対の区画線32の位置、及び隣接車線33における自車線31と反対側(自車線31に対して遠い側)の区画線34の位置を検出し、検出した区画線32,34の位置を用いて上記操舵制御を行う。適用される車両Vとしては、例えばバスやトラック等の商用車が挙げられる。なお、車両Vは、特に限定されるものではなく、例えば大型車両や中型車両、普通乗用車、小型車両、又は軽車両等のいずれであってもよい。
The lane change steering control system 1 is mounted on the vehicle V and performs steering control for changing the lane of the vehicle V running on the
区画線32,34としては、例えば、車道外側線、車線境界線、又は車道中央線等が挙げられる。車道外側線は、車道の外側の線縁を示す必要がある区間の車道の外側に設置される区画線である。車線境界線は、4車線以上の車道の区間内の車線の境界線を示す必要がある区間の車線の境界に設置される区画線である。車道中央線は、車道の幅員が5.5m以上の区間内の中央を示す必要がある車道の中央に設置される区画線である。
The
区画線32,34は、例えば路面30上に実線又は破線として設置される。図3に示す例では、区画線32は車線境界線であり、破線として設置されている。また、2つの区画線34の一方は車道外側線であり、他方は車道中央線である。これらの区画線34は、いずれも実線として設置されている。例えば日本の高速道路の場合、破線としての車線境界線は、その幅Wが0.15m、長さLが8m、間隔(間隙部の長さ)Dが12mとされている。なお、区画線32,34の寸法は、所定の法令により規定されており、例えば、区画線32,34が1本の実線の場合には、その幅が規定されており、区画線32,34が破線の場合には、その短手方向の幅と、その長手方向の間隔及び長さとが規定されている。
The
ここでの車線変更操舵制御システム1は、運転支援システムを構成しており、車両Vの運転支援を実施する。車線変更操舵制御システム1は、例えば、車両Vのドライバに異常が生じた場合に、車両Vのドライバに警報を発すると共に、車両Vを必要に応じて車線変更させつつ路肩まで誘導して停車させる。 The lane change steering control system 1 here constitutes a driving support system, and performs driving support of the vehicle V. The lane change steering control system 1, for example, when an abnormality occurs in the driver of the vehicle V, issues a warning to the driver of the vehicle V, guides the vehicle V to the shoulder while changing the lane as needed, and stops the vehicle. .
図1に示すように、車線変更操舵制御システム1は、レーザセンサ2と、ドライバ異常検出部3と、ECU(Electronic Control Unit)10と、支援実施部20と、を備えている。レーザセンサ2は、レーザ光を利用して検出対象に関する情報を検出するセンサである。図2及び図3に示すように、レーザセンサ2は、車両Vの所定の箇所(例えば、フロントグリルの中央)に取り付けられている。レーザセンサ2は、ECU10と電気的に接続されており、検出した情報をECU10に出力する。
As shown in FIG. 1, the lane change steering control system 1 includes a
図3に示すように、レーザセンサ2は、車両Vの周囲において、自車線31及び隣接車線33を含む路面30上にレーザ光を出射し、出射したレーザ光の反射光を受光する。これにより、図4に示すように、レーザセンサ2は、路面30上の複数の測定点41における位置及び受光強度Rに関する情報を検出する。具体的には、レーザセンサ2は、車両Vから一定距離前方において、車線幅方向DWに沿って並ぶ路面30上の複数の測定点41における位置及び受光強度Rに関する情報を検出する。レーザセンサ2が検出する位置に関する情報には、車線幅方向DWに沿う位置に関する情報が含まれる。車線幅方向DWに沿う位置に関する情報は、例えば車線幅方向DWを座標軸とする座標系の座標情報である。
As shown in FIG. 3, the
ドライバ異常検出部3は、車両Vのドライバの健康に起因する異常を検出するためのものである。ドライバ異常検出部3は、例えば車内カメラ及び心拍数計測器等を含み、車両Vのドライバの顔向き及び心拍数等に基づいてドライバの異常を検出する。ドライバ異常検出部3は、ECU10と電気的に接続されており、検出したドライバの異常に係る情報をECU10に出力する。
The driver abnormality detection unit 3 detects an abnormality caused by the health of the driver of the vehicle V. The driver abnormality detection unit 3 includes, for example, an in-vehicle camera, a heart rate measuring device, and the like, and detects a driver abnormality based on the driver's face orientation, heart rate, and the like of the vehicle V. The driver abnormality detection unit 3 is electrically connected to the
ECU10は、例えばCPU(Central Processing Unit)、ROM(Read OnlyMemory)、RAM(Random Access Memory)等を含むコンピュータにより構成されている。ECU10は、支援実施部20に電気的に接続されており、車両Vの運転を支援するための制御に係る信号を支援実施部20に出力する。ECU10は、その機能的構成として、検出部11と、記憶部12と、制御部13とを含んでいる。ECU10の機能的構成の一部は、区画線32,34の位置を検出する区画線検出部5を構成している。すなわち、区画線検出部5は、上述のレーザセンサ2と、検出部11と、記憶部12と、によって構成されている。
The
検出部11は、レーザセンサ2で検出した複数の測定点41における位置及び受光強度Rに関する情報に基づいて、区画線32,34の位置を検出する。検出部11は、車線幅方向DWの位置に関する複数の測定点41の受光強度分布RDにおいて、区画線32,34の幅に対応する幅を有するピーク部40が存在する場合、ピーク部40の測定点41の少なくとも一部を候補点として抽出し、候補点の位置に基づいて区画線32,34の位置を検出する。候補点の詳細については後述する。区画線32,34の幅に対応する幅とは、検出対象とする区画線32,34の幅、あるいは、当該検出対象とする区画線32,34の幅に対して検出のノイズ(誤差)に係る余裕を持たせた範囲(以下、単に「余裕範囲」という)を含ませた幅である。余裕範囲は、例えば、計測装置の最大誤差を考慮して設定することができる。
The
また、区画線32,34の幅に対応する幅は、一定の幅を有する区画線32,34を検出対象とする場合には、当該一定の幅と略等しい幅、あるいは、当該一定の幅に対して余裕範囲を含む幅とすることができる。また、区画線32,34の幅に対応する幅は、幅が異なる複数種の区画線32,34を検出対象とする場合には、複数種の区画線32,34の幅のうち最小の幅(最小幅)以上かつ最大の幅(最大幅)以下の範囲に含まれる幅、あるいは、当該最小幅よりも余裕範囲だけ小さい幅以上かつ当該最大幅よりも余裕範囲だけ大きい幅以下の幅とすることができる。
Further, the width corresponding to the width of the
一例として、検出部11は、検出対象とする区画線32,34の幅が0.15mの場合、区画線32,34の幅に対応する幅として、例えば、余裕範囲を持たせて、0.10m〜0.20mの範囲の幅を有するピーク部40の測定点41から候補点を抽出する。あるいは、検出部11は、検出対象とする区画線32,34の幅が0.15m及び0.20mの場合、区画線32,34の幅に対応する幅として、例えば、余裕範囲を持たせて、当該方向に0.08m〜0.30mの範囲の幅を有するピーク部40の測定点41から候補点を抽出する。また、検出部11は、後述の記憶部12に記憶された区画線32,34の既検出位置と候補点の位置とに基づいて、区画線32,34の位置を検出する。検出部11は、検出した区画線32,34の位置に係る情報を記憶部12及び制御部13に出力する。
As an example, when the width of the division lines 32 and 34 to be detected is 0.15 m, the
記憶部12は、検出部11によって検出された区画線32,34の位置を、既検出位置として記憶する。記憶部12は、例えばROM及びRAM等を含むメモリにより構成されている。記憶部12は、少なくとも、走行方向後方の走行区間を車両Vが走行した際に検出部11で検出済みの区画線32,34の既検出位置(以下、単に「既検出位置」という)を記憶する。走行方向後方の走行区間とは、車両Vの現在位置よりも一定距離後方の地点から車両Vの現在位置までの区間である。一定距離は、例えば、区画線32,34が破線の場合における区画線32,34の長手方向の長さ及び間隔に応じて予め設定されてもよい。具体的には、区画線32,34が日本の高速道路の車線境界線の場合、一定距離は、車線境界線の長さ(8m)及び間隔(間隙部の長さ、12m)に応じて、例えば当該長さ及び間隔の和の1.5倍の30mに設定される。
The
制御部13は、検出部11で検出した区画線32,34の位置と、ドライバ異常検出部3で検出したドライバの異常に係る情報と、に基づいて支援実施部20を制御する。支援実施部20は、操舵部21と、制動部22と、警報部23とを含んでいる。操舵部21、制動部22、及び警報部23としては、例えば、ステアリングアクチュエータ、ブレーキアクチュエータ、及び警報用スピーカ等がそれぞれ挙げられる。
The
以上のように構成された車線変更操舵制御システム1では、区画線検出部5によって区画線32,34の位置が検出される。検出された区画線32,34の位置は、既検出位置として記憶部12に記憶される。そして、車線変更操舵制御システム1では、例えば、ドライバ異常検出部3によって車両Vのドライバの異常が検出された場合、車両Vのドライバに対し警報部23により注意喚起がなされると共に、検出された区画線32,34の位置に基づいて車両Vが路肩側へ車線変更するように操舵制御され、制動部22により停止するように制動制御される。
In the lane change steering control system 1 configured as described above, the positions of the
次に、区画線32,34の位置を検出する手法について、図4及び図5を参照しつつ詳細に説明する。以下では、隣接車線33の区画線34の位置を検出する手法を説明するが、この手法と同様にして自車線31の区画線32の位置も並列的に検出される。図4は、車線幅方向DWの位置に関する複数の測定点の受光強度分布を示す概略図である。図5は、候補点を抽出する手法を説明する図である。なお、図4における横軸の「位置」は、図3の車線幅方向DWにおける位置と対応する。
Next, a method for detecting the positions of the division lines 32 and 34 will be described in detail with reference to FIGS. In the following, a method for detecting the position of the lane marking 34 of the
区画線34には、視認性等の観点から、例えばガラスビーズ等の再帰性反射材が混ぜ込まれた白色又は黄色等の塗料が用いられる。このため、区画線34では、その周囲の路面30(アスファルトやコンクリート等)と比べて、レーザセンサ2によるレーザ光の反射光の受光強度Rが高くなることが見出される。
From the viewpoint of visibility and the like, for example, a white or yellow paint mixed with a retroreflective material such as glass beads is used for the
そこで、車線変更操舵制御システム1では、レーザセンサ2により、図3に示すスキャン領域LSをスキャンして、車線幅方向DWに沿って並ぶ複数の測定点41の位置及び受光強度Rに関する情報を検出する。図4の例では、スキャン領域LSにおける複数の測定点41の受光強度Rによって受光強度分布RDが形成される。受光強度分布RDでは、スキャン領域LSに区画線34が存在する場合、区画線34に対応する位置でピーク部40が形成される。ピーク部40は、車線幅方向DWに沿う幅に対応する横軸方向の幅を有している。このピーク部40は、区画線34に対応する受光強度Rを有する複数の測定点41が並ぶことによって形成されている。ここでのピーク部40には、3つの測定点が含まれている。換言すれば、互いに隣り合う測定点41の間隔が、区画線34の幅の1/3よりも小さくなっている。例えば、区画線34の幅が0.15mの場合、測定点41の間隔は、0.05mよりも小さくなっている。なお、図4に示す受光強度分布RDでは、ピーク部40以外の部分について、受光強度Rが一定(平坦)となっているが、実際には路面30上に存在する物体や路面状態等により受光強度Rが僅かに変動し、波形状となっていてもよい。
Thus, in the lane change steering control system 1, the
上述のように、区画線34は、その周囲の路面30と比べて高い受光強度Rを有することから、検出部11は、各測定点41での受光強度Rを相対的に比較することで、受光強度Rの閾値(受光強度Rの絶対値に対して設けられる閾値)を用いることなく、ピーク部40に存在する測定点41を候補点として抽出することができる。すなわち、検出部11は、スキャン領域LSにおける複数の測定点41の全てについて、以下のように基準点及び着目点を設定し、受光強度Rを相対的に比較する。
As described above, since the
図5に示すように、検出部11は、スキャン領域LSにおける複数の測定点41のうち一の測定点41を基準点50として設定する。そして、検出部11は、当該基準点50について、区画線34の位置を検出するための以下の処理を実行する。検出部11は、例えば、所定の順番で、又はランダムな順番で、スキャン領域LSにおける複数の測定点41のすべてについて、当該処理を順次実行する。まず、検出部11は、基準点50について、複数の着目点51,52,53,54を設定する。検出部11は、基準点50に対して車線幅方向DWの一方側に第1着目点51及び第3着目点53を設定し、車線幅方向DWの他方側に第2着目点52及び第4着目点54を設定する。
As illustrated in FIG. 5, the
例えば、検出部11は、次の関係となるように着目点51〜54を設定する。すなわち、第1着目点51は、基準点50に対して、車線幅方向DWの一方側に区画線34の幅の1/2よりも小さい第1距離離れた測定点41である。第2着目点52は、基準点50に対して、車線幅方向DWの他方側に区画線34の幅の1/2よりも小さい第2距離離れた測定点41である。第3着目点53は、基準点50に対して、車線幅方向DWの一方側に区画線34の幅の1/2よりも大きい第3距離離れた測定点41である。第4着目点54は、基準点50に対して、車線幅方向DWの他方側に区画線34の幅の1/2よりも大きい第4距離離れた測定点41である。ここでの基準点50と第1着目点51とは隣り合う測定点41であり、基準点50と第2着目点52とは隣り合う測定点41であり、第1着目点51と第3着目点53とは隣り合う測定点41であり、第2着目点52と第4着目点54とは隣り合う測定点41である。
For example, the
あるいは、幅が異なる複数種の区画線34を検出対象とする場合には、第1着目点51は、基準点50に対して、車線幅方向DWの一方側に検出対象の区画線34の最小幅の1/2よりもわずかに小さい第1距離離れた測定点41である。第2着目点52は、基準点50に対して、車線幅方向DWの他方側に検出対象の区画線34の最小幅の1/2よりもわずかに小さい第2距離離れた測定点41である。第3着目点53は、基準点50に対して、車線幅方向DWの一方側に検出対象の区画線34の最大幅の1/2よりもわずかに大きい第3距離離れた測定点41である。第4着目点54は、基準点50に対して、車線幅方向DWの他方側に検出対象の区画線34の最大幅の1/2よりもわずかに大きい第4距離離れた測定点41である。
Alternatively, when a plurality of types of
ここで、区画線34の最小幅の1/2よりもわずかに小さいとは、当該検出対象とする区画線34の最小幅に対して余裕範囲だけ小さいことを意味する。また、区画線34の最小幅の1/2よりもわずかに大きいとは、当該検出対象とする区画線34の最大幅に対して余裕範囲だけ大きいことを意味する。余裕範囲は、例えば、計測装置の最大誤差を考慮して設定することができる。
Here, being slightly smaller than 1 / of the minimum width of the
第1着目点51と第2着目点52との間の距離(=第1距離+第2距離)は、例えば一定の幅を有する区画線34を検出対象とする場合には、区画線34の幅よりも短く、また、第3着目点53と第4着目点54との間の距離(=第3距離+第4距離)は、区画線34の幅よりも長い。あるいは、例えば幅が異なる複数種の区画線34を検出対象とする場合には、第1着目点51と第2着目点52との間の距離(=第1距離+第2距離)は、区画線34の最小幅よりも短く、また、第3着目点53と第4着目点54との間の距離(=第3距離+第4距離)は、区画線34の最大幅よりも長い。
The distance between the first point of
第1着目点51の受光強度R1と第2着目点52の受光強度R2との差の絶対値が第1閾値dR1よりも小さく、第1着目点51の受光強度R1と第3着目点53の受光強度R3との差が第2閾値dR2よりも大きく、かつ第2着目点52の受光強度R2と第4着目点54の受光強度R4との差が第3閾値dR3よりも大きい場合、図5に示す例のように、第1着目点51及び第2着目点52がピーク部40に存在し、かつ、第3着目点53及び第4着目点54がピーク部40に存在しないと判断される。そのため、この場合、検出部11によって基準点50を候補点42として抽出する。
The absolute value of the difference between the light receiving intensity R1 of the first point of
第1閾値dR1、第2閾値dR2及び第3閾値dR3は、上記受光強度Rの差(相対値)についての閾値である。第1閾値dR1は、例えば、ピーク部40における測定点41同士の受光強度Rの差を複数求め、これらの最大値を実験的に求めた値とされていてもよい。この場合、差を求める測定点41同士は、同一のピーク部40に含まれていることが好ましい。第2閾値dR2は、例えば、一のピーク部40における測定点41とピーク部40以外の位置における測定点41との受光強度Rの差を複数求め、これらの最小値を実験的に求めた値とされていてもよい。この場合、ピーク部40以外の位置における測定点41は、当該一のピーク部40と、当該一のピーク部40と隣り合うピーク部40との間に位置していることが好ましい。第3閾値dR3は、例えば、第2閾値dR2と同じ値とされていてもよい。
The first threshold dR1, the second threshold dR2, and the third threshold dR3 are thresholds for the difference (relative value) of the received light intensity R. The first threshold value dR1 may be, for example, a value obtained by obtaining a plurality of differences in the received light intensity R between the measurement points 41 in the
例えば、一定の幅を有する区画線34として、車線幅方向DWに沿う幅が0.15mの区画線34を検出対象とする場合、第1距離及び第2距離は0.05mとされ、第3距離及び第4距離は0.10mとされてもよい。この場合、検出部11は、横軸方向に0.10m〜0.20mの範囲の幅を有するピーク部40から候補点42を抽出し、車線幅方向DWに沿う幅が0.15mの区画線34を検出できる。あるいは、幅が異なる複数の区画線34として、車線幅方向DWに沿う幅が0.15m及び0.20mの区画線34を検出対象とする場合、第1距離及び第2距離は0.04mとされ、第3距離及び第4距離は0.15mとされる。これにより、検出部11は、横軸方向に0.08m〜0.30mの範囲の幅を有するピーク部40が存在する場合、当該ピーク部40から候補点42を抽出し、車線幅方向DWに沿う幅が0.15m及び0.20mの区画線34の位置を検出できる。
For example, when a lane marking 34 having a constant width and a width of 0.15 m along the lane width direction DW is to be detected, the first distance and the second distance are set to 0.05 m, and the third distance is set to 0.05 m. The distance and the fourth distance may be set to 0.10 m. In this case, the
なお、上記の例では、第1距離と第2距離とを等しい距離としているが、異なる距離としてもよい。同様に、第3距離と第4距離とを等しい距離としているが、異なる距離としてもよい。要は、第1距離及び第2距離は、区画線の幅の1/2よりも小さく、第3距離及び第4距離は、区画線の幅の1/2よりも大きければよい。ちなみに、路面30上に複数列の区画線34が描かれている場合には、第3距離及び第4距離は、これらの区画線34の間隔よりも小さい距離とされる。
In the above example, the first distance and the second distance are equal, but may be different. Similarly, the third distance and the fourth distance are equal, but may be different. In short, the first distance and the second distance may be smaller than の of the width of the dividing line, and the third distance and the fourth distance may be larger than 1 / of the width of the dividing line. Incidentally, when a plurality of rows of the
次に、検出部11による区画線34の位置の検出処理手順について具体的に説明する。まず、候補点42を抽出する処理手順について説明する。図6は、図1の車線変更操舵制御システム1において候補点42を抽出する処理を示すフローチャートである。
Next, a procedure for detecting the position of the
図4に示すように、まず、複数の測定点41の中から一の測定点41が基準点50として設定される(S1)。また、ステップS1では、当該基準点50に対する着目点51,52,53,54が設定される。S1の後、下式(1)が成立するか否かに基づいて、第1着目点51の受光強度R1と第2着目点52の受光強度R2との差の絶対値が第1閾値dR1よりも小さいか否かが判定される(S2)。
|R1−R2|<dR1 …(1)
As shown in FIG. 4, first, one of the plurality of measurement points 41 is set as a reference point 50 (S1). In step S1, points of
| R1-R2 | <dR1 (1)
上記ステップS2において、第1着目点51の受光強度R1と第2着目点52の受光強度R2との差の絶対値が第1閾値dR1よりも小さいと判定された場合、下式(2)が成立するか否かに基づいて、第1着目点51の受光強度R1と第3着目点53の受光強度R3との差が第2閾値dR2よりも大きいか否かが判定される(S3)。一方、上記ステップS2において、第1着目点51の受光強度R1と第2着目点52の受光強度R2との差の絶対値が第1閾値dR1よりも小さくないと判定された場合、当該基準点50は候補点42ではないと判断されて、後述のステップS6の処理が行われる。
R1−R3>dR2 …(2)
If it is determined in step S2 that the absolute value of the difference between the received light intensity R1 of the first point of
R1-R3> dR2 (2)
上記ステップS3において、第1着目点51の受光強度R1と第3着目点53の受光強度R3との差が第2閾値dR2よりも大きいと判定された場合、下式(3)が成立するか否かに基づいて、第2着目点52の受光強度R2と第4着目点54の受光強度R4との差が第3閾値dR3よりも大きいか否かが判定される(S4)。一方、上記ステップS3において、第1着目点51の受光強度R1と第3着目点53の受光強度R3との差が第2閾値dR2よりも大きくないと判定された場合、当該基準点50は候補点42ではないと判断されて、後述のステップS6の処理が行われる。
R2−R4>dR3 …(3)
If it is determined in step S3 that the difference between the received light intensity R1 of the
R2-R4> dR3 (3)
上記ステップS4において、第2着目点52の受光強度R2と第4着目点54の受光強度R4との差が第3閾値dR3よりも大きいと判定された場合、当該基準点50は候補点42であると判断できる。よって、当該基準点50が候補点42として抽出され、当該基準点50の位置が候補点42の位置とされる(S5)。その後、後述のステップS6の処理が行われる。
In step S4, when it is determined that the difference between the received light intensity R2 of the
一方、上記ステップS4において、第2着目点52の受光強度R2と第4着目点54の受光強度R4との差が第3閾値dR3よりも大きくないと判定された場合、当該基準点50は候補点42ではないと判断されて、後述のステップS6の処理が行われる。
On the other hand, if it is determined in step S4 that the difference between the received light intensity R2 of the
ステップS6では、レーザセンサ2のスキャン領域LSの範囲における全ての測定点41について、基準点50を設定して上記ステップS2〜上記ステップS5の処理を実行(候補点42の探索)したか否かが判定される。ステップS6において、全ての測定点41について候補点42の探索をしたと判定された場合、そのまま処理が終了される。一方、全ての測定点41について候補点42の探索をしていないと判定された場合、上記ステップS1に移行され、未探索の別の測定点41に基準点50が設定されて候補点42の抽出が継続される。
In step S6, the
続いて、抽出した候補点42の位置に基づき区画線34の位置を検出する処理手順について説明する。図7は、図1の車線変更操舵制御システム1において候補点42に基づき区画線34を検出する処理を示すフローチャートである。
Subsequently, a processing procedure for detecting the position of the
車線変更操舵制御システム1は、隣接車線33の区画線34の位置として、左側の区画線34の位置と、右側の区画線34の位置と、をそれぞれ検出している。以下では、一方の区画線34の位置を検出する処理を説明するが、この処理と同様にして他方の区画線34の位置も並列的に検出される。区画線34の位置とは、車線幅方向DWの位置であって、レーザセンサ2の座標系における位置である。レーザセンサ2の座標系は、当該レーザセンサ2が車両Vに取り付けられていることから、車両Vの進行につれて車両Vの進行方向DFに移動する。
The lane change steering control system 1 detects the position of the left lane marking 34 and the position of the right lane marking 34 as the positions of the
図7に示すように、まず、記憶部12に記憶された区画線34の既検出位置にフィッティングされた二次曲線で区画線34を推定可能か否かが判定される(S8)。二次曲線で区画線34を推定可能でない場合としては、例えば車線変更操舵制御システム1による区画線34の検出開始後、車両Vが一定距離未満しか走行しておらず、記憶されているデータ量が二次曲線によるフィッティングを行うためのデータ量に足りていない場合等が挙げられる。
As shown in FIG. 7, first, it is determined whether or not the
上記ステップS8において、二次曲線で区画線34を推定可能でないと判定された場合、前回検出された区画線34の位置付近に候補点42があるか否かが判定される(S9)。ここでは、前回検出された区画線34の位置として、記憶部12に記憶された区画線34の既検出位置のうち最も新しい(直近の)既検出位置が用いられる。位置付近とは、例えばその位置から一定範囲内を意味し、経験上又は計算上、車線幅方向DWから0.2mの範囲内とすることができる(以下、同じ)。なお、位置付近の範囲については、要求される精度等に応じて、様々の値としてもよい。
If it is determined in step S8 that the
上記ステップS9において、前回検出された区画線34の位置付近に候補点42があると判定された場合、前回検出された区画線34の位置に候補点42が連続し、候補点42の位置が区画線34の位置である可能性が高いと判断できる。よって、後述のステップS12の処理が行われる。一方、上記ステップS9において、前回検出された区画線34の位置付近に候補点42がないと判定された場合、当該候補点42の位置が区画線34の位置として検出されることなく、処理が終了される。なお、候補点42の位置が区画線34の位置として検出されなかった場合、自車線31の区画線32の位置の検出結果を利用して区画線34の位置を検出してもよい。
In step S9, when it is determined that there is a
一方、上記ステップS8において、二次曲線で区画線34を推定可能であると判定された場合、当該推定された区画線34から区画線34の位置(予測位置)が予測される(S10)。ステップS10では、例えば、記憶部12に記憶された区画線34の既検出位置に対して最小二乗法を用いて二次曲線をフィッティングし、区画線34を推定する。そして、この区画線34上に今回検出されるであろう区画線34の位置が存在するとして、区画線34の予測位置を求めることができる。そして、当該区画線34の予測位置付近に候補点42があるか否かが判定される(S11)。
On the other hand, if it is determined in step S8 that the
上記ステップS11において、区画線34の予測位置付近に候補点42があると判定された場合、候補点42の位置が区画線34の位置である可能性が高いと判断できる。よって、後述のステップS12の処理が行われる。一方、上記ステップS11において、区画線34の予測位置付近に候補点42がないと判定された場合、当該候補点42の位置が区画線34の位置として検出されることなく、処理が終了される。
If it is determined in step S11 that there is a
ステップS12では、上記ステップS9及びステップS11において候補点42の値が区画線34の位置である可能性が高いと判断されたことから、当該候補点42の位置が区画線34の位置として検出される。そして、ステップS12は、当該検出された区画線34の位置は、検出済みの区画線34の既検出位置として記憶部12に記憶される。その後、処理が終了される。
In step S12, since it is determined that the value of the
次に、自車線31を走行する車両Vを隣接車線33へ車線変更させる処理について説明する。図8は、車両Vの車線変更の移動軌跡を示す図である。図9は、基準走行軌跡M1を示す図である。
Next, a process of changing the lane of the vehicle V traveling on the
図8において、横軸は進行方向DFにおける位置であり、縦軸は車線幅方向DWにおける位置である。符号P1は、移動開始時刻における位置(移動開始位置)を示し、符号P2は、移動完了時刻における位置(移動完了位置)を示している。移動開始位置P1における車線幅方向DWの位置は、自車線31内の所定位置に設定されており、ここでは自車線31の中央に設定されている。移動完了位置P2における車線幅方向DWの位置は、隣接車線33内の所定位置に設定されており、ここでは隣接車線33の中央に設定されている。本実施形態では、車線変更前には車両Vが自車線31の中央を走行するように操舵制御がなされており(レーンキープ)、この状態から車両Vの目標走行位置を隣接車線33の中央に変更させる車線変更が行われる。
In FIG. 8, the horizontal axis is a position in the traveling direction DF, and the vertical axis is a position in the lane width direction DW. Reference numeral P1 indicates a position (movement start position) at the movement start time, and reference numeral P2 indicates a position (movement completion position) at the movement completion time. The position in the lane width direction DW at the movement start position P1 is set at a predetermined position in the
車線変更操舵制御システム1では、車線変更の際の基準となる基準走行軌跡M1が予め設定されている。基準走行軌跡M1は、例えばECU10のROMに記憶されており、制御部13より参照される。図9に示すように、基準走行軌跡M1は、車線幅方向DWにおける車両Vの位置に関する横位置軸(第1軸)と、時間に関する時間軸(第2軸)とを含む座標系において表されている。ここでは、基準走行軌跡M1は、車線幅方向DWにおける車両Vの移動開始位置からの距離yと、移動開始後の経過時間tとの関係で表されている。基準走行軌跡M1は、所定の基準時間T(例えば、10秒)をかけて、車線幅方向DWに基準距離W1だけ移動させる場合の車両Vの軌跡として規定されている。車線変更操舵制御システム1では、後述するように、基準走行軌跡M1を横位置軸方向及び/又は時間軸方向に変形させることにより実走行軌跡M2(図8)が算出され、車線変更時には、算出された実走行軌跡M2に沿って車両Vが移動するように操舵制御が行われる。
In the lane change steering control system 1, a reference travel locus M1 serving as a reference when changing lanes is set in advance. The reference traveling locus M1 is stored in, for example, the ROM of the
基準走行軌跡M1は、例えば熟練ドライバによる車線変更の移動軌跡を模擬した曲線となっており、ここではロジスティック曲線により規定されている。基準走行軌跡M1は、ロジスティック曲線により規定すると、下記数1で表される。
ここで、パラメータa,b,cは、ロジスティック曲線の形状を決定する定数である。
上記数1を熟練ドライバによる車線変更を測定したデータに対してフィッティングすることにより、下記数2が得られた。本実施形態では、下記数2を基準走行軌跡M1とした。
Here, the parameters a, b, and c are constants that determine the shape of the logistic curve.
By fitting the above equation (1) to data obtained by measuring lane changes by a skilled driver, the following equation (2) was obtained. In the present embodiment, the following
図9に示すように、基準走行軌跡M1(ロジスティック曲線)における移動開始時刻の傾き及び移動完了時刻の傾きは共に0である。また、基準走行軌跡M1の傾きは、移動開始時刻と移動完了時刻との中間時刻において最大となっている。これにより、車両Vが基準走行軌跡M1に沿って移動した場合の軌跡が滑らかになり、車線変更時に車両Vに過大な横加速度が作用することが抑制される。 As shown in FIG. 9, the slope of the movement start time and the slope of the movement completion time on the reference traveling locus M1 (logistic curve) are both 0. The inclination of the reference traveling locus M1 is maximum at an intermediate time between the movement start time and the movement completion time. Thereby, the locus when the vehicle V moves along the reference traveling locus M1 becomes smooth, and the excessive lateral acceleration acting on the vehicle V when changing lanes is suppressed.
図10は、図1の車線変更操舵制御システム1において車両Vを自車線31から隣接車線33へ車線変更させる処理を示すフローチャートである。車両Vを隣接車線33へ車線変更させる場合、まず、制御部13により、区画線34の位置に基づいて、車両Vを車線変更させた場合の実移動距離W2(図8)が算出される(S14)。例えば、区画線34の位置に基づいて隣接車線33の中央を特定し、隣接車線33の中央から自車線31の中央までの車線幅方向DWにおける距離を算出することで、実移動距離W2が算出される。
FIG. 10 is a flowchart showing a process of changing the lane of the vehicle V from the
続いて、制御部13により、基準走行軌跡M1を実移動距離W2に応じて横位置軸方向に変形され、実走行軌跡M2が算出される(S15)。例えば、基準距離W1に対する実移動距離W2の比に従って基準走行軌跡M1を横位置軸方向に比例的に伸縮させることで、実走行軌跡M2が算出される。これにより、基準走行軌跡M1の車線幅方向DWのスケールが調整され、車線幅方向DWに実移動距離W2だけ移動させる場合の実走行軌跡M2が得られる。
Subsequently, the
続いて、制御部13により、基準時間Tをかけて実走行軌跡M2に沿って車両Vを移動させた場合に車両Vに作用する最大横加速度が算出される(S16)。最大横加速度の算出手法は、特に限定されず、公知の手法を用いることができる。なお、最大横加速度は、車両Vがカーブ路を走行する場合には、遠心力に起因して車両Vに作用する横加速度も考慮して算出される。
Subsequently, the
続いて、制御部13により、ステップS16で算出した最大横加速度が、所定の基準横加速度よりも小さいか否かが判定される(S17)。ステップS17において最大横加速度が基準横加速度よりも小さいと判定された場合、制御部13により、実走行軌跡M2に沿って車両Vが移動するように操舵制御が実行される(S18)。基準横加速度の値は、例えばECU10のROMに記憶されており、制御部13より参照される。
Subsequently, the
一方、ステップS17において最大横加速度が基準横加速度以上であると判定された場合、制御部13により、最大横加速度が基準横加速度よりも小さくなるように実走行軌跡M2を時間軸方向に変形させる処理が実行される(S19)。例えば、最大横加速度と基準横加速度との差分の大きさに応じて実走行軌跡M2を時間軸方向に伸長させることで、最大横加速度が基準横加速度よりも小さくなるように実走行軌跡M2を変形させる。そして、変形後の実走行軌跡M2に沿って車両Vが移動するように操舵制御が実行される(S18)。
On the other hand, when it is determined in step S17 that the maximum lateral acceleration is equal to or greater than the reference lateral acceleration, the
基準横加速度の値は、例えば安全性や乗り心地の観点等から経験的に又は実験的に設定される。例えば、当該値を超えた場合にドライバが不快に感じる値が基準横加速度として設定されてもよいし、当該値を超えた場合に車両Vの車両挙動が不安定になってしまう値が基準横加速度として設定されてもよい。車両挙動を考慮して基準横加速度を設定する場合、バスやトラック等の重心が高い車両Vにおいては、より車両挙動が不安定となり易い点を考慮することが好ましい。また、車速が大きい場合には車両挙動が不安定となり易いことから、現在の車速に応じて基準横加速度の大きさが変更される構成としてもよい。 The value of the reference lateral acceleration is set empirically or experimentally, for example, from the viewpoint of safety and riding comfort. For example, a value at which the driver feels uncomfortable when exceeding the value may be set as the reference lateral acceleration, or a value at which the vehicle behavior of the vehicle V becomes unstable when exceeding the value may be set as the reference lateral acceleration. It may be set as acceleration. When the reference lateral acceleration is set in consideration of the vehicle behavior, it is preferable to take into consideration that the vehicle behavior of the vehicle V having a high center of gravity, such as a bus or a truck, is more likely to be unstable. In addition, when the vehicle speed is high, the behavior of the vehicle is likely to be unstable. Therefore, the configuration may be such that the magnitude of the reference lateral acceleration is changed according to the current vehicle speed.
上記ステップS18における処理により、車両Vが自車線31から隣接車線33へ車線変更する。この際、車両Vの車線幅方向DWにおける中心が自車線31における隣接車線33側の区画線32を超えた時点で、車線変更が行われたと判定される。車線変更が行われたと判定された場合、車線変更先の隣接車線33が自車線31となるように車線情報が更新される。
By the processing in step S18, the vehicle V changes lanes from the
以上、車線変更操舵制御システム1では、レーザセンサ2の検出結果に基づき隣接車線33の区画線34の位置が検出され、検出された区画線34の位置に基づき操舵制御が行われる。これにより、例えば、車両Vが夜間に走行する場合、車両Vがトンネルを走行する場合、及び路面が濡れている場合であっても、隣接車線33の区画線34の位置を確実に検出することができる。その結果、車両Vを隣接車線33へ車線変更させる操舵制御を確実に行うことが可能となる。
As described above, in the lane change steering control system 1, the position of the lane marking 34 of the
隣接車線33の区画線34は自車線31の区画線32よりも車両Vから遠いため、区画線34の検出は区画線32の検出よりも難しい。これに対し、車線変更操舵制御システム1では、レーザセンサ2を用いて区画線34の位置を検出するため、区画線34の位置を確実に(ロバストに)検出することができる。
Since the lane marking 34 of the
車線変更操舵制御システム1では、受光強度分布RDにおいて区画線34の幅に対応する幅を有するピーク部40が存在する場合、検出部11により、ピーク部40の測定点41の少なくとも一部が候補点42として抽出され、抽出された候補点42の位置に基づいて区画線34の位置が検出される。これにより、例えば路面30上に受光強度Rが高い他物体が存在していたとしても、この他物体を隣接車線33の区画線34と誤検出するのを抑制することができる。その結果、隣接車線33の区画線34の位置を一層確実に検出することが可能となる。
In the lane change steering control system 1, when there is a
車線変更操舵制御システム1では、走行方向後方の走行区間を車両Vが走行した際に検出部11で検出された区画線34の位置が、区画線34の既検出位置として記憶部12に記憶される。検出部11では、記憶部12に記憶された区画線34の既検出位置と候補点42の位置とに基づいて、区画線34の位置が検出される。これにより、記憶部12に記憶された区画線34の既検出位置を利用して、隣接車線33の区画線34の位置を一層確実に検出することが可能となる。その結果、何らかの原因により比較的短い時間においてピーク部40を検出できなかった場合でも、記憶部12に記憶された区画線34の既検出位置を利用して、暫くの間は区画線34の位置を検出することが可能となる。ピーク部40を検出できない場合としては、例えば隣接車線33を走行する他の車両がレーザセンサ2からのレーザ光を遮ってしまう場合が挙げられる。
In the lane change steering control system 1, the position of the lane marking 34 detected by the
受光強度Rに基づいて区画線34の位置を検出する手法としては、例えば受光強度Rの絶対値に対してある閾値を設けて、閾値を超えた部分の幅に基づく手法も考えられる。これに対し、車線変更操舵制御システム1では、検出部11により、複数の測定点41について基準点50、第1着目点51、第2着目点52、第3着目点53及び第4着目点54が設定され、第1着目点51の受光強度R1と第2着目点52の受光強度R2との差の絶対値が第1閾値dR1よりも小さく、第1着目点51の受光強度R1と第3着目点53の受光強度R3との差が第2閾値dR2よりも大きく、かつ第2着目点52の受光強度R2と第4着目点54の受光強度R4との差が第3閾値dR3よりも大きい場合、基準点50が候補点42として抽出される。よって、受光強度Rの絶対値に対しての閾値を用いることなく(換言すると、定量的ではなく定性的に)、ピーク部40の測定点41を候補点42として抽出することが実現可能となる。
As a method of detecting the position of the
図4に示すように、受光強度分布RDには、区画線32に対応するピーク部40と区画線34に対応するピーク部40とが含まれており、区画線34の受光強度Rは、区画線32の受光強度Rよりも小さくなっている。車線変更操舵制御システム1では、区画線32,34の両方の位置が検出され、検出された区画線32,34のうちの車両Vから遠く受光強度Rの絶対値が小さい方が区画線34として検出されることになり、区画線34の位置を確実に検出することが可能となる。
As shown in FIG. 4, the received light intensity distribution RD includes a
路面30には、幅が異なる複数種の区画線34が設置されることがある。この場合、車線変更操舵制御システム1では、幅が異なる複数種の区画線34を検出対象とする場合には、検出部11により、第1距離は、検出対象の区画線34の最小幅の1/2よりもわずかに小さい距離とされ、第2距離は、検出対象の区画線34の最小幅の1/2よりもわずかに小さい距離とされ、第3距離は、検出対象の区画線34の最大幅の1/2よりもわずかに大きい距離とされ、第4距離は、検出対象の区画線34の最大幅の1/2よりもわずかに大きい距離とされる。このように、検出対象とする区画線34の最小幅及び最大幅を利用して、第1距離、第2距離、第3距離及び第4距離を設定することにより、最小幅以上最大幅以下の幅に対応するピーク部40の測定点41が候補点42として抽出されることとなり、幅が異なる複数種の区画線34の位置を精度よく検出することが可能となる。
A plurality of types of
なお、例えば、行き先を示す文字や矢印等の路面標示等が路面30に記されている場合や、区画線34以外に受光強度Rが高い他物体が路面30上にある場合等、ノイズとしての受光強度Rが大きくなることで区画線34が誤検出される可能性がある。そこで、本実施形態では、例えば高速道路における区画線34が料金所等の一部を除いて実線又は破線とされて連続的に延びていることを利用して、検出済みの区画線34の既検出位置から次に検出されるであろう区画線34の位置の予測を行い、区画線34の候補の関連付けを行っている(上記S9参照)。これにより、上記路面標示等を区画線34として誤検出することや、他物体を区画線34として誤検出することを抑制し、車両Vから見た区画線34の位置をロバストに検出することができる。
It should be noted that, for example, when a road sign such as a character indicating a destination or an arrow is written on the
また、車線変更操舵制御システム1では、隣接車線33の区画線34の位置に基づいて、自車線31から隣接車線33へ車線変更させる際に車両Vが車線幅方向DWに移動する実移動距離W2を算出する(S14)と共に、予め設定された基準走行軌跡M1を実移動距離W2に応じて横位置軸方向に変形させることにより実走行軌跡M2を算出する(S15)。そして、算出した実走行軌跡M2に沿って車両Vが移動するように操舵制御を実行する(S18)。これにより、車線変更時に車両Vが実際に移動する実移動距離W2に応じて基準走行軌跡M1の車線幅方向DWのスケールが調整され、得られた実走行軌跡M2に沿って車両Vが移動することとなる。したがって、急な操舵を伴う操舵制御が行われることが抑制され、滑らかな車線変更を実現することができる。その結果、車線変更時における車両挙動を安定化することが可能となる。
Further, in the lane change steering control system 1, based on the position of the lane marking 34 of the
車線変更操舵制御システム1では、実走行軌跡M2に沿って車両Vを移動させた場合に車両Vに作用する最大横加速度が基準横加速度よりも小さくなるように、実走行軌跡M2を時間軸方向に変形させる(S19)。このため、車両Vに作用する車線幅方向DWの加速度を基準横加速度よりも小さくすることができ、車線変更時における車両挙動をより安定化することが可能となる。 In the lane change steering control system 1, the actual traveling locus M2 is changed in the time axis direction so that the maximum lateral acceleration acting on the vehicle V when the vehicle V moves along the actual traveling locus M2 becomes smaller than the reference lateral acceleration. (S19). Therefore, the acceleration acting on the vehicle V in the lane width direction DW can be made smaller than the reference lateral acceleration, and the vehicle behavior when changing lanes can be further stabilized.
従来の車線変更操舵制御システムでは、車線変更の際に、目標走行位置が自車線31の中央から隣接車線33の中央に変更された場合、目標走行位置と現在の走行位置との間の横偏差が突然大きくなってしまうため、急な操舵を伴う操舵制御が行われてしまうおそれがある。これに対し、車線変更操舵制御システム1では、少なくとも基準時間Tよりも長い時間をかけて、所定の基準横加速度よりも小さい横加速度で車両Vを車線変更させることから、そのような急な操舵を伴う操舵制御が行われることを抑制でき、滑らかな車線変更(熟練ドライバによる運転を模擬できる車線変更)を実現することが可能となる。
In the conventional lane change steering control system, when the target travel position is changed from the center of the
車線変更操舵制御システム1では、基準走行軌跡M1は、ロジスティック曲線により規定されている。基準走行軌跡M1における移動開始時刻の傾き及び移動完了時刻の傾きは0であり、基準走行軌跡M1の傾きは、移動開始時刻と移動完了時刻との中間時刻において最大となっている。このため、一層滑らかな車線変更を実現することができ、車線変更時における車両挙動をより一層安定化することが可能となる。 In the lane change steering control system 1, the reference traveling locus M1 is defined by a logistic curve. The inclination of the movement start time and the inclination of the movement completion time in the reference traveling trajectory M1 are 0, and the inclination of the reference traveling trajectory M1 is maximum at an intermediate time between the movement start time and the movement completion time. Therefore, a smoother lane change can be realized, and the vehicle behavior at the time of the lane change can be further stabilized.
以上、本発明に係る好適な実施形態について説明したが、本発明は、上記実施形態に限られるものではない。例えば、上記実施形態では、レーザセンサ2を車両Vのフロントグリルの中央に取り付けたが、レーザセンサ2は、車両Vの周囲の路面30上の複数の測定点41における位置及び受光強度Rに関する情報を検出することができれば、車両Vのフロントグリルの中央以外(例えば車両Vのサイドミラー)に取り付けられてもよい。
The preferred embodiment according to the present invention has been described above, but the present invention is not limited to the above embodiment. For example, in the above-described embodiment, the
上記実施形態では、検出した区画線34の位置に基づく運転支援の一例として、車両Vのドライバに異常が生じた場合の運転支援(車両Vのドライバに警報を発すると共に、車両Vを必要に応じて車線変更させつつ路肩に停車させる支援)を挙げたが、他の運転支援であってもよい。 In the above embodiment, as an example of the driving support based on the detected position of the lane marking 34, the driving support when an abnormality occurs in the driver of the vehicle V (alerts a warning to the driver of the vehicle V and sets the vehicle V as necessary) (The support to stop the vehicle on the roadside while changing lanes), but other driving support may be used.
上記実施形態では、レーザセンサ2は、図3に示すように、車両Vから一定距離前方において車線幅方向DWに沿うスキャン領域LSをスキャンしたが、例えば、車両Vから一定距離後方又は一定距離側方において路面30上をスキャンしてもよい。
In the above embodiment, as shown in FIG. 3, the
上記実施形態では、候補点42の抽出に際し、受光強度R1,R3の差が第2閾値dR2よりも大きいか否か、及び受光強度R2,R4の差が第3閾値dR3よりも大きいか否かを判定したが、これに代えて、受光強度R1,R4の差が第2閾値dR2よりも大きいか否か、及び受光強度R2,R3との差が第3閾値dR3よりも大きいか否かを判定してもよい。
In the above embodiment, when the
上記実施形態では、基準点50に対して、4つの着目点51,52,53,54を設定したが、更に多くの着目点を設定してもよい。例えば、基準点50に対して、車線幅方向DWの一方側に第1距離よりも大きく第3距離よりも小さい第5距離離れた第5着目点を設定し、基準点50に対して、車線幅方向DWの他方側に第2距離よりも大きく第4距離よりも小さい第6距離離れた第6着目点を設定してもよい。この場合、着目点51,52,55,56における受光強度R1,R2,R5,R6の差を計算し、更に着目点55,56,53,54における受光強度R5,R6,R3,R4の差を計算することで、横軸方向に(第1距離+第2距離)〜(第5距離+第6距離)の範囲の幅を有するピーク部40と、横軸方向に(第5距離+第6距離)〜(第3距離+第4距離)の範囲の幅を有するピーク部40とが区別可能となる。このように、着目点の数及び着目点間の距離に応じて、ピーク部40の幅を測定することができる。
In the above embodiment, four points of
上記実施形態では、次の手法により候補点42を抽出してもよい。すなわち、基準点50の受光強度R0を用いた下式(A)〜(D)を満たす場合、当該基準点50を候補点42として抽出してもよい。ただし、所定値th1は、区画線34と認識される受光強度と区画線34以外と認識される受光強度との差の最低値である。所定値th2は、区画線34と認識される受光強度のうちの最小値と最大値との差である。
|R1−R0|>th1 …(A)
|R4−R0|>th1 …(B)
|R1−R0|<th2 …(C)
|R2−R0|<th2 …(D)
In the above embodiment, the
| R1-R0 |> th1 (A)
| R4-R0 |> th1 (B)
| R1-R0 | <th2 (C)
| R2-R0 | <th2 (D)
上記実施形態において、候補点42の抽出する手法としては、区画線34の幅に対応する幅を有するピーク部40の測定点41を候補点42として抽出すればよく、上記実施形態に限定されない。例えば、各測定点41それぞれの受光強度が閾値以上かどうかを判定することにより、ピーク部を構成する測定点41を特定して候補点42を抽出してもよい。
In the above embodiment, the method of extracting the
上記実施形態では、基準点50と第1着目点51とは隣り合う測定点41であったが、これらの間に一又は複数の測定点41が存在していてもよい。このような場合としては、例えば測定点41の間隔が上記実施形態よりも小さい場合等が挙げられる。同様に、基準点50と第2着目点52との間、第1着目点51と第3着目点53との間、及び第2着目点52と第4着目点54との間にも、一又は複数の測定点41が存在していてもよい。
In the above embodiment, the
上記実施形態では、レーザセンサ2によって自車線31の区画線32及び隣接車線33の区画線34の両方の位置を検出したが、レーザセンサ2によって区画線34の位置のみを検出してもよく、例えば区画線32の位置については車載カメラ等を用いて検出してもよい。この場合、レーザセンサ2は、車両Vの周囲において、必ずしも自車線31及び隣接車線33を含む路面30上にレーザ光を出射する必要はなく、少なくとも隣接車線33を含む路面30上にレーザ光を出射すればよい。
In the above embodiment, the
上記実施形態において、隣接車線33の区画線34の検出に失敗している場合、自車線31の区画線32の検出結果に基づいて区画線34の位置を推測してもよい。この場合、区画線34の検出に失敗している場合でも、区画線32の検出位置を利用して区画線34の位置を検出することができる。
In the above embodiment, when the detection of the lane marking 34 of the
1…車線変更操舵制御システム、2…レーザセンサ、11…検出部、12…記憶部、13…制御部、30…路面、31…自車線、33…隣接車線、34…区画線、40…ピーク部、41…測定点、42…候補点、50…基準点、51…第1着目点、52…第2着目点、53…第3着目点、54…第4着目点、V…車両、R…受光強度、RD…受光強度分布。 DESCRIPTION OF SYMBOLS 1 ... Lane change steering control system 2: Laser sensor, 11 ... Detection part, 12 ... Storage part, 13 ... Control part, 30 ... Road surface, 31 ... Own lane, 33 ... Neighboring lane, 34 ... Partition line, 40 ... Peak Part, 41: Measurement point, 42: Candidate point, 50: Reference point, 51: First attention point, 52: Second attention point, 53: Third attention point, 54: Fourth attention point, V: Vehicle, R ... Received light intensity, RD ... Received light intensity distribution
Claims (2)
前記車両の周囲において、少なくとも前記隣接車線を含む路面上にレーザ光を出射し、出射した前記レーザ光の反射光を受光するレーザセンサと、
前記レーザセンサの検出結果に基づいて、前記隣接車線における前記自車線と反対側の区画線の位置を検出する検出部と、
前記検出部で検出した前記区画線の位置に基づいて前記操舵制御を実行する制御部と、を備え、
前記レーザセンサは、前記路面上の複数の測定点における位置及び受光強度に関する情報を検出し、
前記検出部は、
車線幅方向の位置に関する複数の前記測定点の受光強度分布において、前記区画線の幅に対応する幅を有するピーク部が存在する場合、当該ピーク部の前記測定点の少なくとも一部を候補点として抽出し、
抽出した前記候補点の位置に基づいて前記区画線の位置を検出し、
前記検出部は、
複数の前記測定点のうち一の測定点を基準点に設定し、
複数の前記測定点のうち、前記基準点に対して前記車線幅方向の一方側に前記区画線の幅の1/2よりも小さい第1距離離れた測定点を、第1着目点に設定し、
複数の前記測定点のうち、前記基準点に対して前記車線幅方向の他方側に前記区画線の幅の1/2よりも小さい第2距離離れた測定点を、第2着目点に設定し、
複数の前記測定点のうち、前記基準点に対して前記車線幅方向の一方側に前記区画線の幅の1/2よりも大きい第3距離離れた測定点を、第3着目点に設定し、
複数の前記測定点のうち、前記基準点に対して前記車線幅方向の他方側に前記区画線の幅の1/2よりも大きい第4距離離れた測定点を、第4着目点に設定し、
前記第1着目点の前記受光強度と前記第2着目点の前記受光強度との差の絶対値が第1閾値よりも小さく、前記第1着目点の前記受光強度と前記第3着目点の前記受光強度との差が第2閾値よりも大きく、かつ前記第2着目点の前記受光強度と前記第4着目点の前記受光強度との差が第3閾値よりも大きい場合に、又は、
前記第1着目点の前記受光強度と前記第2着目点の前記受光強度との差の絶対値が第1閾値よりも小さく、前記第1着目点の前記受光強度と前記第4着目点の前記受光強度との差が第2閾値よりも大きく、かつ前記第2着目点の前記受光強度と前記第3着目点の前記受光強度との差が第3閾値よりも大きい場合に、前記基準点を前記候補点として抽出する、車線変更操舵制御システム。 A lane change steering control system that performs a steering control to change a vehicle traveling in the own lane to an adjacent lane adjacent to the own lane,
Around the vehicle, a laser sensor that emits laser light onto a road surface including at least the adjacent lane, and receives reflected light of the emitted laser light,
Based on a detection result of the laser sensor, a detection unit that detects a position of a lane marking opposite to the own lane in the adjacent lane,
A control unit that executes the steering control based on the position of the lane marking detected by the detection unit ,
The laser sensor detects information on positions and received light intensity at a plurality of measurement points on the road surface,
The detection unit,
In the received light intensity distribution of the plurality of measurement points with respect to the position in the lane width direction, if there is a peak having a width corresponding to the width of the lane marking, at least a part of the measurement points of the peak is regarded as a candidate point. Extract,
Detecting the position of the lane marking based on the position of the extracted candidate point,
The detection unit,
Setting one of the measurement points as a reference point,
Among the plurality of measurement points, a measurement point that is a first distance smaller than half of the width of the lane marking on one side in the lane width direction with respect to the reference point is set as a first point of interest. ,
Of the plurality of measurement points, a measurement point that is a second distance smaller than half of the width of the lane marking line on the other side in the lane width direction with respect to the reference point is set as a second point of interest. ,
Of the plurality of measurement points, a measurement point that is located on one side in the lane width direction with respect to the reference point and that is a third distance larger than half the width of the lane marking is set as a third point of interest. ,
Among the plurality of measurement points, a measurement point that is a fourth distance larger than half the width of the lane marking line on the other side in the lane width direction with respect to the reference point is set as a fourth point of interest. ,
An absolute value of a difference between the light receiving intensity of the first point of interest and the light receiving intensity of the second point of interest is smaller than a first threshold value, and the light receiving intensity of the first point of interest and the light receiving intensity of the third point of interest are different. If the difference between the received light intensity is greater than a second threshold, and the difference between the received light intensity of the second point of interest and the received light intensity of the fourth point of interest is greater than a third threshold, or
The absolute value of the difference between the received light intensity of the first point of interest and the received light intensity of the second point of interest is smaller than a first threshold, and the received light intensity of the first point of interest and the When the difference between the received light intensity is larger than a second threshold and the difference between the received light intensity of the second point of interest and the received light intensity of the third point of interest is larger than a third threshold, the reference point A lane change steering control system that is extracted as the candidate points .
前記記憶部は、走行方向後方の走行区間を前記車両が走行した際に前記検出部で検出した前記区画線の位置を、前記区画線の既検出位置として記憶し、
前記検出部は、前記記憶部に記憶された前記区画線の既検出位置と前記候補点の位置とに基づいて、前記区画線の位置を検出する、請求項1記載の車線変更操舵制御システム。 Further comprising a storage unit that stores the position of the lane marking detected by the detection unit,
The storage unit stores a position of the lane marking detected by the detection unit when the vehicle travels in a traveling section behind a traveling direction as a detected position of the lane marking,
The detection part, based on the previously detected position of the stored the partition line and the position of the candidate point in the storage unit, for detecting a position of the lane line, according to claim 1 lane change steering control system according.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015181749A JP6627021B2 (en) | 2015-09-15 | 2015-09-15 | Lane change steering control system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015181749A JP6627021B2 (en) | 2015-09-15 | 2015-09-15 | Lane change steering control system |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2017056780A JP2017056780A (en) | 2017-03-23 |
JP6627021B2 true JP6627021B2 (en) | 2020-01-08 |
Family
ID=58391329
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2015181749A Active JP6627021B2 (en) | 2015-09-15 | 2015-09-15 | Lane change steering control system |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6627021B2 (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6548129B2 (en) * | 2017-09-01 | 2019-07-24 | 本田技研工業株式会社 | Vehicle control system, vehicle control method, and program |
KR102639078B1 (en) | 2018-08-07 | 2024-02-22 | 현대자동차주식회사 | Vehicle and method of projecting informtion on ground |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5875408A (en) * | 1995-07-17 | 1999-02-23 | Imra America, Inc. | Automated vehicle guidance system and method for automatically guiding a vehicle |
DE102004003850A1 (en) * | 2004-01-26 | 2005-08-18 | Ibeo Automobile Sensor Gmbh | Method for detecting markings on a roadway |
JP5286214B2 (en) * | 2009-09-30 | 2013-09-11 | 日立オートモティブシステムズ株式会社 | Vehicle control device |
JP5505651B2 (en) * | 2011-02-22 | 2014-05-28 | 株式会社デンソー | Detection device |
JP6015392B2 (en) * | 2012-11-30 | 2016-10-26 | 株式会社リコー | Server apparatus, document management system, and program |
US20140257686A1 (en) * | 2013-03-05 | 2014-09-11 | GM Global Technology Operations LLC | Vehicle lane determination |
JP6265667B2 (en) * | 2013-09-18 | 2018-01-24 | 株式会社藤商事 | Game machine |
JP6541942B2 (en) * | 2014-05-20 | 2019-07-10 | 国立大学法人電気通信大学 | Parcel detection system |
-
2015
- 2015-09-15 JP JP2015181749A patent/JP6627021B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2017056780A (en) | 2017-03-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6593695B2 (en) | Lane change steering control system | |
US9751506B2 (en) | Algorithms for avoiding automotive crashes at left and right turn intersections | |
US9688273B2 (en) | Methods of improving performance of automotive intersection turn assist features | |
JP6243039B2 (en) | Method for inspecting certainty of erroneous driving of automobile and control detection device | |
US8447484B2 (en) | Branch-lane entry judging system | |
JP6856369B2 (en) | Identification of open areas | |
US9592827B2 (en) | Collision mitigation apparatus and collision mitigation program | |
CN107111952B (en) | Lane assist system responsive to extremely fast approaching vehicles | |
JP6396850B2 (en) | Driving support device and driving support method | |
US10890453B2 (en) | Vehicle localization device | |
JP6654923B2 (en) | Map information output device | |
US20190035280A1 (en) | Lane change support method and apparatus | |
CN102673560A (en) | Method for recognizing turn-off maneuver and driver assistance system | |
KR101716047B1 (en) | Apparatus and method for avoiding collision of vehicle | |
KR20190056977A (en) | Vehicle control device | |
EP2423902A1 (en) | Safety system and method | |
JP2015069289A (en) | Lane recognition device | |
CN110789450B (en) | Vehicle meeting danger alarm prompting method and system and vehicle | |
JP4876147B2 (en) | Lane judgment device and navigation system | |
JP2015203972A (en) | Driving route generation device | |
KR102545582B1 (en) | System for avoiding collision in crossroad and method for control thereof | |
JP6115429B2 (en) | Own vehicle position recognition device | |
JP6627021B2 (en) | Lane change steering control system | |
CN107024930B (en) | Bollard receiver identification | |
JP6747157B2 (en) | Self-position estimation method and self-position estimation device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20180601 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20180601 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20190326 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20190328 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20190524 |
|
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: 20190903 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20190912 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6627021 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |