JP2019156059A - Lane deviation prevention control device - Google Patents

Lane deviation prevention control device Download PDF

Info

Publication number
JP2019156059A
JP2019156059A JP2018043334A JP2018043334A JP2019156059A JP 2019156059 A JP2019156059 A JP 2019156059A JP 2018043334 A JP2018043334 A JP 2018043334A JP 2018043334 A JP2018043334 A JP 2018043334A JP 2019156059 A JP2019156059 A JP 2019156059A
Authority
JP
Japan
Prior art keywords
curve
vehicle
lane
prevention control
deviation
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
JP2018043334A
Other languages
Japanese (ja)
Other versions
JP7075245B2 (en
Inventor
優太 佐藤
Yuta Sato
優太 佐藤
健太 島崎
Kenta SHIMAZAKI
健太 島崎
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 JP2018043334A priority Critical patent/JP7075245B2/en
Publication of JP2019156059A publication Critical patent/JP2019156059A/en
Application granted granted Critical
Publication of JP7075245B2 publication Critical patent/JP7075245B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

To suppress the intervention of a lane deviation prevention control against the driver's steering intention toward the deviation in the curve-outward direction when passing through a curve during a towed-travel while connecting a towed vehicle, thus to reduce the discomfortness for the driver while securing safety.SOLUTION: In a case where a towed-travel determination section 17 determines that an own vehicle is towed-traveling while connecting a trailer on the rear side, when a curve entrance state determination section 18 determines that a curve entrance state of the own vehicle is safe and a curve outside deviation determination section 19 determines that the own vehicle deviates from a partition line on the outside of a curve, a lane deviation allowance instruction section 21 instructs a lane deviation prevention control section 16 to execute a lane deviation prevention control, which tolerates the deviation from the partition line on the outside of the curve of the own vehicle, of up to a deviation allowance calculated in a deviation allowance calculation section 20.SELECTED DRAWING: Figure 4

Description

本発明は、自車両が走行する車線からの逸脱を防止する車線逸脱防止制御装置に関する。   The present invention relates to a lane departure prevention control device that prevents a departure from a lane in which a host vehicle travels.

自動車等の車両においては、電動モータを介して操舵角を制御可能な電動パワーステアリング装置等の操舵装置を備え、カメラやレーダ装置等によって認識した車両周囲の外部環境に基づいて、ドライバの操舵操作を支援する操舵支援制御が知られている。   A vehicle such as an automobile is equipped with a steering device such as an electric power steering device capable of controlling a steering angle via an electric motor, and a driver's steering operation based on an external environment around the vehicle recognized by a camera, a radar device, or the like. Steering support control for assisting is known.

この操舵支援制御の1つとして、自車両の走行車線からの逸脱を防止する車線逸脱防止制御があるが、走行路の形状によっては、車線逸脱防止制御の実行がかえってドライバに違和感を与えてしまう場合がある。   As one of the steering assist controls, there is a lane departure prevention control for preventing a departure from the traveling lane of the host vehicle. However, depending on the shape of the traveling path, the execution of the lane departure prevention control may be changed and the driver may feel uncomfortable. There is a case.

このため、例えば、特許文献1には、曲線路の内側方向に逸脱する傾向がある場合で、かつ逸脱方向の車線後方に自車両と略同方向に走行する接近車両が存在する場合に、自車両へのヨーモーメントの付与を行い、かつ当該ヨーモーメントの付与により逸脱を回避した後、自車両を減速することにより、運転者に違和感を与えることのない車線逸脱防止の制御を実現する技術が開示されている。   For this reason, for example, in Patent Document 1, when there is a tendency to deviate in the inner direction of a curved road, and there is an approaching vehicle traveling in the same direction as the own vehicle behind the lane in the deviating direction, A technology that realizes lane departure prevention control that does not give the driver a sense of incongruity by giving a yaw moment to a vehicle and avoiding the departure by giving the yaw moment and then decelerating the vehicle. It is disclosed.

特許第4380301号公報Japanese Patent No. 4380301

しかしながら、自車両の後部に被牽引車両を連結して牽引走行している場合には、カーブを通過する際、被牽引車両の内輪差によるカーブ内側への逸脱や、被牽引車両の側方の歩行者や二輪車等との接触を防止するため、ドライバが意図的に自車両を大回りさせるように操舵し、カーブ外側方向に自車両を若干逸脱させようとする場合がある。このような場合、ドライバの意図に反して車線逸脱防止制御が介入すると、ドライバに違和感を与えるばかりでなく、ドライバが所望する経路で走行することが困難となる。   However, when the vehicle is towed with a towed vehicle connected to the rear part of the host vehicle, when passing the curve, the deviation of the towed vehicle to the inside of the curve due to the inner ring difference or the side of the towed vehicle In order to prevent contact with a pedestrian, a two-wheeled vehicle, or the like, the driver may intentionally steer the host vehicle to make a large turn and cause the host vehicle to slightly deviate in the curve outward direction. In such a case, if the lane departure prevention control intervenes against the driver's intention, it not only makes the driver feel uncomfortable but also makes it difficult for the driver to travel on a desired route.

本発明は上記事情に鑑みてなされたもので、被牽引車両を連結しての牽引走行でカーブを通過する際に、カーブ外側方向への逸脱に対してドライバの操舵意図に反する車線逸脱防止制御の介入を抑制し、安全を確保しながらドライバへの違和感を低減することのできる車線逸脱防止制御装置を提供することを目的としている。   The present invention has been made in view of the above circumstances, and when passing through a curve in towing traveling with a towed vehicle connected, lane departure prevention control that deviates from the driver's steering intention against deviation in the curve outward direction. It is an object of the present invention to provide a lane departure prevention control device that can reduce the sense of incongruity to the driver while suppressing safety and ensuring safety.

本発明の一態様による車線逸脱防止制御装置は、自車両が走行する車線からの逸脱を防止する車線逸脱防止制御を実行する車線逸脱防止制御部を有する車両の車線逸脱防止制御装置であって、自車両の後部に被牽引車両を連結して走行する牽引走行か否かを判断する牽引走行判断部と、前記牽引走行時に自車両のカーブへの進入状態が安全か否かを判断するカーブ進入状態判断部と、前記牽引走行時に、前記車線を形成する左右の区画線のうちの前記カーブの外側となる区画線を逸脱するか否かを判断するカーブ外側逸脱判断部と、前記カーブの外側となる区画線からの自車両の逸脱量の許容限界を規定する逸脱許容量を算出する逸脱許容量算出部と、自車両の前記カーブへの進入状態が安全と判断され、且つ自車両が前記カーブの外側となる区画線を逸脱すると判断された場合、前記車線逸脱防止制御部に、前記カーブの外側となる区画線からの自車両の逸脱を前記逸脱許容量まで許容して前記車線逸脱防止制御を実行するよう指示する車線逸脱許容指示部とを備える。   A lane departure prevention control device according to an aspect of the present invention is a vehicle lane departure prevention control device having a lane departure prevention control unit that executes lane departure prevention control for preventing departure from a lane in which the host vehicle travels. A tow travel determination unit that determines whether the towed vehicle travels by connecting a towed vehicle to the rear part of the host vehicle, and a curve approach that determines whether the approach state of the host vehicle to the curve is safe during the towed traveling A state determination unit, a curve outer departure determination unit that determines whether or not to deviate from a lane marking that is outside the curve among the left and right lane markings that form the lane during the towing, and an outer side of the curve A deviation allowance calculating unit for calculating a deviation allowance that defines an allowable limit of the deviation amount of the own vehicle from the lane marking, and an approach state of the own vehicle to the curve is determined to be safe, and the own vehicle is Outside the curve When it is determined that the vehicle departs from the lane line, the lane departure prevention control unit is allowed to perform the lane departure prevention control by allowing the vehicle to deviate from the lane line outside the curve to the deviation allowance. A lane departure allowance instruction unit for instructing.

本発明によれば、被牽引車両を連結しての牽引走行でカーブを通過する際に、カーブ外側方向への逸脱に対してドライバの操舵意図に反する車線逸脱防止制御の介入を抑制し、安全を確保しながらドライバへの違和感を低減することができる。   According to the present invention, when passing a curve by towing traveling with a towed vehicle connected, the intervention of the lane departure prevention control that is contrary to the driver's steering intention with respect to the deviation to the outside of the curve is suppressed, and safety is ensured. It is possible to reduce a sense of incongruity to the driver while ensuring the above.

車両走行制御系の構成図Configuration diagram of vehicle travel control system トレーラ牽引時のカーブ内側寄りの走行状態を示す説明図Explanatory diagram showing the running state closer to the inside of the curve when towing the trailer トレーラ牽引時にカーブ外側への逸脱を許容した走行状態を示す説明図Explanatory drawing showing the running state that allows deviation to the outside of the curve when towing the trailer 車線逸脱防止制御装置の機能構成を示すブロック図Block diagram showing the functional configuration of the lane departure prevention control device カーブ進入速度閾値の特性例を示す説明図Explanatory diagram showing a characteristic example of the curve entry speed threshold 車線逸脱防止制御のフローチャートFlow chart of lane departure prevention control

以下、図面を参照して本発明の実施の形態を説明する。図1において、符号1は自動車等の車両であり、車体後部に被牽引車両(トレーラ)100を連結するためのヒッチ2を備えている。車両(自車両)1は、ヒッチ2のヒッチボール2aにトレーラ100のジョイント101を連結することにより、トレーラ100を牽引しながら走行することができる。   Embodiments of the present invention will be described below with reference to the drawings. In FIG. 1, reference numeral 1 denotes a vehicle such as an automobile, and includes a hitch 2 for connecting a towed vehicle (trailer) 100 to the rear part of the vehicle body. The vehicle (own vehicle) 1 can travel while towing the trailer 100 by connecting the joint 101 of the trailer 100 to the hitch ball 2 a of the hitch 2.

自車両1の走行は、複数の制御装置からなる走行制御系によって制御され、トレーラ100の牽引走行時においても、ドライバに対する運転支援を行う。車両1の走行制御系を構成する各制御装置はマイクロコンピュータを中心として構成され、主として、外部環境認識装置11、乗員状態検知装置12、ナビゲーション装置13、駆動制御装置14、操舵支援制御装置15が車内ネットワークを形成する通信バス50を介して双方向通信可能に接続されて構成されている。   The traveling of the host vehicle 1 is controlled by a traveling control system including a plurality of control devices, and performs driving support for the driver even when the trailer 100 is towed. Each control device constituting the travel control system of the vehicle 1 is configured with a microcomputer as a center, and mainly includes an external environment recognition device 11, an occupant state detection device 12, a navigation device 13, a drive control device 14, and a steering assist control device 15. A communication bus 50 forming an in-vehicle network is connected to be capable of bidirectional communication.

外部環境認識装置11は、カメラやレーダ装置等の自車両周囲の物体を検出する各種センサによる自車両周囲の物体の検出情報、路車間通信や車車間通信等のインフラ通信によって取得した交通情報、GPS衛星等からの信号に基づく自車両位置の測位情報、ナビゲーション装置13からの地図情報、例えば、道路の曲率、車線幅、路肩幅等の道路形状データや、道路方位角、車線を区画する区画線の種別、車線数等の走行制御用データを含む高精細の地図情報等により、自車両周囲の外部環境を認識する。   The external environment recognition device 11 includes detection information of objects around the vehicle by various sensors that detect objects around the vehicle such as cameras and radar devices, traffic information acquired by infrastructure communication such as road-to-vehicle communication and vehicle-to-vehicle communication, Positioning information of own vehicle position based on signals from GPS satellites, map information from navigation device 13, for example, road shape data such as road curvature, lane width, shoulder width, road azimuth, and sections that divide lanes The external environment around the host vehicle is recognized based on high-definition map information including travel control data such as line type and number of lanes.

本実施の形態においては、外部環境認識装置11は、車載のカメラによる画像認識処理を主として、ナビゲーション装置13からの地図情報や交通情報等を加えて自車両周囲の外部環境を認識する。この外部環境認識装置11による自車両外部の認識情報は、駆動制御装置14に送られ、経路に沿った自動走行や追従走行等の操舵制御や障害物との衝突防止のためのブレーキ制御用の制御データとして用いられる。   In the present embodiment, the external environment recognition device 11 recognizes the external environment around the vehicle by adding map information, traffic information, and the like from the navigation device 13 mainly by image recognition processing by a vehicle-mounted camera. The recognition information outside the host vehicle by the external environment recognition device 11 is sent to the drive control device 14 for steering control such as automatic traveling and follow-up traveling along the route, and brake control for preventing collision with an obstacle. Used as control data.

車載のカメラとして、自車両1には、車外の前方領域を撮像する前方カメラ3、自車両1の後方領域を撮像する後方カメラ4、ドライバの状態を撮像する車内カメラ5が搭載されている。前方カメラ3及び後方カメラ4で撮像した各画像は、外部環境認識装置11に送られて処理され、車内カメラ5で撮像した画像は、乗員状態検知装置12に送られて処理される。   As a vehicle-mounted camera, the host vehicle 1 is equipped with a front camera 3 that images a front region outside the vehicle, a rear camera 4 that images a rear region of the host vehicle 1, and an in-vehicle camera 5 that images a driver's state. Each image captured by the front camera 3 and the rear camera 4 is sent to the external environment recognition device 11 for processing, and an image captured by the in-vehicle camera 5 is sent to the occupant state detection device 12 for processing.

前方カメラ3は、本実施の形態においては、同一対象物を異なる視点から撮像する2台のカメラ3a,3bで構成されるステレオカメラである(以下では、前方カメラ3は、適宜、ステレオカメラ3と記載する場合がある)。ステレオカメラ3を構成する2台のカメラ3a,3bは、CCDやCMOS等の撮像素子を有するシャッタ同期のカメラであり、例えば、車室内上部のフロントウィンドウ内側のルームミラー近傍に、所定の基線長で固定されて配置されている。   In the present embodiment, the front camera 3 is a stereo camera composed of two cameras 3a and 3b that capture the same object from different viewpoints (hereinafter, the front camera 3 is appropriately selected as the stereo camera 3). May be described). The two cameras 3a and 3b constituting the stereo camera 3 are shutter-synchronized cameras having an image sensor such as a CCD or a CMOS. For example, a predetermined baseline length is provided in the vicinity of a room mirror inside the front window in the upper part of the vehicle interior. It is fixed and arranged with.

