JP2017105249A - Vehicle driving support control device - Google Patents

Vehicle driving support control device Download PDF

Info

Publication number
JP2017105249A
JP2017105249A JP2015238720A JP2015238720A JP2017105249A JP 2017105249 A JP2017105249 A JP 2017105249A JP 2015238720 A JP2015238720 A JP 2015238720A JP 2015238720 A JP2015238720 A JP 2015238720A JP 2017105249 A JP2017105249 A JP 2017105249A
Authority
JP
Japan
Prior art keywords
dimensional object
vehicle
lane
target turning
turning amount
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
JP2015238720A
Other languages
Japanese (ja)
Other versions
JP6661213B2 (en
Inventor
武 寺澤
Takeshi Terasawa
武 寺澤
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.)
Subaru Corp
Original Assignee
Subaru 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 Subaru Corp filed Critical Subaru Corp
Priority to JP2015238720A priority Critical patent/JP6661213B2/en
Publication of JP2017105249A publication Critical patent/JP2017105249A/en
Application granted granted Critical
Publication of JP6661213B2 publication Critical patent/JP6661213B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

PROBLEM TO BE SOLVED: To securely prevent lane deviation of a vehicle by adequately coordinating a lane deviation prevention function and a three-dimensional object avoidance function, and securely prevent collision with a three-dimensional object so as to enhance safety with high versatility.SOLUTION: A vehicle driving support control device calculates a lane deviation prevention target turn amount γ0 to prevent an own vehicle from deviating from a traveling lane of the own vehicle by steering control depending on lane information on the basis of a traffic lane section line location information, three-dimension object information, respective sensor signals, calculates a three-dimension object avoidance target turn amount (γ1, γ2, γ3) to avoid collision of the own vehicle with the three-dimension object by the steering control based on at least the three-dimension object information, and performs the steering control depending on the largest target turn amount by comparing the calculated lane deviation prevention target turn amount γ0 with the calculated three-dimension object avoidance target turn amount (γ1, γ2, γ3).SELECTED DRAWING: Figure 3

Description

本発明は、車線からの逸脱や立体物との衝突を操向制御により回避する車両の運転支援制御装置に関する。   The present invention relates to a vehicle driving support control device that avoids deviation from a lane or collision with a three-dimensional object by steering control.

近年、車両においては、運転を支援する様々な装置が開発、実用化されており、車線からの逸脱を防止する車線逸脱防止制御装置もそのような装置の一つである。例えば、特開平11−189166号公報(以下、特許文献1)では、走行車線に対して車両の進行方向がなす対車線ヨー角を算出し、ヨー角に基づいて操舵用制御トルクを算出し、操舵用制御トルクがヨー角を減らす方向に発生するように操舵アクチュエータを制御する車線逸脱防止装置の技術が開示されている。   In recent years, various devices that support driving have been developed and put into practical use in vehicles, and a lane departure prevention control device that prevents departure from a lane is one of such devices. For example, in Japanese Patent Application Laid-Open No. 11-189166 (hereinafter referred to as Patent Document 1), an anti-lane yaw angle formed by a traveling direction of a vehicle with respect to a traveling lane is calculated, a steering control torque is calculated based on the yaw angle, A technology of a lane departure prevention device that controls a steering actuator so that a steering control torque is generated in a direction to reduce the yaw angle is disclosed.

特開平11−189166号公報Japanese Patent Laid-Open No. 11-189166

ところで、実際の走行環境は様々であり、自車両の走行車線と同じ車線や隣接車線の並走車や対向車等の車両、人、その他立体物の存在も無視することができない。従って、ドライバの安全運転を適切に支援するためには、上述の特許文献1に開示されるような車線逸脱防止機能に加え、走行環境の立体物との衝突を確実に回避できる衝突回避機能を有することが必要である。上述の特許文献1に開示されるような車線逸脱防止機能では、車線逸脱防止機能に特化しているため、立体物を回避することは困難で、また、立体物の回避のみを考慮した場合には、状況によっては本来走行可能な道路から逸脱してしまい、例えば転落してしまう等の虞がある。これら車線逸脱防止機能と立体物回避機能とを適切に協調させて運転支援する制御装置が求められている。   By the way, there are various actual driving environments, and the presence of vehicles, people, and other three-dimensional objects such as parallel vehicles or oncoming vehicles in the same lane as the traveling lane of the host vehicle or an adjacent lane cannot be ignored. Therefore, in order to appropriately support the driver's safe driving, in addition to the lane departure prevention function disclosed in Patent Document 1 described above, a collision avoidance function that can reliably avoid a collision with a three-dimensional object in the driving environment is provided. It is necessary to have. The lane departure prevention function disclosed in the above-mentioned Patent Document 1 is specialized in the lane departure prevention function, so it is difficult to avoid the three-dimensional object, and when only the avoidance of the three-dimensional object is considered. Depending on the situation, there is a risk of deviating from a road that can be originally traveled, for example, falling. There is a need for a control device that assists driving by appropriately coordinating the lane departure prevention function and the three-dimensional object avoidance function.

本発明は上記事情に鑑みてなされたもので、車線逸脱防止機能と立体物回避機能とを適切に協調させて車線からの逸脱を確実に防止し、かつ、立体物との衝突を確実に防止して、汎用性が高く安全性を向上させることができる車両の運転支援制御装置を提供することを目的としている。   The present invention has been made in view of the above circumstances, and appropriately prevents the departure from the lane by properly coordinating the lane departure prevention function and the three-dimensional object avoidance function, and also reliably prevents the collision with the three-dimensional object. An object of the present invention is to provide a vehicle driving support control apparatus that is highly versatile and can improve safety.

本発明の車両の運転支援制御装置の一態様は、少なくとも走行する車線の車線情報と自車両の周辺立体物情報を認識する周辺環境認識手段と、上記車線情報に基づいて操舵制御により自車両が走行する車線から逸脱することを防止する車線逸脱防止目標旋回量を算出する車線逸脱防止目標旋回量算出手段と、少なくとも上記周辺立体物情報に基づいて操舵制御により自車両が立体物と衝突することを回避する立体物回避目標旋回量を算出する立体物回避目標旋回量算出手段と、算出した上記車線逸脱防止目標旋回量と上記立体物回避目標旋回量とを比較して大きい方の目標旋回量に応じて操舵制御の制御量を算出する制御手段とを備えた。   According to one aspect of the vehicle driving support control device of the present invention, a surrounding environment recognition unit that recognizes at least lane information of a traveling lane and surrounding three-dimensional object information of the vehicle, and the vehicle is controlled by steering control based on the lane information. A lane departure prevention target turning amount calculation means for calculating a lane departure prevention target turning amount for preventing a departure from a traveling lane, and at least the own vehicle collides with a three-dimensional object by steering control based on the surrounding three-dimensional object information. The three-dimensional object avoidance target turning amount calculation means for calculating the three-dimensional object avoidance target turning amount that avoids the vehicle, and the larger target turning amount by comparing the calculated lane departure prevention target turning amount and the three-dimensional object avoiding target turning amount. And a control means for calculating a control amount of the steering control according to the control.

本発明による車両の運転支援制御装置によれば、車線逸脱防止機能と立体物回避機能とを適切に協調させて車線からの逸脱を確実に防止し、かつ、立体物との衝突を確実に防止して、汎用性が高く安全性を向上させることが可能となる。   According to the vehicle driving support control device of the present invention, the lane departure prevention function and the three-dimensional object avoidance function are appropriately coordinated to reliably prevent the departure from the lane and to reliably prevent the collision with the three-dimensional object. Thus, the versatility is high and the safety can be improved.

