JP2018151287A - Vehicle running control device - Google Patents

Vehicle running control device Download PDF

Info

Publication number
JP2018151287A
JP2018151287A JP2017048426A JP2017048426A JP2018151287A JP 2018151287 A JP2018151287 A JP 2018151287A JP 2017048426 A JP2017048426 A JP 2017048426A JP 2017048426 A JP2017048426 A JP 2017048426A JP 2018151287 A JP2018151287 A JP 2018151287A
Authority
JP
Japan
Prior art keywords
vehicle
target
gate
function
route
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
JP2017048426A
Other languages
Japanese (ja)
Other versions
JP7003423B2 (en
Inventor
芳明 東條
Yoshiaki Tojo
芳明 東條
佐藤 勝彦
Katsuhiko Sato
勝彦 佐藤
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.)
Suzuki Motor Corp
Original Assignee
Suzuki 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 Suzuki Motor Corp filed Critical Suzuki Motor Corp
Priority to JP2017048426A priority Critical patent/JP7003423B2/en
Publication of JP2018151287A publication Critical patent/JP2018151287A/en
Priority to JP2021214786A priority patent/JP7240649B2/en
Application granted granted Critical
Publication of JP7003423B2 publication Critical patent/JP7003423B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

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

Abstract

PROBLEM TO BE SOLVED: To provide a vehicle running control device which can continue automatic steering operation even if the lane information is lost in front of an expressway tollgate or the like, and can reduce the impact on the driver and the effect on the traffic flow.SOLUTION: The vehicle running control device includes a peripheral recognition function recognizing a lane section dividing line, other vehicles 2 to 4 on each lane and the front of its own vehicle 1, the absolute position of a vehicle, an environment condition estimating unit which acquires an environment condition of its own vehicle based on the information of an internal sensor, and a speed control and a steering control which cause the vehicle to follow the information acquired by the environment condition estimating unit, and to perform the speed control and the steering control on the basis of the information acquired by the environment condition estimating unit. The environmental state estimation unit includes a function of recognizing a tollgate 6 in front of the vehicle and each of the gates 6a to 6e, and a function of selecting a target gate 6b from each of the gates, and a route generation unit includes a function of generating a target approach route 5x-6bx for entering the target gates.SELECTED DRAWING: Figure 5

Description

本発明は、車両の走行制御装置に関し、さらに詳しくは、車線維持支援機能や自動操舵による車線追従機能および車線変更機能を備えた車両の走行制御装置に関する。   The present invention relates to a vehicle travel control device, and more particularly to a vehicle travel control device having a lane keeping assist function, a lane tracking function by automatic steering, and a lane change function.

運転者の負担軽減を目的として、従来運転者が行っていた認知・判断・操作を部分的に車両が行うようにする種々の技術、例えば、アダプティブクルーズコントロール(ACC)やレーンキーピングアシスト(LKA)などの運転支援機能が実用化され、さらには自動操縦を視野に入れた車線追従機能(レーントレースコントロール,LTC)や車線変更機能(レーンチェンジ,LC)なども開発されている。   Various technologies that allow the vehicle to partially perform recognition, judgment, and operation that have been performed by the driver in order to reduce the burden on the driver, such as adaptive cruise control (ACC) and lane keeping assist (LKA). Driving support functions such as these have been put into practical use, and lane tracking functions (lane trace control, LTC) and lane change functions (lane change, LC) have also been developed with the autopilot in mind.

例えば、特許文献1には、自車の左右の路面上に描かれたペイント線を検出するペイント線検出手段と、以前に検出された境界線(区分線)の位置に基づいて仮想線を設定する仮想線設定手段と、前記ペイント線および前記仮想線のうちの少なくとも一方を利用して前記境界線を設定する境界線設定手段と、を備えた境界線検出装置において、自車が料金所に接近している旨を示す接近情報を取得し、前記接近情報が取得された場合、前記境界線設定手段が仮想線を境界線として設定することを禁止することが記載されている。   For example, in Patent Document 1, a virtual line is set based on the position of a paint line detection means for detecting a paint line drawn on the left and right road surfaces of the own vehicle and a boundary line (partition line) detected previously. And a boundary line setting unit that sets the boundary line using at least one of the paint line and the virtual line. It is described that access information indicating that the vehicle is approaching is acquired, and that the boundary line setting unit is prohibited from setting a virtual line as a boundary line when the access information is acquired.

特開2013−232079号公報JP 2013-2322079 A

しかしながら、自車が料金所に接近した場合に仮想線を境界線として設定することを禁止し、実在のペイント線のみを境界線として検出するようにする処理では、例えば、高速道路の本線終点の料金所のようにゲート数が多い料金所では、境界線のない区間が比較的長いうえ、殆どのゲートの境界線は本線の境界線との連続性がないため、特許文献1の処理では対応できず、手動運転に切替えるしかないという課題があった。   However, when the vehicle approaches the toll gate, it is prohibited to set a virtual line as a boundary line, and only the actual paint line is detected as a boundary line. In a toll gate with a large number of gates such as a toll gate, the section without a boundary line is relatively long, and most gate boundary lines are not continuous with the main line boundary line. There was a problem that it was not possible to switch to manual operation.

本発明は、上記のような実状に鑑みてなされたものであり、その目的は、高速道路料金所手前などで車線情報を逸失した場合でも、自動操舵により運転を継続し、運転者への負担および交通流への影響を低減できる車両の走行制御装置を提供することにある。   The present invention has been made in view of the above circumstances, and its purpose is to continue driving by automatic steering even when lane information is lost in front of a highway tollgate, etc. Another object of the present invention is to provide a vehicle travel control device that can reduce the influence on traffic flow.

上記課題を解決するために、本発明は、
外界センサの情報から車線区分線と各車線上の他車および自車前方を認識する周囲認識機能、自車の絶対位置を推定する機能、および、内界センサの情報に基づいて自車の運動状態を取得する機能を含む環境状態推定部と、
前記環境状態推定部に取得される情報に基づいて目標経路を生成する経路生成部と、
前記目標経路に自車を追従させるべく速度制御および操舵制御を行う車両制御部と、
を備えた車両の走行制御装置において、
前記環境状態推定部は、自車前方の料金所とその各ゲートを認識する機能、および、前記各ゲートから目標ゲートを選定する機能を含み、
前記経路生成部は、前記目標ゲートに進入するための目標進入経路を生成する機能を含むことを特徴とする。
In order to solve the above problems, the present invention provides:
Surrounding recognition function that recognizes lane markings, other vehicles on each lane, and the front of the host vehicle from information from the outside world sensor, a function to estimate the absolute position of the host vehicle, and the movement of the host vehicle based on information from the inside world sensor An environmental state estimation unit including a function of acquiring a state;
A route generation unit that generates a target route based on information acquired by the environmental state estimation unit;
A vehicle control unit that performs speed control and steering control so that the vehicle follows the target route;
In a vehicle travel control device comprising:
The environmental state estimation unit includes a function of recognizing a toll gate in front of the host vehicle and each gate thereof, and a function of selecting a target gate from each gate,
The route generation unit includes a function of generating a target approach route for entering the target gate.

本発明に係る車両の走行制御装置によれば、高速道路料金所手前などで車線情報を逸失した場合でも、料金所の各ゲートを認識し、自車状態および他車位置などから目標ゲートを選定し、目標ゲートに進入するための目標進入経路を生成することで、自動操舵により運転を継続でき、運転者への負担および交通流への影響を低減するうえで有利である。   According to the vehicle travel control device of the present invention, even if lane information is lost in front of an expressway toll gate, etc., each gate of the toll gate is recognized and the target gate is selected from the own vehicle state and the position of other vehicles. However, by generating a target approach route for entering the target gate, driving can be continued by automatic steering, which is advantageous in reducing the burden on the driver and the influence on the traffic flow.

車両の走行制御システムを示す概略図である。It is the schematic which shows the traveling control system of a vehicle. 車両の外界センサ群を示す概略的な平面図である。It is a schematic top view which shows the external field sensor group of a vehicle. 車両の走行制御システムを示すブロック図である。It is a block diagram which shows the traveling control system of a vehicle. 本発明実施形態に係る走行制御を示すフローチャートである。It is a flowchart which shows the traveling control which concerns on this invention embodiment. 料金所ゲート認識および目標進入経路の生成例を示す平面図である。It is a top view which shows the generation example of a toll gate recognition and a target approach route. 自車位置に基づく目標ゲートの選定例を示す平面図である。It is a top view which shows the example of selection of the target gate based on the own vehicle position. 他車位置に基づく目標ゲートの選定例を示す平面図である。It is a top view which shows the example of selection of the target gate based on another vehicle position. 目標ゲートの選定および目標進入経路生成を示すフローチャートである。It is a flowchart which shows selection of a target gate and target approach path | route production | generation.