外部環境認識装置11は、ステレオカメラ3で撮像した自車両1の進行方向の1組のステレオ画像対に対し、ステレオマッチング処理により、左右画像の対応位置の画素ずれ量(視差)を求め、画素ずれ量を輝度データ等に変換して距離画像を生成する。距離画像上の点は、三角測量の原理から、自車両1の車幅方向すなわち左右方向をX軸、車高方向をY軸、車長方向すなわち距離方向をZ軸とする実空間上の点に座標変換され、自車両1が走行する車線を形成する左右の区画線として白線、道路側方のガードレールや側壁等の障害物、自車両1の前方を走行する先行車両等が3次元的に認識される。   The external environment recognition device 11 obtains a pixel shift amount (parallax) between corresponding positions of the left and right images by stereo matching processing for a pair of stereo images in the traveling direction of the host vehicle 1 captured by the stereo camera 3, A distance image is generated by converting the shift amount into luminance data or the like. The point on the distance image is a point in the real space in which the vehicle width direction of the own vehicle 1, that is, the left-right direction is the X axis, the vehicle height direction is the Y axis, and the vehicle length direction, that is, the distance direction is the Z axis, based on the principle of triangulation. As a left and right dividing line that forms a lane in which the host vehicle 1 travels, white lines, obstacles such as guardrails and side walls on the side of the road, a preceding vehicle that travels in front of the host vehicle 1, and the like are three-dimensionally displayed. Be recognized.

車線を形成する区画線としての白線は、画像から白線の候補となる点群を抽出し、その候補点を結ぶ直線や曲線を算出することにより、認識することができる。例えば、画像上に設定された白線検出領域内において、水平方向(車幅方向)に設定した複数の探索ライン上で輝度が所定以上変化するエッジの検出を行って探索ライン毎に1組の白線開始点及び白線終了点を検出し、白線開始点と白線終了点との間の中間の領域を白線候補点として抽出する。   A white line as a lane marking forming a lane can be recognized by extracting a point group that is a candidate for a white line from an image and calculating a straight line or a curve connecting the candidate points. For example, in a white line detection region set on an image, an edge whose luminance changes more than a predetermined value is detected on a plurality of search lines set in the horizontal direction (vehicle width direction), and one set of white lines is set for each search line. A start point and a white line end point are detected, and an intermediate region between the white line start point and the white line end point is extracted as a white line candidate point.