本発明の実施の一形態に係る車両の操舵系の構成説明図である。1 is a configuration explanatory diagram of a vehicle steering system according to an embodiment of the present invention. FIG. 本発明の実施の一形態に係る運転支援制御プログラムのフローチャートである。It is a flowchart of the driving assistance control program which concerns on one Embodiment of this invention. 図2から続くフローチャートである。3 is a flowchart continued from FIG. 2. 本発明の実施の一形態に係る衝突余裕時間算出ルーチンのフローチャートである。It is a flowchart of the collision margin time calculation routine which concerns on one Embodiment of this invention. 本発明の実施の一形態に係るX−Y座標上における自車両及び車線と各パラメータの説明図である。It is explanatory drawing of the own vehicle, lane, and each parameter on XY coordinate which concerns on one Embodiment of this invention. 本発明の実施の一形態に係る自車両に対する他車両(前方立体物)の各パラメータの説明図である。It is explanatory drawing of each parameter of the other vehicle (front solid object) with respect to the own vehicle which concerns on one Embodiment of this invention.

以下、図面に基づいて本発明の実施の形態を説明する。   Hereinafter, embodiments of the present invention will be described with reference to the drawings.

図1において、符号1は操舵角をドライバ入力と独立して設定自在な電動パワーステアリング装置を示し、この電動パワーステアリング装置1は、ステアリング軸2が、図示しない車体フレームにステアリングコラム3を介して回動自在に支持されており、その一端が運転席側へ延出され、他端がエンジンルーム側へ延出されている。ステアリング軸2の運転席側端部には、ステアリングホイール4が固設され、また、エンジンルーム側へ延出する端部には、ピニオン軸5が連設されている。   In FIG. 1, reference numeral 1 denotes an electric power steering device in which a steering angle can be set independently of a driver input. It is rotatably supported, and one end thereof extends to the driver's seat side and the other end extends to the engine room side. A steering wheel 4 is fixed to an end portion of the steering shaft 2 on the driver's seat side, and a pinion shaft 5 is connected to an end portion extending to the engine room side.

エンジンルームには、車幅方向へ延出するステアリングギヤボックス6が配設されており、このステアリングギヤボックス6にラック軸7が往復移動自在に挿通支持されている。このラック軸7に形成されたラック(図示せず)に、ピニオン軸5に形成されたピニオンが噛合されて、ラックアンドピニオン式のステアリングギヤ機構が形成されている。   A steering gear box 6 extending in the vehicle width direction is disposed in the engine room, and a rack shaft 7 is inserted into and supported by the steering gear box 6 so as to be reciprocally movable. A rack (not shown) formed on the rack shaft 7 is engaged with a pinion formed on the pinion shaft 5 to form a rack and pinion type steering gear mechanism.

また、ラック軸7の左右両端はステアリングギヤボックス6の端部から各々突出されており、その端部に、タイロッド8を介してフロントナックル9が連設されている。このフロントナックル9は、操舵輪としての左右輪10L,10Rを回動自在に支持すると共に、車体フレームに転舵自在に支持されている。従って、ステアリングホイール4を操作し、ステアリング軸2、ピニオン軸5を回転させると、このピニオン軸5の回転によりラック軸7が左右方向へ移動し、その移動によりフロントナックル9がキングピン軸(図示せず)を中心に回動して、左右輪10L,10Rが左右方向へ転舵される。   The left and right ends of the rack shaft 7 protrude from the end of the steering gear box 6, and a front knuckle 9 is connected to the end via a tie rod 8. The front knuckle 9 rotatably supports left and right wheels 10L and 10R as steering wheels and is supported by a vehicle body frame so as to be steerable. Accordingly, when the steering wheel 4 is operated and the steering shaft 2 and the pinion shaft 5 are rotated, the rack shaft 7 is moved in the left-right direction by the rotation of the pinion shaft 5, and the front knuckle 9 is moved by the movement to the kingpin shaft (not shown). And the left and right wheels 10L, 10R are steered in the left-right direction.

また、ピニオン軸5にアシスト伝達機構11を介して、電動パワーステアリングモータ(電動モータ)12が連設されており、この電動モータ12にてステアリングホイール4に加える操舵トルクのアシスト、及び、設定された目標旋回量(本実施の形態では、目標ヨーレートγt)となるような操舵トルクの付加が行われる。電動モータ12は、後述する操舵制御部20から制御出力値(制御量)としての目標トルクTpがモータ駆動部21に出力されてモータ駆動部21により駆動される。   Further, an electric power steering motor (electric motor) 12 is connected to the pinion shaft 5 via an assist transmission mechanism 11, and assists and sets the steering torque applied to the steering wheel 4 by the electric motor 12. The steering torque is added so that the target turning amount (the target yaw rate γt in this embodiment) is reached. The electric motor 12 is driven by the motor drive unit 21 by outputting a target torque Tp as a control output value (control amount) from the steering control unit 20 described later to the motor drive unit 21.

操舵制御部20には、少なくとも走行する車線の車線情報と自車両の周辺立体物情報を認識する周辺環境認識手段としての前方認識装置31が接続され、また、(自)車速Vを検出する車速センサ32、ヨーレートγを検出するヨーレートセンサ33が接続されている。   The steering control unit 20 is connected to a front recognition device 31 as a surrounding environment recognition means for recognizing at least lane information of a traveling lane and surrounding three-dimensional object information of the host vehicle, and a vehicle speed for detecting the (own) vehicle speed V. A sensor 32 and a yaw rate sensor 33 for detecting the yaw rate γ are connected.

前方環境認識装置31は、例えば、車室内の天井前方に一定の間隔をもって取り付けられ、車外の対象を異なる視点からステレオ撮像する1組のカメラと、このカメラからの画像データを処理するステレオ画像処理装置とから構成されている。   The front environment recognition device 31 is, for example, a set of cameras that are attached to the front of a ceiling in a vehicle interior at a constant interval and that captures an object outside the vehicle from different viewpoints, and stereo image processing that processes image data from the camera. Device.

前方環境認識装置31のステレオ画像処理装置における、カメラからの画像データの処理は、例えば以下のように行われる。まず、カメラで撮像した自車両の進行方向の1組のステレオ画像対に対し、対応する位置のずれ量から距離情報を求め、距離画像を生成する。   The processing of image data from the camera in the stereo image processing device of the forward environment recognition device 31 is performed as follows, for example. First, distance information is obtained from a pair of stereo image pairs taken in the traveling direction of the host vehicle captured by the camera from a corresponding positional shift amount, and a distance image is generated.

白線等の車線区画線のデータの認識では、白線は道路面と比較して高輝度であるという知得に基づき、道路の幅方向の輝度変化を評価して、画像平面における左右の車線区画線の位置を画像平面上で特定する。この車線区画線の実空間上の位置(x,y,z)は、画像平面上の位置(i,j)とこの位置に関して算出された視差とに基づいて、すなわち、距離情報に基づいて、周知の座標変換式より算出される。自車両の位置を基準に設定された実空間の座標系は、本実施の形態では、図5に示すように、カメラの中央真下の道路面を原点として、車両前後方向をX軸、車幅方向(車両横方向)をY軸、車高方向をZ軸とする。このとき、z=0のx−y平面は、道路が平坦な場合、道路面と一致する。道路モデルは、道路上の自車両の走行レーンを距離方向に複数区間に分割し、各区間における左右の車線区画線を所定に近似して連結することによって表現し、取得される。   In recognition of lane markings such as white lines, the left and right lane markings on the image plane are evaluated on the basis of the knowledge that the white lines are brighter than the road surface. Is specified on the image plane. The position (x, y, z) of the lane marking in the real space is based on the position (i, j) on the image plane and the parallax calculated with respect to this position, that is, based on the distance information. It is calculated from a known coordinate conversion formula. In the present embodiment, the coordinate system of the real space set based on the position of the host vehicle is, as shown in FIG. 5, with the road surface directly under the center of the camera as the origin, the vehicle longitudinal direction is the X axis, the vehicle width The direction (vehicle lateral direction) is the Y axis, and the vehicle height direction is the Z axis. At this time, the xy plane at z = 0 coincides with the road surface when the road is flat. The road model is expressed and acquired by dividing the traveling lane of the host vehicle on the road into a plurality of sections in the distance direction, and connecting the left and right lane markings in each section to a predetermined approximation.

