JP2019043431A - Travel control device, and travel control method and program - Google Patents
Travel control device, and travel control method and program Download PDFInfo
- Publication number
- JP2019043431A JP2019043431A JP2017170386A JP2017170386A JP2019043431A JP 2019043431 A JP2019043431 A JP 2019043431A JP 2017170386 A JP2017170386 A JP 2017170386A JP 2017170386 A JP2017170386 A JP 2017170386A JP 2019043431 A JP2019043431 A JP 2019043431A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- travel control
- control device
- travel
- traveling
- 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
Links
Landscapes
- Traffic Control Systems (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Regulating Braking Force (AREA)
Abstract
【課題】緊急車両の回避行動を適切に実現する走行制御装置を提供する。【解決手段】車両の周辺の緊急車両の情報を取得した場合に、車両に先行する第1の車両もしくは車両に後続する第2の車両の挙動が、緊急車両の走行を妨げないための回避動作であれば、回避動作を行っている第1の車両もしくは第2の車両のいずれか一方に追従するようS205、車両の縦方向と横方向の少なくともいずれかについての走行を制御する。【選択図】図6PROBLEM TO BE SOLVED: To provide a traveling control device which appropriately realizes avoidance behavior of an emergency vehicle. When information on an emergency vehicle in the vicinity of a vehicle is acquired, an avoidance operation is performed so that the behavior of a first vehicle preceding the vehicle or a second vehicle following the vehicle does not interfere with the running of the emergency vehicle. If so, S205 controls the traveling of the vehicle in at least one of the vertical direction and the horizontal direction so as to follow either the first vehicle or the second vehicle performing the avoidance operation. [Selection diagram] Fig. 6
Description
本発明は、他の車両の挙動に応じて自車両の走行を制御する走行制御装置、走行制御方法およびプログラムに関する。 The present invention relates to a travel control device, a travel control method, and a program for controlling the travel of a host vehicle according to the behavior of another vehicle.
ドライバによる運転のみならず、自動運転および自動運転支援においても、緊急用務のために走行する緊急車両の走行を妨げずに、緊急車両を回避することは極めて重要である。特許文献1には、緊急車両を特定すると、自車を減速させて路肩に寄せることが記載されている。 It is extremely important not only for driving by a driver but also for automatic driving and automatic driving support to avoid an emergency vehicle without interrupting the traveling of an emergency vehicle traveling for emergency service. Patent Document 1 describes that, when an emergency vehicle is identified, the own vehicle is decelerated and brought close to the road shoulder.
一方、緊急車両でなくても、対象物を回避する技術は、自動運転および自動運転支援の技術では広く用いられている。特許文献2には、先行車が障害物を回避した場合、先行車と同じ走行ルートで障害物の回避を行う運転支援装置が記載されている。 On the other hand, even if it is not an emergency vehicle, the technology for avoiding an object is widely used in the technology of automatic driving and automatic driving support. Patent Literature 2 describes a driving support device that, when a preceding vehicle avoids an obstacle, performs avoidance of the obstacle on the same traveling route as the preceding vehicle.
一般的に、緊急車両の接近時には、自車両を路肩に寄せ、緊急車両の走行を妨げないことが求められる。しかしながら、緊急車両の視覚的な認識のみでは、死角等のために緊急車両が自車両に近接して初めて認識するような場合、緊急車両の回避が間に合わなくなってしまう。また、緊急車両のサイレン等の認識のみでは、自車両が回避しなくても良い場合でも回避行動してしまう可能性がある。 Generally, when an emergency vehicle approaches, it is required that the host vehicle be moved to the shoulder of the road so as not to hinder the traveling of the emergency vehicle. However, if the emergency vehicle recognizes for the first time in proximity to the host vehicle due to a blind spot or the like only by visual recognition of the emergency vehicle, the emergency vehicle can not be avoided in time. In addition, there is a possibility that the avoidance action may be taken even when the own vehicle does not have to avoid only by recognizing the siren of the emergency vehicle.
本発明は、緊急車両の回避行動を適切に実現する走行制御装置、走行制御方法およびプログラムを提供することを目的とする。 An object of the present invention is to provide a travel control device, a travel control method, and a program that appropriately realize the avoidance behavior of an emergency vehicle.
本発明に係る走行制御装置は、車両の走行を制御する走行制御装置であって、緊急車両の情報を取得する第1の取得手段と、前記第1の取得手段により前記車両の周辺の緊急車両の情報を取得した場合に、前記車両に先行する第1の車両もしくは前記車両に後続する第2の車両の挙動が、前記緊急車両の走行を妨げないための回避動作であれば、当該回避動作を行っている前記第1の車両もしくは前記第2の車両のいずれか一方に追従するよう前記車両の縦方向と横方向の少なくともいずれかについての走行を制御する走行制御手段と、を備えることを特徴とする。 The travel control device according to the present invention is a travel control device that controls the travel of a vehicle, and includes an emergency vehicle around the vehicle by a first acquisition unit that acquires information on an emergency vehicle, and the first acquisition unit. If the behavior of the first vehicle preceding the vehicle or the second vehicle following the vehicle is an avoidance operation for preventing the traveling of the emergency vehicle when acquiring the information, the avoidance operation Driving control means for controlling the traveling in at least one of the longitudinal direction and the lateral direction of the vehicle to follow any one of the first vehicle and the second vehicle that are performing It features.
また、本発明に係る走行制御方法は、車両の走行を制御する走行制御装置において実行される走行制御方法であって、緊急車両の情報を取得する取得工程と、前記取得工程において前記車両の周辺の緊急車両の情報を取得した場合に、前記車両に先行する第1の車両もしくは前記車両に後続する第2の車両の挙動が、前記緊急車両の走行を妨げないための回避動作であれば、当該回避動作を行っている前記第1の車両もしくは前記第2の車両のいずれか一方に追従するよう前記車両の縦方向と横方向の少なくともいずれかについての走行を制御する走行制御工程と、を有することを特徴とする。 A travel control method according to the present invention is a travel control method executed in a travel control device that controls the travel of a vehicle, and an acquisition step of acquiring information of an emergency vehicle, and a periphery of the vehicle in the acquisition step. If the behavior of the first vehicle preceding the vehicle or the second vehicle following the vehicle is an avoidance operation for preventing the traveling of the emergency vehicle when acquiring the information of the emergency vehicle, A traveling control step of controlling traveling of at least one of the longitudinal direction and the lateral direction of the vehicle so as to follow any one of the first vehicle and the second vehicle performing the avoidance operation; It is characterized by having.
本発明によれば、緊急車両の回避行動を適切に実現することができる。 According to the present invention, the evasive action of the emergency vehicle can be appropriately realized.
[第1の実施形態]
図1〜図3は、本実施形態における車両用制御システム1のブロック図である。制御システム1は、車両Vを制御する。図1および図2において、車両Vはその概略が平面図と側面図とで示されている。車両Vは一例としてセダンタイプの四輪の乗用車である。制御システム1は、制御装置1Aと制御装置1Bとを含む。図1は制御装置1Aを示すブロック図であり、図2は制御装置1Bを示すブロック図である。図3は主に、制御装置1Aと制御装置1Bとの間の通信回線ならびに電源の構成を示している。
First Embodiment
1 to 3 are block diagrams of a control system 1 for a vehicle according to the present embodiment. The control system 1 controls a vehicle V. In FIGS. 1 and 2, the vehicle V is schematically shown in plan and side views. The vehicle V is a sedan-type four-wheeled vehicle as an example. Control system 1 includes a control device 1A and a control device 1B. FIG. 1 is a block diagram showing the control device 1A, and FIG. 2 is a block diagram showing the control device 1B. FIG. 3 mainly shows the configuration of communication lines and power supplies between the control device 1A and the control device 1B.
制御装置1Aと制御装置1Bとは、車両Vが実現する一部の機能を多重化ないし冗長化したものである。これによりシステムの信頼性を向上することができる。制御装置1Aは、例えば、自動運転制御や、手動運転における通常の動作制御の他、危険回避等に関わる走行支援制御も行う。制御装置1Bは、主に危険回避等に関わる走行支援制御を司る。走行支援のことを運転支援と呼ぶ場合がある。制御装置1Aと制御装置1Bとで機能を冗長化しつつ、異なる制御処理を行わせることで、制御処理の分散化を図りつつ、信頼性を向上できる。 The control device 1A and the control device 1B are obtained by multiplexing or redundantly a part of the functions realized by the vehicle V. This can improve the reliability of the system. The control device 1A also performs, for example, driving support control related to danger avoidance and the like in addition to normal operation control in automatic driving control and manual driving. The control device 1B is mainly responsible for driving support control related to danger avoidance and the like. Driving support may be called driving support. By performing different control processes while making the functions redundant between the control device 1A and the control device 1B, the reliability can be improved while decentralizing the control processes.
本実施形態の車両Vはパラレル方式のハイブリッド車両であり、図2には、車両Vの駆動輪を回転させる駆動力を出力するパワープラント50の構成が模式的に図示されている。パワープラント50は、内燃機関EG、モータMおよび自動変速機TMを有している。モータMは、車両Vを加速させる駆動源として利用可能であると共に減速時等において発電機としても利用可能である(回生制動)。 The vehicle V of the present embodiment is a parallel type hybrid vehicle, and FIG. 2 schematically shows the configuration of a power plant 50 that outputs a driving force for rotating the drive wheels of the vehicle V. The power plant 50 has an internal combustion engine EG, a motor M and an automatic transmission TM. The motor M can be used as a drive source for accelerating the vehicle V and also as a generator at the time of deceleration or the like (regenerative braking).
<制御装置1A>
図1を参照して制御装置1Aの構成について説明する。制御装置1Aは、ECU群(制御ユニット群)2Aを含む。ECU群2Aは、複数のECU20A〜29Aを含む。各ECUは、CPUに代表されるプロセッサ、半導体メモリ等の記憶デバイス、外部デバイスとのインタフェース等を含む。記憶デバイスには、プロセッサが実行するプログラムやプロセッサが処理に使用するデータ等が格納される。各ECUはプロセッサ、記憶デバイスおよびインタフェース等を複数備えていてもよい。なお、ECUの数や、担当する機能については適宜設計可能であり、本実施形態よりも細分化したり、あるいは、統合することが可能である。なお、図1および図3においては、ECU20A〜29Aの代表的な機能の名称を付している。例えば、ECU20Aには「自動運転ECU」と記載している。
<Control device 1A>
The configuration of the control device 1A will be described with reference to FIG. Control device 1A includes an ECU group (control unit group) 2A. ECU group 2A includes a plurality of ECUs 20A to 29A. Each ECU includes a processor represented by a CPU, a storage device such as a semiconductor memory, an interface with an external device, and the like. The storage device stores a program executed by the processor, data used by the processor for processing, and the like. Each ECU may include a plurality of processors, storage devices, interfaces, and the like. The number of ECUs and the functions to be in charge can be appropriately designed, and can be subdivided or integrated as compared with the present embodiment. In FIG. 1 and FIG. 3, names of representative functions of the ECUs 20A to 29A are given. For example, the ECU 20A describes "automatic driving ECU".
ECU20Aは、車両Vの走行制御として自動運転に関わる制御を実行する。自動運転においては車両Vの駆動(パワープラント50による車両Vの加速等)、操舵または制動の少なくとも一つを、運転者の運転操作に依らず自動的に行う。本実施形態では、駆動、操舵および制動を自動的に行う場合も含む。 The ECU 20A executes control related to automatic driving as travel control of the vehicle V. In automatic driving, at least one of driving of the vehicle V (acceleration of the vehicle V by the power plant 50, etc.), steering or braking is automatically performed regardless of the driver's driving operation. The present embodiment also includes the case where driving, steering and braking are performed automatically.
ECU21Aは、車両Vの周囲状況を検知する検知ユニット31A、32Aの検知結果に基づいて、車両Vの走行環境を認識する環境認識ユニットである。ECU21Aは、周辺環境情報として物標データを生成する。 The ECU 21A is an environment recognition unit that recognizes the traveling environment of the vehicle V based on the detection results of the detection units 31A and 32A that detect the surrounding situation of the vehicle V. The ECU 21A generates target data as the surrounding environment information.
本実施形態の場合、検知ユニット31Aは、撮像により車両Vの周囲の物体を検知する撮像デバイス(以下、カメラ31Aと表記する場合がある。)である。カメラ31Aは、車両Vの前方を撮影可能なように、車両Vのルーフ前部に設けられている。カメラ31Aが撮影した画像の解析により、物標の輪郭抽出や、道路上の車線の区画線(白線等)を抽出可能である。 In the case of the present embodiment, the detection unit 31A is an imaging device (hereinafter sometimes referred to as a camera 31A) that detects an object around the vehicle V by imaging. The camera 31A is provided at the front of the roof of the vehicle V so as to be able to capture the front of the vehicle V. By analyzing the image captured by the camera 31A, it is possible to extract the contour of the target and extract the lane line (white line etc.) on the road.
本実施形態の場合、検知ユニット32Aは、光により車両Vの周囲の物体を検知するライダ(LIDAR: Light Detection and Ranging)(レーザレーダ)であり(以下、ライダ32Aと表記する場合がある)、車両Vの周囲の物標を検知したり、物標との距離を測距する。本実施形態の場合、ライダ32Aは、5つ設けられており、車両Vの前部の各隅部に1つずつ、後部中央に1つ、後部各側方に1つずつ設けられている。ライダ32Aの数や配置は、適宜選択可能である。 In the case of this embodiment, the detection unit 32A is a lidar that detects an object around the vehicle V by light (LIDAR: Light Detection and Ranging (laser radar) (hereinafter, may be referred to as a lidar 32A), The target around the vehicle V is detected or the distance to the target is measured. In the case of the present embodiment, five lidars 32A are provided, one at each of the front corners of the vehicle V, one at the center of the rear, and one at each side of the rear. The number and arrangement of the riders 32A can be selected as appropriate.
ECU29Aは、検知ユニット31Aの検知結果に基づいて、車両Vの走行制御として走行支援(換言すると運転支援)に関わる制御を実行する走行支援ユニットである。 The ECU 29A is a driving assistance unit that executes control related to driving assistance (in other words, driving assistance) as traveling control of the vehicle V based on the detection result of the detection unit 31A.
ECU22Aは、電動パワーステアリング装置41Aを制御する操舵制御ユニットである。電動パワーステアリング装置41Aは、ステアリングホイールSTに対する運転者の運転操作(操舵操作)に応じて前輪を操舵する機構を含む。電動パワーステアリング装置41Aは、操舵操作をアシストしたり、あるいは、前輪を自動操舵するための駆動力を発揮するモータや、モータの回転量を検知するセンサや、運転者が負担する操舵トルクを検知するトルクセンサ等を含む。 The ECU 22A is a steering control unit that controls the electric power steering device 41A. Electric power steering apparatus 41A includes a mechanism that steers the front wheels in accordance with the driver's driving operation (steering operation) on steering wheel ST. The electric power steering device 41A assists the steering operation or detects a motor that exerts a driving force for automatically steering the front wheels, a sensor that detects the amount of rotation of the motor, and a steering torque that the driver bears. Torque sensor etc.
ECU23Aは、油圧装置42Aを制御する制動制御ユニットである。ブレーキペダルBPに対する運転者の制動操作はブレーキマスタシリンダBMにおいて液圧に変換されて油圧装置42Aに伝達される。油圧装置42Aは、ブレーキマスタシリンダBMから伝達された液圧に基づいて、四輪にそれぞれ設けられたブレーキ装置(例えばディスクブレーキ装置)51に供給する作動油の液圧を制御可能なアクチュエータであり、ECU23Aは、油圧装置42Aが備える電磁弁等の駆動制御を行う。本実施形態の場合、ECU23Aおよび油圧装置23Aは、電動サーボブレーキを構成し、ECU23Aは、例えば、4つのブレーキ装置51による制動力と、モータMの回生制動による制動力との配分を制御する。 The ECU 23A is a braking control unit that controls the hydraulic device 42A. The driver's braking operation on the brake pedal BP is converted to hydraulic pressure in the brake master cylinder BM and transmitted to the hydraulic device 42A. The hydraulic device 42A is an actuator capable of controlling the hydraulic pressure of the hydraulic oil supplied to the brake devices (for example, the disk brake devices) 51 respectively provided to the four wheels based on the hydraulic pressure transmitted from the brake master cylinder BM. The ECU 23A performs drive control of a solenoid valve and the like included in the hydraulic device 42A. In the case of the present embodiment, the ECU 23A and the hydraulic device 23A constitute an electric servo brake, and the ECU 23A controls, for example, the distribution of the braking force by the four brake devices 51 and the braking force by regenerative braking of the motor M.
ECU24Aは、自動変速機TMに設けられている電動パーキングロック装置50aを制御する停止維持制御ユニットである。電動パーキングロック装置50aは、主としてPレンジ(パーキングレンジ)選択時に自動変速機TMの内部機構をロックする機構を備える。ECU24Aは、電動パーキングロック装置50aによるロックおよびロック解除を制御可能である。 The ECU 24A is a stop maintenance control unit that controls the electric parking lock device 50a provided in the automatic transmission TM. The electric parking lock device 50a is provided with a mechanism that locks the internal mechanism of the automatic transmission TM mainly when the P range (parking range) is selected. The ECU 24A can control locking and unlocking by the electric parking lock device 50a.
ECU25Aは、車内に情報を報知する情報出力装置43Aを制御する車内報知制御ユニットである。情報出力装置43Aは、例えばヘッドアップディスプレイ等の表示装置や音声出力装置を含む。更に、振動装置を含んでもよい。ECU25Aは、例えば、車速や外気温等の各種情報や、経路案内等の情報を情報出力装置43Aに出力させる。 The ECU 25A is an in-vehicle notification control unit that controls an information output device 43A that notifies information in the vehicle. The information output device 43A includes, for example, a display device such as a head-up display or an audio output device. Further, it may include a vibrating device. The ECU 25A causes the information output device 43A to output, for example, various information such as the vehicle speed and the outside air temperature, and information such as route guidance.
ECU26Aは、車外に情報を報知する情報出力装置44Aを制御する車外報知制御ユニットである。本実施形態の場合、情報出力装置44Aは、方向指示器(ハザードランプ)であり、ECU26Aは、方向指示器として情報出力装置44Aの点滅制御を行うことで車外に対して車両Vの進行方向を報知し、また、ハザードランプとして情報出力装置44Aの点滅制御を行うことで車外に対して車両Vへの注意力を高めることができる。 The ECU 26A is an outside notification control unit that controls an information output device 44A that notifies information outside the vehicle. In the case of the present embodiment, the information output device 44A is a direction indicator (hazard lamp), and the ECU 26A performs blinking control of the information output device 44A as a direction indicator to move the traveling direction of the vehicle V outside the vehicle. Further, by performing blinking control of the information output device 44A as a hazard lamp, the alertness to the vehicle V can be enhanced with respect to the outside of the vehicle.
ECU27Aは、パワープラント50を制御する駆動制御ユニットである。本実施形態では、パワープラント50にECU27Aを一つ割り当てているが、内燃機関EG、モータMおよび自動変速機TMのそれぞれにECUを一つずつ割り当ててもよい。ECU27Aは、例えば、アクセルペダルAPに設けた操作検知センサ34aやブレーキペダルBPに設けた操作検知センサ34bにより検知した運転者の運転操作や車速等に対応して、内燃機関EGやモータMの出力を制御したり、自動変速機TMの変速段を切り替える。なお、自動変速機TMには、車両Vの走行状態を検知するセンサとして、自動変速機TMの出力軸の回転数を検知する回転数センサ39が設けられている。車両Vの車速は、回転数センサ39の検知結果から演算可能である。 The ECU 27A is a drive control unit that controls the power plant 50. In the present embodiment, one ECU 27A is allocated to the power plant 50, but one ECU may be allocated to each of the internal combustion engine EG, the motor M, and the automatic transmission TM. The ECU 27A outputs, for example, the output of the internal combustion engine EG or the motor M in response to the driver's drive operation or vehicle speed detected by the operation detection sensor 34a provided on the accelerator pedal AP and the operation detection sensor 34b provided on the brake pedal BP. Control or switch the gear of automatic transmission TM. The automatic transmission TM is provided with a rotation number sensor 39 for detecting the number of rotations of the output shaft of the automatic transmission TM as a sensor for detecting the traveling state of the vehicle V. The vehicle speed of the vehicle V can be calculated from the detection result of the rotation speed sensor 39.
ECU28Aは、車両Vの現在位置や進路を認識する位置認識ユニットである。ECU28Aは、ジャイロセンサ33A、GPSセンサ28b、通信装置28cの制御および検知結果あるいは通信結果の情報処理を行う。ジャイロセンサ33Aは、車両Vの回転運動を検知する。ジャイロセンサ33の検知結果等により車両Vの進路を判定することができる。GPSセンサ28bは、車両Vの現在位置を検知する。通信装置28cは、地図情報や交通情報を提供するサーバと無線通信を行い、これらの情報を取得する。データベース28aには、高精度の地図情報を格納することができ、ECU28Aは、この地図情報等に基づいて、車線上の車両Vの位置をより高精度に特定可能である。また、通信装置28cは、車車間通信や路車間通信にも用いられ、例えば他の車両の情報を取得可能である。 The ECU 28A is a position recognition unit that recognizes the current position and the course of the vehicle V. The ECU 28A controls the gyro sensor 33A, the GPS sensor 28b, and the communication device 28c, and performs information processing of the detection result or the communication result. The gyro sensor 33A detects the rotational movement of the vehicle V. The course of the vehicle V can be determined based on the detection result of the gyro sensor 33 or the like. The GPS sensor 28b detects the current position of the vehicle V. The communication device 28 c wirelessly communicates with a server that provides map information and traffic information to acquire such information. The database 28a can store map information with high accuracy, and the ECU 28A can specify the position of the vehicle V on the lane with higher accuracy based on the map information and the like. The communication device 28c is also used for inter-vehicle communication and road-to-vehicle communication, and can acquire, for example, information of another vehicle.
入力装置45Aは、運転者が操作可能に車内に配置され、運転者からの指示や情報の入力を受け付ける。 The input device 45A is disposed in the vehicle so as to be operable by the driver, and receives input of instructions and information from the driver.
<制御装置1B>
図2を参照して制御装置1Bの構成について説明する。制御装置1Bは、ECU群(制御ユニット群)2Bを含む。ECU群2Bは、複数のECU21B〜25Bを含む。各ECUは、CPUやGPUに代表されるプロセッサ、半導体メモリ等の記憶デバイス、外部デバイスとのインタフェース等を含む。記憶デバイスにはプロセッサが実行するプログラムやプロセッサが処理に使用するデータ等が格納される。各ECUはプロセッサ、記憶デバイスおよびインタフェース等を複数備えていてもよい。なお、ECUの数や、担当する機能については適宜設計可能であり、本実施形態よりも細分化したり、あるいは、統合することが可能である。なお、ECU群2Aと同様、図2および図3においてはECU21B〜25Bの代表的な機能の名称を付している。
<Control device 1B>
The configuration of the control device 1B will be described with reference to FIG. Control device 1B includes an ECU group (control unit group) 2B. The ECU group 2B includes a plurality of ECUs 21B to 25B. Each ECU includes a processor represented by a CPU or a GPU, a storage device such as a semiconductor memory, an interface with an external device, and the like. The storage device stores programs executed by the processor, data used by the processor for processing, and the like. Each ECU may include a plurality of processors, storage devices, interfaces, and the like. The number of ECUs and the functions to be in charge can be appropriately designed, and can be subdivided or integrated as compared with the present embodiment. Similar to the ECU group 2A, names of representative functions of the ECUs 21B to 25B are given in FIGS. 2 and 3.
ECU21Bは、車両Vの周囲状況を検知する検知ユニット31B、32Bの検知結果に基づいて、車両Vの走行環境を認識する環境認識ユニットであると共に、車両Vの走行制御として走行支援(換言すると運転支援)に関わる制御を実行する走行支援ユニットである。ECU21Bは、周辺環境情報として物標データを生成する。 The ECU 21B is an environment recognition unit that recognizes the traveling environment of the vehicle V based on the detection results of the detection units 31B and 32B that detect the surrounding condition of the vehicle V, and supports driving as driving control of the vehicle V (in other words, driving Support unit that executes control related to the The ECU 21B generates target data as the surrounding environment information.
なお、本実施形態では、ECU21Bが環境認識機能と走行支援機能とを有する構成としたが、制御装置1AのECU21AとECU29Aのように、機能毎にECUを設けてもよい。逆に、制御装置1Aにおいて、ECU21Bのように、ECU21AとECU29Aの機能を一つのECUで実現する構成であってもよい。 In the present embodiment, although the ECU 21B is configured to have the environment recognition function and the traveling support function, an ECU may be provided for each function as the ECU 21A and the ECU 29A of the control device 1A. Conversely, in the control device 1A, as in the case of the ECU 21B, the functions of the ECU 21A and the ECU 29A may be realized by one ECU.
本実施形態の場合、検知ユニット31Bは、撮像により車両Vの周囲の物体を検知する撮像デバイス(以下、カメラ31Bと表記する場合がある。)である。カメラ31Bは、車両Vの前方を撮影可能なように、車両Vのルーフ前部に設けられている。カメラ31Bが撮影した画像の解析により、物標の輪郭抽出や、道路上の車線の区画線(白線等)を抽出可能である。本実施形態の場合、検知ユニット32Bは、電波により車両Vの周囲の物体を検知するミリ波レーダであり(以下、レーダ32Bと表記する場合がある)、車両Vの周囲の物標を検知したり、物標との距離を測距する。本実施形態の場合、レーダ32Bは5つ設けられており、車両Vの前部中央に1つ、前部各隅部に1つずつ、後部各隅部に一つずつ設けられている。レーダ32Bの数や配置は、適宜選択可能である。 In the case of the present embodiment, the detection unit 31B is an imaging device (hereinafter sometimes referred to as a camera 31B) that detects an object around the vehicle V by imaging. The camera 31 </ b> B is provided at the front of the roof of the vehicle V so as to be able to capture the front of the vehicle V. By analyzing the image captured by the camera 31 B, it is possible to extract the contour of the target and extract the lane line (white line etc.) on the road. In the case of this embodiment, the detection unit 32B is a millimeter wave radar that detects an object around the vehicle V by radio waves (hereinafter may be referred to as a radar 32B), and detects a target around the vehicle V Or, measure the distance to the target. In the case of this embodiment, five radars 32B are provided, one at the center of the front of the vehicle V and one at each front corner, and one at each rear corner. The number and arrangement of the radars 32B can be selected as appropriate.
ECU22Bは、電動パワーステアリング装置41Bを制御する操舵制御ユニットである。電動パワーステアリング装置41Bは、ステアリングホイールSTに対する運転者の運転操作(操舵操作)に応じて前輪を操舵する機構を含む。電動パワーステアリング装置41Bは、操舵操作をアシストしたり、あるいは、前輪を自動操舵するための駆動力を発揮するモータや、モータの回転量を検知するセンサや、運転者が負担する操舵トルクを検知するトルクセンサ等を含む。また、ECU22Bには、後述する通信回線L2を介して操舵角センサ37が電気的に接続されており、操舵角センサ37の検知結果に基づいて電動パワーステアリング装置41Bを制御可能である。ECU22Bは、運転者がステアリングハンドルSTを把持しているか否かを検知するセンサ36の検知結果を取得可能であり、運転者の把持状態を監視することができる。 The ECU 22B is a steering control unit that controls the electric power steering device 41B. Electric power steering apparatus 41B includes a mechanism that steers the front wheels in accordance with the driver's driving operation (steering operation) on steering wheel ST. The electric power steering device 41B assists the steering operation or detects a motor that exerts a driving force for automatically steering the front wheels, a sensor that detects the amount of rotation of the motor, and a steering torque that the driver bears. Torque sensor etc. Further, a steering angle sensor 37 is electrically connected to the ECU 22B via a communication line L2 described later, and the electric power steering apparatus 41B can be controlled based on the detection result of the steering angle sensor 37. The ECU 22B can acquire the detection result of the sensor 36 that detects whether the driver is gripping the steering wheel ST, and can monitor the gripping state of the driver.
ECU23Bは、油圧装置42Bを制御する制動制御ユニットである。ブレーキペダルBPに対する運転者の制動操作は、ブレーキマスタシリンダBMにおいて液圧に変換されて油圧装置42Bに伝達される。油圧装置42Bは、ブレーキマスタシリンダBMから伝達された液圧に基づいて、各車輪のブレーキ装置51に供給する作動油の液圧を制御可能なアクチュエータであり、ECU23Bは、油圧装置42Bが備える電磁弁等の駆動制御を行う。 The ECU 23B is a braking control unit that controls the hydraulic device 42B. The driver's braking operation on the brake pedal BP is converted to hydraulic pressure in the brake master cylinder BM and transmitted to the hydraulic device 42B. The hydraulic device 42B is an actuator capable of controlling the hydraulic pressure of the hydraulic oil supplied to the brake device 51 of each wheel based on the hydraulic pressure transmitted from the brake master cylinder BM, and the ECU 23B is an electromagnetic device included in the hydraulic device 42B. Drive control of valves etc.
本実施形態の場合、ECU23Bおよび油圧装置23Bには、四輪それぞれに設けられた車輪速センサ38、ヨーレートセンサ33B、ブレーキマスタシリンダBM内の圧力を検知する圧力センサ35が電気的に接続され、これらの検知結果に基づき、ABS機能、トラクションコントロールおよび車両Vの姿勢制御機能を実現する。例えば、ECU23Bは、四輪それぞれに設けられた車輪速センサ38の検知結果に基づき各車輪の制動力を調整し、各車輪の滑走を抑制する。また、ヨーレートセンサ33Bが検知した車両Vの鉛直軸回りの回転角速度に基づき各車輪の制動力を調整し、車両Vの急激な姿勢変化を抑制する。 In the case of this embodiment, the wheel speed sensor 38 provided for each of the four wheels, the yaw rate sensor 33B, and the pressure sensor 35 for detecting the pressure in the brake master cylinder BM are electrically connected to the ECU 23B and the hydraulic device 23B. Based on these detection results, the ABS function, the traction control, and the attitude control function of the vehicle V are realized. For example, the ECU 23B adjusts the braking force of each wheel based on the detection result of the wheel speed sensor 38 provided for each of the four wheels to suppress the sliding of each wheel. In addition, the braking force of each wheel is adjusted based on the rotational angular velocity about the vertical axis of the vehicle V detected by the yaw rate sensor 33B, and a rapid change in posture of the vehicle V is suppressed.
また、ECU23Bは、車外に情報を報知する情報出力装置43Bを制御する車外報知制御ユニットとしても機能する。本実施形態の場合、情報出力装置43Bは、ブレーキランプであり、制動時等にECU23Bは、ブレーキランプを点灯可能である。これにより後続車に対して車両Vへの注意力を高めることができる。 The ECU 23B also functions as an out-of-vehicle notification control unit that controls an information output device 43B that notifies information outside the vehicle. In the case of the present embodiment, the information output device 43B is a brake lamp, and the ECU 23B can light the brake lamp at the time of braking or the like. This can increase the attention to the vehicle V with respect to the following vehicle.
ECU24Bは、後輪に設けられている電動パーキングブレーキ装置(例えばドラムブレーキ)52を制御する停止維持制御ユニットである。電動パーキングブレーキ装置52は、後輪をロックする機構を備える。ECU24Bは、電動パーキングブレーキ装置52による後輪のロックおよびロック解除を制御可能である。 The ECU 24B is a stop maintenance control unit that controls an electric parking brake device (for example, a drum brake) 52 provided on the rear wheel. The electric parking brake device 52 includes a mechanism for locking the rear wheel. The ECU 24B can control the locking and unlocking of the rear wheel by the electric parking brake device 52.
ECU25Bは、車内に情報を報知する情報出力装置44Bを制御する車内報知制御ユニットである。本実施形態の場合、情報出力装置44Bは、インストルメントパネルに配置される表示装置を含む。ECU25Bは、情報出力装置44Bに車速、燃費等の各種の情報を出力させることが可能である。 The ECU 25B is an in-vehicle notification control unit that controls an information output device 44B that notifies information in the vehicle. In the case of the present embodiment, the information output device 44B includes a display device disposed on the instrument panel. The ECU 25B can cause the information output device 44B to output various types of information such as vehicle speed and fuel consumption.
入力装置45Bは、運転者が操作可能に車内に配置され、運転者からの指示や情報の入力を受け付ける。 The input device 45B is disposed in the vehicle so as to be operable by the driver, and receives input of instructions and information from the driver.
<通信回線>
ECU間を通信可能に接続する、制御システム1の通信回線の例について図3を参照して説明する。制御システム1は、有線の通信回線L1〜L7を含む。通信回線L1には、制御装置1Aの各ECU20A〜27A、29Aが接続されている。なお、ECU28Aも通信回線L1に接続されてもよい。
<Communication line>
An example of a communication line of the control system 1 which communicably connects the ECUs will be described with reference to FIG. Control system 1 includes wired communication lines L1 to L7. The ECUs 20A to 27A and 29A of the control device 1A are connected to the communication line L1. The ECU 28A may also be connected to the communication line L1.
通信回線L2には、制御装置1Bの各ECU21B〜25Bが接続されている。また、制御装置1AのECU20Aも通信回線L2に接続されている。通信回線L3は、ECU20AとECU21Aを接続する。通信回線L5は、ECU20A、ECU21AおよびECU28Aを接続する。通信回線L6は、ECU29AとECU21Aを接続する。通信回線L7は、ECU29AとECU20Aを接続する。 The ECUs 21B to 25B of the control device 1B are connected to the communication line L2. Further, the ECU 20A of the control device 1A is also connected to the communication line L2. The communication line L3 connects the ECU 20A and the ECU 21A. The communication line L5 connects the ECU 20A, the ECU 21A, and the ECU 28A. The communication line L6 connects the ECU 29A and the ECU 21A. The communication line L7 connects the ECU 29A and the ECU 20A.
通信回線L1〜L7のプロトコルは同じであっても異なっていてもよいが、通信速度、通信量や耐久性等、通信環境に応じて異ならせてもよい。例えば、通信回線L3およびL4は、通信速度の点でEthernet(登録商標)であってもよい。例えば、通信回線L1、L2、L5〜L7は、CANであってもよい。 The protocols of the communication lines L1 to L7 may be the same or different, but may differ depending on the communication environment, such as communication speed, communication volume, and durability. For example, the communication lines L3 and L4 may be Ethernet (registered trademark) in terms of communication speed. For example, the communication lines L1, L2, and L5 to L7 may be CAN.
制御装置1Aは、ゲートウェイGWを備えている。ゲートウェイGWは、通信回線L1と通信回線L2を中継する。このため、例えば、ECU21Bは、通信回線L2、ゲートウェイGWおよび通信回線L1を介してECU27Aに制御指令を出力可能である。 The control device 1A includes a gateway GW. The gateway GW relays the communication line L1 and the communication line L2. Therefore, for example, the ECU 21B can output a control command to the ECU 27A via the communication line L2, the gateway GW, and the communication line L1.
<電源>
制御システム1の電源について図3を参照して説明する。制御システム1は、大容量バッテリ6と、電源7Aと、電源7Bとを含む。大容量バッテリ6は、モータMの駆動用バッテリであると共に、モータMにより充電されるバッテリである。
<Power supply>
The power supply of the control system 1 will be described with reference to FIG. The control system 1 includes a large capacity battery 6, a power supply 7A, and a power supply 7B. The large capacity battery 6 is a battery for driving the motor M and is a battery charged by the motor M.
電源7Aは、制御装置1Aに電力を供給する電源であり、電源回路71Aとバッテリ72Aとを含む。電源回路71Aは、大容量バッテリ6の電力を制御装置1Aに供給する回路であり、例えば、大容量バッテリ6の出力電圧(例えば190V)を、基準電圧(例えば12V)に降圧する。バッテリ72Aは、例えば12Vの鉛バッテリである。バッテリ72Aを設けたことにより、大容量バッテリ6や電源回路71Aの電力供給が遮断あるいは低下した場合であっても、制御装置1Aに電力の供給を行うことができる。 The power supply 7A is a power supply that supplies power to the control device 1A, and includes a power supply circuit 71A and a battery 72A. The power supply circuit 71A is a circuit that supplies the power of the large capacity battery 6 to the control device 1A, and reduces the output voltage (for example, 190 V) of the large capacity battery 6 to a reference voltage (for example, 12 V). The battery 72A is, for example, a 12V lead battery. By providing the battery 72A, power can be supplied to the control device 1A even when the power supply of the large capacity battery 6 or the power supply circuit 71A is interrupted or reduced.
電源7Bは、制御装置1Bに電力を供給する電源であり、電源回路71Bとバッテリ72Bとを含む。電源回路71Bは、電源回路71Aと同様の回路であり、大容量バッテリ6の電力を制御装置1Bに供給する回路である。バッテリ72Bは、バッテリ72Aと同様のバッテリであり、例えば12Vの鉛バッテリである。バッテリ72Bを設けたことにより、大容量バッテリ6や電源回路71Bの電力供給が遮断あるいは低下した場合であっても、制御装置1Bに電力の供給を行うことができる。 The power supply 7B is a power supply that supplies power to the control device 1B, and includes a power supply circuit 71B and a battery 72B. The power supply circuit 71B is a circuit similar to the power supply circuit 71A, and is a circuit that supplies the power of the large capacity battery 6 to the control device 1B. The battery 72B is a battery similar to the battery 72A, for example, a 12V lead battery. By providing the battery 72B, power can be supplied to the control device 1B even when the power supply of the large capacity battery 6 or the power supply circuit 71B is interrupted or reduced.
<冗長化>
制御装置1Aと、制御装置1Bとが有する機能の共通性について説明する。同一機能を冗長化することで制御システム1の信頼性を向上できる。また、冗長化した一部の機能については、全く同じ機能を多重化したのではなく、異なる機能を発揮する。これは機能の冗長化によるコストアップを抑制する。
<Redundant>
The commonality of the function which control device 1A and control device 1B have is explained. The reliability of the control system 1 can be improved by making the same function redundant. In addition, some of the redundant functions do not have the same functions multiplexed but exhibit different functions. This suppresses the cost increase due to the redundant function.
[アクチュエータ系]
〇操舵
制御装置1Aは、電動パワーステアリング装置41Aおよびこれを制御するECU22Aを有している。制御装置1Bもまた、電動パワーステアリング装置41Bおよびこれを制御するECU22Bを有している。
[Actuator system]
Steering control device 1A includes an electric power steering device 41A and an ECU 22A that controls the electric power steering device 41A. The control device 1B also includes an electric power steering device 41B and an ECU 22B that controls the electric power steering device 41B.
〇制動
制御装置1Aは、油圧装置42Aおよびこれを制御するECU23Aを有している。制御装置1Bは、油圧装置42Bおよびこれを制御するECU23Bを有している。これらは、いずれも車両Vの制動に利用可能である。一方、制御装置1Aの制動機構は、ブレーキ装置51による制動力と、モータMの回生制動による制動力との配分を主要な機能としたものであるのに対し、制御装置1Bの制動機構は、姿勢制御等を主要な機能としたものである。両者は制動という点では共通するものの、互いに異なる機能を発揮する。
Braking control device 1A includes a hydraulic device 42A and an ECU 23A that controls the hydraulic device 42A. The control device 1B includes a hydraulic device 42B and an ECU 23B that controls the hydraulic device 42B. These are all available for braking the vehicle V. On the other hand, while the braking mechanism of the control device 1A mainly has the distribution of the braking force by the braking device 51 and the braking force by the regenerative braking of the motor M, the braking mechanism of the control device 1B is Attitude control etc. is the main function. Although both are common in terms of braking, they exert different functions.
〇停止維持
制御装置1Aは、電動パーキングロック装置50aおよびこれを制御するECU24Aを有している。制御装置1Bは、電動パーキングブレーキ装置52およびこれを制御するECU24Bを有している。これらはいずれも車両Vの停車を維持することに利用可能である。一方、電動パーキングロック装置50aは、自動変速機TMのPレンジ選択時に機能する装置であるのに対し、電動パーキングブレーキ装置52は、後輪をロックするものである。両者は車両Vの停止維持という点では共通するものの、互いに異なる機能を発揮する。
Stop Maintenance The control device 1A includes the electric parking lock device 50a and the ECU 24A that controls the electric parking lock device 50a. Control device 1B has electric parking brake device 52 and ECU24B which controls this. Any of these can be used to maintain the stop of the vehicle V. On the other hand, while the electric parking lock device 50a is a device that functions at the time of selecting the P range of the automatic transmission TM, the electric parking brake device 52 locks the rear wheel. Although both are common in terms of maintaining the stop of the vehicle V, they exert different functions.
〇車内報知
制御装置1Aは、情報出力装置43Aおよびこれを制御するECU25Aを有している。制御装置1Bは、情報出力装置44Bおよびこれを制御するECU25Bを有している。これらは、いずれも運転者に情報を報知することに利用可能である。一方、情報出力装置43Aは、例えばヘッドアップディスプレイであり、情報出力装置44Bは、計器類などの表示装置である。両者は車内報知という点では共通するものの、互いに異なる表示装置を採用可能である。
In-Vehicle Notification The control device 1A includes an information output device 43A and an ECU 25A that controls the information output device 43A. The control device 1B includes an information output device 44B and an ECU 25B that controls the information output device 44B. Any of these can be used to inform the driver of the information. On the other hand, the information output device 43A is, for example, a head-up display, and the information output device 44B is a display device such as instruments. Although both are common in terms of in-vehicle notification, different display devices can be employed.
〇車外報知
制御装置1Aは、情報出力装置44Aおよびこれを制御するECU26Aを有している。制御装置1Bは、情報出力装置43Bおよびこれを制御するECU23Bを有している。これらはいずれも車外に情報を報知することに利用可能である。一方、情報出力装置43Aは、方向指示器(ハザードランプ)であり、情報出力装置44Bは、ブレーキランプである。両者は車外報知という点では共通するものの、互いに異なる機能を発揮する。
Outside Vehicle Notification The control device 1A includes an information output device 44A and an ECU 26A that controls the information output device 44A. The control device 1B includes an information output device 43B and an ECU 23B that controls the information output device 43B. Any of these can be used to report information outside the vehicle. On the other hand, the information output device 43A is a direction indicator (hazard lamp), and the information output device 44B is a brake lamp. Although both are common in terms of informing outside the vehicle, they exert different functions.
〇相違点
制御装置1Aは、パワープラント50を制御するECU27Aを有しているのに対し、制御装置1Bは、パワープラント50を制御する独自のECUは有していない。本実施形態の場合、制御装置1Aおよび1Bのいずれも、単独で、操舵、制動、停止維持が可能であり、制御装置1Aまたは制御装置1Bのいずれか一方が性能低下あるいは電源遮断もしくは通信遮断された場合であっても、車線の逸脱を抑制しつつ、減速して停止状態を維持することが可能である。また、上記のとおり、ECU21Bは、通信回線L2、ゲートウェイGWおよび通信回線L1を介してECU27Aに制御指令を出力可能であり、ECU21Bは、パワープラント50を制御することも可能である。制御装置1Bがパワープラント50を制御する独自のECUを備えないことで、コストアップを抑制することができるが、備えていてもよい。
The difference is that the control device 1A has the ECU 27A that controls the power plant 50, whereas the control device 1B does not have its own ECU that controls the power plant 50. In the case of the present embodiment, any one of the control devices 1A and 1B is capable of steering, braking and stopping independently, and either the control device 1A or the control device 1B is degraded in performance, or the power is shut off or the communication is shut off. Even in this case, it is possible to decelerate and maintain the stop state while suppressing the lane departure. Further, as described above, the ECU 21B can output a control command to the ECU 27A via the communication line L2, the gateway GW, and the communication line L1, and the ECU 21B can also control the power plant 50. Although the cost increase can be suppressed by not providing the ECU unique to the control device 1B for controlling the power plant 50, it may be provided.
[センサ系]
〇周囲状況の検知
制御装置1Aは、検知ユニット31Aおよび32Aを有している。制御装置1Bは、検知ユニット31Bおよび32Bを有している。これらはいずれも車両Vの走行環境の認識に利用可能である。一方、検知ユニット32Aはライダであり、検知ユニット32Bはレーダである。ライダは、一般に形状の検知に有利である。また、レーダは、一般にライダよりもコスト面で有利である。特性が異なるこれらのセンサを併用することで、物標の認識性能の向上やコスト削減を図ることができる。検知ユニット31A、31Bは共にカメラであるが、特性が異なるカメラを用いてもよい。例えば、一方が他方よりも高解像度のカメラであってもよい。また、画角が互いに異なっていてもよい。
[Sensor system]
Detection of Ambient Condition The control device 1A includes detection units 31A and 32A. The control device 1B includes detection units 31B and 32B. Any of these can be used to recognize the traveling environment of the vehicle V. On the other hand, the detection unit 32A is a rider and the detection unit 32B is a radar. The lidar is generally advantageous for shape detection. Also, radar is generally more cost-effective than riders. By using these sensors having different characteristics in combination, it is possible to improve the recognition performance of the target and reduce the cost. Although both detection units 31A and 31B are cameras, cameras with different characteristics may be used. For example, one may be a higher resolution camera than the other. Also, the angles of view may be different from one another.
制御装置1Aと制御装置1Bとの比較でいうと、検知ユニット31Aおよび32Aは、検知ユニット31Bおよび32Bと検知特性が異なってもよい。本実施形態の場合、検知ユニット32Aはライダであり、一般に、レーダ(検知ユニット32B)よりも物標のエッジの検知性能が高い。また、レーダにおいては、ライダに対して一般に、相対速度検出精度や対候性に優れる。 In comparison between the control device 1A and the control device 1B, the detection units 31A and 32A may have different detection characteristics from the detection units 31B and 32B. In the case of this embodiment, the detection unit 32A is a lidar, and generally, the detection performance of the edge of the target is higher than that of the radar (detection unit 32B). In addition, in the radar, relative speed detection accuracy and weather resistance are generally superior to the rider.
また、カメラ31Aをカメラ31Bよりも高解像度のカメラとすれば、検知ユニット31Aおよび32Aの方が検知ユニット31Bおよび32Bよりも検知性能が高くなる。これらの検知特性およびコストが異なるセンサを複数組み合わせることで、システム全体で考えた場合にコストメリットが得られる場合がある。また、検知特性の異なるセンサを組み合わせることで、同一センサを冗長させる場合よりも検出漏れや誤検出を低減することもできる。 If the camera 31A is a camera with a higher resolution than the camera 31B, the detection units 31A and 32A have higher detection performance than the detection units 31B and 32B. By combining a plurality of sensors having different detection characteristics and costs, cost advantages may be obtained when considered in the entire system. In addition, by combining sensors having different detection characteristics, it is possible to reduce detection omissions and false detections more than in the case where the same sensors are made redundant.
〇車速
制御装置1Aは、回転数センサ39を有している。制御装置1Bは、車輪速センサ38を有している。これらはいずれも車速を検知することに利用可能である。一方、回転数センサ39は、自動変速機TMの出力軸の回転速度を検知するものであり、車輪速センサ38は、車輪の回転速度を検知するものである。両者は車速が検知可能という点では共通するものの、互いに検知対象が異なるセンサである。
The vehicle speed control device 1A has a rotational speed sensor 39. The control device 1 B includes a wheel speed sensor 38. Any of these can be used to detect the vehicle speed. On the other hand, the rotation speed sensor 39 detects the rotation speed of the output shaft of the automatic transmission TM, and the wheel speed sensor 38 detects the rotation speed of the wheel. Although both are common in that the vehicle speed can be detected, they are sensors whose detection targets are different from each other.
〇ヨーレート
制御装置1Aは、ジャイロ33Aを有している。制御装置1Bは、ヨーレートセンサ33Bを有している。これらはいずれも車両Vの鉛直軸周りの角速度を検知することに利用可能である。一方、ジャイロ33Aは、車両Vの進路判定に利用するものであり、ヨーレートセンサ33Bは、車両Vの姿勢制御等に利用するものである。両者は車両Vの角速度が検知可能という点では共通するものの、互いに利用目的が異なるセンサである。
The yaw rate controller 1A has a gyro 33A. The controller 1B has a yaw rate sensor 33B. Any of these can be used to detect the angular velocity around the vertical axis of the vehicle V. On the other hand, the gyro 33A is used to determine the course of the vehicle V, and the yaw rate sensor 33B is used to control the attitude of the vehicle V. Both are sensors that are common in that the angular velocity of the vehicle V can be detected, but are sensors that have different usage purposes.
〇操舵角および操舵トルク
制御装置1Aは、電動パワーステアリング装置41Aのモータの回転量を検知するセンサを有している。制御装置1Bは操舵角センサ37を有している。これらはいずれも前輪の操舵角を検知することに利用可能である。制御装置1Aにおいては、操舵角センサ37については増設せずに、電動パワーステアリング装置41Aのモータの回転量を検知するセンサを利用することでコストアップを抑制できる。尤も、操舵角センサ37を増設して制御装置1Aにも設けてもよい。
Steering Angle and Steering Torque The control device 1A has a sensor that detects the amount of rotation of the motor of the electric power steering device 41A. The control device 1 B has a steering angle sensor 37. Any of these can be used to detect the steering angle of the front wheel. In the control device 1A, cost increase can be suppressed by using a sensor that detects the amount of rotation of the motor of the electric power steering device 41A without adding the steering angle sensor 37. However, the steering angle sensor 37 may be additionally provided in the control device 1A.
また、電動パワーステアリング装置41A、41Bがいずれもトルクセンサを含むことで、制御装置1A、1Bのいずれにおいても操舵トルクを認識可能である。 Further, as both of the electric power steering devices 41A and 41B include a torque sensor, the steering torque can be recognized in any of the control devices 1A and 1B.
〇制動操作量
制御装置1Aは、操作検知センサ34bを有している。制御装置1Bは、圧力センサ35を有している。これらはいずれも、運転者の制動操作量を検知することに利用可能である。一方、操作検知センサ34bは、4つのブレーキ装置51による制動力と、モータMの回生制動による制動力との配分を制御するために用いられ、圧力センサ35は、姿勢制御等に用いられる。両者は制動操作量を検知する点で共通するものの、互いに利用目的が異なるセンサである。
The amount of braking operation The control device 1A includes an operation detection sensor 34b. The controller 1 </ b> B includes a pressure sensor 35. Any of these can be used to detect the amount of braking operation by the driver. On the other hand, the operation detection sensor 34b is used to control the distribution of the braking force by the four brake devices 51 and the braking force by the regenerative braking of the motor M, and the pressure sensor 35 is used for attitude control and the like. Although both are common in that the amount of braking operation is detected, they are sensors whose usage purposes are different from each other.
[電源]
制御装置1Aは、電源7Aから電力の供給を受け、制御装置1Bは、電源7Bから電力の供給を受ける。電源7Aまたは電源7Bのいずれかの電力供給が遮断あるいは低下した場合でも、制御装置1Aまたは制御装置1Bのいずれか一方には電力が供給されるので、電源をより確実に確保して制御システム1の信頼性を向上することができる。電源7Aの電力供給が遮断あるいは低下した場合、制御装置1Aに設けたゲートウェイGWが介在したECU間の通信は困難となる。しかし、制御装置1Bにおいて、ECU21Bは、通信回線L2を介してECU22B〜24B、44Bと通信可能である。
[Power supply]
Control device 1A receives supply of power from power supply 7A, and control device 1B receives supply of power from power supply 7B. Even when the power supply of either the power supply 7A or the power supply 7B is cut off or lowered, power is supplied to either the control device 1A or the control device 1B. Reliability can be improved. When the power supply of the power supply 7A is interrupted or reduced, communication between ECUs through the gateway GW provided in the control device 1A becomes difficult. However, in the control device 1B, the ECU 21B can communicate with the ECUs 22B to 24B and 44B via the communication line L2.
[制御装置1A内での冗長化]
制御装置1Aは、自動運転制御を行うECU20Aと、走行支援制御を行うECU29Aとを備えており、走行制御を行う制御ユニットを二つ備えている。
[Redundancy in controller 1A]
The control device 1A includes an ECU 20A that performs automatic operation control and an ECU 29A that performs travel support control, and includes two control units that perform travel control.
<制御機能の例>
制御装置1Aまたは1Bで実行可能な制御機能は、車両Vの駆動、制動、操舵の制御に関わる走行関連機能と、運転者に対する情報の報知に関わる報知機能と、を含む。
<Example of control function>
Control functions that can be executed by the control device 1A or 1B include travel related functions related to control of driving, braking, and steering of the vehicle V, and a notification function related to notification of information to the driver.
走行関連機能としては、例えば、車線維持制御、車線逸脱抑制制御(路外逸脱抑制制御)、車線変更制御、前走車追従制御、衝突軽減ブレーキ制御、誤発進抑制制御を挙げることができる。報知機能としては、隣接車両報知制御、前走車発進報知制御を挙げることができる。 Examples of the driving-related functions include lane keeping control, lane departure suppression control (off road departure suppression control), lane change control, forward vehicle follow-up control, collision mitigation brake control, and false start suppression control. The notification function may include adjacent vehicle notification control and a leading vehicle start notification control.
車線維持制御とは、車線に対する車両の位置の制御の一つであり、車線内に設定した走行軌道上で車両を自動的に(運転者の運転操作によらずに)走行させる制御である。車線逸脱抑制制御とは、車線に対する車両の位置の制御の一つであり、白線または中央分離帯を検知し、車両が線を超えないように自動的に操舵を行うものである。車線逸脱抑制制御と車線維持制御とはこのように機能が異なっている。 The lane keeping control is one of control of the position of the vehicle with respect to the lane, and is control for causing the vehicle to automatically run (without depending on the driver's driving operation) on the traveling track set in the lane. The lane departure suppression control is one of control of the position of the vehicle relative to the lane, detects a white line or a central separation zone, and automatically performs steering so that the vehicle does not exceed the line. The lane departure suppression control and the lane keeping control thus have different functions.
車線変更制御とは、車両が走行中の車線から隣接車線へ車両を自動的に移動させる制御である。前走車追従制御とは、自車両の前方を走行する他車両に自動的に追従する制御である。衝突軽減ブレーキ制御とは、車両の前方の障害物との衝突可能性が高まった場合に、自動的に制動して衝突回避を支援する制御である。誤発進抑制制御は、車両の停止状態で運転者による加速操作が所定量以上の場合に、車両の加速を制限する制御であり、急発進を抑制する。 The lane change control is control for automatically moving the vehicle from the lane in which the vehicle is traveling to the adjacent lane. The forward vehicle following control is control for automatically following other vehicles traveling in front of the own vehicle. The collision mitigation brake control is a control that automatically brakes to support collision avoidance when the possibility of collision with an obstacle ahead of the vehicle increases. The erroneous start suppression control is control for restricting the acceleration of the vehicle when the acceleration operation by the driver is equal to or more than the predetermined amount in the stopped state of the vehicle, and suppresses the sudden start.
隣接車両報知制御とは、自車両の走行車線に隣接する隣接車線を走行する他車両の存在を運転者に報知する制御であり、例えば、自車両の側方、後方を走行する他車両の存在を報知する。前走車発進報知制御とは、自車両およびその前方の他車両が停止状態にあり、前方の他車両が発進したことを報知する制御である。これらの報知は、上述した車内報知デバイス(情報出力装置43A、情報出力装置44B)により行うことができる。 The adjacent vehicle notification control is a control for notifying the driver of the presence of another vehicle traveling on the adjacent lane adjacent to the traveling lane of the own vehicle, for example, the existence of another vehicle traveling to the side of the own vehicle and to the rear To inform The vehicle-in-front vehicle start notification control is control to notify that the host vehicle and the other vehicle in front of it are in the stop state and the other vehicle in front is started. These notifications can be performed by the in-vehicle notification device (the information output device 43A, the information output device 44B) described above.
ECU20A、ECU29AおよびECU21Bは、これらの制御機能を分担して実行することができる。どの制御機能をどのECUに割り当てるかは適宜選択可能である。 The ECU 20A, the ECU 29A, and the ECU 21B can share and execute these control functions. Which control function is assigned to which ECU can be appropriately selected.
図4は、車両Vにおいて、外界情報の取得からアクチュエータの制御までのブロック構成を示す図である。図4のブロック401は、例えば、図1のECU21Aにより実現される。ブロック401は、車両Vの外界情報を取得する。ここで、外界情報とは、例えば、車両Vに搭載された検知ユニット31A、32A、32A、32B(カメラ、レーダ、ライダ)により取得された画像情報や検知情報である。若しくは、外界情報は、車車間通信や路車間通信により取得される場合もある。ブロック401は、ガードレールや分離帯等の障害物や標識等を認識し、その認識結果をブロック402及びブロック408に出力する。ブロック408は、例えば、図1のECU29Aにより実現され、ブロック401により認識された障害物、歩行者、他車両等の情報に基づき、最適経路判断の上でのリスクポテンシャルを算出し、その算出結果をブロック402に出力する。 FIG. 4 is a diagram showing a block configuration from acquisition of external world information to control of an actuator in a vehicle V. As shown in FIG. The block 401 of FIG. 4 is implemented by, for example, the ECU 21A of FIG. The block 401 acquires external world information of the vehicle V. Here, the external world information is, for example, image information or detection information acquired by the detection units 31A, 32A, 32A, 32B (camera, radar, lidar) mounted on the vehicle V. Alternatively, the outside world information may be acquired by inter-vehicle communication or road-to-vehicle communication. The block 401 recognizes obstacles and signs such as guard rails and separation bands, and outputs the recognition result to the block 402 and the block 408. The block 408 is realized, for example, by the ECU 29A of FIG. 1, and based on the information of the obstacle, the pedestrian, the other vehicle, etc. recognized by the block 401, the risk potential based on the optimum route judgment is calculated. Is output to block 402.
ブロック402は、例えば、図1のECU29Aにより実現される。ブロック402は、外界情報の認識結果、速度や加速度等の車両運動情報、ドライバ409からの操作情報(操舵量やアクセル量等)に基づいて最適経路を判断する。その際、走行モデル405やリスク回避モデル406が考慮される。走行モデル405やリスク回避モデル406は、例えば、予めエキスパートドライバによるテスト走行によりサーバに収集されたプローブデータに基づき、学習の結果、生成された走行モデルである。特に、走行モデル405は、カーブや交差点等の各シーンについて生成されたモデルであり、リスク回避モデル406は、例えば、先行車両の急ブレーキ予測や、歩行者等の移動体の移動予測のモデルである。サーバで生成された走行モデルやリスク回避モデルは、車両Vに走行モデル405やリスク回避モデル406として実装される。車両Vにおいて自動運転支援システムを構成する場合には、ブロック402は、ドライバ409からの操作情報と目標値とに基づいて支援量を決定し、その支援量をブロック403に送信する。 The block 402 is implemented by, for example, the ECU 29A of FIG. A block 402 determines the optimum route based on the recognition result of the external world information, vehicle motion information such as speed and acceleration, and operation information from the driver 409 (steering amount, acceleration amount, etc.). At that time, the traveling model 405 and the risk avoidance model 406 are considered. The traveling model 405 and the risk avoidance model 406 are, for example, traveling models generated as a result of learning based on probe data collected by the server in advance by test traveling by an expert driver. In particular, the traveling model 405 is a model generated for each scene such as a curve or an intersection, and the risk avoidance model 406 is, for example, a model of sudden braking prediction of a leading vehicle or movement prediction model of a moving object such as a pedestrian. is there. The travel model and the risk avoidance model generated by the server are implemented in the vehicle V as the travel model 405 and the risk avoidance model 406. When the automatic driving support system is configured in the vehicle V, the block 402 determines the amount of support based on the operation information from the driver 409 and the target value, and transmits the amount of support to the block 403.
ブロック403は、例えば、図1のECU22A、23A、24A、27Aにより実現される。例えば、ブロック402で判断された最適経路や支援量に基づいて、アクチュエータの制御量を決定する。アクチュエータ404は、操舵、制動、停止維持、車内報知、車外報知のシステムを含む。ブロック407は、ドライバ409とのインタフェースであるHMI(ヒューマンマシンインタフェース)であり、入力装置45Aや45Bとして実現される。ブロック407では、例えば、自動運転モードとドライバ運転モードとの切り替えの通知や、車両Vが上述のエキスパートドライバにより運転される場合にはプローブデータの送信に際してのドライバからのコメントを受け付ける。 The block 403 is implemented by, for example, the ECUs 22A, 23A, 24A, 27A of FIG. For example, the control amount of the actuator is determined based on the optimal path and the support amount determined in block 402. The actuator 404 includes a system of steering, braking, stop maintenance, in-vehicle notification, and out-of-vehicle notification. A block 407 is an HMI (Human Machine Interface) which is an interface with the driver 409, and is realized as the input devices 45A and 45B. In block 407, for example, notification of switching between the automatic driving mode and the driver driving mode, and a comment from the driver at the time of transmission of probe data when the vehicle V is driven by the above-described expert driver are received.
図5は、アクチュエータ制御までの処理を示すフローチャートである。S101において、ブロック401は、車両Vの外界情報を取得する。ここで、車両Vの外界情報は、例えば、検知ユニット31A、32A、32A、32B(カメラ、レーダ、ライダ)や、車車間通信や路車間通信により取得されるものが含まれる。S102において、ブロック401は、ガードレールや分離帯等の障害物や標識等、外界環境を認識し、その認識結果をブロック402及びブロック408に出力する。また、S103において、ブロック402は、アクチュエータ404から車両運動情報を取得する。 FIG. 5 is a flowchart showing processing up to actuator control. In S101, the block 401 acquires external world information of the vehicle V. Here, the outside world information of the vehicle V includes, for example, detection units 31A, 32A, 32A, 32B (cameras, radars, riders), and information acquired by inter-vehicle communication or road-vehicle communication. In S102, the block 401 recognizes an external environment such as an obstacle or a sign such as a guardrail or a separation zone, and outputs the recognition result to the block 402 and the block 408. In addition, in S103, the block 402 acquires vehicle motion information from the actuator 404.
S104において、ブロック402は、緊急車両が所定圏内に存在するか否かを判定する。ここで、緊急車両とは、緊急用務のために運転される車両をいい、例えば、消防車や救急車である。ブロック402は、例えば、緊急車両の存在を通知する通知信号を車車間通信や路車間通信等で受信することにより、緊急車両が所定圏内に存在すると判定するようにしても良い。S104で緊急車両が存在すると判定された場合、S105に進み、最適経路判断が行われる。S105での最適経路判断については後述する。一方、S104で緊急車両が存在しないと判定された場合、S106に進む。S104での判定は、例えば、緊急車両の位置および速度に基づいて行われても良い。例えば、緊急車両が50m以内の所定圏内に存在している場合でも、渋滞等により緊急車両の速度が閾値以下であれば、緊急車両が存在しないと判定するようにしても良い。 In S104, the block 402 determines whether the emergency vehicle is in a predetermined area. Here, the emergency vehicle means a vehicle driven for emergency service, for example, a fire engine or an ambulance. For example, the block 402 may determine that the emergency vehicle is in the predetermined area by receiving a notification signal notifying the presence of the emergency vehicle by inter-vehicle communication, road-vehicle communication, or the like. If it is determined in S104 that there is an emergency vehicle, the process proceeds to S105, where an optimal route determination is made. The optimal route determination in S105 will be described later. On the other hand, when it is determined in S104 that there is no emergency vehicle, the process proceeds to S106. The determination in S104 may be performed, for example, based on the position and speed of the emergency vehicle. For example, even if the emergency vehicle is within a predetermined range of 50 m or less, it may be determined that the emergency vehicle does not exist if the speed of the emergency vehicle is equal to or less than the threshold due to traffic congestion or the like.
S106において、ブロック402は、各取得した情報と走行モデル405及びリスク回避モデル406とに基づいて、最適経路を判断する。例えば、車両Vに自動運転支援システムが構成されている場合には、ドライバ409からの操作情報に基づいて支援量を決定する。S107において、ブロック403は、S105若しくはS106で判断された最適経路に基づいてアクチュエータ404を制御する。 In S106, the block 402 determines an optimal route based on each acquired information and the traveling model 405 and the risk avoidance model 406. For example, when the automatic driving support system is configured in the vehicle V, the amount of support is determined based on the operation information from the driver 409. In step S107, the block 403 controls the actuator 404 based on the optimal path determined in step S105 or S106.
図6は、S105の最適経路判断の処理を示すフローチャートである。S201において、ブロック402は、緊急車両が接近してきている方向が、自車両の前方であるか若しくは後方であるかを判定する。S201の判定は、例えば、緊急車両のサイレン音により判定しても良いし、若しくは、緊急車両の位置を示すマップ情報を取得し、マップ上の位置に基づいて判定しても良い。若しくは、他の情報が用いられても良いし、上記の情報を組み合わせて用いることにより、緊急車両が接近してきている方向を判定しても良い。緊急車両が接近してきている方向が自車両の前方であると判定した場合、S202へ進み、自車両の後方であると判定した場合、S221へ進む。 FIG. 6 is a flowchart showing the process of determining the optimum route in S105. In S201, the block 402 determines whether the direction in which the emergency vehicle is approaching is in front of or behind the host vehicle. The determination in S201 may be made based on, for example, the siren sound of the emergency vehicle, or map information indicating the position of the emergency vehicle may be acquired and the determination may be made based on the position on the map. Alternatively, other information may be used, or the direction in which the emergency vehicle is approaching may be determined by using the above information in combination. If it is determined that the direction in which the emergency vehicle is approaching is in front of the host vehicle, the process proceeds to S202, and if it is determined that the emergency vehicle is behind the host vehicle, the process proceeds to S221.
以下、緊急車両が接近してきている方向が自車両の前方であると判定された場合について説明する。S202において、ブロック402は、先行車両が存在するか否かを判定する。ここで、先行車両が存在すると判定された場合、S203へ進み、先行車両が存在しないと判定された場合、S206へ進む。 Hereinafter, the case where it is determined that the direction in which the emergency vehicle is approaching is in front of the host vehicle will be described. In S202, block 402 determines whether a preceding vehicle exists. Here, when it is determined that the preceding vehicle exists, the process proceeds to S203, and when it is determined that the preceding vehicle does not exist, the process proceeds to S206.
S203において、ブロック402は、先行車両の挙動を判定し、S203において、その挙動が緊急車両を優先的に走行させるための回避行動であるか否かを判定する。例えば、左側通行であり且つ先行車両が道路の左側の路側帯側に寄る挙動である場合、緊急車両を優先的に走行させる(緊急車両の走行を妨げない)ための回避行動であると判定し、S205に進む。S205において、ブロック402は、緊急車両回避行動を計画する。S205では、ブロック402は、先行車両の挙動に追従する(トレース)ように回避行動を計画する。つまり、先行車両が路側帯側に寄るオフセット走行である場合、路側帯側に寄るように回避行動を計画する。回避行動として、例えば、現在の走行路から路側帯側に寄って停止するまでの操舵量と減速度がアクチュエータ制御量として決定される。 In S203, the block 402 determines the behavior of the preceding vehicle, and in S203 determines whether the behavior is an avoidance action for causing the emergency vehicle to preferentially travel. For example, if the vehicle is traveling on the left side and the preceding vehicle is in a behavior approaching the roadside of the left side of the road, it is determined that the evasive action is for causing the emergency vehicle to travel preferentially (does not prevent the emergency vehicle from traveling). , S205. At S205, block 402 plans an emergency vehicle avoidance action. At S205, block 402 plans an avoidance action to trace the behavior of the preceding vehicle. That is, when the preceding vehicle is in the offset running approaching the roadside zone, the evasive action is planned so as to approach the roadside zone. As an avoidance action, for example, the steering amount and the deceleration until the vehicle approaches the roadside and stops from the current traveling road are determined as the actuator control amount.
このように、本実施形態では、緊急車両が存在すると判定された場合、先行車両が緊急車両回避行動をとっているのであれば、緊急車両回避行動を計画する。例えば、図9(B)に示すように、緊急車両914が前方から接近している場合には、自車両911よりも先行車両912の方がより早くに回避行動をとることが期待されるので、緊急車両914の接近に対して余裕をもった回避行動をとることができる。 As described above, in the present embodiment, when it is determined that the emergency vehicle is present, the emergency vehicle avoidance action is planned if the preceding vehicle is in the emergency vehicle avoidance action. For example, as shown in FIG. 9B, when the emergency vehicle 914 is approaching from the front, the preceding vehicle 912 is expected to take evasive action earlier than the host vehicle 911. The evasive action can be taken for the approach of the emergency vehicle 914.
一方、S204で緊急車両を走行させるための回避行動でないと判定した場合、S206へ進む。S206において、ブロック402は、他のレーンの車両の挙動は、緊急車両回避行動であるか否かを判定する。図9(B)の場合、他のレーンの車両913が緊急車両回避行動をとっているか否かが判定される。ここで、緊急車両回避行動であると判定された場合、S207において、ブロック402は、緊急車両回避行動を計画する。S207では、ブロック402は、他のレーンの車両の挙動と、車両幅方向上で反対方向に寄るような、即ち、他のレーンの車両と離間する方向へのオフセット走行を回避行動として計画する。例えば、図9(B)に示すように、隣接する対向レーンを走行する車両913が路側帯側に寄った場合には、自車両911が左側に寄るようなオフセット走行を回避行動として計画する。S206で緊急車両回避行動でないと判定された場合若しくは他のレーンに車両がない場合、S208へ進む。 On the other hand, when it is determined in S204 that it is not an evasive action for causing the emergency vehicle to travel, the process proceeds to S206. In S206, the block 402 determines whether the behavior of the vehicle in the other lane is an emergency vehicle avoidance action. In the case of FIG. 9 (B), it is determined whether the vehicle 913 in the other lane is taking an emergency vehicle avoidance action. Here, if it is determined that the action is an emergency vehicle avoidance action, in S207, the block 402 plans an emergency vehicle avoidance action. In S207, the block 402 plans the behavior of the vehicle in the other lane and the offset traveling in the opposite direction in the vehicle width direction, that is, in the direction away from the vehicle in the other lane as the avoidance behavior. For example, as shown in FIG. 9 (B), when the vehicle 913 traveling on the adjacent opposite lane approaches the roadside zone side, the offset travel such that the host vehicle 911 approaches the left side is planned as an avoidance action. If it is determined in S206 that the vehicle is not an emergency vehicle avoidance action or if there is no vehicle in another lane, the process proceeds to S208.
S208において、ブロック402は、緊急車両は所定距離内に接近しているか否かを判定する。S208の判定は、例えば、緊急車両との接近度合いを示す値、例えばTTC(Time To Collision)が所定値以下であれば、緊急車両は所定距離内に接近していると判定しても良い。また、TTCのような時間を表す指標ではなく、距離を表す指標に基づいて、判定が行われても良い。例えば、車車間通信や路車間通信等で受信する緊急車両の通知信号やGPS信号に基づいて、緊急車両が所定距離内に接近しているか否かを判定するようにしても良い。S208で緊急車両は所定距離内に接近していると判定された場合、S209において、ブロック402は、緊急車両回避行動を計画する。その場合、ブロック402は、原則、路側帯側に寄るようなオフセット走行を回避行動として計画する。また、第2走行車線を走行しているなどの場合は、ブロック402は、ブロック401の認識結果およびブロック408で算出されたリスクポテンシャルに基づいて、緊急車両の走行を回避するために、右側若しくは左側に寄るかを判断する。一方、緊急車両は所定距離内に接近していないと判定された場合、S104からの処理を繰り返す。例えば、緊急車両が自車両の走行経路と地理的に隔たりのある経路を介して遠ざかっていった場合には、そのような処理が行われ、S106において通常の最適経路判断が行われることになる。 At S208, block 402 determines whether the emergency vehicle is approaching within a predetermined distance. In the determination of S208, for example, it may be determined that the emergency vehicle is approaching within a predetermined distance if the value indicating the approach degree to the emergency vehicle, for example, TTC (Time To Collision) is less than or equal to the predetermined value. In addition, the determination may be performed based on an index that represents a distance instead of an index that represents time such as TTC. For example, it may be determined whether the emergency vehicle is approaching within a predetermined distance based on a notification signal or a GPS signal of the emergency vehicle received by inter-vehicle communication, road-vehicle communication, or the like. If it is determined in S208 that the emergency vehicle is approaching within the predetermined distance, in S209, block 402 plans an emergency vehicle avoidance action. In that case, the block 402, in principle, plans an offset run approaching the roadside as an avoidance action. In addition, when traveling on the second driving lane, the block 402 controls the right side or the right side to avoid traveling of the emergency vehicle based on the recognition result of the block 401 and the risk potential calculated in the block 408. Decide if you are on the left. On the other hand, when it is determined that the emergency vehicle is not approaching within the predetermined distance, the processing from S104 is repeated. For example, when the emergency vehicle is moved away from the traveling route of the own vehicle via a route geographically separated, such processing is performed, and the normal optimum route determination is performed in S106. .
このように、本実施形態では、先行車両がない場合や先行車両が緊急車両の接近に気づいていないために緊急車両回避行動をとっていない場合には、画像解析やレーダ、ライダ等により、他のレーンを走行する車両の挙動に基づいて、緊急車両回避行動をとるか否かを判定する。そのような構成により、先行車両がない場合や先行車両が緊急車両回避行動をとっていない場合でも、前方からの緊急車両の接近について、他のレーンの車両の挙動に基づいて余裕をもった回避行動をとることができる。 As described above, in the present embodiment, when there is no leading vehicle or when the leading vehicle does not notice the approach of the emergency vehicle and does not take emergency vehicle avoidance action, the image analysis, the radar, the rider, etc. It is determined whether to take an emergency vehicle avoidance action based on the behavior of the vehicle traveling on the lane of. With such a configuration, even if there is no preceding vehicle or no preceding vehicle takes an emergency vehicle avoidance action, the approach of the emergency vehicle from the front can be avoided based on the behavior of the vehicles in the other lanes. I can take action.
次に、緊急車両が接近してきている方向が自車両の後方であると判定された場合について説明する。図7のS221において、ブロック402は、後続車両が存在するか否かを判定する。ここで、後続車両が存在すると判定された場合、S222へ進み、後続車両が存在しないと判定された場合、S225へ進む。 Next, the case where it is determined that the direction in which the emergency vehicle is approaching is the rear of the vehicle will be described. In S221 of FIG. 7, a block 402 determines whether there is a following vehicle. Here, when it is determined that the following vehicle is present, the process proceeds to S222, and when it is determined that the following vehicle is not present, the process proceeds to S225.
S222において、ブロック402は、後続車両の挙動を判定し、S223において、その挙動が緊急車両を優先的に走行させるための回避行動であるか否かを判定する。例えば、左側通行であり且つ後続車両が道路の左側の路側帯側に寄る挙動である場合、緊急車両を優先的に走行させるための回避行動であると判定し、S224へ進む。S224において、ブロック402は、緊急車両回避行動を計画する。S224では、ブロック402は、後続車両の挙動に追従する(トレース)ように回避行動を計画する。つまり、後続車両が路側帯側に寄るオフセット走行である場合、路側帯側に寄るようなオフセット走行を回避行動として計画する。 In S222, the block 402 determines the behavior of the following vehicle, and in S223, determines whether the behavior is an avoidance action for causing the emergency vehicle to run preferentially. For example, if the vehicle is traveling on the left side and the following vehicle is in the behavior of approaching the roadside zone on the left side of the road, it is determined that it is an avoidance action for causing the emergency vehicle to preferentially travel, and the process proceeds to S224. At S224, block 402 plans an emergency vehicle avoidance action. In S224, the block 402 plans an avoidance action to trace the behavior of the following vehicle. That is, when the following vehicle is the offset running approaching the roadside zone, the offset running approaching the roadside zone is planned as an avoidance action.
このように、本実施形態では、緊急車両が存在すると判定した場合、後続車両が緊急車両回避行動をとっているのであれば、緊急車両回避行動を計画する。例えば、図9(A)に示すように、緊急車両904が後方から接近している場合には、自車両901よりも後続車両902の方がより早くに回避行動をとることが期待されるので、緊急車両904の接近に対して余裕をもった回避行動をとることができる。 As described above, in the present embodiment, when it is determined that the emergency vehicle is present, the emergency vehicle avoidance action is planned if the following vehicle is taking the emergency vehicle avoidance action. For example, as shown in FIG. 9A, when the emergency vehicle 904 is approaching from the rear, the following vehicle 902 is expected to take evasive action earlier than the host vehicle 901. The evasive action can be taken for the approach of the emergency vehicle 904.
一方、S223で緊急車両を走行させるための回避行動でないと判定した場合、S225へ進む。S225において、ブロック402は、他のレーンの車両の挙動は、緊急車両回避行動であるか否かを判定する。図9(A)の場合、他のレーンの車両903が緊急車両回避行動をとっているか否かが判定される。ここで、緊急車両回避行動であると判定された場合、S226において、ブロック402は、緊急車両回避行動を計画する。S226では、ブロック402は、他のレーンの車両の挙動と、車両幅方向上、反対方向に寄るように回避行動を計画する。例えば、図9(A)に示すように、隣接する対向レーンを走行する車両903の挙動が路側帯側に寄っている場合には、自車両901が左側に寄るような、即ち、他のレーンの車両と離間する方向へのオフセット走行を回避行動として計画する。これは、左側通行の場合であるが、右側通行の場合には、自車両901が右側に寄るようなオフセット走行を回避行動として計画する。 On the other hand, when it is determined in S223 that it is not an evasive action for causing the emergency vehicle to travel, the process proceeds to S225. In S225, the block 402 determines whether the behavior of the vehicle in the other lane is an emergency vehicle avoidance action. In the case of FIG. 9A, it is determined whether the vehicle 903 in the other lane is taking an emergency vehicle avoidance action. Here, if it is determined that the action is an emergency vehicle avoidance action, in S226, a block 402 plans an emergency vehicle avoidance action. In S226, the block 402 plans the evasive action to move in the opposite direction in the vehicle width direction and the vehicle behavior in the other lanes. For example, as shown in FIG. 9A, when the behavior of a vehicle 903 traveling on an adjacent opposite lane is closer to the roadside zone, the own vehicle 901 is closer to the left, that is, the other lanes. Plan offset running in the direction away from the vehicle as an evasive action. This is the case of left-handed traffic, but in the case of right-handed traffic, it is planned as an offsetting action in which the host vehicle 901 approaches the right.
図9(A)は、片側1車線の場合を示しているが、片側複数車線の場合でも上記の動作を適用可能である。例えば、片側2車線であり、自車両が2車線中の走行車線を走行している場合、追越車線を走行している他車両が中央分離帯側、即ち右側に寄った場合には、左側に寄るように回避行動を計画する。反対に、自車両が2車線中の追越車線を走行している場合、走行車線を走行している他車両が路側帯側、即ち左側に寄った場合には、右側に寄るように回避行動を計画する。 FIG. 9A shows the case of one lane on one side, but the above operation can be applied to the case of multiple lanes on one side. For example, if there are two lanes on one side and the own vehicle is traveling in the lane in two lanes, the other vehicle traveling on the overtaking lane approaches the central separation side, that is, the right side, the left side Plan your evasive action as you approach. On the other hand, when the host vehicle is traveling in the overtaking lane in two lanes, the evasive action is performed so that the other vehicle traveling in the traveling lane approaches the roadside band side, that is, the left side. Plan.
また、片側3車線であり(第1走行車線、第2走行車線、追越車線)且つ自車両が第2走行車線を走行している場合があり得る。そのような場合、ブロック402は、ブロック401の認識結果およびブロック408で算出されたリスクポテンシャルに基づいて、緊急車両の走行を回避するために、右側若しくは左側に寄るかを判断する。S225で緊急車両回避行動でないと判定された場合若しくは他のレーンに車両がない場合、S227へ進む。 In addition, there may be cases in which there are three lanes on one side (a first traveling lane, a second traveling lane, and an overtaking lane) and the host vehicle is traveling in a second traveling lane. In such a case, block 402 determines, based on the recognition result of block 401 and the risk potential calculated in block 408, whether to move to the right or left to avoid traveling of the emergency vehicle. If it is determined in S225 that the vehicle is not an emergency vehicle avoidance action or if there is no vehicle in another lane, the process proceeds to S227.
このように、本実施形態では、後続車両がない場合や、後続車両が緊急車両の接近に気づいていないために緊急車両回避行動をとっていない場合、画像解析やレーダ、ライダ等により、他のレーンを走行する車両の挙動に基づいて、緊急車両回避行動をとるか否かを判定する。 As described above, in the present embodiment, when there is no following vehicle or when the following vehicle does not notice the approach of the emergency vehicle and does not take emergency vehicle avoidance action, the image analysis, the radar, the rider, etc. Based on the behavior of the vehicle traveling on the lane, it is determined whether to take an emergency vehicle avoidance action.
S227において、ブロック402は、緊急車両が所定距離内に接近しているか否かを判定する。S227の判定、例えば、緊急車両との接近度合いを示す値、例えばTTCが所定値以下であれば、緊急車両は所定距離内に接近していると判定しても良い。また、TTCのような時間を表す指標ではなく、距離を表す指標に基づいて、判定が行われても良い。例えば、車車間通信や路車間通信等で受信する緊急車両の通知信号やGPS信号に基づいて、緊急車両が所定距離内に接近しているか否かを判定するようにしても良い。S227で緊急車両が所定距離内に接近していると判定された場合、S228において、ブロック402は、緊急車両回避行動を計画する。その場合、ブロック402は、原則、路側帯に寄るようなオフセット走行を回避行動として計画する。また、第2走行車線を走行しているなどの場合は、ブロック402は、ブロック401の認識結果およびブロック408で算出されたリスクポテンシャルに基づいて、緊急車両の走行を回避するために、右側若しくは左側に寄るかを判断する。 At S227, a block 402 determines whether the emergency vehicle is approaching within a predetermined distance. If the determination in S227, for example, a value indicating the approach degree to the emergency vehicle, for example, TTC is equal to or less than a predetermined value, it may be determined that the emergency vehicle is approaching within the predetermined distance. In addition, the determination may be performed based on an index that represents a distance instead of an index that represents time such as TTC. For example, it may be determined whether the emergency vehicle is approaching within a predetermined distance based on a notification signal or a GPS signal of the emergency vehicle received by inter-vehicle communication, road-vehicle communication, or the like. When it is determined in S227 that the emergency vehicle is approaching within the predetermined distance, in S228, the block 402 plans an emergency vehicle avoidance action. In that case, the block 402 plans, in principle, an offset run approaching the roadside zone as an avoidance action. In addition, when traveling on the second driving lane, the block 402 controls the right side or the right side to avoid traveling of the emergency vehicle based on the recognition result of the block 401 and the risk potential calculated in the block 408. Decide if you are on the left.
一方、S227で緊急車両が所定距離内に存在しないと判定された場合、S104からの処理を繰り返す。例えば、緊急車両が自車両の走行経路と地理的に隔たりのある経路を介して遠ざかっていった場合には、そのような処理が行われ、S106において通常の最適経路判断が行われることになる。 On the other hand, when it is determined in S227 that the emergency vehicle does not exist within the predetermined distance, the processing from S104 is repeated. For example, when the emergency vehicle is moved away from the traveling route of the own vehicle via a route geographically separated, such processing is performed, and the normal optimum route determination is performed in S106. .
図8(A)は、S207、S209、S226、S228の緊急車両回避行動計画の処理を示すフローチャートである。S301において、ブロック401は、外界情報に基づいて環境認識を行う。S302において、ブロック402は、ブロック401の認識結果およびブロック408で算出されたリスクポテンシャルに基づいて、緊急車両回避行動が可能であるか否かを判定する。 FIG. 8A is a flowchart showing processing of the emergency vehicle avoidance action plan of S207, S209, S226, and S228. In step S301, the block 401 performs environment recognition based on the outside world information. In S302, the block 402 determines, based on the recognition result of the block 401 and the risk potential calculated in the block 408, whether or not the emergency vehicle avoidance action is possible.
本実施形態において、緊急車両回避行動とは、緊急車両の走行を妨げないための回避動作を意味するが、例えば、自車両の走行軌道が緊急車両の走行軌道上に重ならないように回避する動作である。これには、自車両および緊急車両の双方について予測される各走行軌道が重ならないように、自車両の走行軌道を決定することが含まれる。また、自車両および緊急車両の双方について予測される各走行軌道が重なった場合でも、自車両の現在の環境において速度制御等により、緊急車両の走行を優先させることが含まれる。 In the present embodiment, the emergency vehicle avoidance action means an avoidance operation for preventing the traveling of the emergency vehicle, but for example, the operation of avoiding the traveling track of the own vehicle so as not to overlap on the traveling track of the emergency vehicle It is. This includes determining the travel path of the vehicle so that the travel paths predicted for both the vehicle and the emergency vehicle do not overlap. In addition, even if the travel paths predicted for both the host vehicle and the emergency vehicle overlap, priority is given to traveling of the emergency vehicle by speed control or the like in the current environment of the host vehicle.
S302で緊急車両回避行動が可能であると判定された場合、S303において、ブロック402は、緊急車両の走行の回避のため縦方向と横方向の少なくともいずれかの走行を制御するオフセット走行を行うように、停止位置、減速割合を含むアクチュエータ制御量を決定する。S303の後、図8(A)の処理を終了する。 When it is determined in S302 that the emergency vehicle avoidance action is possible, in S303, the block 402 performs offset travel to control travel in at least one of the longitudinal direction and the lateral direction to avoid travel of the emergency vehicle. Then, the actuator control amount including the stop position and the deceleration rate is determined. After S303, the process of FIG. 8A ends.
S302で緊急車両回避行動が可能でないと判定された場合、S304において、ブロック402は、緊急車両回避行動計画を中止し、自車両の走行制御をドライバ409による手動運転へ切り替える。その場合、ブロック402は、例えば、HMI407上で、手動運転に切り替えられたことをドライバ402に報知する。S304の後、図8(A)の処理を終了する。 When it is determined in S302 that the emergency vehicle avoidance action is not possible, in S304, the block 402 cancels the emergency vehicle avoidance action plan, and switches travel control of the host vehicle to manual driving by the driver 409. In that case, block 402 informs driver 402 that it has been switched to manual operation, for example, on HMI 407. After S304, the process of FIG. 8A ends.
図8(B)は、S205、S224の緊急車両回避行動計画の処理を示すフローチャートである。S311において、ブロック402は、追従対象(トレース対象)の先行車両若しくは後続車両の挙動を解析する。そして、S312において、ブロック402は、解析結果に基づいて、トレース対象の車両をトレースするか否かを判定する。S312では、例えば、解析の結果、トレース対象の車両の走行状態にふらつきのある場合には、トレースしないと判定する。もしくは、ブロック402が、仮に自車両がトレース対象の車両をトレースした場合、緊急車両の走行軌道と自車両の位置とが互いに干渉すると予測した場合には、トレースしないと判定するようにしても良い。 FIG. 8B is a flowchart showing the process of the emergency vehicle avoidance action plan of S205 and S224. In S311, a block 402 analyzes the behavior of the preceding vehicle or the following vehicle to be followed (trace object). Then, in S312, the block 402 determines whether to trace the vehicle to be traced based on the analysis result. In S312, for example, when there is fluctuation in the traveling state of the tracing target vehicle as a result of analysis, it is determined that tracing is not performed. Alternatively, it may be determined that tracing is not performed if the block 402 estimates that the traveling track of the emergency vehicle and the position of the own vehicle interfere with each other if the own vehicle traces the vehicle to be traced. .
トレースすると判定された場合、S313において、ブロック402は、トレース対象の車両の挙動に基づいて、緊急車両の走行の回避のため縦方向と横方向の少なくともいずれかの走行を制御するオフセット走行を行うように、停止位置、減速割合を含むアクチュエータ制御量を決定する。S313の後、図8(B)の処理を終了する。 When it is determined that tracing is to be performed, in S313, the block 402 performs offset traveling to control traveling in at least one of the longitudinal direction and the lateral direction to avoid traveling of the emergency vehicle based on the behavior of the vehicle to be traced. Thus, the actuator control amount including the stop position and the deceleration rate is determined. After S313, the process of FIG. 8B ends.
S312でトレースしないと判定された場合、S314において、ブロック401は、外界情報に基づいて環境認識を行う。そして、S315において、ブロック402は、ブロック401の認識結果およびブロック408で算出されたリスクポテンシャルに基づいて、緊急車両回避行動が可能であるか否かを判定する。ここで、緊急車両回避行動が可能であると判定された場合、S316において、ブロック402は、緊急車両の走行の回避のため縦方向と横方向の少なくともいずれかの走行を制御するオフセット走行を行うように、停止位置、減速割合を含むアクチュエータ制御量を決定する。S316の後、図8(B)の処理を終了する。 If it is determined in S312 that tracing is not to be performed, in S314, the block 401 performs environment recognition based on the external world information. Then, in S315, the block 402 determines whether or not the emergency vehicle avoidance action is possible based on the recognition result of the block 401 and the risk potential calculated in the block 408. Here, when it is determined that the emergency vehicle avoidance action is possible, in step S316, the block 402 performs offset traveling to control traveling in at least one of the longitudinal direction and the lateral direction to avoid traveling of the emergency vehicle. Thus, the actuator control amount including the stop position and the deceleration rate is determined. After S316, the process of FIG. 8B ends.
S315で緊急車両回避行動が可能でないと判定された場合、S317において、ブロック402は、緊急車両回避行動計画を中止し、自車両の走行制御をドライバ409による手動運転へ切り替える。その場合、ブロック402は、例えば、HMI407上で、手動運転に切り替えられたことをドライバ402に報知する。S317の後、図8(B)の処理を終了する。 When it is determined in S315 that the emergency vehicle avoidance action is not possible, in S317, the block 402 cancels the emergency vehicle avoidance action plan, and switches travel control of the host vehicle to manual driving by the driver 409. In that case, block 402 informs driver 402 that it has been switched to manual operation, for example, on HMI 407. After S317, the process of FIG. 8B ends.
上記のような構成により、トレース対象として適切でない挙動を行っている車両に追従することを防ぐことができる。 According to the configuration as described above, it is possible to prevent the vehicle following the behavior which is not appropriate as the trace object.
以上のように、本実施形態では、緊急車両が接近している場合、自車両を先行車両、後続車両、他のレーンの車両のいずれかに基づいて、オフセット走行させて緊急車両の走行を回避することができる。 As described above, in the present embodiment, when the emergency vehicle is approaching, the own vehicle is offset-traveled based on any of the preceding vehicle, the following vehicle, and the vehicle on the other lane to avoid traveling of the emergency vehicle. can do.
次に、緊急車両が接近している場合に自車両が特定シーンにいる場合の動作について説明する。本実施形態における特定シーンとは、交差点、横断歩道、踏切、狭道、駐停止禁止区間等に位置する状況であり、回避行動が行う際には、まず通過を求められる場所に位置している状況をいう。 Next, an operation when the host vehicle is in a specific scene when the emergency vehicle is approaching will be described. The specific scene in this embodiment is a situation located at an intersection, a pedestrian crossing, a level crossing, a narrow road, a parking suspension section, etc., and when evasive action is performed, it is first located at a place where passing is required I say the situation.
図10は、S105の最適経路判断の処理を示すフローチャートである。S401において、ブロック402は、GPS位置情報やブロック401の認識結果に基づいて、自車両の位置を認識する。S402において、ブロック402は、ブロック401の認識結果から、自車両が特定シーン内にいるか否かを判定する。例えば、ブロック402は、停止線等の物標データやGPS位置情報に基づいて、自車両が交差点内にいるか否かを判定する。ここで、自車両が特定シーン内にいると判定した場合、S403において、ブロック402は、特定シーンを通過するように最適経路を判断する。S403では、例えば、ブロック402は、自車両の前方の停止線を認識した場合に、その位置を目標位置として最適経路を判断する。そして、ブロック403は、判断された最適経路に基づいてアクチュエータ404を制御する。S403の後、S201の処理が行われる。一方、S402で自車両が特定シーン内にいないと判定された場合、S201の処理が行われる。 FIG. 10 is a flowchart showing the process of determining the optimum route in S105. In S401, the block 402 recognizes the position of the host vehicle based on the GPS position information and the recognition result of the block 401. In step S402, the block 402 determines from the recognition result of the block 401 whether or not the host vehicle is in a specific scene. For example, the block 402 determines whether or not the host vehicle is in an intersection based on target data such as a stop line and GPS position information. Here, when it is determined that the host vehicle is in the specific scene, in S403, the block 402 determines an optimal route so as to pass the specific scene. In S403, for example, when the stop line in front of the host vehicle is recognized, the block 402 determines an optimal route with the position as a target position. Block 403 then controls actuator 404 based on the determined optimal path. After S403, the process of S201 is performed. On the other hand, when it is determined in S402 that the host vehicle is not in the specific scene, the processing of S201 is performed.
このように、本実施形態では、S104で緊急車両が存在すると判定された際に、自車両が特定シーン内にいる場合には、特定シーンを通過した後に、図6及び図7の最適経路判断、即ちオフセット走行による回避行動が計画される。また、上記では、交差点を例として説明したが、交差点に限られず、踏切等であっても良い。即ち、緊急車両の接近時に通過を求められる特定シーンであれば、交差点でなくても良い。 As described above, in the present embodiment, when it is determined that the emergency vehicle is present in S104, if the own vehicle is in the specific scene, the optimum route determination of FIGS. 6 and 7 is performed after passing the specific scene. That is, an avoidance action by offset running is planned. Moreover, although an intersection was demonstrated above as an example, it is not restricted to an intersection, A level crossing etc. may be sufficient. That is, if it is a specific scene that is required to pass when an emergency vehicle approaches, it may not be an intersection.
<実施形態のまとめ>
本実施形態の走行制御装置は、車両の走行を制御する走行制御装置であって、緊急車両の情報を取得する第1の取得手段と(28c)、前記第1の取得手段により前記車両の周辺の緊急車両の情報を取得した場合に、前記車両に先行する第1の車両もしくは前記車両に後続する第2の車両の挙動が、前記緊急車両の走行を妨げないための回避動作であれば、当該回避動作を行っている前記第1の車両もしくは前記第2の車両のいずれか一方に追従するよう前記車両の縦方向と横方向の少なくともいずれかについての走行を制御する走行制御手段と(S204、S224、ブロック402)、を備えることを特徴とする。
<Summary of the embodiment>
The travel control device according to the present embodiment is a travel control device for controlling the travel of a vehicle, and includes a first acquisition unit that acquires information on an emergency vehicle, (28c), and the periphery of the vehicle by the first acquisition unit. If the behavior of the first vehicle preceding the vehicle or the second vehicle following the vehicle is an avoidance operation for preventing the traveling of the emergency vehicle when acquiring the information of the emergency vehicle, A traveling control means for controlling traveling of at least one of the longitudinal direction and the lateral direction of the vehicle so as to follow one of the first vehicle and the second vehicle performing the avoidance operation (S204 , S224, and block 402).
そのような構成により、緊急車両の接近時には、自車両の先行車両もしくは後続車両に追従して緊急車両の回避行動をとることができる。 With such a configuration, when the emergency vehicle approaches, it is possible to follow the leading vehicle or the following vehicle of the own vehicle and take an avoidance action of the emergency vehicle.
また、前記第1の取得手段により取得した前記緊急車両の情報が前記車両の前方からの前記緊急車両の接近を示し、且つ、前記第1の車両の挙動が前記回避動作であれば、前記走行制御手段は、前記第1の車両と同じ方向に移動するよう、前記車両の縦方向と横方向の少なくともいずれかについての走行を制御することを特徴とする(S204)。そのような構成により、緊急車両の前方からの接近時には、先行車両と同一方向に自車両をオフセット移動させることができる。 In addition, if the information on the emergency vehicle acquired by the first acquisition means indicates the approach of the emergency vehicle from the front of the vehicle, and the behavior of the first vehicle is the avoidance operation, the traveling The control means controls traveling of at least one of the longitudinal direction and the lateral direction of the vehicle so as to move in the same direction as the first vehicle (S204). With such a configuration, when the emergency vehicle approaches from the front, the own vehicle can be offset-moved in the same direction as the preceding vehicle.
また、前記第1の取得手段により取得した前記緊急車両の情報が前記車両の後方からの前記緊急車両の接近を示し、且つ、前記第2の車両の挙動が前記回避動作であれば、前記走行制御手段は、前記第2の車両と同じ方向に移動するよう、前記車両の縦方向と横方向の少なくともいずれかについての走行を制御することを特徴とする(S224)。そのような構成により、緊急車両の後方からの接近時には、後続車両と同一方向に自車両をオフセット移動させることができる。 Further, if the information on the emergency vehicle acquired by the first acquisition means indicates the approach of the emergency vehicle from the rear of the vehicle, and the behavior of the second vehicle is the avoidance operation, the traveling The control means controls traveling of at least one of the longitudinal direction and the lateral direction of the vehicle so as to move in the same direction as the second vehicle (S224). With such a configuration, when the emergency vehicle approaches from behind, the own vehicle can be offset-moved in the same direction as the following vehicle.
また、追従対象となる前記第1の車両もしくは前記第2の車両の挙動に基づいて、前記第1の車両もしくは前記第2の車両のいずれか一方への追従を行うか否かを判断する第1の判断手段と(S311、S312)、前記第1の判断手段により前記第1の車両もしくは前記第2の車両のいずれか一方への追従を行うと判断された場合、前記走行制御手段は、前記第1の車両もしくは前記第2の車両のいずれか一方に追従するよう前記車両の縦方向と横方向の少なくともいずれかについての走行を制御することを特徴とする。そのような構成により、例えば、先行車両や後続車両の挙動にふらつきがある場合には、それらの車両の追従を行わないようにすることができる。 In addition, it is determined whether to follow one of the first vehicle and the second vehicle based on the behavior of the first vehicle or the second vehicle to be followed. When it is determined that one of the first vehicle and the second vehicle is to be followed by the determination unit 1 (S311, S312), and the first determination unit, the travel control unit It is characterized in that traveling of at least one of the longitudinal direction and the lateral direction of the vehicle is controlled so as to follow any one of the first vehicle and the second vehicle. With such a configuration, for example, in the case where the behavior of the preceding vehicle or the following vehicle is unstable, it is possible to prevent the follow-up of those vehicles.
また、前記第1の判断手段により前記第1の車両もしくは前記第2の車両のいずれか一方への追従を行わないと判断された場合、前記走行制御手段は、追従対象の前記第1の車両もしくは前記第2の車両の挙動に関わらず、前記回避動作を行うよう前記車両の縦方向と横方向の少なくともいずれかについての走行を制御することを特徴とする。そのような構成により、緊急車両の回避が可能である状況で、緊急車両の回避を行うことができる。 Further, when it is determined that the first determination means does not follow any one of the first vehicle and the second vehicle, the travel control means determines that the first vehicle to be followed is Alternatively, regardless of the behavior of the second vehicle, traveling of at least one of the longitudinal direction and the lateral direction of the vehicle is controlled to perform the avoidance operation. With such a configuration, the emergency vehicle can be avoided in a situation where the emergency vehicle can be avoided.
また、前記回避動作が可能であるか否かを判断する第2の判断手段(S304、S317)、をさらに備え、前記第2の判断手段により前記回避動作が可能であると判断された場合、前記走行制御手段は、前記回避動作のための走行制御を行い、前記第2の判断手段により前記回避動作が可能でないと判断された場合、前記走行制御手段は、前記走行制御を中止して手動運転へ切り替えることを特徴とする。そのような構成により、緊急車両の回避が可能でない状況では、ドライバによる手動運転に切り替えることができる。 Further, a second determination unit (S304, S317) for determining whether or not the avoidance operation is possible is further included, and it is determined that the avoidance operation is possible by the second determination unit, The travel control means performs travel control for the avoidance operation, and when it is determined by the second determination means that the avoidance operation is not possible, the travel control means cancels the travel control and manually It is characterized by switching to driving. Such a configuration makes it possible to switch to manual driving by the driver in situations where the emergency vehicle can not be avoided.
また、他の車両の情報を取得する第2の取得手段と(検知ユニット31A、32A、32A、32B)、前記第2の取得手段により取得された前記他の車両の情報に基づいて、前記他の車両の挙動が前記回避動作であるか否かを判断する第3の判断手段と(S205、S225)、をさらに備えることを特徴とする。そのような構成により、例えば、対向車両が回避行動をとっているか否かを判断することができる。 In addition, based on the information on the other vehicle acquired by the second acquisition unit for acquiring information on the other vehicle (detection units 31A, 32A, 32A, 32B), and the second acquisition unit, It is characterized by further having the 3rd judgment means and (S205, S225) which judge whether the behavior of vehicles of the above is the above-mentioned avoidance operation. With such a configuration, for example, it can be determined whether the oncoming vehicle is taking an evasive action.
また、前記第2の取得手段が、前記第1の車両および前記第2の車両の情報を取得できず若しくはしなかった場合で、前記車両が走行するレーンと異なる他のレーンの車両の情報を取得した場合、前記第3の判断手段は、前記第2の取得手段により取得された前記他のレーンの車両の情報に基づいて、前記他のレーンの車両の挙動が前記回避動作であるか否かを判断し、前記他のレーンの車両の挙動が前記回避動作であれば、前記走行制御手段は、前記他のレーンの車両から離間する方向に移動するよう、前記車両の縦方向と横方向の少なくともいずれかについての走行を制御することを特徴とする(S206、S226)。そのような構成により、例えば、対向車両と車両幅方向上、対向車両と離間する方向に自車両をオフセット移動することができる。 In addition, when the second acquisition unit can not or does not acquire information on the first vehicle and the second vehicle, information on vehicles in other lanes different from the lane on which the vehicle travels is If acquired, the third determination unit determines whether the behavior of the vehicle in the other lane is the avoidance operation based on the information of the vehicle in the other lane acquired by the second acquisition unit. If the behavior of the vehicle in the other lane is the avoidance operation, the travel control means moves in the longitudinal direction and the lateral direction of the vehicle so as to move in a direction away from the vehicle in the other lane. Control the traveling of at least one of the above (S206, S226). With such a configuration, for example, the host vehicle can be offset-moved in the direction away from the oncoming vehicle in the width direction of the oncoming vehicle and the vehicle.
また、前記第2の取得手段が前記他の車両の情報を取得しなかった場合、前記走行制御手段は、前記車両の左側方と右側方の両方に移動が可能であれば、左側方に移動するよう、前記車両の縦方向と横方向の少なくともいずれかについての走行を制御することを特徴とする(S228)。そのような構成により、原則、自車両を左側へオフセット移動させることができる。 In addition, when the second acquisition means does not acquire the information of the other vehicle, the travel control means moves to the left side if it can move to both the left side and the right side of the vehicle. To control the traveling of at least one of the longitudinal direction and the lateral direction of the vehicle (S228). With such a configuration, in principle, the host vehicle can be offset to the left.
また、前記車両が特定シーンに位置しているか否かを判断するシーン判断手段と、前記第1の取得手段により前記車両の周辺の緊急車両の情報を取得したときに、前記シーン判断手段により前記車両が特定シーンに位置していると判断された場合、前記特定シーンを通過して前記回避動作を行うよう前記車両の走行を制御する第2の走行制御手段と(図10)、をさらに備えることを特徴とする。また、前記特定シーンは、交差点、横断歩道、踏切、狭道、駐停止禁止区間の少なくともいずれかを含むことを特徴とする(図10)。そのような構成により、例えば、緊急車両の接近時に自車両が交差点内に位置している場合には、交差点を通過させることができる。 In addition, the scene determination means determines whether or not the vehicle is located in a specific scene, and the scene determination means acquires information of an emergency vehicle around the vehicle by the first acquisition means. A second travel control means (FIG. 10) for controlling the travel of the vehicle to pass the specific scene and perform the avoidance operation when it is determined that the vehicle is located in the specific scene It is characterized by Further, the specific scene is characterized in that it includes at least one of an intersection, a pedestrian crossing, a level crossing, a narrow road, and a parking suspension prohibited section (FIG. 10). With such a configuration, for example, when the own vehicle is located in an intersection when an emergency vehicle approaches, the intersection can be passed.
また、前記走行制御装置は、前記車両に構成されていることを特徴とする(図4)。そのような構成により、本実施形態におけるオフセット走行を実現する走行制御装置を車両に構成することができる。 Further, the travel control device is characterized in that the vehicle is configured (FIG. 4). With such a configuration, the travel control device for realizing the offset travel in the present embodiment can be configured in the vehicle.
1A、1B 制御装置: 2A、2B ECU群: 20A 自動運転ECU: 21A 環境認識ECU: 22A、22B 操舵ECU: 23A、23B 制動ECU: 24A、24B 停止維持ECU: 25A 情報ECU: 26A ライトECU: 27A 駆動ECU: 28A 位置認識ECU: 29A、21B 走行支援ECU: 25B 計器類表示ECU 1A, 1B Control device: 2A, 2B ECU group: 20A Automatic operation ECU: 21A Environment recognition ECU: 22A, 22B Steering ECU: 23A, 23B Braking ECU: 24A, 24B Stop keeping ECU: 25A Information ECU: 26A Light ECU: 27A Drive ECU: 28A Position recognition ECU: 29A, 21B Driving support ECU: 25B Instrument display ECU
Claims (14)
緊急車両の情報を取得する第1の取得手段と、
前記第1の取得手段により前記車両の周辺の緊急車両の情報を取得した場合に、前記車両に先行する第1の車両もしくは前記車両に後続する第2の車両の挙動が、前記緊急車両の走行を妨げないための回避動作であれば、当該回避動作を行っている前記第1の車両もしくは前記第2の車両のいずれか一方に追従するよう前記車両の縦方向と横方向の少なくともいずれかについての走行を制御する走行制御手段と、
を備えることを特徴とする走行制御装置。 A travel control device for controlling the travel of a vehicle, wherein
First acquiring means for acquiring information of an emergency vehicle;
The behavior of the first vehicle preceding the vehicle or the behavior of the second vehicle following the vehicle when the information of the emergency vehicle in the vicinity of the vehicle is acquired by the first acquisition means is the travel of the emergency vehicle In the longitudinal direction and / or the lateral direction of the vehicle so as to follow either one of the first vehicle or the second vehicle performing the avoidance operation. Travel control means for controlling the travel of the vehicle;
A travel control device comprising:
前記第1の判断手段により前記第1の車両もしくは前記第2の車両のいずれか一方への追従を行うと判断された場合、前記走行制御手段は、前記第1の車両もしくは前記第2の車両のいずれか一方に追従するよう前記車両の縦方向と横方向の少なくともいずれかについての走行を制御する、
ことを特徴とする請求項1乃至3のいずれか1項に記載の走行制御装置。 It is determined whether or not to follow either the first vehicle or the second vehicle based on the behavior of the first vehicle or the second vehicle to be followed. Judgment means,
When it is determined that the first determination means follows one of the first vehicle and the second vehicle, the travel control means determines whether the first vehicle or the second vehicle is used. Controlling traveling of the vehicle in the longitudinal direction and / or the lateral direction so as to follow one of the two.
The travel control device according to any one of claims 1 to 3, characterized in that:
ことを特徴とする請求項4に記載の走行制御装置。 When it is determined that the first determination means does not follow any one of the first vehicle and the second vehicle, the travel control means determines that the first vehicle to be followed or the following vehicle is to be followed. Controlling traveling of at least one of the longitudinal direction and the lateral direction of the vehicle so as to perform the avoidance operation regardless of the behavior of the second vehicle;
The travel control device according to claim 4, characterized in that:
前記第2の判断手段により前記回避動作が可能であると判断された場合、前記走行制御手段は、前記回避動作のための走行制御を行い、
前記第2の判断手段により前記回避動作が可能でないと判断された場合、前記走行制御手段は、前記走行制御を中止して手動運転へ切り替える、
ことを特徴とする請求項1乃至5のいずれか1項に記載の走行制御装置。 The apparatus further comprises a second determination unit that determines whether the avoidance operation is possible or not.
When it is determined by the second determination unit that the avoidance operation is possible, the traveling control unit performs traveling control for the avoidance operation,
When it is determined by the second determination unit that the avoidance operation is not possible, the traveling control unit cancels the traveling control and switches to the manual operation.
The travel control device according to any one of claims 1 to 5, characterized in that:
前記第2の取得手段により取得された前記他の車両の情報に基づいて、前記他の車両の挙動が前記回避動作であるか否かを判断する第3の判断手段と、
をさらに備えることを特徴とする請求項1乃至6のいずれか1項に記載の走行制御装置。 Second acquisition means for acquiring information of another vehicle,
Third determination means for determining whether the behavior of the other vehicle is the avoidance operation based on the information of the other vehicle acquired by the second acquisition device;
The travel control device according to any one of claims 1 to 6, further comprising:
前記第3の判断手段は、前記第2の取得手段により取得された前記他のレーンの車両の情報に基づいて、前記他のレーンの車両の挙動が前記回避動作であるか否かを判断し、
前記他のレーンの車両の挙動が前記回避動作であれば、前記走行制御手段は、前記他のレーンの車両から離間する方向に移動するよう、前記車両の縦方向と横方向の少なくともいずれかについての走行を制御することを特徴とする請求項7に記載の走行制御装置。 The second acquisition means acquires information of a vehicle on another lane different from the lane on which the vehicle travels, when the information on the first vehicle and the second vehicle can not be acquired or not acquired. If
The third determination means determines whether or not the behavior of the vehicle in the other lane is the avoidance operation based on the information of the vehicle in the other lane acquired by the second acquisition means. ,
If the behavior of the vehicle in the other lane is the avoidance operation, the travel control means moves in a direction away from the vehicle in the other lane, in at least one of the longitudinal direction and the lateral direction of the vehicle. The travel control device according to claim 7, which controls the travel of the vehicle.
前記第1の取得手段により前記車両の周辺の緊急車両の情報を取得したときに、前記シーン判断手段により前記車両が特定シーンに位置していると判断された場合、前記特定シーンを通過して前記回避動作を行うよう前記車両の走行を制御する第2の走行制御手段と、
をさらに備えることを特徴とする請求項1乃至9のいずれか1項に記載の走行制御装置。 A scene determination unit that determines whether the vehicle is located in a specific scene;
When it is determined by the scene determination unit that the vehicle is positioned in a specific scene when the first acquisition unit acquires information on an emergency vehicle around the vehicle, the specific scene is passed. Second travel control means for controlling the travel of the vehicle to perform the avoidance operation;
The travel control device according to any one of claims 1 to 9, further comprising:
緊急車両の情報を取得する取得工程と、
前記取得工程において前記車両の周辺の緊急車両の情報を取得した場合に、前記車両に先行する第1の車両もしくは前記車両に後続する第2の車両の挙動が、前記緊急車両の走行を妨げないための回避動作であれば、当該回避動作を行っている前記第1の車両もしくは前記第2の車両のいずれか一方に追従するよう前記車両の縦方向と横方向の少なくともいずれかについての走行を制御する走行制御工程と、
を有することを特徴とする走行制御方法。 A travel control method executed in a travel control device for controlling the travel of a vehicle, comprising:
An acquisition process for acquiring emergency vehicle information;
When the information on the emergency vehicle around the vehicle is acquired in the acquisition step, the behavior of the first vehicle preceding the vehicle or the behavior of the second vehicle following the vehicle does not disturb the traveling of the emergency vehicle In the case of the avoidance operation for traveling the vehicle in at least one of the longitudinal direction and the lateral direction so as to follow one of the first vehicle and the second vehicle performing the avoidance operation. Traveling control process to control;
A travel control method comprising:
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2017170386A JP6636484B2 (en) | 2017-09-05 | 2017-09-05 | Travel control device, travel control method, and program |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2017170386A JP6636484B2 (en) | 2017-09-05 | 2017-09-05 | Travel control device, travel control method, and program |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2019043431A true JP2019043431A (en) | 2019-03-22 |
| JP6636484B2 JP6636484B2 (en) | 2020-01-29 |
Family
ID=65815238
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2017170386A Expired - Fee Related JP6636484B2 (en) | 2017-09-05 | 2017-09-05 | Travel control device, travel control method, and program |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP6636484B2 (en) |
Cited By (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20200135588A (en) * | 2019-05-22 | 2020-12-03 | 현대자동차주식회사 | Vehicle and control method thereof |
| JP2021011188A (en) * | 2019-07-05 | 2021-02-04 | 本田技研工業株式会社 | Vehicle control systems, vehicle control methods, and programs |
| JP2021125004A (en) * | 2020-02-06 | 2021-08-30 | 本田技研工業株式会社 | Emergency vehicle estimation device and emergency vehicle estimation method |
| JP2021128398A (en) * | 2020-02-12 | 2021-09-02 | 本田技研工業株式会社 | Device and method for controlling emergency vehicle refuge |
| JP2024060820A (en) * | 2022-10-20 | 2024-05-07 | トヨタ自動車株式会社 | Vehicle control device, vehicle control computer program, and vehicle control method |
| JP2024155212A (en) * | 2023-04-21 | 2024-10-31 | 三菱電機株式会社 | Vehicle control device and vehicle control method |
| WO2025211163A1 (en) * | 2024-04-04 | 2025-10-09 | 株式会社デンソー | Autonomous driving control device and autonomous driving control method |
| WO2025258274A1 (en) * | 2024-06-13 | 2025-12-18 | 株式会社デンソー | Automatic driving control device and automatic driving control method |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2004220348A (en) * | 2003-01-15 | 2004-08-05 | Nissan Motor Co Ltd | Vehicle running state detecting device and vehicle running control device |
| JP2005001643A (en) * | 2003-04-14 | 2005-01-06 | Fujitsu Ten Ltd | Operation support device |
| JP2010237792A (en) * | 2009-03-30 | 2010-10-21 | Aisin Aw Co Ltd | Driving assist device, driving assist method, and driving assist program |
| JP2014043156A (en) * | 2012-08-27 | 2014-03-13 | Nissan Motor Co Ltd | Vehicle travel control device and method |
| WO2016067336A1 (en) * | 2014-10-27 | 2016-05-06 | 日産自動車株式会社 | Travel control information data structure and travel control device |
| US20160252905A1 (en) * | 2014-08-28 | 2016-09-01 | Google Inc. | Real-time active emergency vehicle detection |
-
2017
- 2017-09-05 JP JP2017170386A patent/JP6636484B2/en not_active Expired - Fee Related
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2004220348A (en) * | 2003-01-15 | 2004-08-05 | Nissan Motor Co Ltd | Vehicle running state detecting device and vehicle running control device |
| JP2005001643A (en) * | 2003-04-14 | 2005-01-06 | Fujitsu Ten Ltd | Operation support device |
| JP2010237792A (en) * | 2009-03-30 | 2010-10-21 | Aisin Aw Co Ltd | Driving assist device, driving assist method, and driving assist program |
| JP2014043156A (en) * | 2012-08-27 | 2014-03-13 | Nissan Motor Co Ltd | Vehicle travel control device and method |
| US20160252905A1 (en) * | 2014-08-28 | 2016-09-01 | Google Inc. | Real-time active emergency vehicle detection |
| WO2016067336A1 (en) * | 2014-10-27 | 2016-05-06 | 日産自動車株式会社 | Travel control information data structure and travel control device |
Cited By (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20200135588A (en) * | 2019-05-22 | 2020-12-03 | 현대자동차주식회사 | Vehicle and control method thereof |
| KR102689880B1 (en) * | 2019-05-22 | 2024-08-01 | 현대자동차주식회사 | Vehicle and control method thereof |
| JP2021011188A (en) * | 2019-07-05 | 2021-02-04 | 本田技研工業株式会社 | Vehicle control systems, vehicle control methods, and programs |
| JP2021125004A (en) * | 2020-02-06 | 2021-08-30 | 本田技研工業株式会社 | Emergency vehicle estimation device and emergency vehicle estimation method |
| JP2021128398A (en) * | 2020-02-12 | 2021-09-02 | 本田技研工業株式会社 | Device and method for controlling emergency vehicle refuge |
| JP7408429B2 (en) | 2020-02-12 | 2024-01-05 | 本田技研工業株式会社 | Emergency vehicle evacuation control device and emergency vehicle evacuation control method |
| JP2024060820A (en) * | 2022-10-20 | 2024-05-07 | トヨタ自動車株式会社 | Vehicle control device, vehicle control computer program, and vehicle control method |
| JP2024155212A (en) * | 2023-04-21 | 2024-10-31 | 三菱電機株式会社 | Vehicle control device and vehicle control method |
| JP7781100B2 (en) | 2023-04-21 | 2025-12-05 | 三菱電機株式会社 | Vehicle control device and vehicle control method |
| WO2025211163A1 (en) * | 2024-04-04 | 2025-10-09 | 株式会社デンソー | Autonomous driving control device and autonomous driving control method |
| WO2025258274A1 (en) * | 2024-06-13 | 2025-12-18 | 株式会社デンソー | Automatic driving control device and automatic driving control method |
Also Published As
| Publication number | Publication date |
|---|---|
| JP6636484B2 (en) | 2020-01-29 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP7425174B2 (en) | Vehicle control system and control method | |
| JP7205154B2 (en) | Display device | |
| EP3568335B1 (en) | Preparing autonomous vehicles for turns | |
| JP6636484B2 (en) | Travel control device, travel control method, and program | |
| US9963149B2 (en) | Vehicle control device | |
| JP6677822B2 (en) | Vehicle control device | |
| US20190283757A1 (en) | Vehicle control apparatus, vehicle, vehicle control method, and storage medium | |
| JP6729220B2 (en) | Vehicle driving support device | |
| CN110281920B (en) | Vehicle control device, vehicle control method, and storage medium | |
| EP3720750B1 (en) | Method and system for maneuvering a vehicle | |
| JP7048353B2 (en) | Driving control device, driving control method and program | |
| JP6951440B2 (en) | Driving control system and vehicle control method | |
| JP2023100652A (en) | Controlling vehicle through multi-lane turn | |
| CN110036426B (en) | Control device and control method | |
| JP6889274B2 (en) | Driving model generation system, vehicle in driving model generation system, processing method and program | |
| US20130311043A1 (en) | Vehicle control apparatus | |
| JP2017165296A (en) | Automatic operation control system | |
| JP2021018744A (en) | Image display device | |
| JP2020055526A (en) | Automatic driving control system | |
| CN109501798B (en) | Travel control device and travel control method | |
| JP2016124479A (en) | Vehicle travel control device | |
| JP2016212630A (en) | Travel control device | |
| JP6632581B2 (en) | Travel control device, travel control method, and program | |
| CN112180911A (en) | Method for monitoring a control system of an autonomous vehicle | |
| JPWO2019167231A1 (en) | Driving control device, driving control method and program |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20180529 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20190510 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20190628 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20190712 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20190906 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20190920 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20191113 |
|
| 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: 20191125 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20191218 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 6636484 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| LAPS | Cancellation because of no payment of annual fees |