そして、単位時間当たりの車両移動量に基づく白線候補点の空間座標位置の時系列データを処理して左右の白線を近似するモデルを算出し、このモデルにより、白線を認識する。白線の近似モデルとしては、ハフ変換によって求めた直線成分を連結した近似モデルや、2次式等の曲線で近似したモデルを用いることができる。   Then, the time series data of the spatial coordinate position of the white line candidate point based on the vehicle movement amount per unit time is processed to calculate a model that approximates the left and right white lines, and the white line is recognized by this model. As an approximate model of the white line, an approximate model obtained by connecting linear components obtained by the Hough transform, or a model approximated by a curve such as a quadratic equation can be used.

例えば、白線を2次曲線で近似する場合、白線候補点のデータ点群に対して最小二乗法を適用して、以下の(1)式で示すような2次曲線で白線を表すことができる。ここでは、左右の白線を代表して(1)式で示すが、詳細には、(1)式中の係数A,B,Cを、左右の白線のそれぞれに対して求める。
X=A・Z2+B・Z+C …(1)
For example, when a white line is approximated by a quadratic curve, the least square method is applied to the data point group of white line candidate points, and the white line can be represented by a quadratic curve as shown in the following equation (1). . Here, the left and right white lines are represented by the expression (1), but in detail, the coefficients A, B, and C in the expression (1) are obtained for each of the left and right white lines.
X = A · Z 2 + B · Z + C (1)

(1)式の係数A,B,Cは、白線によって形成される車線の経路成分を表している。係数Aは車線の曲率成分を表し、係数Bは自車両1に対する車線のヨー角成分(自車両1の前後方向軸と車線の接線との間の角度成分)、係数Cは自車両1に対する車線の横方向(X軸方向)の位置成分(横位置成分)を表している。   Coefficients A, B, and C in equation (1) represent lane path components formed by white lines. The coefficient A represents the curvature component of the lane, the coefficient B represents the yaw angle component of the lane with respect to the own vehicle 1 (the angle component between the longitudinal axis of the own vehicle 1 and the tangent to the lane), and the coefficient C represents the lane with respect to the own vehicle 1. Represents the position component (lateral position component) in the horizontal direction (X-axis direction).

尚、本実施の形態においては、車線を形成する区画線として道路の白線を画像認識する例をついて説明するが、区画線は、白線に限定されることなく、地図データから取得した車線情報や自車両1の位置情報等に基づいて設定されるラインとしても良い。   In this embodiment, an example of recognizing a white line of a road as a lane line forming a lane will be described. However, the lane line is not limited to a white line, and lane information acquired from map data or A line set based on position information of the host vehicle 1 may be used.

乗員状態検知装置12は、車内カメラ5で撮像したドライバの画像から、運転中のドライバの状態を検知し、ドライバ状態が正常か否かを判断する。例えば、車内カメラ5の撮像画像からドライバの視線挙動の変化や瞳孔面積の変化を検出し、これらの変化に基づいてドライバが覚醒状態にあるか否かを判断する。   The occupant state detection device 12 detects the state of the driving driver from the image of the driver imaged by the in-vehicle camera 5, and determines whether or not the driver state is normal. For example, a change in the driver's line-of-sight behavior or a change in pupil area is detected from the captured image of the in-vehicle camera 5, and based on these changes, it is determined whether or not the driver is awake.

例えば、ドライバの視線挙動を検出してドライバ状態を判断する場合、角膜上の虚像が眼球運動によって平行移動するのを、瞳孔中心を基準として検出する。そして、前方カメラ3で検出した先行車両等に対するドライバの視線挙動のばらつきを評価し、ドライバが覚醒状態にあるか否かを判断する。   For example, when the driver's line-of-sight behavior is detected to determine the driver state, the virtual image on the cornea is detected as a reference based on the pupil center as the eye moves. Then, the variation in the driver's line-of-sight behavior with respect to the preceding vehicle or the like detected by the front camera 3 is evaluated to determine whether or not the driver is awake.

また、ドライバの瞳孔面積の変化からドライバ状態を判断する場合には、車内カメラ5の撮像画像におけるドライバの瞳孔面積の減少率を算出する。そして、所定時間内で瞳孔面積の減少率が閾値を上回った時間が一定以上となった場合、ドライバの覚醒度が低下していると判断する。   When determining the driver state from the change in the pupil area of the driver, the reduction rate of the pupil area of the driver in the captured image of the in-vehicle camera 5 is calculated. Then, when the time during which the reduction rate of the pupil area exceeds the threshold within a predetermined time becomes equal to or greater than a certain value, it is determined that the driver's arousal level has decreased.

ナビゲーション装置13は、地図データベース13aを備え、GPS衛星等の複数の航法衛星からの信号や車載センサ(ジャイロセンサや車速センサ等)からの信号に基づいて自車両1の位置を測位し、地図データベース13aと照合する。そして、地図上の位置情報、及び路車間通信や車車間通信等のインフラ通信によって取得した交通情報に基づいて、走行経路案内や交通情報を表示装置(図示省略)に表示してドライバに提示する。   The navigation device 13 includes a map database 13a, and measures the position of the host vehicle 1 based on signals from a plurality of navigation satellites such as GPS satellites and signals from in-vehicle sensors (gyro sensors, vehicle speed sensors, etc.). Match with 13a. And based on the positional information on a map and the traffic information acquired by infrastructure communication, such as road-to-vehicle communication and vehicle-to-vehicle communication, driving route guidance and traffic information are displayed on a display device (not shown) and presented to the driver. .

また、地図データベース13aには、ドライバに対する経路案内や車両の現在位置を表示する際に参照されるナビゲーション用の地図データに加え、自動運転を含む運転支援制御を行う際に参照される走行制御用の高精細の地図データが格納されている。   In addition to the map data for navigation that is referred to when displaying the route guidance for the driver and the current position of the vehicle, the map database 13a is used for driving control that is referred to when performing driving support control including automatic driving. High-definition map data is stored.

ナビゲーション用の地図データは、現在のノードに対して前のノードと次のノードとがそれぞれリンクを介して結びつけられており、各リンクには、道路に設置された信号機、道路標識、建築物等に関する情報が保存されている。   In the map data for navigation, the previous node and the next node are linked to the current node through links, and each link has traffic lights, road signs, buildings, etc. Information about is stored.

一方、走行制御用の高精細の地図データは、ノードと次のノードとの間に、複数のデータ点を有している。このデータ点には、自車両1が走行する道路の曲率、車線幅、路肩幅等の道路形状データや、道路方位角、道路の白線の種別、レーン数等の走行制御用データが、データの信頼度やデータ更新の日付け等の属性データと共に保持されている。   On the other hand, high-definition map data for traveling control has a plurality of data points between a node and the next node. The data points include road shape data such as the curvature, lane width, and shoulder width of the road on which the vehicle 1 is traveling, and data for driving control such as road azimuth, road white line type, and number of lanes. It is held together with attribute data such as reliability and date of data update.

駆動制御装置14は、各種センサ類からの信号及び通信バス50を介して送信される各種制御情報に基づいて、エンジン、自動変速機、ブレーキ装置等を制御する。尚、ここでの駆動制御装置14は、エンジン、自動変速機、ブレーキ装置を個別に制御する装置群を総称するものとする。   The drive control device 14 controls the engine, the automatic transmission, the brake device, and the like based on signals from various sensors and various control information transmitted via the communication bus 50. Here, the drive control device 14 is a generic term for a group of devices that individually control the engine, the automatic transmission, and the brake device.

エンジン制御としては、例えば、吸入空気量、スロットル開度、エンジン水温、吸気温度、空燃比、クランク角、アクセル開度、その他の車両情報に基づき、燃料噴射制御、点火時期制御、電子制御スロットル弁の開度制御等の制御を主要として実行する。   Engine control includes, for example, fuel injection control, ignition timing control, electronic control throttle valve based on intake air amount, throttle opening, engine water temperature, intake air temperature, air-fuel ratio, crank angle, accelerator opening, and other vehicle information. The control such as the opening degree control is executed mainly.

また、変速機制御として、変速位置や車速等を検出するセンサ類からの信号や通信バス50を介して送信される各種制御情報に基いて、自動変速機に供給する油圧を制御し、予め設定された変速特性に従って自動変速機を制御する。   As transmission control, the hydraulic pressure supplied to the automatic transmission is controlled in advance based on signals from sensors for detecting the shift position, vehicle speed, etc. and various control information transmitted via the communication bus 50. The automatic transmission is controlled in accordance with the changed transmission characteristics.

また、ブレーキ制御として、例えば、ブレーキスイッチ、4輪の車輪速、ハンドル角、ヨーレート、その他の車両情報に基づき、4輪のブレーキ装置(図示せず)をドライバのブレーキ操作とは独立して制御する。更に、各輪のブレーキ力に基づいて各輪のブレーキ液圧を算出して、アンチロック・ブレーキ制御や横すべり防止制御等を行う。   Also, as the brake control, for example, a four-wheel brake device (not shown) is controlled independently of the driver's brake operation based on the brake switch, four-wheel wheel speed, steering wheel angle, yaw rate, and other vehicle information. To do. Further, the brake fluid pressure of each wheel is calculated based on the brake force of each wheel, and antilock / brake control, side slip prevention control, and the like are performed.