以下、本発明の実施形態について、図面を参照しながら詳細に説明する。
本発明は、外界センサと内界センサから得た情報を基に、車両位置および周囲環境を認識し、それに基づいて目標経路を生成し、経路追従制御(目標車速・目標舵角への車速制御・操舵制御)により車線追従や車線変更を実施可能な「自動操舵車両」に関する。
Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings.
The present invention recognizes a vehicle position and surrounding environment based on information obtained from an external sensor and an internal sensor, generates a target route based on the vehicle position, and generates a route following control (vehicle speed control to a target vehicle speed / target steering angle). -"Automatic steering vehicle" that can implement lane tracking and lane change by steering control.

(自動操舵車両の概要)
図1において、本発明に係る走行制御システムを備えた車両1は、エンジンや車体など一般的な自動車の構成要素に加え、従来運転者が行っていた認知・判断・操作を車両側で行うために、車両周囲環境を検知する外界センサ21、車両情報を検知する内界センサ22、速度制御および操舵制御のためのコントローラ/アクチュエータ群、定速走行/追従走行制御のためのACCコントローラ14、および、経路追従制御(LTC)を実施するための自動運転コントローラ10を備えている。
(Outline of the automatic steering vehicle)
In FIG. 1, a vehicle 1 equipped with a travel control system according to the present invention performs recognition, determination, and operation on the vehicle side in addition to conventional automobile components such as an engine and a vehicle body. In addition, an external sensor 21 for detecting the environment around the vehicle, an internal sensor 22 for detecting vehicle information, a controller / actuator group for speed control and steering control, an ACC controller 14 for constant speed / following control, and And an automatic operation controller 10 for carrying out path following control (LTC).

速度制御および操舵制御のためのコントローラ/アクチュエータ群は、操舵制御のためのEPS(電動パワーステアリング)コントローラ31、加減速度制御のためのエンジンコントローラ32、ESP(登録商標;スタビリティコントロールシステム)/ABS(アンチロックブレーキシステム)コントローラ33を含む。   A controller / actuator group for speed control and steering control includes an EPS (electric power steering) controller 31 for steering control, an engine controller 32 for acceleration / deceleration control, ESP (registered trademark; stability control system) / ABS. (Anti-lock brake system) A controller 33 is included.

外界センサ21は、自車線51および隣接車線52を画定する道路上の区分線5s、自車周辺にある他車両や障害物、人物、自車前方の標識、信号、料金所ゲートなどの構造物などの存在と相対距離を画像データや点群データとして自動運転コントローラ10に入力するための複数の検知手段からなる。   The outside sensor 21 is a structure such as a dividing line 5s on the road that defines the own lane 51 and the adjacent lane 52, other vehicles and obstacles around the own vehicle, a person, a sign in front of the own vehicle, a signal, a toll gate, etc. And a plurality of detection means for inputting the relative distance and the like to the automatic operation controller 10 as image data or point cloud data.

例えば、図2に示すように、車両1は、前方検知手段211,212としてミリ波レーダ(211)およびカメラ(212)、前側方検知手段213および後側方検知手段214としてLIDAR(レーザ画像検出/測距)、後方検知手段215としてカメラ(バックカメラ)を備え、自車両周囲360度をカバーし、それぞれ自車前後左右方向所定距離内の車両や構造物(料金所ゲートなど)等の位置と距離、車線区分線位置、標識、信号を検知できるようにしている。   For example, as shown in FIG. 2, the vehicle 1 includes a millimeter wave radar (211) and a camera (212) as the front detection means 211 and 212, and a LIDAR (laser image detection as the front side detection means 213 and the rear side detection means 214. / Ranging), a camera (back camera) as a rear detection means 215, covering 360 degrees around the host vehicle, and positions of vehicles and structures (tollgate gate, etc.) within a predetermined distance in the front-rear and left-right directions And distance, lane marking position, signs, and signals.

内界センサ22は、車速センサ、ヨーレートセンサ、加速度センサなど、車両の運動状態を表す物理量を計測する複数の検知手段からなり、図3に示すように、それぞれの測定値は、自動運転コントローラ10に入力され、外界センサ21からの入力とともに演算処理される。   The internal sensor 22 is composed of a plurality of detection means for measuring a physical quantity representing the motion state of the vehicle, such as a vehicle speed sensor, a yaw rate sensor, and an acceleration sensor. As shown in FIG. And is processed together with the input from the external sensor 21.

自動運転コントローラ10は、環境・状態推定部11、経路生成部12、および、車両制御部13を含む。環境・状態推定部11は、GPS等の測位手段24と地図情報23(データベース)とを照合して自車の絶対位置を取得し、外界センサ21により検知される自車線や隣接車線の区分線の位置、他車位置および速度を推定する。   The automatic operation controller 10 includes an environment / state estimation unit 11, a route generation unit 12, and a vehicle control unit 13. The environment / state estimation unit 11 compares the positioning means 24 such as GPS and the map information 23 (database) to obtain the absolute position of the own vehicle, and the own lane and the adjacent lane markings detected by the external sensor 21. The position of the vehicle, the position of the other vehicle and the speed are estimated.

さらに、環境・状態推定部11は、図5に示すように、高速道路料金所6においては、各ゲート6a〜6eの位置およびそれらに対する自車の相対位置、各ゲート6a〜6eの構造物61の形状、表示装置63の位置と表示情報(ETC/一般)、信号62の位置と表示情報(進入可否)、ETCレーンであることを示す路面標示64をパターンマッチングなどの画像処理によって認識する。認識された情報は個々のゲート6a〜6eごとに一時記憶され、目標ゲートとしての適性が比較され、目標ゲートが選定される。この点については後に詳述する。   Furthermore, as shown in FIG. 5, the environment / state estimation unit 11 includes, in the highway toll gate 6, the positions of the gates 6 a to 6 e and the relative positions of the own vehicle with respect to them, and the structures 61 of the gates 6 a to 6 e. , The position and display information of the display device 63 (ETC / general), the position and display information of the signal 62 (accessibility), and the road marking 64 indicating the ETC lane are recognized by image processing such as pattern matching. The recognized information is temporarily stored for each of the gates 6a to 6e, the suitability as a target gate is compared, and a target gate is selected. This point will be described in detail later.

経路生成部12は、地図情報23を参照し、環境・状態推定部11で推定される自車位置と自車前方の区分線から、車線追従制御(レーントレースコントロール,LTC)を行うための目標経路を生成する。また、自動車線変更機能(レーンチェンジ,LC)が起動している場合は、環境・状態推定部11で推定される自車位置と他車位置および速度と、内界センサ22により検知される自車の運動状態に基づいて車線変更における自車位置から到達目標地点までの目標経路を生成する。   The route generation unit 12 refers to the map information 23, and performs a lane tracking control (lane trace control, LTC) from the vehicle position estimated by the environment / state estimation unit 11 and the lane marking ahead of the vehicle. Generate a route. Further, when the vehicle line change function (lane change, LC) is activated, the own vehicle position, the other vehicle position and the speed estimated by the environment / state estimating unit 11, and the own vehicle detected by the internal sensor 22 Based on the movement state of the vehicle, a target route from the own vehicle position to the destination target point in lane change is generated.

さらに、経路生成部12は、高速道路料金所6においては、環境・状態推定部11で推定される目標ゲート位置と自車位置および他車位置、自車の運動状態に基づいて目標ゲートへの進入経路を生成する。   Further, the route generation unit 12 in the highway toll gate 6 is directed to the target gate based on the target gate position estimated by the environment / state estimation unit 11, the own vehicle position, the other vehicle position, and the movement state of the own vehicle. Create an approach route.

車両制御部13は、経路生成部12で生成された目標経路に基づいて目標車速および目標舵角を算出し、経路追従のための舵角指令をEPSコントローラ31に送信し、車速指令をACCコントローラ14に送信する。車速は、EPSコントローラ31およびACCコントローラ14にも入力される。車速により操舵トルクが変わるため、EPSコントローラ31は、車速毎の操舵角−操舵トルクマップを参照して操舵機構41にトルク指令を送信する。エンジンコントローラ32、ESP/ABSコントローラ33、EPSコントローラ31により、エンジン42、ブレーキ43、操舵機構41を制御することで、車両1の縦横方向の運動が制御される。   The vehicle control unit 13 calculates a target vehicle speed and a target steering angle based on the target route generated by the route generation unit 12, transmits a steering angle command for route tracking to the EPS controller 31, and sends the vehicle speed command to the ACC controller. 14 to send. The vehicle speed is also input to the EPS controller 31 and the ACC controller 14. Since the steering torque changes depending on the vehicle speed, the EPS controller 31 transmits a torque command to the steering mechanism 41 with reference to the steering angle-steering torque map for each vehicle speed. The engine controller 32, the ESP / ABS controller 33, and the EPS controller 31 control the engine 42, the brake 43, and the steering mechanism 41, whereby the vertical and horizontal movements of the vehicle 1 are controlled.

