JP6579119B2 - 車両制御装置 - Google Patents

車両制御装置 Download PDF

Info

Publication number
JP6579119B2
JP6579119B2 JP2017010529A JP2017010529A JP6579119B2 JP 6579119 B2 JP6579119 B2 JP 6579119B2 JP 2017010529 A JP2017010529 A JP 2017010529A JP 2017010529 A JP2017010529 A JP 2017010529A JP 6579119 B2 JP6579119 B2 JP 6579119B2
Authority
JP
Japan
Prior art keywords
vehicle
target
route
arrival position
latent
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.)
Active
Application number
JP2017010529A
Other languages
English (en)
Other versions
JP2018118589A (ja
Inventor
佐藤 国仁
国仁 佐藤
市川 健太郎
健太郎 市川
麻衣子 平野
麻衣子 平野
文洋 奥村
文洋 奥村
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Motor Corp
Original Assignee
Toyota Motor Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Toyota Motor Corp filed Critical Toyota Motor Corp
Priority to JP2017010529A priority Critical patent/JP6579119B2/ja
Priority to US15/870,160 priority patent/US10261516B2/en
Priority to DE102018100668.3A priority patent/DE102018100668A1/de
Priority to CN201810065548.2A priority patent/CN108340915B/zh
Publication of JP2018118589A publication Critical patent/JP2018118589A/ja
Application granted granted Critical
Publication of JP6579119B2 publication Critical patent/JP6579119B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/10Path keeping
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/10Path keeping
    • B60W30/12Lane keeping
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18145Cornering
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18163Lane change; Overtaking manoeuvres
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/36Input/output arrangements for on-board computers
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2552/00Input parameters relating to infrastructure
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/30Road curve radius
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2556/00Input parameters relating to data
    • B60W2556/45External transmission of data to or from the vehicle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2556/00Input parameters relating to data
    • B60W2556/45External transmission of data to or from the vehicle
    • B60W2556/50External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Traffic Control Systems (AREA)
  • Navigation (AREA)

Description

本開示は、車両制御装置に関する。
特許文献1には、車両の走行予定の経路を生成する装置が開示されている。この装置は、レーン境界線などの地図情報に基づいて、レーン内に車両が走行可能な複数の潜在経路を予め算出する。そして、この装置は、センサ情報などに基づいて、複数の経路の中から車両が障害物と距離を保つことができる潜在経路を選択する。そして、この装置は、車両が現在経路から選択された潜在経路へ滑らかに遷移して走行するような目標経路を生成する。
米国特許出願公開第2015/0197246号明細書
特許文献1は、現在経路から潜在経路へ車両が滑らかに遷移するための経路の生成方法を開示していない。現在経路から潜在経路への経路は、例えば、現在経路から潜在経路に到達するまでの事前に決定された目標時間(又は目標距離)を用いて生成することができる。
しかしながら、目標時間(又は目標距離)が一定の場合、道路形状に沿わない経路が生成されたり、信頼性の低い経路が生成されたりするおそれがある。例えば、車両の前方の道路がカーブの場合、直線道路と同様の目標時間(又は目標距離)を用いると、カーブ付近で操舵が開始される経路となる場合がある。また、車両の周囲の道路環境が複雑なほど(分岐の存在、レーンの増減、脇道からの合流がある場合、又は、車両の周囲に複数の他車両が存在する場合)、予測すべき事象が多くなることから経路演算の信頼性が低下しやすい。
このため、本技術分野では、車両の前方の地図情報又は外部状況に応じて、地図情報に基づいた潜在経路へ到達するまでの経路を短く生成することが望まれている。
本開示の一形態は、目標経路に基づいて車両を制御する車両制御装置であって、地図情報を記憶する地図データベースと、車両位置を認識する車両位置認識部と、車両の外部状況を認識する外部状況認識部と、車両の走行状態を認識する走行状態認識部と、地図情報、車両位置、外部状況、及び、走行状態に基づいて、目標経路を生成する走行計画生成部と、目標経路に基づいて車両を走行させる走行制御部と、を備え、走行計画生成部は、地図情報に基づいた潜在経路を決定する潜在経路決定部と、車両が車両位置から潜在経路上に到達するまでの予め定められた目標時間又は目標距離と、車両位置と、走行状態と、に基づいて、目標時間又は目標距離で車両が車両位置から潜在経路上に到達する位置である基準到達位置を算出する位置算出部と、基準到達位置における地図情報又は外部状況に応じて、目標時間よりも短い時間又は目標距離よりも短い距離で車両が潜在経路上に到達する位置を目標到達位置として決定する到達位置決定部と、車両位置から目標到達位置までの遷移経路を算出する経路算出部と、遷移経路と到達位置以降の潜在経路とを繋ぎ合わせて目標経路を生成する経路生成部と、を有する。
この車両制御装置では、地図情報に基づいた潜在経路へ遷移する際に、予め定められた目標時間(又は目標距離)を用いて車両が潜在経路上に到達する位置である基準到達位置が算出される。そして、基準到達位置における地図情報又は外部状況に応じて、目標時間よりも短い時間(又は目標距離よりも短い距離)で車両が潜在経路上に到達する位置が目標到達位置として決定される。このように、この装置は、地図情報又は外部状況に応じて基準到達位置よりも車両側に目標到達位置を設定することができる。よって、この装置は、車両の前方の地図情報又は外部状況に応じて、地図情報に基づいた潜在経路へ到達するまでの遷移経路を短く生成することができる。
一実施形態においては、走行計画生成部は、目標経路を所定周期ごとに生成し、遷移経路は、車両位置から前回生成された目標経路の所定地点までの前半部分と、所定地点から目標到達位置までの後半部分とを含み、経路算出部は、後半部分を算出してもよい。このように、走行計画生成部は、遷移経路の前半部分を前回の目標経路で固定することで車両操舵制御の追従性の低下を抑制することができる。
一実施形態においては、到達位置決定部は、基準到達位置の道路曲率が所定値以下の場合には、基準到達位置を目標到達位置として決定し、基準到達位置の道路曲率が所定値より大きい場合には、目標時間よりも短い時間又は目標距離よりも短い距離で車両が潜在経路上に到達する位置を目標到達位置として決定してもよい。この場合、この車両制御装置は、道路曲率が所定値以下の直線道路などにおいては基準到達位置で潜在経路に車両を到達させ、道路曲率が所定値より大きいカーブなどにおいては基準到達位置よりも手前の位置で潜在経路に車両を到達させることができる。このように、この装置は、地図情報(道路形状)に応じて、地図情報に基づいた潜在経路へ到達するまでの遷移経路を短く生成することができる。
一実施形態においては、到達位置決定部は、道路曲率が所定値以下となる潜在経路上における位置を目標到達位置として決定してもよい。これにより、この装置は、直線道路に近い箇所で潜在経路に車両を到達させることができる。
一実施形態にといては、到達位置決定部は、基準到達位置の周囲に存在する他車両の台数が所定台数以下の場合には、基準到達位置を目標到達位置として決定し、基準到達位置の周囲に存在する他車両の台数が所定台数より大きい場合には、目標時間よりも短い時間又は目標距離よりも短い距離で車両が潜在経路上に到達する位置を目標到達位置として決定してもよい。この場合、この車両制御装置は、他車両の台数が少ない場合などにおいては基準到達位置で潜在経路に車両を到達させ、他車両の台数が多い場合などにおいては基準到達位置よりも手前の位置で潜在経路に車両を到達させることができる。このように、この装置は、外部状況に応じて、地図情報に基づいた潜在経路へ到達するまでの遷移経路を短く生成することができる。
一実施形態にといては、到達位置決定部は、走行中の道路が自動車専用道路の場合には、基準到達位置を目標到達位置として決定し、走行中の道路が一般道路の場合には、目標時間よりも短い時間又は目標距離よりも短い距離で車両が潜在経路上に到達する位置を目標到達位置として決定してもよい。この場合、この車両制御装置は、自動車専用道路を走行中の場合においては基準到達位置で潜在経路に車両を到達させ、一般道路を走行中の場合においては基準到達位置よりも手前の位置で潜在経路に車両を到達させることができる。このように、この装置は、地図情報(道路種別)に応じて、地図情報に基づいた潜在経路へ到達するまでの遷移経路を短く生成することができる。
本開示の一側面又は実施形態によれば、車両の前方の地図情報又は外部状況に応じて、地図情報に基づいた潜在経路へ到達するまでの経路を短く生成することができる。
図1は、第一実施形態に係る車両制御装置を備える車両の構成を示すブロック図である。 図2は、走行計画生成部による目標経路の算出処理の一例を説明する図である。 図3は、遷移経路を説明する図である。 図4は、到達位置の一例を説明する図である。 図5は、到達位置の他の例を説明する図である。 図6は、カーブにおける到達位置を説明する図である。 図7は、走行計画生成部の構成を示すブロック図である。 図8は、道路形状に応じた目標到達位置の探索処理を説明する図である。 図9は、第一実施形態に係る車両制御処理の一例を説明するフローチャートである。 図10は、第二実施形態に係る車両制御処理の一例を説明するフローチャートである。 図11は、第三実施形態に係る車両制御処理の一例を説明するフローチャートである。
以下、図面を参照して、本発明の実施形態について説明する。なお、以下の説明において、同一又は相当要素には同一符号を付し、重複する説明は繰り返さない。
[第一実施形態]
図1は、第一実施形態に係る車両制御装置1を備える車両2の構成を示すブロック図である。図1に示されるように、乗用車などの車両2には、車両システム100が搭載されている。車両システム100は、車両2を自動運転で走行させるシステムである。自動運転とは、運転者が運転操作をすることなく、予め設定された目的地に向かって自動で車両2を走行させる車両制御である。車両システム100は、後述のとおり、目標経路に基づいて車両2の走行を制御する車両制御装置1を備えている。
車両システム100は、外部センサ3、GPS(Global Positioning System)受信部4、内部センサ5、地図データベース6、ナビゲーションシステム7、アクチュエータ8、HMI(Human Machine Interface)9、及び、ECU(Electronic Control Unit)10を備えている。
外部センサ3は、車両2の周辺の状況(外部状況)を検出する検出機器である。外部センサ3は、カメラ及びレーダセンサのうち少なくとも一つを含む。
カメラは、車両の外部状況を撮像する撮像機器である。カメラは、車両のフロントガラスの裏側に設けられている。カメラは、車両の外部状況に関する撮像情報をECU10へ送信する。カメラは、単眼カメラであってもよく、ステレオカメラであってもよい。ステレオカメラは、両眼視差を再現するように配置された二つの撮像部を有している。ステレオカメラの撮像情報には、奥行き方向の情報も含まれている。
レーダセンサは、電波(例えばミリ波)又は光を利用して車両2の周辺の障害物を検出する検出機器である。レーダセンサには、例えば、ミリ波レーダ又はライダー(LIDAR:Laser Imaging Detection and Ranging)が含まれる。レーダセンサは、電波又は光を車両2の周辺に送信し、障害物で反射された電波又は光を受信することで障害物を検出する。レーダセンサは、検出した障害物情報をECU10へ送信する。障害物には、ガードレール、建物等の固定障害物の他、歩行者、自転車、他車両等の移動障害物が含まれる。
GPS受信部4は、3個以上のGPS衛星から信号を受信して、車両2の位置を示す位置情報を取得する。位置情報には、例えば緯度及び経度が含まれる。GPS受信部4は、測定した車両2の位置情報をECU10へ出力する。なお、GPS受信部4に代えて、車両2が存在する緯度及び経度が特定できる他の手段を用いてもよい。
内部センサ5は、車両2の走行状態を検出する検出機器である。内部センサ5は、車速センサを少なくとも含む。車速センサは、車両2の速度を検出する検出機器である。車速センサとしては、車両2の車輪又は車輪と一体に回転するドライブシャフト等に対して設けられ、車輪の回転速度を検出する車輪速センサが用いられる。車速センサは、検出した車速情報をECU10に送信する。なお、内部センサ5は、加速度センサ又はヨーレートセンサを含んでもよい。
加速度センサは、車両2の加速度を検出する検出機器である。加速度センサは、車両2の前後方向の加速度を検出する前後加速度センサと、車両2の横加速度を検出する横加速度センサとを含んでいる。加速度センサは、車両2の加速度情報をECU10に送信する。ヨーレートセンサは、車両2の重心の鉛直軸周りのヨーレート(回転角速度)を検出する検出機器である。ヨーレートセンサとしては、例えばジャイロセンサを用いることができる。ヨーレートセンサは、検出した車両2のヨーレート情報をECU10へ送信する。
地図データベース6は、地図情報を記憶するデータベースである。地図データベース6は、車両2に搭載されたHDD(Hard Disk Drive)内に形成されている。地図情報には、道路の位置情報、レーン情報、道路種別情報、道路形状の情報、交差点及び分岐点の位置情報、及び建物の位置情報等が含まれる。道路種別情報は、自動車専用道路、一般道路などの道路の種類を区別する情報である。道路形状の情報は、例えばカーブ部、直線部などの種別情報や、道路曲率などである。なお、地図データベース6は、車両2と通信可能な情報処理センター等の施設のコンピュータに記憶されていてもよい。
ナビゲーションシステム7は、予め設定された目的地まで車両2の運転者の案内を行うシステムである。ナビゲーションシステム7は、GPS受信部4の測定した車両2の位置と地図データベース6の地図情報とに基づいて、車両2の走行する走行道路及び走行レーンを認識する。ナビゲーションシステム7は、車両2の位置から目的地に至るまでの目標ルートを演算し、HMI9を用いて運転者に対して当該目標ルートの案内を行う。ナビゲーションシステム7は、車両2の位置情報、車両2の走行レーンの情報、及び車両2の目標ルートをECU10に送信する。
アクチュエータ8は、車両2の走行制御を実行する装置である。アクチュエータ8は、エンジンアクチュエータ、ブレーキアクチュエータ、及び操舵アクチュエータを少なくとも含む。エンジンアクチュエータは、ECU10からの制御信号に応じてエンジンに対する空気の供給量を変更(例えばスロットル開度を変更)することで、車両2の駆動力を制御する。なお、エンジンアクチュエータは、車両2がハイブリッド車又は電気自動車である場合には、動力源としてのモータの駆動力を制御する。
ブレーキアクチュエータは、ECU10からの制御信号に応じてブレーキシステムを制御し、車両2の車輪へ付与する制動力を制御する。ブレーキシステムとしては、例えば、液圧ブレーキシステムを用いることができる。なお、ブレーキアクチュエータは、車両2が回生ブレーキシステムを備えている場合、液圧ブレーキシステム及び回生ブレーキシステムの両方を制御してもよい。操舵アクチュエータは、電動パワーステアリングシステムのうち操舵トルクを制御するアシストモータの駆動を、ECU10からの制御信号に応じて制御する。これにより、操舵アクチュエータは、車両2の操舵トルクを制御する。
HMI9は、車両2の乗員(運転者を含む)と車両システム100との間で情報の出力及び入力をするためのインターフェイスである。HMI9は、例えば、乗員に画像情報を表示するためのディスプレイパネル、音声出力のためのスピーカ、及び乗員が入力操作を行うための操作ボタン又はタッチパネルなどを備えている。HMI9は、乗員により入力された情報をECU10へ送信する。また、HMI9は、ECU10からの制御信号に応じた画像情報をディスプレイに表示する。
ECU10は、車両2を制御する。ECU10は、CPU(Central Processing Unit)、ROM(Read Only Memory)、RAM(Random Access Memory)、CAN(Controller Area Network)通信回路などを有する電子制御ユニットである。ECU10は、例えばCAN通信回路を用いて通信するネットワークに接続され、上述した車両2の構成要素と通信可能に接続されている。ECU10は、例えば、CPUが出力する信号に基づいて、CAN通信回路を動作させてデータを入出力し、入力データをRAMに記憶し、ROMに記憶されているプログラムをRAMにロードし、RAMにロードされたプログラムを実行することで、後述するECU10の構成要素の機能を実現する。なお、ECU10は、複数の電子制御ユニットから構成されていてもよい。
ECU10は、車両位置認識部11、外部状況認識部12、走行状態認識部13、走行計画生成部14及び走行制御部15を備えている。車両制御装置1は、車両位置認識部11、外部状況認識部12、走行状態認識部13、走行計画生成部14及び走行制御部15を備えて構成される。
車両位置認識部11は、GPS受信部4で受信した車両2の位置情報、及び地図データベース6の地図情報に基づいて、地図上における車両2の位置(以下、「車両位置」という)を認識する。なお、車両位置認識部11は、ナビゲーションシステム7で用いられる車両位置を該ナビゲーションシステム7から取得して認識してもよい。車両位置認識部11は、道路などの外部に設置されたセンサで車両2の車両位置が測定され得る場合、このセンサから通信によって車両位置を取得してもよい。
外部状況認識部12は、外部センサ3の検出結果に基づいて、車両2の外部状況を認識する。検出結果には、例えばカメラの撮像情報、レーダセンサの検知物体情報などが含まれる。外部状況とは、車両2を取り巻く環境である。外部状況は、一例として車両2の周辺の物体の状況である。物体には、他車両や障害物などが含まれる。物体の状況は、例えば、固定物と移動物を区別する情報、車両2に対する物体の位置、車両2に対する物体の移動方向、車両2に対する物体の相対速度などを含んでもよい。外部状況は、一例として認識された道路環境を含んでもよい。道路環境は、車両2に対する走行レーンのレーン境界線の位置もしくはレーン中心の位置及び道路幅、道路の形状を含んでもよい。道路の形状は、例えば走行レーンの曲率、外部センサ3の見通し推定に有効な路面の勾配変化、うねりなどであってもよい。
走行状態認識部13は、内部センサ5の検出結果に基づいて、車両2の走行状態を認識する。内部センサ5の検出結果には、例えば車速センサの車速情報が含まれる。内部センサ5の検出結果には、加速度センサの加速度情報、ヨーレートセンサのヨーレート情報などが含まれてもよい。走行状態とは、車両2の運動の様子である。走行状態は、車速などを用いて表現され得る。
走行計画生成部14は、ナビゲーションシステム7により設定された目標ルート及び地図データベース6の地図情報に基づいて、車両2の走行計画を生成する。走行計画生成部14は、運転者が自動運転制御の開始操作を行った場合に、走行計画の生成を開始する。この走行計画は、車両2の現在の位置から予め設定された目的地に車両2が至るまでの長期走行計画となる。
走行計画には、車両2の目標ルート上の位置に応じた車両2の制御目標値が含まれている。目標ルート上の位置とは、地図上で目標ルートの延在方向における位置である。目標ルート上の位置は、目標ルートの延在方向において所定間隔(例えば1m)毎に設定された設定縦位置を意味する。制御目標値とは、走行計画において車両2の制御目標となる値である。制御目標値は、目標ルート上の設定縦位置毎に関連付けて設定される。走行計画生成部14は、目標ルート上に所定間隔の設定縦位置を設定すると共に、設定縦位置毎に制御目標値を設定することで、走行計画を生成する。設定縦位置及び目標横位置は、合わせて一つの位置座標として設定されてもよい。設定縦位置及び目標横位置は、走行計画において目標として設定される縦位置の情報及び横位置の情報を意味する。
また、走行計画生成部14は、地図情報に依存した長期走行計画とは別に、実際の道路環境に対応した短期走行計画を生成する。短期走行計画は、外部センサ3の検出範囲(例えば車両2の前方150m以内の範囲)を車両2が走行する計画として生成される。
短期走行計画は、走行計画と同様に、目標ルート上の設定縦位置に応じた短期制御目標値を有する。短期制御目標値とは、短期走行計画において車両2の制御目標となる値である。短期制御目標値は、目標ルート上の設定縦位置毎に関連付けて設定される。短期制御目標値には、車両2の短期目標横位置及び車両2の短期目標車速が含まれる。短期目標横位置とは、短期走行計画において制御目標となる車両2の横位置である。短期目標車速とは、短期走行計画において制御目標となる車両2の車速である。
走行計画生成部14は、外部状況認識部12により認識された車両2の外部状況と、走行状態認識部13により認識された車両2の走行状態と、車両位置認識部11により認識された車両2の位置と、走行計画(地図情報に基づいて生成された車両2の現在位置から目的地までの走行計画)とに基づいて、短期走行計画を生成する。
走行計画生成部14は、地図情報に誤りが無い場合、長期走行計画の制御目標値を短期走行計画の短期制御目標値として採用することができる。短期走行計画の一例として、走行計画生成部14は、車両2が走行計画から外れた横位置(レーンの中央位置から外れた横位置)を走行している場合、現在の車両2の位置からレーンの中央位置に戻るように短期走行計画を生成する。このような短期走行計画の生成は、特開2009−291540号公報を参照して実現することができる。車両2が走行計画から外れた横位置を走行するシーンは、外乱の影響により制御誤差がある場合や、外部状況によって目標とする横位置が変更された場合に発生し得る。
走行制御部15は、走行計画生成部14により生成された走行計画に基づいて、アクチュエータ8へ制御信号を出力する。これにより、車両2は、走行計画に沿って自動で走行する。
以下、走行計画生成部14による短期走行計画の生成処理の一例を説明する。走行計画生成部14は、短期走行計画の一例として目標経路を所定周期ごとに生成する。これにより、車両2の前方の一定範囲(例えば外部センサ3の検出範囲)の目標経路が所定周期ごとに生成される。
所定周期は、車両2が現在位置から前回の目標経路の終端部に到達する時間よりも短く設定される。これにより、車両2の前方の一定範囲のうち車両2に近い領域については、前回目標経路を用いることができる。走行計画生成部14は、前回目標経路が存在する場合、車両2の前方の一定範囲のうち前回目標経路と重なる部分の経路の少なくとも一部を、今回の目標経路の一部とする。つまり、走行計画生成部14は、車両2の前方の一定範囲のうち、車両2に近い領域(近接領域)は前回算出された目標経路(固定部)とする。これにより、走行制御に影響を及ぼす車両2に近い領域の目標経路が維持(固定)される。よって、走行制御の追従性が向上する。
また、車両2の前方の一定範囲のうち、車両2から遠方の領域は、センサの信頼性が低下し、さらには、車両2が到達するまでの間に環境が変化するおそれがある。このため、走行計画生成部14は、車両2の前方の一定範囲のうち、固定部の終端から所定範囲のみを探索し、それ以降は地図情報に基づいて生成された経路(長期走行計画で用いる経路)に接続する。走行計画生成部14は、遠方領域の経路として地図情報に基づいて生成された経路を採用することにより、目標経路の信頼性を向上させ、かつ、経路演算コストを抑えることができる。
以下では、目標経路の固定部の詳細について説明する。図2は、走行計画生成部14による目標経路の算出処理の一例を説明する図である。図2の(A)に示されるように、走行計画生成部14は、車両2が走行するレーンのレーン境界線310,312の位置を、外部センサ3を介して取得する。そして、レーン境界線310,312をその延在方向に対してそれぞれ所定の長さで複数に分割し、レーン境界線310,312における向かい合う二点同士を繋いだ線分Lの中心点Tを複数求める。これらの複数の中心点Tを繋いで経路とする。これらの線分Lの中心点が目標通過点となり、ここで算出された目標通過点が算出目標通過点となる。なお、走行計画生成部14は、複数の経路を生成し、複数の経路の中から外部状況に応じて1つの経路を選択してもよい。
次に、走行計画生成部14は、ECU10の記憶部などに前回生成した前回目標経路が記憶されているか否かを判断する。前回走行経路が記憶されていないと判断された場合には、前回走行経路を用いずに目標経路を生成する。走行計画生成部14は、図2の(B)に示されるように、図2の(A)の経路について、予め設定された粒度で複数の目標通過点T(1)、T(2)、・・・T(N)を生成し、これらの目標通過点を繋ぐことによって経路を補間して目標経路を生成する。目標経路が生成されると、走行計画生成部14は、短期制御目標値(車両2の短期目標横位置及び車両2の短期目標車速)を算出する。また、走行計画生成部14は、各目標通過点について、車両2が通過する目標となる時刻である目標時刻を付与する。目標時刻は、目標経路および車速に基づいて算出される。
走行計画生成部14は、各目標通過点に対して目標時刻が付与されると、目標通過点を固定部に含まれる固定目標通過点を決定する。走行計画生成部14は、車両2に近い所定領域内の目標通過点を固定目標通過点とする。そして、走行計画生成部14は、固定目標通過点以外の目標通過点を探索目標通過点とする。固定目標通過点とするか探索目標通過点とするかは、先読み時間などを現在時刻に加算して得られる固定時刻よりも目標時刻が早い目標通過点を固定目標通過点とする。たとえば、図2の(C)に示すように、車両2に近い領域に含まれる記憶目標通過点T(1)、T(2)、・・・T(n)が固定目標通過点となり、T(n+1)、T(n+2)、・・・T(N)が探索目標通過点となる。
走行計画生成部14は、固定目標通過点と探索目標通過点とを設定した後、生成された目標経路が滑らかかつレーンを逸脱しないことを判定する。目標経路が滑らかかつレーンを逸脱していないと判定された場合には、走行計画生成部14は、目標経路をECU10の記憶部に記憶させる。記憶された目標経路は、次回の目標経路の生成時に用いられる。一方、走行計画生成部14は、目標経路が滑らかでない場合、又は、レーンを逸脱すると判定された場合には、車両停止用の走行進路を生成する。
走行計画生成部14は、ECU10の記憶部に前回目標経路が記憶されている場合、前回目標経路における記憶目標通過点のうち、目標時刻が過去となっている記憶目標通過点を削除する。続いて、走行計画生成部14は、前回目標経路に含まれる記憶目標通過点の中から、探索目標通過点を抽出する。その後、走行計画生成部14は、前回目標経路に含まれる探索目標通過点を固定目標通過点とし、固定目標通過点の終端から延びる経路を探索で生成する。
次に、地図情報に基づいて生成された経路への接続について説明する。なお、以下では、地図情報に基づいて生成された経路を潜在経路という。一般的に、車両2が直線道路を走行し、かつ障害物及び外乱が車両2の周囲に存在しない場合、探索結果に基づく経路と潜在経路とは一致する。しかしながら、障害物が存在する場合などは、探索結果に基づく経路において、目標横位置が変更されることがある。あるいは、外乱により、横位置の制御誤差が生じることもある。さらには、一つのレーン内に複数の潜在経路が存在し、障害物から最も距離を保つことができる潜在経路を選択する場合もある。これらの場合には、固定目標通過点の終端と潜在経路とを接続する経路が必要になる。以下では、潜在経路へ車両2を到達させるための経路を遷移経路という。
図3は、遷移経路を説明する図である。図3の(A)に示されるように、車両2は、前回目標経路MCに沿って走行しているとする。そして、前回目標経路MCとは異なる横位置に今回の目標経路で用いる潜在経路ORが存在するとする。この場合、走行計画生成部14は、図3の(B)に示されるように、前回目標経路MCにおける目標通過点のうち、車両2に近い目標通過点を固定目標通過点とし、その他の目標通過点を探索目標通過点とする。また、走行計画生成部14は、潜在経路ORにおける目標通過点のうち、固定目標通過点に最も目標時刻が近い目標通過点を探索対象外とし、前回目標経路MCにおける探索目標通過点に最も目標時刻が近い目標通過点を探索目標通過点とする。
そして、走行計画生成部14は、前回目標経路MCにおける固定目標通過点と、潜在経路ORにおける探索目標通過点とを用いて遷移経路SRを生成する。たとえば、図3の(C)に示されるように、前回目標経路MCにおける固定目標通過点を通る条件下で、潜在経路ORにおける探索目標通過点に近づく経路を生成する。車両位置C(1)から車両2が潜在経路OR上に到達する位置である探索目標通過点T(n+L)までの経路を遷移経路SRとする。以下では、探索目標通過点の終点であるT(n+L)を到達位置ともいう。つまり、遷移経路SRは、車両位置C(1)から前回生成された目標経路の所定地点C(n)までの前半部分(固定部)と、所定地点C(n)から到達位置である探索目標通過点T(n+L)までの後半部分とを含む。このように、走行計画生成部14は、遷移経路SR及び潜在経路ORを用いて、短期走行計画を生成する。
図4は、到達位置の一例を説明する図である。図4に示されるように、3つのレーン300,302,304のうち、車両2がレーン302を走行している。レーン300は、レーン境界線308,310によって区画され、レーン302は、レーン境界線310,312によって区画され、レーン304は、レーン境界線312,306によって区画されている。走行計画生成部14は、車両2が走行するレーン302内に、レーン境界線310,312の位置に基づいて、レーン302に沿って5つの潜在経路314,316,318,320,322を生成する。走行計画生成部14は、5つの潜在経路314,316,318,320,322の中から、外部状況に応じて1つの潜在経路を決定する。走行計画生成部14は、例えば、他車両502,504の位置に応じて、潜在経路316を選択する。車両2の車両位置から潜在経路316までの遷移経路と、それ以降の潜在経路316とを組み合わせることで車両2の目標経路30となる。潜在経路314上の車両位置から車両2が潜在経路316上に到達する位置20が到達位置である。
図5は、到達位置の他の例を説明する図である。図5に示される例では、走行計画生成部14により目標経路として潜在経路314が選択されている。そして、潜在経路314に沿って走行するように車両2が制御されている。そして、外乱などの制御誤差によって、車両2の横位置が潜在経路314からオフセットしている(図中の40)。この場合、車両2の車両位置から潜在経路までの遷移経路と、それ以降の潜在経路316とを組み合わせることで車両2の目標経路30となる。車両位置から車両2が潜在経路314上に到達する位置20が到達位置である。このように、対象となる潜在経路が変更された場合だけでなく、対象となる潜在経路へ追従できていない場合(制御誤差が発生している場合)にも到達位置が発生する。つまり、対象となる潜在経路と車両位置との横オフセットが発生している場合には、到達位置が発生する。
上述した到達位置は、車両2が車両位置から潜在経路上に到達するまでの予め定められた目標時間又は目標距離を用いて求めることができる。目標時間又は目標距離は、事前に決定された値であるため、一定値である。しかし、目標時間(又は目標距離)が一定の場合、道路形状に沿わない経路が生成されるおそれがある。例えば、車両2の前方の道路がカーブの場合、直線道路と同様の目標時間(又は目標距離)を用いると、カーブ付近で操舵が開始される経路となる場合がある。
図6は、カーブにおける到達位置を説明する図である。図6に示されるように、対象とする潜在経路314が車両2の前方でカーブしている。この場合において、直線道路と同一の目標時間(又は目標距離)で到達位置を設定した場合、例えば位置20Aとなる。これにより生成された目標経路30Aは、カーブ付近で操舵が開始される経路となり、カーブに沿った形状になっていない。ここで、到達位置を、位置20Aよりも車両2の手前の位置20Bへ変更することができれば、カーブに沿った目標経路30Bとすることができる。
カーブに沿った目標経路の生成を実現するために、走行計画生成部14は、地図情報に基づいて、直線道路を想定して設定された目標時間よりも短い時間で、車両位置から到達位置に到達するように到達時間を設定する。又は、走行計画生成部14は、地図情報に基づいて、直線道路を想定して設定された目標距離よりも短い距離で、車両位置から到達位置に到達するように到達時間を設定する。言い換えれば、走行計画生成部14は、地図情報に基づいて到達位置を可変とする。より具体的には、走行計画生成部14は、道路形状(道路曲率)に基づいて到達位置を、直線道路における到達位置と比べて車両2の手前側に設定する。
以下、上述した走行計画生成部14の機能を説明する。図7は、走行計画生成部14の構成を示すブロック図である。走行計画生成部14は、潜在経路決定部141、位置算出部142、到達位置決定部143、経路算出部144及び経路生成部145を備えている。
潜在経路決定部141は、車両2が走行する予定の地図情報に基づいた潜在経路を決定する。例えば、潜在経路決定部141は、地図データベース6に基づいて走行ルート上のレーン境界線を特定し、レーン境界線を用いてレーン内に複数の潜在経路を生成する。そして、潜在経路決定部141は、外部状況などに応じて複数の潜在経路の中から1つの潜在経路を決定する。なお、潜在経路決定部141は、レーン境界線を用いて潜在経路を1つだけ生成してもよい。この場合、潜在経路決定部141は、生成された1つの経路を潜在経路として決定する。
位置算出部142は、車両2が車両位置から潜在経路上に到達するまでの予め定められた目標時間又は目標距離と、車両位置と、走行状態と、に基づいて、目標時間又は目標距離で車両2が車両位置から潜在経路上に到達する位置である基準到達位置を算出する。目標時間又は目標距離は、例えば、直線道路において潜在経路へ滑らかに遷移することができる時間又は距離である。目標時間又は目標距離は、予め設定される。走行状態とは、例えば車速である。基準到達位置とは、後述するように、到達位置を車両2の手前側へ変更する際に基準となる位置である。基準到達位置は、例えば直線道路に対する目標時間又は目標距離で潜在経路に到達する位置である。基準到達位置は、遷移経路の終端であり、上述した到達位置T(n+L)である(図3参照)。図5に示される例では、車両2は、潜在経路314上に位置している。潜在経路314上の車両位置から車両2が潜在経路316上に到達する位置20が基準到達位置である。なお、基準到達位置は、車両2の走行中において所定周期で算出される。したがって、外乱などの制御誤差により、車両2が目標とする経路からオフセットした場合も基準到達位置が算出され得る(図5参照)。
到達位置決定部143は、基準到達位置における地図情報に応じて、目標時間よりも短い時間又は目標距離よりも短い距離で車両2が潜在経路上に到達する位置を目標到達位置として決定する。地図情報とは、地図データベース6に格納された道路形状を表す情報であり、一例として道路曲率である。到達位置決定部143は、到達時間を目標時間よりも短い時間とすることで、基準到達位置(位置20A)よりも車両2の手前側に目標到達位置(位置20B)を設定することができる(図6参照)。あるいは、到達位置決定部143は、到達距離を目標距離よりも短い距離とすることで、基準到達位置(位置20A)よりも車両2の手前側に目標到達位置(位置20B)を設定することができる(図6参照)。
到達位置決定部143は、基準到達位置の道路曲率が所定値以下の場合には、基準到達位置を目標到達位置として決定し、基準到達位置の道路曲率が所定値より大きい場合には、目標時間よりも短い時間又は目標距離よりも短い距離で車両が潜在経路上に到達する位置を目標到達位置として決定する。このように、到達位置決定部143は、地図データベース6を参照し、地図情報として基準到達位置の道路曲率を用いる。所定値は、道路曲率を判定するために予め設定される。所定値は、直線道路であるかカーブであるかを区別する値が設定され得る。つまり、到達位置決定部143は、直線道路の場合、基準到達位置(位置20A)を目標到達位置とし、カーブの場合、基準到達位置(位置20A)よりも車両2の手前側の位置(位置20B)を目標到達位置とする(図6参照)。
到達位置決定部143は、道路曲率が所定値以下となる潜在経路上における位置を目標到達位置として決定する。到達位置決定部143は、基準到達位置よりも車両2の手前側の範囲において、道路曲率が所定値以下となる潜在経路上における位置を探索する。所定値は、道路曲率を判定するために予め設定される。所定値は、直線道路であることを判定する値が設定され得る。なお、この所定値は、目標時間を変更する際に用いた道路曲率の所定値とは別の値を採用してもよいし、同一の値でもよい。
図8は、道路形状に応じた目標到達位置の探索処理を説明する図である。図8に示されるように、到達位置決定部143は、基準到達位置である位置20Aから車両2の手前側である潜在経路314上の位置を車両2側へ向けて探索する。到達位置決定部143は、例えば位置20Bの道路曲率が所定値以下でない場合には、微小区間だけ目標時間を短くして到達位置を演算し、到達位置における道路曲率が所定値以下となるまで演算を繰り返す。到達位置決定部143は、位置20Cの道路曲率が所定値以下である場合、位置20Cを目標到達位置とする。
経路算出部144は、車両位置から目標到達位置までの遷移経路を算出する。上述のとおり、遷移経路は、前半部分が前回目標経路を用いて固定されていてもよい。この場合、経路算出部144は、遷移経路の後半部分を算出する。経路算出部144は、目標時間と車速とを用いて周知の手法で遷移経路を生成する。図8の例では、車両2の位置から目標到達位置である位置20Cまでの経路が遷移経路となる。
経路生成部145は、遷移経路と到達位置以降の潜在経路とを繋ぎ合わせて目標経路を生成する。経路生成部145は、図8の例では、車両2の位置から目標到達位置である位置20Cまでの経路と、潜在経路314の位置20C以降の経路とを繋ぎ合わせる。これにより、経路生成部145は、目標経路30Cを生成する。
次に、車両制御装置1が行う車両制御処理について説明する。図9は、第一実施形態に係る車両制御処理の一例を説明するフローチャートである。図9に示す車両制御処理は、例えば自動運転ON/OFFスイッチに自動運転開始の要求操作が入力されたときに実行される。なお、車両位置認識部11は車両2の位置を常に認識しているものとする。
図9に示されるように、最初に、走行計画生成部14の潜在経路決定部141は、潜在経路の決定処理(S10)として、車両2が走行する予定の地図情報に基づいて、複数の潜在経路を決定する。例えば、走行計画生成部14は、車両2が走行するレーン302内に、レーン境界線310,312の位置に基づいて、レーン302に沿って5つの潜在経路314,316,318,320,322を生成する(図4参照)。決定処理(S10)の実行後は、外部状況の取得処理(S12)が実行される。
走行計画生成部14の外部状況認識部12は、外部状況の取得処理(S12)として、外部センサ3の検出結果に基づいて車両2の外部状況を認識する。なお、取得処理(S12)は、図9に示されるタイミングでの実行に限定されず、常に実行されてもよい。取得処理(S12)の実行後は、選択処理(S14)が実行される。
潜在経路決定部141は、選択処理(S14)として、潜在経路の決定処理(S10)にて決定された複数の潜在経路の中から最適な潜在経路を選択する。例えば、潜在経路決定部141は、5つの潜在経路314,316,318,320,322の中から、外部状況に応じて1つの潜在経路316を決定する(図4参照)。なお、決定処理(S10)にて1つの潜在経路のみが決定された場合、取得処理(S12)及び選択処理(S14)は実行しなくてもよい。選択処理(S14)の実行後は、基準到達位置の算出処理(S16)が実行される。
走行計画生成部14の位置算出部142は、基準到達位置の算出処理(S16)として、目標時間(又は目標距離)と、車両位置と、走行状態と、に基づいて基準到達位置を算出する(図5の位置20、図6,7の位置20Aなどを参照)。算出処理(S16)の実行後は、地図情報の取得処理(S18)が実行される。
走行計画生成部14の到達位置決定部143は、地図情報の取得処理(S18)として、地図データベース6を参照し、基準到達位置における道路曲率を取得する。取得処理(S18)の実行後は、曲率判定処理(S20)が実行される。
到達位置決定部143は、曲率判定処理(S20)として、取得処理(S18)で取得された道路曲率が所定値以下であるか否かを判定する。到達位置決定部143は、基準到達位置の道路曲率が所定値以下の場合には、目標到達位置の決定処理(S22)として、基準到達位置(位置20)を目標到達位置として決定する(図5参照)。決定処理(S22)の実行後は、経路算出処理(S24)が実行される。
走行計画生成部14の経路算出部144は、経路算出処理(S24)として、車両位置から目標到達位置までの遷移経路を算出する。例えば、経路算出部144は、車両位置C(1)から目標到達位置T(n+L)までの遷移経路SRを算出する(図3参照)。経路算出処理(S24)の実行後は、経路生成処理(S26)が実行される。
走行計画生成部14の経路生成部145は、経路生成処理(S26)として、遷移経路と到達位置以降の潜在経路とを繋ぎ合わせて目標経路を生成する。例えば、経路生成部145は、車両2の位置から目標到達位置である位置20までの経路と、潜在経路314の位置20以降の経路とを繋ぎ合わせて、目標経路30を生成する(図5参照)。経路生成処理(S26)の実行後は、車両制御処理(S28)が実行される。
走行制御部15は、車両制御処理(S28)として、経路生成処理(S26)で生成された目標経路に基づいて、アクチュエータ8へ制御信号を出力する。これにより車両2が目標経路に沿って走行する。車両制御処理(S28)の実行後は、車両制御処理の一連の処理が終了する。その後、自動運転終了条件を満たすか否かが判定され、自動運転終了条件が満たされない場合には、図9のフローチャートを再度実行する。
一方、曲率判定処理(S20)において、基準到達位置(位置20A)の道路曲率が所定値より大きい場合には、到達位置決定部143は探索処理(S30)を実行する。到達位置決定部143は、基準到達位置より車両2の手前側、かつ、道路曲率が所定値以下となる到達位置を探索する(図8参照)。到達位置決定部143は、目標到達位置の決定処理(S32)として、探索処理(S30)の探索結果に基づいて、目標時間よりも短い時間又は目標距離よりも短い距離で車両2が潜在経路上に到達する位置(位置20B)を目標到達位置として決定する(図8参照)。決定処理(S32)の実行後は、経路算出処理(S24)が実行される。経路算出処理(S24)以降の処理は、上述のとおりである。
以上、第一実施形態に係る車両制御装置1によれば、地図情報に基づいた潜在経路へ遷移する際に、直線道路を想定して設定された目標時間(又は目標距離)を用いて車両2が潜在経路上に到達する位置である基準到達位置が算出される。そして、基準到達位置における道路曲率(地図情報の一例)に応じて、目標時間よりも短い時間(又は目標距離よりも短い距離)で車両2が潜在経路上に到達する位置が目標到達位置として決定される。このように、この車両制御装置1は、道路曲率に応じて基準到達位置よりも車両2側に目標到達位置を設定することができる。これにより、この車両制御装置1は、カーブを走行する場合に、地図情報に基づいた潜在経路へ到達するまでの遷移経路を短く生成することができる。遷移経路は演算により算出されるため、遷移経路を短くすることは演算負荷の軽減に寄与する。また、演算には不確定要素が含まれるため、遷移経路を短くすることは目標経路の信頼性の低下を抑制することに寄与する。さらに、車両制御装置1は、遷移経路を短くすることにより、カーブに沿った目標経路を生成することができる。言い換えれば、車両制御装置1は、直線道路に近い箇所で潜在経路に車両2を到達させる遷移経路を生成することができる。
さらに、第一実施形態に係る車両制御装置1によれば、遷移経路の前半部分を前回の目標経路で固定することで車両操舵制御の追従性の低下を抑制することができる。
[第二実施形態]
第二実施形態に係る車両制御装置は、第一実施形態に係る車両制御装置1と比べて、目標到達位置を基準到達位置とするか否かの判定に用いられる情報が相違し、その他は同一である。このため、車両制御装置1と同一の構成及び動作については、説明を繰り返さない。
第二実施形態に係る車両制御装置の到達位置決定部は、基準到達位置における外部状況に応じて、目標時間よりも短い時間又は目標距離よりも短い距離で車両2が潜在経路上に到達する位置を目標到達位置として決定する。つまり、目標到達位置は、基準到達位置の地図情報(道路曲率)を用いて決定されるのではなく、外部状況を用いて決定される。外部状況が複雑になるほど遷移経路の長さを短くした方が、目標経路の信頼性を担保することができる。なお、本実施形態における目標時間又は目標距離は、予め設定された任意の時間又は距離である。
外部状況の具体的な一例は、基準到達位置の周囲に存在する他車両の台数である。目標経路を演算する際に、車両2の周囲に存在する他車両との接触回避を考慮する必要があるため、周囲の他車両が増加するほど遷移経路の演算負荷が増大する。また、他車両の動きは不確定であるため、周囲の他車両が増加するほど遷移経路の信頼性も低くなる。
このため、到達位置決定部は、基準到達位置の周囲に存在する他車両の台数が所定台数以下の場合には、基準到達位置を目標到達位置として決定する。一方、到達位置決定部は、基準到達位置の周囲に存在する他車両の台数が所定台数より大きい場合には、外部状況が複雑であるので、目標時間よりも短い時間又は目標距離よりも短い距離で車両2が潜在経路上に到達する位置を目標到達位置として決定する。その他の構成及び動作は、車両制御装置1と同一である。
次に、車両制御装置が行う車両制御処理について説明する。図10は、第二実施形態に係る車両制御処理の一例を説明するフローチャートである。図10に示す車両制御処理は、例えば自動運転ON/OFFスイッチに自動運転開始の要求操作が入力されたときに実行される。なお、車両位置認識部は車両2の位置を常に認識しているものとする。
図10に示される、潜在経路の決定処理(S110)、外部状況の取得処理(S112)、選択処理(S114)、及び、基準到達位置の算出処理(S116)は、図9に示される、潜在経路の決定処理(S10)、外部状況の取得処理(S12)、選択処理(S14)、及び、基準到達位置の算出処理(S16)と同一である。
走行計画生成部の到達位置決定部は、外部状況の取得処理(S118)として、外部センサ3から取得された情報を参照し、基準到達位置の周囲に存在する他車両の台数を取得する。取得処理(S118)の実行後は、台数判定処理(S120)が実行される。
到達位置決定部は、台数判定処理(S120)として、取得処理(S118)で取得された他車両の台数が所定台数以下であるか否かを判定する。到達位置決定部は、他車両の台数が所定台数以下である場合には、目標到達位置の決定処理(S122)として、基準到達位置を目標到達位置として決定する。決定処理(S122)の実行後は、経路算出処理(S124)が実行される。
一方、台数判定処理(S120)において、取得処理(S118)で取得された他車両の台数が所定台数より大きい場合には、到達位置決定部は、決定処理(S130)を実行する。到達位置決定部は、決定処理(S130)として、基準到達位置より車両2の手前側の位置を目標到達位置として決定する。決定処理(S130)の実行後は、経路算出処理(S124)が実行される。
経路算出処理(S124)、経路生成処理(S126)、及び、車両制御処理(S128)は、図9に示される、経路算出処理(S24)、経路生成処理(S26)、及び、車両制御処理(S28)と同一である。
以上、第二実施形態に係る車両制御装置によれば、他車両の台数が少ない場合などにおいては基準到達位置で潜在経路に車両を到達させ、他車両の台数が多い場合などにおいては基準到達位置よりも手前の位置で潜在経路に車両を到達させることができる。このように、この車両制御装置は、周囲の他車両の台数が多い場合、言い換えれば外部状況が複雑な場合には、なるべく速く地図情報に基づいた潜在経路へ到達するように、遷移経路を短く生成することができる。
[第三実施形態]
第三実施形態に係る車両制御装置は、第一実施形態に係る車両制御装置1と比べて、目標到達位置を基準到達位置とするか否かの判定に用いられる情報が相違し、その他は同一である。このため、車両制御装置1と同一の構成及び動作については、説明を繰り返さない。
第三実施形態に係る車両制御装置の到達位置決定部は、地図情報(道路種別)に応じて、目標時間よりも短い時間又は目標距離よりも短い距離で車両2が潜在経路上に到達する位置を目標到達位置として決定する。つまり、目標到達位置は、基準到達位置の道路曲率を用いて決定されるのではなく、道路種別を用いて決定される。道路種別は、地図データベース6に記憶された情報であり、自動車専用道路、自動車専用道路以外の道路(一般道路)などの種別を特定するための情報である。自動車専用道路は、一般道路に比べて分岐、合流、車線の増減が少ない。これに対して、一般道路は、自動車専用道路に比べて信号、分岐、合流が多い。このため、一般道路は、自動車専用道路と比べて環境が複雑である。このように、道路種別は、外部状況が複雑であるか否かを判断するための指標となる。外部状況が複雑になるほど遷移経路の長さを短くした方がよい点については、上述したとおりである。なお、本実施形態における目標時間又は目標距離は、予め設定された任意の時間又は距離である。
到達位置決定部は、走行中の道路が自動車専用道路の場合には、基準到達位置を目標到達位置として決定する。一方、到達位置決定部は、走行中の道路が一般道路の場合には外部状況が複雑であるので、目標時間よりも短い時間又は目標距離よりも短い距離で車両が潜在経路上に到達する位置を目標到達位置として決定する。その他の構成及び動作は、車両制御装置1と同一である。
次に、車両制御装置が行う車両制御処理について説明する。図11は、第三実施形態に係る車両制御処理の一例を説明するフローチャートである。図11に示す車両制御処理は、例えば自動運転ON/OFFスイッチに自動運転開始の要求操作が入力されたときに実行される。なお、車両位置認識部は車両2の位置を常に認識しているものとする。
図11に示される、潜在経路の決定処理(S210)、外部状況の取得処理(S212)、選択処理(S214)、及び、基準到達位置の算出処理(S216)は、図9に示される、潜在経路の決定処理(S10)、外部状況の取得処理(S12)、選択処理(S14)、及び、基準到達位置の算出処理(S16)と同一である。
走行計画生成部の到達位置決定部は、地図情報の取得処理(S218)として、地図データベース6を参照し、基準到達位置における道路種別を取得する。取得処理(S218)の実行後は、種別判定処理(S220)が実行される。
到達位置決定部は、種別判定処理(S220)として、取得処理(S218)で取得された道路種別に基づいて、走行中の道路が自動車専用道路であるか否かを判定する。到達位置決定部は、走行中の道路が自動車専用道路である場合には、目標到達位置の決定処理(S222)として、基準到達位置を目標到達位置として決定する。決定処理(S222)の実行後は、経路算出処理(S224)が実行される。
一方、種別判定処理(S220)において、走行中の道路が自動車専用道路でない場合には、到達位置決定部は、決定処理(S230)を実行する。到達位置決定部は、決定処理(S230)として、基準到達位置より車両2の手前側の位置を目標到達位置として決定する。決定処理(S230)の実行後は、経路算出処理(S224)が実行される。
経路算出処理(S224)、経路生成処理(S226)、及び、車両制御処理(S228)は、図9に示される、経路算出処理(S24)、経路生成処理(S26)、及び、車両制御処理(S28)と同一である。
以上、第三実施形態に係る車両制御装置によれば、自動車専用道路を走行中の場合においては基準到達位置で潜在経路に車両を到達させ、一般道路を走行中の場合においては基準到達位置よりも手前の位置で潜在経路に車両を到達させることができる。この車両制御装置は、一般道路を走行中の場合、言い換えれば外部状況が複雑な場合には、なるべく速く地図情報に基づいた潜在経路へ到達するように、遷移経路を短く生成することができる。
上述した実施形態は、当業者の知識に基づいて種々の変更、改良を施した様々な形態で実施することができる。
1…車両制御装置、2…車両、6…地図データベース、11…車両位置認識部、12…外部状況認識部、13…走行状態認識部、14…走行計画生成部、15…走行制御部、141…潜在経路決定部、142…位置算出部、143…到達位置決定部、144…経路算出部、145…経路生成部。

Claims (3)

  1. 目標経路に基づいて車両を制御する車両制御装置であって、
    地図情報を記憶する地図データベースと、
    車両位置を認識する車両位置認識部と、
    前記車両の外部状況を認識する外部状況認識部と、
    前記車両の走行状態を認識する走行状態認識部と、
    前記地図情報、前記車両位置、前記外部状況、及び、前記走行状態に基づいて、前記目標経路を生成する走行計画生成部と、
    前記目標経路に基づいて前記車両を走行させる走行制御部と、
    を備え、
    前記走行計画生成部は、
    前記地図情報に基づいた潜在経路を決定する潜在経路決定部と、
    前記車両が前記車両位置から前記潜在経路上に到達するまでの予め定められた目標時間又は目標距離と、前記車両位置と、前記走行状態と、に基づいて、前記目標時間又は目標距離で前記車両が前記車両位置から前記潜在経路上に到達する位置である基準到達位置を算出する位置算出部と、
    前記基準到達位置における前記地図情報又は前記外部状況に応じて、前記目標時間よりも短い時間又は目標距離よりも短い距離で前記車両が前記潜在経路上に到達する位置を目標到達位置として決定する到達位置決定部と、
    前記車両位置から前記目標到達位置までの遷移経路を算出する経路算出部と、
    前記遷移経路と前記目標到達位置以降の前記潜在経路とを繋ぎ合わせて前記目標経路を生成する経路生成部と、
    を有し、
    前記到達位置決定部は、前記基準到達位置の道路曲率が所定値以下の場合には、前記基準到達位置を前記目標到達位置として決定し、前記基準到達位置の道路曲率が所定値より大きい場合には、前記目標時間よりも短い時間又は目標距離よりも短い距離で前記車両が前記潜在経路上に到達する位置を目標到達位置として決定し、
    前記到達位置決定部は、道路曲率が所定値以下となる前記潜在経路上における位置を前記目標到達位置として決定する
    車両制御装置。
  2. 前記走行計画生成部は、前記目標経路を所定周期ごとに生成し、
    前記遷移経路は、前記車両位置から前回生成された前記目標経路の所定地点までの前半部分と、前記所定地点から前記目標到達位置までの後半部分とを含み、
    前記経路算出部は、前記後半部分を算出する、
    請求項1に記載の車両制御装置。
  3. 目標経路に基づいて車両を制御する車両制御装置であって、
    地図情報を記憶する地図データベースと、
    車両位置を認識する車両位置認識部と、
    前記車両の外部状況を認識する外部状況認識部と、
    前記車両の走行状態を認識する走行状態認識部と、
    前記地図情報、前記車両位置、前記外部状況、及び、前記走行状態に基づいて、前記目標経路を生成する走行計画生成部と、
    前記目標経路に基づいて前記車両を走行させる走行制御部と、
    を備え、
    前記走行計画生成部は、
    前記地図情報に基づいた潜在経路を決定する潜在経路決定部と、
    前記車両が前記車両位置から前記潜在経路上に到達するまでの予め定められた目標時間又は目標距離と、前記車両位置と、前記走行状態と、に基づいて、前記目標時間又は目標距離で前記車両が前記車両位置から前記潜在経路上に到達する位置である基準到達位置を算出する位置算出部と、
    前記基準到達位置における前記地図情報又は前記外部状況に応じて、前記目標時間よりも短い時間又は目標距離よりも短い距離で前記車両が前記潜在経路上に到達する位置を目標到達位置として決定する到達位置決定部と、
    前記車両位置から前記目標到達位置までの遷移経路を算出する経路算出部と、
    前記遷移経路と前記目標到達位置以降の前記潜在経路とを繋ぎ合わせて前記目標経路を生成する経路生成部と、
    を有し、
    前記到達位置決定部は、前記基準到達位置の周囲に存在する他車両の台数が所定台数以下の場合には、前記基準到達位置を前記目標到達位置として決定し、前記基準到達位置の周囲に存在する前記他車両の台数が前記所定台数より大きい場合には、前記目標時間よりも短い時間又は目標距離よりも短い距離で前記車両が前記潜在経路上に到達する位置を前記目標到達位置として決定する、車両制御装置。
JP2017010529A 2017-01-24 2017-01-24 車両制御装置 Active JP6579119B2 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2017010529A JP6579119B2 (ja) 2017-01-24 2017-01-24 車両制御装置
US15/870,160 US10261516B2 (en) 2017-01-24 2018-01-12 Vehicle control device
DE102018100668.3A DE102018100668A1 (de) 2017-01-24 2018-01-12 Fahrzeugsteuervorrichtung
CN201810065548.2A CN108340915B (zh) 2017-01-24 2018-01-23 车辆控制装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017010529A JP6579119B2 (ja) 2017-01-24 2017-01-24 車両制御装置

Publications (2)

Publication Number Publication Date
JP2018118589A JP2018118589A (ja) 2018-08-02
JP6579119B2 true JP6579119B2 (ja) 2019-09-25

Family

ID=62812950

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017010529A Active JP6579119B2 (ja) 2017-01-24 2017-01-24 車両制御装置

Country Status (4)

Country Link
US (1) US10261516B2 (ja)
JP (1) JP6579119B2 (ja)
CN (1) CN108340915B (ja)
DE (1) DE102018100668A1 (ja)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7053211B2 (ja) * 2017-10-04 2022-04-12 株式会社Soken 運転支援装置
US10788839B2 (en) * 2018-07-31 2020-09-29 Baidu Usa Llc Planning-control collaboration design for low cost autonomous driving technology
JP2020163869A (ja) * 2019-03-28 2020-10-08 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム
JP2020165692A (ja) * 2019-03-28 2020-10-08 本田技研工業株式会社 制御装置、制御方法およびプログラム
JP7194640B2 (ja) * 2019-05-16 2022-12-22 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム
FR3096948B1 (fr) * 2019-06-06 2021-05-14 Renault Sas Procédé de calcul de la position latérale d'un véhicule automobile
CN111645612A (zh) * 2020-05-06 2020-09-11 北京梧桐车联科技有限责任公司 参数调整方法、装置、设备及计算机可读存储介质

Family Cites Families (27)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5640323A (en) * 1990-02-05 1997-06-17 Caterpillar Inc. System and method for operating an autonomous navigation system
CN1154525A (zh) * 1995-10-24 1997-07-16 三菱电机株式会社 车载式行驶控制装置
US8630795B2 (en) * 1999-03-11 2014-01-14 American Vehicular Sciences Llc Vehicle speed control method and arrangement
US7183942B2 (en) * 2000-01-26 2007-02-27 Origin Technologies Limited Speed trap detection and warning system
JP2001328451A (ja) * 2000-05-18 2001-11-27 Denso Corp 進行路推定装置、先行車認識装置、及び記録媒体
US7421334B2 (en) * 2003-04-07 2008-09-02 Zoom Information Systems Centralized facility and intelligent on-board vehicle platform for collecting, analyzing and distributing information relating to transportation infrastructure and conditions
KR20040091788A (ko) * 2003-04-22 2004-11-02 현대자동차주식회사 고속도로 자율주행 시스템 및 그의 제어방법
US7432800B2 (en) * 2004-07-07 2008-10-07 Delphi Technologies, Inc. Adaptive lighting display for vehicle collision warning
US7589643B2 (en) * 2005-06-30 2009-09-15 Gm Global Technology Operations, Inc. Vehicle speed monitoring system
JP4746674B2 (ja) * 2006-05-12 2011-08-10 村田機械株式会社 搬送システムと搬送方法
JP4724043B2 (ja) * 2006-05-17 2011-07-13 トヨタ自動車株式会社 対象物認識装置
DE102007024391A1 (de) * 2007-05-25 2008-11-27 Robert Bosch Gmbh Kollisionswarngerät mit Leitplankenerkennung
JP4737179B2 (ja) * 2007-11-02 2011-07-27 トヨタ自動車株式会社 車両制御装置及び車両制御方法
US8090489B2 (en) * 2007-11-09 2012-01-03 Bruno Delean Computerized driverless vehicles and traffic control system
JP5215740B2 (ja) 2008-06-09 2013-06-19 株式会社日立製作所 移動ロボットシステム
JP5278378B2 (ja) * 2009-07-30 2013-09-04 日産自動車株式会社 車両運転支援装置及び車両運転支援方法
US8140258B1 (en) * 2010-03-02 2012-03-20 The General Hospital Corporation Wayfinding system
US8498778B2 (en) * 2011-04-21 2013-07-30 Continental Automotive Systems, Inc Navigation system controlled turn signals
JP5780133B2 (ja) * 2011-11-25 2015-09-16 トヨタ自動車株式会社 走行進路生成装置および走行制御装置
SE1251163A1 (sv) * 2012-10-15 2014-04-16 Scania Cv Ab System och metod i samband med förekomst av fordonståg
US9020536B1 (en) * 2012-10-30 2015-04-28 Onasset Intelligence, Inc. Method and apparatus for tracking a transported item while accommodating communication gaps
JP6020224B2 (ja) * 2013-02-07 2016-11-02 トヨタ自動車株式会社 目標走行軌跡生成装置
KR101500082B1 (ko) * 2013-06-10 2015-03-18 현대자동차주식회사 주행차로 인식 장치 및 방법
JP6152939B2 (ja) * 2013-08-28 2017-06-28 株式会社国際電気通信基礎技術研究所 経路算出装置、経路算出プログラムおよび経路算出方法
US9340207B2 (en) 2014-01-16 2016-05-17 Toyota Motor Engineering & Manufacturing North America, Inc. Lateral maneuver planner for automated driving system
JP6176264B2 (ja) * 2015-01-19 2017-08-09 トヨタ自動車株式会社 自動運転車両システム
JP6269534B2 (ja) * 2015-03-02 2018-01-31 トヨタ自動車株式会社 走行制御装置

Also Published As

Publication number Publication date
CN108340915A (zh) 2018-07-31
US20180210453A1 (en) 2018-07-26
US10261516B2 (en) 2019-04-16
JP2018118589A (ja) 2018-08-02
DE102018100668A1 (de) 2018-07-26
CN108340915B (zh) 2021-09-28

Similar Documents

Publication Publication Date Title
JP6579119B2 (ja) 車両制御装置
US10663973B2 (en) Autonomous driving system
US11043127B2 (en) Autonomous driving device
JP6344275B2 (ja) 車両制御装置
JP6705414B2 (ja) 動作範囲決定装置
JP6269552B2 (ja) 車両走行制御装置
JP6939428B2 (ja) 車両制御装置
KR20170052488A (ko) 지도 갱신 판정 시스템
US11055540B2 (en) Method for determining anchor boxes for training neural network object detection models for autonomous driving
US11433897B2 (en) Method and apparatus for determination of optimal cruising lane in an assisted driving system
US11485360B2 (en) Dynamic speed limit adjustment system based on perception results
JP6558214B2 (ja) 自動運転装置
JP2019039831A (ja) 自動運転装置
US11042160B2 (en) Autonomous driving trajectory determination device
EP3757711A1 (en) A vehicle-platoons implementation under autonomous driving system designed for single vehicle
US10845814B2 (en) Host vehicle position confidence degree calculation device
JP2018062300A (ja) 車両制御システム
US11787440B2 (en) Lane boundary and vehicle speed based nudge decision
US11904890B2 (en) Lane change system for lanes with different speed limits
US11474525B2 (en) Method and apparatus for method for dynamic multi-segment path and speed profile shaping
JP2016113092A (ja) 車両制御装置
WO2021189350A1 (en) A point cloud-based low-height obstacle detection system
US11242057B2 (en) Method for optimizing three-point turn of autonomous driving vehicles
US20230065284A1 (en) Control and planning with localization uncertainty
JP2017156874A (ja) 自動運転システム

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20180827

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20190410

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190514

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190716

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20190812

R151 Written notification of patent or utility model registration

Ref document number: 6579119

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151