JP2014144764A - Lane marker reliability determination device and driving support control apparatus - Google Patents

Lane marker reliability determination device and driving support control apparatus Download PDF

Info

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
Application number
JP2013016217A
Other languages
Japanese (ja)
Other versions
JP6040788B2 (en
Inventor
Akihide Tachibana
彰英 橘
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Motor Corp
Original Assignee
Toyota Motor Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Toyota Motor Corp filed Critical Toyota Motor Corp
Priority to JP2013016217A priority Critical patent/JP6040788B2/en
Publication of JP2014144764A publication Critical patent/JP2014144764A/en
Application granted granted Critical
Publication of JP6040788B2 publication Critical patent/JP6040788B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

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

PROBLEM TO BE SOLVED: To provide a lane marker reliability determination device which can accurately determine the reliability of a detected lane marker.SOLUTION: A lane marker reliability determination device includes: a lane marker detection unit 71 for detecting a lane marker marking the lane where an own vehicle is traveling; a lane marker lateral deviation calculation unit 72 for calculating a lane marker lateral deviation which is a lateral deviation between the lane marker and the vehicle; an inertia lateral deviation calculation unit 75 for calculating an inertia lateral deviation according to the current position of the vehicle, using inertial navigation on the basis of vehicle speed and vehicle turning state, and road data 74a of the road where the vehicle is traveling; and a reliability determination unit 76 for determining the reliability of the lane marker detected by the lane marker detection unit 71 by comparing the difference between the lane marker lateral deviation and the inertia lateral deviation with a permissible range based on lane marker lateral deviation error and accumulatively increasing inertia lateral deviation error. The device determines that the reliability of the lane marker detected by the lane marker detection unit 71 is low when the difference exceeds the permissible range.

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 Patent Document 1, if the erroneous detection of the candidate point of the lane marker is clear, the road model is initialized and the lane recognition is performed again from the beginning. If the erroneous detection of the candidate point is unknown, the candidate point A technique has been proposed in which it is determined whether there is continuity in the detection result, and if there is no continuity, updating of the road model is stopped and lane recognition is performed based on the previous value instead of the current value (see Patent Document 1).

特開2011−043907号公報JP 2011-043907 A

ところで、画像から区画線を精度良く検出したとしても、検出された区画線が、実際は車両の走行すべき車線を区画する区画線とは異なる区画線であっても正しい区画線であると判定する虞がある。例えば、高速道路においては、本線に対して車両が出て行く流出路や入ってくる流入路などの分岐路があり、本線に対向する区画線が本線と分岐路との接続部分で消失している。さらに、分岐点で消失した本線に対応する区画線は、分岐路に対応する区画線と接続されている。従って、分岐路に接続する車線を走行している車両においては、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.

図1は、実施形態1に係る区画線信頼度判定装置を含む運転支援制御装置の概略構成例を示す図である。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. 図2−1は、実施形態1における車両の走行状態を示す図である。FIG. 2-1 is a diagram illustrating a traveling state of the vehicle in the first embodiment. 図2−2は、実施形態1における横偏差Zと走行距離Lとの関係を示す図である。FIG. 2-2 is a diagram illustrating a relationship between the lateral deviation Z and the travel distance L in the first embodiment. 図2−3は、実施形態1における差分ΔZと走行距離Lと許容範囲PRとの関係を示す図である。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. 図3−1は、区画線横偏差誤差EZ1と実走行軌跡RLとの関係を示す図である。FIG. 3A is a diagram illustrating a relationship between the lane marking lateral deviation error EZ1 and the actual travel locus RL. 図3−2は、慣性横偏差誤差EZ2と実走行軌跡RLとの関係を示す図である。FIG. 3-2 is a diagram illustrating a relationship between the inertial lateral deviation error EZ2 and the actual travel locus RL. 図3−3は、許容範囲PRを示す図である。FIG. 3C is a diagram illustrating the allowable range PR. 図4は、実施形態1に係る区画線信頼度判定方法のフロー図である。FIG. 4 is a flowchart of the lane marking reliability determination method according to the first embodiment. 図5は、実施形態1に係る運転支援制御方法のフロー図である。FIG. 5 is a flowchart of the driving support control method according to the first embodiment. 図6−1は、実施形態1における運転支援制御中の車両の走行状態を示す図である。FIG. 6A is a diagram illustrating a traveling state of the vehicle during the driving support control in the first embodiment. 図6−2は、実施形態1における運転支援制御中の横偏差Zと走行距離Lとの関係を示す図である。FIG. 6B is a diagram illustrating a relationship between the lateral deviation Z and the travel distance L during the driving support control in the first embodiment. 図6−3は、実施形態1における運転支援制御中の差分ΔZと走行距離Lと許容範囲PRとの関係を示す図である。6-3 is a diagram illustrating a relationship among the difference ΔZ, the travel distance L, and the allowable range PR during the driving support control in the first embodiment. 図7は、実施形態2における運転支援制御中の差分ΔZと走行距離Lと許容範囲PRとの関係を示す図である。FIG. 7 is a diagram illustrating a relationship among the difference ΔZ, the driving distance L, and the allowable range PR during the driving support control in the second embodiment. 図8は、実施形態2に係る区画線信頼度判定方法のフロー図である。FIG. 8 is a flowchart of the lane marking reliability determination method according to the second embodiment. 図9は、実施形態3に係る区画線信頼度判定方法のフロー図である。FIG. 9 is a flowchart of the lane marking reliability determination method according to the third embodiment. 図10−1は、実施形態3における差分ΔZと走行距離Lと許容範囲PRとの関係を示す図である。FIG. 10A is a diagram illustrating a relationship among the difference ΔZ, the travel distance L, and the allowable range PR in the third embodiment. 図10−2は、実施形態3における横偏差Zと走行距離Lとの関係を示す図である。FIG. 10-2 is a diagram illustrating a relationship between the lateral deviation Z and the travel distance L in the third embodiment. 図10−3は、実施形態3における差分ΔZと走行距離Lと許容範囲PRとの関係を示す図である。FIG. 10C is a diagram illustrating a relationship among the difference ΔZ, the travel distance L, and the allowable range PR in the third embodiment.

本発明を実施するための形態(実施形態)につき、図面を参照しつつ詳細に説明する。以下の実施形態に記載した内容により本発明が限定されるものではない。また、以下に記載した構成要素には、当業者が容易に想定できるもの、実質的に同一のものが含まれる。さらに、以下に記載した構成は適宜組み合わせることが可能である。また、本発明の要旨を逸脱しない範囲で構成の種々の省略、置換又は変更を行うことができる。   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通信システムに代表される通信システムにより電気的に接続されている。
Embodiment 1
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 reliability determination device 2 of the driving support control device 1 is mounted on a vehicle CA (not shown), and includes a front camera 3, a vehicle speed sensor 4, a yaw rate sensor 5, and GPS (Global Positioning System) 6 and driving support ECU (Electronic Control Unit) 7 are included. The driving support control device 1 includes a lane marking reliability determination device 2, a front camera 3, a vehicle speed sensor 4, a driving support ECU 7 including a driving support control unit 77, a drive device 8, a braking device 9, and a steering device. 10. The driving assistance ECU 7 and other devices and devices such as the front camera 3 are electrically connected by a communication system represented by a CAN communication system, for example.

前方カメラ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 GPS 6, and in this case, the vehicle speed V is detected based on a change in a positioning current position described later.

ヨーレートセンサ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 GPS 6 is a vehicle position detection means for acquiring a positioning current position that is the current position of the vehicle CA, and the acquired positioning current position is input to the driving assistance ECU 7.

運転支援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 line detection unit 71, a lane line lateral deviation calculation unit 72, an inertial navigation unit 73, a storage unit 74 in which road data 74a is stored, an inertia lateral deviation calculation unit 75, and reliability. It has at least functions as a determination unit 76 and a driving support control unit 77. The hardware configuration of the driving support ECU 7 mainly includes a CPU (Central Processing Unit) that performs arithmetic processing, a memory that stores programs and information (RAM such as SRAM, ROM (Read Only Memory) such as EEPROM), an input / output interface, and the like. Since it is the same as an ECU that is configured and mounted on a known vehicle CA, detailed description thereof is omitted. The driving support ECU 7 includes a driving device 8 that applies a driving force or a braking force to a vehicle CA such as an engine or a motor mounted on the vehicle CA, a braking device 9 that applies a braking force to the vehicle CA such as a hydraulic brake device, It is electrically connected to a steering device 10 such as an EPS (Electric Power Steering), an accelerator pedal sensor (not shown), a brake pedal sensor, and the like. The control of each device 8 to 10 and the vehicle CA from each device 8 to 10 and sensor. And the travel request of the vehicle CA of the driver are acquired as information. The driving assistance ECU 7 is a driving assistance control based on the driver's lane marking. In this embodiment, the driving assistance ECU 7 detects the intention to use LKA (e.g., a switch or a lever provided in the vehicle) and an electric If it is determined that there is a driver's intention to use, the driving support control is performed.

区画線検出部71は、区画線検出手段であり、区画線を前方カメラ3により撮像された画像から検出するものである。区画線検出部71による区画線の検出は、すでに公知の検出方法により行えばよく、例えば、画像を水平方向に順次走査し、走査ラインごとに輝度に基づいたエッジ検出を行い、検出されたエッジに基づいて画像から区画線を検出する。ここで、前方カメラ3により撮像された画像には、車両CAの走行すべき車線を区画する区画線、それ以外の車線を区画する区画線、あるいは流入路や流出路などの分岐路を区画する区画線が含まれる。また、車両CAが走行する車線を区画する区画線は、高速道路や主要幹線道路では、平行に2つ存在する。そこで、区画線検出部71は、車両CAの左右において最も近接した区画線を検出し、検出された区画線が2つ存在する場合は一方、本実施形態では、車両CAが走行する車線を区画する2つの区画線のうち、通常、分岐路が接続されている左側の区画線を検出する。区画線検出部71は、例えば、図2−1に示すように、車両CAが高速道路の最も左側の車線LMを走行している場合は、車線LMの左側の区画線である白線WLMを検出する。   The lane marking detection unit 71 is a lane marking detection unit that detects a lane marking from an image captured by the front camera 3. The lane line detection by the lane line detection unit 71 may be performed by a known detection method. For example, the image is sequentially scanned in the horizontal direction, edge detection based on luminance is performed for each scan line, and the detected edge is detected. The lane marking is detected from the image based on the above. Here, the image captured by the front camera 3 defines a lane line that divides the lane in which the vehicle CA should travel, a lane line that divides the other lane, or a branch path such as an inflow path or an outflow path. Includes a lot line. In addition, there are two lane markings that divide the lane in which the vehicle CA travels in parallel on the highway and the main highway. Therefore, the lane line detection unit 71 detects the closest lane line on the left and right of the vehicle CA. On the other hand, when there are two detected lane lines, in the present embodiment, the lane line on which the vehicle CA travels is defined. Of the two lane lines to be detected, the lane line on the left side to which the branch path is normally connected is detected. For example, as shown in FIG. 2-1, the lane marking detection unit 71 detects the white line WLM that is the lane marking on the left side of the lane LM when the vehicle CA is traveling on the left lane LM of the expressway. To do.

区画線横偏差算出部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 deviation calculating unit 72 is a lane marking lateral deviation calculating unit, and calculates a lane marking lateral deviation Z1 [m] which is a lateral deviation between the lane marking and the vehicle CA. As shown in FIG. 1, the lane marking lateral deviation calculation unit 72 includes the position in the image of the lane marking detected by the lane marking detection unit 71, the attachment position of the front camera 3 in the vehicle width direction relative to the vehicle CA, and the front camera 3. The lane marking for the vehicle CA based on the image captured in the vehicle width direction based on the information for correcting the position of the lane marking in the image such as the depression angle with respect to the horizontal direction to the actual lane marking position for the vehicle CA Is calculated as a lane marking lateral deviation Z1. For example, as shown in FIG. 2-1, the lane marking lateral deviation calculation unit 72 uses a lane marking on the left side of the lane LM when the vehicle CA is traveling on the lane LM that is the leftmost lane of the expressway. A lane marking lateral deviation Z1 between a certain white line WLM and the vehicle CA is calculated. The lane marking lateral deviation Z1 is a positive value in the direction in which the vehicle CA and the lane marking are separated, and a negative value in the approaching direction.

慣性航法部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 inertial navigation unit 73 calculates the current inertia position, which is the current position of the vehicle CA, based on the vehicle speed V and the turning state of the vehicle CA. The inertial navigation unit 73 calculates the relative current position with respect to the starting point O as the inertia current position by integrating the vehicle speed V acquired by the vehicle speed sensor 4 and the yaw rate R detected by the yaw rate sensor 5. Here, in this embodiment, the starting point O is obtained by adding a lane marking lateral deviation Z1 when the positioning current position is acquired to the position of a boundary line described later corresponding to the positioning current position acquired by the GPS 6. . Note that when the vehicle CA is traveling in any of a plurality of lanes, the starting point O is the lane marking Z1 added to the position of the boundary line, and the lane in which the vehicle is traveling further from the outermost lane. Add the lane width according to the lane. The number of lanes is determined based on the image captured by the front camera 3 and the current positioning position acquired by the GPS 6. In addition, the inertial navigation unit 73 sets the starting point O before the branch road in the lane in which the vehicle CA travels based on the current positioning position and the road data 74a. For example, as illustrated in FIG. 2A, the starting point O is set based on the positioning current position acquired before the outflow path LS in the lane LM.

記憶部74は、道路データ74aを格納するものである。道路データ74aは、車両CAが走行できる車線の区画線に相当する境界線のデータを含むものであり、GPS6により取得される測位現在位置と関連付けがなされているものである。ここで、境界線は、実際に道路に設けられている区画線とは異なり、車線に対応する区画線の位置と同位置の線であり、かつ車線に沿って常に連続した線である。従って、車線が分岐路と接続される部分には、通常区画線は存在しないが、境界線としてはそのような区画線が欠落している部分において存在する。例えば、図2−1に示すように、車両CAが高速道路の最も左側の車線LMを走行している場合は、白線WLMが流出路LSにより消失していても、その部分においては白線WLMに相当する境界線RDが存在することとなる。なお、道路データ74aは、通常、予め記憶部74に格納されているものであるが、車両CAに搭載されている図示しない通信手段によりセンターからの更新情報に基づいて随時更新されてもよい。   The storage unit 74 stores road data 74a. The road data 74a includes boundary line data corresponding to the lane markings on which the vehicle CA can travel, and is associated with the current position of positioning obtained by the GPS 6. Here, unlike the lane marking actually provided on the road, the boundary line is a line at the same position as the position of the lane marking corresponding to the lane, and is a continuous line along the lane. Therefore, a lane line is usually not present at a portion where the lane is connected to the branch road, but a boundary line is present at a portion where such a lane line is missing. For example, as shown in FIG. 2A, when the vehicle CA is traveling on the leftmost lane LM of the highway, even if the white line WLM disappears due to the outflow path LS, the white line WLM is lost in that portion. A corresponding boundary line RD exists. The road data 74a is normally stored in the storage unit 74 in advance, but may be updated at any time based on update information from the center by a communication means (not shown) mounted on the vehicle CA.

慣性横偏差算出部75は、慣性横偏差算出手段であり、慣性航法による車両CAの現在位置、すなわち慣性現在位置と、道路データ74aとに基づいて慣性航法における横偏差である慣性横偏差Z2〔m〕を算出するものである。慣性横偏差算出部75は、図1に示すように、車線幅方向において、慣性現在位置に基づいた車両CAに対する境界線の位置を慣性横偏差Z2として算出する。なお、慣性横偏差Z2は、車両CAと境界線データとが離れる方向をプラスの値、近づく方向をマイナス値とする。   The inertia lateral deviation calculation unit 75 is an inertia lateral deviation calculation means, and is based on the current position of the vehicle CA by inertial navigation, that is, the current inertia position and the road data 74a, and the inertia lateral deviation Z2 [ m] is calculated. As shown in FIG. 1, the inertia lateral deviation calculating unit 75 calculates the position of the boundary line with respect to the vehicle CA based on the current inertia position as the inertia lateral deviation Z2 in the lane width direction. The inertia lateral deviation Z2 is a positive value in the direction in which the vehicle CA and the boundary line data are separated, and a negative value in the direction in which the vehicle CA approaches the boundary line data.

信頼度判定部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 line detection unit 71. The reliability of is determined. The reliability determination unit 76 calculates a difference ΔZ between the lane marking lateral deviation Z1 and the inertia lateral deviation Z2, and the lane marking detected as being within the allowable range PR has a high reliability. It is determined that the reliability of the detected lane marking whose ΔZ is outside the allowable range PR is low. In the present embodiment, the difference ΔZ is a change in the inertial lateral deviation Z2 with the lane marking lateral deviation Z1 as a reference, and a change in the direction in which the vehicle CA and the lane marking (boundary line) separate from each other becomes a positive value. Change the direction to a negative value.

ここで、差分Δ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 lane marking detector 71 based on the image captured by the front camera 3 is used and is calculated sequentially, and is related to the travel distance L of the vehicle CA. It occurs in a certain range on the left and right with respect to the actual travel locus RL of the vehicle CA.

慣性横偏差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 storage unit 74 in advance, and the map is compared with the difference ΔZ. May be used.

運転支援制御部77は、少なくとも区画線に基づいてLKAを実施するものである。運転支援制御部77は、区画線検出部71により検出された区画線と車両CAとの位置関係、車速センサ4により取得された車速Vと、ヨーレートセンサ5により検出されたヨーレートRと、操舵装置10の状態(例えば操舵角、操舵トルクなど)とに基づいて、すでに公知の算出方法により、車両CAが区画線に対して一定の間隔で走行することができるように、操舵装置10の制御値(例えば、アシストトルク)を算出し、算出された制御値に基づいて、少なくとも操舵装置10を制御するものである。また、運転支援制御部77は、上記区画線検出部71により検出された区画線と車両CAとの位置関係を算出された慣性横偏差Z2に置き換えることで、慣性横偏差Z2に基づいてもLKAを実施することができる。   The driving support control unit 77 performs LKA based on at least the lane marking. The driving support control unit 77 includes the positional relationship between the lane line detected by the lane line detection unit 71 and the vehicle CA, the vehicle speed V acquired by the vehicle speed sensor 4, the yaw rate R detected by the yaw rate sensor 5, and the steering device. The control value of the steering device 10 so that the vehicle CA can travel at a fixed interval with respect to the lane line by a known calculation method based on the 10 states (for example, steering angle, steering torque, etc.). (For example, assist torque) is calculated, and at least the steering device 10 is controlled based on the calculated control value. Further, the driving support control unit 77 replaces the positional relationship between the lane line detected by the lane line detection unit 71 and the vehicle CA with the calculated inertial lateral deviation Z2, so that the LKA is also based on the inertial lateral deviation Z2. Can be implemented.

ここで、差分Δ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 support control unit 77 and the vehicle CA is traveling on the lane LM connected to the outflow path LS as shown in FIG. 2A, the front of the outflow path LS. In this case, the vehicle CA travels at a constant interval with respect to the white line WLM. The white line WLM corresponding to the lane LM disappears at the connection portion of the lane LM with the outflow path LS, but the white line WLM is continuous with the white line WLS corresponding to the outflow path LS to become one white line. There may be. Therefore, when the vehicle CA continues to travel and reaches the connection portion with the outflow path LS in the lane LM, the driving support control unit 77 detects the white line WLS as the white line WLM corresponding to the lane LM, and the vehicle CA is in the lane. There is a risk of turning from the LM toward the outflow path LS. Even if the vehicle CA travels on the lane LM and then flows into the outflow path LS, the lane marking lateral deviation Z1 does not change because LKA is performed by the driving support control unit 77 as shown in FIG. (Excluding changes due to the lane marking lateral deviation error EZ1). On the other hand, as shown in FIG. 2-1, the inertia lateral deviation Z2 is from the starting point O set in front of the outflow path LS in the inertial navigation to the point a where the vehicle CA starts turning toward the outflow path LS. The estimated traveling locus IL changes by the inertia lateral deviation error EZ2 with respect to the actual traveling locus RL. As shown in FIG. 2B, the difference ΔZ from the starting point O to the point a is dominated by the inertia lateral deviation error EZ2, and does not exceed the allowable range PR as shown in FIG. Further, as shown in FIG. 2-1, the inertia lateral deviation Z2 decreases as the vehicle CA approaches the outflow path LS from the point a because the vehicle CA approaches the boundary line RD. As shown, the difference ΔZ turns from positive to negative. Then, as shown in FIG. 2A, when the vehicle CA reaches the point b, it exceeds the allowable range PR as shown in FIG. Accordingly, when the LKA is performed based on a lane line (white line WLS) different from the lane line (white line WLM) on which the original vehicle CA should travel, the difference Δ may change and exceed the allowable range PR. .

次に、実施形態1に係る区画線信頼度判定装置2による区画線信頼度判定方法について説明する。図4は、実施形態1に係る区画線信頼度判定方法のフロー図である。ここで、運転支援ECU7は、予め設定された制御周期毎に区画線信頼度判定方法を繰り返し実行するものである。   Next, a lane marking reliability determination method performed by the lane marking reliability determination apparatus 2 according to the first embodiment will be described. FIG. 4 is a flowchart of the lane marking reliability determination method according to the first embodiment. Here, the driving assistance ECU 7 repeatedly executes the lane marking reliability determination method for each preset control cycle.

まず、運転支援ECU7の区画線横偏差算出部72は、区画線横偏差Z1を算出する(ステップST11)。ここでは、区画線横偏差算出部72は、区画線検出部71により検出された区画線の車両CAに対する位置を区画線横偏差Z1として算出する。   First, the lane marking lateral deviation calculation unit 72 of the driving assistance ECU 7 calculates the lane marking lateral deviation Z1 (step ST11). Here, the lane line lateral deviation calculating unit 72 calculates the position of the lane line detected by the lane line detecting unit 71 with respect to the vehicle CA as the lane line lateral deviation Z1.

次に、慣性航法部73は、慣性航法を実施する(ステップST12)。ここでは、慣性航法部73は、設定された起点Oに対する慣性現在位置を算出する。なお、起点Oが設定されていない場合は、起点Oを設定した後、慣性現在位置を算出する。   Next, the inertial navigation unit 73 performs inertial navigation (step ST12). Here, the inertial navigation unit 73 calculates the current inertia position with respect to the set starting point O. If the starting point O is not set, the current inertia position is calculated after setting the starting point O.

次に、慣性横偏差算出部75は、道路データ74aを読み出す(ステップST13)。ここでは、慣性横偏差算出部75は、起点Oに基づいて、車両CAが走行している車線に対応する境界線RDのデータを読み出す。   Next, the inertia lateral deviation calculation part 75 reads the road data 74a (step ST13). Here, based on the starting point O, the inertia lateral deviation calculation unit 75 reads data on the boundary line RD corresponding to the lane in which the vehicle CA is traveling.

次に、慣性横偏差算出部75は、慣性横偏差Z2を算出する(ステップST14)。ここでは、慣性横偏差算出部75は、慣性現在位置と、道路データ74aの境界線RDとに基づいて慣性横偏差Z2を算出する。   Next, the inertial lateral deviation calculation unit 75 calculates the inertial lateral deviation Z2 (step ST14). Here, the inertia lateral deviation calculation unit 75 calculates the inertia lateral deviation Z2 based on the current inertia position and the boundary line RD of the road data 74a.

次に、信頼度判定部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 line detection unit 71 corresponds to the lane that the vehicle CA should originally travel. It is determined that the line is not a lane marking, and the flag is reset (F = 0).

また、信頼度判定部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 line detection unit 71 corresponds to the lane that the vehicle CA should originally travel. It is determined that it is a lane marking, and a flag is set (F = 1).

また、信頼度判定部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 reliability determination apparatus 2 according to the present embodiment, the vehicle CA travels from the lane marking lateral deviation Z1 based on the detected lane marking, the inertial navigation from the starting point O, and the road data 74a. When the difference ΔZ between the inertial lateral deviation Z2 in the lane to be compared with the allowable range PR based on the lane marking lateral deviation error EZ1 and the inertial lateral deviation error EZ2, and the difference ΔZ exceeds the allowable range PR, It is determined that the reliability of the lane line detected by the lane line detection unit 71, that is, the possibility of the lane line facing the lane in which the vehicle CA should travel is low. Here, for the purpose of improving the reliability of the detected lane line, a technique for performing driving support control only when the lane line existing on the left and right sides of the lane can be correctly detected has been proposed. Although it is possible to improve the reliability of lane markings using multiple lane markings, driving assistance control is interrupted if one lane marking can be detected correctly but the other lane marking is erroneously detected. Or since it will stop, there exists a possibility of reducing the opportunity of driving assistance control. However, in the lane marking reliability determination device 2 according to the present embodiment, when a lane marking that does not correspond to the lane that the vehicle CA should travel is detected, the lane line corresponds to the lane that the vehicle CA should travel. Therefore, it is possible to accurately recognize an abnormality in the lane marking detection. As a result, it is possible to accurately determine whether the driving support control is stopped or interrupted. In addition, if there is one lane line corresponding to the lane in which the vehicle CA travels, the reliability of the lane line can be determined, so that the opportunity for driving support control can be increased.

なお、本実施形態に係る区画線信頼度判定装置2では、運転支援制御が行われている場合において、区画線の信頼度を判定することについて説明したが、これに限定されるものではない。例えば、車両CAがナビゲーションシステムを搭載しており、目的地までの走行軌跡が算出されて、運転者が走行軌跡に基づいて車両CAを走行させている場合に、運転者の操舵装置10に対する操作によって、走行軌跡において車両CAの走行すべき車線から逸脱すると、差分ΔZが変化する可能性がある。このような場合においても、区画線の信頼度を判定し、区画線の信頼度が低いと判定した場合に、図示しない報知手段により運転者に走行軌跡から逸脱したことを報知するようにしても良い。   In the lane marking reliability determination apparatus 2 according to the present embodiment, the determination of the lane marking reliability in the case where the driving support control is performed has been described, but the present invention is not limited to this. For example, when the vehicle CA is equipped with a navigation system, a travel locus to the destination is calculated, and the driver is driving the vehicle CA based on the travel locus, the driver operates the steering device 10. Therefore, if the vehicle CA deviates from the lane in which the vehicle CA should travel, the difference ΔZ may change. Even in such a case, when the reliability of the lane line is determined and it is determined that the reliability of the lane line is low, the driver may be informed that the vehicle has deviated from the travel locus by a not-illustrated notification means. good.

次に、本実施形態に係る区画線信頼度判定装置2の区画線の判定結果を用いた運転支援制御装置1による運転支援制御方法について説明する。図5は、実施形態1に係る運転支援制御方法のフロー図である。ここで、運転支援ECU7は、予め設定された制御周期毎に運転支援制御方法を繰り返し実行するものである。   Next, the driving assistance control method by the driving assistance control apparatus 1 using the lane marking determination result of the lane marking reliability determination apparatus 2 according to the present embodiment will be described. FIG. 5 is a flowchart of the driving support control method according to the first embodiment. Here, the driving assistance ECU 7 repeatedly executes the driving assistance control method every preset control cycle.

まず、運転支援制御部77は、LKAを実施していることを前提として、F=1であるか否かを判定する(ステップST21)。ここでは、運転支援制御部77は、区画線の信頼度が高いか否かを判定する。   First, the driving support control unit 77 determines whether or not F = 1 on the premise that LKA is performed (step ST21). Here, the driving assistance control unit 77 determines whether or not the reliability of the lane marking is high.

次に、運転支援制御部77は、F=1であると判定する(ステップST21肯定)と、区画線に基づいて運転支援制御を実施する(ステップST22)。ここでは、運転支援制御部77は、区画線の信頼度が高いと判定されることで、検出された区画線が車両CAの走行すべき車線に対応する区画線であるので、検出された区画線に基づいてLKAを実施する。   Next, when it is determined that F = 1 (Yes in step ST21), the driving support control unit 77 performs driving support control based on the lane marking (step ST22). Here, since the driving assistance control unit 77 determines that the reliability of the lane marking is high, the detected lane marking is a lane marking corresponding to the lane on which the vehicle CA should travel, and thus the detected lane marking. Perform LKA based on the line.

また、運転支援制御部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 support control unit 77 performs driving support control based on the current inertia position (step ST23). Here, since it is determined that the reliability of the lane marking is low, the detected lane marking is not a lane marking corresponding to the lane on which the vehicle CA is to travel, and therefore LKA is performed based on the detected lane marking. There is a possibility that the vehicle CA deviates from the lane where the vehicle CA should originally travel. Therefore, the driving support control unit 77 performs LKA based on the current inertia position instead of LKA based on the detected lane marking. Note that the driving support control is continued based on the current inertia position until it is determined that F = 1 (Yes in step ST21), and when it is determined that F = 1 (Yes in step ST21), the lane marking is displayed. Return to the implementation of the driving support control based on.

例えば、図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 support control unit 77 moves the vehicle CA approaching the boundary line RD at the point b to the boundary line RD in order to travel the lane LM that should travel the vehicle CA that has been traveling from the point b toward the outflow path LS. LKA is performed so as to return to a certain interval (for example, the positional relationship of the boundary line RD with respect to the vehicle CA at the starting point O). Accordingly, as shown in FIG. 6B, the inertial lateral deviation Z2 changes according to the travel distance L so as to approach the lane marking lateral deviation Z1 at the starting point O, and the vehicle CA changes to the boundary line RD at the point c. On the other hand, when a certain interval is reached, it is maintained. On the other hand, the lane marking lateral deviation Z1 increases according to the travel distance L because the vehicle CA is further away from the white line WLS by performing LKA based on the current inertia position. Therefore, even if the vehicle CA maintains a constant interval with respect to the boundary line RD up to the point d at which the lane marking detection unit 71 can detect the white line WLM corresponding to the lane LM formed at the tip of the outflow path LS. As shown in FIG. 6-3, the difference ΔZ maintains a state exceeding the allowable range PR. When the point d is reached, the lane line detection unit 71 detects the white line WLM corresponding to the lane LM again, so that the lane line lateral deviation Z1 and the inertia lateral deviation Z2 are approximated as shown in FIG. As a result, as shown in FIG. 6C, the difference ΔZ is within the allowable range PR, and the LKA is switched from the LKA based on the current inertia position to the LKA based on the white line WLM detected.

以上のように、本実施形態に係る運転支援制御部77では、区画線の信頼度が低いと判定されると、区画線に基づいた運転支援制御を禁止し、慣性現在位置に基づいて運転支援制御を行い、区画線の信頼度が高いと判定されると、区画線に基づいた運転支援制御に復帰するので、区画線の信頼度が低い場合でも運転支援制御を継続することができる。従って、区画線の信頼度を判定することで、運転支援制御の機会を増やすことができる。   As described above, the driving support control unit 77 according to the present embodiment prohibits driving support control based on a lane line and determines driving assistance based on the current inertia position when it is determined that the reliability of the lane line is low. When the control is performed and it is determined that the reliability of the lane line is high, the driving support control based on the lane line is restored, so that the driving support control can be continued even when the reliability of the lane line is low. Therefore, the opportunity of driving assistance control can be increased by determining the reliability of the lane marking.

〔実施形態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 reliability determination apparatus 2 according to the first embodiment, description of the configuration is omitted. The lane marking reliability determination apparatus according to the second embodiment determines the lane marking reliability based on the difference gradient K instead of determining the lane marking reliability based on whether or not the difference ΔZ exceeds the allowable range PR. Is. FIG. 7 is a diagram illustrating a relationship among the difference ΔZ, the driving distance L, and the allowable range PR during the driving support control in the second embodiment.

差分勾配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 lane line detector 71 should travel. In the state, that is, in the normal state, the amount of change due to the accumulation according to the travel distance L of the inertial lateral deviation error EZ2 is equivalent. Since the change amount due to the accumulation of the inertial lateral deviation error EZ2 is constant, the change amount due to the accumulation of the maximum value of the inertial lateral deviation error EZ2 is also constant. That is, the allowable range gradient PRKmax, which is the change amount of the maximum value in the positive direction and the negative direction of the allowable range PR according to the travel distance L, is a change amount due to accumulation at the maximum value of the inertia lateral deviation error EZ2. Here, when the lane line detection unit 71 detects a lane line different from the lane line facing the lane on which the vehicle CA should travel, and the LKA is performed based on the detected lane line, the differential gradient K is Under the influence of the change amount of the inertial lateral deviation Z2, the allowable range gradient PRKmax may be exceeded.

次に、実施形態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 deviation calculation unit 72 calculates the lane line lateral deviation Z1 (step ST31), the inertial navigation unit 73 performs inertial navigation (step ST32), reads road data 74a (step ST33), and inertias. The lateral deviation Z2 is calculated (step ST34), and the reliability determination unit 76 calculates the lateral deviation difference ΔZ (step ST35).

次に、信頼度判定部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 line detection unit 71 is the original vehicle CA when the difference gradient K changed by the change in the difference ΔZ exceeds the allowable range gradient PRKmax. It is determined that it is not a lane line corresponding to the lane to be traveled, and the flag is reset (F = 0).

また、信頼度判定部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 support control apparatus 1 as in the first embodiment.

〔実施形態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 reliability determination apparatus 2 according to the first and second embodiments, description of the configuration is omitted. The lane marking reliability determination apparatus according to the third embodiment sets the lane marking lateral deviation Z1 in the inertia lateral deviation Z2 and updates the allowable range PR when the lane marking reliability is high. FIG. 9 is a flowchart of the lane marking reliability determination method according to the third embodiment. FIG. 10A is a diagram illustrating a relationship among the difference ΔZ, the travel distance L, and the allowable range PR in the third embodiment. FIG. 10-2 is a diagram illustrating a relationship between the lateral deviation Z and the travel distance L in the third embodiment. FIG. 10C is a diagram illustrating a relationship among the difference ΔZ, the travel distance L, and the allowable range PR in the third embodiment.

図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 deviation calculation unit 72 calculates the lane line lateral deviation Z1 (step ST50), the inertial navigation unit 73 performs inertial navigation (step ST51), reads road data 74a (step ST52), and inertias. The lateral deviation Z2 is calculated (step ST53), and the reliability determination unit 76 calculates the lateral deviation difference ΔZ (step ST54), and calculates the difference gradient K of the difference ΔZ (step ST55).

次に、信頼度判定部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 SYMBOLS 1 Driving assistance control apparatus 2 Marking line reliability determination apparatus 3 Front camera 4 Vehicle speed sensor 5 Yaw rate sensor 6 GPS
7 Driving assistance ECU
71 Marking Line Detection Unit 72 Marking Line Lateral Deviation Calculation Unit 73 Inertial Navigation Unit 74 Storage Unit 74a Road Data 75 Inertial Lateral Deviation Calculation Unit 76 Reliability Determination Unit 77 Driving Support Control Unit 8 Drive Device 9 Braking Device 10 Steering Device CA Vehicle EZ1 Lane deviation error EZ2 Inertial deviation error IL Estimated travel locus K Difference gradient L Travel distance LM Lane LS Outflow path (branch path)
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:
請求項1に記載の区画線信頼度判定装置において、
前記信頼度判定手段は、前記差分が前記許容範囲を超えた場合に、前記区画線検出手段により検出された前記区画線の信頼度が低いと判定する区画線信頼度判定装置。
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.
請求項1に記載の区画線信頼度判定装置において、
前記信頼度判定手段は、前記差分の走行距離に応じた変化の勾配である差分勾配が、前記許容範囲の最大値の走行距離に応じた変化の勾配である許容範囲勾配を超えた場合に、前記区画線検出手段により検出された前記区画線の信頼度が低いと判定する区画線信頼度判定装置。
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.
請求項1〜3のいずれか1項に記載の区画線信頼度判定装置において、
前記慣性横偏差算出手段は、前記区画線検出手段により検出された前記区画線の信頼度が高いと判定されると、前記区画線横偏差を前記慣性横偏差にセットするとともに、前記許容範囲を更新する更新処理を許容する区画線信頼度判定装置。
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.
前記請求項1〜4のいずれか1項に記載の区画線信頼度判定装置と、
前記区画線に基づいて前記車両の運転支援制御を行う運転支援制御手段と、
を備え、
前記運転支援制御手段は、
前記区画線検出手段により検出された前記区画線の信頼度が低いと判定されると、前記区画線に基づいた前記運転支援制御を禁止し、前記慣性航法による車両の現在位置に基づいて前記運転支援制御を行い、
前記区画線検出手段により検出された前記区画線の信頼度が高いと判定されると、前記区画線に基づいた前記運転支援制御に復帰する運転支援制御装置。
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:
JP2013016217A 2013-01-30 2013-01-30 Track line reliability determination device and driving support control device Expired - Fee Related JP6040788B2 (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Patent Citations (5)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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