自動運転コントローラ10は、自車位置と自車の運動特性、すなわち、車速Vで走行中に操舵機構41に操舵トルクTが与えられた時に生じる前輪舵角δによって、車両運動により生じるヨーレートと横加速度の関係から、Δt秒後の車両の速度・姿勢・横変位を推定し、Δt秒後に横変位がytとなるような舵角指令をEPSコントローラ31に与え、Δt秒後に速度Vtとなるような速度指令をACCコントローラ14に与える。   The automatic operation controller 10 determines the vehicle position and the vehicle's motion characteristics, that is, the front wheel steering angle δ generated when the steering torque T is applied to the steering mechanism 41 while traveling at the vehicle speed V, and the yaw rate and lateral force generated by the vehicle motion. From the relationship of acceleration, the speed, posture, and lateral displacement of the vehicle after Δt seconds are estimated, a steering angle command is given to the EPS controller 31 so that the lateral displacement becomes yt after Δt seconds, and the speed Vt is reached after Δt seconds. To the ACC controller 14.

なお、自動車線変更機能が起動している場合は、生成された目標経路・目標車速による他車両との車間距離・相対速度に基づいて、車線変更が可能か否かを判定し、車線変更可能と判定された場合は「自動車線変更可能フラグ」を立て、その状態で、運転者の車線変更意思(ウインカ操作等)があった場合のみ車線変更が実行される。   When the lane change function is activated, it is possible to change lanes based on the generated target route and target vehicle speed based on the inter-vehicle distance and relative speed with other vehicles. If it is determined that the vehicle lane change flag is set, the lane change is executed only when the driver has an intention to change lanes (such as a turn signal operation).

運転者は、自動車線変更中は継続的な監視を要求され、運転者の操作(オーバーライド)により自動車線変更機能は直ちに解除される。すなわち、自動車線変更中に運転者の手動操舵34による操舵トルク(操舵角)がEPSコントローラ31に入力された場合は車両制御部13からの舵角指令を無効にし、手動操舵34に切替わる。車線変更の終了は、自車位置が隣接車線の中央にあり、かつ、追い越した車両との車間距離が、自車速と後方車速により決定される後方所定距離より大きいことをもって判断される。   The driver is required to continuously monitor during the lane change, and the lane change function is immediately canceled by the driver's operation (override). That is, when the steering torque (steering angle) by the driver's manual steering 34 is input to the EPS controller 31 while the vehicle line is changed, the steering angle command from the vehicle control unit 13 is invalidated and the manual steering 34 is switched. The end of the lane change is determined when the own vehicle position is in the center of the adjacent lane and the inter-vehicle distance from the overtaking vehicle is greater than the predetermined rear distance determined by the own vehicle speed and the rear vehicle speed.

(ACC、EPS、ESP/ABS、エンジン制御と自動操舵機能の関係)
自動操舵機能は、主としてACCコントローラ14による縦方向制御(速度制御)とEPSコントローラ31による横方向制御(操舵制御)を組み合わせることにより実施されるが、ACCコントローラ14、EPSコントローラ31、エンジンコントローラ32、および、ESP/ABSコントローラ33は、自動操舵とは無関係に作動できる。
(ACC, EPS, ESP / ABS, relationship between engine control and automatic steering function)
The automatic steering function is implemented mainly by combining longitudinal control (speed control) by the ACC controller 14 and lateral control (steering control) by the EPS controller 31, but the ACC controller 14, the EPS controller 31, the engine controller 32, The ESP / ABS controller 33 can operate independently of automatic steering.

自動運転コントローラ10からの舵角指令を受けたEPSコントローラ31は、車速−操舵角−操舵トルクのマップを参照して、アクチュエータ(EPSモータ)にトルク指令を出し、操舵機構41が目標とする前輪舵角を与える。また、自動運転コントローラ10からの速度指令を受けたACCコントローラ14は、内界センサ22から取得される車速に応じてブレーキ制御のための減速指令またはエンジン制御のための加減速指令を出す。   Receiving the steering angle command from the automatic operation controller 10, the EPS controller 31 refers to the vehicle speed-steering angle-steering torque map, issues a torque command to the actuator (EPS motor), and the steering mechanism 41 targets the front wheels. Give the rudder angle. The ACC controller 14 that has received the speed command from the automatic operation controller 10 issues a deceleration command for brake control or an acceleration / deceleration command for engine control according to the vehicle speed acquired from the internal sensor 22.

ACCコントローラ14からの減速指令を受けたESP/ABSコントローラ33は、アクチュエータに油圧指令を出し、ブレーキ43の制動力を制御することで車速を制御する。また、ACCコントローラ14からの加減速指令を受けたエンジンコントローラ32は、アクチュエータ出力(スロットル開度)を制御することで、エンジン42にトルク指令を与え、駆動力を制御することで車速を制御する。   The ESP / ABS controller 33 that has received the deceleration command from the ACC controller 14 issues a hydraulic pressure command to the actuator and controls the braking force of the brake 43 to control the vehicle speed. Further, the engine controller 32 that receives the acceleration / deceleration command from the ACC controller 14 controls the actuator output (throttle opening), thereby giving a torque command to the engine 42 and controlling the driving force to control the vehicle speed. .

ACC機能は、外界センサ21としてのミリ波レーダ211、ACCコントローラ14、エンジンコントローラ32、ESP/ABSコントローラ33等のハードウエアとソフトウエアの組合せで機能する。すなわち、先行車が無い場合は目標車速(クルーズコントロールセット速度)で定速走行し、先行車に追いついた場合(先行車速度が目標車速以下の場合)には、先行車速度に合わせて、設定されたタイムギャップ(車間時間=車間距離/自車速)に応じた車間距離を維持しながら先行車に追従走行する。   The ACC function functions by a combination of hardware and software such as the millimeter wave radar 211, the ACC controller 14, the engine controller 32, and the ESP / ABS controller 33 as the external sensor 21. In other words, when there is no preceding vehicle, it runs at a constant speed at the target vehicle speed (cruise control set speed), and when it catches up with the preceding vehicle (when the preceding vehicle speed is less than the target vehicle speed), it is set according to the preceding vehicle speed. The vehicle follows the preceding vehicle while maintaining the inter-vehicle distance according to the time gap (inter-vehicle time = inter-vehicle distance / own vehicle speed).

なお、EPSコントローラ31による操舵制御を利用した車線維持支援機能としてLKA(レーンキーピングアシスト)がある。LKAは、外界センサ21(カメラ212,215)に取得される画像データに基づき、自動運転コントローラ10の環境・状態推定部11で自車両前方の車線(車線区分線)を検出して道路形状を推定し、内界センサ22により検知される自車の運動状態から推定した自車の到達位置と道路形状を比較し、ずれが生じないように、EPSコントローラ31により操舵力を補助するものであり、自動操舵を行うものではない。   Note that there is LKA (Lane Keeping Assist) as a lane keeping support function using steering control by the EPS controller 31. Based on the image data acquired by the external sensor 21 (cameras 212 and 215), the LKA detects the lane (lane marking line) ahead of the host vehicle by the environment / state estimation unit 11 of the automatic driving controller 10 to determine the road shape. The EPS controller 31 assists the steering force so as not to cause a deviation by comparing the arrival position of the own vehicle estimated from the motion state of the own vehicle detected by the internal sensor 22 and the road shape. It does not perform automatic steering.

(高速道路料金所手前での車線区分線ロスト時の課題)
ところで、LTC(レーントレースコントロール)およびLKA(レーンキーピングアシスト)は、自車前方の車線区分線を認識し、それに基づいて生成される目標経路への追従制御(または、操舵力補助)を実施するものであるため、既に述べたように、高速道路料金所手前などの合流区間60(進路選択区間)のように車線区分線が存在しない区間では、自動操舵や車線維持支援を行えない。
(Problems when lane markings are lost before the expressway toll booth)
By the way, LTC (lane trace control) and LKA (lane keeping assist) recognize a lane marking in front of the host vehicle, and perform follow-up control (or steering force assistance) to the target route generated based on the lane marking. Therefore, as described above, automatic steering and lane maintenance support cannot be performed in a section where there is no lane division line, such as a junction section 60 (route selection section), such as in front of an expressway toll gate.

しかも、自車の走行位置や他車の位置、料金所通過後の進路や混雑状況などの条件に応じて、複数の料金所ゲートの中から通過するゲートを選択する必要がある。   In addition, it is necessary to select a gate passing through a plurality of toll gates according to conditions such as the traveling position of the own vehicle, the position of other vehicles, the route after passing the toll gate, and the congestion situation.

