JP2018203108A - Vehicle control device - Google Patents

Vehicle control device Download PDF

Info

Publication number
JP2018203108A
JP2018203108A JP2017111763A JP2017111763A JP2018203108A JP 2018203108 A JP2018203108 A JP 2018203108A JP 2017111763 A JP2017111763 A JP 2017111763A JP 2017111763 A JP2017111763 A JP 2017111763A JP 2018203108 A JP2018203108 A JP 2018203108A
Authority
JP
Japan
Prior art keywords
vehicle
speed
travel route
obstacle
target
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
JP2017111763A
Other languages
Japanese (ja)
Other versions
JP6521487B2 (en
Inventor
大村 博志
Hiroshi Omura
博志 大村
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.)
Mazda Motor Corp
Original Assignee
Mazda Motor Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Mazda Motor Corp filed Critical Mazda Motor Corp
Priority to JP2017111763A priority Critical patent/JP6521487B2/en
Publication of JP2018203108A publication Critical patent/JP2018203108A/en
Application granted granted Critical
Publication of JP6521487B2 publication Critical patent/JP6521487B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

To provide a vehicle control device that can inhibit a vehicle from deviating from a travelling lane when avoiding an obstacle even if the device cannot detect a border line of the lane.SOLUTION: A vehicle control device (ECU) 10 is configured to arrange a speed distribution region 40 for specifying a distribution of allowable upper limit values Vof a relative speed of a vehicle 1 to an obstacle 3, between the obstacle 3 and the vehicle 1, and to execute travelling route correction processing (S15) for correcting a target travelling route R to calculate a corrected target travelling route Rc, to prevent the relative speed of the vehicle 1 from exceeding the allowable upper-limit values Vand allow the vehicle 1 to avoid the obstacle 3, if a vehicle 3 is travelling on a lane 7. The travelling route correction processing includes approach processing (S27) for calculating corrected target travelling routes (approach target travelling routes Rc1_a-Rc3_a) so that the vehicle approaches the obstacle 3 in a lateral direction when border lines (8L and 8R) of the lane 7 are not detected (S24:No).SELECTED DRAWING: Figure 5

Description

本発明は、車両制御装置に係り、特に、車両の安全走行を支援する車両制御装置に関する。   The present invention relates to a vehicle control device, and more particularly to a vehicle control device that supports safe driving of a vehicle.

車線逸脱防止に関する種々の車両運転支援技術が提案されている。特許文献1には、特に、車線の一方の区画線が検出できない場合に仮想的な区画線を設定し、車線逸脱防止等の運転支援を実行する技術が記載されている。   Various vehicle driving support technologies relating to lane departure prevention have been proposed. Japanese Patent Application Laid-Open No. 2004-151867 describes a technique for setting a virtual lane line and executing driving support such as prevention of lane departure when one lane line of a lane cannot be detected.

特開2014−142965号公報JP 2014-142965 A

しかしながら、例えば、区画線が検出できない期間が長くなると、仮想的な区画線の信頼性が低くなる。このため、走行車線上の障害物(例えば、駐車車両)を回避する場合、車両が現実の区画線を超えてしまい、車線を逸脱するおそれがあるという問題があった。   However, for example, if the period during which the lane marking cannot be detected becomes longer, the reliability of the virtual lane marking becomes lower. For this reason, when an obstacle (for example, a parked vehicle) on the traveling lane is avoided, there is a problem that the vehicle may exceed the actual lane line and depart from the lane.

本発明は、このような問題を解決するためになされたものであり、走行車線の境界線が検出できない場合であっても、障害物を回避する際に車線の逸脱を抑制することが可能な車両制御装置を提供することを目的とする。   The present invention has been made to solve such a problem, and even when a boundary line of a traveling lane cannot be detected, deviation of the lane can be suppressed when avoiding an obstacle. An object is to provide a vehicle control device.

上記の目的を達成するために、本発明は、車両が走行する車線の目標走行経路を設定する車両制御装置であって、目標走行経路は、目標位置及び目標速度を含み、車線上に障害物が存在する場合、障害物と車両との間に、障害物に対する車両の相対速度の許容上限値の分布を規定する速度分布領域を設定し、車両の相対速度が許容上限値を超えず、且つ、車両が障害物を回避するように、目標走行経路を補正して補正目標走行経路を計算する走行経路補正処理を実行するように構成されており、走行経路補正処理は、車線の境界線が検出されていない場合には、境界線が検出されている場合と比べて、横方向において障害物に近づくように補正目標走行経路を計算する接近処理を含むことを特徴とする。   In order to achieve the above object, the present invention provides a vehicle control device for setting a target travel route of a lane in which a vehicle travels, the target travel route including a target position and a target speed, and an obstacle on the lane. Is set between the obstacle and the vehicle, a speed distribution region that defines the distribution of the allowable upper limit value of the relative speed of the vehicle with respect to the obstacle, the relative speed of the vehicle does not exceed the allowable upper limit value, and The vehicle is configured to execute a travel route correction process for correcting the target travel route and calculating a corrected target travel route so that the vehicle avoids an obstacle. Compared with the case where the boundary line is detected when not detected, it includes an approach process for calculating the corrected target travel route so as to approach the obstacle in the lateral direction.

このように構成された本発明によれば、車線の境界線が検出されていない場合には、境界線が検出されている場合よりも障害物に近づくように、補正目標走行経路が計算される。これにより、車線の境界線が検出されていない場合であっても、障害物を回避しつつ、車両が車線を逸脱するおそれを低減することができる。   According to the present invention configured as described above, when the boundary line of the lane is not detected, the corrected target travel route is calculated so as to be closer to the obstacle than when the boundary line is detected. . Thereby, even if it is a case where the boundary line of a lane is not detected, a possibility that a vehicle may deviate from a lane can be reduced, avoiding an obstruction.

本発明において、好ましくは、走行経路補正処理は、車線の境界線が検出されていない場合には、境界線が検出されている場合と比べて、目標走行経路に対する横方向への回避距離が小さく制限された補正目標走行経路を計算する制限処理を更に含み、所定条件に応じて、接近処理と制限処理のいずれかが実行される。
このように構成された本発明によれば、所定条件に応じて接近処理と制限処理のいずれかにより補正目標走行経路を計算することができる。
In the present invention, it is preferable that the travel route correction process has a smaller avoidance distance in the lateral direction with respect to the target travel route when the boundary line of the lane is not detected than when the boundary line is detected. It further includes a restriction process for calculating the restricted corrected target travel route, and either the approach process or the restriction process is executed according to a predetermined condition.
According to the present invention configured as described above, the corrected target travel route can be calculated by either the approach process or the restriction process according to a predetermined condition.

本発明において、好ましくは、所定条件は、障害物の種類であり、障害物が静止物の場合には接近処理が実行される。
このように構成された本発明によれば、静止物(例えば、停車車両、電柱等)の場合は、障害物に接近しても衝突のおそれは極めて低い。よって、この場合は、接近処理を実行することにより、障害物により近づくように補正目標走行経路を計算することができる。
In the present invention, preferably, the predetermined condition is the type of the obstacle, and when the obstacle is a stationary object, the approach process is executed.
According to the present invention configured as described above, in the case of a stationary object (for example, a stopped vehicle, a utility pole, etc.), the possibility of a collision is extremely low even when approaching an obstacle. Therefore, in this case, the corrected target travel route can be calculated so as to be closer to the obstacle by executing the approach process.

本発明において、好ましくは、所定条件は、車両の車速であり、車両の車速が所定車速以下の場合には接近処理が実行される。
このように構成された本発明によれば、車両が障害物に接近する際に速度分布領域に基づいて車速が減速されるが、車速が所定車速以下の低速の場合には減速幅が小さい。よって、この場合は、運転者に違和感を与えることなく、車線逸脱のおそれを低減することができる。
In the present invention, preferably, the predetermined condition is a vehicle speed of the vehicle. When the vehicle speed is equal to or lower than the predetermined vehicle speed, the approach process is executed.
According to the present invention configured as above, the vehicle speed is decelerated based on the speed distribution region when the vehicle approaches the obstacle, but the deceleration width is small when the vehicle speed is a low speed equal to or lower than the predetermined vehicle speed. Therefore, in this case, the risk of lane departure can be reduced without causing the driver to feel uncomfortable.

本発明において、好ましくは、所定条件は、車両のステアリングホイールに対する把持力の大きさであり、把持力が所定値以下の場合には接近処理が実行される。
このように構成された本発明によれば、運転者がステアリングホイールを握っていない場合には、運転者自身の操舵による車線逸脱回避操作が期待されない。よって、この場合は、接近処理により、障害物により近づく補正目標走行経路を計算することにより、車線逸脱のおそれを抑制することができる。
In the present invention, preferably, the predetermined condition is the magnitude of the gripping force with respect to the steering wheel of the vehicle, and the approaching process is executed when the gripping force is equal to or less than a predetermined value.
According to the present invention configured as described above, when the driver does not hold the steering wheel, the lane departure avoidance operation by the driver's own steering is not expected. Therefore, in this case, the possibility of lane departure can be suppressed by calculating the corrected target travel route that approaches the obstacle by the approach process.

本発明によれば、走行車線の境界線が検出できない場合であっても、障害物を回避する際に車線の逸脱を抑制することが可能な車両制御装置を提供することができる。   ADVANTAGE OF THE INVENTION According to this invention, even when it is a case where the boundary line of a driving lane cannot be detected, the vehicle control apparatus which can suppress the deviation of a lane when avoiding an obstacle can be provided.

本発明の実施形態における車両制御システムの構成図である。It is a lineblock diagram of the vehicle control system in the embodiment of the present invention. 本発明の実施形態における運転支援モードと目標走行経路との関係を示す説明図である。It is explanatory drawing which shows the relationship between the driving assistance mode and target driving | running route in embodiment of this invention. 本発明の実施形態における障害物回避制御の説明図である。It is explanatory drawing of the obstacle avoidance control in embodiment of this invention. 本発明の実施形態の障害物回避制御における障害物と車両との間のすれ違い速度の許容上限値とクリアランスとの関係を示す説明図である。It is explanatory drawing which shows the relationship between the allowable upper limit of the passing speed between the obstruction and the vehicle in the obstruction avoidance control of embodiment of this invention, and clearance. 本発明の実施形態における直線優先モード選択時における接近処理後の補正目標走行経路の説明図である。It is explanatory drawing of the correction | amendment target driving | running route after the approach process at the time of the straight line priority mode selection in embodiment of this invention. 本発明の実施形態における中間モード選択時における接近処理後の補正目標走行経路の説明図である。It is explanatory drawing of the correction | amendment target driving | running route after the approach process at the time of intermediate mode selection in embodiment of this invention. 本発明の実施形態における速度優先モード選択時における接近処理後の補正目標走行経路の説明図である。It is explanatory drawing of the correction | amendment target driving | running route after the approach process at the time of speed priority mode selection in embodiment of this invention. 本発明の実施形態における運転支援制御の処理フローである。It is a processing flow of the driving assistance control in the embodiment of the present invention. 本発明の実施形態における走行経路補正処理の処理フローである。It is a processing flow of the travel route correction process in the embodiment of the present invention. 本発明の改変例における直線優先モード選択時における制限処理後の補正目標走行経路の説明図である。It is explanatory drawing of the correction | amendment target driving | running route after the restriction | limiting process at the time of the straight line priority mode selection in the modification of this invention. 本発明の改変例における中間モード選択時における制限処理後の補正目標走行経路の説明図である。It is explanatory drawing of the correction | amendment target travel route after the restriction | limiting process at the time of intermediate mode selection in the modification of this invention. 本発明の改変例における速度優先モード選択時における制限処理後の補正目標走行経路の説明図である。It is explanatory drawing of the correction | amendment target driving | running route after the restriction | limiting process at the time of speed priority mode selection in the modification of this invention. 本発明の改変例における走行経路補正処理の処理フローである。It is a processing flow of the travel route correction process in the modification of this invention.

以下、添付図面を参照して、本発明の実施形態による車両制御システムについて説明する。まず、図1を参照して、車両制御システムの構成について説明する。図1は、車両制御システムの構成図である。   Hereinafter, a vehicle control system according to an embodiment of the present invention will be described with reference to the accompanying drawings. First, the configuration of the vehicle control system will be described with reference to FIG. FIG. 1 is a configuration diagram of a vehicle control system.

本実施形態の車両制御システム100は、車両1(図3等参照)に対して複数の運転支援モードにより、それぞれ異なる運転支援制御を提供するように構成されている。運転者は、複数の運転支援モードから所望の運転支援モードを選択可能である。   The vehicle control system 100 of the present embodiment is configured to provide different driving support controls to the vehicle 1 (see FIG. 3 and the like) by a plurality of driving support modes. The driver can select a desired driving support mode from a plurality of driving support modes.

図1に示すように、車両制御システム100は、車両1に搭載されており、車両制御装置(ECU)10と、複数のセンサ及びスイッチと、複数の制御システムと、運転支援モードについてのユーザ入力を行うための運転者操作部35を備えている。複数のセンサ及びスイッチには、車載カメラ21,ミリ波レーダ22,車両の挙動を検出する複数の挙動センサ(車速センサ23,加速度センサ24,ヨーレートセンサ25)及び複数の挙動スイッチ(操舵角センサ26,アクセルセンサ27,ブレーキセンサ28,把持センサ34),測位システム29,ナビゲーションシステム30が含まれる。また、複数の制御システムには、エンジン制御システム31,ブレーキ制御システム32,ステアリング制御システム33が含まれる。   As shown in FIG. 1, a vehicle control system 100 is mounted on a vehicle 1, and includes a vehicle control device (ECU) 10, a plurality of sensors and switches, a plurality of control systems, and user input for a driving support mode. A driver operation unit 35 is provided. The plurality of sensors and switches include an in-vehicle camera 21, a millimeter wave radar 22, a plurality of behavior sensors (vehicle speed sensor 23, acceleration sensor 24, yaw rate sensor 25) for detecting the behavior of the vehicle, and a plurality of behavior switches (steering angle sensor 26). , Accelerator sensor 27, brake sensor 28, grip sensor 34), positioning system 29, and navigation system 30 are included. The plurality of control systems include an engine control system 31, a brake control system 32, and a steering control system 33.

運転者操作部35は、運転者が操作可能なように車両1の車室内に設けられており、複数の運転支援モードから所望の運転支援モードを選択するためのモード選択スイッチ36と、選択された運転支援モードに応じて設定車速を入力するための設定車速入力部37と、障害物に対する回避モードを選択するための回避モード選択スイッチ38とを備えている。運転者がモード選択スイッチ36を操作することにより、選択された運転支援モードに応じた運転支援モード選択信号が出力される。また、運転者が設定車速入力部37を操作することにより、設定車速信号が出力される。また、回避モード選択スイッチ38を操作することにより、回避モード選択信号が出力される。   The driver operation unit 35 is provided in the passenger compartment of the vehicle 1 so that the driver can operate, and is selected with a mode selection switch 36 for selecting a desired driving support mode from a plurality of driving support modes. A set vehicle speed input unit 37 for inputting a set vehicle speed according to the driving support mode, and an avoidance mode selection switch 38 for selecting an avoidance mode for an obstacle. When the driver operates the mode selection switch 36, a driving support mode selection signal corresponding to the selected driving support mode is output. Further, when the driver operates the set vehicle speed input unit 37, a set vehicle speed signal is output. Further, by operating the avoidance mode selection switch 38, an avoidance mode selection signal is output.

ECU10は、CPU,各種プログラムを記憶するメモリ,入出力装置等を備えたコンピュータにより構成される。ECU10は、運転者操作部35から受け取った運転支援モード選択信号,設定車速信号,回避モード選択信号、及び、複数のセンサ及びスイッチから受け取った信号に基づき、エンジン制御システム31,ブレーキ制御システム32,ステアリング制御システム33に対して、それぞれエンジンシステム,ブレーキシステム,ステアリングシステムを適宜に作動させるための要求信号を出力可能に構成されている。   The ECU 10 includes a computer having a CPU, a memory for storing various programs, an input / output device, and the like. The ECU 10 is based on the driving support mode selection signal, the set vehicle speed signal, the avoidance mode selection signal received from the driver operation unit 35, and the signals received from the plurality of sensors and switches, the engine control system 31, the brake control system 32, The steering control system 33 is configured to be able to output request signals for appropriately operating the engine system, the brake system, and the steering system, respectively.