また、前方環境認識装置31は、三次元の距離分布を表す距離画像のデータを基に周知のグルーピング処理を行い、側壁データ、立体物データ等の枠(ウインドウ)と比較し、道路に沿って存在するガードレール、縁石等の側壁データを抽出すると共に、立体物を、歩行者、二輪車、四輪車(車両)、その他の立体物の種類に分類して抽出する。また、認識された車両の中で、例えば、自車両1に最も近く、同じ車両として設定時間以上連続して認識された車両を先行車として抽出する。これら立体物の情報としては、図6に示すように、上述の自車両を基準とするX−Y座標の原点を、自車両の立体物に最も近い部位(図6では、左前端部を例としている)にオフセットした座標において、上述の立体物の種類、自車両からの距離、方向、中心位置の他に、当該立体物の自車両に最も近い部位の相対的な位置(xobj,yobj)、速度Vobj、立体物の進行方向の自車両の進行方向に対するなす角度θobjの各情報が入力される。   The forward environment recognition device 31 performs a well-known grouping process based on distance image data representing a three-dimensional distance distribution, and compares it with a frame (window) such as side wall data or three-dimensional object data along the road. Side wall data such as existing guardrails and curbs are extracted, and three-dimensional objects are classified and extracted into pedestrians, two-wheeled vehicles, four-wheeled vehicles (vehicles), and other three-dimensional types. In addition, among the recognized vehicles, for example, a vehicle that is closest to the host vehicle 1 and is continuously recognized as the same vehicle for a set time or longer is extracted as a preceding vehicle. As information of these three-dimensional objects, as shown in FIG. 6, the origin of the XY coordinates with respect to the above-mentioned own vehicle is used as a part closest to the three-dimensional object of the own vehicle (in FIG. 6, the left front end portion is an example. In addition to the three-dimensional object type, the distance from the own vehicle, the direction, and the center position, the relative position (xobj, yobj) of the portion closest to the own vehicle of the three-dimensional object , Speed Vobj, and information on the angle θobj formed by the traveling direction of the three-dimensional object with respect to the traveling direction of the host vehicle are input.

また、上述の車線区画線情報、立体物情報については、それぞれ信頼度が前方環境認識装置31において設定され、これら信頼度情報も共に、操舵制御部20入力される。   In addition, for the above-described lane marking information and three-dimensional object information, the reliability is set in the forward environment recognition device 31, and the reliability information is also input to the steering control unit 20.

車線区画線情報の信頼度は、例えば、カメラにて撮像された画像上のレーンの中で判定された処理領域内に存在する車線区画線の特徴量が画像上で線上に並ぶ多さによって信頼度を算出する。エリアの中に理想的な直線実車線区画線がある場合に存在する車線区画線の特徴量の多さを1と設定し、まったく特徴量が存在しない場合、もしくは線上に並んでいると判定できない場合に0と設定される。そして、予め設定しておいた閾値以上の信頼度で車線が検出される場合に車線が存在すると判定する。   The reliability of the lane line information depends on the number of feature values of the lane line existing in the processing area determined in the lane on the image captured by the camera, for example, on the line. Calculate the degree. When there is an ideal straight solid lane line in the area, the feature quantity of the lane line that exists is set to 1, and if there is no feature quantity at all, or it cannot be judged as being aligned on the line In this case, 0 is set. And when a lane is detected with the reliability more than the preset threshold value, it determines with a lane existing.

また、立体物の信頼度は、例えば、設定した領域内で検出された立体物が同じ立体物と連続して認識される時間に応じて設定され、同じ立体物と連続して認識されるほど信頼度が高く1に設定され、連続して認識される時間が少ないほど信頼度が低く0に設定される。そして、予め設定しておいた閾値以上の信頼度で立体物が検出される場合に立体物が存在すると判定される。立体物が存在すると認識された場合、立体物に関する情報の立体物の自車両に対する前後方向の位置xobj、立体物の自車両に対する横方向の位置yobj、立体物の進行方向の自車両の進行方向に対するなす角度θobjは、検出される安定度(例えば、連続して認識される時間)に応じてそれぞれ信頼度が設定される。そして、それぞれのパラメータ毎に予め設定された信頼度の閾値以上の場合に、当該パラメータの検出が行われたと判定され、信頼度の閾値に達しない場合は、当該パラメータの検出が行われないと判定される。   In addition, the reliability of the three-dimensional object is set according to the time for which the three-dimensional object detected in the set region is continuously recognized as the same three-dimensional object, for example, so that the three-dimensional object is continuously recognized as the same three-dimensional object. The reliability is set to high 1 and the reliability is set to 0 as the continuous recognition time decreases. And when a solid object is detected with the reliability more than the preset threshold value, it determines with a solid object existing. When it is recognized that a three-dimensional object exists, the position xobj of the information about the three-dimensional object in the front-rear direction with respect to the own vehicle, the position yobj of the three-dimensional object in the lateral direction with respect to the own vehicle, and the traveling direction of the own vehicle in the traveling direction of the three-dimensional object As for the angle θobj formed with respect to, the reliability is set in accordance with the detected stability (for example, the continuously recognized time). And when it is more than the reliability threshold value preset for each parameter, it is determined that the parameter is detected, and when the reliability threshold value is not reached, the parameter is not detected. Determined.

尚、本実施の形態では、前方情報を認識するためにステレオカメラを用いた例について説明したが、他に、単眼カメラ等を用いるようにしても良い。   In this embodiment, an example in which a stereo camera is used for recognizing forward information has been described, but a monocular camera or the like may be used instead.

そして、操舵制御部20は、図2に示す運転支援制御プログラムに従って、上述の車線区画線位置情報、立体物情報、各センサ信号を基に、車線情報に基づいて操舵制御により自車両が走行する車線から逸脱することを防止する車線逸脱防止目標旋回量γ0を算出し、少なくとも立体物情報に基づいて操舵制御により自車両が立体物と衝突することを回避する立体物回避目標旋回量(γ1、γ2、γ3)を算出し、算出した車線逸脱防止目標旋回量γ0と立体物回避目標旋回量(γ1、γ2、γ3)とを比較して最も大きい目標旋回量を基に、制御量としての目標トルクTpを算出して電動パワーステアリング装置1のモータ駆動部21に出力して電動パワーステアリングモータ12を駆動制御する。このように、操舵制御部20は、車線逸脱防止目標旋回量算出手段、立体物回避目標旋回量算出手段、制御手段として設けられている。   Then, the steering control unit 20 runs the host vehicle by steering control based on the lane information based on the lane marking position information, the three-dimensional object information, and each sensor signal according to the driving support control program shown in FIG. A lane departure prevention target turning amount γ0 for preventing departure from the lane is calculated, and at least three-dimensional object avoidance target turning amount (γ1, γ2, γ3) are calculated, and the calculated target lane departure prevention target turning amount γ0 and the three-dimensional object avoidance target turning amount (γ1, γ2, γ3) are compared, and the target as the control amount is calculated based on the largest target turning amount. The torque Tp is calculated and output to the motor drive unit 21 of the electric power steering apparatus 1 to drive and control the electric power steering motor 12. As described above, the steering control unit 20 is provided as a lane departure prevention target turning amount calculation unit, a three-dimensional object avoidance target turning amount calculation unit, and a control unit.

以下、図2のフローチャートを基に、操舵制御部20で実行される運転支援制御を説明する。   Hereinafter, the driving support control executed by the steering control unit 20 will be described based on the flowchart of FIG.

まず、ステップ(以下、「S」と略称)101で、車線が認識されているか否か判定し、車線が認識されている場合は、S102に進み、車線逸脱予想時間t_tlcを算出する。   First, in step (hereinafter abbreviated as “S”) 101, it is determined whether or not a lane is recognized. If a lane is recognized, the process proceeds to S102, and an estimated lane departure time t_tlc is calculated.

ここで、前方環境認識装置31で認識された車線区画線から求めることができるパラメータの導出について説明する。   Here, derivation of parameters that can be obtained from the lane marking recognized by the forward environment recognition device 31 will be described.

自車両の左側の車線区画線は最小自乗法により、以下の(1)式により近似される。   The lane marking on the left side of the host vehicle is approximated by the following equation (1) by the method of least squares.

y=AL・x+BL・x+CL …(1)
また、自車両の右側の車線区画線は最小自乗法により、以下の(2)式により近似される。
y = AL · x 2 + BL · x + CL (1)
Further, the lane marking on the right side of the host vehicle is approximated by the following equation (2) by the method of least squares.

y=AR・x+BR・x+CR …(2)
ここで、上述の(1)式、(2)式における、「AL」と「AR」は、それぞれの曲線における曲率を示し、左側の白線の曲率κは、2・ALであり、右側の白線の曲率κは、2・ARである。また、(1)式、(2)式における、「BL」と「BR」は、それぞれの曲線の自車両の幅方向における傾きを示し、「CL」と「CR」は、それぞれの曲線の自車両の幅方向における位置を示す(図5参照)。
y = AR · x 2 + BR · x + CR (2)
In the above equations (1) and (2), “AL” and “AR” indicate the curvature of each curve, the curvature κ of the left white line is 2 · AL, and the right white line The curvature κ is 2 · AR. In the equations (1) and (2), “BL” and “BR” indicate the inclinations of the respective curves in the width direction of the host vehicle, and “CL” and “CR” indicate the respective curves. The position in the width direction of the vehicle is shown (see FIG. 5).

このため、自車両の走行車線に対して自車両の進行方向がなす対車線ヨー角(以下、自車両の対車線ヨー角)θyawを、上述の(1)、(2)の近似式により、以下の(3)式により算出する。   For this reason, an on-lane yaw angle (hereinafter referred to as an on-vehicle yaw angle) θyaw formed by the traveling direction of the own vehicle with respect to the traveling lane of the own vehicle is expressed by the above-described approximate expressions (1) and (2). It calculates with the following (3) Formula.

θyaw=tan−1((BL+BR)/2) …(3)
また、車線の中央からの自車両位置である車線幅方向車両横位置yvを、以下の(4)式により算出する。
θyaw = tan −1 ((BL + BR) / 2) (3)
Also, the vehicle lateral position yv in the lane width direction, which is the vehicle position from the center of the lane, is calculated by the following equation (4).

yv=(CL+CR)/2 …(4)
以上により、現在の走行状態で車線から逸脱する車線逸脱予想時間t_tlcは、例えば、以下の(5)式により算出できる。
yv = (CL + CR) / 2 (4)
As described above, the predicted lane departure time t_tlc that deviates from the lane in the current traveling state can be calculated by, for example, the following equation (5).

t_tlc=(L−y_offset)/(V・sin(θyaw) …(5)
ここで、Lは車線区画線から自車両までの距離であり、例えば、以下の(6)式により算出する。また、y_offsetは、例えば、路面カント、道路幅、車線曲率等の条件により、予め実験・計算等により設定しておいたマップやテーブルを参照して設定する値である。
t_tlc = (L−y_offset) / (V · sin (θyaw) (5)
Here, L is the distance from the lane marking to the host vehicle, and is calculated by, for example, the following equation (6). Further, y_offset is a value that is set by referring to a map or table that has been set in advance through experiments and calculations, for example, under conditions such as road surface cant, road width, and lane curvature.

L=((CL−CR)−W)/2−yv …(6)
ここで、Wは車幅である。
L = ((CL-CR) -W) / 2-yv (6)
Here, W is a vehicle width.

次に、S103に進み、車線逸脱防止目標旋回量(本実施の形態では、車線逸脱防止目標ヨーレート)γ0を、例えば、以下の(7)式により算出する。   Next, the process proceeds to S103, and a lane departure prevention target turning amount (in this embodiment, a lane departure prevention target yaw rate) γ0 is calculated by the following equation (7), for example.

γ0=−θyaw/t_tlc …(7)
また、S101の判定で、車線が認識されていない場合は、S104に進み、車線逸脱防止目標ヨーレートγ0を0(γ0=0:車線逸脱防止の目標旋回量は0)に設定する。
γ0 = −θyaw / t_tlc (7)
If the lane is not recognized in S101, the process proceeds to S104, and the lane departure prevention target yaw rate γ0 is set to 0 (γ0 = 0: the target turning amount for lane departure prevention is 0).

S103、或いは、S104で車線逸脱防止目標ヨーレートγ0の設定を行った後は、S105に進み、立体物が認識されているか否か判定される。   After setting the lane departure prevention target yaw rate γ0 in S103 or S104, the process proceeds to S105, in which it is determined whether a three-dimensional object is recognized.

このS105の判定の結果、立体物が認識されていると判定された場合は、S106に進み、後述する図4に示す衝突余裕時間算出ルーチンに従って、衝突余裕時間t_ttcの算出を実行する。   As a result of the determination in S105, when it is determined that a three-dimensional object is recognized, the process proceeds to S106, and the collision margin time t_ttc is calculated according to the collision margin time calculation routine shown in FIG.

S106で衝突余裕時間t_ttcの算出を実行した後はS107に進み、S106の衝突余裕時間t_ttcの算出処理の結果、衝突余裕時間t_ttcが算出されたか否か判定される。   After calculating the collision margin time t_ttc in S106, the process proceeds to S107, and it is determined whether or not the collision margin time t_ttc is calculated as a result of the calculation process of the collision margin time t_ttc in S106.

このS107で、衝突余裕時間t_ttcが算出されたと判定された場合はS108に進み、立体物の進行方向の自車両の進行方向に対するなす角度θobjが検出されているか否か判定される。   If it is determined in S107 that the collision allowance time t_ttc has been calculated, the process proceeds to S108, and it is determined whether or not an angle θobj formed by the traveling direction of the three-dimensional object with respect to the traveling direction of the host vehicle is detected.

そして、立体物の進行方向の自車両の進行方向に対するなす角度θobjが検出されている場合は、S109に進み、第1の立体物回避目標旋回量(本実施の形態では、第1の立体物回避目標ヨーレート)γ1を、例えば、以下の(8)式により算出する。   When the angle θobj formed by the traveling direction of the three-dimensional object with respect to the traveling direction of the host vehicle is detected, the process proceeds to S109, and the first three-dimensional object avoidance target turning amount (in this embodiment, the first three-dimensional object). The avoidance target yaw rate) γ1 is calculated by the following equation (8), for example.

γ1=−θobj/t_ttc …(8)
すなわち、第1の立体物回避目標ヨーレートγ1は、自車両が立体物と衝突するまでに、自車両の進行方向を立体物の進行方向と同一方向になるように操舵制御し、自車両と立体物とが衝突することを確実に防止できる制御量となっている。
γ1 = −θobj / t_ttc (8)
That is, the first three-dimensional object avoidance target yaw rate γ1 performs steering control so that the traveling direction of the host vehicle is the same as the traveling direction of the three-dimensional object before the host vehicle collides with the three-dimensional object. The control amount can reliably prevent the object from colliding.

また、S108の判定の結果、立体物の進行方向の自車両の進行方向に対するなす角度θobjが検出されていない場合は、S110に進み、第1の立体物回避目標ヨーレートγ1を0(γ1=0:第1の立体物回避の目標旋回量は0)に設定する。   If the angle θobj formed by the traveling direction of the three-dimensional object with respect to the traveling direction of the host vehicle is not detected as a result of the determination in S108, the process proceeds to S110 and the first three-dimensional object avoidance target yaw rate γ1 is set to 0 (γ1 = 0). : The target turning amount for avoiding the first three-dimensional object is set to 0).

S109、或いは、S110で、第1の立体物回避目標ヨーレートγ1を設定した後はS111に進み、自車両の対車線ヨー角θyawが検出されているか否か判定する。   After setting the first three-dimensional object avoidance target yaw rate γ1 in S109 or S110, the process proceeds to S111, and it is determined whether or not the lane yaw angle θyaw of the host vehicle is detected.

そして、自車両の対車線ヨー角θyawが検出されている場合は、S112に進み、第2の立体物回避目標旋回量(本実施の形態では、第2の立体物回避目標ヨーレート)γ2を、例えば、以下の(9)式により算出する。   If the on-vehicle yaw angle θyaw of the host vehicle is detected, the process proceeds to S112, and the second three-dimensional object avoidance target turning amount (in the present embodiment, the second three-dimensional object avoidance target yaw rate) γ2 is For example, it is calculated by the following equation (9).

γ1=−θyaw/t_ttc …(9)
すなわち、第2の立体物回避目標ヨーレートγ2は、少なくとも自車両が立体物と衝突しないように、自車両の走行車線から逸脱しないように操舵制御し、自車両と立体物とが衝突することを確実に防止できる制御量となっている。
γ1 = −θyaw / t_ttc (9)
In other words, the second three-dimensional object avoidance target yaw rate γ2 is controlled so that at least the host vehicle does not collide with the three-dimensional object so as not to deviate from the traveling lane of the host vehicle, and the host vehicle and the three-dimensional object collide. The control amount can be surely prevented.

また、S111の判定の結果、自車両の対車線ヨー角θyawが検出されていない場合は、S113に進み、第2の立体物回避目標ヨーレートγ2を0(γ2=0:第2の立体物回避の目標旋回量は0)に設定する。   On the other hand, if it is determined in S111 that the lane yaw angle θyaw of the host vehicle is not detected, the process proceeds to S113, and the second three-dimensional object avoidance target yaw rate γ2 is set to 0 (γ2 = 0: second solid object avoidance) Is set to 0).