(自動操舵による高速道路料金所通過)
そこで、本発明では以下に述べるように、(1)料金所ゲートを検出し、(2)その中から通過すべき目標ゲートを選定し、(3)それに基づいて目標進入経路を生成することで、自動操舵により料金所ゲートを通過できるようにする。
(Passing the highway tollgate by automatic steering)
Therefore, in the present invention, as described below, (1) a toll gate is detected, (2) a target gate to be passed through is selected, and (3) a target approach route is generated based on the target gate. It is possible to pass through the toll gate by automatic steering.

(1)料金所ゲート検出
図5に示すように、高速道路5(本線またはランプウェイ)の料金所6におけるゲート6a〜6eの検出は、環境・状態推定部11において、料金所6の手前で前方カメラ(212)に取得された画像データから、パターンマッチングなどの画像処理により、ゲート構造物61、進入可否を示す信号62、ゲート種別(ETC/一般)の表示装置63、ETCレーンであることを示す路面標示64などが認識されることによってなされる。
(1) Tollgate detection As shown in FIG. 5, detection of the gates 6 a to 6 e at the toll gate 6 on the highway 5 (main line or rampway) is performed before the toll gate 6 in the environment / state estimation unit 11. The gate structure 61, the signal 62 indicating whether or not to enter, the gate type (ETC / general) display device 63, and the ETC lane by image processing such as pattern matching from the image data acquired by the front camera (212). This is done by recognizing a road marking 64 or the like.

環境・状態推定部11で認識されたゲート6a〜6eの位置情報(61)、進入可否(62)、ゲート種別(63,64)などの表示情報は、個々のゲート6a〜6eごとにデータテーブルに一時記憶される。   Display information such as the position information (61) of the gates 6a to 6e recognized by the environment / state estimation unit 11, the availability of entry (62), and the gate type (63, 64) is a data table for each of the gates 6a to 6e. Is temporarily stored.

(2)目標ゲート候補抽出および目標ゲートの選定
次に、検出された料金所ゲート6a〜6eから目標ゲート候補を抽出し、それらの中から1つの目標ゲートを選定するに際しては、個々のゲート6a〜6eの位置情報および表示情報が、排他性や快適性、混雑度などの条件で比較評価され、それらの条件に適合しないゲートは除外されるか、評価(優先順位)が下げられ、最終的に最適なゲートが目標ゲートに選定される。
(2) Target gate candidate extraction and target gate selection Next, target gate candidates are extracted from the detected toll gates 6a to 6e and one target gate is selected from them. The position information and display information of ~ 6e are compared and evaluated under conditions such as exclusivity, comfort, and congestion, and gates that do not meet these conditions are excluded or the evaluation (priority order) is lowered, and finally The optimal gate is selected as the target gate.

(i)排他性条件
車両の停止距離などから自車周囲の排他領域を設定し、その排他領域に侵入または接近する他車が存在しない方向に位置するほど排他性が高いゲートであると評価する。
(I) Exclusion condition An exclusive area around the own vehicle is set based on the stopping distance of the vehicle, and the gate is evaluated to be more exclusive as it is located in a direction in which no other vehicle enters or approaches the exclusive area.

例えば、図7に示されるように、自車1が左側に移動する場合、自車1の左方向に部分円領域(扇形領域)7a〜7cを定義し、その範囲内に他車が存在する場合は、自車1との相対距離(部分円領域7a〜7cの半径)に応じて、左側のゲート6a,6bの排他性評価を下げるか、または、目標ゲート候補から除外し、左側への移動を禁止する。   For example, as shown in FIG. 7, when the own vehicle 1 moves to the left side, partial circle regions (fan-shaped regions) 7 a to 7 c are defined in the left direction of the own vehicle 1, and other vehicles exist within the range. In this case, depending on the relative distance from the own vehicle 1 (radius of the partial circle regions 7a to 7c), the exclusivity evaluation of the left gates 6a and 6b is lowered or excluded from the target gate candidates and moved to the left side. Is prohibited.

例えば、図7において、左前方には他車2が存在するが、比較的離れた部分円領域7aであるので、左側のゲート6a,6bの排他性への影響は少ない。当然ながら、自車1の前方の他車3′や後方の他車4′は、部分円領域7a〜7cおよび部分円領域7d〜7gの外にあり、左側への移動にも右側への移動にも影響しない。一方、右前方には他車は存在しないが、右後方の比較的近い部分円領域7eに他車4′が存在するので、右側のゲート6e〜6gは何れも排他性が低い評価となる。   For example, in FIG. 7, the other vehicle 2 is present in the left front, but since it is a relatively circular partial circle region 7a, the influence on the exclusiveness of the left gates 6a and 6b is small. Of course, the other vehicle 3 'in front of the own vehicle 1 and the other vehicle 4' in the rear are outside the partial circle areas 7a to 7c and the partial circle areas 7d to 7g, and the movement to the right side is also performed to the left side. Does not affect. On the other hand, there is no other vehicle on the right front side, but the other vehicle 4 'exists in the relatively close partial circle area 7e on the right rear side, so that the right gates 6e to 6g are evaluated as having low exclusiveness.

ここで、部分円領域7a〜7cの半径(閾値)は、必要な横移動の距離や周囲他車の車速によって変動させても良い。また、全方位に一定の閾値を設定する代わりに、前方や後方の閾値を大きくしても良く、その場合、領域7a〜7cは部分楕円領域となる。   Here, the radii (threshold values) of the partial circle regions 7a to 7c may be changed depending on the required distance of lateral movement and the vehicle speed of other surrounding vehicles. Further, instead of setting a constant threshold value in all directions, the front and rear threshold values may be increased. In this case, the regions 7a to 7c are partial ellipse regions.

(ii)快適性条件
ゲートに到達するのに必要な横移動を比較し、必要な横移動(操舵量)が少ないほど快適性が高いゲートであると評価する。
(Ii) Comfort condition The lateral movement required to reach the gate is compared, and the smaller the required lateral movement (steering amount), the higher the comfort is evaluated.

例えば、図6に示されるように、自車1から料金所ゲート6a〜6eまでの進行方向の相対距離70xと、自車1の進行方向中心(横移動なし)から左右方向の距離70y,7yによって画定される領域70を想定する場合に、操舵量=(左右方向の距離)/(前後方向の距離)が閾値(70y/70x)以上の場合(領域70の外にある場合)は、相対的に急な横移動(操舵角)が必要であるため、快適性が低いと評価するか、または、目標ゲート候補から除外することで、ある一定以上の快適性を担保することができる。   For example, as shown in FIG. 6, the relative distance 70x in the traveling direction from the own vehicle 1 to the toll gates 6a to 6e, and the distance 70y, 7y in the left and right direction from the center of the traveling direction of the own vehicle 1 (no lateral movement). Assuming the region 70 defined by the following equation, if the steering amount = (distance in the left / right direction) / (distance in the front / rear direction) is equal to or greater than the threshold (70y / 70x) (if it is outside the region 70), the relative Since a sudden lateral movement (steering angle) is necessary, it is possible to guarantee a certain level of comfort by evaluating that the comfort is low or excluding it from the target gate candidates.

(iii)混雑度条件
周囲他車の位置情報をセンシングし、他車が存在しないか減速している他車台数が少ないほど混雑度が低いゲートであると評価する。
(Iii) Congestion degree condition The position information of surrounding other vehicles is sensed, and it is evaluated that the gate is less crowded as the number of other vehicles that are not present or decelerated is smaller.

他車台数の代わりに車列の長さ(車列終端までの相対距離)が大きいほど混雑度が高いゲートであると評価しても良い。また、何れの場合にも、各ゲートとその進入路を減速走行中であるかもしくはその進入路に並んでいる他車を対応させることが好ましいが、厳密に対応させる代わりに、自車1と各ゲート6a〜6eの中間に検出される他車の有無または他車台数を検出することもできる。   You may evaluate that it is a gate with a high congestion degree, so that the length of a vehicle row (relative distance to the vehicle row end) is large instead of the number of other vehicles. In any case, it is preferable that each gate is associated with another vehicle that is traveling at a reduced speed on the approach path or is aligned with the approach path. It is also possible to detect the presence or absence of other vehicles or the number of other vehicles detected between the gates 6a to 6e.

(iv)その他の条件
ゲート種別が「ETC(電子料金収受システム)専用」であるゲートを優先し、他の条件によって「ETC専用」が利用困難な場合のみ、「ETC/一般」、「一般」の順に候補に追加する。
(Iv) Other conditions Priority is given to gates whose gate type is "ETC (electronic toll collection system) only", and "ETC / general", "general" only when "ETC only" is difficult to use due to other conditions Add to candidates in the order of.

自動操舵を前提とした走行制御であるため、一時停止の必要な「一般」は基本的に除外し、先行他車の一時停止により停車する可能性がある「ETC/一般」も極力除外すべきである。また、当然ながら、赤信号が点灯しているゲートは候補から除外する。   Because it is traveling control based on automatic steering, “general” that needs to be temporarily stopped should be basically excluded, and “ETC / general” that may stop due to temporary stop of the preceding other vehicle should be excluded as much as possible. It is. Of course, gates with red lights are excluded from the candidates.