車載カメラ21は、車両1の周囲を撮像し、撮像した画像データを出力する。ECU10は、画像データに基づいて対象物(例えば、車両、歩行者、道路、区画線(白線、黄線)、交通信号、交通標識、停止線、交差点、障害物等)を特定する。なお、ECU10は、交通インフラや車々間通信等によって、車載通信機器を介して外部から対象物の情報を取得してもよい。   The in-vehicle camera 21 images the surroundings of the vehicle 1 and outputs the captured image data. The ECU 10 identifies an object (for example, vehicle, pedestrian, road, lane marking (white line, yellow line), traffic signal, traffic sign, stop line, intersection, obstacle, etc.) based on the image data. In addition, ECU10 may acquire the information of a target object from the exterior via a vehicle-mounted communication apparatus by traffic infrastructure, vehicle-to-vehicle communication, etc.

ミリ波レーダ22は、対象物(特に、先行車、駐車車両、歩行者、障害物等)の位置及び速度を測定する測定装置であり、車両1の前方へ向けて電波(送信波)を送信し、対象物により送信波が反射されて生じた反射波を受信する。そして、ミリ波レーダ22は、送信波と受信波に基づいて、車両1と対象物との間の距離(例えば、車間距離)や車両1に対する対象物の相対速度を測定する。なお、本実施形態において、ミリ波レーダ22に代えて、レーザレーダや超音波センサ等を用いて対象物との距離や相対速度を測定するように構成してもよい。また、複数のセンサを用いて、位置及び速度測定装置を構成してもよい。   The millimeter wave radar 22 is a measuring device that measures the position and speed of an object (particularly, a preceding vehicle, a parked vehicle, a pedestrian, an obstacle, etc.), and transmits radio waves (transmitted waves) toward the front of the vehicle 1. Then, the reflected wave generated by reflecting the transmission wave by the object is received. The millimeter wave radar 22 measures the distance between the vehicle 1 and the object (for example, the inter-vehicle distance) and the relative speed of the object with respect to the vehicle 1 based on the transmitted wave and the received wave. In the present embodiment, instead of the millimeter wave radar 22, a distance from the object and a relative speed may be measured using a laser radar, an ultrasonic sensor, or the like. Moreover, you may comprise a position and speed measuring apparatus using a some sensor.

車速センサ23は、車両1の絶対速度を検出する。
加速度センサ24は、車両1の加速度(前後方向の縦加減速度、横方向の横加速度)を検出する。
ヨーレートセンサ25は、車両1のヨーレートを検出する。
操舵角センサ26は、車両1のステアリングホイールの回転角度(操舵角)を検出する。
アクセルセンサ27は、アクセルペダルの踏み込み量を検出する。
ブレーキセンサ28は、ブレーキペダルの踏み込み量を検出する。
把持センサ34は、運転者によるステアリングホイールの把持力を検出する。
The vehicle speed sensor 23 detects the absolute speed of the vehicle 1.
The acceleration sensor 24 detects the acceleration (vertical acceleration / deceleration in the front-rear direction, lateral acceleration in the horizontal direction) of the vehicle 1.
The yaw rate sensor 25 detects the yaw rate of the vehicle 1.
The steering angle sensor 26 detects the rotation angle (steering angle) of the steering wheel of the vehicle 1.
The accelerator sensor 27 detects the amount of depression of the accelerator pedal.
The brake sensor 28 detects the amount of depression of the brake pedal.
The grip sensor 34 detects the grip force of the steering wheel by the driver.

測位システム29は、GPSシステム及び/又はジャイロシステムであり、車両1の位置(現在車両位置情報)を検出する。
ナビゲーションシステム30は、内部に地図情報を格納しており、ECU10へ地図情報を提供することができる。ECU10は、地図情報及び現在車両位置情報に基づいて、車両1の周囲(特に、進行方向前方)に存在する道路、交差点、交通信号、建造物等を特定する。地図情報は、ECU10内に格納されていてもよい。
The positioning system 29 is a GPS system and / or a gyro system, and detects the position of the vehicle 1 (current vehicle position information).
The navigation system 30 stores map information therein and can provide the map information to the ECU 10. The ECU 10 specifies roads, intersections, traffic signals, buildings, etc. existing around the vehicle 1 (particularly in the forward direction) based on the map information and the current vehicle position information. The map information may be stored in the ECU 10.

エンジン制御システム31は、車両1のエンジンを制御するコントローラである。ECU10は、車両1を加速又は減速させる必要がある場合に、エンジン制御システム31に対して、エンジン出力の変更を要求するエンジン出力変更要求信号を出力する。   The engine control system 31 is a controller that controls the engine of the vehicle 1. When it is necessary to accelerate or decelerate the vehicle 1, the ECU 10 outputs an engine output change request signal requesting the engine control system 31 to change the engine output.

ブレーキ制御システム32は、車両1のブレーキ装置を制御するためのコントローラである。ECU10は、車両1を減速させる必要がある場合に、ブレーキ制御システム32に対して、車両1への制動力の発生を要求するブレーキ要求信号を出力する。   The brake control system 32 is a controller for controlling the brake device of the vehicle 1. When it is necessary to decelerate the vehicle 1, the ECU 10 outputs a brake request signal requesting the brake control system 32 to generate a braking force on the vehicle 1.

ステアリング制御システム33は、車両1のステアリング装置を制御するコントローラである。ECU10は、車両1の進行方向を変更する必要がある場合に、ステアリング制御システム33に対して、操舵方向の変更を要求する操舵方向変更要求信号を出力する。   The steering control system 33 is a controller that controls the steering device of the vehicle 1. When it is necessary to change the traveling direction of the vehicle 1, the ECU 10 outputs a steering direction change request signal for requesting the steering control system 33 to change the steering direction.

次に、本実施形態による車両制御システム100が備える運転支援モードについて説明する。本実施形態では、運転支援モードとして、4つのモード(先行車追従モード、自動速度制御モード、速度制限モード、基本制御モード)が備えられている。   Next, the driving support mode provided in the vehicle control system 100 according to the present embodiment will be described. In the present embodiment, four modes (preceding vehicle follow-up mode, automatic speed control mode, speed limit mode, and basic control mode) are provided as driving support modes.

先行車追従モードは、基本的に、車両1と先行車との間に車速に応じた所定の車間距離を維持しつつ、車両1を先行車に追従走行させるモードであり、車両制御システム100による自動的なステアリング制御,速度制御(エンジン制御,ブレーキ制御),障害物回避制御(速度制御及びステアリング制御)を伴う。   The preceding vehicle follow-up mode is basically a mode in which the vehicle 1 follows the preceding vehicle while maintaining a predetermined inter-vehicle distance corresponding to the vehicle speed between the vehicle 1 and the preceding vehicle. It involves automatic steering control, speed control (engine control, brake control), and obstacle avoidance control (speed control and steering control).

先行車追従モードでは、車線両端部(境界線)の検出の可否、及び、先行車の有無に応じて、異なるステアリング制御及び速度制御が行われる。ここで、車線両端部とは、車両1が走行する車線の両側の境界線(白線等の区画線,道路端,縁石,中央分離帯,ガードレール等)であり、隣接する車線や歩道等との境界である。走行路端部検出部としてのECU10は、この車線両端部を車載カメラ21により撮像された画像データから検出する。また、ナビゲーションシステム30の地図情報から車線両端部を検出してもよい。しかしながら、例えば、区画線が消えかかっている場合、区画線が存在しない場合、車載カメラ21からの画像データの読取り不良等の場合に車線両端部が検出できない場合が生じ得る。   In the preceding vehicle follow-up mode, different steering control and speed control are performed depending on whether or not both ends (boundary lines) of the lane can be detected and whether there is a preceding vehicle. Here, both ends of the lane are boundary lines (lane lines such as white lines, road edges, curbs, median strips, guardrails, etc.) on both sides of the lane in which the vehicle 1 travels. It is a boundary. The ECU 10 serving as the travel path end detection unit detects both ends of the lane from image data captured by the in-vehicle camera 21. Further, both end portions of the lane may be detected from the map information of the navigation system 30. However, for example, when the lane line is about to disappear, when the lane line does not exist, or when the image data from the in-vehicle camera 21 is poorly read, both ends of the lane may not be detected.

なお、上記実施形態では、ECU10を走行路端部検出部としているが、これに限らず、走行路端部検出部としての車載カメラ21が車線両端部を検出してもよいし、走行路端部検出部としての車載カメラ21とECU10が協働して車線両端部を検出してもよい。   In the above embodiment, the ECU 10 is used as the road end detection unit. However, the present invention is not limited to this, and the vehicle-mounted camera 21 as the road end detection unit may detect both ends of the lane. The vehicle-mounted camera 21 as the unit detection unit and the ECU 10 may detect both ends of the lane in cooperation.

また、本実施形態では、先行車検出部としてのECU10は、車載カメラ21による画像データ及びミリ波レーダ22による測定データにより、先行車を検出する。具体的には、車載カメラ21による画像データにより前方を走行する他車両を走行車として検出する。更に、本実施形態では、ミリ波レーダ22による測定データにより、車両1と他車両との車間距離が所定距離(例えば、400〜500m)以下である場合に、当該他車両が先行車として検出される。   In the present embodiment, the ECU 10 as the preceding vehicle detection unit detects the preceding vehicle based on the image data from the in-vehicle camera 21 and the measurement data from the millimeter wave radar 22. Specifically, another vehicle traveling ahead is detected as a traveling vehicle based on image data from the in-vehicle camera 21. Furthermore, in this embodiment, when the inter-vehicle distance between the vehicle 1 and the other vehicle is equal to or less than a predetermined distance (for example, 400 to 500 m), the other vehicle is detected as a preceding vehicle based on the measurement data obtained by the millimeter wave radar 22. The

なお、上記実施形態では、ECU10を先行車検出部としているが、これに限らず、先行車検出部としての車載カメラ21が前方を走行する他車両を検出してもよく、ECU10に加えて車載カメラ21及びミリ波レーダ22が先行車両検出部の一部を構成してもよい。   In the embodiment described above, the ECU 10 is used as the preceding vehicle detection unit. However, the present invention is not limited to this, and the in-vehicle camera 21 serving as the preceding vehicle detection unit may detect other vehicles traveling ahead. The camera 21 and the millimeter wave radar 22 may constitute a part of the preceding vehicle detection unit.

まず、車線両端部が検出される場合、車両1は、車線の中央付近を走行するようにステアリング制御され、設定車速入力部37を用いて運転者によって又は所定の処理に基づいてシステム100によって予め設定された設定車速(一定速度)を維持するように速度制御される。なお、設定車速が制限車速(速度標識やカーブの曲率に応じて規定される制限速度)よりも大きい場合は制限車速が優先され、車両1の車速は制限車速に制限される。カーブの曲率に応じて規定される制限速度は、所定の計算式により計算され、カーブの曲率が大きい(曲率半径が小さい)ほど低速度に設定される。   First, when both ends of the lane are detected, the vehicle 1 is steered so as to travel near the center of the lane, and is set in advance by the driver using the set vehicle speed input unit 37 or by the system 100 based on a predetermined process. The speed is controlled so as to maintain the set vehicle speed (constant speed). When the set vehicle speed is higher than the limit vehicle speed (the limit speed defined according to the speed sign or the curvature of the curve), the limit vehicle speed is given priority, and the vehicle speed of the vehicle 1 is limited to the limit vehicle speed. The speed limit defined according to the curvature of the curve is calculated by a predetermined calculation formula, and the speed is set to be lower as the curvature of the curve is larger (the curvature radius is smaller).

なお、車両1の設定車速が先行車の車速よりも大きい場合は、車両1は、車速に応じた車間距離を維持しながら先行車に追従するように速度制御される。また、追従していた先行車が車線変更等により、車両1の前方に存在しなくなると、車両1は、再び設定車速を維持するように速度制御される。   When the set vehicle speed of the vehicle 1 is higher than the vehicle speed of the preceding vehicle, the vehicle 1 is speed-controlled so as to follow the preceding vehicle while maintaining an inter-vehicle distance corresponding to the vehicle speed. In addition, when the preceding vehicle that has been followed does not exist in front of the vehicle 1 due to a lane change or the like, the vehicle 1 is speed-controlled so as to maintain the set vehicle speed again.

また、車線両端部が検出されない場合であって、且つ、先行車が存在する場合、車両1は、先行車の走行軌跡を追従するようにステアリング制御され、且つ、先行車の走行軌跡上の速度に追従するように速度制御される。   Further, when both ends of the lane are not detected and there is a preceding vehicle, the vehicle 1 is steered to follow the traveling locus of the preceding vehicle, and the speed on the traveling locus of the preceding vehicle is The speed is controlled so as to follow.

また、車線両端部が検出されない場合であって、且つ、先行車も存在しない場合、走行路上での走行位置を特定できない(区画線等検出不可、先行車追従不可)。この場合、現在の走行挙動(操舵角、ヨーレート、車速、加減速度等)を運転者の意思により維持又は変更するように、運転者がステアリングホイール,アクセルペダル,ブレーキペダルを操作することにより、ステアリング制御及び速度制御を実行する。   In addition, when both ends of the lane are not detected and there is no preceding vehicle, the traveling position on the traveling path cannot be specified (division line etc. cannot be detected, and the preceding vehicle cannot be followed). In this case, the driver operates the steering wheel, accelerator pedal, and brake pedal so that the current driving behavior (steering angle, yaw rate, vehicle speed, acceleration / deceleration, etc.) is maintained or changed according to the driver's intention. Perform control and speed control.

なお、先行車追従モードでは、先行車の有無、車線両端部の検出の可否にかかわらず、後述する障害物回避制御(速度制御及びステアリング制御)が更に自動的に実行される。   In the preceding vehicle follow-up mode, obstacle avoidance control (speed control and steering control), which will be described later, is further automatically executed regardless of whether there is a preceding vehicle and whether both ends of the lane can be detected.

また、自動速度制御モードは、運転者によって又はシステム100によって予め設定された所定の設定車速(一定速度)を維持するように速度制御するモードであり、車両制御システム100による自動的な速度制御(エンジン制御,ブレーキ制御),障害物回避制御(速度制御)を伴うが、ステアリング制御は行われない。この自動速度制御モードでは、車両1は、設定車速を維持するように走行するが、運転者によるアクセルペダルの踏み込みにより設定車速を超えて増速され得る。また、運転者がブレーキ操作を行った場合には、運転者の意思が優先され、設定車速から減速される。また、先行車に追いついた場合には、車速に応じた車間距離を維持しながら先行車に追従するように速度制御され、先行車が存在しなくなると、再び設定車速に復帰するように速度制御される。   The automatic speed control mode is a mode in which speed control is performed so as to maintain a predetermined set vehicle speed (constant speed) set in advance by the driver or by the system 100, and automatic speed control by the vehicle control system 100 ( Engine control, brake control) and obstacle avoidance control (speed control) are involved, but steering control is not performed. In this automatic speed control mode, the vehicle 1 travels so as to maintain the set vehicle speed, but can be increased beyond the set vehicle speed by depressing the accelerator pedal by the driver. Further, when the driver performs a brake operation, the driver's intention is prioritized and the vehicle is decelerated from the set vehicle speed. In addition, when catching up with the preceding vehicle, the speed is controlled so as to follow the preceding vehicle while maintaining the inter-vehicle distance according to the vehicle speed, and when there is no preceding vehicle, the speed control is performed so that it returns to the set vehicle speed again. Is done.

また、速度制限モードは、車両1の車速が速度標識による制限速度又は運転者によって設定された設定速度を超えないように、速度制御するモードであり、車両制御システム100による自動的な速度制御(エンジン制御)を伴う。制限速度は、車載カメラ21により撮像された速度標識や路面上の速度表示の画像データをECU10が画像認識処理することにより特定してもよいし、外部からの無線通信により受信してもよい。速度制限モードでは、運転者が制限速度を超えるようにアクセルペダルを踏み込んだ場合であっても、車両1は制限速度までしか増速されない。   The speed limit mode is a mode for speed control so that the vehicle speed of the vehicle 1 does not exceed the speed limit set by the speed indicator or the set speed set by the driver. With engine control). The speed limit may be specified when the ECU 10 performs image recognition processing on the speed sign imaged by the in-vehicle camera 21 or the image data of the speed display on the road surface, or may be received by wireless communication from the outside. In the speed limit mode, even when the driver depresses the accelerator pedal so as to exceed the speed limit, the vehicle 1 is increased only to the speed limit.

また、基本制御モードは、運転者操作部35により、運転支援モードが選択されていないときのモード(オフモード)であり、車両制御システム100による自動的なステアリング制御及び速度制御は行われない。ただし、自動衝突防止制御は実行されるように構成されており、この制御において、車両1が先行車等に衝突する可能性がある場合には自動的にブレーキ制御が実行され、衝突が回避される。また、自動衝突防止制御は、先行車追従モード,自動速度制御,速度制限モードにおいても同様に実行される。   The basic control mode is a mode (off mode) when the driving support mode is not selected by the driver operation unit 35, and automatic steering control and speed control by the vehicle control system 100 are not performed. However, the automatic collision prevention control is configured to be executed. In this control, when the vehicle 1 may collide with a preceding vehicle or the like, the brake control is automatically executed to avoid the collision. The Further, the automatic collision prevention control is executed in the same manner in the preceding vehicle following mode, the automatic speed control, and the speed limit mode.