また、前述のS107の判定の結果、衝突余裕時間t_ttcが算出されていないと判定された場合は、S114に進み、第1の立体物回避目標ヨーレートγ1を0(γ1=0:第1の立体物回避の目標旋回量は0)に設定し、S115に進んで、第2の立体物回避目標ヨーレートγ2を0(γ2=0:第2の立体物回避の目標旋回量は0)に設定する。   If it is determined that the collision allowance time t_ttc has not been calculated as a result of the determination in S107, the process proceeds to S114, and the first three-dimensional object avoidance target yaw rate γ1 is set to 0 (γ1 = 0: first solid). The target turning amount for object avoidance is set to 0), and the process proceeds to S115, where the second three-dimensional object avoidance target yaw rate γ2 is set to 0 (γ2 = 0: the second target turning amount for avoiding the three-dimensional object is 0). .

そして、S112、或いは、S113、或いは、S115で第2の立体物回避目標ヨーレートγ2を設定した後は、S116に進み、自車両の対車線ヨー角θyawと立体物の自車両に対する横方向の位置yobjとが検出されているか否か判定される。   Then, after setting the second three-dimensional object avoidance target yaw rate γ2 in S112, S113, or S115, the process proceeds to S116, where the vehicle's anti-lane yaw angle θyaw and the position of the three-dimensional object in the lateral direction with respect to the own vehicle are determined. It is determined whether or not yobj is detected.