以上のような各条件に従って、各料金所ゲート6a〜6eが個別に評価され、それぞれの評価値は、ゲート6a〜6eごとにデータテーブルに一時記憶され、各条件の評価が確定次第、評価の高い順にデータテーブルがソートされ、または、データテーブルから除外され、最終的に1またはいくつかのゲートが候補として残り、その中から最も評価の高いゲートが目標ゲートに選定されることになる。   Each toll gate 6a to 6e is individually evaluated according to each condition as described above, and each evaluation value is temporarily stored in the data table for each gate 6a to 6e. The data table is sorted or excluded from the data table in descending order, and finally one or several gates remain as candidates, and the gate with the highest evaluation is selected as the target gate.

なお、上記各条件を総合して評価する場合に、条件ごとに評価に重み付けしたポイントを用い、各条件のポイントを合算または乗算した演算結果から目標ゲートを選定しても良い。   In addition, when evaluating each said condition comprehensively, you may use the point weighted for evaluation for every condition, and may select a target gate from the calculation result which added or multiplied the point of each condition.

(3)目標進入経路の生成
目標ゲートが選定されると、その目標ゲートに進入するための目標進入経路が、当該目標ゲートの位置情報に基づいて生成される。
(3) Generation of target approach route When a target gate is selected, a target approach route for entering the target gate is generated based on the position information of the target gate.

例えば、図5において、左から2番目のゲート6bが目標ゲートに選定された場合、カメラ212に取得される画像空間内で、複数のゲートを含む料金所構造物は、自車1の進行方向5aと直交する横方向に延びる立体構造物と近似できるので、この立体構造物の地表付近に沿って、自車1の進行方向5aと直交する横方向(ゲート並び方向)に延びるゲート基準線6yを画定する。   For example, in FIG. 5, when the second gate 6b from the left is selected as the target gate, the toll gate structure including a plurality of gates in the image space acquired by the camera 212 is the traveling direction of the own vehicle 1. Since it can be approximated as a three-dimensional structure extending in the horizontal direction orthogonal to 5a, a gate reference line 6y extending in the horizontal direction (gate alignment direction) orthogonal to the traveling direction 5a of the host vehicle 1 along the vicinity of the ground surface of the three-dimensional structure. Is defined.

画像空間における地表平面内で、目標ゲート6bの中央を通り、ゲート基準線6yと直交しかつ近位側(近景側)に延びる中心線(6bx)を、目標ゲート6bに向う仮想進入経路とし、自車1の現在位置からこの仮想進入経路6bxの近位側に向かう目標経路5x(操舵角)を求め、この目標経路5xと仮想進入経路6bxを連続させて目標進入経路5x−6bxを生成する。   A center line (6bx) passing through the center of the target gate 6b in the ground plane in the image space, orthogonal to the gate reference line 6y and extending to the proximal side (near view side) is a virtual approach path toward the target gate 6b, A target route 5x (steering angle) from the current position of the host vehicle 1 toward the proximal side of the virtual approach route 6bx is obtained, and the target route 5x-6bx is generated by continuing the target route 5x and the virtual approach route 6bx. .

この目標進入経路5x−6bxは、料金所ゲート6a〜6eを含む前方画像に基づいて生成されるので、その時点で、車線区分線5sの情報を逸失していても、目標進入経路5x−6bxに従って自動操舵を継続できる。   Since the target approach route 5x-6bx is generated based on the front image including the toll gates 6a to 6e, even if information on the lane line 5s is lost at that time, the target approach route 5x-6bx Automatic steering can be continued according to

なお、車線区分線5sの情報が維持されている場合、すなわち、車線区分線5sの情報に基づいて自動操舵による車線維持走行が継続している場合には、目標進入経路5x−6bxの生成を更新しながら、車線区分線5sの情報が失われた時点で目標進入経路5x−6bxに追従させる自動操舵に移行するようにしても良い。   When the information on the lane marking 5s is maintained, that is, when the lane maintaining traveling by the automatic steering is continued based on the information on the lane marking 5s, the target approach route 5x-6bx is generated. While updating, you may make it transfer to the automatic steering which tracks the target approach path | route 5x-6bx at the time of the information of the lane division line 5s being lost.

目標進入経路5x−6bxに従って目標ゲート6bに進入する途中で、目標ゲート6bに進入する車線の路面表示64や区分線6s、あるいは分離帯6tが認識された場合には、これらに基づく自動操舵(車線維持走行)に移行し、目標ゲート6bに進入する。   When the road surface display 64, the division line 6s, or the separation zone 6t of the lane entering the target gate 6b is recognized while entering the target gate 6b according to the target approach route 5x-6bx, automatic steering based on these ( Lane maintenance travel) and enters the target gate 6b.

(高速道路料金所手前〜料金所通過までの制御フロー)
以下、上記実施形態に基づき、高速道路料金所手前〜料金所通過までの制御フローについて、図4および図8を参照しながら説明する。
(Control flow from highway toll gate to toll gate passage)
Hereinafter, based on the above embodiment, a control flow from before the expressway toll gate to passing through the toll gate will be described with reference to FIGS. 4 and 8.

本発明に係る走行制御装置を備えた車両1において、運転者の操作により自動操舵運転が開始されると(ステップ100)、外界センサ21による車線区分線5s、他車、周囲環境および自車前方が常時センシングされる(ステップ101)。   In the vehicle 1 provided with the travel control device according to the present invention, when the automatic steering operation is started by the driver's operation (step 100), the lane marking 5s by the external sensor 21, the other vehicle, the surrounding environment, and the front of the host vehicle Is always sensed (step 101).

高速道路本線5を走行する場合にはACC・LTC機能のシステム限界に達するまでは、ACC・LTC機能を併用して定速車線維持走行を行い、先行車がある場合は先行車追従車線維持走行を行う(ステップ102)。   When driving on the main highway 5 until the system limit of the ACC / LTC function is reached, the ACC / LTC function is used to maintain a constant speed lane. (Step 102).

自動操舵運転中は車線区分線の検出が継続されており(ステップ103)、高速道路料金所に接近した場合でも、車線区分線が検出可能な状況では、ACC・LTC機能による先行車追従車線維持走行を継続する(ステップ104)。   During automatic steering operation, the detection of lane markings continues (step 103), and even if the lane markings can be detected even when approaching the expressway toll gate, the following lanes are maintained using the ACC / LTC function. The running is continued (step 104).

ACC・LTC機能を併用した自動操舵運転中に車線区分線が検出されなくなった場合には、直ちにGPS24と地図情報23とのマッチングにより自車の絶対位置を推定し(ステップ105)、自車位置が高速道路料金所手前であると判定された場合には、環境・状態推定部11の料金所ゲート位置検出機能により、料金所の1ないし複数のゲートの検出を行う(ステップ110)。   If a lane marking is not detected during automatic steering operation using both the ACC and LTC functions, the absolute position of the vehicle is immediately estimated by matching the GPS 24 with the map information 23 (step 105). Is determined to be in front of the toll gate, the toll gate position detection function of the environment / state estimation unit 11 detects one or more gates of the toll gate (step 110).

なお、車線区分線が検出されなくなり、かつ、自車の絶対位置が高速道路料金所手前でないと判定された場合、あるいは、料金所ゲートを検出できない場合は、運転者に引継要求して権限移譲し、自動操舵運転を中止する(ステップ127)。   If it is determined that the lane marking is not detected and the absolute position of the vehicle is not in front of the expressway toll gate, or if the toll gate cannot be detected, transfer to the driver and transfer of authority. Then, the automatic steering operation is stopped (step 127).

環境・状態推定部11にて、カメラ212に取得された前方画像から料金所6の複数のゲート位置(6a〜6e)が検出された場合は(ステップ111)、環境・状態推定部11の目標ゲート候補抽出機能により、個々のゲート6a〜6eの位置情報および表示情報が、排他性や快適性、混雑度などの条件で比較評価され、それらの条件に適合しないゲートは除外されるか、評価が下げられる(ステップ112)。   When the environment / state estimation unit 11 detects a plurality of gate positions (6a to 6e) of the toll gate 6 from the front image acquired by the camera 212 (step 111), the target of the environment / state estimation unit 11 The gate candidate extraction function compares and evaluates the position information and display information of the individual gates 6a to 6e under conditions such as exclusivity, comfort, and the degree of congestion, and gates that do not meet those conditions are excluded or evaluated. Is lowered (step 112).

比較評価を経て目標ゲート候補が残っていれば(ステップ113)、その中から最終的に目標ゲートに選定される(ステップ114)。目標ゲート候補がなくなった場合には、ドライバに引継要求、権限委譲し、自動操舵運転を中止する。   If a target gate candidate remains after the comparative evaluation (step 113), it is finally selected as a target gate (step 114). When there are no more target gate candidates, the handover request and authority transfer are made to the driver, and the automatic steering operation is stopped.