また、自動速度制御モード、速度制限モード、及び基本制御モードにおいても、後述する障害物回避制御(速度制御のみ、又は、速度制御及びステアリング制御)が更に実行される。   Further, also in the automatic speed control mode, the speed limit mode, and the basic control mode, obstacle avoidance control (speed control only or speed control and steering control) described later is further executed.

次に、本実施形態による車両制御システム100において計算される複数の走行経路について説明する。本実施形態では、ECU10が、以下の第1走行経路R1〜第3走行経路R3を時間的に繰返し計算するように構成されている(例えば、0.1秒毎)。本実施形態では、ECU10は、センサ等の情報に基づいて、現時点から所定期間(例えば、2〜4秒)が経過するまでの間の走行経路を計算する。走行経路Rx(x=1,2,3)は、走行経路上の車両1の目標位置(Px_k)及び目標速度(Vx_k)により特定される(k=0,1,2,・・・,n)。   Next, a plurality of travel routes calculated in the vehicle control system 100 according to the present embodiment will be described. In the present embodiment, the ECU 10 is configured to repeatedly calculate the following first travel route R1 to third travel route R3 in terms of time (for example, every 0.1 second). In the present embodiment, the ECU 10 calculates a travel route from a current time until a predetermined period (for example, 2 to 4 seconds) elapses based on information such as a sensor. The travel route Rx (x = 1, 2, 3) is specified by the target position (Px_k) and the target speed (Vx_k) of the vehicle 1 on the travel route (k = 0, 1, 2,..., N). ).

なお、走行経路R1〜R3は、車両1が走行する走行路上又は走行路周辺の障害物(駐車車両、歩行者等を含む)に関する障害物情報(即ち時間的に状況が変動し得る情報)を考慮せずに、走行路の形状,先行車の走行軌跡,車両1の走行挙動,及び設定車速に基づいて計算される。このように、本実施形態では、障害物情報が計算に考慮されないので、これら複数の走行経路の全体的な計算負荷を低く抑えることができる。   Note that the travel routes R1 to R3 are obstacle information on obstacles (including parked vehicles, pedestrians, etc.) on or around the travel road on which the vehicle 1 travels (that is, information whose situation can change over time). Without consideration, the calculation is made based on the shape of the travel path, the travel locus of the preceding vehicle, the travel behavior of the vehicle 1, and the set vehicle speed. Thus, in this embodiment, since obstacle information is not taken into consideration in the calculation, the overall calculation load of the plurality of travel routes can be kept low.

第1走行経路R1は、走行車線の形状に即して車両1に走行車線内の理想経路上の走行を維持させるように所定期間分だけ設定される。詳しくは、第1走行経路R1は、直線区間では車両1が車線の中央付近の走行を維持するように設定され、カーブ区間では車両1が車線の幅方向中央よりも内側又はイン側(カーブ区間の曲率半径の中心側)を走行するように設定される。   The first travel route R1 is set for a predetermined period so that the vehicle 1 maintains the travel on the ideal route in the travel lane according to the shape of the travel lane. Specifically, the first travel route R1 is set so that the vehicle 1 keeps traveling in the vicinity of the center of the lane in the straight section, and in the curve section, the vehicle 1 is inside or inward from the center in the width direction of the lane (curve section). Is set to travel on the center side of the radius of curvature.

ECU10は、車載カメラ21により撮像された車両1の周囲の画像データの画像認識処理を実行し、車線両端部を検出する。車線両端部は、上述のように、区画線(白線等)や路肩等である。更に、ECU10は、検出した車線両端部に基づいて、車線の車線幅及びカーブ区間の曲率半径を算出する。また、ナビゲーションシステム30の地図情報から車線幅及び曲率半径を取得してもよい。更に、ECU10は、画像データから速度標識や路面上に表示された制限速度を読み取る。なお、上述のように、制限速度を外部からの無線通信により取得してもよい。   ECU10 performs the image recognition process of the image data around the vehicle 1 imaged with the vehicle-mounted camera 21, and detects a lane both ends. Both ends of the lane are lane markings (white lines, etc.) and road shoulders as described above. Further, the ECU 10 calculates the lane width of the lane and the radius of curvature of the curve section based on the detected both ends of the lane. Further, the lane width and the curvature radius may be acquired from the map information of the navigation system 30. Further, the ECU 10 reads a speed sign or a speed limit displayed on the road surface from the image data. As described above, the speed limit may be acquired by wireless communication from the outside.

ECU10は、直線区間では、車線両端部の幅方向の中央部を車両1の幅方向中央部(例えば、重心位置)が通過するように、第1走行経路R1の複数の目標位置P1_kを設定する。なお、本実施形態では、第1走行経路R1は、直線区間において、車両1が車線中央を走行するように設定されるが、これに限らず、運転者の運転特性(好み等)を反映させて、車線中央よりも所定のシフト量(距離)だけ幅方向に偏った車線中央付近に第1走行経路R1を設定するように構成してもよい。   In the straight section, the ECU 10 sets a plurality of target positions P1_k of the first travel route R1 so that the center part in the width direction (for example, the center of gravity position) of the vehicle 1 passes through the center part in the width direction of both ends of the lane. . In the present embodiment, the first travel route R1 is set so that the vehicle 1 travels in the center of the lane in the straight section. However, the present invention is not limited to this, and reflects the driving characteristics (preference, etc.) of the driver. Thus, the first travel route R1 may be set near the center of the lane that is deviated in the width direction by a predetermined shift amount (distance) from the center of the lane.

一方、ECU10は、カーブ区間では、カーブ区間の長手方向の中央位置において、車線の幅方向中央位置からイン側への変位量を最大に設定する。この変位量は、曲率半径,車線幅,車両1の幅寸法(ECU10のメモリに格納された規定値)に基づいて計算される。そして、ECU10は、カーブ区間の中央位置と直線区間の幅方向中央位置とを滑らかにつなぐように第1走行経路R1の複数の目標位置P1_kを設定する。なお、カーブ区間への進入前後においても、直線区間のイン側に第1走行経路R1を設定してもよい。   On the other hand, in the curve section, the ECU 10 sets the maximum amount of displacement from the center position in the width direction of the lane to the in side at the center position in the longitudinal direction of the curve section. This displacement amount is calculated based on the radius of curvature, the lane width, and the width dimension of the vehicle 1 (a prescribed value stored in the memory of the ECU 10). Then, the ECU 10 sets a plurality of target positions P1_k of the first travel route R1 so as to smoothly connect the center position of the curve section and the center position in the width direction of the straight section. Note that the first travel route R1 may be set on the in side of the straight section before and after entering the curve section.

第1走行経路R1の各目標位置P1_kにおける目標速度V1_kは、原則的に、運転者が運転者操作部35の設定車速入力部37によって又はシステム100によって予め設定された所定の設定車速(一定速度)に設定される。しかしながら、この設定車速が、速度標識等から取得された制限速度、又は、カーブ区間の曲率半径に応じて規定される制限速度を超える場合、走行経路上の各目標位置P1_kの目標速度V1_kは、2つの制限速度のうち、より低速な制限速度に制限される。さらに、ECU10は、車両1の現在の挙動状態(即ち、車速,加減速度,ヨーレート,操舵角,横加速度等)に応じて、目標位置P1_k,目標車速V1_kを適宜に補正する。例えば、現車速が設定車速から大きく異なっている場合は、車速を設定車速に近づけるように目標車速が補正される。   In principle, the target speed V1_k at each target position P1_k on the first travel route R1 is a predetermined set vehicle speed (constant speed) preset by the driver through the set vehicle speed input unit 37 of the driver operation unit 35 or by the system 100. ). However, when the set vehicle speed exceeds the speed limit obtained from the speed sign or the like, or the speed limit defined according to the radius of curvature of the curve section, the target speed V1_k of each target position P1_k on the travel route is Of the two speed limits, the speed is limited to a lower speed limit. Further, the ECU 10 appropriately corrects the target position P1_k and the target vehicle speed V1_k according to the current behavior state of the vehicle 1 (that is, vehicle speed, acceleration / deceleration, yaw rate, steering angle, lateral acceleration, etc.). For example, when the current vehicle speed is significantly different from the set vehicle speed, the target vehicle speed is corrected so that the vehicle speed approaches the set vehicle speed.

なお、第1走行経路R1は、原則的には車線両端部が検出される場合に用いられる走行経路であるため、車線両端部が検出されない場合には計算しなくてもよいが、車線両端部が検出されていないにもかかわらず第1走行経路R1が誤って選択された場合に備えて、代替的に以下のように計算してもよい。   Since the first travel route R1 is a travel route that is used when both ends of the lane are detected in principle, the first travel route R1 may not be calculated when the both ends of the lane are not detected. Alternatively, the following calculation may alternatively be performed in preparation for the case where the first travel route R1 is erroneously selected even though no is detected.

この場合、車両1が車線の中央を走行していると仮定し、ECU10は、車両1の車速に応じて操舵角又はヨーレートを用いて仮想的な車線両端部を設定する。そして、ECU10は、仮想的に設定した車両両端部に基づいて、上記と同様に、直線区間であれば車線の中央を走行し、カーブ区間であれば車線のイン側を走行するように第1走行経路を計算する。   In this case, assuming that the vehicle 1 is traveling in the center of the lane, the ECU 10 sets the virtual lane both ends using the steering angle or the yaw rate according to the vehicle speed of the vehicle 1. Then, based on the both ends of the vehicle set virtually, the ECU 10 travels in the center of the lane if it is a straight section, and travels in the lane in the lane if it is a curve section, as described above. Calculate the travel route.

また、第2走行経路R2は、先行車の走行軌跡を追従するように所定期間分だけ設定される。ECU10は、車載カメラ21による画像データ,ミリ波レーダ22による測定データ,車速センサ23による車両1の車速に基づいて、車両1の走行する車線上の先行車の位置及び速度を継続的に計算して、これらを先行車軌跡情報として記憶し、この先行車軌跡情報に基づいて、先行車の走行軌跡を第2走行経路R2(目標位置P2_k、目標速度V2_k)として設定する。   The second travel route R2 is set for a predetermined period so as to follow the travel locus of the preceding vehicle. The ECU 10 continuously calculates the position and speed of the preceding vehicle on the lane in which the vehicle 1 travels based on the image data from the in-vehicle camera 21, the measurement data from the millimeter wave radar 22, and the vehicle speed of the vehicle 1 from the vehicle speed sensor 23. These are stored as preceding vehicle locus information, and the traveling locus of the preceding vehicle is set as the second traveling route R2 (target position P2_k, target speed V2_k) based on the preceding vehicle locus information.

本実施形態では、第2走行経路R2は、原則的には先行車が検出される場合に計算される走行経路であるため、先行車が検出されない場合には計算しなくてもよいが、先行車が検出されていないにもかかわらず第2走行経路R2が誤って選択された場合に備えて、代替的に以下のように計算してもよい。   In the present embodiment, the second travel route R2 is a travel route that is calculated when a preceding vehicle is detected in principle, and therefore may not be calculated when the preceding vehicle is not detected. In preparation for the case where the second travel route R2 is erroneously selected even though no vehicle is detected, the following calculation may alternatively be performed.

この場合、ECU10は、車両1から車速に応じた所定距離だけ前方に先行車が走行していると仮定する。この仮想的な先行車は車両1と同じ走行挙動(車速,操舵角,ヨーレート等)を有するものとする。そして、ECU10は、仮想的な先行車を追従するように第2走行経路R2を計算する。   In this case, the ECU 10 assumes that the preceding vehicle is traveling forward from the vehicle 1 by a predetermined distance according to the vehicle speed. This virtual preceding vehicle has the same traveling behavior (vehicle speed, steering angle, yaw rate, etc.) as the vehicle 1. Then, the ECU 10 calculates the second travel route R2 so as to follow the virtual preceding vehicle.

また、第3走行経路R3は、運転者による車両1の現在の運転状態に基づいて所定期間分だけ設定される。即ち、第3走行経路R3は、車両1の現在の走行挙動から推定される位置及び速度に基づいて設定される。
ECU10は、車両1の操舵角,ヨーレート,横加速度に基づいて、所定期間分の第3走行経路R3の目標位置P3_kを計算する。ただし、ECU10は、車線両端部が検出される場合、計算された第3走行経路R3が車線端部に接近又は交差しないように、目標位置P3_kを補正する。
Further, the third travel route R3 is set for a predetermined period based on the current driving state of the vehicle 1 by the driver. That is, the third travel route R3 is set based on the position and speed estimated from the current travel behavior of the vehicle 1.
The ECU 10 calculates the target position P3_k of the third travel route R3 for a predetermined period based on the steering angle, yaw rate, and lateral acceleration of the vehicle 1. However, the ECU 10 corrects the target position P3_k so that the calculated third travel route R3 does not approach or intersect the lane edge when the lane both ends are detected.

また、ECU10は、車両1の現在の車速,加減速度に基づいて、所定期間分の第3走行経路R3の目標速度V3_kを計算する。なお、目標速度V3_kが速度標識等から取得された制限速度を超えてしまう場合は、制限速度を超えないように目標速度V3_kを補正してもよい。   Further, the ECU 10 calculates the target speed V3_k of the third travel route R3 for a predetermined period based on the current vehicle speed and acceleration / deceleration of the vehicle 1. Note that when the target speed V3_k exceeds the speed limit acquired from the speed indicator or the like, the target speed V3_k may be corrected so as not to exceed the speed limit.

次に、図2を参照して、本実施形態による車両制御システム100における運転支援モードと走行経路との関係について説明する。図2は、運転支援モードと目標走行経路との関係を示す説明図である。本実施形態では、運転者がモード選択スイッチ36を操作して1つの運転支援モードを選択すると、ECU10が、センサ等による測定データに応じて、第1走行経路R1〜第3走行経路R3のうち、いずれか1つを選択するように構成されている。即ち、本実施形態では、運転者がある運転支援モードを選択しても、必ず同じ走行経路が適用されるわけではなく、走行状況に応じた適切な走行経路が適用されるように構成されている。   Next, the relationship between the driving support mode and the travel route in the vehicle control system 100 according to the present embodiment will be described with reference to FIG. FIG. 2 is an explanatory diagram showing the relationship between the driving support mode and the target travel route. In the present embodiment, when the driver operates the mode selection switch 36 to select one driving support mode, the ECU 10 selects one of the first travel route R1 to the third travel route R3 according to the measurement data by the sensor or the like. , Any one is selected. That is, in the present embodiment, even if the driver selects a certain driving support mode, the same travel route is not necessarily applied, and an appropriate travel route according to the travel situation is applied. Yes.

先行車追従モードの選択時には、車線両端部が検出されていると、先行車の有無にかかわらず、第1走行経路が適用される。この場合、設定車速入力部37によって設定された設定車速が目標速度となる。なお、「車線両端部が検出されている」とは、経路計算に必要な車両前方の所定距離区間にわたって車線両端部が実質的に連続して存在すると判断されることを意味する。   When the preceding vehicle following mode is selected, if both ends of the lane are detected, the first travel route is applied regardless of the presence or absence of the preceding vehicle. In this case, the set vehicle speed set by the set vehicle speed input unit 37 becomes the target speed. Note that “the lane ends are detected” means that it is determined that the lane ends exist substantially continuously over a predetermined distance section ahead of the vehicle necessary for route calculation.

一方、先行車追従モードの選択時において、車線両端部が検出されず、先行車が検出された場合、第2走行経路が適用される。この場合、目標速度は、先行車の車速に応じて設定される。また、先行車追従モードの選択時において、車線両端部が検出されず、先行車も検出されない場合、第3走行経路が適用される。よって、先行車追従モード選択中は、先行車の有無及び車線両端部の検出の可否に応じて、選択される走行経路が第1〜第3走行経路の中で時間的に切り替えられる。   On the other hand, when the preceding vehicle follow-up mode is selected, the second travel route is applied when both ends of the lane are not detected and the preceding vehicle is detected. In this case, the target speed is set according to the vehicle speed of the preceding vehicle. In addition, when the preceding vehicle follow-up mode is selected, the third travel route is applied when neither end of the lane is detected and no preceding vehicle is detected. Therefore, when the preceding vehicle follow-up mode is selected, the selected travel route is temporally switched among the first to third travel routes according to the presence / absence of the preceding vehicle and whether or not both end portions of the lane can be detected.