操舵支援制御装置15は、自車両1の自動運転やドライバの運転を支援する運転支援制御を実行する。例えば、外部環境の認識結果から自車両1が走行する目標コースを設定し、この目標コースに追従して走行するよう操舵制御し、ドライバの操舵操作をアシストするアシストトルク、更には自動走行の操舵トルクを、電動パワーステアリング(EPS;Electric Power Steering)装置30を介して出力する。   The steering assistance control device 15 executes driving assistance control for assisting automatic driving of the host vehicle 1 and driving of the driver. For example, a target course on which the vehicle 1 travels is set based on the recognition result of the external environment, steering control is performed so as to travel following the target course, assist torque for assisting the steering operation of the driver, and further automatic steering Torque is output via an electric power steering (EPS) device 30.

尚、EPS装置30は、ラックアンドピニオン式等の操舵機構に連設される電動モータと、この電動モータを駆動制御する制御部を有する周知の装置であり、その詳細な説明は省略する。   Note that the EPS device 30 is a well-known device having an electric motor connected to a steering mechanism such as a rack and pinion type and a control unit that drives and controls the electric motor, and detailed description thereof is omitted.

操舵支援制御装置15の操舵制御における目標コースは、外部環境認識装置11による外部環境の認識結果に基づいて設定される。例えば、自車両1を車線中央に維持する車線維持制御では、自車両1の左右の白線の幅方向の中央位置が目標コースとして設定される。   The target course in the steering control of the steering assist control device 15 is set based on the recognition result of the external environment by the external environment recognition device 11. For example, in the lane keeping control for keeping the host vehicle 1 at the center of the lane, the center position in the width direction of the left and right white lines of the host vehicle 1 is set as the target course.

操舵支援制御装置15は、自車両1の車幅方向の中心位置を目標コースに一致させる目標操舵角を設定し、操舵制御の舵角が目標操舵角となるよう、EPS装置30のモータ駆動電流を制御する。尚、目標コースは、操舵支援制御装置15ではなく、外部環境認識装置11等の他の制御装置で設定するようにしても良い。   The steering assist control device 15 sets a target steering angle that matches the center position in the vehicle width direction of the host vehicle 1 with the target course, and the motor drive current of the EPS device 30 is set so that the steering angle of the steering control becomes the target steering angle. To control. The target course may be set not by the steering assist control device 15 but by another control device such as the external environment recognition device 11.

また、操舵支援制御装置15は、自車両1を車線中央に維持する車線維持制御に加えて、自車両1の車線から逸脱を防止する車線逸脱防止制御を実行する。具体的には、操舵支援制御装置15は、外部環境認識装置11からの情報及び自車両1の運転状態に基づいて、自車両1の進行方向が車線を形成する左右の区画線(左右の白線)の一方に対して逸脱方向を向いている場合、自車両1が逸脱方向の区画線(白線)を跨ぐまでの車線逸脱推定時間Ttlcを算出し、車線逸脱推定時間Ttlcが自車両1の車速Vと車線の曲率κとによって決定される閾値以下の場合、車線逸脱防止制御を開始する。   In addition to the lane keeping control for keeping the host vehicle 1 at the center of the lane, the steering assist control device 15 executes lane departure prevention control for preventing a departure from the lane of the host vehicle 1. Specifically, the steering assist control device 15 is based on the information from the external environment recognition device 11 and the driving state of the host vehicle 1, and the left and right dividing lines (left and right white lines) in which the traveling direction of the host vehicle 1 forms a lane. ), The estimated lane departure time Ttlc until the host vehicle 1 crosses the lane marking (white line) in the departure direction is calculated, and the estimated lane departure time Ttlc is the vehicle speed of the host vehicle 1. When the value is equal to or less than the threshold value determined by V and the curvature κ of the lane, the lane departure prevention control is started.

ここで、自車両1の後部にトレーラ100を連結しての牽引走行でカーブを通過する場合には、ドライバが意図的に自車両1をカーブ外側にはみ出させて大回りするように操舵する場合が想定される。従って、操舵支援制御装置15は、カーブ内側方向とカーブ外側方向とで車線逸脱防止制御の介入形態を変更することで、安全を確保しながらドライバへの違和感を低減する。   Here, in the case of passing the curve by towing traveling with the trailer 100 connected to the rear portion of the host vehicle 1, the driver may intentionally steer the host vehicle 1 so as to go out of the curve and make a large turn. is assumed. Therefore, the steering assist control device 15 reduces the sense of discomfort to the driver while ensuring safety by changing the intervention mode of the lane departure prevention control between the curve inner direction and the curve outer direction.

すなわち、図2に示すように、自車両1がカーブの内側となる区画線Linから逸脱する虞がある場合、操舵支援制御装置15は、従来と同様、車線逸脱防止制御を介入させて、車線からの逸脱を防止する。一方、図3に示すように、カーブの外側となる区画線Loutに対しては、操舵支援制御装置15は、区画線Loutから逸脱する虞がある場合であっても、状況に応じて区画線Loutからの自車両1の逸脱を所定の範囲内で許容する。   That is, as shown in FIG. 2, when there is a possibility that the host vehicle 1 may deviate from the lane marking Lin that is inside the curve, the steering assist control device 15 intervenes the lane departure prevention control as in the conventional case, and the lane To prevent deviations from On the other hand, as shown in FIG. 3, for the lane line Lout that is outside the curve, the steering assist control device 15 may diverge from the lane line Lout depending on the situation even when there is a risk of deviating from the lane line Lout. Deviation of the vehicle 1 from Lout is allowed within a predetermined range.

このため、操舵支援制御装置15は、図4に示すように、車線からの逸脱を防止する通常の車線逸脱防止制御を実行する車線逸脱防止制御部16に対して、牽引走行時の状況に応じてカーブの外側となる区画線からの逸脱を許容するための機能部を備えている。具体的は、操舵支援制御装置15は、通常の車線逸脱防止制御部16に加えて、牽引走行判断部17、カーブ進入状態判断部18、カーブ外側逸脱判断部19、逸脱許容量算出部20、車線逸脱許容指示部21を備えている。   For this reason, as shown in FIG. 4, the steering assist control device 15 responds to the lane departure prevention control unit 16 that executes normal lane departure prevention control for preventing departure from the lane according to the situation during towing. And a functional unit for allowing deviation from the lane marking that is outside the curve. Specifically, in addition to the normal lane departure prevention control unit 16, the steering assist control device 15 includes a tow travel determination unit 17, a curve approach state determination unit 18, a curve outer departure determination unit 19, a deviation allowable amount calculation unit 20, A lane departure allowance instruction unit 21 is provided.

詳細には、車線逸脱防止制御部16は、車線からの逸脱を防止するための目標旋回量となる目標ヨーレートγtgtを算出する。この目標ヨーレートγtgtは、以下の(2)式に示すように、自車両1に車線逸脱抑制の挙動を発生させるヨーレートγturnと、車線の曲率に応じたヨーレートγlaneとを加算して算出される。
γtgt=γturn+γlane …(2)
Specifically, the lane departure prevention control unit 16 calculates a target yaw rate γtgt that is a target turning amount for preventing departure from the lane. The target yaw rate γtgt is calculated by adding the yaw rate γturn that causes the host vehicle 1 to suppress the lane departure and the yaw rate γlane according to the curvature of the lane, as shown in the following equation (2).
γtgt = γturn + γlane (2)

(2)式において、車線逸脱抑制の挙動を発生させるヨーレートγturnは、例えば、以下の(3)式に示すように、自車両1の車線に対するヨー角(対車線ヨー角)θyawと、前述した車線逸脱推定時間Ttlcとに基づいて算出することができる。
γturn=θyaw/Ttlc …(3)
In the equation (2), the yaw rate γturn that causes the behavior of suppressing the lane departure is, for example, the yaw angle (to the lane yaw angle) θyaw with respect to the lane of the host vehicle 1 as described in the following equation (3), It can be calculated based on the lane departure estimated time Ttlc.
γturn = θyaw / Ttlc (3)