次に、選定された目標ゲート(6b)の位置情報に基づいて、当該目標ゲート(6b)への目標進入経路(5x−6bx)が生成され(ステップ120)、該目標進入経路(5x−6bx)に従って自動操舵が継続される(ステップ121)。   Next, based on the position information of the selected target gate (6b), a target approach route (5x-6bx) to the target gate (6b) is generated (step 120), and the target approach route (5x-6bx) ), Automatic steering is continued (step 121).

この際、目標ゲート(6b)の手前で速度規制標識を認識した場合には、規制値に応じてACC車速設定値を変更する。速度規制が認識できない場合は、所定車速(例えば40km/h)まで減速する。   At this time, when the speed regulation sign is recognized before the target gate (6b), the ACC vehicle speed set value is changed according to the regulation value. If the speed restriction cannot be recognized, the vehicle is decelerated to a predetermined vehicle speed (for example, 40 km / h).

また、当該ゲートへの進入車線区分線を認識した場合や路面の誘導表示を認識した場合には、それらに基づくLTC制御により車線に沿って目標ゲート(6b)に進入するとともに、車速を20km/h程度まで減速する。   When an approach lane marking to the gate is recognized or when a guidance display on the road surface is recognized, the vehicle enters the target gate (6b) along the lane by LTC control based on the lane marking, and the vehicle speed is set to 20 km / Decelerate to about h.

次いで、目標ゲート(6b)に到達したか否かの判定が行われ(ステップ122)、到達した場合には(ステップ123)、ゲート自動通過機能により目標ゲートを通過する(ステップ124)。目標ゲートに向かう経路追従走行中に先行車を認識できた場合には、前車追従走行に移行する。目標ゲートを通過し、前方に車線区分線が検出された場合は、それに基づくLTC制御により自動操舵運転を継続する(ステップ130)。   Next, it is determined whether or not the target gate (6b) has been reached (step 122). If the target gate (6b) has been reached (step 123), the target gate is passed through the automatic gate passing function (step 124). When the preceding vehicle can be recognized during the route following traveling toward the target gate, the vehicle shifts to the front vehicle following traveling. If a lane marking is detected ahead after passing through the target gate, automatic steering operation is continued by LTC control based on the lane marking (step 130).

なお、目標ゲートに向かう経路追従走行中は、目標進入経路の排他性検証が常に実施されており(ステップ125)、他車の進路変更などにより、目標進入経路の排他性喪失が予測された場合には(ステップ126)、その時点で運転者に引継要求、権限移譲され(ステップ127)、自動操舵運転が中止される(ステップ128)。   In addition, during the route following travel toward the target gate, the verification of the exclusiveness of the target approach route is always performed (step 125), and when the loss of the exclusiveness of the target approach route is predicted due to the course change of other vehicles, etc. (Step 126) At that time, the driver takes over and the authority is transferred (Step 127), and the automatic steering operation is stopped (Step 128).

目標ゲート通過時にバーが開かない場合は、バーが障害物として検知され、衝突防止機能により停車し、バーが開き次第自動運転を再開してゲートを通過する。   If the bar does not open when passing through the target gate, the bar is detected as an obstacle, stops by the collision prevention function, and as soon as the bar opens, the automatic operation resumes and passes through the gate.

目標ゲートの選定時にETC対応ゲートが残っておらず、ETC非対応の一般ゲートが目標ゲートに選定された場合は、チケット受け取り位置や料金支払い位置で一旦停車してからゲートを通過する。   If no ETC-compatible gate remains when the target gate is selected, and a general gate that does not support ETC is selected as the target gate, the vehicle stops once at the ticket receiving position or the fee payment position and then passes through the gate.

(作用と効果)
以上詳述したように、本発明に係る車両の走行制御装置では、高速道路料金所手前などで車線情報を逸失した場合でも、料金所の各ゲートを周囲認識手段(環境・状態推定部1121)にて認識し、自車状態および他車位置などに基づいて最適な目標ゲートを選定するとともに、目標ゲートに進入するための目標進入経路を、前方の料金所ゲートに基づいて生成することで、自動操舵運転を継続でき、運転者への負担および交通流への影響を低減するうえで有利である。
(Action and effect)
As described above in detail, in the vehicle travel control device according to the present invention, even if lane information is lost in front of an expressway tollgate or the like, each gate of the toll gate is recognized as a surrounding recognition means (environment / state estimation unit 1121). By selecting the optimal target gate based on the host vehicle state and the position of the other vehicle, and generating a target approach route for entering the target gate based on the toll gate ahead, Automatic steering operation can be continued, which is advantageous in reducing the burden on the driver and the influence on traffic flow.

また、本発明において、自動操舵のための経路生成手段(12)が、目標ゲート(6b)から近位側に延びる仮想進入経路(6bx)を生成する機能と、その仮想進入経路の近位側に連続させて目標進入経路(5x−6bx)を生成する機能を含むことにより、目標ゲートの位置に拘わらず、目標ゲートに直線的に進入できる自動操舵に適した好適な目標進入経路を生成できる。   In the present invention, the route generating means (12) for automatic steering generates a virtual approach route (6bx) extending proximally from the target gate (6b), and a proximal side of the virtual approach route. By including the function of generating the target approach route (5x-6bx) continuously, it is possible to generate a suitable target approach route suitable for automatic steering that can linearly enter the target gate regardless of the position of the target gate. .

また、本発明において、周囲認識手段(21)が、目標進入経路に沿って走行中に、目標ゲートへの進入車線またはその区分線(6s)を認識した場合には、該進入車線に自車を追従させ、目標ゲートを通過する機能を含むことにより、料金所ゲートに基づいて生成した目標進入経路への追従走行から、実際に認識される区分線に基づく車線維持走行に速やかに移行できる。   In the present invention, when the surrounding recognition means (21) recognizes an approach lane to the target gate or its lane marking (6s) while traveling along the target approach route, By including the function of following the vehicle and passing through the target gate, it is possible to quickly shift from the following traveling to the target approach route generated based on the toll gate to the lane maintaining traveling based on the actually recognized division line.

上記において、目標進入経路または進入車線に沿って走行中に、先行他車が認識された場合には、該先行他車に追従走行して目標ゲートを通過する機能を含むことにより、料金所ゲートに基づいて生成した目標進入経路への追従走行から、前車追従走行に速やかに移行できる。   In the above, when a preceding other vehicle is recognized while traveling along the target approach route or approach lane, the toll gate is provided with a function of following the preceding other vehicle and passing through the target gate. From the follow-up traveling to the target approach route generated based on the above, it is possible to quickly shift to the preceding vehicle follow-up travel.

また、本発明において、経路生成手段(12)は、目標進入経路に接近する他車が存在せず(排他性良好)、目標進入経路に先行他車が存在しないかまたは少なく(混雑度が低く)、目標進入経路に沿って走行する場合の操舵量が最小(快適性良好)になるようなゲートを目標ゲートに選定する機能を含むことにより、容易かつ確実に好適な目標ゲートを選定でき、運転者への負担および交通流への影響を低減するうえで有利である。   Further, in the present invention, the route generation means (12) has no other vehicle approaching the target approach route (excellent exclusivity), and there is little or no preceding other vehicle on the target approach route (low congestion). By including the function to select a gate that minimizes the amount of steering when driving along the target approach route (good comfort), it is possible to select a suitable target gate easily and reliably, and driving This is advantageous in reducing the burden on the user and the impact on traffic flow.

なお、上記実施形態では、最終的な目標ゲート(6b)を選定してから、それに対する目標進入経路(5x−6bx)を生成する場合について述べたが、いくつかのゲート候補を抽出した時点で、それらについての仮想中心線(図5の符号6ax,6bx,6cx・・)を仮定し、それらの近位側に連続する進入経路の生成を並行して実施し、それぞれの進入経路の排他性や混雑度を評価して、最終的な目標ゲートを選定しても良い。   In the above embodiment, the case where the final target gate (6b) is selected and then the target approach route (5x-6bx) is generated has been described. However, when several gate candidates are extracted. , Assuming virtual centerlines (reference numerals 6ax, 6bx, 6cx,... In FIG. 5) and generating continuous approach paths on the proximal side in parallel, The final target gate may be selected by evaluating the degree of congestion.

以上、本発明のいくつかの実施形態について述べたが、本発明は上記実施形態に限定されるものではなく、本発明の技術的思想に基づいてさらに各種の変形および変更が可能であることを付言する。   Although several embodiments of the present invention have been described above, the present invention is not limited to the above-described embodiments, and various modifications and changes can be made based on the technical idea of the present invention. I will add.