また、自動速度制御モードの選択時には、第3走行経路が適用される。自動速度制御モードは、上述のように速度制御を自動的に実行するモードであり、設定車速入力部37によって設定された設定車速が目標速度となる。また、運転者によるステアリングホイールの操作に基づいてステアリング制御が実行される。このため、第3走行経路が適用されるが、運転者の操作(ステアリングホイール、ブレーキ)によっては、必ずしも第3走行経路に従って車両1が走行しない場合がある。   Further, the third travel route is applied when the automatic speed control mode is selected. The automatic speed control mode is a mode in which the speed control is automatically executed as described above, and the set vehicle speed set by the set vehicle speed input unit 37 becomes the target speed. Further, steering control is executed based on the operation of the steering wheel by the driver. For this reason, the third travel route is applied, but the vehicle 1 may not necessarily travel along the third travel route depending on the driver's operation (steering wheel, brake).

また、速度制限モードの選択時にも第3走行経路が適用される。速度制限モードも、上述のように速度制御を自動的に実行するモードであり、目標速度は、制限速度以下の範囲で、運転者によるアクセルペダルの踏み込み量に応じて設定される。また、運転者によるステアリングホイールの操作に基づいてステアリング制御が実行される。このため、自動速度制御モードと同様に、第3走行経路が適用されるが、運転者の操作(ステアリングホイール、ブレーキ、アクセル)によっては、必ずしも第3走行経路に従って車両1が走行しない場合がある。   The third travel route is also applied when the speed limit mode is selected. The speed limit mode is also a mode in which the speed control is automatically executed as described above, and the target speed is set in accordance with the depression amount of the accelerator pedal by the driver within the range of the limit speed or less. Further, steering control is executed based on the operation of the steering wheel by the driver. For this reason, as in the automatic speed control mode, the third travel route is applied. However, depending on the driver's operation (steering wheel, brake, accelerator), the vehicle 1 may not necessarily travel along the third travel route. .

また、基本制御モード(オフモード)の選択時には、第3走行経路が適用される。基本制御モードは、基本的に、速度制限モードにおいて制限速度が設定されない状態と同様である。   In addition, when the basic control mode (off mode) is selected, the third travel route is applied. The basic control mode is basically the same as the state where the speed limit is not set in the speed limit mode.

次に、図3及び図4を参照して、本実施形態による車両制御システム100において実行される障害物回避制御及びこれに伴う走行経路補正処理について説明する。図3は障害物回避制御の説明図、図4は障害物回避制御における障害物と車両との間のすれ違い速度の許容上限値とクリアランスとの関係を示す説明図である。
図3では、車両1は走行路(車線)7上を走行しており、走行路7の道路脇に駐車された別の車両3とすれ違って、車両3を追い抜こうとしている。なお、図3では、車両1のECU10は、走行路7の左側の境界線8L,右側の境界線8Rを検出している。
Next, with reference to FIG. 3 and FIG. 4, the obstacle avoidance control executed in the vehicle control system 100 according to the present embodiment and the travel route correction process associated therewith will be described. FIG. 3 is an explanatory diagram of the obstacle avoidance control, and FIG. 4 is an explanatory diagram showing the relationship between the allowable upper limit value of the passing speed between the obstacle and the vehicle and the clearance in the obstacle avoidance control.
In FIG. 3, the vehicle 1 is traveling on a travel path (lane) 7, and is trying to pass the vehicle 3 by passing another vehicle 3 parked on the roadside of the travel path 7. In FIG. 3, the ECU 10 of the vehicle 1 detects the left boundary line 8 </ b> L and the right boundary line 8 </ b> R of the travel path 7.

一般に、道路上又は道路付近の障害物(例えば、先行車、駐車車両、歩行者等)とすれ違うとき(又は追い抜くとき)、車両1の運転者は、進行方向に対して直交する横方向において、車両1と障害物との間に所定のクリアランス又は間隔(横方向距離)を保ち、且つ、車両1の運転者が安全と感じる速度に減速する。具体的には、先行車が急に進路変更したり、障害物の死角から歩行者が出てきたり、駐車車両のドアが開いたりするといった危険を回避するため、クリアランスが小さいほど、障害物に対する相対速度は小さくされる。   In general, when passing (or overtaking) an obstacle on the road or near the road (for example, a preceding car, a parked vehicle, a pedestrian, etc.), the driver of the vehicle 1 A predetermined clearance or interval (lateral distance) is maintained between the vehicle 1 and the obstacle, and the vehicle 1 is decelerated to a speed at which the driver feels safe. Specifically, in order to avoid the danger that the preceding vehicle suddenly changes course, the pedestrian comes out from the blind spot of the obstacle, or the door of the parked vehicle opens, The relative speed is reduced.

また、一般に、後方から先行車に近づいているとき、車両1の運転者は、進行方向に沿った車間距離(縦方向距離)に応じて速度(相対速度)を調整する。具体的には、車間距離が大きいときは、接近速度(相対速度)が大きく維持されるが、車間距離が小さくなると、接近速度は低速にされる。そして、所定の車間距離で両車両の間の相対速度はゼロとなる。これは、先行車が駐車車両であっても同様である。   In general, when approaching the preceding vehicle from behind, the driver of the vehicle 1 adjusts the speed (relative speed) according to the inter-vehicle distance (vertical distance) along the traveling direction. Specifically, when the inter-vehicle distance is large, the approach speed (relative speed) is maintained high, but when the inter-vehicle distance is small, the approach speed is decreased. The relative speed between the two vehicles is zero at a predetermined inter-vehicle distance. This is the same even if the preceding vehicle is a parked vehicle.

このように、運転者は、障害物と車両1との間の距離(横方向距離及び縦方向距離を含む)と相対速度との関係を考慮しながら、危険を回避するように車両1を運転している。   In this way, the driver drives the vehicle 1 so as to avoid danger while considering the relationship between the distance between the obstacle and the vehicle 1 (including the lateral distance and the longitudinal distance) and the relative speed. doing.

そこで、本実施形態では、図3に示すように、車両1は、車両1から検知される障害物(例えば、駐車車両3)に対して、障害物の周囲に(横方向領域、後方領域、及び前方領域にわたって)又は少なくとも障害物と車両1との間に、車両1の進行方向における相対速度についての許容上限値を規定する2次元分布(速度分布領域40)を設定するように構成されている。速度分布領域40では、障害物の周囲の各点において、相対速度の許容上限値Vlimが設定されている。本実施形態では、すべての運転支援モードにおいて、障害物に対する車両1の相対速度が速度分布領域40内の許容上限値Vlimを超えることを防止するための障害物回避制御が実施される。 Therefore, in the present embodiment, as shown in FIG. 3, the vehicle 1 is located around the obstacle (lateral region, rear region, And over the front area) or at least between the obstacle and the vehicle 1, a two-dimensional distribution (speed distribution area 40) that defines an allowable upper limit value for the relative speed in the traveling direction of the vehicle 1 is configured. Yes. In the velocity distribution region 40, an allowable upper limit value V lim of the relative velocity is set at each point around the obstacle. In the present embodiment, obstacle avoidance control for preventing the relative speed of the vehicle 1 with respect to the obstacle from exceeding the allowable upper limit value V lim in the speed distribution region 40 is performed in all driving support modes.

図3から分かるように、速度分布領域40は、障害物からの横方向距離及び縦方向距離が小さくなるほど(障害物に近づくほど)、相対速度の許容上限値が小さくなるように設定される。また、図3では、理解の容易のため、同じ許容上限値を有する点を連結した等相対速度線が示されている。等相対速度線a,b,c,dは、それぞれ許容上限値Vlimが0km/h,20km/h,40km/h,60km/hに相当する。 As can be seen from FIG. 3, the velocity distribution region 40 is set such that the allowable upper limit value of the relative velocity decreases as the lateral distance and the longitudinal distance from the obstacle become smaller (as the obstacle gets closer). Further, in FIG. 3, for the sake of easy understanding, an equal relative velocity line connecting points having the same allowable upper limit value is shown. The equal relative velocity lines a, b, c and d correspond to allowable upper limit values V lim of 0 km / h, 20 km / h, 40 km / h and 60 km / h, respectively.

なお、速度分布領域40は、必ずしも障害物の全周にわたって設定されなくてもよく、少なくとも車両1が存在する障害物の横方向の一方側(図3では、車両3の右側領域)に設定されればよい。また、図3では、車両1が走行しない領域(走行路7の外部)にも速度分布領域40が示されているが、走行路7上のみに速度分布領域40を設定してもよい。更に、図3では、許容上限値が60km/hまでの速度分布領域40が示されているが、対向車線を走行する対向車とのすれ違いを考慮して、更に大きな相対速度まで速度分布領域40を設定することができる。   The speed distribution region 40 does not necessarily have to be set over the entire circumference of the obstacle, and is set at least on one side in the lateral direction of the obstacle where the vehicle 1 exists (in FIG. 3, the right side region of the vehicle 3). Just do it. In FIG. 3, the speed distribution area 40 is also shown in an area where the vehicle 1 does not travel (outside the travel path 7), but the speed distribution area 40 may be set only on the travel path 7. Further, in FIG. 3, the speed distribution region 40 having an allowable upper limit value of 60 km / h is shown. However, the speed distribution region 40 is increased to a higher relative speed in consideration of the passing with the oncoming vehicle traveling in the oncoming lane. Can be set.