また、車線の曲率に応じたヨーレートγlaneは、例えば、以下の(4)式に示すように、車速センサ6で検出した自車両1の車速Vと、外部環境認識装置11で取得した車線の曲率κとに基づいて算出することができる。
γlane=κ・V …(4)
The yaw rate γlane corresponding to the curvature of the lane is, for example, the vehicle speed V of the host vehicle 1 detected by the vehicle speed sensor 6 and the curvature of the lane acquired by the external environment recognition device 11 as shown in the following equation (4). It can be calculated based on κ.
γlane = κ · V (4)

更に、車線逸脱防止制御部16は、目標ヨーレートγtgtを実現するための目標操舵トルクTtgtを算出し、EPS装置30に対する指示トルクとして出力する。EPS装置30は、操舵機構から出力される操舵トルクが目標操舵トルクTtgtとなるよう、電動モータの駆動電流を制御する。   Further, the lane departure prevention control unit 16 calculates a target steering torque Ttgt for realizing the target yaw rate γtgt, and outputs the target steering torque Ttgt as an instruction torque for the EPS device 30. The EPS device 30 controls the drive current of the electric motor so that the steering torque output from the steering mechanism becomes the target steering torque Ttgt.

目標操舵トルクTtgtは、例えば、以下の(5)式に示すように、目標ヨーレートγtgtとヨーレートセンサ7によって検出した自車両1の実ヨーレートγとの偏差に基づくフィードバックトルクTfbと、車速V及び車線の曲率κに基づくヨーレートγlaneを所定の変換ゲインでトルク変換したフィードフォワードトルクTffとを加算して算出される。
Ttgt=Tfb+Tff …(5)
The target steering torque Ttgt is, for example, a feedback torque Tfb based on a deviation between the target yaw rate γtgt and the actual yaw rate γ of the host vehicle 1 detected by the yaw rate sensor 7, vehicle speed V and lane, as shown in the following equation (5): The feedforward torque Tff obtained by torque-converting the yaw rate γlane based on the curvature κ of the current with a predetermined conversion gain is added.
Ttgt = Tfb + Tff (5)

牽引走行判断部17は、後方カメラ4で撮像した自車両1の後方の画像に基づいて、自車両1の後部にトレーラ100が連結されているか否かを検知し、トレーラ100が連結された状態で走行しているか否かを判断する。例えば、後方カメラ4によって撮像された画像中に所定以上の大きさの物体の存在が認識され、且つ、自車両1の走行中に画像中の物体の領域が操舵角に対して所定以上に変化しない場合、自車両1の後部にトレーラ100を連結して牽引走行していると判断することができる。   The tow travel determination unit 17 detects whether the trailer 100 is connected to the rear part of the host vehicle 1 based on the rear image of the host vehicle 1 captured by the rear camera 4, and the trailer 100 is connected. Judge whether or not you are driving. For example, the presence of an object larger than a predetermined size is recognized in the image captured by the rear camera 4, and the area of the object in the image changes more than a predetermined value with respect to the steering angle while the host vehicle 1 is traveling. If not, it can be determined that the trailer 100 is connected to the rear portion of the host vehicle 1 and the vehicle is towing.

尚、牽引走行判断部17の機能は、操舵支援制御装置15に設けることなく、外部環境認識装置11に設けるようにしても良い。   Note that the function of the tow travel determination unit 17 may be provided in the external environment recognition device 11 without being provided in the steering assist control device 15.

この場合、例えば、ヒッチ2にトレーラ100のジョイント101が連結されたときにオンする電気的なスイッチを設け、このスイッチのオンオフによってトレーラ100の連結を検知するようにしても良いが、機械的な連結機構により、連結可能なトレーラが限定される場合がある。本実施の形態においては、後方カメラ4の画像によってトレーラ100の連結を検知するため、連結するトレーラ側の制約を小さくすることができる。   In this case, for example, an electrical switch that is turned on when the joint 101 of the trailer 100 is connected to the hitch 2 may be provided, and the connection of the trailer 100 may be detected by turning on or off the switch. The trailer that can be coupled may be limited by the coupling mechanism. In the present embodiment, since the connection of the trailer 100 is detected from the image of the rear camera 4, the restriction on the trailer side to be connected can be reduced.

カーブ進入状態判断部18は、自車両1を運転するドライバの状態、カーブ進入前の車速、ドライバのブレーキ操作状態を調べ、牽引走行時の自車両1のカーブ進入状態が安全か否かを判断する。乗員状態検知装置12によって検知されたドライバの状態が正常でない場合、自車両1が安全にカーブを走行できないと判断して、車線逸脱防止制御部16に通知して車線逸脱に備えると共に、駆動制御装置14を介した退避制御に移行する。   The curve approach state determination unit 18 examines the state of the driver driving the host vehicle 1, the vehicle speed before entering the curve, and the brake operation state of the driver, and determines whether the curve approach state of the host vehicle 1 during towing is safe. To do. When the driver's state detected by the occupant state detection device 12 is not normal, it is determined that the host vehicle 1 cannot safely travel the curve, and notifies the lane departure prevention control unit 16 to prepare for lane departure and drive control. The process shifts to evacuation control via the device 14.

乗員状態検知装置12によって検知されたドライバの状態が正常である場合には、少なくともカーブ進入前の自車両1の車速(カーブ進入前速度)Vが、安全にカーブを走行できる閾値(カーブ進入速度閾値)Vsafe以下か否かにより、自車両1のカーブへの進入状態が安全か否かを判断する。カーブ進入前速度Vがカーブ進入速度閾値Vsafe以下の場合、自車両1のカーブ進入状態が安全であり、安全にカーブを走行できると判断する。   When the state of the driver detected by the occupant state detection device 12 is normal, at least a threshold (curve entry speed) at which the vehicle speed (speed before entering the curve) V of the host vehicle 1 before entering the curve can safely travel on the curve. It is determined whether or not the approach state of the host vehicle 1 to the curve is safe depending on whether or not the threshold value is Vsafe or less. When the curve entry speed V is equal to or less than the curve entry speed threshold Vsafe, it is determined that the vehicle 1 is in a curve entry state and the curve can be traveled safely.

一方、カーブ進入前速度Vがカーブ進入速度閾値Vsafeを超えている場合には、更に、ドライバが確実にブレーキを操作して自車両1の車速Vをカーブ進入速度閾値Vsafe以下とする減速度が発生しているか否かを調べる。そして、ブレーキ操作によってカーブ進入前速度Vをカーブ進入速度閾値Vsafe以下とする減速度が発生している場合、自車両1が安全にカーブを走行できると判断する。   On the other hand, if the speed V before the curve entry exceeds the curve entry speed threshold value Vsafe, the driver further operates the brake to make the vehicle speed V of the host vehicle 1 less than the curve entry speed threshold value Vsafe. Check if it has occurred. Then, when deceleration that causes the pre-curve entry speed V to be equal to or lower than the curve entry speed threshold Vsafe is generated by the brake operation, it is determined that the host vehicle 1 can travel on the curve safely.

カーブ進入速度閾値Vsafeは、曲率κのカーブを安全に走行できる速度の上限を定めるものである。例えば、車速Vでの曲率半径R(R=1/κ)の定常円旋回を想定し、以下の(6)式における横加速度Acを道路設計上の安全値(定数)とした場合、カーブ進入速度閾値Vsafeは、曲率κに対して、図5に示すような特性となる。
1/R=Ac×(1/V2) …(6)
The curve approach speed threshold value Vsafe defines an upper limit of the speed at which the curve κ can be safely traveled. For example, assuming a steady circular turn with a curvature radius R (R = 1 / κ) at a vehicle speed V, and the lateral acceleration Ac in the following equation (6) is a safety value (constant) in road design, a curve approach The speed threshold value Vsafe has a characteristic as shown in FIG. 5 with respect to the curvature κ.
1 / R = Ac × (1 / V 2 ) (6)

カーブ外側逸脱判断部19は、牽引走行時に自車両1がカーブの外側となる区画線を逸脱するか否かを判断する。前述したように、自車両1が車線(区画線)を逸脱するか否かは、車線逸脱推定時間Ttlcによって判断することができ、自車両1の進行方向がカーブの外側となる区画線に対して逸脱方向を向いており、車線逸脱推定時間Ttlcが閾値以下となる場合、自車両1がカーブの外側となる区画線を逸脱すると判断する。   The curve outside departure determination unit 19 determines whether or not the host vehicle 1 departs from a lane marking that is outside the curve during towing. As described above, whether or not the own vehicle 1 departs from the lane (lane line) can be determined by the lane departure estimation time Ttlc, with respect to the lane line whose traveling direction is outside the curve. If the lane departure estimated time Ttlc is less than or equal to the threshold value, it is determined that the host vehicle 1 departs from the lane marking that is outside the curve.