S116の判定の結果、自車両の対車線ヨー角θyawと立体物の自車両に対する横方向の位置yobjとが検出されている場合は、S117に進み、第3の立体物回避目標旋回量(本実施の形態では、第3の立体物回避目標ヨーレート)γ3を、例えば、以下の(10)式により算出する。   As a result of the determination in S116, when the lane yaw angle θyaw of the host vehicle and the position yobj of the three-dimensional object in the lateral direction with respect to the host vehicle are detected, the process proceeds to S117, and the third three-dimensional object avoidance target turning amount (main In the embodiment, the third three-dimensional object avoidance target yaw rate) γ3 is calculated by, for example, the following equation (10).

γ3=−θyaw/((yobj−y_offset)/(V・sin(θyaw))
…(10)
すなわち、第3の立体物回避目標ヨーレートγ3は、たとえ自車両の走行車線内であっても、立体物に接近していく走行は、ドライバにとって恐怖感を与える可能性があるため、そのような車両の走行を防止する制御量となっている。
γ3 = −θyaw / ((yobj−y_offset) / (V · sin (θyaw))
(10)
In other words, the third three-dimensional object avoidance target yaw rate γ3 is likely to cause fear for the driver to travel closer to the three-dimensional object even in the traveling lane of the own vehicle. The control amount prevents the vehicle from running.

また、前述のS116の判定の結果、自車両の対車線ヨー角θyawと立体物の自車両に対する横方向の位置yobjとが検出されていない場合は、S118に進み、第3の立体物回避目標ヨーレートγ3を0(γ3=0:第3の立体物回避の目標旋回量は0)に設定する。   Further, as a result of the determination in S116 described above, when the anti-lane yaw angle θyaw of the host vehicle and the position yobj of the three-dimensional object in the lateral direction with respect to the host vehicle have not been detected, the process proceeds to S118 and the third three-dimensional object avoidance target is reached. The yaw rate γ3 is set to 0 (γ3 = 0: the target turning amount for the third solid object avoidance is 0).

一方、前述のS105の判定の結果、立体物が認識されていないと判定された場合は、S119に進み、第1の立体物回避目標ヨーレートγ1を0(γ1=0:第1の立体物回避の目標旋回量は0)に設定し、S120に進んで、第2の立体物回避目標ヨーレートγ2を0(γ2=0:第2の立体物回避の目標旋回量は0)に設定し、S121に進み、第3の立体物回避目標ヨーレートγ3を0(γ3=0:第3の立体物回避の目標旋回量は0)に設定する。   On the other hand, if it is determined that the three-dimensional object is not recognized as a result of the determination in S105, the process proceeds to S119, where the first three-dimensional object avoidance target yaw rate γ1 is set to 0 (γ1 = 0: first three-dimensional object avoidance). Is set to 0), the process proceeds to S120, the second three-dimensional object avoidance target yaw rate γ2 is set to 0 (γ2 = 0: the target turn amount of the second three-dimensional object avoidance is 0), and S121. , The third three-dimensional object avoidance target yaw rate γ3 is set to 0 (γ3 = 0: the target turning amount of the third three-dimensional object avoidance is 0).

そして、S117、或いは、S118、或いは、S121で第3の立体物回避目標ヨーレートγ2を設定した後は、S122に進み、目標旋回量(本実施の形態では、目標ヨーレート)γtを、例えば、以下の(11)式により算出する。   Then, after setting the third three-dimensional object avoidance target yaw rate γ2 in S117, S118, or S121, the process proceeds to S122, and the target turning amount (target yaw rate in the present embodiment) γt is set to, for example, (11).

γt=MAX(|γ0|,|γ1|,|γ2|,|γ3|) …(11)
ここで、MAX(|γ0|,|γ1|,|γ2|,|γ3|)は、|γ0|,|γ1|,|γ2|,|γ3|の中で、最大値を求めるMAX関数であり、すなわち、各目標ヨーレートの中で、絶対値の最も大きな値が目標ヨーレートγtとして算出される。
γt = MAX (| γ0 |, | γ1 |, | γ2 |, | γ3 |) (11)
Here, MAX (| γ0 |, | γ1 |, | γ2 |, | γ3 |) is a MAX function for obtaining a maximum value among | γ0 |, | γ1 |, | γ2 |, | γ3 |. That is, among the target yaw rates, the largest absolute value is calculated as the target yaw rate γt.

そして、S123に進み、例えば、以下の(12)式により、目標トルクTpを算出して出力する。   Then, the process proceeds to S123, and the target torque Tp is calculated and output by the following equation (12), for example.

Tp=Gff・γt+(Gp・(γt−γ)+Gd・d(γt−γ)/dt
+Gi・∫(γt−γ)dt) …(12)
ここで、Gffはフィードフォワードゲイン、Gpはフィードバック項の比例ゲイン、Gdはフィードバック項の微分ゲイン、Giはフィードバック項の積分ゲインであり、それぞれ予め設定しておいた値である。
Tp = Gff · γt + (Gp · (γt−γ) + Gd · d (γt−γ) / dt
+ Gi · ∫ (γt−γ) dt) (12)
Here, Gff is a feedforward gain, Gp is a proportional gain of the feedback term, Gd is a differential gain of the feedback term, and Gi is an integral gain of the feedback term, which are preset values.

次に、上述のS106で実行される衝突余裕時間算出ルーチンを、図4のフローチャートで説明する。   Next, the collision margin time calculation routine executed in S106 described above will be described with reference to the flowchart of FIG.

まず、S201で、立体物の自車両に対する前後方向の位置xobjが検出されているか否か判定される。   First, in S201, it is determined whether or not a position xobj in the front-rear direction of the three-dimensional object with respect to the host vehicle is detected.

この判定の結果、立体物の自車両に対する前後方向の位置xobjが検出されている場合は、S202に進み、立体物の自車両に対する横方向の位置yobjが検出されているか否か判定される。   As a result of the determination, if the front-rear direction position xobj of the three-dimensional object is detected, the process proceeds to S202, and it is determined whether the horizontal position yobj of the three-dimensional object is detected.

そして、S202の判定の結果、立体物の自車両に対する横方向の位置yobjが検出されている場合は、S203に進み、立体物と自車両との相対速度の前後方向成分Vrx_obj(=dxobj/dt)と、立体物と自車両との相対速度の横方向成分Vry_obj(=dyobj/dt)を算出する。   If the result of the determination in S202 is that the lateral position yobj of the three-dimensional object relative to the host vehicle is detected, the process proceeds to S203, and the longitudinal component Vrx_obj (= dxobj / dt) of the relative speed between the three-dimensional object and the host vehicle. ) And the lateral component Vry_obj (= dyobj / dt) of the relative speed between the three-dimensional object and the host vehicle.