図4に示すように、車両1がある絶対速度で走行するときにおいて、障害物の横方向に設定される許容上限値Vlimは、クリアランスXがD0(安全距離)までは0(ゼロ)km/hであり、D0以上で2次関数的に増加する(Vlim=k(X−D02。ただし、X≧D0)。即ち、安全確保のため、クリアランスXがD0以下では車両1は相対速度がゼロとなる。一方、クリアランスXがD0以上では、クリアランスが大きくなるほど、車両1は大きな相対速度ですれ違うことが可能となる。 As shown in FIG. 4, when the vehicle 1 travels at a certain absolute speed, the allowable upper limit value V lim set in the lateral direction of the obstacle is 0 (zero) until the clearance X is D 0 (safety distance). km / h, and increases in a quadratic function above D 0 (V lim = k (X−D 0 ) 2 , where X ≧ D 0 ). That is, in order to ensure safety, the relative speed of the vehicle 1 becomes zero when the clearance X is D 0 or less. On the other hand, when the clearance X is equal to or greater than D 0 , the larger the clearance, the more the vehicle 1 can pass at a higher relative speed.

図4の例では、障害物の横方向における許容上限値は、Vlim=f(X)=k(X−D02で定義されている。なお、kは、Xに対するVlimの変化度合いに関連するゲイン係数であり、障害物の種類等に依存して設定される。また、D0も障害物の種類等に依存して設定される。 In the example of FIG. 4, the allowable upper limit value in the lateral direction of the obstacle is defined by V lim = f (X) = k (X−D 0 ) 2 . Note that k is a gain coefficient related to the degree of change in V lim with respect to X, and is set depending on the type of obstacle or the like. D 0 is also set depending on the type of obstacle.

なお、本実施形態では、Vlimが安全距離を含み、且つ、Xの2次関数となるように定義されているが、これに限らず、Vlimが安全距離を含まなくてもよいし、他の関数(例えば、一次関数等)で定義されてもよい。また、図4を参照して、障害物の横方向の許容上限値Vlimについて説明したが、障害物の縦方向を含むすべての径方向について同様に設定することができる。その際、係数k、安全距離D0は、障害物からの方向に応じて設定することができる。 In this embodiment, V lim includes a safe distance and is defined to be a quadratic function of X. However, the present invention is not limited to this, and V lim may not include a safe distance. You may define with another function (for example, linear function etc.). Moreover, although the allowable upper limit value V lim in the lateral direction of the obstacle has been described with reference to FIG. 4, it can be set similarly in all radial directions including the vertical direction of the obstacle. At that time, the coefficient k and the safety distance D 0 can be set according to the direction from the obstacle.

なお、速度分布領域40は、種々のパラメータに基づいて設定することが可能である。パラメータとして、例えば、車両1と障害物の相対速度、障害物の種類、車両1の進行方向、障害物の移動方向及び移動速度、障害物の長さ、車両1の絶対速度等を考慮することができる。即ち、これらのパラメータに基づいて、係数k及び安全距離D0を選択することができる。 The velocity distribution region 40 can be set based on various parameters. As parameters, for example, the relative speed between the vehicle 1 and the obstacle, the type of the obstacle, the traveling direction of the vehicle 1, the moving direction and moving speed of the obstacle, the length of the obstacle, the absolute speed of the vehicle 1, etc. Can do. That is, the coefficient k and the safety distance D 0 can be selected based on these parameters.

また、本実施形態において、障害物は、車両,歩行者,自転車,崖,溝,穴,落下物,静止物(道路に配置された固定物や構造体)等を含む。更に、車両は、自動車,トラック,自動二輪で区別可能である。歩行者は、大人,子供,集団で区別可能である。   In the present embodiment, the obstacle includes a vehicle, a pedestrian, a bicycle, a cliff, a groove, a hole, a falling object, a stationary object (a fixed object or a structure disposed on a road), and the like. Furthermore, vehicles can be distinguished by automobiles, trucks, and motorcycles. Pedestrians can be distinguished by adults, children and groups.

また、図3では、1つの障害物が存在する場合の速度分布領域が示されているが、複数の障害物が接近して存在している場合には、複数の速度分布領域が互いに重なり合う。このため、重なり合う部分では、図3に示したような略楕円形状の等相対速度線ではなく、より小さい許容上限値の方を優先して他方を除外するようにして、又は、2つの略楕円形を滑らかにつなげるようにして、等相対速度線が設定されることになる。   Further, FIG. 3 shows the velocity distribution region when one obstacle exists, but when a plurality of obstacles are close to each other, the plurality of velocity distribution regions overlap each other. For this reason, in the overlapping portion, not the substantially elliptical uniform relative velocity line as shown in FIG. 3, but the smaller allowable upper limit value is preferentially excluded, or two substantially elliptical shapes are excluded. An iso-relative velocity line is set so as to connect the shapes smoothly.

図3に示すように、車両1が走行路7上を走行しているとき、車両1のECU10は、車載カメラ21から画像データに基づいて障害物(車両3)を検出する。このとき、障害物の種類(この場合は、車両、歩行者)が特定される。   As shown in FIG. 3, when the vehicle 1 is traveling on the travel path 7, the ECU 10 of the vehicle 1 detects an obstacle (vehicle 3) from the in-vehicle camera 21 based on the image data. At this time, the type of obstacle (in this case, vehicle, pedestrian) is specified.

また、ECU10は、ミリ波レーダ22の測定データ及び車速センサ23の車速データに基づいて、車両1に対する障害物(車両3)の位置及び相対速度並びに絶対速度を算出する。なお、障害物の位置は、車両1の進行方向に沿ったy方向位置(縦方向距離)と、進行方向と直交する横方向に沿ったx方向位置(横方向距離)が含まれる。相対速度は、測定データに含まれる相対速度をそのまま用いてもよいし、測定データから進行方向に沿った速度成分を算出してもよい。また、進行方向に直交する速度成分は、必ずしも算出しなくてもよいが、必要であれば、複数の測定データ及び/又は複数の画像データから推定してもよい。   Further, the ECU 10 calculates the position, relative speed, and absolute speed of the obstacle (vehicle 3) with respect to the vehicle 1 based on the measurement data of the millimeter wave radar 22 and the vehicle speed data of the vehicle speed sensor 23. The position of the obstacle includes a y-direction position (vertical distance) along the traveling direction of the vehicle 1 and an x-direction position (horizontal distance) along the lateral direction orthogonal to the traveling direction. As the relative speed, the relative speed included in the measurement data may be used as it is, or a speed component along the traveling direction may be calculated from the measurement data. In addition, the velocity component orthogonal to the traveling direction may not necessarily be calculated, but may be estimated from a plurality of measurement data and / or a plurality of image data if necessary.

ECU10は、検知したすべての障害物(図3の場合、車両3)について、それぞれ速度分布領域40を設定する。そして、ECU10は、車両1の速度が速度分布領域40の許容上限値Vlimを超えないように障害物回避制御を行う。このため、ECU10は、障害物回避制御に伴い、運転者の選択した運転支援モードに応じて適用された目標走行経路を補正する。 The ECU 10 sets the speed distribution region 40 for all detected obstacles (the vehicle 3 in the case of FIG. 3). Then, the ECU 10 performs obstacle avoidance control so that the speed of the vehicle 1 does not exceed the allowable upper limit value V lim of the speed distribution region 40. For this reason, ECU10 correct | amends the target driving | running | working path | route applied according to the driving assistance mode which the driver | operator selected with obstacle avoidance control.

即ち、目標走行経路を車両1が走行すると、ある目標位置において目標速度が速度分布領域40によって規定された許容上限値を超えてしまう場合には、回避モード選択スイッチ38により選択されている回避モード(直線優先モード,中間モード,速度優先モード等)に応じて、走行経路補正処理により目標走行経路Rが補正される。これら回避モードに応じて算出される補正目標走行経路Rc(Rc1〜Rc3)は、補正前の目標走行経路Rに対する横方向への回避距離が異なって設定される。   That is, when the vehicle 1 travels on the target travel route, when the target speed exceeds the allowable upper limit defined by the speed distribution region 40 at a certain target position, the avoidance mode selected by the avoidance mode selection switch 38. In accordance with (straight line priority mode, intermediate mode, speed priority mode, etc.), the target travel route R is corrected by the travel route correction process. The corrected target travel route Rc (Rc1 to Rc3) calculated according to these avoidance modes is set with different avoidance distances in the lateral direction with respect to the target travel route R before correction.

なお、先行車が存在する場合、この先行車も障害物(車両3)を回避して走行する。よって、先行車追従モードにおいて先行車が存在する場合、選択されている目標走行経路(第2走行経路)を走行することにより、車両1も障害物を安全に回避可能と想定される。よって、先行車追従モードにおいて先行車が存在する場合には、走行経路補正処理を実行しない構成を採用してもよい。   In addition, when a preceding vehicle exists, the preceding vehicle travels while avoiding an obstacle (vehicle 3). Therefore, when a preceding vehicle exists in the preceding vehicle follow-up mode, it is assumed that the vehicle 1 can safely avoid an obstacle by traveling on the selected target traveling route (second traveling route). Therefore, when there is a preceding vehicle in the preceding vehicle following mode, a configuration in which the travel route correction process is not executed may be employed.

直線優先モードは、目標位置を変更することなく目標速度を低下させるモードである(図3の経路Rc1)。速度優先モードは、目標速度を変更することなく目標位置を変更するモードであり、即ち、目標速度(又は設定速度)が許容上限値を超えないように迂回経路上に目標位置が変更される(図3の経路Rc3)。中間モードは、目標位置及び目標速度の両方が変更されるモードであり、補正目標位置が直線優先モードと速度優先モードの補正目標位置の間に位置し、補正目標速度が直線優先モードと速度優先モードの補正目標速度の間の値となる(図3の経路Rc2)。   The straight line priority mode is a mode in which the target speed is reduced without changing the target position (path Rc1 in FIG. 3). The speed priority mode is a mode in which the target position is changed without changing the target speed, that is, the target position is changed on the detour path so that the target speed (or set speed) does not exceed the allowable upper limit value ( Route Rc3 in FIG. The intermediate mode is a mode in which both the target position and the target speed are changed, the correction target position is located between the correction target position in the linear priority mode and the speed priority mode, and the correction target speed is in the linear priority mode and the speed priority. It becomes a value between the corrected target speeds of the mode (path Rc2 in FIG. 3).

ただし、いずれの回避モード選択時においても、障害物との衝突及び車線からの逸脱が防止されるように走行経路補正処理が実行される。よって、直線優先モード選択時において障害物(車両3)に衝突するおそれがある場合には、障害物を回避するため、横方向の移動が最小になるように目標位置も変更される。また、速度優先モード選択時において車線7を逸脱するおそれがある場合には、車線逸脱しないように補正目標位置が設定され、目標速度からの速度低下が最小になるように補正目標速度が設定される。   However, in any of the avoidance modes selected, the travel route correction process is executed so that the collision with the obstacle and the departure from the lane are prevented. Therefore, when there is a possibility of colliding with an obstacle (vehicle 3) when the straight line priority mode is selected, the target position is also changed so as to minimize the lateral movement in order to avoid the obstacle. Further, when there is a possibility of deviating from the lane 7 when the speed priority mode is selected, the corrected target position is set so as not to deviate from the lane, and the corrected target speed is set so that the speed decrease from the target speed is minimized. The

例えば、図3は、計算されていた目標走行経路Rが、走行路7の幅方向の中央位置(目標位置)を60km/h(目標速度)で走行する経路であった場合を示している。この場合、前方に駐車車両3が障害物として存在するが、上述のように、目標走行経路Rの計算段階においては、計算負荷の低減のため、この障害物は考慮されていない。   For example, FIG. 3 shows a case where the calculated target travel route R is a route that travels at a center position (target position) in the width direction of the travel path 7 at 60 km / h (target speed). In this case, the parked vehicle 3 is present as an obstacle ahead, but as described above, this obstacle is not taken into consideration in the calculation stage of the target travel route R in order to reduce the calculation load.

目標走行経路Rを走行すると、車両1は、速度分布領域40の等相対速度線d,c,b,b,c,dを順に横切ることになる。即ち、60km/hで走行する車両1が等相対速度線d(許容上限値Vlim=60km/h)の内側の領域に進入することになる。したがって、直線優先モード選択時には、ECU10は、目標走行経路Rの各目標位置における目標速度を許容上限値Vlim以下に制限するように目標走行経路Rを補正して、補正後の目標走行経路Rc1を生成する。即ち、補正後の目標走行経路Rc1では、各目標位置において目標車速が許容上限値Vlim以下となるように、車両3に接近するに連れて目標速度が徐々に20km/h未満に低下し、その後、車両3から遠ざかるに連れて目標速度が元の60km/hまで徐々に増加される。 When traveling on the target travel route R, the vehicle 1 crosses the equal relative speed lines d, c, b, b, c, d in the speed distribution region 40 in order. That is, the vehicle 1 traveling at 60 km / h enters an area inside the equal relative speed line d (allowable upper limit value V lim = 60 km / h). Therefore, when the straight line priority mode is selected, the ECU 10 corrects the target travel route R so as to limit the target speed at each target position of the target travel route R to the allowable upper limit value V lim or less, and the corrected target travel route Rc1. Is generated. That is, in the corrected target travel route Rc1, the target speed gradually decreases to less than 20 km / h as the vehicle 3 approaches, so that the target vehicle speed is less than or equal to the allowable upper limit value V lim at each target position. Thereafter, as the vehicle 3 moves away from the vehicle 3, the target speed is gradually increased to the original 60 km / h.

また、速度優先モード選択時に計算される目標走行経路Rc3は、目標走行経路Rの目標速度(60km/h)を変更せず、このため等相対速度線d(相対速度60km/hに相当)の外側を走行するように設定された経路である。ECU10は、車線逸脱のおそれがない限り、目標走行経路Rの目標速度を維持するため、目標位置が等相対速度線d上又はその外側に位置するように目標位置を変更するように目標走行経路Rを補正して、目標走行経路Rc3を生成する。したがって、目標走行経路Rc3の目標速度は、目標走行経路Rの目標速度であった60km/hに維持される。   Further, the target travel route Rc3 calculated when the speed priority mode is selected does not change the target speed (60 km / h) of the target travel route R, and therefore, the equal relative speed line d (corresponding to a relative speed of 60 km / h). The route is set to travel outside. The ECU 10 changes the target travel path so that the target position is positioned on or outside the equal relative speed line d in order to maintain the target speed of the target travel path R unless there is a risk of lane departure. R is corrected to generate a target travel route Rc3. Therefore, the target speed of the target travel route Rc3 is maintained at 60 km / h, which is the target speed of the target travel route R.

また、中間モード選択時に計算される目標走行経路Rc2は、目標走行経路Rの目標位置及び目標速度の両方が変更された経路である。目標走行経路Rc2では、目標速度は、60km/hには維持されず、車両3に接近するに連れて徐々に40km/hまで低下し、その後、車両3から遠ざかるに連れて元の60km/hまで徐々に増加される。目標走行経路Rc2は、その目標位置及び目標速度が所定の条件を満たすように生成することができる。所定の条件とは、例えば、車両1の縦加減速度,横加速度がそれぞれ所定値以下であることや、走行路7から隣の車線への逸脱がないこと等である。   Further, the target travel route Rc2 calculated when the intermediate mode is selected is a route in which both the target position and the target speed of the target travel route R are changed. In the target travel route Rc2, the target speed is not maintained at 60 km / h, and gradually decreases to 40 km / h as the vehicle 3 approaches, and then the original speed of 60 km / h as the vehicle 3 moves away. Is gradually increased until. The target travel route Rc2 can be generated so that the target position and target speed satisfy predetermined conditions. The predetermined condition is, for example, that the longitudinal acceleration / deceleration and the lateral acceleration of the vehicle 1 are not more than predetermined values, that there is no deviation from the traveling road 7 to the adjacent lane, and the like.

また、先行車追従モード,自動速度制御モード,速度制限モード,又は基本制御モードにおいて車両1が同一車線を走行中の先行車に追いついた場合にも、障害物回避制御が適用される。即ち、車両1が先行車に接近するにつれて、速度分布領域40の許容上限値Vlimに従って相対速度が小さくなるように車両1の車速が制限される。そして、車両1は、車両1と先行車の間の相対速度がゼロとなる等相対速度線aの位置での車間距離を維持しつつ先行車に追従する。 The obstacle avoidance control is also applied when the vehicle 1 catches up with a preceding vehicle traveling in the same lane in the preceding vehicle following mode, automatic speed control mode, speed limiting mode, or basic control mode. That is, as the vehicle 1 approaches the preceding vehicle, the vehicle speed of the vehicle 1 is limited so that the relative speed decreases according to the allowable upper limit value V lim of the speed distribution region 40. The vehicle 1 follows the preceding vehicle while maintaining the inter-vehicle distance at the position of the equal relative speed line a where the relative speed between the vehicle 1 and the preceding vehicle is zero.

また、先行車追従モードにおいて、車線両端部の検出の可否及び先行車の有無にかかわらず、且つ、選択されている回避モードにかかわらず、運転者によりステアリングホイールが操作されると、ECU10は、障害物との衝突及び車線逸脱のおそれがないと判断する場合には、ステアリングホイール操作に基づく車両1の横方向移動を許容する。例えば、障害物から離れる方向にステアリングホイールが操作される場合や、車両1から車線の境界線までの横方向距離が所定距離以上の場合、障害物との衝突及び車線逸脱のおそれがないと判断される。   In the preceding vehicle following mode, when the steering wheel is operated by the driver regardless of whether the lane ends can be detected and whether there is a preceding vehicle, and regardless of the selected avoidance mode, the ECU 10 When it is determined that there is no risk of collision with an obstacle and lane departure, the lateral movement of the vehicle 1 based on the steering wheel operation is permitted. For example, when the steering wheel is operated in a direction away from the obstacle, or when the lateral distance from the vehicle 1 to the lane boundary is a predetermined distance or more, it is determined that there is no risk of collision with the obstacle and lane departure. Is done.

一方、ECU10は、ステアリングホイール操作により、障害物との衝突及び車線逸脱のおそれがあると判断する場合には、ステアリングホイールに操作方向とは逆方向のアシストトルクを加えて、ステアリングホイールの操作を抑制する。   On the other hand, when the ECU 10 determines that there is a risk of collision with an obstacle and departure from the lane due to the steering wheel operation, the assist torque in the direction opposite to the operation direction is applied to the steering wheel to operate the steering wheel. Suppress.

次に、図5〜図7を参照して、本実施形態による車両制御システム100において実行される走行経路補正処理に含まれる接近処理について説明する。図5は直線優先モード選択時における接近処理後の補正目標走行経路の説明図、図6は中間モード選択時における接近処理後の補正目標走行経路の説明図、図7は速度優先モード選択時における接近処理後の補正目標走行経路の説明図である。   Next, an approach process included in the travel route correction process executed in the vehicle control system 100 according to the present embodiment will be described with reference to FIGS. FIG. 5 is an explanatory diagram of the corrected target travel path after the approach process when the straight line priority mode is selected, FIG. 6 is an explanatory diagram of the corrected target travel path after the approach process when the intermediate mode is selected, and FIG. It is explanatory drawing of the correction | amendment target driving | running route after an approach process.

本実施形態では、走行車線の境界線が検出されていない場合には、走行経路補正処理において、接近処理が実行される。前出の図3では、追い抜きの際に車両1は車両3の右側を走行する。よって、車両3との衝突を回避するために、走行経路補正処理により計算される補正目標走行経路は、目標走行経路よりも横方向(右側)に位置する。しかしながら、図5〜図7では、車両1のECU10は、走行路7の境界線のうち、少なくとも車両3の右側に位置する境界線8Rを検出していない。よって、未検出の境界線8Rが考慮されない場合、補正目標走行経路が実際には境界線8Rを超えるおそれがある。   In the present embodiment, when the boundary line of the travel lane is not detected, the approach process is executed in the travel route correction process. In FIG. 3 described above, the vehicle 1 travels on the right side of the vehicle 3 when overtaking. Therefore, in order to avoid a collision with the vehicle 3, the corrected target travel route calculated by the travel route correction process is located in the lateral direction (right side) with respect to the target travel route. However, in FIGS. 5 to 7, the ECU 10 of the vehicle 1 does not detect the boundary line 8 </ b> R located at least on the right side of the vehicle 3 among the boundary lines of the travel path 7. Therefore, when the undetected boundary line 8R is not taken into account, the corrected target travel route may actually exceed the boundary line 8R.

そこで、接近処理では、このような車線逸脱を防止するため、図3を参照して説明した補正目標走行経路(Rc1〜Rc3)を更に補正して、接近目標走行経路(Rc1_a〜Rc3_a)を算出する。即ち、境界線が検出されている場合(図3)に算出される補正目標走行経路と比べて、境界線が検出されていない場合(図5〜図7)に算出される接近目標走行経路は、横方向において車両3に近づくように計算される。   Therefore, in the approach processing, in order to prevent such lane departure, the corrected target travel route (Rc1 to Rc3) described with reference to FIG. 3 is further corrected to calculate the approach target travel route (Rc1_a to Rc3_a). To do. That is, the approach target travel path calculated when the boundary line is not detected (FIGS. 5 to 7) is compared with the corrected target travel path calculated when the boundary line is detected (FIG. 3). , Calculated so as to approach the vehicle 3 in the lateral direction.

直線優先モード選択時に境界線(少なくとも境界線8R)が検出されていない場合、図5に示すように、接近目標走行経路Rc1_aが算出される。接近目標走行経路Rc1_aは、車両3の横方向位置において補正目標走行経路Rc1よりも車両3に接近する。図5の例では、横方向における車両1と車両3との最接近距離が所定接近距離(例えば50cm)である。所定接近距離は安全距離以上に設定されている。また、接近目標走行経路Rc1_aの(接近)目標速度は、速度分布領域40の許容上限値Vlimを超えないように再計算され、補正目標走行経路Rc1よりも小さく設定される。 When the boundary line (at least the boundary line 8R) is not detected when the straight line priority mode is selected, the approach target travel route Rc1_a is calculated as shown in FIG. The approach target travel route Rc1_a is closer to the vehicle 3 than the corrected target travel route Rc1 at the lateral position of the vehicle 3. In the example of FIG. 5, the closest approach distance between the vehicle 1 and the vehicle 3 in the lateral direction is a predetermined approach distance (for example, 50 cm). The predetermined approach distance is set to be greater than the safe distance. Further, the (approaching) target speed of the approach target travel route Rc1_a is recalculated so as not to exceed the allowable upper limit value V lim of the speed distribution region 40, and is set smaller than the corrected target travel route Rc1.

また、中間モード選択時に境界線(少なくとも境界線8R)が検出されていない場合、図6に示すように、接近目標走行経路Rc2_aが算出される。接近目標走行経路Rc2_aは、車両3の横方向位置において補正目標走行経路Rc2よりも車両3により接近する。図6の例では、補正目標走行経路Rc2は、目標走行経路Rに対して、最大で回避距離L2だけ横方向に変位している。接近処理が実行されると、接近目標走行経路Rc2_aは、目標走行経路Rに対して、最大で接近回避距離L2_r(=d・L2)だけ横方向に変位するように設定される。この例では、係数dは0.25である。しかし、これに限らず、係数dを、0から1の間(0<c<1)で任意に設定することができる。また、(接近)目標位置の設定に伴い、各(接近)目標位置に対応する(接近)目標速度も速度分布領域40の許容上限値Vlimを超えないように再計算される。また、これに限らず、直線優先モードと同様に、横方向における車両1と車両3との最接近距離が所定接近距離となるように接近目標走行経路Rc2_aを計算してもよい(即ち、Rc2_a=Rc1_a)。 Further, when the boundary line (at least the boundary line 8R) is not detected when the intermediate mode is selected, the approach target travel route Rc2_a is calculated as shown in FIG. The approach target travel route Rc2_a is closer to the vehicle 3 than the corrected target travel route Rc2 at the lateral position of the vehicle 3. In the example of FIG. 6, the corrected target travel route Rc2 is displaced laterally with respect to the target travel route R by a maximum avoidance distance L2. When the approach process is executed, the approach target travel route Rc2_a is set to be displaced laterally with respect to the target travel route R by the approach avoidance distance L2_r (= d · L2) at the maximum. In this example, the coefficient d is 0.25. However, the present invention is not limited to this, and the coefficient d can be arbitrarily set between 0 and 1 (0 <c <1). Further, with the setting of the (approach) target position, the (approach) target speed corresponding to each (approach) target position is recalculated so as not to exceed the allowable upper limit value V lim of the speed distribution region 40. Not limited to this, the approach target travel route Rc2_a may be calculated so that the closest approach distance between the vehicle 1 and the vehicle 3 in the lateral direction becomes a predetermined approach distance, as in the straight line priority mode (that is, Rc2_a = Rc1_a).

また、速度優先モード選択時に境界線(少なくとも境界線8R)が検出されていない場合、図7に示すように、接近目標走行経路Rc3_aが算出される。接近目標走行経路Rc3_aは、車両3の横方向位置において補正目標走行経路Rc3よりも車両3により接近する。図7の例では、補正目標走行経路Rc3は、目標走行経路Rに対して、最大で回避距離L3だけ横方向に変位している。接近処理が実行されると、接近目標走行経路Rc3_aは、目標走行経路Rに対して、最大で接近回避距離L3_r(=d・L3)だけ横方向に変位するように設定される。この例では、係数dは0.25である。しかし、これに限らず、係数dを、0から1の間(0<c<1)で任意に設定することができる。また、(接近)目標位置の設定に伴い、各(接近)目標位置に対応する(接近)目標速度も速度分布領域40の許容上限値Vlimを超えないように再計算される。また、これに限らず、直線優先モードと同様に、横方向における車両1と車両3との最接近距離が所定接近距離となるように接近目標走行経路Rc3_aを計算してもよい(即ち、Rc3_a=Rc1_a)。したがって、速度優先モードが選択されていても、境界線が検出されない場合には、接近目標走行経路Rc3_aは、車両1の現在の速度よりも小さい(接近)目標速度を含む。なお、上記係数dは、各回避モードにおいて同じ値であってもよいし、異なる値であってもよい。 Further, when the boundary line (at least the boundary line 8R) is not detected when the speed priority mode is selected, the approach target travel route Rc3_a is calculated as shown in FIG. The approach target travel route Rc3_a is closer to the vehicle 3 than the corrected target travel route Rc3 at the lateral position of the vehicle 3. In the example of FIG. 7, the corrected target travel route Rc3 is laterally displaced from the target travel route R by the avoidance distance L3 at the maximum. When the approach process is executed, the approach target travel route Rc3_a is set to be displaced laterally with respect to the target travel route R by the approach avoidance distance L3_r (= d · L3) at the maximum. In this example, the coefficient d is 0.25. However, the present invention is not limited to this, and the coefficient d can be arbitrarily set between 0 and 1 (0 <c <1). Further, with the setting of the (approach) target position, the (approach) target speed corresponding to each (approach) target position is recalculated so as not to exceed the allowable upper limit value V lim of the speed distribution region 40. In addition, the approach target travel route Rc3_a may be calculated so that the closest approach distance between the vehicle 1 and the vehicle 3 in the lateral direction is a predetermined approach distance (ie, Rc3_a). = Rc1_a). Therefore, even when the speed priority mode is selected, when the boundary line is not detected, the approach target travel route Rc3_a includes a target speed that is smaller (approaching) than the current speed of the vehicle 1. The coefficient d may be the same value or a different value in each avoidance mode.

また、先行車追従モードにおいて、車線両端部の検出の可否及び先行車の有無にかかわらず、且つ、選択されている回避モードにかかわらず、運転者により、ステアリングホイールが操作されると、ECU10は、障害物との衝突のおそれがないと判断する場合には、ステアリングホイール操作に基づく車両1の横方向移動を許容する。例えば、障害物から離れる方向にステアリングホイールが操作される場合、障害物との衝突及び車線逸脱のおそれがないと判断される。しかしながら、これらの判断をすることなく、いずれの方向のステアリングホイールの操作も無効にして、ステアリングホイール操作に基づく車両1の横方向移動を禁止するように構成してもよい。   In the preceding vehicle follow-up mode, when the steering wheel is operated by the driver regardless of whether the lane ends can be detected and whether there is a preceding vehicle, and regardless of the selected avoidance mode, the ECU 10 When it is determined that there is no risk of collision with an obstacle, the lateral movement of the vehicle 1 based on the steering wheel operation is permitted. For example, when the steering wheel is operated in a direction away from the obstacle, it is determined that there is no risk of collision with the obstacle and lane departure. However, without making these determinations, the operation of the steering wheel in any direction may be invalidated and the lateral movement of the vehicle 1 based on the steering wheel operation may be prohibited.

一方、ECU10は、ステアリングホイール操作により、障害物との衝突及び車線逸脱のおそれがあると判断する場合には、ステアリングホイールに操作方向とは逆方向のアシストトルクを加えて、ステアリングホイールの操作を抑制する。   On the other hand, when the ECU 10 determines that there is a risk of collision with an obstacle and departure from the lane due to the steering wheel operation, the assist torque in the direction opposite to the operation direction is applied to the steering wheel to operate the steering wheel. Suppress.

次に、図8及び図9を参照して、本実施形態の車両制御システム100における運転支援制御の処理フローを説明する。図8は運転支援制御の処理フローであり、図9は走行経路補正処理の処理フローである。   Next, with reference to FIG.8 and FIG.9, the processing flow of the driving assistance control in the vehicle control system 100 of this embodiment is demonstrated. FIG. 8 is a processing flow of driving support control, and FIG. 9 is a processing flow of travel route correction processing.

ECU10は、図8の処理フローを所定時間(例えば、0.1秒)ごとに繰り返して実行している。まず、ECU10は、情報取得処理を実行する(S11)。情報取得処理において、ECU10は、測位システム29及びナビゲーションシステム30から、現在車両位置情報及び地図情報を取得し(S11a)、車載カメラ21,ミリ波レーダ22,車速センサ23,加速度センサ24,ヨーレートセンサ25,運転者操作部35等からセンサ情報を取得し(S11b)、操舵角センサ26,アクセルセンサ27,ブレーキセンサ28,把持センサ34等からスイッチ情報を取得する(S11c)。   The ECU 10 repeatedly executes the processing flow of FIG. 8 every predetermined time (for example, 0.1 seconds). First, the ECU 10 executes information acquisition processing (S11). In the information acquisition process, the ECU 10 acquires the current vehicle position information and map information from the positioning system 29 and the navigation system 30 (S11a), the in-vehicle camera 21, the millimeter wave radar 22, the vehicle speed sensor 23, the acceleration sensor 24, and the yaw rate sensor. 25, sensor information is acquired from the driver operation unit 35 or the like (S11b), and switch information is acquired from the steering angle sensor 26, the accelerator sensor 27, the brake sensor 28, the grip sensor 34, or the like (S11c).

次に、ECU10は、情報取得処理(S11)において取得した各種の情報を用いて所定の情報検出処理を実行する(S12)。情報検出処理において、ECU10は、現在車両位置情報及び地図情報並びにセンサ情報から、車両1の周囲及び前方エリアにおける走行路形状に関する走行路情報(直線区間及びカーブ区間の有無,各区間長さ,カーブ区間の曲率半径,車線幅,車線両端部位置,車線数,交差点の有無,カーブ曲率で規定される制限速度等)、走行規制情報(制限速度、赤信号等)、障害物情報(先行車や障害物の有無,位置,速度等)、先行車軌跡情報(先行車の位置及び速度)を検出する(S12a)。   Next, ECU10 performs a predetermined information detection process using the various information acquired in the information acquisition process (S11) (S12). In the information detection process, the ECU 10 determines, based on the current vehicle position information, the map information, and the sensor information, the road information about the road shape around the vehicle 1 and the front area (presence / absence of straight sections and curve sections, lengths of sections, Section radius of curvature, lane width, lane end positions, number of lanes, presence / absence of intersection, speed limit defined by curve curvature, etc., travel regulation information (speed limit, red signal, etc.), obstacle information (preceding vehicle and The presence / absence of an obstacle, position, speed, etc.) and preceding vehicle locus information (position and speed of the preceding vehicle) are detected (S12a).

また、ECU10は、スイッチ情報から、運転者による車両操作に関する車両操作情報(操舵角,アクセルペダル踏み込み量,ブレーキペダル踏み込み量,ステアリングホイールの把持力等)を検出し(S12b)、更に、スイッチ情報及びセンサ情報から、車両1の挙動に関する走行挙動情報(車速、加減速度、横加速度、ヨーレート等)を検出する(S12c)。   Further, the ECU 10 detects vehicle operation information (steering angle, accelerator pedal depression amount, brake pedal depression amount, steering wheel gripping force, etc.) relating to vehicle operation by the driver from the switch information (S12b), and further, switch information. From the sensor information, travel behavior information (vehicle speed, acceleration / deceleration, lateral acceleration, yaw rate, etc.) relating to the behavior of the vehicle 1 is detected (S12c).

次に、ECU10は、計算により得られた情報に基づいて、走行経路計算処理を実行する(S13)。走行経路計算処理では、上述のように、第1走行経路の計算処理(S13a)、第2走行経路の計算処理(S13b)、第3走行経路の計算処理(S13c)がそれぞれ実行される。   Next, the ECU 10 executes a travel route calculation process based on the information obtained by the calculation (S13). In the travel route calculation process, as described above, the first travel route calculation process (S13a), the second travel route calculation process (S13b), and the third travel route calculation process (S13c) are executed.

第1走行経路計算処理では、ECU10は、設定車速,車線両端部,車線幅,制限速度,車速,加減速度,ヨーレート,操舵角,横加速度等に基づいて、直線区間では車線中央付近を走行するように、カーブ区間では旋回半径が大きくなるようにカーブのイン側を走行するように、且つ、設定車速,交通標識による制限車速,及びカーブ曲率により規定される制限車速のうち最も低速な速度を上限速度とするように、所定期間分(例えば、2〜4秒)の走行経路R1(目標位置P1_k及び目標速度V1_k)を計算する。   In the first travel route calculation process, the ECU 10 travels near the center of the lane in the straight section based on the set vehicle speed, both ends of the lane, lane width, speed limit, vehicle speed, acceleration / deceleration, yaw rate, steering angle, lateral acceleration, and the like. Thus, in the curve section, the slowest speed among the set vehicle speed, the limited vehicle speed by the traffic sign, and the limited vehicle speed defined by the curve curvature is set so that the vehicle turns on the inside of the curve so that the turning radius becomes large. The travel route R1 (target position P1_k and target speed V1_k) for a predetermined period (for example, 2 to 4 seconds) is calculated so as to be the upper limit speed.

また、第2走行経路計算処理では、ECU10は、センサ情報等から取得した先行車の先行車軌跡情報(位置及び速度)から、先行車と車両1との間に所定の車間距離を維持しつつ、車間距離を走行する時間分だけ遅れて先行車の挙動(位置及び速度)に追従するように、所定期間分の走行経路R2を計算する。   In the second travel route calculation process, the ECU 10 maintains a predetermined inter-vehicle distance between the preceding vehicle and the vehicle 1 based on the preceding vehicle trajectory information (position and speed) of the preceding vehicle acquired from the sensor information or the like. The travel route R2 for a predetermined period is calculated so as to follow the behavior (position and speed) of the preceding vehicle with a delay of the travel time of the inter-vehicle distance.

また、第3走行経路計算処理では、ECU10は、車両操作情報,走行挙動情報等に基づいて、現在の車両1の挙動から推定される所定期間分の走行経路R3を計算する。   In the third travel route calculation process, the ECU 10 calculates a travel route R3 for a predetermined period estimated from the current behavior of the vehicle 1 based on the vehicle operation information, the travel behavior information, and the like.

次に、ECU10は、計算した3つの走行経路から1つの目標走行経路を選択する走行経路選択処理を実行する(S14)。この処理では、ECU10は、上述のように、運転者がモード選択スイッチ36により選択している運転支援モードに加えて、車線両端部の検出の可否、先行車の有無に基づいて、1つの目標走行経路を選択する(図2参照)。   Next, the ECU 10 executes a travel route selection process for selecting one target travel route from the calculated three travel routes (S14). In this process, as described above, the ECU 10 determines one target based on whether or not both ends of the lane are detected and whether there is a preceding vehicle, in addition to the driving support mode selected by the driver using the mode selection switch 36. A travel route is selected (see FIG. 2).

更に、ECU10は、選択した目標走行経路の補正処理を実行する(S15)。この走行経路補正処理では、ECU10は、障害物情報(例えば、図3に示した駐車車両3)に基づいて、図3,図5〜図7を参照して上述したように、目標走行経路を補正する。走行経路補正処理では、原則的に選択されている運転支援モードに応じて、速度制御及び/又はステアリング制御により、車両1に障害物を回避させる、又は先行車を追従させるように、走行経路が補正される。   Further, the ECU 10 executes a correction process for the selected target travel route (S15). In this travel route correction process, the ECU 10 determines the target travel route based on the obstacle information (for example, the parked vehicle 3 shown in FIG. 3) as described above with reference to FIGS. to correct. In the travel route correction process, the travel route is determined so that the vehicle 1 avoids an obstacle or follows the preceding vehicle by speed control and / or steering control according to the driving support mode selected in principle. It is corrected.

次に、ECU10は、選択されている運転支援モードに応じて、車両1が最終的に算出された走行経路上を走行するように、該当する制御システム(エンジン制御システム31,ブレーキ制御システム32,ステアリング制御システム33)へ要求信号を出力する(S16)。   Next, the ECU 10 controls the corresponding control system (the engine control system 31, the brake control system 32, so that the vehicle 1 travels on the travel route calculated finally according to the selected driving support mode. A request signal is output to the steering control system 33) (S16).

次に、図9を参照して、図8の走行経路補正処理(S15)の詳細な処理フローを説明する。
まず、ECU10は、障害物情報から車両1の前方に障害物が存在するか否かを判定する(S21)。障害物が存在しない場合(S21;No)、ステップS14で選択された目標走行経路を補正することなく処理を終了する。一方、障害物が存在する場合(S21;Yes)、ECU10は、検出した障害物に対して速度分布領域を設定し(S22)、更に回避モード選択信号を読み込む(S23)。ECU10は、回避モード選択信号により、回避モードを特定する。
Next, a detailed processing flow of the travel route correction process (S15) of FIG. 8 will be described with reference to FIG.
First, the ECU 10 determines whether there is an obstacle ahead of the vehicle 1 from the obstacle information (S21). If there is no obstacle (S21; No), the process ends without correcting the target travel route selected in step S14. On the other hand, if there is an obstacle (S21; Yes), the ECU 10 sets a speed distribution region for the detected obstacle (S22), and further reads an avoidance mode selection signal (S23). The ECU 10 specifies the avoidance mode based on the avoidance mode selection signal.

次に、ECU10は、走行路情報から走行車線の両側の境界線が検出されているか否かを判定する(S24)。なお、ステップS24では、目標走行経路の両側の境界線のうち、障害物が存在しない側の境界線(即ち、障害物に対して目標走行経路が存在する側の境界線、又は、車両1が逸脱するおそれがある回避側の境界線)のみを検出対象としてもよい。即ち、目標走行経路に対して障害物が存在する側(障害物に対して目標走行経路が存在しない側)の境界線の検出の可否は判定しなくてもよい。   Next, the ECU 10 determines whether boundary lines on both sides of the travel lane are detected from the travel route information (S24). In step S24, of the boundary lines on both sides of the target travel route, the boundary line on the side where no obstacle exists (that is, the boundary line on the side where the target travel route exists with respect to the obstacle, or the vehicle 1 Only the avoidance side boundary line that may deviate may be detected. That is, it is not necessary to determine whether or not the boundary line on the side where an obstacle exists with respect to the target travel route (the side where the target travel route does not exist with respect to the obstacle) can be detected.

境界線が検出されている場合(S24;Yes)、ECU10は、補正目標走行経路を算出して(S25)、処理を終了する。即ち、ECU10は、図3を参照して説明したように、ステップS14で選択された目標走行経路Rの目標速度が、速度分布領域の許容上限値を超えないように、選択されている回避モードに応じて目標走行経路Rを補正して、補正目標走行経路を算出する。なお、上述のように、先行車追従モードで先行車が存在している場合には、ECU10は、目標走行経路R(第2走行経路)を補正することなくそのまま出力してもよい。   When the boundary line is detected (S24; Yes), the ECU 10 calculates a corrected target travel route (S25) and ends the process. That is, as described with reference to FIG. 3, the ECU 10 selects the avoidance mode so that the target speed of the target travel route R selected in step S14 does not exceed the allowable upper limit value of the speed distribution region. Accordingly, the target travel route R is corrected to calculate a corrected target travel route. As described above, when there is a preceding vehicle in the preceding vehicle following mode, the ECU 10 may output the target traveling route R (second traveling route) as it is without correcting it.

一方、境界線が検出されていない場合(S24;No)、ECU10は、接近目標走行経路を算出して(S27)、処理を終了する。即ち、ECU10は、図5〜図7を参照して説明したように、選択されている回避モードに応じて、補正目標走行経路よりも障害物に接近する接近目標走行経路を算出する。なお、上述のように、先行車追従モードで先行車が存在している場合には、ECU10は、目標走行経路R(第2走行経路)を補正することなくそのまま出力してもよい。   On the other hand, when the boundary line is not detected (S24; No), the ECU 10 calculates the approach target travel route (S27) and ends the process. That is, as described with reference to FIGS. 5 to 7, the ECU 10 calculates an approach target travel route that is closer to the obstacle than the corrected target travel route in accordance with the selected avoidance mode. As described above, when there is a preceding vehicle in the preceding vehicle following mode, the ECU 10 may output the target traveling route R (second traveling route) as it is without correcting it.

なお、ステップS27において、選択されている回避モードにかかわらず、直線優先モードを選択されている回避モードとして、接近目標走行経路を算出するように構成してもよい。   In step S27, the approach target travel route may be calculated using the straight line priority mode as the selected avoidance mode regardless of the selected avoidance mode.

次に、図10〜図13を参照して、本実施形態の車両制御システムの改変例について説明する。図10は直線優先モード選択時における制限処理後の補正目標走行経路の説明図、図11は中間モード選択時における制限処理後の補正目標走行経路の説明図、図12は速度優先モード選択時における制限処理後の補正目標走行経路の説明図、図13は走行経路補正処理の処理フローである。   Next, a modified example of the vehicle control system of the present embodiment will be described with reference to FIGS. FIG. 10 is an explanatory diagram of the corrected target travel route after the restriction process when the straight line priority mode is selected, FIG. 11 is an explanatory diagram of the corrected target travel route after the restriction process when the intermediate mode is selected, and FIG. 12 is a diagram when the speed priority mode is selected. FIG. 13 is an explanatory diagram of the corrected target travel route after the restriction process, and FIG. 13 is a process flow of the travel route correction process.

上記実施形態では、通常の補正目標走行経路算出処理(S25)又は接近処理(S27)が選択的に実施されるのに対し、この改変例では、さらに制限処理(図13のS28)を加えた3つの処理から1つの処理が選択的に実施される。   In the above embodiment, the normal correction target travel route calculation process (S25) or the approach process (S27) is selectively performed, but in this modified example, a restriction process (S28 in FIG. 13) is further added. One process is selectively performed from the three processes.

制限処理も接近処理と同様に、車線の境界線が検出されない場合に車線逸脱を防止するためのものである。制限処理は、補正目標走行経路(Rc1〜Rc3)を更に補正して、制限目標走行経路(Rc1_r〜Rc3_r)を算出する。即ち、境界線が検出されている場合に算出される補正目標走行経路(図3)と比べて、境界線が検出されていない場合に算出される制限目標走行経路(図10〜図12)は、目標走行経路Rに対する横方向の移動距離(回避距離)が小さく制限される。   Similar to the approach process, the restriction process is for preventing a lane departure when a lane boundary is not detected. In the restriction process, the corrected target travel route (Rc1 to Rc3) is further corrected to calculate the restricted target travel route (Rc1_r to Rc3_r). That is, compared to the corrected target travel route (FIG. 3) calculated when the boundary line is detected, the limited target travel route (FIGS. 10 to 12) calculated when the boundary line is not detected. The lateral movement distance (avoidance distance) with respect to the target travel route R is limited to be small.

直線優先モード選択時に境界線(少なくとも境界線8R)が検出されていない場合、図10に示すように、制限目標走行経路Rc1_rが算出される。図10の例では、目標走行経路R上の目標位置が車両3から少なくとも安全距離以上離れているので、補正目標走行経路Rc1は、目標走行経路Rに対して横方向へ移動されていない。ただし、補正目標走行経路Rc1の(補正)目標速度は、速度分布領域40の許容上限値Vlimを超えないように再計算される。よって、この例では、制限目標走行経路Rc1_rも、補正目標走行経路Rc1に対して横方向位置を変更する必要が無い。 When the boundary line (at least the boundary line 8R) is not detected when the straight line priority mode is selected, as shown in FIG. 10, the limited target travel route Rc1_r is calculated. In the example of FIG. 10, since the target position on the target travel route R is at least a safe distance from the vehicle 3, the corrected target travel route Rc <b> 1 is not moved laterally with respect to the target travel route R. However, the (corrected) target speed of the corrected target travel route Rc1 is recalculated so as not to exceed the allowable upper limit value V lim of the speed distribution region 40. Therefore, in this example, it is not necessary for the limited target travel route Rc1_r to change the lateral position with respect to the corrected target travel route Rc1.

一方、車両3との衝突を回避するために、補正目標走行経路Rc1が目標走行経路Rに対して所定の回避距離だけ横方向へ移動されている場合には、制限目標走行経路Rc1_rは、各目標位置の横方向の回避距離が補正目標走行経路Rc1よりも小さく制限される。例えば、車両3に対して安全距離以上離間する限りにおいて、制限目標走行経路Rc1_rの制限された回避距離を、対応する各目標位置において、補正目標走行経路Rc1の目標走行経路Rに対する回避距離に係数c(0<c<1)を乗じた値に設定することができる。また、これに限らず、各目標位置における回避距離を、所定値(例えば、50cm)以下に制限してもよい(回避距離≦所定値)。この場合、回避距離が所定値を超えていなければ制限目標走行経路Rc1_rは補正目標走行経路Rc1から変更されない。   On the other hand, when the corrected target travel route Rc1 is moved laterally by a predetermined avoidance distance with respect to the target travel route R in order to avoid a collision with the vehicle 3, the restricted target travel route Rc1_r The lateral avoidance distance of the target position is limited to be smaller than the corrected target travel route Rc1. For example, as long as it is separated from the vehicle 3 by a safety distance or more, the restricted avoidance distance of the restricted target travel route Rc1_r is a coefficient for the avoidance distance of the corrected target travel route Rc1 with respect to the target travel route R at each corresponding target position. A value obtained by multiplying c (0 <c <1) can be set. In addition, the avoidance distance at each target position is not limited to this, and may be limited to a predetermined value (for example, 50 cm) or less (avoidance distance ≦ predetermined value). In this case, if the avoidance distance does not exceed the predetermined value, the restricted target travel route Rc1_r is not changed from the corrected target travel route Rc1.

また、中間モード選択時に境界線(少なくとも境界線8R)が検出されていない場合、図11に示すように、制限目標走行経路Rc2_rが算出される。図11の例では、補正目標走行経路Rc2は、目標走行経路Rに対して、最大で回避距離L2だけ横方向に変位している。制限処理が実行されると、制限目標走行経路Rc2_rは、目標走行経路Rに対して、最大で制限回避距離L2_r(=c・L2)だけ横方向に変位するように設定される。この例では、係数cは0.5である。しかし、これに限らず、係数cを、0から1の間(0<c<1)で任意に設定することができる。また、(制限)目標位置の設定に伴い、各(制限)目標位置に対応する(制限)目標速度も速度分布領域40の許容上限値Vlimを超えないように再計算される。また、これに限らず、直線優先モードと同様に、各目標位置における回避距離を、所定値(例えば、50cm)以下に制限してもよい(回避距離≦所定値)。この場合、回避距離が所定値を超えていなければ制限目標走行経路Rc2_rは補正目標走行経路Rc2から変更されない。 Further, when the boundary line (at least the boundary line 8R) is not detected when the intermediate mode is selected, the limited target travel route Rc2_r is calculated as shown in FIG. In the example of FIG. 11, the corrected target travel route Rc2 is displaced laterally with respect to the target travel route R by the avoidance distance L2 at the maximum. When the restriction process is executed, the restriction target travel route Rc2_r is set so as to be displaced laterally with respect to the target travel route R by the restriction avoidance distance L2_r (= c · L2) at the maximum. In this example, the coefficient c is 0.5. However, the present invention is not limited to this, and the coefficient c can be arbitrarily set between 0 and 1 (0 <c <1). Further, with the setting of the (limit) target position, the (limit) target speed corresponding to each (limit) target position is also recalculated so as not to exceed the allowable upper limit value V lim of the speed distribution region 40. Further, the present invention is not limited to this, and the avoidance distance at each target position may be limited to a predetermined value (for example, 50 cm) or less (avoidance distance ≦ predetermined value) as in the straight line priority mode. In this case, if the avoidance distance does not exceed the predetermined value, the restricted target travel route Rc2_r is not changed from the corrected target travel route Rc2.

また、速度優先モード選択時に境界線(少なくとも境界線8R)が検出されていない場合、図12に示すように、制限目標走行経路Rc3_rが算出される。図12の例では、補正目標走行経路Rc3は、目標走行経路Rに対して、最大で回避距離L3だけ横方向に変位している。これに対して、制限処理が実行されることにより、制限目標走行経路Rc3_rは、目標走行経路Rに対して、最大で制限回避距離L3_r(=c・L3)だけ横方向に変位するように設定される。係数cは中間モード選択時の係数と同様である。また、(制限)目標位置の設定に伴い、各(制限)目標位置に対応する(制限)目標速度も速度分布領域40の許容上限値Vlimを超えないように再計算される。したがって、速度優先モードが選択されていても、境界線が検出されない場合には、制限目標走行経路Rc3_rは、車両1の現在の速度よりも小さい(制限)目標速度を含む。また、直線優先モードと同様に、各目標位置における回避距離を、所定値(例えば、50cm)以下に制限してもよい(回避距離≦所定値)。この場合、回避距離が所定値を超えていなければ制限目標走行経路Rc3_rは補正目標走行経路Rc3から変更されない。 Further, when the boundary line (at least the boundary line 8R) is not detected when the speed priority mode is selected, the limited target travel route Rc3_r is calculated as shown in FIG. In the example of FIG. 12, the corrected target travel route Rc3 is displaced laterally with respect to the target travel route R by the avoidance distance L3 at the maximum. On the other hand, the restriction target travel route Rc3_r is set such that the restriction target travel route Rc3_r is displaced in the lateral direction at a maximum by the restriction avoidance distance L3_r (= c · L3) with respect to the target travel route R by executing the restriction process. Is done. The coefficient c is the same as the coefficient when the intermediate mode is selected. Further, with the setting of the (limit) target position, the (limit) target speed corresponding to each (limit) target position is also recalculated so as not to exceed the allowable upper limit value V lim of the speed distribution region 40. Therefore, even if the speed priority mode is selected, when the boundary line is not detected, the limited target travel route Rc3_r includes a target speed that is smaller (limited) than the current speed of the vehicle 1. Similarly to the straight line priority mode, the avoidance distance at each target position may be limited to a predetermined value (for example, 50 cm) or less (avoidance distance ≦ predetermined value). In this case, if the avoidance distance does not exceed the predetermined value, the restricted target travel route Rc3_r is not changed from the corrected target travel route Rc3.

なお、上記係数cは、各回避モードにおいて同じ値であってもよいし、異なる値であってもよい。また、回避距離の上限値を規定する上記所定値は、各回避モードにおいて同じ値(例えば、50cm)であってもよいし、異なる値(直進優先モード:30cm、中間モード:40cm、速度優先モード:50cm)であってもよい。   The coefficient c may be the same value or a different value in each avoidance mode. Further, the predetermined value defining the upper limit value of the avoidance distance may be the same value (for example, 50 cm) in each avoidance mode, or may be a different value (straight ahead priority mode: 30 cm, intermediate mode: 40 cm, speed priority mode). : 50 cm).

本実施形態では、接近目標走行経路(図5〜図7参照)と制限目標走行経路(図10〜図12参照)を、各回避モードで比較すると、制限目標走行経路よりも接近目標走行経路の方が、より障害物(車両3)に接近した経路(より境界線から離れた経路)を走行することになる。このため、車両1が制限目標走行経路に沿って走行するよりも、接近目標走行経路に沿って走行する方が、車両3を追い抜く際により減速されるが、車線7を逸脱するおそれはより低減される。   In the present embodiment, when the approach target travel route (see FIGS. 5 to 7) and the restricted target travel route (see FIGS. 10 to 12) are compared in each avoidance mode, the approach target travel route is more than the restricted target travel route. The vehicle travels on a route closer to the obstacle (vehicle 3) (a route farther from the boundary). Therefore, the vehicle 1 traveling along the approach target travel route is decelerated when overtaking the vehicle 3 rather than traveling along the restricted target travel route, but the risk of deviating from the lane 7 is further reduced. Is done.

次に、図13を参照して、改変例にかかる走行経路補正処理(S15)の詳細な処理フローを説明する。
ステップS21〜S25は、図9と同様であるので、重複する説明は省略する。
ステップS24において、境界線が検出されていない場合(S24;No)、ECU10は、センサ情報又はスイッチ情報に基づいて、所定条件が成立しているか否かを判定する(S26)。
Next, a detailed processing flow of the travel route correction process (S15) according to the modified example will be described with reference to FIG.
Steps S21 to S25 are the same as those in FIG.
In step S24, when the boundary line is not detected (S24; No), the ECU 10 determines whether a predetermined condition is satisfied based on the sensor information or the switch information (S26).

所定条件が成立している場合(S26;Yes)、ECU10は、接近目標走行経路を算出して(S27)、処理を終了する。即ち、ECU10は、図5〜図7を参照して説明したように、選択されている回避モードに応じて、補正目標走行経路よりも障害物に接近した接近目標走行経路を算出する。なお、上述のように、先行車追従モードで先行車が存在している場合には、ECU10は、目標走行経路R(第2走行経路)を補正することなくそのまま出力してもよい。   When the predetermined condition is satisfied (S26; Yes), the ECU 10 calculates the approach target travel route (S27) and ends the process. That is, as described with reference to FIGS. 5 to 7, the ECU 10 calculates the approach target travel route that is closer to the obstacle than the corrected target travel route in accordance with the selected avoidance mode. As described above, when there is a preceding vehicle in the preceding vehicle following mode, the ECU 10 may output the target traveling route R (second traveling route) as it is without correcting it.

所定条件は、例えば、障害物が静止物であるか否か、車両1の車速(絶対速度)が所定速度(例えば、30km/h)以下であるか否か、運転者がステアリングホイールを握っていないか握っているか(ステアリングホイールの把持力が所定値以下か否か)、又はこれらの組み合わせである。即ち、これら条件が成立している場合、車両1はより障害物に接近した経路を走行することが可能である。   The predetermined condition is, for example, whether the obstacle is a stationary object, whether the vehicle speed (absolute speed) of the vehicle 1 is a predetermined speed (for example, 30 km / h) or less, and whether the driver is holding the steering wheel. Whether or not the steering wheel is gripped (whether or not the gripping force of the steering wheel is a predetermined value or less), or a combination thereof. That is, when these conditions are satisfied, the vehicle 1 can travel on a route closer to the obstacle.

例えば、障害物が静止物(例えば、停車車両,電柱等)である場合は、障害物が動かないため接近しても衝突するおそれが低い。また、車速が所定速度以下の低速である場合は、障害物への接近に伴う車両1の減速幅が小さく、運転者に違和感を与えにくい。また、運転者がステアリングホイールを握っていない場合は、車線逸脱を確実に防止する必要がある。なお、運転者がステアリングホイールを握っている場合は、車線逸脱防止のための運転者自身による回避操作(操舵)が期待される。よって、これらの場合には、障害物により接近する接近目標走行経路を走行することにより、確実に車線逸脱を回避することができる。   For example, when the obstacle is a stationary object (for example, a parked vehicle, a utility pole, etc.), the obstacle does not move, so there is a low possibility of collision even when approaching. Further, when the vehicle speed is a low speed equal to or lower than a predetermined speed, the deceleration width of the vehicle 1 accompanying the approach to the obstacle is small, and it is difficult for the driver to feel uncomfortable. Further, when the driver does not hold the steering wheel, it is necessary to reliably prevent lane departure. When the driver is holding the steering wheel, an avoidance operation (steering) by the driver himself for preventing lane departure is expected. Therefore, in these cases, it is possible to reliably avoid lane departure by traveling on the approach target travel route that is closer to the obstacle.

一方、所定条件が成立していない場合(S26;No)、ECU10は、制限目標走行経路を算出して(S28)、処理を終了する。即ち、ECU10は、図10〜図12を参照して説明したように、選択されている回避モードに応じて、補正目標走行経路の横方向の回避距離を小さく設定した制限目標走行経路を算出する。なお、上述のように、先行車追従モードで先行車が存在している場合には、ECU10は、目標走行経路R(第2走行経路)を補正することなくそのまま出力してもよい。   On the other hand, when the predetermined condition is not satisfied (S26; No), the ECU 10 calculates the restricted target travel route (S28) and ends the process. That is, as described with reference to FIGS. 10 to 12, the ECU 10 calculates a restricted target travel route in which the lateral avoidance distance of the corrected target travel route is set small according to the selected avoidance mode. . As described above, when there is a preceding vehicle in the preceding vehicle following mode, the ECU 10 may output the target traveling route R (second traveling route) as it is without correcting it.

なお、ステップS27において、選択されている回避モードにかかわらず、直線優先モードを選択されている回避モードとして、制限目標走行経路を算出するように構成してもよい。   In step S27, the limited target travel route may be calculated using the straight line priority mode as the selected avoidance mode regardless of the selected avoidance mode.

次に、本実施形態の車両制御システムの作用について説明する。
本実施形態は、車両1が走行する車線7の目標走行経路Rを設定する車両制御装置(ECU10)であって、目標走行経路Rは、目標位置及び目標速度を含み、車線7上に障害物(車両3)が存在する場合(S21;Yes)、障害物3と車両1との間に、障害物3に対する車両1の相対速度の許容上限値Vlimの分布を規定する速度分布領域40を設定し、車両1の相対速度が許容上限値Vlimを超えず、且つ、車両1が障害物3を回避するように、目標走行経路Rを補正して補正目標走行経路Rcを計算する走行経路補正処理(S15)を実行するように構成されており、走行経路補正処理は、車線7の境界線(8L,8R)が検出されていない場合(S24;No)には、境界線が検出されている場合(S24;Yes)と比べて、横方向において障害物3に近づくように補正目標走行経路(接近目標走行経路Rc1_a〜Rc3_a)を計算する接近処理(S27)を含むことを特徴とする。
Next, the operation of the vehicle control system of this embodiment will be described.
The present embodiment is a vehicle control device (ECU 10) that sets a target travel route R of a lane 7 on which the vehicle 1 travels. The target travel route R includes a target position and a target speed, and an obstacle on the lane 7 When (vehicle 3) exists (S21; Yes), between the obstacle 3 and the vehicle 1, a speed distribution region 40 that defines the distribution of the allowable upper limit value V lim of the relative speed of the vehicle 1 with respect to the obstacle 3 is provided. A travel route that is set to calculate the corrected target travel route Rc by correcting the target travel route R so that the relative speed of the vehicle 1 does not exceed the allowable upper limit value V lim and the vehicle 1 avoids the obstacle 3. The correction process (S15) is configured to be executed. In the travel route correction process, when the boundary line (8L, 8R) of the lane 7 is not detected (S24; No), the boundary line is detected. Compared to the case (S24; Yes) Characterized in that it comprises approaching process of calculating the corrected target traveling path so as to approach the obstacle 3 (approaching the target traveling path Rc1_a~Rc3_a) a (S27) in.

これにより本実施形態では、車線7の境界線が検出されていない場合には、境界線が検出されている場合よりも障害物3に近づくように、補正目標走行経路が計算される。これにより、車線7の境界線が検出されていない場合であっても、障害物3を回避しつつ、車両1が車線を逸脱するおそれを低減することができる。   Thereby, in this embodiment, when the boundary line of the lane 7 is not detected, the corrected target travel route is calculated so as to be closer to the obstacle 3 than when the boundary line is detected. Thereby, even if it is a case where the boundary line of the lane 7 is not detected, the possibility that the vehicle 1 will deviate from a lane can be reduced, avoiding the obstruction 3.

また、本実施形態では、走行経路補正処理(S15)は、車線7の境界線が検出されていない場合(S24;No)には、境界線が検出されている場合(S24;Yes)と比べて、目標走行経路Rに対する横方向への回避距離(L2_r,L3_r)が小さく制限された補正目標走行経路(制限目標走行経路Rc1_r〜Rc3_r)を計算する制限処理(S28)を更に含み、所定条件に応じて、接近処理と制限処理のいずれかが実行される。
これにより本実施形態では、所定条件に応じて接近処理と制限処理のいずれかにより補正目標走行経路を計算することができる。
In the present embodiment, the travel route correction process (S15) is compared with the case where the boundary line is detected (S24; Yes) when the boundary line of the lane 7 is not detected (S24; No). And a limit process (S28) for calculating a corrected target travel path (restricted target travel paths Rc1_r to Rc3_r) in which a lateral avoidance distance (L2_r, L3_r) with respect to the target travel path R is limited to a small value, In response to this, either the approach process or the restriction process is executed.
Accordingly, in the present embodiment, the corrected target travel route can be calculated by either the approach process or the restriction process according to the predetermined condition.

また、本実施形態では、所定条件は、障害物の種類であり、障害物が静止物の場合には接近処理(S27)が実行される。静止物(例えば、停車車両、電柱等)の場合は、障害物3に接近しても衝突のおそれは極めて低い。よって、この場合は、接近処理(S27)を実行することにより、障害物により近づくように補正目標走行経路(接近目標走行経路)を計算することができる。   In the present embodiment, the predetermined condition is the type of obstacle, and when the obstacle is a stationary object, the approach process (S27) is executed. In the case of a stationary object (for example, a stopped vehicle, a utility pole, etc.), even if it approaches the obstacle 3, the risk of collision is extremely low. Therefore, in this case, the corrected target travel route (approach target travel route) can be calculated so as to approach the obstacle by executing the approach process (S27).

また、本実施形態では、所定条件は、車両1の車速であり、車両1の車速が所定車速(例えば、30km/h)以下の場合には接近処理(S27)が実行される。車両1が障害物3に接近する際に速度分布領域40に基づいて車速が減速されるが、車速が所定車速以下の低速の場合には減速幅が小さい。よって、この場合は、運転者に違和感を与えることなく、車線逸脱のおそれを低減することができる。   In the present embodiment, the predetermined condition is the vehicle speed of the vehicle 1, and when the vehicle speed of the vehicle 1 is equal to or lower than a predetermined vehicle speed (for example, 30 km / h), an approach process (S27) is executed. When the vehicle 1 approaches the obstacle 3, the vehicle speed is decelerated based on the speed distribution region 40. However, when the vehicle speed is a low speed equal to or lower than a predetermined vehicle speed, the deceleration width is small. Therefore, in this case, the risk of lane departure can be reduced without causing the driver to feel uncomfortable.

また、本実施形態では、所定条件は、車両1のステアリングホイールに対する把持力の大きさであり、把持力が所定値以下の場合には接近処理(S27)が実行される。運転者がステアリングホイールを握っていない場合には、運転者自身の操舵による車線逸脱回避操作が期待できない。よって、この場合は、接近処理(S27)により、障害物3により近づく補正目標走行経路(接近目標走行経路)を計算することにより、車線逸脱のおそれを抑制することができる。   In the present embodiment, the predetermined condition is the magnitude of the gripping force with respect to the steering wheel of the vehicle 1, and when the gripping force is equal to or less than a predetermined value, the approach process (S27) is executed. When the driver does not hold the steering wheel, lane departure avoidance operation by the driver's own steering cannot be expected. Therefore, in this case, the risk of lane departure can be suppressed by calculating the corrected target travel route (approach target travel route) that approaches the obstacle 3 by the approach processing (S27).

1 車両
3 車両(障害物)
7 車線(走行路)
8L,8R 境界線
40 速度分布領域
100 車両制御システム
a,b,c,d 等相対速度線
R 目標走行経路
Rc1〜Rc3 補正目標走行経路
Rc1_a〜Rc3_a 接近目標走行経路
Rc1_r〜Rc3_r 制限目標走行経路
1 vehicle 3 vehicle (obstacle)
7 lanes (travel path)
8L, 8R Boundary line 40 Speed distribution area 100 Vehicle control system a, b, c, d Equal relative speed line R Target travel path Rc1-Rc3 Corrected target travel path Rc1_a-Rc3_a Approach target travel path Rc1_r-Rc3_r Restricted target travel path

Claims (5)

車両が走行する車線の目標走行経路を設定する車両制御装置であって、
前記目標走行経路は、目標位置及び目標速度を含み、
前記車線上に障害物が存在する場合、前記障害物と前記車両との間に、前記障害物に対する前記車両の相対速度の許容上限値の分布を規定する速度分布領域を設定し、前記車両の相対速度が前記許容上限値を超えず、且つ、前記車両が前記障害物を回避するように、前記目標走行経路を補正して補正目標走行経路を計算する走行経路補正処理を実行するように構成されており、
前記走行経路補正処理は、前記車線の境界線が検出されていない場合には、前記境界線が検出されている場合と比べて、横方向において前記障害物に近づくように補正目標走行経路を計算する接近処理を含む、車両制御装置。
A vehicle control device for setting a target travel route of a lane in which a vehicle travels,
The target travel route includes a target position and a target speed,
When there is an obstacle on the lane, a speed distribution region that defines a distribution of an allowable upper limit value of the relative speed of the vehicle with respect to the obstacle is set between the obstacle and the vehicle, A travel route correction process is performed to correct the target travel route and calculate a corrected target travel route so that the relative speed does not exceed the allowable upper limit value and the vehicle avoids the obstacle. Has been
In the travel route correction process, when the boundary line of the lane is not detected, the corrected target travel route is calculated so as to approach the obstacle in the lateral direction compared to the case where the boundary line is detected. A vehicle control device including an approach process.
前記走行経路補正処理は、前記車線の境界線が検出されていない場合には、前記境界線が検出されている場合と比べて、前記目標走行経路に対する横方向への回避距離が小さく制限された補正目標走行経路を計算する制限処理を更に含み、
所定条件に応じて、前記接近処理と前記制限処理のいずれかが実行される、請求項1に記載の車両制御装置。
In the travel route correction process, when the boundary line of the lane is not detected, the avoidance distance in the lateral direction with respect to the target travel route is limited to be smaller than when the boundary line is detected. A limit process for calculating a corrected target travel route;
The vehicle control device according to claim 1, wherein one of the approach process and the restriction process is executed according to a predetermined condition.
前記所定条件は、前記障害物の種類であり、
前記障害物が静止物の場合には前記接近処理が実行される、請求項2に記載の車両制御装置。
The predetermined condition is a type of the obstacle,
The vehicle control device according to claim 2, wherein the approach process is executed when the obstacle is a stationary object.
前記所定条件は、前記車両の車速であり、
前記車両の車速が所定車速以下の場合には前記接近処理が実行される、請求項2に記載の車両制御装置。
The predetermined condition is a vehicle speed of the vehicle,
The vehicle control device according to claim 2, wherein the approach process is executed when a vehicle speed of the vehicle is equal to or lower than a predetermined vehicle speed.
前記所定条件は、前記車両のステアリングホイールに対する把持力の大きさであり、
前記把持力が所定値以下の場合には前記接近処理が実行される、請求項2に記載の車両制御装置。
The predetermined condition is a magnitude of a gripping force with respect to a steering wheel of the vehicle,
The vehicle control device according to claim 2, wherein the approach process is executed when the gripping force is equal to or less than a predetermined value.
JP2017111763A 2017-06-06 2017-06-06 Vehicle control device Active JP6521487B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2017111763A JP6521487B2 (en) 2017-06-06 2017-06-06 Vehicle control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017111763A JP6521487B2 (en) 2017-06-06 2017-06-06 Vehicle control device

Publications (2)

Publication Number Publication Date
JP2018203108A true JP2018203108A (en) 2018-12-27
JP6521487B2 JP6521487B2 (en) 2019-05-29

Family

ID=64956214

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017111763A Active JP6521487B2 (en) 2017-06-06 2017-06-06 Vehicle control device

Country Status (1)

Country Link
JP (1) JP6521487B2 (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2020132149A (en) * 2019-02-22 2020-08-31 バイドゥ オンライン ネットワーク テクノロジー (ベイジン) カンパニー リミテッド Speed planning method for automatic driving vehicle, device, storage medium and program
JP2020131897A (en) * 2019-02-19 2020-08-31 日産自動車株式会社 Vehicular travel route display method and vehicular travel route display device
JP2021011168A (en) * 2019-07-05 2021-02-04 日産自動車株式会社 Driving control method and driving control device
CN112455439A (en) * 2020-11-25 2021-03-09 重庆长安汽车股份有限公司 Environment cognition and decision control method and system for unmanned vehicle and vehicle
JP2021041754A (en) * 2019-09-09 2021-03-18 日産自動車株式会社 Operation control method and operation control apparatus
CN113335312A (en) * 2021-08-06 2021-09-03 新石器慧通(北京)科技有限公司 Obstacle-detouring driving method and device, electronic equipment and medium
WO2022085042A1 (en) * 2020-10-19 2022-04-28 三菱電機株式会社 Path generation device and travel assistance control device

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010006334A (en) * 2008-06-30 2010-01-14 Toyota Motor Corp Vehicle speed limiting device and vehicle speed limiting method
JP2016038837A (en) * 2014-08-11 2016-03-22 日産自動車株式会社 Vehicle drive control device and method
JP2017052486A (en) * 2015-09-11 2017-03-16 株式会社ジェイテクト Steering device
JP2017087940A (en) * 2015-11-09 2017-05-25 マツダ株式会社 Vehicle speed control device

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010006334A (en) * 2008-06-30 2010-01-14 Toyota Motor Corp Vehicle speed limiting device and vehicle speed limiting method
JP2016038837A (en) * 2014-08-11 2016-03-22 日産自動車株式会社 Vehicle drive control device and method
JP2017052486A (en) * 2015-09-11 2017-03-16 株式会社ジェイテクト Steering device
JP2017087940A (en) * 2015-11-09 2017-05-25 マツダ株式会社 Vehicle speed control device

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2020131897A (en) * 2019-02-19 2020-08-31 日産自動車株式会社 Vehicular travel route display method and vehicular travel route display device
JP7282543B2 (en) 2019-02-19 2023-05-29 日産自動車株式会社 Vehicle travel route display method and vehicle travel route display device
JP2020132149A (en) * 2019-02-22 2020-08-31 バイドゥ オンライン ネットワーク テクノロジー (ベイジン) カンパニー リミテッド Speed planning method for automatic driving vehicle, device, storage medium and program
JP7000640B2 (en) 2019-02-22 2022-01-19 アポロ インテリジェント ドライビング テクノロジー(ペキン)カンパニー リミテッド Speed planning methods, devices, storage media, and programs for self-driving vehicles
US11718318B2 (en) 2019-02-22 2023-08-08 Apollo Intelligent Driving (Beijing) Technology Co., Ltd. Method and apparatus for planning speed of autonomous vehicle, and storage medium
JP2021011168A (en) * 2019-07-05 2021-02-04 日産自動車株式会社 Driving control method and driving control device
JP7258677B2 (en) 2019-07-05 2023-04-17 日産自動車株式会社 Operation control method and operation control device
JP2021041754A (en) * 2019-09-09 2021-03-18 日産自動車株式会社 Operation control method and operation control apparatus
JP7341806B2 (en) 2019-09-09 2023-09-11 日産自動車株式会社 Operation control method and operation control device
WO2022085042A1 (en) * 2020-10-19 2022-04-28 三菱電機株式会社 Path generation device and travel assistance control device
CN112455439A (en) * 2020-11-25 2021-03-09 重庆长安汽车股份有限公司 Environment cognition and decision control method and system for unmanned vehicle and vehicle
CN113335312A (en) * 2021-08-06 2021-09-03 新石器慧通(北京)科技有限公司 Obstacle-detouring driving method and device, electronic equipment and medium

Also Published As

Publication number Publication date
JP6521487B2 (en) 2019-05-29

Similar Documents

Publication Publication Date Title
WO2018225575A1 (en) Vehicle control device
JP6573224B2 (en) Vehicle control device
JP6573223B2 (en) Vehicle control device
JP6460580B2 (en) Driving support control device
JP6573222B2 (en) Vehicle control device
WO2018101253A1 (en) Vehicle control device
JP6525402B2 (en) Vehicle control device
WO2018042498A1 (en) Vehicle control device
JP6380920B2 (en) Vehicle control device
JP6525401B2 (en) Vehicle control device
WO2018101254A1 (en) Vehicle control device
JP6521487B2 (en) Vehicle control device
JP2019142303A (en) Vehicle control device
JP6376523B2 (en) Vehicle control device
WO2018042499A1 (en) Vehicle control device
WO2019159724A1 (en) Vehicle control device
JP6656603B2 (en) Vehicle control device
JP6376522B2 (en) Vehicle control device
JP6572948B2 (en) Vehicle control device
JP6376520B2 (en) Vehicle control device
JP6376521B2 (en) Vehicle control device
JP6432584B2 (en) Vehicle control device
JP2021126981A (en) Vehicle control device
JP2019142300A (en) Vehicle control device

Legal Events

Date Code Title Description
A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20181203

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20181212

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190325

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

R150 Certificate of patent or registration of utility model

Ref document number: 6521487

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20190421