逸脱許容量算出部20は、ドライバの意図的な大回りの操舵操作による自車両1のカーブの外側となる区画線からの逸脱に対して、自車両1の逸脱量の許容限界を規定する逸脱許容量Xoverを算出する。逸脱許容量Xoverは、カーブの外側となる区画線から車幅方向に一定の距離だけ離れた値(例えば、逸脱側の白線から3m程度)としても良く、カーブの曲率と自車両1及びトレーラ100を含めた連結車両の全長との少なくとも一方に基づいて算出するようにしても良い。   The deviation allowance calculation unit 20 defines a deviation allowance that defines an allowable limit of the deviation amount of the host vehicle 1 with respect to a departure from a lane line that is outside the curve of the host vehicle 1 due to the intentional steering operation of the driver. The capacity Xover is calculated. The deviation allowable amount Xover may be a value separated from the lane marking on the outside of the curve by a certain distance in the vehicle width direction (for example, about 3 m from the white line on the deviation side), the curvature of the curve, the vehicle 1 and the trailer 100. May be calculated based on at least one of the total length of the connected vehicles including

カーブの曲率や連結車両の全長によって逸脱許容量を算出する場合、カーブの曲率が大きくなるほど、逸脱許容量を大きくし、連結車両の全長が長くなるほど、逸脱許容量を大きくする。連結車両の全長は、自車両1の既知の全長とユーザの入力等によるトレーラ100の全長とに基づいて取得する。   When the deviation allowance is calculated based on the curvature of the curve and the total length of the connected vehicle, the deviation allowance is increased as the curvature of the curve is increased, and the allowance is increased as the total length of the connected vehicle is increased. The total length of the connected vehicle is acquired based on the known total length of the host vehicle 1 and the total length of the trailer 100 by user input or the like.

但し、カーブ外側の逸脱先にガードレールや側壁等が存在する場合、或いは、カーブの外側となる区画線に隣接して更に車線が設けられており、その隣接車線が自車両1に対向して走行する他車両の対向車線である場合には、Xover=0として逸脱を許容しない。   However, if there are guardrails, side walls, etc. on the outside of the curve, or there is a further lane adjacent to the lane marking on the outside of the curve, the adjacent lane faces the host vehicle 1 and travels. If the vehicle is in the opposite lane of another vehicle, Xover = 0 and no deviation is allowed.

車線逸脱許容指示部21は、自車両1のカーブ進入状態が安全と判断され、且つ自車両1がカーブの外側となる区画車線を逸脱すると判断された場合、車線逸脱防止制御部16に、自車両1のカーブの外側となる区画線からの逸脱を、逸脱許容量Xoverまで許容して車線逸脱防止制御を実行するよう指示する。   The lane departure allowance instruction unit 21 instructs the lane departure prevention control unit 16 when the vehicle 1 is determined to be safe and the vehicle 1 departs from a lane that is outside the curve. An instruction is given to execute the lane departure prevention control while allowing the departure from the lane marking on the outside of the curve of the vehicle 1 to the allowable departure amount Xover.

所定範囲の逸脱を許容する車線逸脱防止制御は、例えば、自車両1に車線逸脱抑制の挙動を発生させるヨーレートγturnに対して、(3)式中の車線逸脱推定時間Ttlcを修正することで実現することができる。例えば、逸脱許容量Xoverと車速Vに基づいて修正係数を設定し、この修正係数を車線逸脱推定時間Ttlcに乗算することにより、逸脱を許容する場合の車線逸脱推定時間を修正することができる。これは、換言すれば、道路の白線に対して、白線の横位置を逸脱許容量Xoverだけオフセットさせた区画線を設定し、このオフセットさせた区画線に対して車線逸脱防止制御を行うこととも言える。   Lane departure prevention control that allows departure of a predetermined range is realized, for example, by correcting the estimated lane departure time Ttlc in equation (3) for the yaw rate γturn that causes the lane departure suppression behavior of the host vehicle 1 can do. For example, by setting a correction coefficient based on the deviation allowable amount Xover and the vehicle speed V and multiplying the correction coefficient by the lane departure estimated time Ttlc, the lane departure estimated time when the deviation is allowed can be corrected. In other words, a lane line in which the lateral position of the white line is offset by the deviation allowance Xover is set with respect to the white line of the road, and lane departure prevention control is performed on the offset lane line. I can say that.

次に、操舵支援制御装置15における車線逸脱防止制御について、図6のフローチャートを用いて説明する。   Next, the lane departure prevention control in the steering assist control device 15 will be described with reference to the flowchart of FIG.

この車線逸脱防止制御では、最初のステップS1において、操舵支援制御装置15は、後方カメラ4で撮像した画像に基づいて、被牽引車両(トレーラ100)の有無を検知し、ステップS12でトレーラ100を連結しての牽引走行中か否かを判断する。   In this lane departure prevention control, in the first step S1, the steering assist control device 15 detects the presence / absence of a towed vehicle (trailer 100) based on the image captured by the rear camera 4, and the trailer 100 is turned off in step S12. It is determined whether or not the tow traveling is connected.

トレーラ100を連結せずに自車両1単独での走行中である場合、ステップS2からステップS12に進む。ステップS12では、操舵支援制御装置15は、自車両1が車線を逸脱するか否かを判断し、車線を逸脱すると判断される場合、逸脱側の車線に対する通常の車線逸脱防止制御を実行する。   When the vehicle 1 is traveling alone without connecting the trailer 100, the process proceeds from step S2 to step S12. In step S12, the steering assist control device 15 determines whether or not the host vehicle 1 departs from the lane, and when it is determined to deviate from the lane, the steering assist control device 15 executes normal lane departure prevention control for the lane on the departure side.

一方、トレーラ100を連結しての牽引走行中である場合には、ステップS2からステップS3へ進み、操舵支援制御装置15は、自車両1の進行路(自車両1が走行する車線)の曲率κを取得する。本実施の形態においては、進行路の曲率κは、車線を形成する左右の区画線(白線)の各々に対して取得する。白線を前述の(1)式によって近似する場合、左右それぞれの白線の曲率は、(1)式における2次曲線の係数Aに基づいて求めることができる。   On the other hand, if the trailer 100 is connected and the vehicle is towing, the process proceeds from step S2 to step S3, and the steering assist control device 15 calculates the curvature of the traveling path of the host vehicle 1 (the lane in which the host vehicle 1 travels). Get κ. In the present embodiment, the curvature κ of the traveling path is acquired for each of the left and right dividing lines (white lines) forming the lane. When the white line is approximated by the above-described equation (1), the curvature of each of the left and right white lines can be obtained based on the coefficient A of the quadratic curve in the equation (1).

尚、地図データベース13aに高精細の地図データを保有している場合には、地図データベース13aから自車両1の現在位置の道路の曲率と車線幅を読み込み、左右それぞれの区画線の曲率を求めるようにしても良い。   When high-definition map data is held in the map database 13a, the curvature and lane width of the road at the current position of the host vehicle 1 are read from the map database 13a, and the curvatures of the left and right lane markings are obtained. Anyway.

その後、ステップS3からステップS4へ進み、ステップS3で取得した曲率κが閾値κs以上か否かを調べる。閾値κsは、進行路が曲線路であるか否かを判断するための閾値であり、例えば曲率半径150m程度以下を曲線路として想定している。   Thereafter, the process proceeds from step S3 to step S4, and it is checked whether or not the curvature κ acquired in step S3 is equal to or greater than the threshold value κs. The threshold value κs is a threshold value for determining whether or not the traveling path is a curved path. For example, a curvature radius of about 150 m or less is assumed as the curved path.

ステップS4で曲率κが閾値κs未満で直線路と判断される場合、ステップS4からステップS12へ進み、通常の車線逸脱防止制御を実行可能とする。一方、ステップS4で曲率κが閾値κs以上で曲線路と判断される場合には、ステップS4からステップS5へ進み、操舵支援制御装置15は、乗員状態検知装置12からの情報に基づいてドライバ状態が正常か否かを調べる。   When it is determined in step S4 that the curvature κ is less than the threshold κs and the road is a straight road, the process proceeds from step S4 to step S12, and normal lane departure prevention control can be executed. On the other hand, if it is determined in step S4 that the curvature κ is equal to or greater than the threshold κs and the road is a curved road, the process proceeds from step S4 to step S5, and the steering assist control device 15 determines the driver state based on information from the occupant state detection device 12. Check if is normal.