次いで、S204に進み、車両前後方向における衝突余裕時間t_ttc_x(=xobj/Vrx_obj)と、車両横方向における衝突余裕時間t_ttc_y(=yobj/Vry_obj)を算出する。   Next, in S204, a collision margin time t_ttc_x (= xobj / Vrx_obj) in the vehicle longitudinal direction and a collision margin time t_ttc_y (= yobj / Vry_obj) in the vehicle lateral direction are calculated.

また、前述のS202で、立体物の自車両に対する横方向の位置yobjが検出されていない場合は、S205に進み、立体物の進行方向の自車両の進行方向に対するなす角度θobjが検出されているか否か判定される。   If the horizontal position yobj of the three-dimensional object with respect to the own vehicle is not detected in S202 described above, the process proceeds to S205, and whether the angle θobj formed by the three-dimensional object traveling direction with respect to the traveling direction of the own vehicle is detected. It is determined whether or not.

この判定の結果、立体物の進行方向の自車両の進行方向に対するなす角度θobjが検出されている場合は、S206に進み、立体物と自車両との相対速度の前後方向成分Vrx_obj(=dxobj/dt)を算出する。また、立体物と自車両との相対速度の横方向成分Vry_objは、Vrx_objとθobjを用いて、以下の(13)式で算出する。   As a result of the determination, if the angle θobj formed by the traveling direction of the three-dimensional object with respect to the traveling direction of the host vehicle is detected, the process proceeds to S206, and the longitudinal component Vrx_obj (= dxobj / dt) is calculated. Further, the lateral component Vry_obj of the relative speed between the three-dimensional object and the host vehicle is calculated by the following equation (13) using Vrx_obj and θobj.

Vry_obj=Vrx_obj・sin(θobj) …(13)
次いで、S207に進み、検出できない立体物の自車両に対する横方向の位置yobjを、立体物と自車両との相対速度の横方向成分Vry_objを検出できなくなってからの時間を乗算し、最後に検出された立体物の自車両に対する横方向の位置yobjに加算することで算出する。
Vry_obj = Vrx_obj · sin (θobj) (13)
Next, the process proceeds to S207, where the lateral position yobj of the three-dimensional object that cannot be detected with respect to the own vehicle is multiplied by the time after the lateral component Vry_obj of the relative speed between the three-dimensional object and the own vehicle cannot be detected, and finally detected. It is calculated by adding to the horizontal position yobj of the three-dimensional object made with respect to the host vehicle.

次に、S208に進んで、車両前後方向における衝突余裕時間t_ttc_x(=xobj/Vrx_obj)と、車両横方向における衝突余裕時間t_ttc_y(=yobj/Vry_obj)を算出する。   Next, the process proceeds to S208, where a collision margin time t_ttc_x (= xobj / Vrx_obj) in the vehicle longitudinal direction and a collision margin time t_ttc_y (= yobj / Vry_obj) in the vehicle lateral direction are calculated.

S204、或いは、S208で、車両前後方向における衝突余裕時間t_ttc_xと、車両横方向における衝突余裕時間t_ttc_yを算出した後は、S209に進み、車両前後方向における衝突余裕時間t_ttc_xと、車両横方向における衝突余裕時間t_ttc_yとを比較する。   After calculating the collision margin time t_ttc_x in the vehicle front-rear direction and the collision margin time t_ttc_y in the vehicle lateral direction in S204 or S208, the process proceeds to S209, where the collision margin time t_ttc_x in the vehicle longitudinal direction and the collision in the vehicle lateral direction are calculated. The margin time t_ttc_y is compared.

そして、このS209の比較の結果、小さい方の衝突余裕時間、すなわち、t_ttc_x≧t_ttc_yであれば、S210に進み、車両横方向における衝突余裕時間t_ttc_yを衝突余裕時間t_ttcとして設定し、t_ttc_x<t_ttc_yであれば、S211に進み、車両前後方向における衝突余裕時間t_ttc_xを衝突余裕時間t_ttcとして設定する。   If the result of the comparison in S209 shows that the smaller collision margin time, that is, t_ttc_x ≧ t_ttc_y, the process proceeds to S210, where the collision margin time t_ttc_y in the lateral direction of the vehicle is set as the collision margin time t_ttc. If there is, the process proceeds to S211, and the collision margin time t_ttc_x in the vehicle longitudinal direction is set as the collision margin time t_ttc.

また、前述のS205で、立体物の進行方向の自車両の進行方向に対するなす角度θobjが検出されていない場合は、S212に進み、立体物と自車両との相対速度の前後方向成分Vrx_obj(=dxobj/dt)を算出し、S213に進んで、車両前後方向における衝突余裕時間t_ttc_x(=xobj/Vrx_obj)を算出する。   When the angle θobj formed by the traveling direction of the three-dimensional object with respect to the traveling direction of the host vehicle is not detected in S205 described above, the process proceeds to S212, and the longitudinal component Vrx_obj (= dxobj / dt) is calculated, the process proceeds to S213, and a collision margin time t_ttc_x (= xobj / Vrx_obj) in the vehicle longitudinal direction is calculated.

そして、S214に進み、車両前後方向における衝突余裕時間t_ttc_xを衝突余裕時間t_ttcとして設定する。   Then, the process proceeds to S214, and the collision margin time t_ttc_x in the vehicle longitudinal direction is set as the collision margin time t_ttc.

一方、S201で、立体物の自車両に対する前後方向の位置xobjが検出されていない場合は、S215に進み、立体物の自車両に対する横方向の位置yobjが検出されているか否か判定される。   On the other hand, if the front-rear direction position xobj of the three-dimensional object with respect to the host vehicle is not detected in S201, the process proceeds to S215, and it is determined whether or not the horizontal position yobj of the three-dimensional object with respect to the host vehicle is detected.

