[go: up one dir, main page]

JP2018034719A - Vehicle lane departure determination method and lane departure determination device - Google Patents

Vehicle lane departure determination method and lane departure determination device Download PDF

Info

Publication number
JP2018034719A
JP2018034719A JP2016170865A JP2016170865A JP2018034719A JP 2018034719 A JP2018034719 A JP 2018034719A JP 2016170865 A JP2016170865 A JP 2016170865A JP 2016170865 A JP2016170865 A JP 2016170865A JP 2018034719 A JP2018034719 A JP 2018034719A
Authority
JP
Japan
Prior art keywords
vehicle
lane departure
lateral movement
movement amount
lane
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
JP2016170865A
Other languages
Japanese (ja)
Other versions
JP6720783B2 (en
Inventor
橋本 隆志
Takashi Hashimoto
隆志 橋本
岳嗣 小松
Takeshi Komatsu
岳嗣 小松
達郎 中原
Tatsuro Nakahara
達郎 中原
良貴 高木
Yoshitaka Takagi
良貴 高木
崇史 甲斐
Takashi Kai
崇史 甲斐
益謙 高
Yiqian Gao
益謙 高
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.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor Co Ltd
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 Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP2016170865A priority Critical patent/JP6720783B2/en
Publication of JP2018034719A publication Critical patent/JP2018034719A/en
Application granted granted Critical
Publication of JP6720783B2 publication Critical patent/JP6720783B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Traffic Control Systems (AREA)

Abstract

【課題】自車両の走行中、レーン逸脱対応の余裕時間が適切になるレーン逸脱判定を実現すること。【解決手段】走行中の自車両が走行レーンを逸脱するかどうかを判定する車両のレーン逸脱判定方法において、最大横移動量算出ステップS3〜S5と、レーン逸脱閾値設定ステップS6と、レーン逸脱判定ステップS8と、を有する。最大横移動量算出ステップS3〜S5は、車速情報とヨーレート情報に基づいて、走行中の自車両に発生し得る最大横移動量Δy*を算出する。レーン逸脱閾値設定ステップS6は、算出された最大横移動量Δy*を用いてレーン逸脱閾値y*を設定する。レーン逸脱判定ステップS8は、走行中の自車両の横位置情報が、レーン逸脱閾値y*以上になるとレーン逸脱と判定する。【選択図】図2To realize a lane departure determination in which a margin time corresponding to a lane departure is appropriate while a host vehicle is traveling. In a vehicle lane departure determination method for determining whether a traveling vehicle deviates from a travel lane, maximum lateral movement amount calculation steps S3 to S5, a lane departure threshold setting step S6, and lane departure determination Step S8. The maximum lateral movement amount calculation steps S3 to S5 calculate the maximum lateral movement amount Δy * that can occur in the traveling vehicle based on the vehicle speed information and the yaw rate information. In the lane departure threshold setting step S6, the lane departure threshold y * is set using the calculated maximum lateral movement amount Δy *. The lane departure determination step S8 determines that the lane has departed when the lateral position information of the traveling vehicle is equal to or greater than the lane departure threshold y *. [Selection] Figure 2

Description

本開示は、走行中の自車両が走行レーンを逸脱するかどうかを判定する車両のレーン逸脱判定方法とレーン逸脱判定装置に関する。   The present disclosure relates to a vehicle lane departure determination method and a lane departure determination device that determine whether or not a traveling vehicle deviates from a travel lane.

従来例としては、自車両1が走行する車線の中央を検出し、検出した車線の中央に対する自車両1の中心位置の横偏倚量が所定の閾値を越えた時に車線逸脱を判定するコントロールユニット10を備える。コントロールユニット10は、上記閾値として自車両進行方向右側への偏倚量に対する値と、左側への偏倚量に対する閾値とを個別に設定すると共に、自車両1において運転者が位置する側の閾値を反対側の閾値よりも小さな値に設定する装置が知られている(例えば、特許文献1参照)。   As a conventional example, the control unit 10 detects the center of the lane in which the host vehicle 1 travels, and determines the lane departure when the lateral deviation amount of the center position of the host vehicle 1 with respect to the detected center of the lane exceeds a predetermined threshold. Is provided. The control unit 10 individually sets a threshold value for the right side deviation amount and a threshold value for the left side deviation amount as the threshold values, and is opposite to the threshold value on the side where the driver is located in the own vehicle 1. An apparatus that sets a value smaller than the threshold on the side is known (for example, see Patent Document 1).

特開2015−162127号公報Japanese Patent Laying-Open No. 2015-162127

しかしながら、従来例にあっては、レーン逸脱の判定閾値を運転席位置が右側か左側かのみで変更(シフト)させているので、運転者への操作支援には効果が認められるが、車両停止まで制御する自動運転においては直接的な効果が望めない。例えば、車速に関係なくレーン逸脱閾値を一定とすると、高速時には、逸脱判定後に自動運転にて制動制御を実行しても間に合わない。低速時には、そのまま自動運転モードで継続可能なのにレーン逸脱と判定をしてしまい不必要に停車する、といった問題が発生する。   However, in the conventional example, the threshold for judging the departure from the lane is changed (shifted) depending on whether the driver's seat position is on the right side or the left side. A direct effect cannot be expected in the automatic operation that controls up to. For example, if the lane departure threshold value is constant regardless of the vehicle speed, even if the braking control is executed by automatic driving after departure determination at high speed, it is not in time. At low speeds, there is a problem that the vehicle can be continued in the automatic operation mode as it is, but it is determined that the vehicle has deviated from the lane and the vehicle stops unnecessarily.

本開示は、上記問題に着目してなされたもので、自車両の走行中、レーン逸脱対応の余裕時間が適切になるレーン逸脱判定を実現することを目的とする。   The present disclosure has been made paying attention to the above-described problem, and an object thereof is to realize a lane departure determination in which a margin time corresponding to a lane departure is appropriate while the host vehicle is traveling.

上記目的を達成するため、本開示は、車両のレーン逸脱判定方法において、
車速情報とヨーレート情報に基づいて、走行中の自車両に発生し得る最大横移動量を算出する。
算出された最大横移動量を用いてレーン逸脱閾値を設定する。
走行中の自車両の横位置情報が、レーン逸脱閾値以上になるとレーン逸脱と判定する。
In order to achieve the above object, the present disclosure provides a vehicle lane departure determination method,
Based on the vehicle speed information and the yaw rate information, the maximum amount of lateral movement that can occur in the traveling vehicle is calculated.
A lane departure threshold is set using the calculated maximum lateral movement amount.
When the lateral position information of the traveling vehicle is equal to or greater than the lane departure threshold, it is determined that the vehicle is lane departure.

上記のように、自車両に発生し得る最大横移動量を用いてレーン逸脱閾値を設定することで、自車両の走行中、レーン逸脱対応の余裕時間が適切になるレーン逸脱判定を実現することができる。   As described above, by setting the lane departure threshold using the maximum amount of lateral movement that can occur in the host vehicle, it is possible to realize the lane departure determination in which the margin time corresponding to the lane departure is appropriate while the host vehicle is traveling. Can do.

実施例1のレーン逸脱判定方法とレーン逸脱判定装置が適用された自動運転車両の自動運転システムを示すブロック構成図である。1 is a block configuration diagram illustrating an automatic driving system for an autonomous driving vehicle to which a lane departure determination method and a lane departure determination apparatus according to a first embodiment are applied. 実施例1のコントロールユニットにて実行される車速・ヨーレートを考慮したレーン逸脱判定を有する自動運転制御処理の流れを示すフローチャートである。3 is a flowchart illustrating a flow of an automatic driving control process having a lane departure determination in consideration of a vehicle speed and a yaw rate, which is executed by the control unit of the first embodiment. 実施例1での自車両の走行及び挙動に伴う最大横移動量Δy*の算出概要を示す説明図である。It is explanatory drawing which shows the calculation outline | summary of maximum lateral movement amount (DELTA) y * accompanying the driving | running | working and behavior of the own vehicle in Example 1. FIG. 実施例1での最大横移動量Δy*の要素Δy1の算出概要を示す説明図である。It is explanatory drawing which shows the calculation outline | summary of element (DELTA) y1 of the largest horizontal movement amount (DELTA) y * in Example 1. FIG. 実施例1での最大横移動量Δy*の要素Δy2の算出概要を示す説明図である。It is explanatory drawing which shows the calculation outline | summary of element (DELTA) y2 of the largest horizontal movement amount (DELTA) y * in Example 1. FIG. 実施例1での車両制動をかけた際の最大横移動量Δy*の考え方を示す説明図である。It is explanatory drawing which shows the view of the largest lateral movement amount (DELTA) y * at the time of vehicle braking in Example 1. FIG. 実施例1のレーン逸脱判定方法とレーン逸脱判定装置が適用された自動運転車両の自動運転システムを示すブロック構成図である。1 is a block configuration diagram illustrating an automatic driving system for an autonomous driving vehicle to which a lane departure determination method and a lane departure determination apparatus according to a first embodiment are applied. 実施例2のコントロールユニットにて実行される車速・ヨーレートを考慮したレーン逸脱判定を有する自動運転制御処理の流れを示すフローチャートである。It is a flowchart which shows the flow of the automatic driving | running control process which has the lane deviation | determination determination in consideration of the vehicle speed and the yaw rate performed by the control unit of Example 2. 実施例1での車両制動をかけた際のレーン逸脱閾値y*(t)の考え方を示す説明図である。It is explanatory drawing which shows the idea of the lane departure threshold value y * (t) at the time of applying the vehicle braking in Example 1. 実施例2での自己位置推定係数とセンシング系誤差修正係数の考え方を示す説明図である。It is explanatory drawing which shows the concept of the self-position estimation coefficient in Example 2, and a sensing system error correction coefficient.

以下、本開示による車両のレーン逸脱判定方法とレーン逸脱判定装置を実現する最良の実施形態を、図面に示す実施例1及び実施例2に基づいて説明する。   Hereinafter, a best mode for realizing a vehicle lane departure determination method and a lane departure determination apparatus according to the present disclosure will be described based on Example 1 and Example 2 shown in the drawings.

まず、構成を説明する。
実施例1におけるレーン逸脱判定方法とレーン逸脱判定装置は、自動運転モードにより自車両を走行させる走行制御、自動運転走行中にレーン逸脱との判定により自車両を停止させる制動制御を実行する自動運転車両に適用したものである。以下、実施例1の構成を、「全体システム構成」、「レーン逸脱判定による自動運転制御処理構成」に分けて説明する。
First, the configuration will be described.
The lane departure determination method and the lane departure determination apparatus according to the first embodiment perform automatic control for executing traveling control for causing the host vehicle to travel in the automatic driving mode, and braking control for stopping the own vehicle based on the determination of the lane departure during the automatic driving traveling. It is applied to a vehicle. Hereinafter, the configuration of the first embodiment will be described by dividing it into “the overall system configuration” and “the automatic operation control processing configuration based on the lane departure determination”.

[全体システム構成]
図1は、実施例1のレーン逸脱判定方法とレーン逸脱判定装置が適用された自動運転車両の自動運転システムを示すブロック構成図である。以下、図1に基づき、全体システム構成を説明する。
[Overall system configuration]
FIG. 1 is a block diagram illustrating an automatic driving system for an autonomous driving vehicle to which the lane departure determination method and the lane departure determination apparatus according to the first embodiment are applied. The overall system configuration will be described below with reference to FIG.

自動運転システムは、自動運転モードを選択すると、走行レーン(走行車線)のセンタ基準で候補ラインを設定し、自車両の前後方向中心線がその候補ラインの接線と一致する走行ができるように、自動的に走行制御する。この自動運転システムは、図1に示すように、自車速検出手段1と、ヨーレート検出手段2と、車線映像撮影手段3と、物体検出手段4と、コントロールユニット5と、車両制御手段6と、を備えている。このように、自車速検出手段1とヨーレート検出手段2を有することで、自車両における速度及び姿勢に関する運動状態量を得るようにしている。   When the automatic driving system selects the automatic driving mode, the candidate line is set on the basis of the center of the driving lane (driving lane), and the center line in the front-rear direction of the host vehicle can run to match the tangent line of the candidate line. Run control automatically. As shown in FIG. 1, the automatic driving system includes an own vehicle speed detecting means 1, a yaw rate detecting means 2, a lane image photographing means 3, an object detecting means 4, a control unit 5, a vehicle control means 6, It has. As described above, by including the own vehicle speed detecting means 1 and the yaw rate detecting means 2, an amount of motion state relating to the speed and posture of the own vehicle is obtained.

自車速検出手段1は、自車両の速度や走行距離を演算するための車速情報を取得する車速センサや車輪速センサに代表される手段である。自車速検出手段1からの自車速検出情報は、コントロールユニット5に出力される。   The own vehicle speed detecting means 1 is a means represented by a vehicle speed sensor and a wheel speed sensor for obtaining vehicle speed information for calculating the speed and travel distance of the own vehicle. The own vehicle speed detection information from the own vehicle speed detection means 1 is output to the control unit 5.

ヨーレート検出手段2は、自車両の重心点を通る鉛直軸周りの回転角速度であるヨーレート情報を取得するヨーレートセンサに代表される手段である。ヨーレート検出手段2からのヨーレート検出情報は、コントロールユニット5に出力される。   The yaw rate detection unit 2 is a unit represented by a yaw rate sensor that acquires yaw rate information that is a rotational angular velocity around a vertical axis that passes through the center of gravity of the host vehicle. The yaw rate detection information from the yaw rate detection means 2 is output to the control unit 5.

車線映像撮影手段3は、自車両の外周位置に複数個設けられ、車線映像が含まれる自車両の外部環境を撮影する車載カメラに代表される手段である。車線映像撮影手段3からの車線映像情報は、コントロールユニット5に出力される。   The lane image photographing means 3 is a means represented by an in-vehicle camera that is provided in plural at the outer peripheral position of the own vehicle and photographs the external environment of the own vehicle including the lane image. The lane image information from the lane image photographing means 3 is output to the control unit 5.

物体検出手段4は、自車両から赤外線レーザーを照射し、物体からの反射により物体の存在を検出すると共に、その反射の度合いで物体までの距離を測定するレーザレンジファインダに代表される手段である。物体検出手段4からの物体検出情報は、コントロールユニット5に出力される。なお、レーザレンジファインダにより検出された物体までの距離情報は、ポイントクラウド情報として取得できるようになっている。さらに、物体検出手段4としては、レーザレンジファインダの他に、超音波を利用するクリアランスソナーやステレオカメラ等を用い、物体の検出や物体までの距離を検出してもよい。   The object detection means 4 is a means typified by a laser range finder that irradiates an infrared laser from the host vehicle, detects the presence of the object by reflection from the object, and measures the distance to the object by the degree of reflection. . Object detection information from the object detection means 4 is output to the control unit 5. In addition, the distance information to the object detected by the laser range finder can be acquired as point cloud information. Furthermore, as the object detection means 4, in addition to the laser range finder, a clearance sonar using an ultrasonic wave, a stereo camera, or the like may be used to detect an object or a distance to the object.

コントロールユニット5は、CPU,ROM,RAM等から構成され、自車両と走行車線における左右白線までの相対位置関係を定量的に把握することが可能である。このコントロールユニット5は、図1に示すように、車線白線検出部51と、他車両検出部52と、状況判断部53と、最大横移動量算出部54と、レーン逸脱閾値設定部55と、走行車線検出部56と、レーン逸脱判定部57と、を有する。   The control unit 5 includes a CPU, a ROM, a RAM, and the like, and can quantitatively grasp the relative positional relationship between the host vehicle and the left and right white lines in the traveling lane. As shown in FIG. 1, the control unit 5 includes a lane white line detection unit 51, another vehicle detection unit 52, a situation determination unit 53, a maximum lateral movement amount calculation unit 54, a lane departure threshold setting unit 55, A travel lane detection unit 56 and a lane departure determination unit 57 are provided.

車線白線検出部51は、車線映像撮影手段3からの車線映像情報に基づいて、走行レーンの境界線である車線白線を検出する。   The lane white line detection unit 51 detects a lane white line that is a boundary line of the travel lane based on the lane image information from the lane image capturing unit 3.

他車両検出部52は、車線映像撮影手段3からの車線映像情報と、物体検出手段4からの物体検出情報とに基づいて、自車両の周囲に存在する他車両を検出する。   The other vehicle detection unit 52 detects other vehicles around the host vehicle based on the lane image information from the lane image photographing unit 3 and the object detection information from the object detection unit 4.

状況判断部53は、自車速検出手段1からの自車速検出情報と、ヨーレート検出手段2からのヨーレート検出情報と、車線白線検出部51からの車線白線検出情報と、を入力する。そして、これらの入力情報に基づき、自車両における速度及び姿勢に関する運動状態量を含む自車両の走行状況を判断する。   The situation determination unit 53 inputs the own vehicle speed detection information from the own vehicle speed detection unit 1, the yaw rate detection information from the yaw rate detection unit 2, and the lane white line detection information from the lane white line detection unit 51. And based on these input information, the driving | running | working condition of the own vehicle containing the motion state amount regarding the speed and attitude | position in the own vehicle is judged.

最大横移動量算出部54は、状況判断部53からの自車両における速度及び姿勢に関する運動状態量の情報に基づき、走行中の自車両に発生し得る最大横移動量を算出する。この最大横移動量算出部54では、自車両が最大ヨーレートにより走行状態から制動状態へと移行して停車すると想定し、その間に生じる想定最大ヨーレートベースでの自車両の横移動量を、最大横移動量とみなして算出する。   The maximum lateral movement amount calculation unit 54 calculates the maximum lateral movement amount that can occur in the traveling host vehicle based on the information on the motion state amount related to the speed and posture of the host vehicle from the situation determination unit 53. The maximum lateral movement amount calculation unit 54 assumes that the host vehicle is stopped from the running state to the braking state by the maximum yaw rate, and the lateral movement amount of the host vehicle based on the assumed maximum yaw rate generated during that time is calculated as the maximum lateral movement amount. Calculated as a movement amount.

レーン逸脱閾値設定部55は、最大横移動量算出部54から取得された最大横移動量を用いてレーン逸脱閾値を設定する。このレーン逸脱閾値は、最大横移動量算出部54にて算出された最大横移動量が大きいほど、レーン逸脱と判定されやすい値に設定する。   The lane departure threshold setting unit 55 sets the lane departure threshold using the maximum lateral movement amount acquired from the maximum lateral movement amount calculation unit 54. The lane departure threshold value is set to a value that is more easily determined as a lane departure as the maximum lateral movement amount calculated by the maximum lateral movement amount calculation unit 54 is larger.

走行車線検出部56は、状況判断部53からの走行状況情報に基づいて、自車両が走行可能な走行車線(走行レーン)を検出する。   The travel lane detection unit 56 detects a travel lane (travel lane) in which the host vehicle can travel based on the travel status information from the situation determination unit 53.

レーン逸脱判定部57は、他車両検出部52からの他車両検出情報と、走行車線検出部56からの走行車線検出情報と、に基づいて、自車両の横位置情報を取得する。そして、自車両の横位置情報による白線までの距離とレーン逸脱閾値設定部55からのレーン逸脱閾値との比較により、自車両のレーン逸脱の有無を判定する。ここで、手動運転時や運転支援時等であって自動運転モードが選択されていないときには、自車両の横位置情報を、取得された走行レーン上での自車両の位置とし、白線までの距離を算出する。一方、自動運転モードの選択時には、自車両の横位置情報を、自動運転モードでの候補ラインである走行レーンのセンタ位置とし、白線までの距離を算出する。   The lane departure determination unit 57 acquires the lateral position information of the host vehicle based on the other vehicle detection information from the other vehicle detection unit 52 and the travel lane detection information from the travel lane detection unit 56. And the presence or absence of the lane deviation of the own vehicle is determined by comparing the distance to the white line based on the lateral position information of the own vehicle and the lane departure threshold value from the lane departure threshold setting unit 55. Here, when the automatic driving mode is not selected at the time of manual driving or driving support, the lateral position information of the own vehicle is the position of the own vehicle on the acquired travel lane, and the distance to the white line Is calculated. On the other hand, when the automatic driving mode is selected, the lateral position information of the host vehicle is set as the center position of the traveling lane that is a candidate line in the automatic driving mode, and the distance to the white line is calculated.

即ち、自動運転モードが前提の場合、走行レーンのセンタ位置から白線までの距離が設定されたレーン逸脱閾値未満であると、レーン逸脱していないと判定し、自動運転モードを継続する指令を車両制御手段6に出力する。一方、走行レーンのセンタ位置から白線までの距離が設定されたレーン逸脱閾値以上になると、レーン逸脱と判定し、自車両を制動制御により停止する指令を車両制御手段6に出力する。   In other words, when the automatic driving mode is assumed, if the distance from the center position of the driving lane to the white line is less than the set lane departure threshold, it is determined that the lane has not departed, and a command to continue the automatic driving mode is issued to the vehicle. Output to the control means 6. On the other hand, when the distance from the center position of the traveling lane to the white line is equal to or greater than the set lane departure threshold value, it is determined as lane departure and a command to stop the host vehicle by braking control is output to the vehicle control means 6.

車両制御手段6は、コントロールユニット5からの制御指令と、図外の車輪速センサからの車輪速センサ信号と、図外の操舵角センサからの操舵角センサ信号を入力する。そして、レーン逸脱判定部57から自動運転モードを継続する指令を入力すると、走行レーンのセンタ基準により生成された候補ラインに沿って自車両を走行させる自動運転制御指令をアクチュエータに出力する。又、レーン逸脱判定部57から自車両を停止する指令を入力すると、所定の停止距離の位置で自車両を自動停止させる停車制御指令をアクチュエータに出力する。なお、アクチュエータとしては、自動運転モードのために必要とされる駆動アクチュエータ、制動アクチュエータ、転舵アクチュエータ、セレクトレンジ位置アクチュエータ等が設けられている。   The vehicle control means 6 receives a control command from the control unit 5, a wheel speed sensor signal from a wheel speed sensor (not shown), and a steering angle sensor signal from a steering angle sensor (not shown). When a command to continue the automatic driving mode is input from the lane departure determining unit 57, an automatic driving control command for driving the host vehicle along the candidate line generated based on the center reference of the driving lane is output to the actuator. When a command for stopping the host vehicle is input from the lane departure determining unit 57, a stop control command for automatically stopping the host vehicle at a predetermined stop distance is output to the actuator. As the actuator, a drive actuator, a brake actuator, a steering actuator, a select range position actuator, and the like necessary for the automatic operation mode are provided.

[レーン逸脱判定による自動運転制御処理構成]
図2は、実施例1のコントロールユニット5にて実行される車速・ヨーレートを考慮したレーン逸脱判定を有する自動運転制御処理の流れを示す。以下、自動運転制御処理構成をあらわす図2の各ステップについて説明する。なお、この自動運転制御処理は「自動運転モード」の選択により開始される。
[Automatic operation control processing configuration based on lane departure judgment]
FIG. 2 shows the flow of the automatic driving control process having the lane departure determination in consideration of the vehicle speed and yaw rate, which is executed by the control unit 5 of the first embodiment. Hereinafter, each step of FIG. 2 showing the automatic driving control processing configuration will be described. This automatic operation control process is started by selecting the “automatic operation mode”.

ステップS1では、車両パラメータを読み込み、ステップS2へ進む。
ここで、「車両パラメータ」とは、車両横幅W、車両回転中心〜車両前端隅部の長さLd、車速と停止距離のプロファイルのことをいう。
In step S1, the vehicle parameters are read and the process proceeds to step S2.
Here, the “vehicle parameter” means a profile of the vehicle lateral width W, the vehicle rotation center to the length Ld of the vehicle front end corner, the vehicle speed and the stop distance.

ステップS2では、ステップS1での車両パラメータの読み込みに続き、時々刻々における各種物理量を読み込み、ステップS3へ進む。
ここで、「各種物理量」とは、車速V、横位置、想定最大ヨーレートγ、ヨー角φ(ヨーレートγから導出)のことをいう。
In step S2, following reading of the vehicle parameters in step S1, various physical quantities are read every moment, and the process proceeds to step S3.
Here, “various physical quantities” means vehicle speed V, lateral position, assumed maximum yaw rate γ, and yaw angle φ (derived from yaw rate γ).

ステップS3では、ステップS2での各種物理量の読み込みに続き、想定最大ヨーレートベースで車両横移動量y1を算出し、ステップS4へ進む。
ここで、車両横移動量y1の算出は、
y1=(VΔt)・sinφ …(1)
の式を用いる。
In step S3, following the reading of various physical quantities in step S2, the vehicle lateral movement amount y1 is calculated based on the assumed maximum yaw rate, and the process proceeds to step S4.
Here, the calculation of the vehicle lateral movement amount y1 is as follows:
y1 = (VΔt) · sinφ (1)
Is used.

ステップS4では、ステップS3での車両横移動量y1の算出に続き、想定最大ヨーレートベースで回転に伴う車体横変位量y2を算出し、ステップS5へ進む。
ここで、車体横変位量y2の算出は、
y2=Ld・sin(φ+θ) …(2)
の式を用いる。なお、「θ」は、車両前後方向中心線上から車両前隅部の車両前後方向に対する見開き角である。
In step S4, following the calculation of the vehicle lateral movement amount y1 in step S3, the vehicle body lateral displacement amount y2 associated with the rotation is calculated based on the assumed maximum yaw rate, and the process proceeds to step S5.
Here, the calculation of the vehicle body lateral displacement amount y2 is as follows.
y2 = Ld · sin (φ + θ) (2)
Is used. “Θ” is a spread angle of the front corner of the vehicle with respect to the vehicle longitudinal direction from the vehicle longitudinal center line.

ステップS5では、ステップS4での車体横変位量y2の算出に続き、想定最大ヨーレートベースで、車両制動後から車両停止距離までの間の横移動量ysを算出し、ステップS6へ進む。
ここで、横移動量ysの算出は、
ys=ΔDs・sinφ …(3)
の式を用いる。なお、「ΔDs」は、Δt後に自車両に制動をかけた際に、発生せざるを得ない最小制動距離である。
In step S5, following the calculation of the vehicle body lateral displacement amount y2 in step S4, the lateral movement amount ys from the vehicle braking to the vehicle stop distance is calculated based on the assumed maximum yaw rate, and the process proceeds to step S6.
Here, the calculation of the lateral movement amount ys is
ys = ΔDs · sinφ (3)
Is used. Note that “ΔDs” is the minimum braking distance that must be generated when the host vehicle is braked after Δt.

ステップS6では、ステップS5での横移動量ysの算出に続き、レーン逸脱閾値y*を算出し、ステップS7へ進む。
ここで、レーン逸脱閾値y*の算出は、
y*=y1+y2+ys …(4)
の式を用いる。
In step S6, following the calculation of the lateral movement amount ys in step S5, a lane departure threshold value y * is calculated, and the process proceeds to step S7.
Here, the lane departure threshold y * is calculated as follows:
y * = y1 + y2 + ys (4)
Is used.

ステップS7では、ステップS6でのレーン逸脱閾値y*の算出に続き、車線白線の検出により、自車両の中心に対する白線までの距離T/2(T:車線幅)を算出し、ステップS8へ進む。
ここで、自車両の中心に対する白線までの距離としては、自動運転モードでの走行により車線幅Tのセンタ位置を維持しながら自車両が走行していることを想定して距離T/2で与えている。
In step S7, following the calculation of the lane departure threshold value y * in step S6, the distance T / 2 (T: lane width) from the center of the host vehicle to the white line is calculated by detecting the lane white line, and the process proceeds to step S8. .
Here, the distance to the white line with respect to the center of the host vehicle is given by a distance T / 2 assuming that the host vehicle is traveling while maintaining the center position of the lane width T by traveling in the automatic driving mode. ing.

ステップS8では、ステップS7での自車両の中心に対する白線までの距離T/2の算出に続き、{(VΔt)・sinφ+Ld・sin(φ+θ)+ΔDs・sinφ}<T/2であるか否かを判定する。YES(y*<T/2)の場合はステップS9へ進み、NO(y*≧T/2)の場合はステップS10へ進む。
ここで、ステップS8で用いられる
{(VΔt)・sinφ+Ld・sin(φ+θ)+ΔDs・sinφ}<T/2 …(5)
の関係式のうち、上記(1)〜(4)式により得られる左辺は、自車両に発生し得る最大横移動量を用いて設定されたレーン逸脱閾値y*である。
In step S8, following the calculation of the distance T / 2 from the center of the vehicle to the white line in step S7, {(VΔt) · sinφ + Ld · sin (φ + θ) + ΔDs · sinφ} <T / 2. Determine whether. If YES (y * <T / 2), the process proceeds to step S9. If NO (y * ≧ T / 2), the process proceeds to step S10.
Here, used in step S8
{(VΔt) · sinφ + Ld · sin (φ + θ) + ΔDs · sinφ} <T / 2 (5)
The left side obtained by the above equations (1) to (4) is the lane departure threshold value y * set using the maximum amount of lateral movement that can occur in the host vehicle.

ステップS9では、ステップS8でのy*<T/2であるとの判定に続き、レーン逸脱していないと判定し、自動運転モードを継続し、リターンへ進む。   In step S9, following the determination that y * <T / 2 in step S8, it is determined that there is no lane departure, the automatic operation mode is continued, and the process proceeds to return.

ステップS10では、ステップS8でのy*≧T/2であるとの判定に続き、レーン逸脱と判定し、設定された制動制御により所定の停止距離で停止し、エンドへ進む。なお、エンドへ進むと、リセット処理等が行われる。   In step S10, following the determination that y * ≧ T / 2 in step S8, it is determined that the vehicle has deviated from the lane, the vehicle is stopped at a predetermined stop distance by the set braking control, and the process proceeds to the end. When the process proceeds to the end, reset processing or the like is performed.

次に、作用を説明する。
実施例1の作用を、「レーン逸脱判定による自動運転制御処理作用」、「レーン逸脱閾値の設定作用」、「レーン逸脱判定の特徴作用」に分けて説明する。
Next, the operation will be described.
The operation of the first embodiment will be described by dividing it into “automatic operation control processing operation by lane departure determination”, “lane departure threshold setting operation”, and “lane departure determination characteristic operation”.

[レーン逸脱判定による自動運転制御処理作用]
以下、図2のフローチャートに基づき、レーン逸脱判定による自動運転制御処理作用を説明する。
[Automatic operation control processing action by lane departure judgment]
Hereinafter, based on the flowchart of FIG. 2, the automatic operation control processing operation by the lane departure determination will be described.

自動運転モードでの走行中、図2のフローチャートにおいて、ステップS1→ステップS2→ステップS3→ステップS4→ステップS5→ステップS6→ステップS7へと進む。ステップS3では、想定最大ヨーレートベースで車両横移動量y1が算出される。ステップS4では、想定最大ヨーレートベースで回転に伴う車体横変位量y2が算出される。ステップS5では、想定最大ヨーレートベースで、車両制動後から車両停止距離までの間の横移動量ysが算出される。そして、ステップS6では、レーン逸脱閾値y*が、想定最大ヨーレートベースで算出された車両横移動量y1と車体横変位量y2と横移動量ysとを加算して算出される。ステップS7では、車線白線の検出により、自車両の中心に対する白線までの距離T/2が算出される。   While traveling in the automatic operation mode, in the flowchart of FIG. 2, the process proceeds from step S1, step S2, step S3, step S4, step S5, step S6, and step S7. In step S3, the vehicle lateral movement amount y1 is calculated based on the assumed maximum yaw rate. In step S4, the vehicle body lateral displacement amount y2 accompanying rotation is calculated on the basis of the assumed maximum yaw rate. In step S5, the lateral movement amount ys from after the vehicle braking to the vehicle stop distance is calculated based on the assumed maximum yaw rate. In step S6, the lane departure threshold value y * is calculated by adding the vehicle lateral movement amount y1, the vehicle body lateral displacement amount y2, and the lateral movement amount ys calculated on the basis of the assumed maximum yaw rate. In step S7, the distance T / 2 from the center of the host vehicle to the white line is calculated by detecting the lane white line.

そして、ステップS7からステップS8へと進むと、ステップS8では、距離T/2がレーン逸脱閾値y*を超えているか否かが判定される。ステップS8にてy*<T/2であると判定されると、ステップS8からステップS9へ進み、ステップS9では、レーン逸脱していないと判定され、自動運転モードが継続される。さらに、y*<T/2と判定されている間は、ステップS1→ステップS2→ステップS3→ステップS4→ステップS5→ステップS6→ステップS7→ステップS8→ステップS9へと進む流れが繰り返され、自動運転モードが継続される。   Then, when the process proceeds from step S7 to step S8, it is determined in step S8 whether or not the distance T / 2 exceeds the lane departure threshold value y *. If it is determined in step S8 that y * <T / 2, the process proceeds from step S8 to step S9. In step S9, it is determined that there is no lane departure, and the automatic operation mode is continued. Furthermore, while it is determined that y * <T / 2, the flow of step S1, step S2, step S3, step S4, step S5, step S6, step S7, step S8, and step S9 is repeated. The automatic operation mode is continued.

一方、ステップS8にてy*≧T/2であると判定されると、ステップS8からステップS10へ進み、ステップS10では、レーン逸脱と判定され、設定された制動制御によって所定の停止距離で自車両を停止される制御が行われる。   On the other hand, if it is determined in step S8 that y * ≧ T / 2, the process proceeds from step S8 to step S10. In step S10, it is determined that the vehicle has deviated from the lane, and the vehicle is automatically controlled at a predetermined stop distance by the set braking control. Control for stopping the vehicle is performed.

このように、レーン逸脱判定による自動運転制御処理においては、このまま自車両が自動運転モードによる走行を維持してもレーン逸脱をすることがないとの情報を、自動運転モードの継続条件として常に監視するようにしている。そして、このまま自車両が自動運転モードによる走行を維持するとレーン逸脱をする可能性があると判断されると、自動運転モードを停止し、自車両を走行レーンから逸脱することがない位置で自動停車させるようにしている。   As described above, in the automatic driving control process based on the lane departure determination, the information that the lane does not deviate even if the host vehicle keeps traveling in the automatic driving mode is continuously monitored as the continuation condition of the automatic driving mode. Like to do. If it is determined that there is a possibility that the vehicle will deviate if the vehicle keeps traveling in the automatic driving mode, the automatic driving mode is stopped and the vehicle is automatically stopped at a position where the vehicle does not deviate from the driving lane. I try to let them.

[レーン逸脱閾値の設定作用]
実施例1において、自動運転モードでの走行中、モード継続/モード停止を決めるレーン逸脱判定で用いられるレーン逸脱閾値y*の設定作用を、図3〜図6に基づいて説明する。
[Setting effect of lane departure threshold]
In the first embodiment, the setting operation of the lane departure threshold y * used in the lane departure determination for determining the mode continuation / mode stop during traveling in the automatic operation mode will be described with reference to FIGS.

自車両は、図3に示すように、t=0からt=Δtまでの間に車速Vにて距離ΔDを走行し、t=Δtにて制動をかけるものとし、その間はヨーレートγにてヨー角φの回転移動を伴うものとする。即ち、ヨー角φは、φ=γ・Δtである。自車両としては、t=Δtにおいて制動をかけられ、その後、制動距離ΔDsを経て停止する。   As shown in FIG. 3, the host vehicle travels a distance ΔD at a vehicle speed V from t = 0 to t = Δt, and applies a brake at t = Δt. It shall be accompanied by rotational movement of the angle φ. That is, the yaw angle φ is φ = γ · Δt. The host vehicle is braked at t = Δt, and then stops after a braking distance ΔDs.

この時、自車両としては、t=0における自車両の位置に対してy*だけ横移動すると考えられる。制動距離ΔDsを路面状況や温度等を勘案した上での車速Vに対する必要制動距離とし、予め車速Vと制動距離ΔDsの関係(プロファイル)が得られていれば、上記y*は、t=Δtにおける“自車両が発生し得る最大横移動量”とおくことができる。よって、図3において、y*による横移動量が走路境界を示す左側白線よりも大きくなると、自車両はレーン逸脱したと判定できるので、このy*を「レーン逸脱閾値」として定義する。   At this time, the host vehicle is considered to move laterally by y * with respect to the position of the host vehicle at t = 0. The braking distance ΔDs is set as a necessary braking distance with respect to the vehicle speed V in consideration of the road surface condition, temperature, and the like. If a relationship (profile) between the vehicle speed V and the braking distance ΔDs is obtained in advance, the above y * is t = Δt. The “maximum amount of lateral movement that the host vehicle can generate” can be set. Therefore, in FIG. 3, when the lateral movement amount by y * becomes larger than the left white line indicating the road boundary, it can be determined that the host vehicle has deviated from the lane. Therefore, y * is defined as a “lane deviation threshold”.

以下、レーン逸脱閾値y*の算出方法を、図4及び図5を用いて説明する。レーン逸脱閾値y*は、図4に示すように、下記の3つの車両挙動に伴う横移動量の和として考えることができる。
1.Δy1:Δtの間にΔDを走行する際、発生したヨー角φで生じる車両並進成分の横移動量(Δy1:車両横移動量)
2.Δy2:Δtの間にΔDを走行する際、発生したヨー角φで生じる車両回転成分の横移動量(Δy2:車体横変位量)
3.Δys:t=Δtを経過した後の制動で生じる最小制動移動距離ΔDsの自車両における横移動量(Δys:横移動量)
これらの車両横移動量Δy1、車体横変位量Δy2、横移動量Δysを用いると、最大横移動量Δy*は、
Δy*=Δy1+Δy2+Δys …(4’)
と書ける。
Hereinafter, a method of calculating the lane departure threshold y * will be described with reference to FIGS. As shown in FIG. 4, the lane departure threshold y * can be considered as the sum of the lateral movement amounts associated with the following three vehicle behaviors.
1. Δy1: When the vehicle travels ΔD during Δt, the lateral movement amount of the vehicle translation component generated by the generated yaw angle φ (Δy1: vehicle lateral movement amount)
2. Δy2: A lateral movement amount of the vehicle rotation component generated by the generated yaw angle φ when traveling ΔD during Δt (Δy2: a lateral displacement amount of the vehicle body)
3. Δys: lateral movement amount in the host vehicle of the minimum braking movement distance ΔDs generated by braking after elapse of t = Δt (Δys: lateral movement amount)
Using these vehicle lateral movement amount Δy1, vehicle body lateral displacement amount Δy2, and lateral movement amount Δys, the maximum lateral movement amount Δy * is
Δy * = Δy1 + Δy2 + Δys (4 ′)
Can be written.

車両横移動量Δy1について説明する。t=Δtにおいて、仮想的に自車両の並進移動状態を点線で示す。よって、車両横移動量Δy1は、車両左前隅部P1(図4に示すt=0での実線)と車両左前隅部P2(図4に示すt=Δtでの点線)の横移動量になる。このため、t=Δtにおける自車両の走行移動量ΔD及び発生したヨー角φを用いて、
Δy1=ΔD・sinφ …(1’)
と導かれる。尚、この車両横移動量Δy1は、車両を剛体として扱った際の並進移動量なので、図5から明らかなように、t=0〜t=Δtの間における車両回転中心O〜O’の横移動量とも合致する。
The vehicle lateral movement amount Δy1 will be described. At t = Δt, the translational movement state of the host vehicle is virtually indicated by a dotted line. Therefore, the vehicle lateral movement amount Δy1 is the lateral movement amount of the vehicle left front corner P1 (solid line at t = 0 shown in FIG. 4) and the vehicle left front corner P2 (dotted line at t = Δt shown in FIG. 4). . For this reason, using the travel amount ΔD of the host vehicle and the generated yaw angle φ at t = Δt,
Δy1 = ΔD · sinφ (1 ')
It is guided. The vehicle lateral movement amount Δy1 is a translational movement amount when the vehicle is handled as a rigid body, and as is apparent from FIG. 5, the lateral movement of the vehicle rotation center O to O ′ between t = 0 and t = Δt. It also matches the amount of movement.

車体横変位量Δy2について説明する。車体横変位量Δy2は、t=0〜t=Δtの間における自車両の回転成分の横移動量である。このため、t=Δtにおける仮想的な車両並進移動状態の車両左前隅部P2(図4に示すt=Δtでの点線)と、ヨー角φで生じる実際の自車両状態の車両左前隅部P3((図4に示すt=Δtでの実線)の移動量における横成分となる。車両左前隅部P2(t=Δt)と車両回転中心Oとの長さをLd,同様に車両前後方向中心線上のOら車両左前隅部P2の車両前後方向に対する見開き角をθ、車両全幅をWとおけば、図5により、
Δy2=Ld・sin(φ+θ)−W/2 …(2’)
という関係式が成立する。
The vehicle body lateral displacement amount Δy2 will be described. The lateral displacement amount Δy2 of the vehicle body is the lateral movement amount of the rotational component of the host vehicle between t = 0 and t = Δt. For this reason, the vehicle left front corner P2 in the virtual vehicle translational state at t = Δt (dotted line at t = Δt shown in FIG. 4) and the vehicle left front corner P3 in the actual own vehicle state generated at the yaw angle φ. (The solid line at t = Δt shown in FIG. 4) is a lateral component. The length between the vehicle left front corner P2 (t = Δt) and the vehicle rotation center O is Ld, and the vehicle longitudinal center is also the same. If the spread angle with respect to the vehicle front-rear direction of the left front corner P2 of the vehicle from O on the line is θ and the full width of the vehicle is W, FIG.
Δy2 = Ld · sin (φ + θ) −W / 2 (2 ′)
The following relational expression holds.

横移動量Δysは、t=Δt後に車両に制動をかけた際に、発生せざるを得ない最小制動距離ΔDsに伴う横移動成分なので、導出の考え方はΔy1と同様に、
Δys=ΔDs・sinφ …(3’)
と導かれる。
Since the lateral movement amount Δys is a lateral movement component accompanying the minimum braking distance ΔDs that must be generated when the vehicle is braked after t = Δt, the derivation concept is the same as Δy1.
Δys = ΔDs · sinφ (3 ')
It is guided.

以上を用いて、t=Δtにて車両制動をかけた際のレーン逸脱閾値の考え方を図6に示す。t=0において車線幅Tの中心線に車両前後中心線を合わせて車速Vにて走行中の自車両が、t=Δtにて制動をかけたと想定する。この場合の最大横移動量Δy*との関係において、その時の自車両に生じているヨーレートγに伴うヨー角φ(即ちφ=γ・Δt)を用いれば、下記関係式が成立している限り自車両は走行車線内に留まれる。即ち、図6において、
Δy*+W/2<T/2 …(5’)
の関係式が成立していれば、走行レーン逸脱しないと考えられる。上記(5’)の関係式に上記(4’)の式を代入すると、
Δy1+Δy2+Δys+W/2<T/2 …(5’-1)
になる。さらに、(5’-1)の関係式に、上記(1’),(2’),(3’)の各式を代入すると、
{(ΔD)・sinφ+Ld・sin(φ+θ)−W/2+ΔDs・sinφ}+W/2<T/2…(5’-2)
になる。さらに、関係式(5’-2)の左辺を整理し、ΔD=VΔtとすると、
{(VΔt)・sinφ+Ld・sin(φ+θ)+ΔDs・sinφ}<T/2 …(5’-3)
の式になる。
FIG. 6 shows the concept of the lane departure threshold when the vehicle is braked at t = Δt using the above. It is assumed that the host vehicle traveling at the vehicle speed V with the center line of the vehicle lane width T aligned with the center line of the lane width T at t = 0 is braked at t = Δt. In this case, if the yaw angle φ (that is, φ = γ · Δt) that accompanies the yaw rate γ generated in the host vehicle at that time is used in relation to the maximum lateral movement amount Δy *, the following relational expression is satisfied. The host vehicle stays in the driving lane. That is, in FIG.
Δy * + W / 2 <T / 2 (5 ')
If the following relational expression is established, it is considered that the driving lane does not depart. Substituting the above equation (4 ') into the above equation (5'),
Δy1 + Δy2 + Δys + W / 2 <T / 2 (5'-1)
become. Furthermore, substituting the above formulas (1 '), (2'), and (3 ') into the relational formula (5'-1),
{(ΔD) · sinφ + Ld · sin (φ + θ) −W / 2 + ΔDs · sinφ} + W / 2 <T / 2 (5'-2)
become. Furthermore, if the left side of the relational expression (5′-2) is arranged and ΔD = VΔt,
{(VΔt) · sinφ + Ld · sin (φ + θ) + ΔDs · sinφ} <T / 2 (5'-3)
It becomes the following formula.

よって、上記(5’-3)に示す関係式から明らかなように、最大横移動量Δy*(=Δy1+Δy2+Δys)を用いると、レーン逸脱判定指標としてのレーン逸脱閾値y*が設定できることが解る。そして、自動運転車両に実装した際の図2に示すフローチャートにおいては、上記(5’-3)に示す関係式の左辺をレーン逸脱閾値y*とし、上記(5’-3)に示す関係式の右辺を自車両の横位置情報とし、レーン逸脱の有無を判定するようにしている。   Therefore, as is clear from the relational expression shown in (5'-3) above, it is understood that the lane departure threshold value y * as the lane departure determination index can be set by using the maximum lateral movement amount Δy * (= Δy1 + Δy2 + Δys). In the flowchart shown in FIG. 2 when mounted on an autonomous driving vehicle, the left side of the relational expression shown in the above (5′-3) is the lane departure threshold y *, and the relational expression shown in the above (5′-3). The right side of the vehicle is used as lateral position information of the host vehicle, and the presence or absence of lane departure is determined.

[レーン逸脱判定の特徴作用]
実施例1では、車両のレーン逸脱判定方法において、車速情報とヨーレート情報に基づいて、走行中の自車両に発生し得る最大横移動量Δy*を算出し、算出された最大横移動量Δy*を用いてレーン逸脱閾値y*を設定する。走行中の自車両の横位置情報が、レーン逸脱閾値y*以上になるとレーン逸脱と判定する。
[Characteristic effect of lane departure judgment]
In the first embodiment, in the vehicle lane departure determination method, the maximum lateral movement amount Δy * that can occur in the traveling vehicle is calculated based on the vehicle speed information and the yaw rate information, and the calculated maximum lateral movement amount Δy * is calculated. Is used to set the lane departure threshold y *. When the lateral position information of the traveling vehicle is equal to or greater than the lane departure threshold y *, it is determined that the vehicle is lane departure.

例えば、車速に関係なくレーン逸脱閾値を、走行レーンの車幅方向の所定位置に設定すると、高速時には、レーン逸脱判定が遅れるタイミングになり、レーン逸脱への対応操作や対応動作の余裕時間が不足する。一方、低速時には、レーン逸脱判定が早期のタイミングになり、レーン逸脱への対応操作や対応動作の余裕時間が過剰になる。即ち、レーン逸脱し得るとの判定タイミングが、車両挙動への影響が大きな車速やヨーレートを考慮することのないタイミングになる。このため、レーン逸脱判定後の対応時間として与えられる余裕時間に過不足が発生する。   For example, if the lane departure threshold is set to a predetermined position in the vehicle width direction of the traveling lane regardless of the vehicle speed, the lane departure determination will be delayed at high speeds, and there will be insufficient time for operations and operations to respond to lane departure. To do. On the other hand, at the time of low speed, the lane departure determination is performed at an early timing, and the time for dealing with the lane departure and the margin for the corresponding operation become excessive. That is, the determination timing that the vehicle can deviate from the lane is a timing that does not take into consideration the vehicle speed and yaw rate that have a great influence on the vehicle behavior. For this reason, excess or deficiency occurs in the margin time given as the response time after the lane departure determination.

これに対し、車速情報とヨーレート情報に基づいて、走行中の自車両に発生し得る最大横移動量Δy*が算出されることで、高車速時や旋回走行時等のように車速やヨーレートが高く、車両挙動が不安定になり易い状況においては、大きな最大横移動量Δy*が算出される。逆に、低車速時や直進走行時等のように、車速やヨーレートが低く車両挙動が安定性を保っている状況においては、小さな最大横移動量Δy*が算出される。そして、算出された最大横移動量Δy*を用いてレーン逸脱閾値y*を設定すると、レーン逸脱し得るとの判定タイミングが、車両挙動への影響が大きな車速やヨーレートを考慮した適切なタイミングになる。このため、レーン逸脱判定後の対応時間となる余裕時間の過不足が解消される。   On the other hand, the maximum lateral movement amount Δy * that can occur in the traveling vehicle is calculated based on the vehicle speed information and the yaw rate information, so that the vehicle speed and yaw rate can be adjusted as in a high vehicle speed or turning. In a situation where the vehicle behavior is likely to be unstable, a large maximum lateral movement amount Δy * is calculated. On the other hand, in a situation where the vehicle speed and yaw rate are low and the vehicle behavior is stable, such as when the vehicle is traveling at low speed or traveling straight, a small maximum lateral movement amount Δy * is calculated. Then, when the lane departure threshold value y * is set using the calculated maximum lateral movement amount Δy *, the determination timing that the lane departure is possible is an appropriate timing that takes into consideration the vehicle speed and yaw rate that have a large influence on the vehicle behavior. Become. For this reason, the excess and deficiency of the surplus time that becomes the response time after the lane departure determination is solved.

実施例1では、レーン逸脱閾値y*を、算出された最大横移動量Δy*(=Δy1+Δy2+Δys)が大きいほどレーン逸脱と判定されやすい値に設定する。   In the first embodiment, the lane departure threshold y * is set to a value that is more easily determined as a lane departure as the calculated maximum lateral movement amount Δy * (= Δy1 + Δy2 + Δys) is larger.

即ち、高車速時や旋回走行時等のように、車速やヨーレートが高く、車両挙動が不安定になり易い状況で大きな最大横移動量Δy*が算出されると、レーン逸脱閾値y*がレーン逸脱と判定しやすい値に設定される。このため、大きな最大横移動量Δy*が算出されたときは、自車両が走路境界(白線)に対し相対的に距離があっても、レーン逸脱し得ると早目に判定される。従って、車両挙動が不安定になり易い走行状況において、レーン逸脱のリスクを未然に回避することができる。   That is, when a large maximum lateral movement amount Δy * is calculated in a situation where the vehicle speed or yaw rate is high and the vehicle behavior is likely to be unstable, such as at high vehicle speed or turning, the lane departure threshold y * is It is set to a value that is easy to determine as a deviation. For this reason, when the large maximum lateral movement amount Δy * is calculated, it is determined early that the vehicle can deviate from the lane even if the vehicle is relatively far from the road boundary (white line). Therefore, the risk of lane departure can be avoided in a driving situation where the vehicle behavior tends to become unstable.

逆に、低車速時や直進走行時等のように、車速やヨーレートが低く、車両挙動が安定性を保っている状況で小さな最大横移動量Δy*が算出されると、レーン逸脱閾値y*がレーン逸脱と判定しにくい値に設定される。このため、小さな最大横移動量Δy*が算出されたときは、自車両が走路境界(白線)に対し相対的に近い距離まで接近しないとレーン逸脱し得ると判定しない。従って、車両挙動が安定性を保っている走行状況において、いたずらに自動運転モードを中止させることを回避することができる。この結果、レーン逸脱の判定に際し、乗員に対し不安やストレスを与えない車両を実現することができる。   Conversely, when a small maximum lateral movement amount Δy * is calculated in a situation where the vehicle speed and yaw rate are low and the vehicle behavior is stable, such as when the vehicle is traveling at low speed or straight ahead, the lane departure threshold y * Is set to a value that is difficult to determine as a lane departure. For this reason, when the small maximum lateral movement amount Δy * is calculated, it is not determined that the vehicle can deviate unless the host vehicle approaches a distance relatively close to the road boundary (white line). Therefore, it is possible to avoid unnecessarily stopping the automatic driving mode in a driving situation where the vehicle behavior is stable. As a result, it is possible to realize a vehicle that does not give anxiety or stress to the occupant when determining lane departure.

実施例1では、自車両が最大ヨーレートにより走行状態から制動状態へと移行して停車すると想定する。そして、最大横移動量Δy*を、想定最大ヨーレートベースでの自車両の横移動量により算出する。   In the first embodiment, it is assumed that the host vehicle shifts from the traveling state to the braking state at the maximum yaw rate and stops. Then, the maximum lateral movement amount Δy * is calculated from the lateral movement amount of the host vehicle based on the assumed maximum yaw rate.

即ち、自動運転モードのときにレーン逸脱し得ると判定されると、制動制御により自車両を停止させるようにしている。このとき、レーン逸脱判定後、制動力が発生するまでの応答遅れにより走行状態から制動状態へと移行して停車する。この自動運転モードでの走行中におけるレーン逸脱への対応動作に沿って、自車両が最大ヨーレートにより走行状態から制動状態へと移行して停車すると想定し、最大横移動量Δy*を算出している。従って、自動運転モードによる走行中にレーン逸脱し得ると判定されたとき、走行レーン内に留まる位置に自車両を自動停止させることができる。   That is, when it is determined that the vehicle can deviate from the lane in the automatic driving mode, the host vehicle is stopped by the braking control. At this time, after determining the departure from the lane, the vehicle shifts from the traveling state to the braking state due to a response delay until the braking force is generated, and stops. Assuming that the host vehicle moves from the running state to the braking state at the maximum yaw rate and stops in accordance with the operation to respond to the lane departure during traveling in the automatic driving mode, the maximum lateral movement amount Δy * is calculated. Yes. Therefore, when it is determined that the vehicle can deviate from the lane during traveling in the automatic driving mode, the host vehicle can be automatically stopped at a position where the vehicle stays in the traveling lane.

実施例1では、走行状態での車両並進成分による横移動量Δy1と、走行状態での車両回転成分による横変位量Δy2と、制動状態での最小制動距離による横移動量Δysと、を個別に算出し、最大横移動量Δy*を、個別に算出した値を加算(Δy1+Δy2+Δys)することで算出する。   In the first embodiment, the lateral movement amount Δy1 due to the vehicle translation component in the traveling state, the lateral displacement amount Δy2 due to the vehicle rotation component in the traveling state, and the lateral displacement amount Δys due to the minimum braking distance in the braking state are individually set. The maximum lateral movement amount Δy * is calculated by adding the individually calculated values (Δy1 + Δy2 + Δys).

即ち、最大横移動量Δy*は、走行状態での車両並進成分による横移動量Δy1と、走行状態での車両回転成分による横変位量Δy2と、制動状態での最小制動距離による横移動量Δysと、の和として考えることができる。従って、個別に算出した横移動量Δy1と横変位量Δy2と横移動量Δysを加算して最大横移動量Δy*(=Δy1+Δy2+Δys)を算出することで、最大横移動量を精度よく算出することができる。   That is, the maximum lateral movement amount Δy * is the lateral movement amount Δy1 due to the vehicle translation component in the traveling state, the lateral displacement amount Δy2 due to the vehicle rotation component in the traveling state, and the lateral displacement amount Δys due to the minimum braking distance in the braking state. And the sum of Therefore, the maximum lateral movement amount can be accurately calculated by calculating the maximum lateral movement amount Δy * (= Δy1 + Δy2 + Δys) by adding the individually calculated lateral movement amount Δy1, lateral displacement amount Δy2, and lateral movement amount Δys. Can do.

次に、効果を説明する。
実施例1における車両のレーン逸脱判定方法とレーン逸脱判定装置にあっては、下記に列挙する効果が得られる。
Next, the effect will be described.
In the vehicle lane departure determination method and the lane departure determination apparatus according to the first embodiment, the following effects can be obtained.

(1) 走行中の自車両が走行レーンを逸脱するかどうかを判定する車両のレーン逸脱判定方法において、
車速情報とヨーレート情報に基づいて、走行中の自車両に発生し得る最大横移動量Δy*を算出する(図2のS3〜S5)。
算出された最大横移動量Δy*を用いてレーン逸脱閾値y*を設定する(図2のS6)。
走行中の自車両の横位置情報が、レーン逸脱閾値y*以上になるとレーン逸脱と判定する(図2のS8)。
このため、自車両の走行中、レーン逸脱対応の余裕時間が適切になるレーン逸脱判定を実現する車両のレーン逸脱判定方法を提供することができる。
(1) In the vehicle lane departure determination method for determining whether the traveling vehicle departs from the traveling lane,
Based on the vehicle speed information and the yaw rate information, the maximum lateral movement amount Δy * that can occur in the traveling vehicle is calculated (S3 to S5 in FIG. 2).
A lane departure threshold value y * is set using the calculated maximum lateral movement amount Δy * (S6 in FIG. 2).
When the lateral position information of the traveling vehicle is equal to or greater than the lane departure threshold y *, it is determined that the vehicle is lane departure (S8 in FIG. 2).
Therefore, it is possible to provide a vehicle lane departure determination method that realizes a lane departure determination in which a margin time corresponding to the lane departure is appropriate while the host vehicle is traveling.

(2) レーン逸脱閾値y*を設定するとき、算出された最大横移動量Δy*が大きいほどレーン逸脱と判定されやすい値に設定する(図2のS6)。
このため、(1)の効果に加え、レーン逸脱の判定に際し、乗員に対し不安やストレスを与えない車両を実現することができる。
(2) When setting the lane departure threshold value y *, the lane departure threshold value y * is set to a value that is more easily determined as a lane departure as the calculated maximum lateral movement amount Δy * is larger (S6 in FIG. 2).
For this reason, in addition to the effect of (1), it is possible to realize a vehicle that does not give anxiety or stress to the occupant when determining lane departure.

(3) 最大横移動量Δy*を算出するとき、自車両が最大ヨーレートにより走行状態から制動状態へと移行して停車すると想定し、想定最大ヨーレートベースでの自車両の横移動量により算出する(図3)。
このため、(2)の効果に加え、自動運転モードによる走行中にレーン逸脱し得ると判定されたとき、走行レーン内に留まる位置に自車両を自動停止させることができる。
(3) When calculating the maximum lateral movement amount Δy *, it is assumed that the host vehicle will shift from the running state to the braking state at the maximum yaw rate and stop and calculated based on the lateral movement amount of the host vehicle based on the assumed maximum yaw rate. (Figure 3).
For this reason, in addition to the effect of (2), when it is determined that the vehicle can depart from the lane during traveling in the automatic driving mode, the host vehicle can be automatically stopped at a position where the vehicle stays in the traveling lane.

(4) 最大横移動量Δy*を算出するとき、走行状態での車両並進成分による横移動量Δy1と、走行状態での車両回転成分による横変位量Δy2と、制動状態での最小制動距離による横移動量Δysと、を個別に算出し、個別に算出した値を加算(Δy1+Δy2+Δys)することで算出する(図4)。
このため、(3)の効果に加え、個別に算出した横移動量Δy1と横変位量Δy2と横移動量Δysを加算して最大横移動量Δy*を算出することで、最大横移動量Δy*を精度よく算出することができる。
(4) When calculating the maximum lateral movement amount Δy *, the lateral movement amount Δy1 due to the vehicle translation component in the traveling state, the lateral displacement amount Δy2 due to the vehicle rotation component in the traveling state, and the minimum braking distance in the braking state The lateral movement amount Δys is calculated separately, and is calculated by adding the individually calculated values (Δy1 + Δy2 + Δys) (FIG. 4).
For this reason, in addition to the effect of (3), the maximum lateral movement amount Δy * is calculated by adding the individually calculated lateral movement amount Δy1, lateral displacement amount Δy2, and lateral movement amount Δys to calculate the maximum lateral movement amount Δy *. * Can be calculated accurately.

(5) 走行中の自車両が走行レーンを逸脱するかどうかを判定する車両のレーン逸脱判定装置において、コントローラ(コントロールユニット5)は、最大横移動量算出部54と、レーン逸脱閾値設定部55と、レーン逸脱判定部57と、を有する。
最大横移動量算出部54は、車速情報とヨーレート情報に基づいて、走行中の自車両に発生し得る最大横移動量Δy*を算出する。
レーン逸脱閾値設定部55は、算出された最大横移動量Δy*を用いてレーン逸脱閾値y*を設定する。
レーン逸脱判定部57は、走行中の自車両の横位置情報が、レーン逸脱閾値y*以上になるとレーン逸脱と判定する(図1)。
このため、自車両の走行中、レーン逸脱対応の余裕時間が適切になるレーン逸脱判定を実現する車両のレーン逸脱判定装置を提供することができる。
(5) In the vehicle lane departure determination apparatus for determining whether the traveling vehicle departs from the traveling lane, the controller (control unit 5) includes a maximum lateral movement amount calculation unit 54 and a lane departure threshold setting unit 55. And a lane departure determination unit 57.
The maximum lateral movement amount calculation unit 54 calculates the maximum lateral movement amount Δy * that can occur in the traveling vehicle based on the vehicle speed information and the yaw rate information.
The lane departure threshold setting unit 55 sets the lane departure threshold y * using the calculated maximum lateral movement amount Δy *.
The lane departure determination unit 57 determines that the lane has departed when the lateral position information of the traveling vehicle is equal to or greater than the lane departure threshold y * (FIG. 1).
Therefore, it is possible to provide a vehicle lane departure determination device that realizes a lane departure determination in which a margin time corresponding to the lane departure is appropriate while the host vehicle is traveling.

実施例2は、最大横移動量を用いたレーン逸脱閾値に、車両センシング系における白線検知誤差のマージンとロケータ情報及び地図情報に基づいた自己位置推定誤差のマージンを加算し、レーン逸脱を判定する例である。   In the second embodiment, the margin of the white line detection error in the vehicle sensing system and the margin of the self-position estimation error based on the locator information and the map information are added to the lane departure threshold using the maximum lateral movement amount to determine the lane departure. It is an example.

まず、構成を説明する。
実施例2におけるレーン逸脱判定方法とレーン逸脱判定装置は、実施例1と同様に、自動運転モードにより自車両を走行させる走行制御、自動運転走行中にレーン逸脱との判定により自車両を停止させる制動制御を実行する自動運転車両に適用したものである。以下、実施例2の構成を、「全体システム構成」、「レーン逸脱判定による自動運転制御処理構成」に分けて説明する。
First, the configuration will be described.
The lane departure determination method and the lane departure determination apparatus according to the second embodiment, like in the first embodiment, travel control that causes the host vehicle to travel in the automatic driving mode, and stops the host vehicle based on the determination of the lane departure during the automatic driving travel. The present invention is applied to an autonomous driving vehicle that executes braking control. Hereinafter, the configuration of the second embodiment will be described by dividing it into “the overall system configuration” and “the automatic operation control processing configuration based on the lane departure determination”.

[全体システム構成]
図7は、実施例2のレーン逸脱判定方法とレーン逸脱判定装置が適用された自動運転車両のシステム構成を示す全体システム構成図である。以下、図7に基づき、全体システム構成を説明する。
[Overall system configuration]
FIG. 7 is an overall system configuration diagram illustrating a system configuration of an autonomous driving vehicle to which the lane departure determination method and the lane departure determination apparatus according to the second embodiment are applied. The overall system configuration will be described below with reference to FIG.

自動運転システムは、図7に示すように、自車速検出手段1と、ヨーレート検出手段2と、車線映像撮影手段3と、物体検出手段4と、コントロールユニット5と、車両制御手段6と、ロケータ7と、地図データベース8と、を備えている。
なお、自車速検出手段1、ヨーレート検出手段2、車線映像撮影手段3、物体検出手段4、車両制御手段6については、実施例1と同様の構成であるため説明を省略する。
As shown in FIG. 7, the automatic driving system includes an own vehicle speed detecting means 1, a yaw rate detecting means 2, a lane image photographing means 3, an object detecting means 4, a control unit 5, a vehicle control means 6, and a locator. 7 and a map database 8.
Note that the vehicle speed detection means 1, the yaw rate detection means 2, the lane image photographing means 3, the object detection means 4, and the vehicle control means 6 have the same configurations as those in the first embodiment, and therefore description thereof is omitted.

ロケータ7は、位置座標を表現するデータを与える入力装置であり、ある場所を基準にして、自車両が存在する位置情報(自己位置)を、方向や距離等で示す。このロケータ7が追加されたことにより、時々刻々における自車両の自己位置を推定可能となり、例えば、車線映像撮影手段3にて得られる走路境界としての白線に対する自車両の相対位置精度が向上する。   The locator 7 is an input device that provides data representing position coordinates, and indicates position information (self-position) where the host vehicle is present with a direction, a distance, and the like with respect to a certain place. By adding this locator 7, it becomes possible to estimate the self-position of the own vehicle from moment to moment, and for example, the relative position accuracy of the own vehicle with respect to the white line as the road boundary obtained by the lane image photographing means 3 is improved.

地図データベース8は、ロケータ7から得られる自己位置情報と連関できるように整備されている。この地図データベース8が追加されたことにより、ロケータ7から得られる自己位置情報と組合せれば、地図上に自車両の位置をかなりの高精度で重畳する(マップマッチング)ことができるようになる。これに加え、地図情報を用いることで、自車両に設定したセンシング系では得られない遠距離における走路境界情報、例えば、この先どこからカーブが始まるか、道幅がどの程度変化するか、という情報を積極的に活用することができる。   The map database 8 is prepared so as to be associated with the self-location information obtained from the locator 7. By adding this map database 8, when combined with the self-location information obtained from the locator 7, it becomes possible to superimpose the position of the vehicle on the map (map matching). In addition to this, by using map information, information on road boundary information at long distances that cannot be obtained with the sensing system set for the vehicle, such as where the curve starts and how much the road width changes, is positive. Can be used.

コントロールユニット5は、CPU,ROM,RAM等から構成され、自車両と走行車線における左右白線までの相対位置関係を定量的に把握することが可能である。このコントロールユニット5は、図7に示すように、車線白線検出部51と、他車両検出部52と、状況判断部53’と、最大横移動量算出部54’と、レーン逸脱閾値設定部55’と、走行車線検出部56と、レーン逸脱判定部57と、を有する。なお、車線白線検出部51、他車両検出部52、走行車線検出部56、レーン逸脱判定部57については、実施例1と同様の構成であるため説明を省略する。   The control unit 5 includes a CPU, a ROM, a RAM, and the like, and can quantitatively grasp the relative positional relationship between the host vehicle and the left and right white lines in the traveling lane. As shown in FIG. 7, the control unit 5 includes a lane white line detection unit 51, another vehicle detection unit 52, a situation determination unit 53 ′, a maximum lateral movement amount calculation unit 54 ′, and a lane departure threshold setting unit 55. ', A traveling lane detection unit 56, and a lane departure determination unit 57. Note that the lane white line detection unit 51, the other vehicle detection unit 52, the traveling lane detection unit 56, and the lane departure determination unit 57 have the same configurations as those in the first embodiment, and thus description thereof is omitted.

状況判断部53’は、自車速検出手段1からの自車速検出情報と、ヨーレート検出手段2からのヨーレート検出情報と、車線白線検出部51からの車線白線検出情報と、地図データベース8からの地図上での自己位置情報を入力する。そして、これらの入力情報に基づき、自車両における速度及び姿勢に関する運動状態量を含む自車両の走行状況に加え、地図上での自車両位置を判断する。   The situation determination unit 53 ′ includes the own vehicle speed detection information from the own vehicle speed detection unit 1, the yaw rate detection information from the yaw rate detection unit 2, the lane white line detection information from the lane white line detection unit 51, and the map from the map database 8. Enter the above self-location information. And based on these input information, in addition to the driving | running | working condition of the own vehicle containing the motion state quantity regarding the speed and attitude | position in the own vehicle, the own vehicle position on a map is judged.

最大横移動量算出部54’は、状況判断部53’からの自車両における速度及び姿勢に関する運動状態量の情報に基づき、走行中の自車両に発生し得る最大横移動量を算出すると共に、自己位置推定誤差及び白線検知誤差を算出する。この最大横移動量算出部54’では、自車両が最大ヨーレートにより走行状態から制動状態へと移行して停車すると想定し、想定最大ヨーレートベースでt秒後の自車両の横移動量を、最大横移動量とみなして算出する。自己位置推定誤差は、ロケータ情報及び地図情報に基づく推定誤差である。白線検知誤差は、車両センシング系における推定誤差である。   The maximum lateral movement amount calculation unit 54 ′ calculates the maximum lateral movement amount that can occur in the traveling vehicle based on the information on the motion state amount related to the speed and posture in the host vehicle from the situation determination unit 53 ′. Self-position estimation error and white line detection error are calculated. The maximum lateral movement amount calculation unit 54 ′ assumes that the host vehicle shifts from the running state to the braking state at the maximum yaw rate and stops, and calculates the maximum lateral movement amount of the host vehicle after t seconds based on the assumed maximum yaw rate. Calculated as the amount of lateral movement. The self-position estimation error is an estimation error based on locator information and map information. The white line detection error is an estimation error in the vehicle sensing system.

レーン逸脱閾値設定部55’は、レーン逸脱判定指標としてのレーン逸脱閾値を、最大横移動量算出部54’から取得された最大横移動量を用いたレーン逸脱閾値に、自己位置推定誤差と、白線検知誤差と、を加算して設定する。なお、最大横移動量を用いたレーン逸脱閾値は、最大横移動量算出部54’にて算出された最大横移動量が大きいほど、レーン逸脱と判定されやすい値に設定する。   The lane departure threshold setting unit 55 ′ uses the lane departure threshold as a lane departure determination index as a lane departure threshold using the maximum lateral movement amount acquired from the maximum lateral movement amount calculation unit 54 ′, a self-position estimation error, Set by adding white line detection error. Note that the lane departure threshold value using the maximum lateral movement amount is set to a value that is more likely to be determined as a lane departure as the maximum lateral movement amount calculated by the maximum lateral movement amount calculation unit 54 ′ is larger.

[レーン逸脱判定による自動運転制御処理構成]
図8は、実施例2のコントロールユニット5にて実行される車速・ヨーレートを考慮したレーン逸脱判定を有する自動運転制御処理の流れを示す。以下、自動運転制御処理構成をあらわす図8の各ステップについて説明する。なお、この自動運転制御処理は「自動運転モード」の選択により開始される。
[Automatic operation control processing configuration based on lane departure judgment]
FIG. 8 shows a flow of an automatic driving control process having a lane departure determination in consideration of the vehicle speed and yaw rate, which is executed by the control unit 5 of the second embodiment. Hereinafter, each step of FIG. 8 showing the automatic driving control processing configuration will be described. This automatic operation control process is started by selecting the “automatic operation mode”.

ステップS21では、車両パラメータを読み込み、ステップS22へ進む。
ここで、「車両パラメータ」とは、車両横幅W、車両回転中心〜車両前端隅部の長さLd、車速と停止距離のプロファイルのことをいう。
In step S21, vehicle parameters are read, and the process proceeds to step S22.
Here, the “vehicle parameter” means a profile of the vehicle lateral width W, the vehicle rotation center to the length Ld of the vehicle front end corner, the vehicle speed and the stop distance.

ステップS22では、ステップS21での車両パラメータの読み込みに続き、時々刻々における各種物理量を読み込み、ステップS23へ進む。
ここで、「各種物理量」とは、車速V、横位置、想定最大ヨーレートγ、ヨー角φ(ヨーレートγから導出)、地図情報(車線幅、曲率等)のことをいう。
In step S22, following the reading of the vehicle parameters in step S21, various physical quantities are read every moment, and the process proceeds to step S23.
Here, “various physical quantities” means vehicle speed V, lateral position, assumed maximum yaw rate γ, yaw angle φ (derived from yaw rate γ), map information (lane width, curvature, etc.).

ステップS23では、ステップS22での各種物理量の読み込みに続き、想定最大ヨーレートベースでt秒後の車両横移動量y1(t)を算出し、ステップS24へ進む。
ここで、車両横移動量y1(t)の算出は、
y1(t)=∫V(t)・sinφdt …(21)
の式を用いる。
In step S23, following the reading of various physical quantities in step S22, the vehicle lateral movement amount y1 (t) after t seconds is calculated based on the assumed maximum yaw rate, and the process proceeds to step S24.
Here, the calculation of the vehicle lateral movement amount y1 (t) is as follows:
y1 (t) = ∫V (t) · sinφdt (21)
Is used.

ステップS24では、ステップS23での車両横移動量y1(t)の算出に続き、想定最大ヨーレートベースでt秒後の回転に伴う車体横変位量y2(t)を算出し、ステップS25へ進む。
ここで、車体横変位量y2の算出は、
y2(t)=Ld・sin(φ+θ) …(22)
の式を用いる。なお、「θ」は、車両前後方向中心線上から車両前隅部の車両前後方向に対する見開き角である。
In step S24, following the calculation of the vehicle lateral movement amount y1 (t) in step S23, the vehicle body lateral displacement amount y2 (t) associated with the rotation after t seconds is calculated based on the assumed maximum yaw rate, and the process proceeds to step S25.
Here, the calculation of the vehicle body lateral displacement amount y2 is as follows.
y2 (t) = Ld · sin (φ + θ) (22)
Is used. “Θ” is a spread angle of the front corner of the vehicle with respect to the vehicle longitudinal direction from the vehicle longitudinal center line.

ステップS25では、ステップS24での車体横変位量y2(t)の算出に続き、想定最大ヨーレートベースで、t秒後に車両制動をかけた後から車両停止距離までの間の横移動量ys(t)を算出し、ステップS26へ進む。
ここで、横移動量ys(t)の算出は、
ys(t)=Ds(V)・sinφ …(23)
の式を用いる。なお、「Ds(V)」は、t秒後に自車両に制動をかけた際に、発生せざるを得ない最小制動距離である。
In step S25, following the calculation of the vehicle body lateral displacement amount y2 (t) in step S24, the lateral movement amount ys (t (t) from the time the vehicle is braked after t seconds to the vehicle stop distance on the basis of the assumed maximum yaw rate. ) And the process proceeds to step S26.
Here, the lateral movement amount ys (t) is calculated as follows:
ys (t) = Ds (V) · sinφ (23)
Is used. “Ds (V)” is the minimum braking distance that must be generated when the host vehicle is braked after t seconds.

ステップS26では、ステップS25での横移動量ys(t)の算出に続き、レーン逸脱閾値y*(t)を算出し、ステップS27へ進む。
ここで、レーン逸脱閾値y*(t)の算出は、
y*(t)=y1(t)+y2(t)+ys(t) …(24)
の式を用いる。
In step S26, following the calculation of the lateral movement amount ys (t) in step S25, a lane departure threshold value y * (t) is calculated, and the process proceeds to step S27.
Here, the calculation of the lane departure threshold y * (t) is
y * (t) = y1 (t) + y2 (t) + ys (t) (24)
Is used.

ステップS27では、ステップS26でのレーン逸脱閾値y*(t)の算出に続き、地図情報から、t秒後の自車両の中心に対する白線までの距離T(t)/2を算出し、ステップS28へ進む。   In step S27, following the calculation of the lane departure threshold y * (t) in step S26, a distance T (t) / 2 from the map information to the white line with respect to the center of the host vehicle after t seconds is calculated, and step S28 is performed. Proceed to

ステップS28では、ステップS27でのt秒後の自車両中心に対する白線までの距離T(t)/2の算出に続き、自己位置情報等から、実路と地図上の道路のズレによる自己位置推定誤差Ta(t)、及び、車両センシング系に基づく白線検知誤差Tb(t)を算出し、ステップS29へ進む。   In step S28, following the calculation of the distance T (t) / 2 to the white line with respect to the center of the vehicle after t seconds in step S27, self-position estimation based on the deviation of the actual road and the road on the map from the self-position information and the like. The error Ta (t) and the white line detection error Tb (t) based on the vehicle sensing system are calculated, and the process proceeds to step S29.

ステップS29では、ステップS28での自己位置推定誤差Ta(t)、白線検知誤差Tb(t)の算出に続き、{∫V(t)・sinφdt+Ld・sin(φ+θ)+Ds(V)・sinφ}+Ta(t)+Tb(t)<T(t)/2であるか否かを判定する。YES(y*<T(t)/2)の場合はステップS30へ進み、NO(y*≧T(t)/2)の場合はステップS31へ進む。
ここで、ステップS29で用いられる関係式のうち、左辺である
{∫V(t)・sinφdt+Ld・sin(φ+θ)+Ds(V)・sinφ}+Ta(t)+Tb(t)
は、自車両に発生し得る最大横移動量を用いたレーン逸脱閾値y*(t)に、自己位置推定誤差Ta(t)と白線検知誤差Tb(t)を加えることで最終的に設定されたレーン逸脱閾値y*である。
In step S29, following the calculation of the self-position estimation error Ta (t) and white line detection error Tb (t) in step S28, {∫V (t) · sinφdt + Ld · sin (φ + θ) + Ds (V) · sinφ } + Ta (t) + Tb (t) <T (t) / 2. If YES (y * <T (t) / 2), the process proceeds to step S30. If NO (y * ≧ T (t) / 2), the process proceeds to step S31.
Here, it is the left side of the relational expression used in step S29.
{∫V (t) · sinφdt + Ld · sin (φ + θ) + Ds (V) · sinφ} + Ta (t) + Tb (t)
Is finally set by adding the self-position estimation error Ta (t) and the white line detection error Tb (t) to the lane departure threshold y * (t) using the maximum amount of lateral movement that can occur in the host vehicle. The lane departure threshold y *.

ステップS30では、ステップS29でのy*<T(t)/2であるとの判定に続き、レーン逸脱していないと判定し、自動運転モードを継続し、リターンへ進む。   In step S30, following the determination that y * <T (t) / 2 in step S29, it is determined that there is no lane departure, the automatic operation mode is continued, and the process proceeds to return.

ステップS31では、ステップS29でのy*≧T(t)/2であるとの判定に続き、レーン逸脱と判定し、設定された制動制御により所定の停止距離で停止し、エンドへ進む。なお、エンドへ進むと、リセット処理等が行われる。   In step S31, following the determination that y * ≧ T (t) / 2 in step S29, it is determined that the vehicle has deviated from the lane, the vehicle is stopped at a predetermined stop distance by the set braking control, and the process proceeds to the end. When the process proceeds to the end, reset processing or the like is performed.

次に、作用を説明する。
実施例2の作用を、「レーン逸脱判定による自動運転制御処理作用」、「レーン逸脱閾値の設定作用」、「レーン逸脱判定の特徴作用」に分けて説明する。
Next, the operation will be described.
The operation of the second embodiment will be described by dividing it into “automatic operation control processing operation by lane departure determination”, “lane departure threshold setting operation”, and “lane departure determination characteristic operation”.

[レーン逸脱判定による自動運転制御処理作用]
以下、図8のフローチャートに基づき、レーン逸脱判定による自動運転制御処理作用を説明する。
[Automatic operation control processing action by lane departure judgment]
Hereinafter, based on the flowchart of FIG. 8, the automatic operation control processing operation by the lane departure determination will be described.

自動運転モードでの走行中、図8のフローチャートにおいて、ステップS21→ステップS22→ステップS23→ステップS24→ステップS25→ステップS26→ステップS27→ステップS28へと進む。ステップS23では、想定最大ヨーレートベースでt秒後の車両横移動量y1(t)が算出される。ステップS24では、想定最大ヨーレートベースでt秒後の回転に伴う車体横変位量y2(t)が算出される。ステップS25では、想定最大ヨーレートベースで、t秒後に車両制動をかけた後から車両停止距離までの間の横移動量ys(t)が算出される。そして、ステップS26では、レーン逸脱閾値y*(t)が、想定最大ヨーレートベースで算出された車両横移動量y1(t)と車体横変位量y2(t)と横移動量ys(t)とを加算して算出される。ステップS27では、自車両の中心に対する白線までの距離T(t)/2が算出される。ステップS28では、自己位置推定誤差Ta(t)と白線検知誤差Tb(t)が算出される。   During traveling in the automatic operation mode, in the flowchart of FIG. 8, the process proceeds from step S21 → step S22 → step S23 → step S24 → step S25 → step S26 → step S27 → step S28. In step S23, the vehicle lateral movement amount y1 (t) after t seconds is calculated based on the assumed maximum yaw rate. In step S24, the vehicle body lateral displacement amount y2 (t) associated with the rotation after t seconds is calculated based on the assumed maximum yaw rate. In step S25, on the basis of the assumed maximum yaw rate, a lateral movement amount ys (t) from after the vehicle is braked after t seconds to the vehicle stop distance is calculated. In step S26, the lane departure threshold value y * (t) is calculated based on the assumed maximum yaw rate, the vehicle lateral movement amount y1 (t), the vehicle body lateral displacement amount y2 (t), and the lateral movement amount ys (t). It is calculated by adding. In step S27, a distance T (t) / 2 to the white line with respect to the center of the host vehicle is calculated. In step S28, a self-position estimation error Ta (t) and a white line detection error Tb (t) are calculated.

そして、ステップS28からステップS29へと進むと、ステップS29では、距離T(t)/2がレーン逸脱閾値y*を超えているか否かが判定される。ステップS29にてy*<T(t)/2であると判定されると、ステップS29からステップS30へ進み、ステップS30では、レーン逸脱していないと判定され、自動運転モードが継続される。さらに、y*<T(t)/2と判定されている間は、ステップS21→ステップS22→ステップS23→ステップS24→ステップS25→ステップS26→ステップS27→ステップS28→ステップS29→ステップS30へと進む流れが繰り返され、自動運転モードが継続される。   When the process proceeds from step S28 to step S29, it is determined in step S29 whether or not the distance T (t) / 2 exceeds the lane departure threshold y *. If it is determined in step S29 that y * <T (t) / 2, the process proceeds from step S29 to step S30. In step S30, it is determined that there is no lane departure, and the automatic operation mode is continued. Furthermore, while it is determined that y * <T (t) / 2, step S21 → step S22 → step S23 → step S24 → step S25 → step S26 → step S27 → step S28 → step S29 → step S30. The forward flow is repeated and the automatic operation mode is continued.

一方、ステップS29にてy*≧T(t)/2であると判定されると、ステップS29からステップS31へ進み、ステップS31では、レーン逸脱と判定され、設定された制動制御によって所定の停止距離で自車両を停止される制御が行われる。   On the other hand, if it is determined in step S29 that y * ≧ T (t) / 2, the process proceeds from step S29 to step S31. In step S31, a lane departure is determined, and a predetermined stop is performed by the set braking control. Control to stop the vehicle at a distance is performed.

このように、実施例2のレーン逸脱判定による自動運転制御処理においては、
(a) 自車両に発生し得る最大横移動量を用いたレーン逸脱閾値y*(t)に、自己位置推定誤差Ta(t)と白線検知誤差Tb(t)を加えてレーン逸脱閾値y*を設定する。
(b) レーン逸脱を判定するときの走行中の自車両の横位置情報を、現時点からt秒経過した後に自車両が存在すると推定される位置としている。
という点で実施例1と相違する。
Thus, in the automatic operation control process by the lane departure determination of the second embodiment,
(a) A lane departure threshold y * by adding a self-position estimation error Ta (t) and a white line detection error Tb (t) to the lane departure threshold y * (t) using the maximum amount of lateral movement that can occur in the host vehicle. Set.
(b) The lateral position information of the traveling vehicle at the time of determining the lane departure is the position where the traveling vehicle is estimated to exist after t seconds from the current time.
This is different from the first embodiment.

[レーン逸脱閾値の設定作用]
実施例2において、自動運転モードでの走行中、モード継続/モード停止を決めるレーン逸脱判定で用いられるレーン逸脱閾値y*の設定作用を、図9及び図10に基づいて説明する。なお、実施例1との共通部分の説明は割愛する。
[Setting effect of lane departure threshold]
In Example 2, the setting operation of the lane departure threshold y * used in the lane departure determination for determining mode continuation / mode stop during traveling in the automatic operation mode will be described with reference to FIGS. In addition, description of a common part with Example 1 is omitted.

実施例2における時刻tにて車速Vの自車両が制動をかけた際のレーン逸脱閾値の考え方を図9に示す。t=0において車線幅は地図データベースから得られる時系列情報とも解釈できるのでT(t)とおく。T(t)の中心線に自車両の前後中心線を合わせて車速V(t)にて走行中の自車両が、時刻tにて制動をかけたと想定する。この場合の最大横移動量y*(t)との関係において、時々刻々における車両に生じているヨーレートγに伴うヨー角φ(t)(即ち、φ(t)=∫γdt)を用いれば、下記関係式が成立している限り自車両は車線内に留まれる、即ちレーン逸脱しないと考えられる。尚、前述の実施例1と同様にプロファイリングの上与えられるΔDsに関しては、そのパラメータの1つとして制動時の車速Vを必ず含むので、実施例2においてはDs(V)と記述する。
y*(t)+W/2<T(t)/2
⇔y1(t)+y2(t)+ys(t)+W/2<T(t)/2
⇔{∫V(t)・sinφdt+Ld・sin(φ+θ)−W/2+Ds(V)・sinφ}+W/2<T(t)/2
⇔{∫V(t)・sinφdt+Ld・sin(φ+θ)+Ds(V)・sinφ}<T(t)/2 …(31)
但し、実施例2においてマップマッチング機能により地図上の車線中央に車両中心線を合わせて自車両を制御しても、実世界の路面上では同様に自車両が車線中央に位置するとは限らない。これは、ロケータ7に基く自己位置情報と、車両センシング系から得られる画像をはじめとした検出情報にそれぞれ誤差を含みうるためであり、これらに対しては各々修正係数を設定することでレーン逸脱閾値判定の実路に則した精度向上を図ることが可能である。
FIG. 9 shows the concept of the lane departure threshold when the host vehicle at the vehicle speed V is braked at time t in the second embodiment. At t = 0, the lane width can be interpreted as time-series information obtained from the map database, so it is set as T (t). It is assumed that the host vehicle traveling at the vehicle speed V (t) with the center line of the host vehicle aligned with the center line of T (t) braked at time t. In this case, in relation to the maximum lateral movement amount y * (t), if the yaw angle φ (t) (that is, φ (t) = ∫γdt) accompanying the yaw rate γ occurring in the vehicle from moment to moment is used, As long as the following relational expression holds, it is considered that the host vehicle stays in the lane, that is, does not depart from the lane. Note that ΔDs given by profiling as in the first embodiment described above always includes the vehicle speed V at the time of braking as one of its parameters, so in the second embodiment, it is described as Ds (V).
y * (t) + W / 2 <T (t) / 2
⇔y1 (t) + y2 (t) + ys (t) + W / 2 <T (t) / 2
⇔ {∫V (t) · sinφdt + Ld · sin (φ + θ) −W / 2 + Ds (V) · sinφ} + W / 2 <T (t) / 2
⇔ {∫V (t) · sinφdt + Ld · sin (φ + θ) + Ds (V) · sinφ} <T (t) / 2 (31)
However, even if the host vehicle is controlled by aligning the vehicle center line with the center of the lane on the map by the map matching function in the second embodiment, the host vehicle is not always located at the center of the lane on the road surface in the real world. This is because the self-location information based on the locator 7 and detection information including an image obtained from the vehicle sensing system may each contain an error. It is possible to improve the accuracy in accordance with the actual threshold judgment.

上記の含み得る誤差の考え方を図10に示す。この場合において自己位置情報に伴う誤差修正係数を自己位置推定誤差Ta(t)とし、検出情報に伴う誤差修正係数を白線検知誤差Tb(t)とし、これを走路境界に対するマージンとして設定すれば、上記式(31)は、
{∫V(t)・sinφdt+Ld・sin(φ+θ)+Ds(V)・sinφ}+Ta(t)+Tb(t)<T(t)/2
…(32)
と書き換えることができる。
The concept of the error that can be included is shown in FIG. In this case, if the error correction coefficient accompanying the self-position information is the self-position estimation error Ta (t), the error correction coefficient accompanying the detection information is the white line detection error Tb (t), and this is set as a margin for the road boundary, The above equation (31) is
{∫V (t) · sinφdt + Ld · sin (φ + θ) + Ds (V) · sinφ} + Ta (t) + Tb (t) <T (t) / 2
… (32)
Can be rewritten.

よって、上記(32)に示す関係式から明らかなように、最大横移動量を用いたレーン逸脱閾値y*(t)に、自己位置推定誤差Ta(t)と白線検知誤差Tb(t)を加えると、レーン逸脱判定指標としてのレーン逸脱閾値y*が設定できることが解る。そして、自動運転車両に実装した際の図8に示すフローチャートにおいては、上記(32)に示す関係式の左辺をレーン逸脱閾値y*とし、上記(32)に示す関係式の右辺を自車両の横位置情報とし、レーン逸脱の有無を判定するようにしている。   Therefore, as is clear from the relational expression shown in (32) above, the self-position estimation error Ta (t) and the white line detection error Tb (t) are added to the lane departure threshold y * (t) using the maximum lateral movement amount. In addition, it can be seen that a lane departure threshold value y * as a lane departure determination index can be set. In the flowchart shown in FIG. 8 when mounted on an autonomous driving vehicle, the left side of the relational expression shown in the above (32) is the lane departure threshold y *, and the right side of the relational expression shown in the above (32) is the own vehicle. The lateral position information is used to determine whether or not there is a lane departure.

[レーン逸脱判定の特徴作用]
実施例2では、レーン逸脱判定指標としてのレーン逸脱閾値y*を、走行中の自車両に発生し得る最大横移動量を用いたレーン逸脱閾値y*(t)に、車両センシング系における白線検知誤差Tb(t)をマージンとして加算して設定する。
[Characteristic effect of lane departure judgment]
In the second embodiment, the lane departure threshold value y * as the lane departure determination index is set to the lane departure threshold value y * (t) using the maximum lateral movement amount that can be generated in the traveling vehicle, and white line detection in the vehicle sensing system is performed. The error Tb (t) is added and set as a margin.

即ち、自車両に搭載したセンシング系では、測定誤差が発生することがある。具体的には、カメラやレーザレンジファインダ等の出力信号から得られる解像度の限界に起因して測定誤差が発生する。そこで、これらを予め把握しておくことでレーン逸脱閾値にマージンを持たせることができる。従って、レーン逸脱判定指標を設定する際、車両センシング系における白線検知誤差Tb(t)をマージンとして加算することで、レーン逸脱対応の余裕時間をより確実に持たせたタイミングにてレーン逸脱を判定することができる。   That is, a measurement error may occur in the sensing system mounted on the host vehicle. Specifically, a measurement error occurs due to a resolution limit obtained from an output signal from a camera, a laser range finder, or the like. Therefore, it is possible to give a margin to the lane departure threshold value by grasping these in advance. Therefore, when setting the lane departure determination index, the white line detection error Tb (t) in the vehicle sensing system is added as a margin, so that the lane departure is determined at a timing with more certain margin time for lane departure. can do.

実施例2では、レーン逸脱判定指標としてのレーン逸脱閾値y*を、走行中の自車両に発生し得る最大横移動量を用いたレーン逸脱閾値y*(t)に、ロケータ情報及び地図情報に基づいた自己位置推定誤差Ta(t)をマージンとして加算して設定する。   In the second embodiment, the lane departure threshold y * as the lane departure determination index is set to the lane departure threshold y * (t) using the maximum lateral movement amount that can be generated in the traveling vehicle, and the locator information and the map information are used. The self-position estimation error Ta (t) based on this is added and set as a margin.

即ち、実施例2は、GPS等に基づくロケータ情報及び地図から得られる情報(緯度経度,道幅,曲率等)に基づいた自己位置推定機能を利用している。このため、相対的により遠くの走行環境を把握しながら、且つ、地図の有する精度に基づき、道路(走行車線)のセンタ基準で候補ラインを設定し、自車両の前後方向中心線がその候補ラインの接線と一致するように走行できる。しかし、自己位置推定機能に基づく地図上での車両位置と、実世界における走行車線上での自車両位置は、場合によっては多少の乖離を発生させることがある。そこで、これらの傾向を予め把握しておくことでレーン逸脱閾値にマージンを持たせることができる。従って、レーン逸脱判定指標を設定する際、ロケータ情報及び地図情報に基づいた自己位置推定誤差Ta(t)をマージンとして加算することで、自車両がレーン逸脱をするかしないかの判定を的確に実現することができる。   That is, the second embodiment uses a self-position estimation function based on locator information based on GPS or the like and information (latitude / longitude, road width, curvature, etc.) obtained from a map. Therefore, a candidate line is set based on the center reference of the road (running lane) while grasping a relatively far traveling environment and based on the accuracy of the map, and the front-rear direction center line of the host vehicle is the candidate line. You can drive to match the tangent line. However, the vehicle position on the map based on the self-position estimation function and the vehicle position on the driving lane in the real world may cause a slight divergence in some cases. Therefore, it is possible to give a margin to the lane departure threshold value by grasping these trends in advance. Therefore, when setting the lane departure determination index, by adding the self-position estimation error Ta (t) based on the locator information and the map information as a margin, it is possible to accurately determine whether or not the vehicle deviates from the lane. Can be realized.

次に、効果を説明する。
実施例2における車両のレーン逸脱判定方法とレーン逸脱判定装置にあっては、下記の効果が得られる。
Next, the effect will be described.
In the vehicle lane departure determination method and the lane departure determination apparatus according to the second embodiment, the following effects can be obtained.

(6) レーン逸脱閾値y*を設定するとき、走行中の自車両に発生し得る最大横移動量を用いたレーン逸脱閾値y*(t)に、車両センシング系における白線検知誤差Tb(t)をマージンとして加算して設定する(図10)。
このため、上記(1)〜(5)の効果に加え、レーン逸脱閾値y*を設定する際、車両センシング系における白線検知誤差Tb(t)をマージンとして加算することで、レーン逸脱対応の余裕時間をより確実に持たせたタイミングにてレーン逸脱を判定することができる。
(6) When the lane departure threshold value y * is set, the white line detection error Tb (t) in the vehicle sensing system is added to the lane departure threshold value y * (t) using the maximum amount of lateral movement that can occur in the traveling vehicle. Are added and set as a margin (FIG. 10).
For this reason, in addition to the effects (1) to (5) above, when setting the lane departure threshold value y *, the white line detection error Tb (t) in the vehicle sensing system is added as a margin, so that the margin for lane departure can be accommodated. Lane departure can be determined at a timing with more certain time.

(7) レーン逸脱閾値y*を設定するとき、走行中の自車両に発生し得る最大横移動量を用いたレーン逸脱閾値y*(t)に、ロケータ情報及び地図情報に基づいた自己位置推定誤差Ta(t)をマージンとして加算して設定する(図10)。
このため、上記(1)〜(6)の効果に加え、レーン逸脱閾値y*を設定する際、ロケータ情報及び地図情報に基づいた自己位置推定誤差Ta(t)をマージンとして加算することで、自車両がレーン逸脱をするかしないかの判定を的確に実現することができる。
(7) When setting the lane departure threshold value y *, the lane departure threshold value y * (t) using the maximum amount of lateral movement that can be generated in the traveling vehicle is estimated based on the locator information and map information. The error Ta (t) is added and set as a margin (FIG. 10).
For this reason, in addition to the effects (1) to (6) above, when setting the lane departure threshold y *, the self-position estimation error Ta (t) based on the locator information and the map information is added as a margin, It is possible to accurately determine whether or not the host vehicle deviates from the lane.

以上、本開示の車両のレーン逸脱判定方法とレーン逸脱判定装置を実施例1及び実施例2に基づき説明してきた。しかし、具体的な構成については、これらの実施例に限られるものではなく、特許請求の範囲の各請求項に係る発明の要旨を逸脱しない限り、設計の変更や追加等は許容される。   The vehicle lane departure determination method and the lane departure determination apparatus according to the present disclosure have been described based on the first and second embodiments. However, the specific configuration is not limited to these examples, and design changes and additions are permitted without departing from the spirit of the invention according to each claim of the claims.

実施例1,2では、自車両の左側がレーン逸脱をする/レーン逸脱しないを例とした。しかし、自車両に対し右側で判定する場合、両側でレーン逸脱を判定する場合、右側又は左側の何れか機能している側のみを用いて判定する場合、車両センシング系は左側でありながらも、道幅や車幅或いは地図情報等を勘案して、左側だけでなく右側のレーン逸脱判定できる場合、等も含むものとする。   In the first and second embodiments, the left side of the host vehicle deviates / does not deviate from the lane. However, when judging on the right side of the own vehicle, when judging lane departure on both sides, when judging using only the functioning side of either the right side or the left side, the vehicle sensing system is on the left side, In consideration of road width, vehicle width, map information, etc., it is possible to include not only left side but also right side lane departure judgment.

実施例1,2では、自車両が最大ヨーレートにより走行状態から制動状態へと移行して停車すると想定し、最大横移動量を、想定最大ヨーレートベースでの自車両の横移動量により算出する例を示した。しかし、最大横移動量を算出するに際し、例えば、横ずれにより走行する自車両が走行レーンのセンタ位置に復帰することを想定し、最大横移動量を算出する例であっても良い。又、そのときの車速とヨーレートによる横移動で自車両が走行状態のままでレーン逸脱することを想定し、レーン逸脱に要する時間で最大横移動量を算出するような例としても良い。   In the first and second embodiments, it is assumed that the host vehicle shifts from the running state to the braking state at the maximum yaw rate and stops, and the maximum lateral movement amount is calculated based on the lateral movement amount of the host vehicle based on the assumed maximum yaw rate. showed that. However, when calculating the maximum lateral movement amount, for example, it may be an example in which the maximum lateral movement amount is calculated on the assumption that the host vehicle traveling due to lateral deviation returns to the center position of the travel lane. It is also possible to calculate the maximum lateral movement amount in the time required for the lane departure, assuming that the vehicle deviates from the lane while the vehicle is running due to the lateral movement based on the vehicle speed and yaw rate at that time.

実施例1,2では、走行中の時々刻々における車速に対する“必要制動距離”、“許容(発生し得る)ヨーレート”を予め設定・把握しておき、これらの数値をベースとして自車両に発生し得る最大横移動量を算出する例を示した。しかし、これらの情報に、次に走行する道路のパス形状(直線、曲線等)を加味して自車両に発生し得る最大横移動量を算出するようにしても良い。   In the first and second embodiments, “required braking distance” and “allowable (possible) yaw rate” with respect to the vehicle speed at every moment during traveling are set and grasped in advance, and these values are generated on the host vehicle based on these values. An example of calculating the maximum lateral movement amount to be obtained has been shown. However, the maximum amount of lateral movement that can occur in the host vehicle may be calculated by adding the path shape (straight line, curve, etc.) of the next road to this information.

実施例1,2では、本開示の車両の旋回走行ライン生成方法と旋回走行ライン生成装置を、乗員が搭乗している有人の自動運転車両に適用する例を示した。しかし、本開示の旋回走行ライン生成方法と旋回走行ライン生成装置は、有人の自動運転車両に限られず、無人の自動運転車両に適用することもできる。さらに、レーン逸脱防止に関する運転支援機能を持つ車両に対しても適用することができるし、自車両がレーン逸脱しそうなときドライバーに対し警報を発する車両に対しても適用することができる。   In the first and second embodiments, an example in which the turning traveling line generation method and the turning traveling line generation device for a vehicle according to the present disclosure are applied to a manned automatic driving vehicle on which an occupant is aboard is shown. However, the turning traveling line generation method and the turning traveling line generation device of the present disclosure are not limited to manned automatic driving vehicles, but can also be applied to unmanned automatic driving vehicles. Furthermore, the present invention can be applied to a vehicle having a driving support function related to lane departure prevention, and can also be applied to a vehicle that issues a warning to the driver when the own vehicle is likely to depart from the lane.

1 自車速検出手段
2 ヨーレート検出手段
3 車線映像撮影手段
4 物体検出手段
5 コントロールユニット
51 車線白線検出部
52 他車両検出部
53,53’ 状況判断部
54,54’ 最大横移動量算出部
55,55’ レーン逸脱閾値設定部
56 走行車線検出部
57 レーン逸脱判定部
6 車両制御手段
7 ロケータ
8 地図データベース
DESCRIPTION OF SYMBOLS 1 Own vehicle speed detection means 2 Yaw rate detection means 3 Lane image imaging means 4 Object detection means 5 Control unit 51 Lane white line detection part 52 Other vehicle detection parts 53, 53 'Situation judgment part 54, 54' Maximum lateral movement amount calculation part 55, 55 'Lane departure threshold setting unit 56 Driving lane detection unit 57 Lane departure determination unit 6 Vehicle control means 7 Locator 8 Map database

Claims (7)

走行中の自車両が走行レーンを逸脱するかどうかを判定する車両のレーン逸脱判定方法において、
車速情報とヨーレート情報に基づいて、走行中の自車両に発生し得る最大横移動量を算出し、
算出された前記最大横移動量を用いてレーン逸脱閾値を設定し、
走行中の自車両の横位置情報が、前記レーン逸脱閾値以上になるとレーン逸脱と判定する
ことを特徴とする車両のレーン逸脱判定方法。
In the vehicle lane departure determination method for determining whether the traveling vehicle deviates from the travel lane,
Based on the vehicle speed information and the yaw rate information, the maximum amount of lateral movement that can occur in the traveling vehicle is calculated,
A lane departure threshold is set using the calculated maximum lateral movement amount,
A vehicle lane departure determination method, comprising: determining a lane departure when lateral position information of a running vehicle is equal to or greater than the lane departure threshold.
請求項1に記載された車両のレーン逸脱判定方法において、
前記レーン逸脱閾値を設定するとき、算出された前記最大横移動量が大きいほどレーン逸脱と判定されやすい値に設定する
ことを特徴とする車両のレーン逸脱判定方法。
The vehicle lane departure determination method according to claim 1,
When setting the lane departure threshold value, the vehicle lane departure determination method is characterized in that as the calculated maximum lateral movement amount is larger, the value is more easily determined as a lane departure.
請求項1又は請求項2に記載された車両のレーン逸脱判定方法において、
前記最大横移動量を算出するとき、自車両が最大ヨーレートにより走行状態から制動状態へと移行して停車すると想定し、想定最大ヨーレートベースでの自車両の横移動量により算出する
ことを特徴とする車両のレーン逸脱判定方法。
In the vehicle lane departure determination method according to claim 1 or 2,
When calculating the maximum lateral movement amount, it is assumed that the host vehicle shifts from the running state to the braking state at the maximum yaw rate and stops, and is calculated from the lateral movement amount of the host vehicle based on the assumed maximum yaw rate. A vehicle lane departure determination method.
請求項3に記載された車両のレーン逸脱判定方法において、
前記最大横移動量を算出するとき、走行状態での車両並進成分による横移動量と、走行状態での車両回転成分による横変位量と、制動状態での最小制動距離による横移動量と、を個別に算出し、個別に算出した値を加算することで算出する
ことを特徴とする車両のレーン逸脱判定方法。
The vehicle lane departure determination method according to claim 3,
When calculating the maximum lateral movement amount, the lateral movement amount by the vehicle translation component in the traveling state, the lateral displacement amount by the vehicle rotation component in the traveling state, and the lateral movement amount by the minimum braking distance in the braking state A vehicle lane departure determination method, characterized in that the calculation is performed by individually calculating and adding the individually calculated values.
請求項1から請求項4までの何れか一項に記載された車両のレーン逸脱判定方法において、
前記レーン逸脱閾値を設定するとき、走行中の自車両に発生し得る前記最大横移動量を用いた前記レーン逸脱閾値に、車両センシング系における白線検知誤差をマージンとして加算して設定する
ことを特徴とする車両のレーン逸脱判定方法。
In the vehicle lane departure determination method according to any one of claims 1 to 4,
When the lane departure threshold is set, the white line detection error in the vehicle sensing system is added as a margin to the lane departure threshold using the maximum lateral movement amount that can occur in the traveling vehicle. A vehicle lane departure determination method.
請求項1から請求項5までの何れか一項に記載された車両のレーン逸脱判定方法において、
前記レーン逸脱閾値を設定するとき、走行中の自車両に発生し得る前記最大横移動量を用いた前記レーン逸脱閾値に、ロケータ情報及び地図情報に基づいた自己位置推定誤差をマージンとして加算して設定する
ことを特徴とする車両のレーン逸脱判定方法。
In the vehicle lane departure determination method according to any one of claims 1 to 5,
When setting the lane departure threshold, a self-position estimation error based on locator information and map information is added as a margin to the lane departure threshold using the maximum amount of lateral movement that can occur in the traveling vehicle. A vehicle lane departure determination method, characterized by: setting.
走行中の自車両が走行レーンを逸脱するかどうかを判定するコントローラを備える車両のレーン逸脱判定装置において、
前記コントローラは、
車速情報とヨーレート情報に基づいて、走行中の自車両に発生し得る最大横移動量を算出する最大横移動量算出部と、
算出された前記最大横移動量を用いてレーン逸脱閾値を設定するレーン逸脱閾値設定部と、
走行中の自車両の横位置情報が、前記レーン逸脱閾値以上になるとレーン逸脱と判定するレーン逸脱判定部と、
を有することを特徴とするレーン逸脱判定装置。
In a vehicle lane departure determination device including a controller for determining whether the traveling vehicle deviates from the travel lane,
The controller is
A maximum lateral movement amount calculation unit that calculates a maximum lateral movement amount that can occur in the traveling vehicle based on the vehicle speed information and the yaw rate information;
A lane departure threshold setting unit for setting a lane departure threshold using the calculated maximum lateral movement amount;
A lane departure determination unit that determines a lane departure when lateral position information of the traveling vehicle is equal to or greater than the lane departure threshold;
A lane departure determination device characterized by comprising:
JP2016170865A 2016-09-01 2016-09-01 Vehicle lane departure determination method and lane departure determination apparatus Active JP6720783B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2016170865A JP6720783B2 (en) 2016-09-01 2016-09-01 Vehicle lane departure determination method and lane departure determination apparatus

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2016170865A JP6720783B2 (en) 2016-09-01 2016-09-01 Vehicle lane departure determination method and lane departure determination apparatus

Publications (2)

Publication Number Publication Date
JP2018034719A true JP2018034719A (en) 2018-03-08
JP6720783B2 JP6720783B2 (en) 2020-07-08

Family

ID=61565141

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016170865A Active JP6720783B2 (en) 2016-09-01 2016-09-01 Vehicle lane departure determination method and lane departure determination apparatus

Country Status (1)

Country Link
JP (1) JP6720783B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109263660A (en) * 2018-11-12 2019-01-25 江铃汽车股份有限公司 A kind of lane shift pre-warning and control method for looking around image system based on 360 °
US20210405641A1 (en) * 2020-06-29 2021-12-30 Lyft, Inc. Detecting positioning of a sensor system associated with a vehicle

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1083499A (en) * 1996-09-10 1998-03-31 Mazda Motor Corp Vehicle position/direction angle detection device
JP2001114081A (en) * 1999-08-09 2001-04-24 Toyota Motor Corp Driving stability control device
JP2002157698A (en) * 2000-11-22 2002-05-31 Natl Inst For Land & Infrastructure Management Mlit Lane departure prevention support system using forward linear information
JP2015210764A (en) * 2014-04-30 2015-11-24 日産自動車株式会社 Traveling lane recognition device and traveling lane recognition method

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1083499A (en) * 1996-09-10 1998-03-31 Mazda Motor Corp Vehicle position/direction angle detection device
JP2001114081A (en) * 1999-08-09 2001-04-24 Toyota Motor Corp Driving stability control device
JP2002157698A (en) * 2000-11-22 2002-05-31 Natl Inst For Land & Infrastructure Management Mlit Lane departure prevention support system using forward linear information
JP2015210764A (en) * 2014-04-30 2015-11-24 日産自動車株式会社 Traveling lane recognition device and traveling lane recognition method

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109263660A (en) * 2018-11-12 2019-01-25 江铃汽车股份有限公司 A kind of lane shift pre-warning and control method for looking around image system based on 360 °
US20210405641A1 (en) * 2020-06-29 2021-12-30 Lyft, Inc. Detecting positioning of a sensor system associated with a vehicle
US12399496B2 (en) * 2020-06-29 2025-08-26 Lyft, Inc. Detecting positioning of a sensor system associated with a vehicle

Also Published As

Publication number Publication date
JP6720783B2 (en) 2020-07-08

Similar Documents

Publication Publication Date Title
JP6905397B2 (en) Autonomous driving method based on stereo camera, autonomous driving device and computer program
US9229453B1 (en) Unified motion planner for autonomous driving vehicle in avoiding the moving obstacle
JP6384604B2 (en) Self-position estimation apparatus and self-position estimation method
CN108349532B (en) System for controlling a steering device of a motor vehicle in the event of an imminent collision with an obstacle
US9227632B1 (en) Method of path planning for evasive steering maneuver
JP7278705B2 (en) AUTONOMOUS ROUTE GENERATION METHOD AND DEVICE THEREOF
US9037379B2 (en) Apparatus and method for providing a crash prevention control functionality for a vehicle
JP6243931B2 (en) Vehicle travel control device
US10147003B2 (en) Lane detection device and method thereof, curve starting point detection device and method thereof, and steering assistance device and method thereof
US9610976B2 (en) Lane departure prevention control system for vehicle
CN106043302B (en) The cruise active control system and its method of vehicle
JP6432679B2 (en) Stop position setting apparatus and method
JP6123297B2 (en) Driving support device
US11415999B2 (en) Traveling control system and method of autonomous vehicle
KR101812863B1 (en) Vehicle control system
JP6076394B2 (en) Vehicle steering apparatus and vehicle steering control method
JP6222786B2 (en) Vehicle travel control device
KR20190113918A (en) Driving assistance method and driving assistance device
US20130179036A1 (en) Lane tracking system with active rear-steer
KR101748269B1 (en) Apparatus and method for automatic steering control in vehicle
CN110709911A (en) Driving assistance method of driving assistance device and driving assistance device
CN103370250A (en) Driving assistance device, driving assistance method, and driving assistance program
CN106794838A (en) For at least semi-autonomous method for manipulating motor vehicles, driver assistance system and motor vehicles
CN103109312A (en) Method for warning a driver of a motor vehicle of an obstacle present in a side area next to a side flank of the vehicle and motor vehicle with a driver assistance system
JP2018024345A (en) Vehicle travel control device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190328

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200107

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20191226

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200225

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200317

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200413

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200601

R151 Written notification of patent or utility model registration

Ref document number: 6720783

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151