乗員状態検知装置12によってドライバに何らかの異常が検知されており、ドライバ状態が正常でない場合には、ステップS5から前述のステップS12へ進み、車線逸脱に備えて通常の車線逸脱防止制御を実行可能状態とする。一方、ドライバ状態が正常の場合には、ステップS5からステップS6へ進む。   If any abnormality is detected in the driver by the occupant state detection device 12 and the driver state is not normal, the process proceeds from step S5 to step S12 described above, and normal lane departure prevention control can be executed in preparation for lane departure. And On the other hand, if the driver state is normal, the process proceeds from step S5 to step S6.

ステップS6では、自車両1のカーブ進入前速度Vが安全にカーブを走行できる閾値であるカーブ進入速度閾値Vsafe以下か否かを調べる。そして、V>Vsafeの場合、ステップS6からステップS7へ進み、自車両1のカーブ進入前の減速状態(カーブ前減速状態)が予め設定した減速条件を満足するか否かを調べる。カーブ前減速状態が減速条件を満足しない場合には、ステップS7からステップS12へ進んで、通常の車線逸脱防止制御を実行可能状態とする。   In step S6, it is checked whether or not the speed V before entering the curve of the host vehicle 1 is equal to or lower than a curve entry speed threshold Vsafe that is a threshold at which the vehicle can safely travel on the curve. When V> Vsafe, the process proceeds from step S6 to step S7, and it is checked whether or not the deceleration state before the vehicle enters the vehicle 1 (pre-curve deceleration state) satisfies a preset deceleration condition. If the pre-curve deceleration state does not satisfy the deceleration condition, the routine proceeds from step S7 to step S12, where normal lane departure prevention control is made executable.

カーブ前減速状態に対する減速条件は、ブレーキスイッチがオンでドライバがブレーキペダルを確実に踏んでおり、且つ、カーブ進入前速度Vをカーブ進入速度閾値Vsafe以下とすることのできる減速度が得られる条件である。但し、このときの減速度は、車両挙動の不安定化を招く虞がない減速度を上限として、例えば、0.1G程度以下の減速度であることが望ましい。   The deceleration condition for the pre-curve deceleration state is a condition in which the brake switch is on and the driver is surely stepping on the brake pedal, and a deceleration is obtained that allows the pre-curve entry speed V to be less than or equal to the curve entry speed threshold Vsafe. It is. However, the deceleration at this time is desirably a deceleration of about 0.1 G or less, for example, with the upper limit being a deceleration that does not cause instability of the vehicle behavior.

一方、ステップS6においてV≦Vsafeの場合、或いはステップS7においてカーブ前減速状態に対する減速条件を満足する場合には、ステップS6或いはステップS7からステップS8へ進む。ステップS8では、操舵支援制御装置15は、自車両1がカーブの外側となる区画線を逸脱する可能性があるか否かを判断する。   On the other hand, if V ≦ Vsafe in step S6, or if the deceleration condition for the pre-curve deceleration state is satisfied in step S7, the process proceeds from step S6 or step S7 to step S8. In step S8, the steering assist control device 15 determines whether or not the host vehicle 1 may deviate from a lane marking that is outside the curve.

自車両1がカーブの外側となる区画線を逸脱する可能性がないと判断される場合、ステップS8からステップS12へ進み、カーブ内側となる区画線からの逸脱に備えて通常の車線逸脱防止制御を実行可能状態とする。自車両1がカーブの外側となる区画線を逸脱する可能性があると判断される場合には、ステップS8からステップS9へ進む。   If it is determined that there is no possibility that the host vehicle 1 deviates from the lane line that is outside the curve, the process proceeds from step S8 to step S12, and normal lane departure prevention control is provided in preparation for deviation from the lane line that is inside the curve. Is made executable. If it is determined that the host vehicle 1 may deviate from the lane marking on the outside of the curve, the process proceeds from step S8 to step S9.

ステップS9では、操舵支援制御装置15は、逸脱先が対向車線であるか、或いは逸脱先にガードレールや側壁等の障害物があるか否かを調べる。逸脱先が対向車線、或いは逸脱先にガードレールや側壁等の障害物がある場合には、ステップS9からステップS12へ進んで通常の車線逸脱防止制御を実行可能とする。   In step S9, the steering assist control device 15 checks whether the departure destination is an oncoming lane or whether there is an obstacle such as a guardrail or a side wall at the departure destination. When the departure point is the oncoming lane or there is an obstacle such as a guardrail or a side wall at the departure point, the process proceeds from step S9 to step S12, and normal lane departure prevention control can be executed.

一方、逸脱先が対向車線でなく、逸脱先にガードレールや側壁等の障害物がない場合には、ステップS9からステップS10へ進み、カーブの外側となる区画線からの逸脱許容量Xoverを算出する。そして、ステップS11において、逸脱許容量を考慮した車線逸脱防止制御を実行し、自車両1のカーブの外側となる区画線からの逸脱を、逸脱許容量Xoverまで許容する。   On the other hand, if the departure point is not an oncoming lane and there is no obstacle such as a guardrail or a side wall at the departure point, the process proceeds from step S9 to step S10, and the deviation allowable amount Xover from the lane marking outside the curve is calculated. . In step S11, lane departure prevention control is performed in consideration of the deviation allowable amount, and deviation from the lane marking on the outside of the curve of the host vehicle 1 is allowed up to the deviation allowable amount Xover.

このように本実施の形態においては、トレーラ100を連結しての牽引走行でカーブを通過する際に、カーブ内側方向に逸脱する可能性がある場合には、従来と同様、車線逸脱防止制御を介入させる一方、カーブ外側方向に逸脱する可能性がある場合には、カーブ進入状態が安全か否かを判断し、安全と判断された場合、カーブの外側となる区画線からの逸脱を、逸脱許容量Xoverまで許容し、カーブ外側方向への逸脱に対してドライバの操舵意図に反する車線逸脱防止制御の介入を抑制する。これにより、安全を確保しながらドライバへの違和感を低減することができ、また、ドライバが所望する経路での走行が可能となる。   As described above, in this embodiment, when there is a possibility of deviating in the curve inward direction when passing the curve by towing traveling with the trailer 100 connected, the lane departure prevention control is performed as in the conventional case. While intervening, there is a possibility of deviating outside the curve, it is judged whether the curve approaching state is safe, and if it is judged safe, deviating from the demarcation line outside the curve An allowable amount Xover is allowed, and the intervention of the lane departure prevention control that is contrary to the driver's steering intention with respect to the departure in the curve outward direction is suppressed. Accordingly, it is possible to reduce a sense of incongruity to the driver while ensuring safety, and it is possible to travel on a route desired by the driver.

1 自車両
2 ヒッチ
3 前方カメラ
4 後方カメラ
5 車内カメラ
6 車速センサ
7 ヨーレートセンサ
11 外部環境認識装置
12 乗員状態検知装置
13 ナビゲーション装置
13a 地図データベース
14 駆動制御装置
15 操舵支援制御装置
16 車線逸脱防止制御部
17 牽引走行判断部
18 カーブ進入状態判断部
19 カーブ外側逸脱判断部
20 逸脱許容量算出部
21 車線逸脱許容指示部
30 EPS装置
100 トレーラ
DESCRIPTION OF SYMBOLS 1 Own vehicle 2 Hitch 3 Front camera 4 Rear camera 5 In-vehicle camera 6 Vehicle speed sensor 7 Yaw rate sensor 11 External environment recognition apparatus 12 Occupant state detection apparatus 13 Navigation apparatus 13a Map database 14 Drive control apparatus 15 Steering support control apparatus 16 Lane departure prevention control Section 17 Traction travel determination section 18 Curve approach state determination section 19 Curve outside departure determination section 20 Deviation allowance calculation section 21 Lane departure allowance instruction section 30 EPS device 100 Trailer

Claims (6)