このS215の判定の結果、立体物の自車両に対する横方向の位置yobjが検出されている場合は、S216に進み、立体物と自車両との相対速度の横方向成分Vry_obj(=dyobj/dt)を算出し、S217に進んで、車両横方向における衝突余裕時間t_ttc_y(=yobj/Vry_obj)を算出する。   As a result of the determination in S215, when the lateral position yobj of the three-dimensional object with respect to the own vehicle is detected, the process proceeds to S216, and the lateral component Vry_obj (= dyobj / dt) of the relative speed between the three-dimensional object and the own vehicle. The process proceeds to S217, and a collision margin time t_ttc_y (= yobj / Vry_obj) in the lateral direction of the vehicle is calculated.

そして、S218に進み、車両横方向における衝突余裕時間t_ttc_yを衝突余裕時間t_ttcとして設定する。   In S218, the collision margin time t_ttc_y in the vehicle lateral direction is set as the collision margin time t_ttc.

また、前述のS215で、立体物の自車両に対する横方向の位置yobjが検出されていない場合は、S219に進み、衝突余裕時間t_ttcは設定しない。   If the lateral position yobj of the three-dimensional object with respect to the host vehicle is not detected in S215 described above, the process proceeds to S219, and the collision margin time t_ttc is not set.

以上のように、本実施の形態によれば、車線区画線位置情報、立体物情報、各センサ信号を基に、車線情報に基づいて操舵制御により自車両が走行する車線から逸脱することを防止する車線逸脱防止目標旋回量γ0を算出し、少なくとも立体物情報に基づいて操舵制御により自車両が立体物と衝突することを回避する立体物回避目標旋回量(γ1、γ2、γ3)を算出し、算出した車線逸脱防止目標旋回量γ0と立体物回避目標旋回量(γ1、γ2、γ3)とを比較して最も大きい目標旋回量を基に、操舵制御を実行するようになっている。このため、車線逸脱防止機能と立体物回避機能とを適切に協調させて車線からの逸脱を確実に防止し、かつ、立体物との衝突を確実に防止して、汎用性が高く安全性を向上させることが可能となる。特に、立体物は、歩行者、二輪車、四輪車(車両)、その他の立体物により自車両との相対的な位置の変化が異なり、また、検出できる立体物情報の信頼度も様々であるため、立体物との衝突を確実に防止するためには、これらの変化や違いを考慮して制御することが必要となるが、本実施の形態では、第1の立体物回避目標ヨーレートγ1、第2の立体物回避目標ヨーレートγ2、第3の立体物回避目標ヨーレートγ3の複数の目標旋回量から最大のもので制御するようになっているので、車線からの逸脱を確実に防止し、確実に立体物との衝突を防止できるようになっている。   As described above, according to the present embodiment, based on the lane line position information, the three-dimensional object information, and each sensor signal, it is possible to prevent the vehicle from deviating from the lane in which the host vehicle travels by steering control based on the lane information. The target turning amount γ0 to prevent lane departure is calculated, and the three-dimensional object avoidance target turning amount (γ1, γ2, γ3) that avoids the collision of the host vehicle with the three-dimensional object by steering control based on at least three-dimensional object information is calculated. The calculated lane departure prevention target turning amount γ0 and the three-dimensional object avoiding target turning amount (γ1, γ2, γ3) are compared, and the steering control is executed based on the largest target turning amount. For this reason, the lane departure prevention function and the three-dimensional object avoidance function are properly coordinated to reliably prevent deviation from the lane, and to reliably prevent collision with the three-dimensional object, making it highly versatile and safe. It becomes possible to improve. In particular, three-dimensional objects vary in relative position with the host vehicle depending on pedestrians, two-wheeled vehicles, four-wheeled vehicles (vehicles), and other three-dimensional objects, and the reliability of three-dimensional object information that can be detected varies. Therefore, in order to reliably prevent a collision with a three-dimensional object, it is necessary to control in consideration of these changes and differences. In the present embodiment, the first three-dimensional object avoidance target yaw rate γ1, Since the control is performed with the maximum of the plurality of target turning amounts of the second three-dimensional object avoidance target yaw rate γ2 and the third three-dimensional object avoidance target yaw rate γ3, the deviation from the lane is surely prevented and reliably In addition, it is possible to prevent a collision with a three-dimensional object.

1 電動パワーステアリング装置
2 ステアリング軸
4 ステアリングホイール
5 ピニオン軸
10L、10R 車輪
12 電動モータ
20 操舵制御部(車線逸脱防止目標旋回量算出手段、立体物回避目標旋回量算出手段、制御手段)
21 モータ駆動部
31 前方認識装置(周辺環境認識手段)
32 車速センサ
33 ヨーレートセンサ
DESCRIPTION OF SYMBOLS 1 Electric power steering apparatus 2 Steering shaft 4 Steering wheel 5 Pinion shaft 10L, 10R Wheel 12 Electric motor 20 Steering control part (lane departure prevention target turning amount calculation means, three-dimensional object avoidance target turning amount calculation means, control means)
21 motor drive unit 31 forward recognition device (peripheral environment recognition means)
32 Vehicle speed sensor 33 Yaw rate sensor

Claims (6)

