JP2014144764A - Lane marker reliability determination device and driving support control apparatus - Google Patents
Lane marker reliability determination device and driving support control apparatus Download PDFInfo
- Publication number
- JP2014144764A JP2014144764A JP2013016217A JP2013016217A JP2014144764A JP 2014144764 A JP2014144764 A JP 2014144764A JP 2013016217 A JP2013016217 A JP 2013016217A JP 2013016217 A JP2013016217 A JP 2013016217A JP 2014144764 A JP2014144764 A JP 2014144764A
- Authority
- JP
- Japan
- Prior art keywords
- lane
- lateral deviation
- vehicle
- lane marking
- reliability
- 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.)
- Granted
Links
Images
Landscapes
- Traffic Control Systems (AREA)
- Image Analysis (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Image Processing (AREA)
Abstract
Description
本発明は、検出された車両が走行している車線を区画する区画線の信頼度を判定する区画線信頼度判定装置、運転支援制御装置、区画線信頼度判定方法並びに運転支援制御方法に関するものである。 The present invention relates to a lane marking reliability determination device, a driving support control device, a lane marking reliability determination method, and a driving support control method that determine the reliability of a lane marking that divides a lane in which a detected vehicle is traveling. It is.
近年、車両には、運転支援制御としてLKA(Lane Keeping Assist System)が搭載されているものがある。LKAは、車両前方を撮像するカメラにより、車両が走行している車線を区画する区画線、例えば白線や黄色線などを撮像し、撮像された画像に基づいて区画線を検出し、検出された区画線に基づいて車線に対する車両の位置を算出し、算出された車両の位置に基づいて車両を車線から逸脱しないように運転支援制御、特に操舵装置を制御するものである。 In recent years, some vehicles are equipped with LKA (Lane Keeping Assist System) as driving assistance control. LKA uses a camera that captures the front of the vehicle to capture a lane line that divides the lane in which the vehicle is traveling, such as a white line or a yellow line, and detects the lane line based on the captured image. The position of the vehicle relative to the lane is calculated based on the lane line, and the driving assistance control, particularly the steering device is controlled based on the calculated position of the vehicle so as not to deviate from the lane.
LKAにおいては、画像から区画線を精度良く検出することが重要である。そのため、例えば、特許文献1に示すように、レーンマーカーの候補点の誤検出が明らかであれば道路モデルを初期化し車線認識を初めからやり直し、候補点の誤検出が不明であれば候補点の検出結果に連続性があるかを判断し、連続性がなければ道路モデルの更新を中止し今回値ではなく前回値に基づいて車線認識を行う技術が提案されている(特許文献1参照)。
In LKA, it is important to accurately detect a lane marking from an image. Therefore, for example, as shown in
ところで、画像から区画線を精度良く検出したとしても、検出された区画線が、実際は車両の走行すべき車線を区画する区画線とは異なる区画線であっても正しい区画線であると判定する虞がある。例えば、高速道路においては、本線に対して車両が出て行く流出路や入ってくる流入路などの分岐路があり、本線に対向する区画線が本線と分岐路との接続部分で消失している。さらに、分岐点で消失した本線に対応する区画線は、分岐路に対応する区画線と接続されている。従って、分岐路に接続する車線を走行している車両においては、LKAが分岐路に対応する区画線を本線に対応する区画線と判定する虞がある。 By the way, even if a lane line is accurately detected from the image, it is determined that the detected lane line is a correct lane line even if it is different from the lane line that actually divides the lane in which the vehicle should travel. There is a fear. For example, on an expressway, there are branch roads such as an outflow path from which vehicles exit the main line and an incoming inflow path, and the lane marking opposite the main line disappears at the connection between the main line and the branch path. Yes. Furthermore, the lane line corresponding to the main line disappeared at the branch point is connected to the lane line corresponding to the branch path. Therefore, in a vehicle traveling in a lane connected to a branch road, LKA may determine that the lane line corresponding to the branch road is the lane line corresponding to the main line.
そこで、本発明は、上記に鑑みてなされたものであって、検出された区画線の信頼度を精度良く判定することができる区画線信頼度判定装置、運転支援制御装置、区画線信頼度判定方法並びに運転支援制御方法を提供することを目的とする。 Therefore, the present invention has been made in view of the above, and is a lane line reliability determination device, a driving support control device, and a lane line reliability determination that can accurately determine the reliability of a detected lane line. It is an object to provide a method and a driving support control method.
上述した課題を解決し、目的を達成するために、本発明に係る区画線信頼度判定装置は、車両が走行している車線を区画する区画線を検出する区画線検出手段と、前記区画線と前記車両との横偏差である区画線横偏差を算出する区画線横偏差算出手段と、前記車両の車速および旋回状態に基づいた慣性航法による車両の現在位置と、前記車両が走行する道路データとに基づいて慣性横偏差を算出する慣性横偏差算出手段と、前記区画線横偏差と前記慣性横偏差との差分と、区画線横偏差誤差および累積増加する慣性横偏差誤差に基づいた許容範囲とを比較して、前記区画線検出手段により検出された前記区画線の信頼度を判定する信頼度判定手段と、を備えることを特徴とする。 In order to solve the above-described problems and achieve the object, a lane line reliability determination apparatus according to the present invention includes a lane line detection unit that detects a lane line that divides a lane in which a vehicle is traveling, and the lane line A lane line lateral deviation calculating means for calculating a lane line lateral deviation which is a lateral deviation between the vehicle and the vehicle, a current position of the vehicle by inertial navigation based on a vehicle speed and a turning state of the vehicle, and road data on which the vehicle travels Inertial lateral deviation calculating means for calculating an inertial lateral deviation based on the above, a difference between the lane marking lateral deviation and the inertia lateral deviation, an allowable range based on the lane marking lateral deviation error and the cumulatively increasing inertial lateral deviation error And reliability determination means for determining the reliability of the lane markings detected by the lane marking detection means.
また、上記区画線信頼度判定装置において、前記信頼度判定手段は、前記差分が前記許容範囲を超えた場合に、前記区画線検出手段により検出された前記区画線の信頼度が低いと判定することが好ましい。 In the lane marking reliability determination apparatus, the reliability determination unit determines that the lane marking detected by the lane line detection unit is low when the difference exceeds the allowable range. It is preferable.
また、上記区画線信頼度判定装置において、前記信頼度判定手段は、前記差分の走行距離に応じた変化の勾配である差分勾配が、前記許容範囲の最大値の走行距離に応じた変化の勾配である許容範囲勾配を超えた場合に、前記区画線検出手段により検出された前記区画線の信頼度が低いと判定することが好ましい。 Further, in the lane marking reliability determination apparatus, the reliability determination unit is configured such that a difference gradient that is a change gradient according to the difference travel distance is a change gradient according to a maximum travel distance of the allowable range. It is preferable to determine that the reliability of the lane marking detected by the lane marking detection means is low when an allowable range gradient is exceeded.
また、上記区画線信頼度判定装置において、前記慣性横偏差算出手段は、前記区画線検出手段により検出された前記区画線の信頼度が高いと判定されると、前記区画線横偏差を前記慣性横偏差にセットするとともに、前記許容範囲を更新する更新処理を許容することが好ましい。 Further, in the lane marking reliability determination apparatus, when the inertia lateral deviation calculation unit determines that the lane marking detected by the lane line detection unit has a high reliability, the inertia line lateral deviation is calculated as the inertial line deviation. It is preferable to set the lateral deviation and allow an update process for updating the allowable range.
また、本発明に係る運転支援制御装置は、上記区画線信頼度判定装置と、前記区画線に基づいて前記車両の運転支援制御を行う運転支援制御手段と、を備え、前記運転支援制御手段は、前記区画線検出手段により検出された前記区画線の信頼度が低いと判定されると、前記区画線に基づいた前記運転支援制御を禁止し、前記慣性航法による車両の現在位置に基づいて前記運転支援制御を行い、前記区画線検出手段により検出された前記区画線の信頼度が高いと判定されると、前記区画線に基づいた前記運転支援制御に復帰することを特徴とする。 Further, a driving support control device according to the present invention includes the lane marking reliability determination device and driving support control means for performing driving support control of the vehicle based on the lane marking, wherein the driving support control means includes: If the reliability of the lane line detected by the lane line detection means is determined to be low, the driving support control based on the lane line is prohibited, and based on the current position of the vehicle by the inertial navigation When driving support control is performed and it is determined that the reliability of the lane marking detected by the lane marking detector is high, the driving assistance control is returned to the driving assistance control based on the lane marking.
また、本発明に係る区画線信頼度判定方法は、車両が走行している車線を区画する区画線を検出する手順と、前記区画線と前記車両との横偏差である区画線横偏差を算出する手順と、前記車両の車速および旋回状態に基づいた慣性航法による車両位置と、前記車両が走行する道路データとに基づいて慣性横偏差を算出する手順と、前記区画線横偏差と前記慣性横偏差との差分と、区画線横偏差誤差および累積増加する慣性横偏差誤差に基づいた許容範囲とを比較して、前記区画線検出手段により検出された前記区画線の信頼度を判定する手順と、を含むことを特徴とする。 The lane marking reliability determination method according to the present invention includes a procedure for detecting a lane marking that divides a lane in which a vehicle is traveling, and a lane marking lateral deviation that is a lateral deviation between the lane marking and the vehicle. A procedure for calculating an inertia lateral deviation based on a vehicle position by inertial navigation based on a vehicle speed and a turning state of the vehicle, and road data on which the vehicle travels, and the lane marking lateral deviation and the inertia lateral A procedure for determining the reliability of the lane marking detected by the lane marking detecting means by comparing the difference between the deviation and an allowable range based on the lane marking lateral deviation error and the cumulatively increasing inertial lateral deviation error; , Including.
また、本発明に係る運転支援制御方法は、車両が走行している車線を区画する区画線を検出する手順と、前記区画線と前記車両との横偏差である区画線横偏差を算出する手順と、前記車両の車速および旋回状態に基づいた慣性航法による車両位置と、前記車両が走行する道路データとに基づいて慣性横偏差を算出する手順と、前記区画線横偏差と前記慣性横偏差との差分と、区画線横偏差誤差および累積増加する慣性横偏差誤差に基づいた許容範囲とを比較して、前記区画線検出手段により検出された前記区画線の信頼度を判定する手順と、前記区画線検出手段により検出された前記区画線の信頼度が低いと判定されると、前記区画線に基づいた前記車両の運転支援制御を禁止し、前記慣性航法による車両の現在位置に基づいて前記運転支援制御を行う手順と、前記区画線検出手段により検出された前記区画線の信頼度が高いと判定されると、前記区画線に基づいた前記運転支援制御に復帰する手順と、を含むことを特徴とする。 The driving support control method according to the present invention includes a procedure for detecting a lane line that divides a lane in which a vehicle is traveling, and a procedure for calculating a lane line lateral deviation that is a lateral deviation between the lane line and the vehicle. A procedure for calculating an inertia lateral deviation based on a vehicle position by inertial navigation based on a vehicle speed and a turning state of the vehicle, and road data on which the vehicle travels, the lane marking lateral deviation and the inertia lateral deviation, Comparing the difference between the difference and an allowable range based on the lane marking lateral deviation error and the cumulatively increasing inertial lateral deviation error, and determining the reliability of the lane marking detected by the lane marking detection unit; When it is determined that the reliability of the lane line detected by the lane line detection means is low, driving support control of the vehicle based on the lane line is prohibited, and the vehicle is based on the current position of the vehicle by the inertial navigation. Driving assistance And a procedure for returning to the driving support control based on the lane marking when it is determined that the lane marking detected by the lane marking detecting means has high reliability. And
本発明に係る区画線信頼度判定装置および区画線信頼度判定方法では、検出された区画線に基づいた区画線横偏差と、慣性航法による車両の現在位置と道路データとに基づいた慣性横偏差との差分と、区画線横偏差誤差および慣性横偏差誤差に基づいた許容範囲とを比較して、差分が許容範囲を超えたか否かで、区画線検出手段により検出された区画線の信頼度を判定するので、区画線が車両の走行すべき車線に対向する区画線であるか否かを精度良く認識することができる。これにより、運転支援制御に対して中止・中断を精度良く判定することができる。 In the lane marking reliability determination apparatus and the lane marking reliability determination method according to the present invention, the lane marking lateral deviation based on the detected lane marking, and the inertia lateral deviation based on the current position of the vehicle by inertial navigation and road data. The reliability of the lane line detected by the lane line detection means based on whether the difference exceeds the allowable range or not and the allowable range based on the lane line lateral deviation error and inertial lateral deviation error Therefore, it is possible to accurately recognize whether the lane marking is a lane marking facing the lane in which the vehicle should travel. Thereby, cancellation / interruption can be accurately determined for the driving support control.
また、本発明に係る区画線信頼度判定装置および区画線信頼度判定方法では、区画線の信頼度が低いと判定されると、区画線に基づいた運転支援制御を禁止し、慣性現在位置に基づいて運転支援制御を行い、区画線の信頼度が高いと判定されると、区画線に基づいた運転支援制御に復帰するので、区画線の信頼度が低い場合でも運転支援制御を継続することができる。従って、区画線の信頼度を判定することで、運転支援制御の機会を増やすことができる。 Further, in the lane marking reliability determination apparatus and the lane marking reliability determination method according to the present invention, when it is determined that the lane marking reliability is low, driving support control based on the lane marking is prohibited and the inertia current position is set. If the reliability of the lane line is determined to be high, the driving assistance control based on the lane line is restored. Therefore, the driving support control should be continued even when the reliability of the lane line is low. Can do. Therefore, the opportunity of driving assistance control can be increased by determining the reliability of the lane marking.
本発明を実施するための形態(実施形態)につき、図面を参照しつつ詳細に説明する。以下の実施形態に記載した内容により本発明が限定されるものではない。また、以下に記載した構成要素には、当業者が容易に想定できるもの、実質的に同一のものが含まれる。さらに、以下に記載した構成は適宜組み合わせることが可能である。また、本発明の要旨を逸脱しない範囲で構成の種々の省略、置換又は変更を行うことができる。 DESCRIPTION OF EMBODIMENTS Embodiments (embodiments) for carrying out the present invention will be described in detail with reference to the drawings. The present invention is not limited by the contents described in the following embodiments. The constituent elements described below include those that can be easily assumed by those skilled in the art and those that are substantially the same. Furthermore, the structures described below can be combined as appropriate. Various omissions, substitutions, or changes in the configuration can be made without departing from the scope of the present invention.
〔実施形態1〕
図1は、実施形態1に係る区画線信頼度判定装置を含む運転支援制御装置の概略構成例を示す図である。図2−1は、実施形態1における車両の走行状態を示す図である。図2−2は、実施形態1における横偏差Zと走行距離Lとの関係を示す図である。図2−3は、実施形態1における差分ΔZと走行距離Lと許容範囲PRとの関係を示す図である。図3−1は、区画線横偏差誤差EZ1と実走行軌跡RLとの関係を示す図である。図3−2は、慣性横偏差誤差EZ2と実走行軌跡RLとの関係を示す図である。図3−3は、許容範囲PRを示す図である。図1に示すように、運転支援制御装置1の区画線信頼度判定装置2は、図示しない車両CAに搭載されており、前方カメラ3と、車速センサ4と、ヨーレートセンサ5と、GPS(Global Positioning System)6と、運転支援ECU(Electronic Control Unit)7とを含んで構成されている。運転支援制御装置1は、区画線信頼度判定装置2と、前方カメラ3と、車速センサ4と、運転支援制御部77を含む運転支援ECU7と、駆動装置8と、制動装置9と、操舵装置10とを含んで構成されている。運転支援ECU7と、前方カメラ3などの他の機器、装置とは、例えばCAN通信システムに代表される通信システムにより電気的に接続されている。
FIG. 1 is a diagram illustrating a schematic configuration example of a driving support control device including a lane marking reliability determination device according to the first embodiment. FIG. 2-1 is a diagram illustrating a traveling state of the vehicle in the first embodiment. FIG. 2-2 is a diagram illustrating a relationship between the lateral deviation Z and the travel distance L in the first embodiment. FIG. 2-3 is a diagram illustrating a relationship among the difference ΔZ, the travel distance L, and the allowable range PR in the first embodiment. FIG. 3A is a diagram illustrating a relationship between the lane marking lateral deviation error EZ1 and the actual travel locus RL. FIG. 3-2 is a diagram illustrating a relationship between the inertial lateral deviation error EZ2 and the actual travel locus RL. FIG. 3C is a diagram illustrating the allowable range PR. As shown in FIG. 1, the lane marking
前方カメラ3は、車両CAが走行する車両前方を撮像する例えばCCDカメラであり、車両CAが走行する車線である走行車線および走行車線と他の車線あるいは道路以外とを区画する区画線を含んだ画像を撮像するものである。ここで、区画線は、道路に設けられた白線、黄色線などの通常の区画線のみならず、ガードレールや反射板など、車線を区画することができる対象物も含まれる。前方カメラ3により撮像された区画線を含む画像は、運転支援ECU7に入力される。前方カメラ3は、通常、図示しない車内のフロントウィンドを挟んで車両前方を撮像できる位置に設けられているが、車外の例えばフロントグリル、フロントバンパー、サイドミラーなどに設けられていてもよい。 The front camera 3 is, for example, a CCD camera that images the front of the vehicle on which the vehicle CA travels, and includes a travel lane that is a lane on which the vehicle CA travels and a lane marking that separates the travel lane from other lanes or roads An image is taken. Here, the lane markings include not only normal lane markings such as white lines and yellow lines provided on the road, but also objects that can divide the lane, such as guardrails and reflectors. An image including a lane marking imaged by the front camera 3 is input to the driving assistance ECU 7. The front camera 3 is usually provided at a position where the front of the vehicle can be imaged with a front window inside the vehicle (not shown), but may be provided outside the vehicle, for example, on a front grill, a front bumper, a side mirror, or the like.
車速センサ4は、車速検出手段であり、車両CAの速度である車速V〔km/h〕を検出するものであり、検出された車速Vが運転支援ECU7に入力される。車速センサ4は、例えば図示しないデファレンシャルギヤやアウトプットシャフトなどの動力源(例えば、エンジン、モータなど)が発生した動力を駆動輪(例えば、前輪FT)に伝達する動力伝達経路上の回転体に設けられており、回転体の回転速度に基づいて車速Vを検出する。なお、車速検出手段は、各車輪に設けられた車輪速センサであってもよく、この場合、各車輪速センサにより検出された車輪速に基づいて車速Vを検出することとなる。また、車速検出手段は、GPS6でもよく、この場合後述する測位現在位置の変化に基づいて車速Vを検出することとなる。
The vehicle speed sensor 4 is a vehicle speed detection means that detects a vehicle speed V [km / h], which is the speed of the vehicle CA, and the detected vehicle speed V is input to the driving assistance ECU 7. The vehicle speed sensor 4 is provided on a rotating body on a power transmission path that transmits power generated by a power source (for example, an engine, a motor, etc.) such as a differential gear or an output shaft (not shown) to drive wheels (for example, front wheels FT). The vehicle speed V is detected based on the rotational speed of the rotating body. The vehicle speed detection means may be a wheel speed sensor provided on each wheel. In this case, the vehicle speed V is detected based on the wheel speed detected by each wheel speed sensor. Further, the vehicle speed detecting means may be a
ヨーレートセンサ5は、車両旋回状態検出手段であり、車両CAのヨーレートR〔°/sec〕、すなわち車両CAの旋回状態を検出する例えばジャイロセンサであり、検出されたヨーレートRが運転支援ECU7に入力される。車両旋回状態検出手段は、ジャイロセンサに限定されるものではなく、車両CAの方位角速度を検出することができる角速度センサであればよい。また、車両旋回状態検出手段は、車輪速センサでもよく、この場合検出された車輪速の差に基づいてヨーレートRを検出することとなる。 The yaw rate sensor 5 is a vehicle turning state detection means, and is a gyro sensor, for example, that detects the yaw rate R [° / sec] of the vehicle CA, that is, the turning state of the vehicle CA, and the detected yaw rate R is input to the driving assistance ECU 7. Is done. The vehicle turning state detecting means is not limited to the gyro sensor, and may be any angular velocity sensor that can detect the azimuth angular velocity of the vehicle CA. Further, the vehicle turning state detection means may be a wheel speed sensor, and in this case, the yaw rate R is detected based on the detected wheel speed difference.
GPS6は、車両位置検出手段であり、車両CAの現在位置である測位現在位置を取得するものであり、取得された測位現在位置が運転支援ECU7に入力される。
The
運転支援ECU7は、制御手段であり、前方カメラ3により検出された区画線の信頼度を判定するものであるとともに、区画線に基づいて車両CAの運転支援制御、本実施形態では、区画線に基づいて車両CAを車両CAの走行すべき車線から逸脱することを抑制するLKAを実施するものである。運転支援ECU7は、区画線検出部71と、区画線横偏差算出部72と、慣性航法部73と、道路データ74aが格納されている記憶部74と、慣性横偏差算出部75と、信頼度判定部76と、運転支援制御部77としての機能を少なくとも有している。運転支援ECU7のハード構成は、主に演算処理を行うCPU(Central Processing Unit)、プログラムや情報を格納するメモリ(SRAMなどのRAM、EEPROMなどのROM(Read Only Memory))、入出力インターフェースなどから構成され、既知の車両CAに搭載されるECUと同様であるため、詳細な説明は省略する。また、運転支援ECU7は、車両CAに搭載されたエンジンやモータなどの車両CAに駆動力あるいは制動力を作用させる駆動装置8、油圧ブレーキ装置などの車両CAに制動力を作用させる制動装置9、EPS(Electric Power Steering)などの操舵装置10、図示しないアクセルペダルセンサ、ブレーキペダルセンサなどと電気的に接続されており、各装置8〜10の制御や、各装置8〜10およびセンサから車両CAの走行状態や運転者の車両CAの走行要求を情報として取得する。また、運転支援ECU7は、運転者の区画線に基づいた運転支援制御、本実施形態では、LKAの使用意志を検出する使用意志検出手段(例えば、車内に設けられたスイッチ、レバーなど)と電気的に接続されており、使用意志検出手段により運転者の使用意志ありと判定されると、運転支援制御を行う。
The driving assistance ECU 7 is a control means for determining the reliability of the lane markings detected by the front camera 3 and driving assistance control for the vehicle CA based on the lane markings. Based on this, the LKA is performed to suppress the vehicle CA from deviating from the lane in which the vehicle CA should travel. The driving assistance ECU 7 includes a lane
区画線検出部71は、区画線検出手段であり、区画線を前方カメラ3により撮像された画像から検出するものである。区画線検出部71による区画線の検出は、すでに公知の検出方法により行えばよく、例えば、画像を水平方向に順次走査し、走査ラインごとに輝度に基づいたエッジ検出を行い、検出されたエッジに基づいて画像から区画線を検出する。ここで、前方カメラ3により撮像された画像には、車両CAの走行すべき車線を区画する区画線、それ以外の車線を区画する区画線、あるいは流入路や流出路などの分岐路を区画する区画線が含まれる。また、車両CAが走行する車線を区画する区画線は、高速道路や主要幹線道路では、平行に2つ存在する。そこで、区画線検出部71は、車両CAの左右において最も近接した区画線を検出し、検出された区画線が2つ存在する場合は一方、本実施形態では、車両CAが走行する車線を区画する2つの区画線のうち、通常、分岐路が接続されている左側の区画線を検出する。区画線検出部71は、例えば、図2−1に示すように、車両CAが高速道路の最も左側の車線LMを走行している場合は、車線LMの左側の区画線である白線WLMを検出する。
The lane marking
区画線横偏差算出部72は、区画線横偏差算出手段であり、区画線と車両CAとの横偏差である区画線横偏差Z1〔m〕を算出するものである。区画線横偏差算出部72は、図1に示すように、区画線検出部71により検出された区画線の画像における位置と、車両CAに対する前方カメラ3の車両幅方向における取付位置および前方カメラ3の水平方向に対する俯角などの画像における区画線の位置を実際の車両CAに対する区画線の位置に補正するための情報とに基づいて、車両幅方向において撮像された画像に基づいた車両CAに対する区画線の位置を区画線横偏差Z1として算出する。区画線横偏差算出部72は、例えば、図2−1に示すように、車両CAが高速道路の最も左側の車線である車線LMを走行している場合は、車線LMの左側の区画線である白線WLMと車両CAとの区画線横偏差Z1を算出する。なお、区画線横偏差Z1は、車両CAと区画線とが離れる方向をプラスの値、近づく方向をマイナス値とする。
The lane marking lateral
慣性航法部73は、車両CAの車速Vおよび旋回状態に基づいて車両CAの現在位置である慣性現在位置を算出するものである。慣性航法部73は、車速センサ4により取得された車速Vと、ヨーレートセンサ5により検出されたヨーレートRとの積分により、起点Oに対する相対現在位置を慣性現在位置として算出するものである。ここで、起点Oは、本実施形態では、GPS6により取得された測位現在位置に対応する後述する境界線の位置に、測位現在位置を取得した際における区画線横偏差Z1を加えたものである。なお、車両CAが複数の車線のいずれかを走行している場合は、起点Oは、上記境界線の位置に区画線横偏差Z1を加え、さらに走行している車線が最も外側の車線から何車線目かに応じて車線幅を加える。何車線目か否かは、上述の前方カメラ3により撮像された画像やGPS6により取得された測位現在位置に基づいて行われる。また、慣性航法部73は、測位現在位置と、道路データ74aとに基づいて、車両CAが走行する車線のうち、分岐路の手前に起点Oを設定する。例えば、図2−1に示すように、車線LMのうち流出路LSの手前において取得された測位現在位置に基づいて起点Oを設定する。
The
記憶部74は、道路データ74aを格納するものである。道路データ74aは、車両CAが走行できる車線の区画線に相当する境界線のデータを含むものであり、GPS6により取得される測位現在位置と関連付けがなされているものである。ここで、境界線は、実際に道路に設けられている区画線とは異なり、車線に対応する区画線の位置と同位置の線であり、かつ車線に沿って常に連続した線である。従って、車線が分岐路と接続される部分には、通常区画線は存在しないが、境界線としてはそのような区画線が欠落している部分において存在する。例えば、図2−1に示すように、車両CAが高速道路の最も左側の車線LMを走行している場合は、白線WLMが流出路LSにより消失していても、その部分においては白線WLMに相当する境界線RDが存在することとなる。なお、道路データ74aは、通常、予め記憶部74に格納されているものであるが、車両CAに搭載されている図示しない通信手段によりセンターからの更新情報に基づいて随時更新されてもよい。
The
慣性横偏差算出部75は、慣性横偏差算出手段であり、慣性航法による車両CAの現在位置、すなわち慣性現在位置と、道路データ74aとに基づいて慣性航法における横偏差である慣性横偏差Z2〔m〕を算出するものである。慣性横偏差算出部75は、図1に示すように、車線幅方向において、慣性現在位置に基づいた車両CAに対する境界線の位置を慣性横偏差Z2として算出する。なお、慣性横偏差Z2は、車両CAと境界線データとが離れる方向をプラスの値、近づく方向をマイナス値とする。
The inertia lateral
信頼度判定部76は、信頼度判定手段であり、区画線横偏差Z1と慣性横偏差Z2との差分ΔZと、許容範囲PRとを比較して、区画線検出部71により検出された区画線の信頼度を判定するものである。信頼度判定部76は、区画線横偏差Z1と慣性横偏差Z2との差分ΔZを算出し、算出された差分ΔZが許容範囲PR内であると検出された区画線の信頼度が高く、差分ΔZが許容範囲PR外である検出された区画線の信頼度が低いと判定する。なお、差分ΔZは、本実施形態では、区画線横偏差Z1を基準とする慣性横偏差Z2の変化であり、車両CAと区画線(境界線)とが離れる方向の変化をプラスの値、近づく方向の変化をマイナス値とする。
The reliability determination unit 76 is reliability determination means, and compares the difference ΔZ between the lane line lateral deviation Z1 and the inertia lateral deviation Z2 with the allowable range PR, and the lane line detected by the lane
ここで、差分ΔZは、横偏差Zの誤差EZで変化するものである。横偏差Zの誤差EZは、区画線横偏差Z1および慣性横偏差Z2にそれぞれ異なって発生する。 Here, the difference ΔZ changes with the error EZ of the lateral deviation Z. The error EZ of the lateral deviation Z occurs differently in the lane marking lateral deviation Z1 and the inertia lateral deviation Z2.
区画線横偏差Z1の誤差である区画線横偏差誤差EZ1は、図3−1に示すように、車両CAの実走行軌跡RLに対して左右に一定量で発生する。区画線横偏差Z1は、前方カメラ3により撮像された画像に基づいて区画線検出部71により検出された区画線を用いていて、逐次算出されるためであり、車両CAの走行距離Lに関わりなく車両CAの実走行軌跡RLに対して左右一定の範囲で発生する。
The lane marking lateral deviation error EZ1, which is an error of the lane marking lateral deviation Z1, is generated at a constant amount on the left and right with respect to the actual travel locus RL of the vehicle CA, as shown in FIG. The lane marking lateral deviation Z1 is because the lane marking detected by the
慣性横偏差Z2の誤差である慣性横偏差誤差EZ2は、図3−2に示すように、起点Oにおける初期ヨー角誤差に基づいて発生する。慣性横偏差Z2は上述のように車速VとヨーレートRの積分により算出されるため、慣性横偏差誤差EZ2は累積される。慣性横偏差誤差EZ2は、車両CAの走行距離Lに応じて増加する。ここで、初期ヨー角誤差は、車両CAの起点Oにおける向きであり、慣性現在位置に基づいた車両CAの推定走行軌跡ILが起点Oを基準に、車両CAの実走行軌跡RLに対して初期ヨー角誤差分傾くことになる。ここで、ヨーレートRについては、初期ヨー角誤差のみならず、ヨーレートセンサ5に基づいた誤差が発生するが、車両CAの停車中などにおいて0点補正、すなわち車両CAが停車中であることを条件に、ヨーレートセンサ5が検出したヨーレートRを0とすることで、ヨーレートセンサ5に起因する慣性横偏差誤差EZ2を極力小さくすることができる。また、車速Vについても様々な方法で、補正できることが知られている。 The inertia lateral deviation error EZ2, which is an error of the inertia lateral deviation Z2, is generated based on the initial yaw angle error at the starting point O, as shown in FIG. Since the inertia lateral deviation Z2 is calculated by integrating the vehicle speed V and the yaw rate R as described above, the inertia lateral deviation error EZ2 is accumulated. Inertial lateral deviation error EZ2 increases according to travel distance L of vehicle CA. Here, the initial yaw angle error is the direction at the starting point O of the vehicle CA, and the estimated traveling locus IL of the vehicle CA based on the current inertia position is initially set with respect to the actual traveling locus RL of the vehicle CA based on the starting point O. It will be tilted by the yaw angle error. Here, with respect to the yaw rate R, not only the initial yaw angle error but also an error based on the yaw rate sensor 5 occurs. However, it is a condition that the vehicle CA is stopped when the vehicle CA is stopped or the like. In addition, by setting the yaw rate R detected by the yaw rate sensor 5 to 0, the inertial lateral deviation error EZ2 caused by the yaw rate sensor 5 can be minimized. It is also known that the vehicle speed V can be corrected by various methods.
また、許容範囲PRは、区画線横偏差誤差EZ1および慣性横偏差誤差EZ2に基づいたものである。許容範囲PRは、区画線横偏差誤差EZ1の最大値と起点Oからの走行距離Lに応じた慣性横偏差誤差EZ2の最大値と合計した値に基づいて設定される。許容範囲PRは、本実施形態では、図3−3に示すように、プラス方向(区画線横偏差Z1に対して慣性横偏差Z2が大きい場合)の区画線横偏差誤差EZ1の最大値と慣性横偏差誤差EZ2の最大値の合計値から、0を挟んでマイナス方向(区画線横偏差Z1に対して慣性横偏差Z2が小さい場合)の区画線横偏差誤差EZ1の最大値と慣性横偏差誤差EZ2の最大値の合計値までの範囲である。区画線横偏差Z1および慣性横偏差Z2に誤差がないとすると、起点Oにおける区画線横偏差Z1および慣性横偏差Z2は同じ値となり、差分ΔZは0となる。ただし、起点Oにおいても、プラスマイナス両方向の区画線横偏差誤差EZ1をすでに含んでいる。車両CAが起点Oから走行すると、走行距離Lが増加し、差分ΔZに対する許容範囲PRが増加することになる。ここで、通常、区画線と境界線とは一致しているので、区画線横偏差Z1および慣性横偏差Z2は、区画線横偏差誤差EZ1および慣性横偏差誤差EZ2をそれぞれ除けば一致しているので、区画線横偏差誤差EZ1および慣性横偏差誤差EZ2を含む差分ΔZは、許容範囲PRを超えることはない。なお、許容範囲PRは、差分ΔZと比較するごとに算出しても良いし、予め走行距離Lとの関係に基づいたマップを記憶部74に格納しておき、差分ΔZと比較する際にマップを用いるようにしても良い。
The allowable range PR is based on the lane marking lateral deviation error EZ1 and the inertia lateral deviation error EZ2. The allowable range PR is set based on the sum of the maximum value of the lane marking lateral deviation error EZ1 and the maximum value of the inertia lateral deviation error EZ2 corresponding to the travel distance L from the starting point O. In the present embodiment, the allowable range PR is the maximum value and inertia of the lane marking lateral deviation error EZ1 in the plus direction (when the inertia lateral deviation Z2 is larger than the lane marking lateral deviation Z1), as shown in FIG. From the sum of the maximum values of the lateral deviation error EZ2, the maximum value of the lane marking lateral deviation error EZ1 and the inertia lateral deviation error in the minus direction (when the inertia lateral deviation Z2 is smaller than the lane marking lateral deviation Z1) with zero in between. This is a range up to the sum of the maximum values of EZ2. If there is no error in the lane marking lateral deviation Z1 and the inertia lateral deviation Z2, the lane marking lateral deviation Z1 and the inertia lateral deviation Z2 at the starting point O have the same value, and the difference ΔZ is zero. However, the starting point O already includes the lane marking lateral deviation error EZ1 in both the plus and minus directions. When the vehicle CA travels from the starting point O, the travel distance L increases, and the allowable range PR for the difference ΔZ increases. Here, since the lane line and the boundary line normally coincide, the lane line lateral deviation Z1 and the inertia lateral deviation Z2 are identical except for the lane line lateral deviation error EZ1 and the inertia lateral deviation error EZ2. Therefore, the difference ΔZ including the lane marking lateral deviation error EZ1 and the inertia lateral deviation error EZ2 does not exceed the allowable range PR. The permissible range PR may be calculated every time it is compared with the difference ΔZ, or a map based on the relationship with the travel distance L is stored in the
運転支援制御部77は、少なくとも区画線に基づいてLKAを実施するものである。運転支援制御部77は、区画線検出部71により検出された区画線と車両CAとの位置関係、車速センサ4により取得された車速Vと、ヨーレートセンサ5により検出されたヨーレートRと、操舵装置10の状態(例えば操舵角、操舵トルクなど)とに基づいて、すでに公知の算出方法により、車両CAが区画線に対して一定の間隔で走行することができるように、操舵装置10の制御値(例えば、アシストトルク)を算出し、算出された制御値に基づいて、少なくとも操舵装置10を制御するものである。また、運転支援制御部77は、上記区画線検出部71により検出された区画線と車両CAとの位置関係を算出された慣性横偏差Z2に置き換えることで、慣性横偏差Z2に基づいてもLKAを実施することができる。
The driving
ここで、差分ΔZは、車両CAが車線を走行している際に、運転支援制御を行うことで変化する場合がある。本実施形態では、この変化に基づいて区画線の信頼性を判定する。例えば、運転支援制御部77によってLKAが実施されており、図2−1に示すように、流出路LSと接続されている車線LMを車両CAが走行している場合は、流出路LSの手前においては白線WLMに対して一定の間隔で車両CAが走行することとなる。車線LMのうち流出路LSとの接続部分では、車線LMに対応する白線WLMは消失しているが、白線WLMが流出路LSに対応する白線WLSと連続することで、1つの白線となっている場合がある。従って、車両CAが走行を続け、車線LMのうち流出路LSとの接続部分に差し掛かると、運転支援制御部77は、白線WLSを車線LMに対応する白線WLMとして検出し、車両CAが車線LMから流出路LSに向かって旋回するおそれがある。区画線横偏差Z1は、車両CAが車線LMを走行し、その後流出路LSに流入しても、図2−2に示すように、運転支援制御部77によってLKAが実施されているため変化しない(区画線横偏差誤差EZ1による変化を除く)。一方、慣性横偏差Z2は、図2−1に示すように、慣性航法において流出路LSの手前に設定されている起点Oから車両CAが流出路LSに向けて旋回を開始するa点までは、実走行軌跡RLに対して推定走行軌跡ILは慣性横偏差誤差EZ2分変化する。起点Oからa点までの差分ΔZは、図2−2に示すように、慣性横偏差誤差EZ2が支配的であり、図2−3に示すように、許容範囲PRを超えることはない。さらに、慣性横偏差Z2は、図2−1に示すように、a点から車両CAが流出路LSに近づきはじめると、車両CAが境界線RDに近づいて行くので小さくなり、図2−2に示すように、差分ΔZがプラスからマイナスに転じる。そして、図2−1に示すように、車両CAがb点まで到達すると、図2−3に示すように、許容範囲PRを超える。従って、LKAが本来の車両CAの走行すべき車線の区画線(白線WLM)と異なる区画線(白線WLS)に基づいて行われることで、差分Δが変化し、許容範囲PRを超える場合がある。
Here, the difference ΔZ may change by performing driving support control when the vehicle CA is traveling in a lane. In the present embodiment, the reliability of the lane marking is determined based on this change. For example, when LKA is implemented by the driving
次に、実施形態1に係る区画線信頼度判定装置2による区画線信頼度判定方法について説明する。図4は、実施形態1に係る区画線信頼度判定方法のフロー図である。ここで、運転支援ECU7は、予め設定された制御周期毎に区画線信頼度判定方法を繰り返し実行するものである。
Next, a lane marking reliability determination method performed by the lane marking
まず、運転支援ECU7の区画線横偏差算出部72は、区画線横偏差Z1を算出する(ステップST11)。ここでは、区画線横偏差算出部72は、区画線検出部71により検出された区画線の車両CAに対する位置を区画線横偏差Z1として算出する。
First, the lane marking lateral
次に、慣性航法部73は、慣性航法を実施する(ステップST12)。ここでは、慣性航法部73は、設定された起点Oに対する慣性現在位置を算出する。なお、起点Oが設定されていない場合は、起点Oを設定した後、慣性現在位置を算出する。
Next, the
次に、慣性横偏差算出部75は、道路データ74aを読み出す(ステップST13)。ここでは、慣性横偏差算出部75は、起点Oに基づいて、車両CAが走行している車線に対応する境界線RDのデータを読み出す。
Next, the inertia lateral
次に、慣性横偏差算出部75は、慣性横偏差Z2を算出する(ステップST14)。ここでは、慣性横偏差算出部75は、慣性現在位置と、道路データ74aの境界線RDとに基づいて慣性横偏差Z2を算出する。
Next, the inertial lateral
次に、信頼度判定部76は、横偏差の差分ΔZを算出する(ステップST15)。ここでは、信頼度判定部76は、区画線横偏差Z1を基準とする慣性横偏差Z2の変化を差分ΔZとして算出する。 Next, the reliability determination unit 76 calculates a lateral deviation difference ΔZ (step ST15). Here, the reliability determination unit 76 calculates a change in the inertial lateral deviation Z2 with reference to the lane marking lateral deviation Z1 as the difference ΔZ.
次に、信頼度判定部76は、F=1であるか否かを判定する(ステップST16)。ここで、Fとは、区画線の信頼度に対応したフラグであり、区画線の信頼度が高い場合に1とし、低い場合に0とする。 Next, the reliability determination unit 76 determines whether or not F = 1 (step ST16). Here, F is a flag corresponding to the reliability of the lane marking, and is set to 1 when the lane marking reliability is high, and 0 when it is low.
次に、信頼度判定部76は、F=1であると判定する(ステップST16肯定)と、差分ΔZが許容範囲PR外であるか否かを判定する(ステップST17)。ここでは、信頼度判定部76は、区画線の信頼度が高いと判定した場合に、差分ΔZが許容範囲PR外、例えば運転支援制御を行うことで差分ΔZが変化することで、許容範囲PRを超えるか否かを判定する。 Next, when determining that F = 1 (Yes in Step ST16), the reliability determination unit 76 determines whether or not the difference ΔZ is outside the allowable range PR (Step ST17). Here, when the reliability determination unit 76 determines that the reliability of the lane marking is high, the difference ΔZ is outside the allowable range PR, for example, by performing the driving support control, the difference ΔZ changes, so that the allowable range PR It is determined whether or not.
次に、信頼度判定部76は、差分ΔZが許容範囲PR外であると判定する(ステップST17肯定)と、区画線の信頼度が低いと判定する(ステップST18)。ここでは、信頼度判定部76は、差分ΔZが変化することで許容範囲PRを超えた場合に、区画線検出部71により検出された区画線が、本来車両CAの走行すべき車線に対応する区画線ではないと判定し、フラグをリセット(F=0)とする。
Next, when the reliability determination unit 76 determines that the difference ΔZ is outside the allowable range PR (Yes in step ST17), the reliability determination unit 76 determines that the reliability of the lane marking is low (step ST18). Here, the reliability determination unit 76, when the difference ΔZ changes and exceeds the allowable range PR, the lane line detected by the lane
また、信頼度判定部76は、差分ΔZが許容範囲PR外でないと判定する(ステップST17否定)と、現在の制御周期を終了し、次の制御周期に移行する。つまり、信頼度判定部76は、差分ΔZが変化しても許容範囲PRを超えていない場合に、区画線の信頼度が高いままと判定し、フラグを立てた状態を維持(F=1)する。 If the reliability determination unit 76 determines that the difference ΔZ is not outside the allowable range PR (No in step ST17), the reliability control unit 76 ends the current control cycle and shifts to the next control cycle. That is, when the difference ΔZ changes but does not exceed the allowable range PR, the reliability determination unit 76 determines that the reliability of the lane marking remains high and maintains the flagged state (F = 1). To do.
また、信頼度判定部76は、F=0であると判定する(ステップST16否定)と、差分ΔZが許容範囲PR内であるか否かを判定する(ステップST19)。ここでは、信頼度判定部76は、区画線の信頼度が低いと判定した場合に、差分ΔZが許容範囲PR内、例えば差分ΔZが小さくなるように運転支援制御を行うことで、許容範囲PRに収まったか否かを判定する。 Further, when determining that F = 0 (No in step ST16), the reliability determination unit 76 determines whether or not the difference ΔZ is within the allowable range PR (step ST19). Here, when the reliability determination unit 76 determines that the reliability of the lane marking is low, by performing driving support control so that the difference ΔZ is within the allowable range PR, for example, the difference ΔZ is small, the allowable range PR It is judged whether it was settled in.
次に、信頼度判定部76は、差分ΔZが許容範囲PR内であると判定する(ステップST19肯定)と、区画線の信頼度が高いと判定する(ステップST20)。ここでは、信頼度判定部76は、差分ΔZが変化することで許容範囲PRを収まった場合に、区画線検出部71により検出された区画線が、本来車両CAの走行すべき車線に対応する区画線であると判定し、フラグを立てる(F=1)とする。
Next, when the reliability determination unit 76 determines that the difference ΔZ is within the allowable range PR (Yes in step ST19), the reliability determination unit 76 determines that the reliability of the lane marking is high (step ST20). Here, in the reliability determination unit 76, when the difference ΔZ changes to fall within the allowable range PR, the lane line detected by the lane
また、信頼度判定部76は、差分ΔZが許容範囲PR外であると判定する(ステップST19否定)と、現在の制御周期を終了し、次の制御周期に移行する。つまり、信頼度判定部76は、差分ΔZが変化しても許容範囲PRを超えている場合に、区画線の信頼度が低いままと判定し、フラグを立てない状態を維持(F=0)する。 If the reliability determination unit 76 determines that the difference ΔZ is outside the allowable range PR (No in step ST19), the reliability control unit 76 ends the current control cycle and shifts to the next control cycle. That is, when the difference ΔZ changes, the reliability determination unit 76 determines that the reliability of the lane marking remains low and maintains a state where no flag is set (F = 0). To do.
以上のように、本実施形態に係る区画線信頼度判定装置2では、検出された区画線に基づいた区画線横偏差Z1と、起点Oからの慣性航法と道路データ74aとから車両CAの走行すべき車線における慣性横偏差Z2との差分ΔZと、区画線横偏差誤差EZ1および慣性横偏差誤差EZ2に基づいた許容範囲PRとを比較して、差分ΔZが許容範囲PRを超えた場合に、区画線検出部71により検出された区画線の信頼度、すなわち車両CAの走行すべき車線に対向する区画線である可能性が低いと判定する。ここで、検出された区画線の信頼性を向上する目的で、車線の左右に存在する区画線を正しく検出できた場合にのみ運転支援制御を行う技術も提案されている。このような、複数の区画線を用いて区画線の信頼性を向上することも可能であるが、一方の区画線を正しく検出できても、他方の区画線を誤検出すると運転支援制御を中断あるいは停止することとなるので、運転支援制御の機会を減少させる虞がある。しかしながら、本実施形態に係る区画線信頼度判定装置2では、車両CAの走行すべき車線に対応していない区画線を検出した場合に、その区画線が、車両CAの走行すべき車線に対応する区画線でないこと、すなわち区画線検出の異常を精度良く認識することができる。これにより、運転支援制御の中止・中断を精度良く判定することができる。また、車両CAが走行する車線に対応する区画線が1つあれば、区画線の信頼度の判定を行うことができるので、運転支援制御の機会を増やすことができる。
As described above, in the lane marking
なお、本実施形態に係る区画線信頼度判定装置2では、運転支援制御が行われている場合において、区画線の信頼度を判定することについて説明したが、これに限定されるものではない。例えば、車両CAがナビゲーションシステムを搭載しており、目的地までの走行軌跡が算出されて、運転者が走行軌跡に基づいて車両CAを走行させている場合に、運転者の操舵装置10に対する操作によって、走行軌跡において車両CAの走行すべき車線から逸脱すると、差分ΔZが変化する可能性がある。このような場合においても、区画線の信頼度を判定し、区画線の信頼度が低いと判定した場合に、図示しない報知手段により運転者に走行軌跡から逸脱したことを報知するようにしても良い。
In the lane marking
次に、本実施形態に係る区画線信頼度判定装置2の区画線の判定結果を用いた運転支援制御装置1による運転支援制御方法について説明する。図5は、実施形態1に係る運転支援制御方法のフロー図である。ここで、運転支援ECU7は、予め設定された制御周期毎に運転支援制御方法を繰り返し実行するものである。
Next, the driving assistance control method by the driving
まず、運転支援制御部77は、LKAを実施していることを前提として、F=1であるか否かを判定する(ステップST21)。ここでは、運転支援制御部77は、区画線の信頼度が高いか否かを判定する。
First, the driving
次に、運転支援制御部77は、F=1であると判定する(ステップST21肯定)と、区画線に基づいて運転支援制御を実施する(ステップST22)。ここでは、運転支援制御部77は、区画線の信頼度が高いと判定されることで、検出された区画線が車両CAの走行すべき車線に対応する区画線であるので、検出された区画線に基づいてLKAを実施する。
Next, when it is determined that F = 1 (Yes in step ST21), the driving
また、運転支援制御部77は、F=0であると判定する(ステップST21否定)と、慣性現在位置に基づいて運転支援制御を実施する(ステップST23)。ここで、区画線の信頼度が低いと判定されることで、検出された区画線が車両CAの走行すべき車線に対応する区画線でないため、検出された区画線に基づいてLKAを実施すると、車両CAが本来走行すべき車線から逸脱する可能性がある。従って、運転支援制御部77は、検出された区画線に基づいたLKAのかわりに慣性現在位置に基づいたLKAを実施する。なお、慣性現在位置に基づいて運転支援制御は、F=1であると判定(ステップST21肯定)されるまで継続され、F=1であると判定(ステップST21肯定)されると、区画線に基づいた運転支援制御の実施に復帰する。
Further, when it is determined that F = 0 (No in step ST21), the driving
例えば、図6−1に示すように、流出路LSと接続されている車線LMを車両CAが走行している場合は、起点Oからa点までは、検出された白線WLMに基づいてLKAが実施されているので、車両CAが走行すべき車線LMを逸脱することはない。a点以降は、白線WLMとは異なる流出路LSの白線WLSが検出されることとなり、検出された白線WLSに基づいてLKAが実施されることで、b点において差分ΔZが許容範囲PRを超えると、検出された白線WLSに基づいたLKAから慣性現在位置に基づいたLKAに切り替わる。慣性現在位置に基づいたLKAを実施することで、起点Oにおける車両CAに対する境界線RDの位置関係、例えば慣性横偏差Z2と、起点Oあるいはb点において車両CAに対する境界線RDの慣性横偏差Z2とが異なっている。従って、運転支援制御部77は、b点から流出路LSに向かっていた車両CAを走行すべき車線LMを走行させるために、b点において境界線RDに対して接近した車両CAを境界線RDに対して一定の間隔(例えば、起点Oにおける車両CAに対する境界線RDの位置関係)に戻すように、LKAを実施する。これにより、図6−2に示すように、慣性横偏差Z2は、起点Oにおける区画線横偏差Z1に接近するように走行距離Lに応じて変化し、c点において車両CAが境界線RDに対して一定の間隔となると、それを維持する。一方、区画線横偏差Z1は、慣性現在位置に基づいたLKAの実施により、車両CAが白線WLSからさらに離れるため、走行距離Lに応じて増加する。従って、流出路LSの先に形成されている車線LMに対応する白線WLMを区画線検出部71が検出できるd点までは、車両CAが境界線RDに対して一定の間隔を維持しても、図6−3に示すように、差分ΔZは許容範囲PRを超えた状態を維持する。d点に到達すると、区画線検出部71が車線LMに対応する白線WLMを再び検出するため、図6−2に示すように、区画線横偏差Z1と慣性横偏差Z2とが近似する。その結果、図6−3に示すように、差分ΔZが許容範囲PR内となり、慣性現在位置に基づいたLKAから検出された白線WLMに基づいたLKAに切り替わる。
For example, as shown in FIG. 6A, when the vehicle CA is traveling on the lane LM connected to the outflow path LS, the LKA is based on the detected white line WLM from the starting point O to the point a. Since it is implemented, the vehicle CA does not deviate from the lane LM on which the vehicle CA should travel. After the point a, the white line WLS of the outflow path LS different from the white line WLM is detected, and LKA is performed based on the detected white line WLS, so that the difference ΔZ exceeds the allowable range PR at the point b. Then, the LKA based on the detected white line WLS is switched to the LKA based on the current inertia position. By performing LKA based on the current inertia position, the positional relationship of the boundary line RD with respect to the vehicle CA at the starting point O, for example, the inertia lateral deviation Z2 and the inertia lateral deviation Z2 of the boundary line RD with respect to the vehicle CA at the starting point O or b point. Is different. Accordingly, the driving
以上のように、本実施形態に係る運転支援制御部77では、区画線の信頼度が低いと判定されると、区画線に基づいた運転支援制御を禁止し、慣性現在位置に基づいて運転支援制御を行い、区画線の信頼度が高いと判定されると、区画線に基づいた運転支援制御に復帰するので、区画線の信頼度が低い場合でも運転支援制御を継続することができる。従って、区画線の信頼度を判定することで、運転支援制御の機会を増やすことができる。
As described above, the driving
〔実施形態2〕
次に、実施形態2に係る区画線信頼度判定装置について説明する。実施形態2に係る区画線信頼度判定装置の基本的構成は、実施形態1に係る区画線信頼度判定装置2と同様であるので、構成の説明は省略する。実施形態2に係る区画線信頼度判定装置は、差分ΔZが許容範囲PRを超えるか否かで区画線の信頼度を判定するかわりに、差分勾配Kに基づいて区画線の信頼度を判定するものである。図7は、実施形態2における運転支援制御中の差分ΔZと走行距離Lと許容範囲PRとの関係を示す図である。
[Embodiment 2]
Next, the lane marking reliability determination apparatus according to the second embodiment will be described. Since the basic configuration of the lane marking reliability determination apparatus according to the second embodiment is the same as that of the lane marking
差分勾配Kは、差分ΔZの走行距離Lに応じた変化の勾配、すなわち単位時間当たりの差分ΔZの変化量(変化率)をいい、図7に示すように、差分軌跡ΔZLの傾きである。上述のように、区画線横偏差誤差EZ1は走行距離Lに応じて累積しないので、差分勾配Kは、区画線検出部71が車両CAの走行すべき車線に対向する区画線を検出している状態、すなわち正常な状態では、慣性横偏差誤差EZ2の走行距離Lに応じた累積による変化量と同等である。慣性横偏差誤差EZ2の累積による変化量は一定であるため、慣性横偏差誤差EZ2の最大値の累積による変化量も一定である。つまり、走行距離Lに応じた許容範囲PRのプラス方向およびマイナス方向の最大値の変化量である許容範囲勾配PRKmaxは、慣性横偏差誤差EZ2の最大値での累積による変化量である。ここで、区画線検出部71が車両CAの走行すべき車線に対向する区画線と異なる区画線を検出し、検出された区画線に基づいてLKAが実施されている場合では、差分勾配Kが慣性横偏差Z2の変化量の影響を受け、許容範囲勾配PRKmaxを超えることがある。
The difference gradient K is the gradient of the change according to the travel distance L of the difference ΔZ, that is, the amount of change (change rate) of the difference ΔZ per unit time, and is the slope of the difference locus ΔZL as shown in FIG. As described above, since the lane line lateral deviation error EZ1 does not accumulate according to the travel distance L, the difference gradient K detects the lane line facing the lane where the
次に、実施形態2に係る区画線信頼度判定装置による区画線信頼度判定方法について説明する。図8は、実施形態2に係る区画線信頼度判定方法のフロー図である。なお、実施形態2に係る区画線信頼度判定方法の基本的手順は、上記実施形態1に係る区画線信頼度判定方法と同様であるので、手順によっては説明を省略あるいは簡略化する。 Next, a lane marking reliability determination method by the lane marking reliability determination apparatus according to the second embodiment will be described. FIG. 8 is a flowchart of the lane marking reliability determination method according to the second embodiment. Note that the basic procedure of the lane marking reliability determination method according to the second embodiment is the same as that of the lane marking reliability determination method according to the first embodiment, and therefore the description is omitted or simplified depending on the procedure.
まず、区画線横偏差算出部72は区画線横偏差Z1を算出し(ステップST31)、慣性航法部73は、慣性航法を実施し(ステップST32)、道路データ74aを読み出し(ステップST33)、慣性横偏差Z2を算出し(ステップST34)、信頼度判定部76は横偏差の差分ΔZを算出する(ステップST35)。
First, the lane line lateral
次に、信頼度判定部76は、差分ΔZの差分勾配Kを算出する(ステップST36)。ここでは、信頼度判定部76は、差分ΔZの単位時間あたりの変化量を差分勾配Kとして算出する(K=dΔZ/dt)。 Next, the reliability determination unit 76 calculates a difference gradient K of the difference ΔZ (step ST36). Here, the reliability determination unit 76 calculates the amount of change per unit time of the difference ΔZ as the difference gradient K (K = dΔZ / dt).
次に、信頼度判定部76は、F=1であるか否かを判定(ステップST37)し、F=1であると判定する(ステップST37肯定)と、差分勾配Kが許容範囲勾配PRKmaxを超えるか否かを判定する(ステップST38)。ここでは、信頼度判定部76は、区画線の信頼度が高いと判定した場合に、差分勾配Kが許容範囲勾配PRKmaxを超える、例えば運転支援制御を行うことで差分勾配Kが誤差EZのみの差分勾配Kを超えて変化することで、許容範囲勾配PRKmaxを超えるか否かを判定する。 Next, the reliability determination unit 76 determines whether or not F = 1 (step ST37). If the reliability determination unit 76 determines that F = 1 (Yes in step ST37), the difference gradient K sets the allowable range gradient PRKmax. It is determined whether it exceeds (step ST38). Here, when the reliability determination unit 76 determines that the reliability of the lane marking is high, the difference gradient K exceeds the allowable range gradient PRKmax. For example, the difference gradient K includes only the error EZ by performing driving support control. By changing beyond the differential gradient K, it is determined whether or not the allowable gradient GPR PRKmax is exceeded.
次に、信頼度判定部76は、差分勾配Kが許容範囲勾配PRKmaxを超えていると判定する(ステップST38肯定)と、区画線の信頼度が低いと判定する(ステップST39)。ここでは、信頼度判定部76は、差分ΔZが変化することで変化した差分勾配Kが許容範囲勾配PRKmaxを超えた場合に、区画線検出部71により検出された区画線が、本来車両CAの走行すべき車線に対応する区画線ではないと判定し、フラグをリセット(F=0)とする。
Next, when determining that the difference gradient K exceeds the allowable range gradient PRKmax (Yes in step ST38), the reliability determination unit 76 determines that the reliability of the lane marking is low (step ST39). Here, the reliability determination unit 76 determines that the lane line detected by the lane
また、信頼度判定部76は、差分勾配Kが許容範囲勾配PRKmaxを超えていないと判定する(ステップST38否定)と、現在の制御周期を終了し、次の制御周期に移行する。つまり、信頼度判定部76は、差分ΔZが変化することで変化した差分勾配Kが許容範囲勾配PRKmaxを超えていない場合に、区画線の信頼度が高いままと判定し、フラグを立てた状態を維持(F=1)する。 In addition, when the reliability determination unit 76 determines that the difference gradient K does not exceed the allowable range gradient PRKmax (No in step ST38), the reliability determination unit 76 ends the current control cycle and shifts to the next control cycle. That is, the reliability determination unit 76 determines that the reliability of the lane marking remains high and sets a flag when the difference gradient K that has changed due to the change in the difference ΔZ does not exceed the allowable range gradient PRKmax. Is maintained (F = 1).
また、信頼度判定部76は、F=0であると判定する(ステップST37否定)と、差分ΔZが許容範囲PR内であるか否かを判定し(ステップST40)、差分ΔZが許容範囲PR内であると判定する(ステップST40肯定)と区画線の信頼度が高いと判定し(ステップST41)、差分ΔZが許容範囲PR外であると判定する(ステップST40否定)と、現在の制御周期を終了し、次の制御周期に移行する。 Further, when determining that F = 0 (No in step ST37), the reliability determination unit 76 determines whether or not the difference ΔZ is within the allowable range PR (step ST40), and the difference ΔZ is within the allowable range PR. If it is determined that it is within the range (Yes in step ST40), it is determined that the reliability of the lane marking is high (step ST41), and if it is determined that the difference ΔZ is outside the allowable range PR (No in step ST40), the current control cycle To end the next control cycle.
以上のように、本実施形態に係る区画線信頼度判定装置では、差分勾配Kと、許容範囲勾配PRKmaxとに基づいて区画線の信頼度を判定するので、差分ΔZが許容範囲PR内であっても、差分勾配Kが許容範囲勾配PRKmaxを超えると、区画線の信頼度が低いと判定することができる。従って、上記実施形態1と同様の効果を奏するとともに、実施形態1における区画線の信頼度の判定よりも早い段階で、検出された区画線が車両CAの走行すべき車線に対向する区画線でないことを判定することができる。これにより、区画線検出の異常をさらに精度良く認識することができ、信頼度の高い運転支援制御を実施することができる。なお、本実施形態に係る区画線信頼度判定装置は、実施形態1と同様に、運転支援制御装置1における運転支援制御の切り替えに用いることができる。
As described above, in the lane marking reliability determination apparatus according to the present embodiment, the lane marking reliability is determined based on the difference gradient K and the allowable range gradient PRKmax. Therefore, the difference ΔZ is within the allowable range PR. However, if the difference gradient K exceeds the allowable range gradient PRKmax, it can be determined that the reliability of the lane marking is low. Therefore, the same effect as in the first embodiment is achieved, and the detected lane line is not a lane line facing the lane in which the vehicle CA should travel at an earlier stage than the determination of the lane line reliability in the first embodiment. Can be determined. Thereby, the abnormality in the lane marking detection can be recognized with higher accuracy, and the driving support control with high reliability can be performed. Note that the lane marking reliability determination apparatus according to the present embodiment can be used for switching driving support control in the driving
〔実施形態3〕
次に、実施形態3に係る区画線信頼度判定装置について説明する。実施形態3に係る区画線信頼度判定装置の基本的構成は、実施形態1,2に係る区画線信頼度判定装置2と同様であるので、構成の説明は省略する。実施形態3に係る区画線信頼度判定装置は、区画線の信頼度が高い場合に、慣性横偏差Z2に区画線横偏差Z1をセットするとともに、許容範囲PRの更新を行うものである。図9は、実施形態3に係る区画線信頼度判定方法のフロー図である。図10−1は、実施形態3における差分ΔZと走行距離Lと許容範囲PRとの関係を示す図である。図10−2は、実施形態3における横偏差Zと走行距離Lとの関係を示す図である。図10−3は、実施形態3における差分ΔZと走行距離Lと許容範囲PRとの関係を示す図である。
[Embodiment 3]
Next, a lane marking reliability determination apparatus according to Embodiment 3 will be described. Since the basic configuration of the lane marking reliability determination apparatus according to the third embodiment is the same as that of the lane marking
図10−1に示すように、許容範囲PRは、起点Oからの走行距離Lに応じて増加していくものである。従って、起点Oから走行距離Lが伸びるほど、差分ΔZが許容範囲PRを超えるのに時間がかかるため、検出された区画線が車両CAの走行すべき車線に対応する区画線と異なってから、区画線の信頼度が低いと判定されるまでのタイミングが遅くなる虞がある。そこで、区画線の信頼度が高い、本実施形態では、差分ΔZが許容範囲PR内であり、差分勾配Kが許容範囲勾配PRKmax以下であり、かつ起点Oから所定の走行距離L1を走行している場合(同図に示す斜線部分)に、慣性横偏差Z2をリセットすることで、許容範囲PRの更新を行う。 As shown in FIG. 10A, the allowable range PR increases according to the travel distance L from the starting point O. Accordingly, the longer the travel distance L from the starting point O, the longer it takes for the difference ΔZ to exceed the allowable range PR. Therefore, after the detected lane line is different from the lane line corresponding to the lane on which the vehicle CA should travel, There is a possibility that the timing until it is determined that the reliability of the lane marking is low is delayed. Therefore, in the present embodiment, the reliability of the lane marking is high, the difference ΔZ is within the allowable range PR, the differential gradient K is equal to or less than the allowable range gradient PRKmax, and the vehicle travels a predetermined travel distance L1 from the starting point O. If it is present (shaded area shown in the figure), the allowable range PR is updated by resetting the inertial lateral deviation Z2.
次に、実施形態3に係る区画線信頼度判定装置による区画線信頼度判定方法について説明する。なお、実施形態3に係る区画線信頼度判定方法の基本的手順は、上記実施形態1,2に係る区画線信頼度判定方法と同様であるので、手順によっては説明を省略あるいは簡略化する。 Next, a lane marking reliability determination method by the lane marking reliability determination apparatus according to the third embodiment will be described. Note that the basic procedure of the lane marking reliability determination method according to the third embodiment is the same as that of the lane marking reliability determination method according to the first and second embodiments. Therefore, the description is omitted or simplified depending on the procedure.
まず、区画線横偏差算出部72は区画線横偏差Z1を算出し(ステップST50)、慣性航法部73は、慣性航法を実施し(ステップST51)、道路データ74aを読み出し(ステップST52)、慣性横偏差Z2を算出し(ステップST53)、信頼度判定部76は横偏差の差分ΔZを算出し(ステップST54)、差分ΔZの差分勾配Kを算出する(ステップST55)。
First, the lane line lateral
次に、信頼度判定部76は、許容範囲勾配PRKmaxが差分勾配Kを超えるか否かを判定する(ステップST56)。ここでは、信頼度判定部76は、区画線の信頼度が高いと判定される条件の1つである差分勾配Kと許容範囲勾配PRKmaxとの関係を満たしているか否かを判定する。 Next, the reliability determination unit 76 determines whether or not the allowable range gradient PRKmax exceeds the difference gradient K (step ST56). Here, the reliability determination unit 76 determines whether or not the relationship between the difference gradient K and the allowable range gradient PRKmax, which is one of the conditions for determining that the lane marking reliability is high, is satisfied.
次に、信頼度判定部76は、許容範囲勾配PRKmaxが差分勾配Kを超えると判定する(ステップST56肯定)と、差分ΔZが許容範囲PR内であるか否かを判定する(ステップST57)。ここでは、信頼度判定部76は、区画線の信頼度が高いと判定される条件の1つである差分ΔZと許容範囲PRとの関係を満たしているか否かを判定する。なお、信頼度判定部76は、差分勾配Kが許容範囲勾配PRKmaxを超えると判定する(ステップST56否定)と、現在の制御周期を終了し、次の制御周期に移行する。つまり、信頼度判定部76は、検出された区画線の信頼度が低いので、許容範囲PRの更新を行わない。 Next, when determining that the allowable range gradient PRKmax exceeds the difference gradient K (Yes in step ST56), the reliability determination unit 76 determines whether or not the difference ΔZ is within the allowable range PR (step ST57). Here, the reliability determination unit 76 determines whether or not the relationship between the difference ΔZ, which is one of the conditions for determining that the lane marking reliability is high, and the allowable range PR are satisfied. In addition, if the reliability determination part 76 determines with the difference gradient K exceeding the tolerance | permissible_range gradient PRKmax (step ST56 negative), it will complete | finish the present control period and will transfer to the following control period. That is, the reliability determination unit 76 does not update the allowable range PR because the reliability of the detected lane marking is low.
次に、信頼度判定部76は、差分ΔZが許容範囲PR内であると判定する(ステップST57肯定)と、車両CAが所定の走行距離L1を走行しているか否かを判定する(ステップST58)。ここで、所定の走行距離L1は、例えば、許容範囲勾配PRKmaxなどに基づいて設定されるものであり、例えば、数m〜数百m程度であるが、区画線検出の異常判定の精度と許容範囲PRの更新頻度とを両立できる値が好ましい。なお、信頼度判定部76は、差分ΔZが許容範囲PR外であると判定する(ステップST57否定)と、現在の制御周期を終了し、次の制御周期に移行する。つまり、信頼度判定部76は、検出された区画線の信頼度が低いので、許容範囲PRの更新を行わない。 Next, when the reliability determination unit 76 determines that the difference ΔZ is within the allowable range PR (Yes in step ST57), the reliability determination unit 76 determines whether or not the vehicle CA is traveling the predetermined travel distance L1 (step ST58). ). Here, the predetermined travel distance L1 is set based on, for example, the allowable range gradient PRKmax, and is, for example, about several meters to several hundred meters. A value that can achieve both the update frequency of the range PR is preferable. If the reliability determination unit 76 determines that the difference ΔZ is outside the allowable range PR (No in step ST57), the reliability determination unit 76 ends the current control cycle and shifts to the next control cycle. That is, the reliability determination unit 76 does not update the allowable range PR because the reliability of the detected lane marking is low.
次に、信頼度判定部76は、車両CAが所定の走行距離L1を走行していると判定する(ステップST58肯定)と、慣性横偏差Z2に区画線横偏差Z1をセットする(ステップST59)。ここでは、信頼度判定部76は、許容範囲PRの更新の条件をすべて満たすと、図10−2に示すように、慣性横偏差Z2を区画線横偏差Z1とする(Z2=Z1)ことで、差分ΔZを0にリセットし、起点Oを新たに設定する。なお、同図に示すように、許容範囲PRの更新の条件をすべて満たす場合は、所定の走行距離L1ごとに起点Oが更新されるとともに、差分ΔZが0となる。なお、信頼度判定部76は、車両CAが所定の走行距離L1を走行していないと判定する(ステップST58否定)と、現在の制御周期を終了し、次の制御周期に移行する。つまり、信頼度判定部76は、許容範囲PRの更新が頻繁となることを抑制するために、車両CAが起点Oから所定の走行距離L1だけ走行していない場合は許容範囲PRの更新を行わない。 Next, when the reliability determination unit 76 determines that the vehicle CA is traveling the predetermined travel distance L1 (Yes in step ST58), the lane marking lateral deviation Z1 is set to the inertia lateral deviation Z2 (step ST59). . Here, when all the conditions for updating the allowable range PR are satisfied, the reliability determination unit 76 sets the inertial lateral deviation Z2 as the lane marking lateral deviation Z1 (Z2 = Z1) as shown in FIG. 10-2. Then, the difference ΔZ is reset to 0, and the starting point O is newly set. As shown in the figure, when all the conditions for updating the allowable range PR are satisfied, the starting point O is updated for each predetermined travel distance L1, and the difference ΔZ becomes zero. Note that when the reliability determination unit 76 determines that the vehicle CA is not traveling the predetermined travel distance L1 (No in step ST58), the reliability control unit 76 ends the current control cycle and shifts to the next control cycle. That is, the reliability determination unit 76 updates the allowable range PR when the vehicle CA is not traveling the predetermined travel distance L1 from the starting point O in order to prevent the allowable range PR from being frequently updated. Absent.
次に、信頼度判定部76は、図9に示すように、許容範囲PRを更新する(ステップST60)。ここでは、信頼度判定部76は、許容範囲PRの更新の条件をすべて満たすと、図10−3に示すように、許容範囲PRの更新、すなわち新しい起点Oに基づいて許容範囲PRを設定する。 Next, the reliability determination unit 76 updates the allowable range PR as shown in FIG. 9 (step ST60). Here, when all the conditions for updating the allowable range PR are satisfied, the reliability determination unit 76 sets the allowable range PR based on the update of the allowable range PR, that is, the new starting point O, as illustrated in FIG. .
以上のように、本実施形態に係る区画線信頼度判定装置では、区画線の信頼度が高く、起点Oから所定の走行距離L1を走行していると、慣性横偏差Z2に区画線横偏差Z1をセットしつつ、許容範囲PRの更新を行うので、検出された区画線が車両CAの走行すべき車線に対応する区画線と異なってから、区画線の信頼度が低いと判定されるまでのタイミングが遅くなることを抑制することができる。これにより、区画線検出の異常をさらに精度良く認識することができ、信頼度の高い運転支援制御を実施することができる。 As described above, in the lane marking reliability determination apparatus according to the present embodiment, when the lane marking reliability is high and the vehicle travels a predetermined travel distance L1 from the starting point O, the lane marking lateral deviation becomes the inertia lateral deviation Z2. Since the allowable range PR is updated while Z1 is set, it is determined that the reliability of the lane marking is low after the detected lane marking is different from the lane marking corresponding to the lane on which the vehicle CA should travel Can be prevented from being delayed. Thereby, the abnormality in the lane marking detection can be recognized with higher accuracy, and the driving support control with high reliability can be performed.
また、上記実施形態1〜3における各構成要素は、適宜組み合わせることができ、本発明は実施形態1〜3に限定されるものではない。 Moreover, each component in the said Embodiment 1-3 can be combined suitably, and this invention is not limited to Embodiment 1-3.
1 運転支援制御装置
2 区画線信頼度判定装置
3 前方カメラ
4 車速センサ
5 ヨーレートセンサ
6 GPS
7 運転支援ECU
71 区画線検出部
72 区画線横偏差算出部
73 慣性航法部
74 記憶部
74a 道路データ
75 慣性横偏差算出部
76 信頼度判定部
77 運転支援制御部
8 駆動装置
9 制動装置
10 操舵装置
CA 車両
EZ1 区画線横偏差誤差
EZ2 慣性横偏差誤差
IL 推定走行軌跡
K 差分勾配
L 走行距離
LM 車線
LS 流出路(分岐路)
O 起点
PR 許容範囲
PRKmax 許容範囲勾配
RD 境界線
RL 実走行軌跡
WLM 白線(車線)
WLS 白線(流出路)
Z1 区画線横偏差
Z2 慣性横偏差
ΔZ 差分
ΔZL 差分軌跡
DESCRIPTION OF
7 Driving assistance ECU
71 Marking
O Start PR Permissible range PRKmax Permissible range gradient RD Boundary line RL Actual travel locus WLM White line (lane)
WLS white line (outflow)
Z1 lane marking lateral deviation Z2 inertia lateral deviation ΔZ difference ΔZL difference trajectory
Claims (7)
前記区画線と前記車両との横偏差である区画線横偏差を算出する区画線横偏差算出手段と、
前記車両の車速および旋回状態に基づいた慣性航法による車両の現在位置と、前記車両が走行する道路データとに基づいて慣性横偏差を算出する慣性横偏差算出手段と、
前記区画線横偏差と前記慣性横偏差との差分と、区画線横偏差誤差および累積増加する慣性横偏差誤差に基づいた許容範囲とを比較して、前記区画線検出手段により検出された前記区画線の信頼度を判定する信頼度判定手段と、
を備えることを特徴とする区画線信頼度判定装置。 Lane marking detection means for detecting a lane marking that divides the lane in which the vehicle is traveling;
A lane marking lateral deviation calculating means for calculating a lane marking lateral deviation which is a lateral deviation between the lane marking and the vehicle;
An inertia lateral deviation calculating means for calculating an inertia lateral deviation based on a current position of the vehicle by inertial navigation based on a vehicle speed and a turning state of the vehicle, and road data on which the vehicle travels;
The difference between the lane line lateral deviation and the inertial lateral deviation is compared with an allowable range based on the lane line lateral deviation error and the cumulatively increasing inertial lateral deviation error, and the compartment detected by the lane line detection means A reliability determination means for determining the reliability of the line;
A lane marking reliability determination apparatus comprising:
前記信頼度判定手段は、前記差分が前記許容範囲を超えた場合に、前記区画線検出手段により検出された前記区画線の信頼度が低いと判定する区画線信頼度判定装置。 In the lane marking reliability determination apparatus according to claim 1,
The lane marking reliability determination device that determines that the reliability of the lane marking detected by the lane marking detection unit is low when the difference exceeds the allowable range.
前記信頼度判定手段は、前記差分の走行距離に応じた変化の勾配である差分勾配が、前記許容範囲の最大値の走行距離に応じた変化の勾配である許容範囲勾配を超えた場合に、前記区画線検出手段により検出された前記区画線の信頼度が低いと判定する区画線信頼度判定装置。 In the lane marking reliability determination apparatus according to claim 1,
The reliability determination means, when a difference gradient that is a change gradient according to the difference travel distance exceeds an allowable range gradient that is a change gradient according to the maximum travel distance of the allowable range, A lane marking reliability determination apparatus that determines that the lane marking detected by the lane marking detection unit has low reliability.
前記慣性横偏差算出手段は、前記区画線検出手段により検出された前記区画線の信頼度が高いと判定されると、前記区画線横偏差を前記慣性横偏差にセットするとともに、前記許容範囲を更新する更新処理を許容する区画線信頼度判定装置。 In the lane marking reliability determination apparatus according to any one of claims 1 to 3,
If it is determined that the lane marking detected by the lane marking detection unit is highly reliable, the inertia lateral deviation calculation means sets the lane marking lateral deviation to the inertia lateral deviation and sets the allowable range. A lane marking reliability determination apparatus that allows update processing to be updated.
前記区画線に基づいて前記車両の運転支援制御を行う運転支援制御手段と、
を備え、
前記運転支援制御手段は、
前記区画線検出手段により検出された前記区画線の信頼度が低いと判定されると、前記区画線に基づいた前記運転支援制御を禁止し、前記慣性航法による車両の現在位置に基づいて前記運転支援制御を行い、
前記区画線検出手段により検出された前記区画線の信頼度が高いと判定されると、前記区画線に基づいた前記運転支援制御に復帰する運転支援制御装置。 The lane marking reliability determination apparatus according to any one of claims 1 to 4,
Driving support control means for performing driving support control of the vehicle based on the lane marking;
With
The driving support control means includes
If it is determined that the reliability of the lane line detected by the lane line detection means is low, the driving support control based on the lane line is prohibited, and the driving is performed based on the current position of the vehicle by the inertial navigation. Do support control,
The driving support control device that returns to the driving support control based on the lane marking when it is determined that the lane marking detected by the lane marking detecting means has high reliability.
前記区画線と前記車両との横偏差である区画線横偏差を算出する手順と、
前記車両の車速および旋回状態に基づいた慣性航法による車両位置と、前記車両が走行する道路データとに基づいて慣性横偏差を算出する手順と、
前記区画線横偏差と前記慣性横偏差との差分と、区画線横偏差誤差および累積増加する慣性横偏差誤差に基づいた許容範囲とを比較して、前記区画線検出手段により検出された前記区画線の信頼度を判定する手順と、
を含むことを特徴とする区画線信頼度判定方法。 A procedure for detecting a lane marking that divides the lane in which the vehicle is traveling; and
A procedure for calculating a lane marking lateral deviation which is a lateral deviation between the lane marking and the vehicle;
A procedure for calculating an inertia lateral deviation based on a vehicle position by inertial navigation based on a vehicle speed and a turning state of the vehicle, and road data on which the vehicle travels;
The difference between the lane line lateral deviation and the inertial lateral deviation is compared with an allowable range based on the lane line lateral deviation error and the cumulatively increasing inertial lateral deviation error, and the compartment detected by the lane line detection means A procedure for determining the reliability of the line;
A lane marking reliability determination method comprising:
前記区画線と前記車両との横偏差である区画線横偏差を算出する手順と、
前記車両の車速および旋回状態に基づいた慣性航法による車両位置と、前記車両が走行する道路データとに基づいて慣性横偏差を算出する手順と、
前記区画線横偏差と前記慣性横偏差との差分と、区画線横偏差誤差および累積増加する慣性横偏差誤差に基づいた許容範囲とを比較して、前記区画線検出手段により検出された前記区画線の信頼度を判定する手順と、
前記区画線検出手段により検出された前記区画線の信頼度が低いと判定されると、前記区画線に基づいた前記車両の運転支援制御を禁止し、前記慣性航法による車両の現在位置に基づいて前記運転支援制御を行う手順と、
前記区画線検出手段により検出された前記区画線の信頼度が高いと判定されると、前記区画線に基づいた前記運転支援制御に復帰する手順と、
を含むことを特徴とする運転支援制御方法。 A procedure for detecting a lane marking that divides the lane in which the vehicle is traveling; and
A procedure for calculating a lane marking lateral deviation which is a lateral deviation between the lane marking and the vehicle;
A procedure for calculating an inertia lateral deviation based on a vehicle position by inertial navigation based on a vehicle speed and a turning state of the vehicle, and road data on which the vehicle travels;
The difference between the lane line lateral deviation and the inertial lateral deviation is compared with an allowable range based on the lane line lateral deviation error and the cumulatively increasing inertial lateral deviation error, and the compartment detected by the lane line detection means A procedure for determining the reliability of the line;
If it is determined that the reliability of the lane line detected by the lane line detection means is low, driving support control of the vehicle based on the lane line is prohibited, and based on the current position of the vehicle by the inertial navigation A procedure for performing the driving support control;
When it is determined that the reliability of the lane marking detected by the lane marking detection means is high, a procedure for returning to the driving support control based on the lane marking;
A driving support control method comprising:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013016217A JP6040788B2 (en) | 2013-01-30 | 2013-01-30 | Track line reliability determination device and driving support control device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013016217A JP6040788B2 (en) | 2013-01-30 | 2013-01-30 | Track line reliability determination device and driving support control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2014144764A true JP2014144764A (en) | 2014-08-14 |
JP6040788B2 JP6040788B2 (en) | 2016-12-07 |
Family
ID=51425374
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2013016217A Expired - Fee Related JP6040788B2 (en) | 2013-01-30 | 2013-01-30 | Track line reliability determination device and driving support control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6040788B2 (en) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014151906A (en) * | 2013-02-07 | 2014-08-25 | Mando Corp | Lane keep control system and method and computer readable recording medium |
JP2016218649A (en) * | 2015-05-19 | 2016-12-22 | 株式会社デンソー | Travel support apparatus |
CN106441354A (en) * | 2015-08-11 | 2017-02-22 | 通用汽车环球科技运作有限责任公司 | Methods and apparatus for evaluating operation of a vehicle onboard navigation system using lateral offset data |
JP2018079892A (en) * | 2016-11-18 | 2018-05-24 | 株式会社Soken | Vehicle control device |
CN110001636A (en) * | 2017-12-25 | 2019-07-12 | 丰田自动车株式会社 | Vehicle control system |
WO2019187750A1 (en) * | 2018-03-28 | 2019-10-03 | 日立オートモティブシステムズ株式会社 | Vehicle control device |
CN111003062A (en) * | 2018-10-08 | 2020-04-14 | 株式会社万都 | Apparatus and method for controlling vehicle by determining distortion in lane recognition |
JPWO2019186692A1 (en) * | 2018-03-27 | 2020-12-03 | 日産自動車株式会社 | Control method and control device for autonomous vehicles |
JP7380734B2 (en) | 2022-03-25 | 2023-11-15 | いすゞ自動車株式会社 | Steering control device |
JP7380735B2 (en) | 2022-03-25 | 2023-11-15 | いすゞ自動車株式会社 | Steering control device |
JP7380733B2 (en) | 2022-03-25 | 2023-11-15 | いすゞ自動車株式会社 | Steering control device |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07295633A (en) * | 1994-04-26 | 1995-11-10 | Mazda Motor Corp | Travel path estimation device for automobile |
JPH11281352A (en) * | 1998-03-31 | 1999-10-15 | Nissan Motor Co Ltd | Road shape detector |
JP2000059764A (en) * | 1998-08-07 | 2000-02-25 | Mazda Motor Corp | Vehicle position detecting device |
JP2004206275A (en) * | 2002-12-24 | 2004-07-22 | Denso Corp | Automatic drive control system |
JP2005346382A (en) * | 2004-06-02 | 2005-12-15 | Toyota Motor Corp | Boundary line detecting device |
-
2013
- 2013-01-30 JP JP2013016217A patent/JP6040788B2/en not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07295633A (en) * | 1994-04-26 | 1995-11-10 | Mazda Motor Corp | Travel path estimation device for automobile |
JPH11281352A (en) * | 1998-03-31 | 1999-10-15 | Nissan Motor Co Ltd | Road shape detector |
JP2000059764A (en) * | 1998-08-07 | 2000-02-25 | Mazda Motor Corp | Vehicle position detecting device |
JP2004206275A (en) * | 2002-12-24 | 2004-07-22 | Denso Corp | Automatic drive control system |
JP2005346382A (en) * | 2004-06-02 | 2005-12-15 | Toyota Motor Corp | Boundary line detecting device |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014151906A (en) * | 2013-02-07 | 2014-08-25 | Mando Corp | Lane keep control system and method and computer readable recording medium |
JP2016218649A (en) * | 2015-05-19 | 2016-12-22 | 株式会社デンソー | Travel support apparatus |
CN106441354A (en) * | 2015-08-11 | 2017-02-22 | 通用汽车环球科技运作有限责任公司 | Methods and apparatus for evaluating operation of a vehicle onboard navigation system using lateral offset data |
JP2018079892A (en) * | 2016-11-18 | 2018-05-24 | 株式会社Soken | Vehicle control device |
CN110001636B (en) * | 2017-12-25 | 2022-06-07 | 丰田自动车株式会社 | Vehicle control system |
CN110001636A (en) * | 2017-12-25 | 2019-07-12 | 丰田自动车株式会社 | Vehicle control system |
JPWO2019186692A1 (en) * | 2018-03-27 | 2020-12-03 | 日産自動車株式会社 | Control method and control device for autonomous vehicles |
WO2019187750A1 (en) * | 2018-03-28 | 2019-10-03 | 日立オートモティブシステムズ株式会社 | Vehicle control device |
JPWO2019187750A1 (en) * | 2018-03-28 | 2021-01-07 | 日立オートモティブシステムズ株式会社 | Vehicle control device |
US11472419B2 (en) | 2018-03-28 | 2022-10-18 | Hitachi Astemo, Ltd. | Vehicle control device |
CN111003062A (en) * | 2018-10-08 | 2020-04-14 | 株式会社万都 | Apparatus and method for controlling vehicle by determining distortion in lane recognition |
CN111003062B (en) * | 2018-10-08 | 2023-08-25 | 汉拿科锐动电子股份公司 | Apparatus and method for controlling vehicle by determining distortion in lane recognition |
JP7380734B2 (en) | 2022-03-25 | 2023-11-15 | いすゞ自動車株式会社 | Steering control device |
JP7380735B2 (en) | 2022-03-25 | 2023-11-15 | いすゞ自動車株式会社 | Steering control device |
JP7380733B2 (en) | 2022-03-25 | 2023-11-15 | いすゞ自動車株式会社 | Steering control device |
Also Published As
Publication number | Publication date |
---|---|
JP6040788B2 (en) | 2016-12-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6040788B2 (en) | Track line reliability determination device and driving support control device | |
JP6447639B2 (en) | Target route generation device and travel control device | |
RU2702850C1 (en) | Method of motion control and movement control device | |
US9550494B2 (en) | Driving assistance apparatus | |
CN107615011B (en) | Parking position setting device and method | |
US10717439B2 (en) | Traveling control system and vehicle control method | |
JP5924508B2 (en) | Vehicle travel control device | |
KR102560700B1 (en) | Apparatus and Method for vehicle driving assistance | |
JP4938351B2 (en) | Positioning information update device for vehicles | |
US8788136B2 (en) | Method and device for lane keeping assistance regulation | |
JP5162103B2 (en) | Support control device | |
US9014917B2 (en) | Method and device for adjusting an intervention torque of a steering assistance system | |
CN107107751B (en) | Target vehicle speed generation device and travel control device | |
WO2007132860A1 (en) | Object recognition device | |
US10001782B2 (en) | Target pathway generating device and driving control device | |
JP6881369B2 (en) | Vehicle position estimation device | |
JP6377942B2 (en) | Driving assistance device | |
WO2018131062A1 (en) | Travel path recognition device and travel path recognition method | |
JP2010078387A (en) | Lane determining apparatus | |
JP2011033572A (en) | Device and method for determining entry into fork road | |
WO2016110732A1 (en) | Target route generation device and travel control device | |
JP2005343260A (en) | Steering assistance device for vehicle | |
JP2010190832A (en) | Device and program for determining merging/leaving | |
JP4217900B2 (en) | Vehicle travel control device | |
JP2008129867A (en) | Drive support device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20150513 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20160328 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20160405 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20160519 |
|
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: 20161011 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20161024 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6040788 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
LAPS | Cancellation because of no payment of annual fees |