自車両が走行する車線からの逸脱を防止する車線逸脱防止制御を実行する車線逸脱防止制御部を有する車両の車線逸脱防止制御装置であって、
自車両の後部に被牽引車両を連結して走行する牽引走行か否かを判断する牽引走行判断部と、
前記牽引走行時に自車両のカーブへの進入状態が安全か否かを判断するカーブ進入状態判断部と、
前記牽引走行時に、前記車線を形成する左右の区画線のうちの前記カーブの外側となる区画線を逸脱するか否かを判断するカーブ外側逸脱判断部と、
前記カーブの外側となる区画線からの自車両の逸脱量の許容限界を規定する逸脱許容量を算出する逸脱許容量算出部と、
自車両の前記カーブへの進入状態が安全と判断され、且つ自車両が前記カーブの外側となる区画線を逸脱すると判断された場合、前記車線逸脱防止制御部に、前記カーブの外側となる区画線からの自車両の逸脱を前記逸脱許容量まで許容して前記車線逸脱防止制御を実行するよう指示する車線逸脱許容指示部と
を備えることを特徴とする車線逸脱防止制御装置。
A lane departure prevention control device for a vehicle having a lane departure prevention control unit that executes lane departure prevention control for preventing departure from a lane in which the host vehicle travels,
A towed traveling determination unit that determines whether the towed vehicle travels by connecting a towed vehicle to the rear of the host vehicle;
A curve approach state determination unit that determines whether the approach state to the curve of the host vehicle is safe during the towing,
A curve outside deviation determining unit that determines whether or not to deviate from the lane marking that is outside the curve among the left and right lane markings that form the lane during the towing;
A deviation allowance calculating unit that calculates a deviation allowance that defines an allowable limit of the deviation amount of the vehicle from the lane marking that is outside the curve; and
When it is determined that the approach state of the host vehicle to the curve is safe and the host vehicle departs from a lane line that is outside the curve, the lane departure prevention control unit is provided with a partition that is outside the curve. A lane departure prevention control device, comprising: a lane departure allowance instruction unit that instructs to execute the lane departure prevention control while allowing a departure of the host vehicle from a line to the allowable departure amount.
前記逸脱許容量算出部は、前記逸脱許容量を前記カーブの曲率と自車両及び前記被牽引車両を含めた連結車両の全長との少なくとも一方に基づいて算出し、前記カーブの曲率が大きくなるほど前記逸脱許容量を大きくし、前記連結車両の全長が長くなるほど前記逸脱許容量を大きくすることを特徴とする請求項1に記載の車線逸脱防止制御装置。   The deviation allowance calculation unit calculates the deviation allowance based on at least one of the curvature of the curve and the total length of the coupled vehicle including the host vehicle and the towed vehicle, and the curvature of the curve increases as the curvature of the curve increases. 2. The lane departure prevention control device according to claim 1, wherein the deviation allowance is increased, and the deviation allowance is increased as the total length of the coupled vehicles is increased. 前記逸脱許容量算出部は、前記逸脱許容量を、前記カーブの外側となる区画線から車幅方向に一定の距離だけ離れた値として算出することを特徴とする請求項1に記載の車線逸脱防止制御装置。   2. The lane departure according to claim 1, wherein the deviation allowable amount calculation unit calculates the deviation allowable amount as a value that is a fixed distance away from a lane marking that is outside the curve in a vehicle width direction. Prevention control device. 前記カーブ進入状態判断部は、少なくとも前記カーブへの進入前速度が前記カーブの曲率に基づいて設定されるカーブ進入速度閾値以下であるか否かにより、前記カーブへの進入状態が安全か否かを判断することを特徴とする請求項1〜3の何れか一項に記載の車線逸脱防止制御装置。   The curve entry state determination unit determines whether the entry state to the curve is safe based on whether or not at least the speed before entering the curve is equal to or less than a curve entry speed threshold set based on the curvature of the curve. The lane departure prevention control device according to any one of claims 1 to 3, wherein the lane departure prevention control device is determined. 前記カーブ進入速度閾値は、前記カーブの曲率に対して定常円旋回で一定の加速度を与える閾値であることを特徴とする請求項4に記載の車線逸脱防止制御装置。   The lane departure prevention control device according to claim 4, wherein the curve approach speed threshold is a threshold that gives a constant acceleration to the curvature of the curve in a steady circle turn. 前記牽引走行判断部は、前記被牽引車両を連結しての牽引走行を、カメラで撮像した自車両後方の画像に基づいて判断することを特徴とする請求項1〜5の何れか一項に記載の車線逸脱防止制御装置。   The said tow travel judgment part judges the tow run which connected the said towed vehicle based on the image of the back of the own vehicle imaged with the camera. The lane departure prevention control device described.
JP2018043334A 2018-03-09 2018-03-09 Lane departure prevention control device Active JP7075245B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2018043334A JP7075245B2 (en) 2018-03-09 2018-03-09 Lane departure prevention control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018043334A JP7075245B2 (en) 2018-03-09 2018-03-09 Lane departure prevention control device

Publications (2)

Publication Number Publication Date
JP2019156059A true JP2019156059A (en) 2019-09-19
JP7075245B2 JP7075245B2 (en) 2022-05-25

Family

ID=67994413

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018043334A Active JP7075245B2 (en) 2018-03-09 2018-03-09 Lane departure prevention control device

Country Status (1)

Country Link
JP (1) JP7075245B2 (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020050385A1 (en) 2018-09-07 2020-03-12 マックス株式会社 Binding machine
CN113771849A (en) * 2021-09-02 2021-12-10 英博超算(南京)科技有限公司 Be applicable to lane and keep auxiliary system
CN113911125A (en) * 2021-11-15 2022-01-11 苏州挚途科技有限公司 Truck path point determining method and device and electronic equipment
WO2022202877A1 (en) * 2021-03-26 2022-09-29 いすゞ自動車株式会社 Driving control device

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08205306A (en) * 1995-01-27 1996-08-09 Fuji Heavy Ind Ltd Alarm device for car
JP2002352373A (en) * 2001-05-22 2002-12-06 Isuzu Motors Ltd Automatic steering system
JP2010536632A (en) * 2007-08-15 2010-12-02 ボルボ テクノロジー コーポレイション Driving control method and system for vehicle lane keeping assistance
JP2011003075A (en) * 2009-06-19 2011-01-06 Fuji Heavy Ind Ltd Driving support device for vehicle
JP2017146653A (en) * 2016-02-15 2017-08-24 本田技研工業株式会社 Vehicle control system, vehicle control method and vehicle control program

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08205306A (en) * 1995-01-27 1996-08-09 Fuji Heavy Ind Ltd Alarm device for car
JP2002352373A (en) * 2001-05-22 2002-12-06 Isuzu Motors Ltd Automatic steering system
JP2010536632A (en) * 2007-08-15 2010-12-02 ボルボ テクノロジー コーポレイション Driving control method and system for vehicle lane keeping assistance
JP2011003075A (en) * 2009-06-19 2011-01-06 Fuji Heavy Ind Ltd Driving support device for vehicle
JP2017146653A (en) * 2016-02-15 2017-08-24 本田技研工業株式会社 Vehicle control system, vehicle control method and vehicle control program

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020050385A1 (en) 2018-09-07 2020-03-12 マックス株式会社 Binding machine
WO2022202877A1 (en) * 2021-03-26 2022-09-29 いすゞ自動車株式会社 Driving control device
JP2022150606A (en) * 2021-03-26 2022-10-07 いすゞ自動車株式会社 Operation control apparatus
JP7306419B2 (en) 2021-03-26 2023-07-11 いすゞ自動車株式会社 Operation control device
CN113771849A (en) * 2021-09-02 2021-12-10 英博超算(南京)科技有限公司 Be applicable to lane and keep auxiliary system
CN113911125A (en) * 2021-11-15 2022-01-11 苏州挚途科技有限公司 Truck path point determining method and device and electronic equipment

Also Published As

Publication number Publication date
JP7075245B2 (en) 2022-05-25

Similar Documents

Publication Publication Date Title
US10106161B2 (en) Vehicle travel control device
JP6438516B2 (en) Vehicle travel control device
US10525973B2 (en) Vehicle traveling control device
JP5300357B2 (en) Collision prevention support device
JP6294928B1 (en) Vehicle travel control device
JP7128623B2 (en) Vehicle predictive control
JP6465319B2 (en) Vehicle travel control device
JP6755071B2 (en) Vehicle travel control device
JP7075245B2 (en) Lane departure prevention control device
JP7065649B2 (en) Vehicle driving control device
JP6647361B2 (en) Vehicle driving support device
JP2017121912A (en) Traveling control system of vehicle
JP2010163164A (en) Drive assist apparatus
US9783198B2 (en) Vehicle travel control device
JP6774259B2 (en) Vehicle travel control device
KR20190045308A (en) A vehicle judging method, a traveling path correcting method, a vehicle judging device, and a traveling path correcting device
JP7137332B2 (en) Vehicle travel control device
JP6494020B2 (en) Vehicle driving support control device
WO2016189727A1 (en) Travel control device and method
JP2018167732A (en) Vehicle travel control device
JP7065585B2 (en) Vehicle driving control device
JP6598303B2 (en) Vehicle travel control device
JP6598304B2 (en) Vehicle travel control device
JP7216505B2 (en) Vehicle cruise control system
JP2018171986A (en) Travel control device for vehicle

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210217

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20210217

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220114

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220118

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220302

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220513

R150 Certificate of patent or registration of utility model

Ref document number: 7075245

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150