少なくとも走行する車線の車線情報と自車両の周辺立体物情報を認識する周辺環境認識手段と、
上記車線情報に基づいて操舵制御により自車両が走行する車線から逸脱することを防止する車線逸脱防止目標旋回量を算出する車線逸脱防止目標旋回量算出手段と、
少なくとも上記周辺立体物情報に基づいて操舵制御により自車両が立体物と衝突することを回避する立体物回避目標旋回量を算出する立体物回避目標旋回量算出手段と、
算出した上記車線逸脱防止目標旋回量と上記立体物回避目標旋回量とを比較して大きい方の目標旋回量に応じて操舵制御の制御量を算出する制御手段と、
を備えたことを特徴とする車両の運転支援制御装置。
Surrounding environment recognition means for recognizing at least lane information of a traveling lane and surrounding three-dimensional object information of the host vehicle,
Lane departure prevention target turning amount calculation means for calculating a lane departure prevention target turning amount that prevents the vehicle from deviating from the lane in which the vehicle travels by steering control based on the lane information;
A three-dimensional object avoidance target turning amount calculating means for calculating a three-dimensional object avoidance target turning amount that avoids the vehicle from colliding with the three-dimensional object by steering control based on at least the surrounding three-dimensional object information;
Control means for calculating the control amount of the steering control in accordance with the larger target turning amount by comparing the calculated lane departure prevention target turning amount and the three-dimensional object avoiding target turning amount;
A vehicle driving support control device comprising:
上記立体物回避目標旋回量算出手段は、自車両と立体物とが衝突する衝突余裕時間を算出し、少なくとも上記立体物回避目標旋回量を、上記衝突余裕時間と立体物の進行方向の自車両の進行方向に対するなす角度とに基づいて算出することを特徴とする請求項1記載の車両の運転支援制御装置。   The three-dimensional object avoidance target turning amount calculation means calculates a collision allowance time in which the host vehicle and the three-dimensional object collide, and at least the three-dimensional object avoidance target turning amount is determined based on the collision allowance time and the own vehicle in the traveling direction of the three-dimensional object. The vehicle driving support control device according to claim 1, wherein the vehicle driving support control device calculates the angle based on an angle formed with respect to the traveling direction of the vehicle. 上記立体物回避目標旋回量算出手段は、自車両と立体物とが衝突する衝突余裕時間を算出し、少なくとも上記立体物回避目標旋回量を、上記衝突余裕時間と自車両の走行車線に対して自車両の進行方向がなす対車線ヨー角とに基づいて算出することを特徴とする請求項1又は請求項2記載の車両の運転支援制御装置。   The three-dimensional object avoidance target turning amount calculation means calculates a collision allowance time in which the host vehicle and the three-dimensional object collide, and at least the three-dimensional object avoidance target turning amount is calculated with respect to the collision allowance time and the traveling lane of the own vehicle. 3. The vehicle driving support control device according to claim 1, wherein the driving assistance control device calculates the vehicle based on an anti-lane yaw angle formed by a traveling direction of the host vehicle. 上記立体物回避目標旋回量算出手段は、少なくとも上記立体物回避目標旋回量を、自車両が横方向に立体物に近づく接近速度と立体物の横方向の位置と自車両の走行車線に対して自車両の進行方向がなす対車線ヨー角とに基づいて算出することを特徴とする請求項1乃至請求項3の何れか一つに記載の車両の運転支援制御装置。   The three-dimensional object avoidance target turning amount calculation means calculates at least the three-dimensional object avoidance target turning amount with respect to the approach speed at which the host vehicle approaches the three-dimensional object in the lateral direction, the lateral position of the three-dimensional object, and the traveling lane of the own vehicle. The vehicle driving support control device according to any one of claims 1 to 3, wherein the vehicle driving support control device calculates the vehicle lane based on a yaw angle to the lane formed by the traveling direction of the host vehicle. 上記制御手段は、立体物回避目標旋回量算出手段から複数の立体物回避目標旋回量が入力されている場合、算出した上記車線逸脱防止目標旋回量と上記複数の立体物回避目標旋回量とを比較して最も大きな目標旋回量に応じて操舵制御の制御量を算出することを特徴とする請求項1乃至請求項4の何れか一つに記載の車両の運転支援制御装置。   When a plurality of three-dimensional object avoidance target turn amounts are input from the three-dimensional object avoidance target turn amount calculation means, the control means calculates the calculated lane departure prevention target turn amount and the plurality of three-dimensional object avoidance target turn amounts. The vehicle driving support control apparatus according to any one of claims 1 to 4, wherein the control amount of the steering control is calculated in accordance with the largest target turning amount in comparison. 上記周辺環境認識手段は、上記車線情報と上記周辺立体物情報の信頼度を算出し、上記車線情報と上記周辺立体物情報の信頼度に応じて情報の検出を判断することを特徴とする請求項1乃至請求項5の何れか一つに記載の車両の運転支援制御装置。   The surrounding environment recognition means calculates the reliability of the lane information and the surrounding solid object information, and judges the detection of information according to the reliability of the lane information and the surrounding solid object information. The vehicle driving support control device according to any one of claims 1 to 5.
JP2015238720A 2015-12-07 2015-12-07 Vehicle driving support control device Active JP6661213B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2015238720A JP6661213B2 (en) 2015-12-07 2015-12-07 Vehicle driving support control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2015238720A JP6661213B2 (en) 2015-12-07 2015-12-07 Vehicle driving support control device

Publications (2)

Publication Number Publication Date
JP2017105249A true JP2017105249A (en) 2017-06-15
JP6661213B2 JP6661213B2 (en) 2020-03-11

Family

ID=59058693

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2015238720A Active JP6661213B2 (en) 2015-12-07 2015-12-07 Vehicle driving support control device

Country Status (1)

Country Link
JP (1) JP6661213B2 (en)

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11189166A (en) * 1997-12-25 1999-07-13 Mitsubishi Motors Corp Lane deviation preventing device
JP2004362224A (en) * 2003-06-04 2004-12-24 Nissan Motor Co Ltd Driving operation auxiliary device for vehicle and vehicle equipped with same device
JP2006182129A (en) * 2004-12-27 2006-07-13 Nissan Motor Co Ltd Preventing device of deviation from lane
EP1927499A1 (en) * 2006-11-29 2008-06-04 Ford Global Technologies, LLC Steering safety system
JP2009078733A (en) * 2007-09-27 2009-04-16 Hitachi Ltd Driving support system
JP2010100119A (en) * 2008-10-22 2010-05-06 Honda Motor Co Ltd Vehicle behavior control system
JP2010105553A (en) * 2008-10-30 2010-05-13 Nissan Motor Co Ltd Driving operation support device and driving operation support method
JP2012076621A (en) * 2010-10-01 2012-04-19 Toyota Motor Corp Driving assist apparatus and method
JP2012079117A (en) * 2010-10-01 2012-04-19 Toyota Motor Corp Object recognition system for vehicle
WO2013030906A1 (en) * 2011-08-26 2013-03-07 トヨタ自動車株式会社 Driving support apparatus and driving support method
WO2013098996A1 (en) * 2011-12-28 2013-07-04 トヨタ自動車株式会社 Vehicle driving assistance device
JP2017030472A (en) * 2015-07-31 2017-02-09 トヨタ自動車株式会社 Drive support device

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11189166A (en) * 1997-12-25 1999-07-13 Mitsubishi Motors Corp Lane deviation preventing device
JP2004362224A (en) * 2003-06-04 2004-12-24 Nissan Motor Co Ltd Driving operation auxiliary device for vehicle and vehicle equipped with same device
JP2006182129A (en) * 2004-12-27 2006-07-13 Nissan Motor Co Ltd Preventing device of deviation from lane
EP1927499A1 (en) * 2006-11-29 2008-06-04 Ford Global Technologies, LLC Steering safety system
JP2009078733A (en) * 2007-09-27 2009-04-16 Hitachi Ltd Driving support system
JP2010100119A (en) * 2008-10-22 2010-05-06 Honda Motor Co Ltd Vehicle behavior control system
JP2010105553A (en) * 2008-10-30 2010-05-13 Nissan Motor Co Ltd Driving operation support device and driving operation support method
JP2012076621A (en) * 2010-10-01 2012-04-19 Toyota Motor Corp Driving assist apparatus and method
JP2012079117A (en) * 2010-10-01 2012-04-19 Toyota Motor Corp Object recognition system for vehicle
WO2013030906A1 (en) * 2011-08-26 2013-03-07 トヨタ自動車株式会社 Driving support apparatus and driving support method
WO2013098996A1 (en) * 2011-12-28 2013-07-04 トヨタ自動車株式会社 Vehicle driving assistance device
JP2017030472A (en) * 2015-07-31 2017-02-09 トヨタ自動車株式会社 Drive support device

Also Published As

Publication number Publication date
JP6661213B2 (en) 2020-03-11

Similar Documents

Publication Publication Date Title
JP6243931B2 (en) Vehicle travel control device
JP6222786B2 (en) Vehicle travel control device
JP6294928B1 (en) Vehicle travel control device
JP5798658B1 (en) Vehicle lane departure prevention control device
US10106161B2 (en) Vehicle travel control device
JP5300357B2 (en) Collision prevention support device
JP5743286B2 (en) Vehicle driving support device
JP6335155B2 (en) Vehicle travel control device
JP5947849B2 (en) Vehicle lane departure prevention control device
US7711466B2 (en) Vehicle driving control unit
KR20180063199A (en) A system for controlling steering means of a vehicle in the event of an imminent collision with an obstacle
JP6027659B1 (en) Vehicle travel control device
JP6595852B2 (en) Vehicle driving support device
JP5651052B2 (en) Vehicle power steering control device
JP6381069B2 (en) Vehicle driving support control device
JP2015189410A (en) Lane deviation prevention controller for vehicle
JP2019089521A (en) Lane deviation prevention control device for vehicle
JP6898636B2 (en) Vehicle travel control device
JP2019156059A (en) Lane deviation prevention control device
JP6626293B2 (en) Vehicle driving support device
JP6803285B2 (en) Vehicle travel control device
JP6338417B2 (en) Vehicle lane departure prevention control device
JP6068185B2 (en) Vehicle driving support device
JP6661214B2 (en) Vehicle driving support control device
JP6661213B2 (en) Vehicle driving support control device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20180928

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20190711

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190806

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190917

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20190917

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: 20200114

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200207

R150 Certificate of patent or registration of utility model

Ref document number: 6661213

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250