1 車両(自車)
2,3,3′,4,4′ 他車
5 高速道路
5a 進行方向
5s,6s 区分線
5x 目標経路
5x−6bx 目標進入経路
6 料金所
6a〜6g ゲート
6b 目標ゲート
6bx 仮想進入経路
6y ゲート基準線
7a〜7g 部分円領域(扇形領域)、部分楕円領域
10 自動運転コントローラ
11 環境・状態推定部
12 経路生成部
13 車両制御部
14 ACCコントローラ
21 外界センサ
22 内界センサ
51,52,53 車線
60 合流区間(進路選択区間)
61 ゲート構造物
62 信号
63 ゲート種別
64 路面表示
70x 進行方向の相対距離
70y 左右方向の距離
1 Vehicle (own vehicle)
2,3,3 ', 4,4' Other vehicle 5 Highway 5a Traveling direction 5s, 6s Dividing line 5x Target route 5x-6bx Target approach route 6 Tollgate 6a-6g Gate 6b Target gate 6bx Virtual approach route 6y Gate reference Lines 7a to 7g Partial circle area (fan-shaped area), partial ellipse area 10 Automatic operation controller 11 Environment / state estimation unit 12 Route generation unit 13 Vehicle control unit 14 ACC controller 21 External sensor 22 Internal sensor 51, 52, 53 Lane 60 Junction section (course selection section)
61 Gate structure 62 Signal 63 Gate type 64 Road surface display 70x Relative distance 70y in the traveling direction Distance in the left-right direction

Claims (5)

外界センサの情報から車線区分線と各車線上の他車および自車前方を認識する周囲認識機能、自車の絶対位置を推定する機能、および、内界センサの情報に基づいて自車の運動状態を取得する機能を含む環境状態推定部と、
前記環境状態推定部に取得される情報に基づいて目標経路を生成する経路生成部と、
前記目標経路に自車を追従させるべく速度制御および操舵制御を行う車両制御部と、
を備えた車両の走行制御装置において、
前記環境状態推定部は、自車前方の料金所とその各ゲートを認識する機能、および、前記各ゲートから目標ゲートを選定する機能を含み、
前記経路生成部は、前記目標ゲートに進入するための目標進入経路を生成する機能を含むことを特徴とする車両の走行制御装置。
Surrounding recognition function that recognizes lane markings, other vehicles on each lane, and the front of the host vehicle from information from the outside world sensor, a function to estimate the absolute position of the host vehicle, and the movement of the host vehicle based on information from the inside world sensor An environmental state estimation unit including a function of acquiring a state;
A route generation unit that generates a target route based on information acquired by the environmental state estimation unit;
A vehicle control unit that performs speed control and steering control so that the vehicle follows the target route;
In a vehicle travel control device comprising:
The environmental state estimating unit includes a function of recognizing a toll gate in front of the host vehicle and each gate thereof, and a function of selecting a target gate from each gate,
The vehicle travel control device, wherein the route generation unit includes a function of generating a target approach route for entering the target gate.
前記経路生成部は、前記目標ゲートから近位側に延びる仮想進入経路を生成する機能と、前記仮想進入経路の近位側に連続させて前記目標進入経路を生成する機能を含むことを特徴とする請求項1記載の車両の走行制御装置。   The route generation unit includes a function of generating a virtual approach route extending proximally from the target gate and a function of generating the target approach route continuously to the proximal side of the virtual approach route. The vehicle travel control apparatus according to claim 1. 前記目標進入経路に沿って走行中に、前記目標ゲートへの進入車線またはその区分線を認識した場合には、該進入車線に自車を追従させ、前記目標ゲートを通過する機能を含むことを特徴とする請求項1または2記載の車両の走行制御装置。   A function of causing the vehicle to follow the approach lane and passing through the target gate when the approach lane to the target gate or its lane marking is recognized while traveling along the target approach route. The travel control device for a vehicle according to claim 1 or 2, characterized in that: 前記目標進入経路または前記進入車線に沿って走行中に、先行他車が認識された場合には、該先行他車に追従走行して前記目標ゲートを通過する機能を含むことを特徴とする請求項1〜3の何れか一項記載の車両の走行制御装置。   The vehicle includes a function of following a preceding other vehicle and passing through the target gate when a preceding other vehicle is recognized while traveling along the target approach route or the approach lane. Item 4. The vehicle travel control device according to any one of Items 1 to 3. 前記環境状態推定部は、前記目標進入経路に接近する他車が存在せず、前記目標進入経路に先行他車が存在しないかまたは少なく、前記目標進入経路に沿って走行する場合の操舵量が最小になるようなゲートを前記目標ゲートに選定する機能を含むことを特徴とする請求項1〜4の何れか一項記載の車両の走行制御装置。   The environmental state estimation unit has no other vehicle approaching the target approach route, and there are few or no preceding other vehicles on the target approach route, and the steering amount when traveling along the target approach route is small. The vehicle travel control apparatus according to any one of claims 1 to 4, further comprising a function of selecting a gate that can be minimized as the target gate.
JP2017048426A 2017-03-14 2017-03-14 Vehicle driving control device Active JP7003423B2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2017048426A JP7003423B2 (en) 2017-03-14 2017-03-14 Vehicle driving control device
JP2021214786A JP7240649B2 (en) 2017-03-14 2021-12-28 Vehicle travel control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017048426A JP7003423B2 (en) 2017-03-14 2017-03-14 Vehicle driving control device

Related Child Applications (1)

Application Number Title Priority Date Filing Date
JP2021214786A Division JP7240649B2 (en) 2017-03-14 2021-12-28 Vehicle travel control device

Publications (2)

Publication Number Publication Date
JP2018151287A true JP2018151287A (en) 2018-09-27
JP7003423B2 JP7003423B2 (en) 2022-01-20

Family

ID=63681579

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017048426A Active JP7003423B2 (en) 2017-03-14 2017-03-14 Vehicle driving control device

Country Status (1)

Country Link
JP (1) JP7003423B2 (en)

Cited By (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111352427A (en) * 2020-03-19 2020-06-30 北京汽车集团越野车有限公司 Automatic driving method and automatic driving system
JP2020101957A (en) * 2018-12-21 2020-07-02 マツダ株式会社 Driving support device and method
JP2020101422A (en) * 2018-12-21 2020-07-02 マツダ株式会社 Driving assist device, and method for the same
CN111439261A (en) * 2020-05-12 2020-07-24 吉林大学 Traffic flow calculation system for intelligent vehicle cluster active lane changing function
JP2020149272A (en) * 2019-03-13 2020-09-17 三菱電機株式会社 Passage gate determination device, passage gate determination system and passage gate determination method
JP2020157985A (en) * 2019-03-27 2020-10-01 スズキ株式会社 Travel control device for vehicle
JP2021007050A (en) * 2020-10-08 2021-01-21 三菱電機株式会社 Passage gate determination device, passage gate determination system and passage gate determination method
JPWO2020058741A1 (en) * 2018-09-17 2021-08-30 日産自動車株式会社 Automatic driving control method and automatic driving control system
JP2021126907A (en) * 2020-02-10 2021-09-02 スズキ株式会社 Travel control device of vehicle
US11161513B2 (en) 2019-05-21 2021-11-02 Suzuki Motor Corporation Driving control apparatus for vehicle
US11186278B2 (en) 2019-02-22 2021-11-30 Suzuki Motor Corporation Driving control apparatus for vehicle
CN114475654A (en) * 2022-01-13 2022-05-13 香港中文大学(深圳) Vehicle control method and device and computer readable storage medium
CN114495509A (en) * 2022-04-08 2022-05-13 四川九通智路科技有限公司 Method for monitoring tunnel running state based on deep neural network
US11370430B2 (en) 2019-02-08 2022-06-28 Suzuki Motor Corporation Driving control apparatus for vehicle
US11396294B2 (en) 2018-12-28 2022-07-26 Suzuki Motor Corporation Driving control apparatus for vehicle
US11407427B2 (en) 2019-09-26 2022-08-09 Suzuki Motor Corporation Driving control apparatus for vehicle
JP2022538113A (en) * 2019-06-28 2022-08-31 ズークス インコーポレイテッド System and method for determining target vehicle speed
US11433889B2 (en) 2019-03-08 2022-09-06 Suzuki Motor Corporation Driving control apparatus for vehicle
US11433898B2 (en) 2019-03-27 2022-09-06 Suzuki Motor Corporation Driving control apparatus for vehicle
CN115323850A (en) * 2022-08-31 2022-11-11 济南市市政工程设计研究院(集团)有限责任公司 Road network planning method for narrow-road dense road network

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000285396A (en) * 1999-03-30 2000-10-13 Mitsubishi Motors Corp Vehicle travel controller
JP2008128932A (en) * 2006-11-24 2008-06-05 Alpine Electronics Inc Navigation system
JP2011214914A (en) * 2010-03-31 2011-10-27 Toyota Motor Corp Front environment recognition device, and vehicle guiding system including the same
JP2014106854A (en) * 2012-11-29 2014-06-09 Toyota Infotechnology Center Co Ltd Automatic driving vehicle control apparatus and method
JP2014119372A (en) * 2012-12-18 2014-06-30 Alpine Electronics Inc Navigation device and method for guiding travel route at tollhouse
JP2015111386A (en) * 2013-10-29 2015-06-18 株式会社デンソー Automatic operation device
JP2016095831A (en) * 2014-11-07 2016-05-26 株式会社デンソー Driving support system and center
JP2016115356A (en) * 2014-12-12 2016-06-23 ソニー株式会社 Automatic drive control device, automatic drive control method, and program
JP2016153736A (en) * 2015-02-20 2016-08-25 一三 西野 Inflammatory myopathy differentiation markers and method of differentiating inflammatory myopathy and non-inflammatory myopathy using same
JP2017013644A (en) * 2015-07-01 2017-01-19 トヨタ自動車株式会社 Automatic operation control apparatus
US20180154898A1 (en) * 2016-12-02 2018-06-07 Toyota Motor Engineering & Manufacturing North America, Inc. Systems and Methods for Preemptively Adjusting Vehicle Parameters According to Predicted Controls Relating to a Toll Booth

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000285396A (en) * 1999-03-30 2000-10-13 Mitsubishi Motors Corp Vehicle travel controller
JP2008128932A (en) * 2006-11-24 2008-06-05 Alpine Electronics Inc Navigation system
JP2011214914A (en) * 2010-03-31 2011-10-27 Toyota Motor Corp Front environment recognition device, and vehicle guiding system including the same
JP2014106854A (en) * 2012-11-29 2014-06-09 Toyota Infotechnology Center Co Ltd Automatic driving vehicle control apparatus and method
JP2014119372A (en) * 2012-12-18 2014-06-30 Alpine Electronics Inc Navigation device and method for guiding travel route at tollhouse
JP2015111386A (en) * 2013-10-29 2015-06-18 株式会社デンソー Automatic operation device
JP2016095831A (en) * 2014-11-07 2016-05-26 株式会社デンソー Driving support system and center
JP2016115356A (en) * 2014-12-12 2016-06-23 ソニー株式会社 Automatic drive control device, automatic drive control method, and program
JP2016153736A (en) * 2015-02-20 2016-08-25 一三 西野 Inflammatory myopathy differentiation markers and method of differentiating inflammatory myopathy and non-inflammatory myopathy using same
JP2017013644A (en) * 2015-07-01 2017-01-19 トヨタ自動車株式会社 Automatic operation control apparatus
US20180154898A1 (en) * 2016-12-02 2018-06-07 Toyota Motor Engineering & Manufacturing North America, Inc. Systems and Methods for Preemptively Adjusting Vehicle Parameters According to Predicted Controls Relating to a Toll Booth

Cited By (32)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPWO2020058741A1 (en) * 2018-09-17 2021-08-30 日産自動車株式会社 Automatic driving control method and automatic driving control system
JP7304875B2 (en) 2018-09-17 2023-07-07 日産自動車株式会社 AUTOMATIC OPERATION CONTROL METHOD AND AUTOMATIC OPERATION CONTROL SYSTEM
JP7147545B2 (en) 2018-12-21 2022-10-05 マツダ株式会社 Driving support device and method
JP7119981B2 (en) 2018-12-21 2022-08-17 マツダ株式会社 Driving support device and method
JP2020101957A (en) * 2018-12-21 2020-07-02 マツダ株式会社 Driving support device and method
JP2020101422A (en) * 2018-12-21 2020-07-02 マツダ株式会社 Driving assist device, and method for the same
US11396294B2 (en) 2018-12-28 2022-07-26 Suzuki Motor Corporation Driving control apparatus for vehicle
US11370430B2 (en) 2019-02-08 2022-06-28 Suzuki Motor Corporation Driving control apparatus for vehicle
US11186278B2 (en) 2019-02-22 2021-11-30 Suzuki Motor Corporation Driving control apparatus for vehicle
US11433889B2 (en) 2019-03-08 2022-09-06 Suzuki Motor Corporation Driving control apparatus for vehicle
JP2020149272A (en) * 2019-03-13 2020-09-17 三菱電機株式会社 Passage gate determination device, passage gate determination system and passage gate determination method
JP7189509B2 (en) 2019-03-27 2022-12-14 スズキ株式会社 Vehicle travel control device
US11235765B2 (en) 2019-03-27 2022-02-01 Suzuki Motor Corporation Driving control apparatus for vehicle
US11433898B2 (en) 2019-03-27 2022-09-06 Suzuki Motor Corporation Driving control apparatus for vehicle
FR3094320A1 (en) * 2019-03-27 2020-10-02 Suzuki Motor Corporation VEHICLE DRIVING CONTROL DEVICE
JP2020157985A (en) * 2019-03-27 2020-10-01 スズキ株式会社 Travel control device for vehicle
US11161513B2 (en) 2019-05-21 2021-11-02 Suzuki Motor Corporation Driving control apparatus for vehicle
JP2022538113A (en) * 2019-06-28 2022-08-31 ズークス インコーポレイテッド System and method for determining target vehicle speed
US11407427B2 (en) 2019-09-26 2022-08-09 Suzuki Motor Corporation Driving control apparatus for vehicle
JP7415635B2 (en) 2020-02-10 2024-01-17 スズキ株式会社 Vehicle travel control device
JP2021126907A (en) * 2020-02-10 2021-09-02 スズキ株式会社 Travel control device of vehicle
CN111352427A (en) * 2020-03-19 2020-06-30 北京汽车集团越野车有限公司 Automatic driving method and automatic driving system
CN111439261A (en) * 2020-05-12 2020-07-24 吉林大学 Traffic flow calculation system for intelligent vehicle cluster active lane changing function
CN111439261B (en) * 2020-05-12 2023-07-21 吉林大学 Traffic flow calculation system for intelligent vehicle group active lane change function
JP7123103B2 (en) 2020-10-08 2022-08-22 三菱電機株式会社 PASSING GATE DETERMINATION DEVICE, PASSING GATE DETERMINING SYSTEM AND PASSING GATE DETERMINING METHOD
JP2021007050A (en) * 2020-10-08 2021-01-21 三菱電機株式会社 Passage gate determination device, passage gate determination system and passage gate determination method
CN114475654B (en) * 2022-01-13 2024-03-15 香港中文大学(深圳) Vehicle control method and device and computer readable storage medium
CN114475654A (en) * 2022-01-13 2022-05-13 香港中文大学(深圳) Vehicle control method and device and computer readable storage medium
CN114495509A (en) * 2022-04-08 2022-05-13 四川九通智路科技有限公司 Method for monitoring tunnel running state based on deep neural network
CN114495509B (en) * 2022-04-08 2022-07-12 四川九通智路科技有限公司 Method for monitoring tunnel running state based on deep neural network
CN115323850A (en) * 2022-08-31 2022-11-11 济南市市政工程设计研究院(集团)有限责任公司 Road network planning method for narrow-road dense road network
CN115323850B (en) * 2022-08-31 2024-02-09 济南市市政工程设计研究院(集团)有限责任公司 Road network planning method for narrow road dense road network

Also Published As

Publication number Publication date
JP7003423B2 (en) 2022-01-20

Similar Documents

Publication Publication Date Title
JP7003423B2 (en) Vehicle driving control device
US11932284B2 (en) Trajectory setting device and trajectory setting method
US11173902B2 (en) Vehicle control device
JP6547735B2 (en) Collision avoidance support device
US20190283757A1 (en) Vehicle control apparatus, vehicle, vehicle control method, and storage medium
JP5300357B2 (en) Collision prevention support device
US11186275B2 (en) Vehicle control system
WO2018110400A1 (en) Vehicle control device
US20190308625A1 (en) Vehicle control device
US20170101092A1 (en) Driving support apparatus
JP2017035927A (en) Vehicle travel control device and speed control method
WO2018173403A1 (en) Vehicle control apparatus and vehicle control method
US11180141B2 (en) Vehicle control system
JP2015203972A (en) Driving route generation device
US10351130B2 (en) Vehicle control system
JP6609292B2 (en) Outside environment recognition device
JP7240649B2 (en) Vehicle travel control device
JP7461847B2 (en) Vehicle control device, vehicle control method, and program
WO2023047148A1 (en) Travel assistance method and travel assistance device
WO2023054195A1 (en) Vehicle control device and vehicle control program
JP2021126907A (en) Travel control device of vehicle
JP2024006451A (en) Travel control method and travel control device
JP2023154622A (en) Driving support method and driving support device
JP2023154618A (en) Drive support method and drive support device
JP2023139856A (en) Travel controller of vehicle

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200109

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20200812

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200915

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201029

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210302

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210427

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20211001

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20211029

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20211213