JP6512140B2 - 自動運転システム - Google Patents

自動運転システム Download PDF

Info

Publication number
JP6512140B2
JP6512140B2 JP2016045955A JP2016045955A JP6512140B2 JP 6512140 B2 JP6512140 B2 JP 6512140B2 JP 2016045955 A JP2016045955 A JP 2016045955A JP 2016045955 A JP2016045955 A JP 2016045955A JP 6512140 B2 JP6512140 B2 JP 6512140B2
Authority
JP
Japan
Prior art keywords
vehicle
travel plan
reliability
unit
state
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
JP2016045955A
Other languages
English (en)
Other versions
JP2017159789A (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 JP2016045955A priority Critical patent/JP6512140B2/ja
Priority to US15/452,302 priority patent/US10095227B2/en
Publication of JP2017159789A publication Critical patent/JP2017159789A/ja
Application granted granted Critical
Publication of JP6512140B2 publication Critical patent/JP6512140B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/005Handover processes
    • B60W60/0053Handover processes from vehicle to occupant
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/0055Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot with safety arrangements
    • G05D1/0061Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot with safety arrangements for transition from automatic pilot to manual pilot and vice versa
    • 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
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/08Interaction between the driver and the control system
    • B60W50/082Selecting or switching between different modes of propelling
    • 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
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/005Handover processes
    • B60W60/0059Estimation of the risk associated with autonomous or manual driving, e.g. situation too complex, sensor failure or driver incapacity
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W2050/0062Adapting control system settings
    • B60W2050/0075Automatic parameter input, automatic initialising or calibrating means
    • B60W2050/0095Automatic control mode change
    • B60W2050/0096Control during transition between modes
    • 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
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo or light sensitive means, e.g. infrared sensors
    • B60W2420/403Image sensing, e.g. optical camera
    • B60W2420/408
    • 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • B60W2520/105Longitudinal acceleration
    • 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/12Lateral speed
    • B60W2520/125Lateral acceleration
    • 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/14Yaw
    • 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/28Wheel speed
    • 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/18Steering angle
    • 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/22Psychological state; Stress level or workload
    • 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/223Posture, e.g. hand, foot, or seat position, turned or inclined
    • 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/225Direction of gaze
    • 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/229Attention level, e.g. attentive to driving, reading or sleeping
    • 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/10Number of lanes
    • 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/53Road markings, e.g. lane marker or crosswalk
    • 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/20Static objects
    • 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/402Type
    • B60W2554/4023Type large-size vehicles, e.g. trucks
    • 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/402Type
    • B60W2554/4029Pedestrians
    • 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/60Traversable objects, e.g. speed bumps or curbs
    • 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
    • B60W2555/00Input parameters relating to exterior conditions, not covered by groups B60W2552/00, B60W2554/00
    • B60W2555/20Ambient conditions, e.g. wind or rain
    • 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/20Data confidence level
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Human Computer Interaction (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • General Physics & Mathematics (AREA)
  • Traffic Control Systems (AREA)
  • Business, Economics & Management (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Game Theory and Decision Science (AREA)
  • Medical Informatics (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Description

本発明は、車両の自動運転システムに関する。
車両の自動運転制御を行うシステムが、例えば特許文献1に記載されている。特許文献1に記載されたシステムは、車両の自動運転制御を行っているときに自動運転制御を行うための条件を満たしていないと判定した場合、ドライバに対して自動運転制御の解除を促す通知を行う。また、このシステムは、十分な幅を有する路側帯又は非常駐車帯等の車両を停車可能な停車地点を算出している。そしてこのシステムは、ドライバに対して自動運転制御の解除を促す通知をしてもドライバが自動運転制御を解除しない場合には、算出された停車地点まで車両を自動で走行させて停車させる。
特開2014−106854号公報
ここで、ドライバが自動運転制御を解除しないために停車地点まで車両を自動で走行させる場合、停車地点まで車両を自動で走行させることが容易ではないことがある。この場合には、自動運転制御の継続が困難となるため、運転操作をドライバに引き継ぐことが望ましい。ドライバに運転操作を引き継ぐ場合には、自動運転制御をできるだけ長く継続し、ドライバに運転操作を引き継ぐための時間を長く確保することが望ましい。
そこで、本発明の種々の側面は、ドライバに運転操作を引き継ぐ場合に、ドライバに運転操作を引き継ぐための時間を長く確保することができる自動運転システムを提供することを目的とする。
本発明の一側面は、車両の自動運転制御を行う自動運転システムであって、車両の位置測定部の測定結果に基づいて、車両の位置を認識する位置認識部と、車両の外部状況を検出する外部センサの検出結果に基づいて、車両の周辺環境を認識する環境認識部と、車両の状態を検出する内部センサの検出結果に基づいて、車両の状態を認識する車両状態認識部と、認識された車両の位置、認識された車両の周辺環境、及び認識された車両の状態に基づいて、車両の第1走行計画を生成する第1計画部と、認識された車両の位置の信頼度、認識された車両の周辺環境の認識の信頼度、認識された車両の状態の認識の信頼度、及び生成された第1走行計画の生成周期、及び第1走行計画と予め定められた走行計画のパターンとの一致度の少なくともいずれかに基づいて、第1走行計画の信頼度を算出する第1信頼度算出部と、認識された車両の位置、認識された車両の周辺環境、及び認識された車両の状態のうち、1つ又は2つに基づいて車両の第2走行計画を生成する第2計画部と、認識された車両の位置、認識された車両の周辺環境、及び認識された車両の状態のうち、第2計画部が第2走行計画を生成する際に用いた認識結果の信頼度、及び生成された第2走行計画の生成周期、及び第2走行計画と予め定められた走行計画のパターンとの一致度の少なくともいずれかに基づいて、第2走行計画の信頼度を算出する第2信頼度算出部と、第1走行計画の信頼度と第2走行計画の信頼度とを比較し、第1走行計画及び第2走行計画のうち、走行計画の信頼度が高い走行計画を選択する選択部と、選択部で選択された走行計画に基づいて、車両の自動運転制御を行う走行制御部と、を備える。
この自動運転システムにおいて走行制御部は、第1走行計画及び第2走行計画のうち走行計画の信頼度が高い走行計画に基づいて車両の自動運転制御を行う。ここで、第1計画部は、位置認識部、環境認識部及び車両状態認識部における全ての認識結果を用いて第1走行計画を生成する。このため、例えば、位置認識部、環境認識部及び車両状態認識部のいずれかの認識結果の信頼度が低下した場合、これらの結果を全て用いて生成される第1走行計画の信頼度は低下する。一方、第2計画部は、第1計画部よりも少ない種類の認識結果に基づいて第2走行計画を生成する。第2走行計画は第1走行計画よりも少ない種類の認識結果に基づいて生成されるため、信頼度が低下した認識結果を用いずに第2走行計画を生成している場合には、認識結果の信頼度の低下の影響を受けることなく、第2走行計画が生成される。このようにして第2走行計画が生成される場合、信頼度が低下した認識結果を用いていないため、認識結果の信頼度の低下に起因して第2走行計画の信頼度が低下することはない。このため、位置認識部、環境認識部及び車両状態認識部のいずれかの認識結果の信頼度の低下に伴って第1走行計画の信頼度が低下し、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じた場合、選択部によって第2走行計画が選択される。このように、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じたとしても、ドライバが運転操作を引き継ぐまでの間、第2走行計画に基づいて車両の自動運転制御が継続される。以上のように、自動運転システムでは、第1走行計画に基づく自動運転制御が困難となりドライバに運転操作を引き継ぐ場合であっても、第2走行計画に基づいて自動運転制御が継続されるため、ドライバに運転操作を引き継ぐための時間を長く確保することができる。
本発明の他の一側面は、車両の自動運転制御を行う自動運転システムであって、車両の位置測定部の測定結果に基づいて、車両の位置を認識する位置認識部と、車両の外部状況を検出する外部センサの検出結果に基づいて、車両の周辺環境を認識する環境認識部と、車両の状態を検出する内部センサの検出結果に基づいて、車両の状態を認識する車両状態認識部と、認識された車両の位置、認識された車両の周辺環境、及び認識された車両の状態に基づいて、車両の第1走行計画を生成する第1計画部と、認識された車両の位置の信頼度、認識された車両の周辺環境の認識の信頼度、認識された車両の状態の認識の信頼度、及び生成された第1走行計画の生成周期、及び第1走行計画と予め定められた走行計画のパターンとの一致度の少なくともいずれかに基づいて、第1走行計画の信頼度を算出する第1信頼度算出部と、認識された車両の位置、認識された車両の周辺環境、及び認識された車両の状態に基づいて、第1走行計画よりも単位時間当たりの車両の加減速度の変化量及び操舵の変化量の少なくとも一方が小さくなるように第2走行計画を生成する第2計画部と、認識された車両の位置の信頼度、認識された車両の周辺環境の認識の信頼度、認識された車両の状態の認識の信頼度、及び生成された第2走行計画の生成周期、及び第2走行計画と予め定められた走行計画のパターンとの一致度の少なくともいずれかに基づいて第2走行計画の信頼度を算出する第2信頼度算出部と、第1走行計画の信頼度と第2走行計画の信頼度とを比較し、第1走行計画及び第2走行計画のうち、走行計画の信頼度が高い走行計画を選択する選択部と、選択部で選択された走行計画に基づいて、車両の自動運転制御を行う走行制御部と、を備える。
この自動運転システムにおいて走行制御部は、第1走行計画及び第2走行計画のうち走行計画の信頼度が高い走行計画に基づいて車両の自動運転制御を行う。ここで、第1計画部は、位置認識部、環境認識部及び車両状態認識部の認識結果を用いて第1走行計画を生成する。例えば、位置認識部、環境認識部及び車両状態認識部のいずれかの認識結果の信頼度が低下した場合、認識結果の信頼度の低下に伴って、第1走行計画の信頼度は低下する。一方、第2計画部は、第1計画部と同じ認識結果を用いるものの、第1走行計画よりも単位時間当たりの車両の加減速度の変化量及び操舵の変化量の少なくとも一方が小さい第2走行計画を生成する。すなわち、第2計画部は、第1走行計画と比べて、車両の状態を大きく変化させずに車両を走行させる第2走行計画を生成する。車両の状態を大きく変化させない場合には、例えば、車両の状態を大きく変化させる場合と比べて車両の周辺環境の認識精度が低くても走行計画を生成できる。このため、第2計画部は、第1計画部が第1走行計画を生成する場合と比べて、位置認識部、環境認識部及び車両状態認識部における認識結果の信頼度が低くても第2走行計画を生成することができる。また、認識結果の信頼度が低くても第2走行計画の生成を行うことができるため、認識結果の信頼度が低下したとしても、第1走行計画と比べて第2走行計画の信頼度に与える影響は小さい。このため、位置認識部、環境認識部及び車両状態認識部のいずれかの認識結果の信頼度の低下に伴って第1走行計画の信頼度が低下し、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じても、ドライバが運転操作を引き継ぐまでの間、第2走行計画に基づいて車両の自動運転制御が継続される。このように、自動運転システムは、第1走行計画に基づく自動運転制御が困難となりドライバに運転操作を引き継ぐ場合であっても、第2走行計画に基づいて自動運転制御が継続されるため、ドライバに運転操作を引き継ぐための時間を長く確保することができる。
本発明の更に他の一側面は、車両の自動運転制御を行う自動運転システムであって、車両の位置測定部の測定結果に基づいて、車両の位置を認識する位置認識部と、車両の外部状況を検出する外部センサの検出結果に基づいて、車両の周辺環境を認識する環境認識部と、車両の状態を検出する内部センサの検出結果に基づいて、車両の状態を認識する車両状態認識部と、認識された車両の位置、認識された車両の周辺環境、及び認識された車両の状態に基づいて、車両の第1走行計画を生成する第1計画部と、認識された車両の位置の信頼度、認識された車両の周辺環境の認識の信頼度、認識された車両の状態の認識の信頼度、及び生成された第1走行計画の生成周期、及び第1走行計画と予め定められた走行計画のパターンとの一致度の少なくともいずれかに基づいて、第1走行計画の信頼度を算出する第1信頼度算出部と、第1計画部で生成された過去の第1走行計画に基づいて第2走行計画を生成する第2計画部と、第2計画部が第2走行計画を生成する際に用いた過去の第1走行計画の信頼度に基づいて、第2走行計画の信頼度を算出する第2信頼度算出部と、第1走行計画の信頼度と第2走行計画の信頼度とを比較し、第1走行計画及び第2走行計画のうち、走行計画の信頼度が高い走行計画を選択する選択部と、選択部で選択された走行計画に基づいて、車両の自動運転制御を行う走行制御部と、を備える。
この自動運転システムにおいて走行制御部は、第1走行計画及び第2走行計画のうち走行計画の信頼度が高い走行計画に基づいて車両の自動運転制御を行う。ここで、第1計画部は、位置認識部、環境認識部及び車両状態認識部の認識結果を用いて第1走行計画を生成する。例えば、位置認識部、環境認識部及び車両状態認識部のいずれかの認識結果の信頼度が低下した場合、認識結果の信頼度の低下に伴って、即座に第1走行計画の信頼度が低下する。一方、第2計画部は、第1計画部で過去に生成された第1走行計画に基づいて第2走行計画を生成する。また、第2信頼度算出部は、過去に生成された第1走行計画の信頼度に基づいて第2走行計画の信頼度を算出するため、位置認識部における認識結果等の信頼度が低下しても、第2走行計画の信頼度は即座には低下しない。このため、位置認識部における認識結果等の信頼度が低下することに伴って第1走行計画の信頼度が低下した場合には、選択部によって第2走行計画が選択される。従って、位置認識部、環境認識部及び車両状態認識部のいずれかの認識結果の信頼度の低下に伴って第1走行計画の信頼度が低下し、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じても、ドライバが運転操作を引き継ぐまでの間、第2走行計画に基づいて車両の自動運転制御が継続される。なお、第2走行計画は過去に生成された第1走行計画に基づいて生成されるため、第2走行計画の信頼度は一般に低くなる。しかしながら、第1走行計画に基づく自動運転制御が困難となって自動運転制御を停止するよりも、信頼度が低くても第2走行計画に基づいて自動運転制御を継続することで、ドライバが運転操作を引き継ぐまでの時間を確保することができる。このように、自動運転システムは、第1走行計画に基づく自動運転制御が困難となりドライバに運転操作を引き継ぐ場合であっても、第2走行計画に基づいて自動運転制御が継続されるため、ドライバに運転操作を引き継ぐための時間を長く確保することができる。
自動運転システムは、車両のドライバの状態を検出する状態検出部の検出結果に基づいてドライバに対して報知部を通じて報知を行うことにより、車両の走行に対するドライバの注意力を管理するドライバ状態管理部と、状態検出部の検出の信頼度、状態検出部の状態、報知部の状態、ドライバ状態管理部の状態、及びドライバの注意力の管理状況の少なくともいずれかに基づいて、ドライバ状態管理部の信頼度を算出するドライバ信頼度算出部と、ドライバ状態管理部の信頼度に基づいて、第1走行計画の信頼度を補正する信頼度補正部と、を更に備えていてもよい。ここで、例えば、第1走行計画は、ドライバ状態管理部の信頼度が高い状態、すなわち、状態検出部、報知部、及びドライバ状態管理部が正常に作動しており、更にドライバの注意力が適切に管理されている状態であることを前提として生成されている。このため、ドライバ状態管理部の信頼度が低下した場合に、信頼度補正部が第1走行計画の信頼度を低く補正することで、選択部によって第2走行計画が選択され易くなる。このように、ドライバ状態管理部の信頼度に基づいて第1走行計画の信頼度を補正することで、第1走行計画に基づいて車両の自動運転制御が行われることが抑制される。ドライバ状態管理部の信頼度が低下することに伴って第1走行計画に基づく自動運転制御を終了させる場合であっても、第2走行計画に基づいて自動運転制御が行われるため、ドライバに運転操作を引き継ぐための時間を長く確保することができる。
本発明の種々の一側面によれば、ドライバに運転操作を引き継ぐ場合に、ドライバに運転操作を引き継ぐための時間を長く確保することができる。
実施形態に係る自動運転システムの概略構成を示す図である。 ECUで実行される処理の流れを示すフローチャートである。 変形例に係る自動運転システムの概略構成を示す図である。
以下、本発明の実施形態について図面を参照しながら説明する。なお、図面の説明において同一の要素には同一の符号を付し、重複する説明を省略する。
図1に示すように、自動運転システム100は、乗用車等の車両Mに搭載されており、車両Mの自動運転制御を行うためのシステムである。自動運転システム100は、自動運転が可能であるか否かを判定し、自動運転が可能であると判定した場合、且つ、ドライバによる自動運転制御の開始操作(自動運転制御の開始ボタンを押す操作等)が行われた場合に、車両Mの自動運転制御を開始する。自動運転制御とは、予め設定された目標ルートに沿って自動で車両Mを走行させる車両制御である。自動運転制御では、ドライバが運転操作を行う必要が無く、車両Mが自動で走行する。目標ルートとは、自動運転制御において車両Mが走行する地図上の経路である。
自動運転システム100は、自動運転制御を実行するためのECU6を備えている。ECU6は、CPU[Central Processing Unit]、ROM[Read Only Memory]、RAM[Random Access Memory]、CAN[Controller Area Network]通信回路等を有する電子制御ユニットである。ECU6では、ROMに記憶されているプログラムをRAMにロードし、RAMにロードされたプログラムをCPUで実行することにより各種の機能を実現する。ECU6は、複数の電子制御ユニットから構成されていてもよい。ECU6には、CAN通信回路を介して、GPS受信部1、外部センサ2、内部センサ3、地図データベース4、ナビゲーションシステム5、アクチュエータ7、及びHMI[Human Machine Interface]8が接続されている。
GPS受信部1は、車両Mに搭載され、車両Mの位置を測定する位置測定部として機能する。GPS受信部1は、3個以上のGPS衛星から信号を受信することにより、車両Mの位置(例えば車両Mの緯度及び経度)を測定する。GPS受信部1は、測定した車両Mの位置の情報をECU6へ送信する。
外部センサ2は、車両Mの周辺の外部状況等を検出するための検出機器である。外部センサ2は、カメラ、レーダー[Radar]、及びライダー[LIDAR:Laser Imaging Detection and Ranging]のうち少なくとも一つを含む。なお、外部センサ2は、後述する車両Mの走行する走行車線の白線認識にも用いられる。また、外部センサ2は、車両Mの位置の測定に用いられてもよい。
カメラは、車両の外部状況を撮像する撮像機器である。カメラは、車両Mのフロントガラスの裏側に設けられている。カメラは、車両Mの左右側面及び車両の背面に設けられていてもよい。カメラは、車両Mの前方を撮像した撮像情報をECU6へ送信する。カメラは、単眼カメラであってもよく、ステレオカメラであってもよい。ステレオカメラは、両眼視差を再現するように配置された二つの撮像部を有している。ステレオカメラの撮像情報には、奥行き方向の情報も含まれている。
レーダーは、電波(例えばミリ波)を利用して車両Mの周辺の障害物を検出する。レーダーは、電波を車両Mの周辺に送信し、障害物で反射された電波を受信することで障害物を検出する。レーダーは、検出した障害物情報をECU6へ送信する。障害物には、縁石、電柱、ポール、ガードレール、壁、建物、路側に設けられる看板及び標識等の固定障害物の他、人、自転車、他車両等の動的障害物が含まれる。
ライダーは、光を利用して車両Mの外部の障害物を検出する。ライダーは、光を車両Mの周辺に送信し、障害物で反射された光を受信することで反射点までの距離を計測し、障害物を検出する。ライダーは、検出した障害物情報をECU6へ送信する。ライダー及びレーダーは、必ずしも重複して備える必要はない。
内部センサ3は、車両Mの車両状態を検出する検出機器である。内部センサ3は、車速センサ、加速度センサ、及びヨーレートセンサを含んでいる。車速センサは、車両Mの車速を検出する検出器である。車速センサとしては、車両Mの車輪又は車輪と一体に回転するドライブシャフト等に対して設けられ、車輪の回転速度を検出する車輪速センサが用いられる。車速センサは、検出した車速情報をECU6に送信する。
内部センサ3は、舵角センサを含んでいてもよい。舵角センサは、車両Mの舵角(実舵角)を検出するセンサである。舵角センサは、車両Mのステアリングシャフトに対して設けられている。舵角センサは、検出した舵角情報をECU6へ送信する。
加速度センサは、車両Mの加速度を検出する検出器である。加速度センサは、車両Mの前後方向の加速度を検出する前後加速度センサと、車両Mの横加速度を検出する横加速度センサとを含んでいる。加速度センサは、車両Mの加速度情報をECU6に送信する。ヨーレートセンサは、車両Mの重心の鉛直軸周りのヨーレート(回転角速度)を検出する検出器である。ヨーレートセンサとしては、ジャイロセンサを用いることができる。ヨーレートセンサは、検出した車両Mのヨーレート情報をECU6へ送信する。
地図データベース4は、地図情報を記憶するデータベースである。地図情報には、固定障害物の位置情報が含まれていてもよい。地図情報には、道路上に設けられた白線の位置情報が含まれていてもよい。地図データベース4は、車両Mに搭載されたHDD[Hard Disk Drive]内に形成されている。地図データベース4は、無線通信によって地図情報管理センターのサーバへ接続し、地図情報管理センターのサーバに記憶された最新の地図情報を用いて、定期的に地図情報を更新してもよい。なお、地図データベース4は、必ずしも車両Mに搭載されている必要はない。地図データベース4は、車両Mと通信可能なサーバ等に設けられていてもよい。
また、地図情報には、自動運転制御から手動運転に切り替えられた頻度が場所ごとに対応付けられた情報が含まれていてもよい。地図情報には、自動運転制御で走行している時間に対して手動運転で走行している時間の割合が、所定のエリア毎に対応付けられた情報が含まれていてもよい。この情報により、あるエリアではドライバによって手動で運転されている割合が高いといったことをECU6の位置認識部11等が認識することができる。また、地図データベース4は、場所ごとの気象を示す気象地図を記憶していてもよい。地図データベース4は、災害(地震、水害等)が発生している場所を示す災害地図を記憶していてもよい。
ナビゲーションシステム5は、車両Mに搭載され、自動運転制御によって車両Mが走行する目標ルートを設定する。ナビゲーションシステム5は、予め設定された目的地、GPS受信部1によって測定された車両Mの位置、及び地図データベース4の地図情報に基づいて、車両Mの位置から目的地に至るまでの目標ルートを演算する。自動運転制御の目的地は、車両Mの乗員がナビゲーションシステム5に備えられた入力ボタン(又はタッチパネル)を操作することにより設定される。ナビゲーションシステム5は、周知の手法により目標ルートを設定することができる。ナビゲーションシステム5は、ドライバによる車両Mの手動運転時において、目標ルートに沿った案内を行う機能を有していてもよい。ナビゲーションシステム5は、車両Mの目標ルートの情報をECU6へ送信する。ナビゲーションシステム5は、その機能の一部が車両Mと通信可能な情報処理センター等の施設のサーバで実行されていてもよい。ナビゲーションシステム5の機能は、ECU6において実行されてもよい。
なお、ここで言う目標ルートには、特許5382218号公報(WO2011/158347号公報)に記載された「運転支援装置」、又は、特開2011−162132号公報に記載された「自動運転装置」における道なり走行ルートのように、目的地の設定がドライバから明示的に行われていない際に、過去の目的地の履歴や地図情報に基づき自動的に生成される目標ルートも含まれる。
アクチュエータ7は、車両Mの走行制御を実行する装置である。アクチュエータ7は、エンジンアクチュエータ、ブレーキアクチュエータ、及び操舵アクチュエータを少なくとも含む。エンジンアクチュエータは、ECU6からの制御信号に応じてエンジンに対する空気の供給量(スロットル開度)を制御し、車両Mの駆動力を制御する。なお、車両Mがハイブリッド車である場合には、エンジンに対する空気の供給量の他に、動力源としてのモータにECU6からの制御信号が入力されて当該駆動力が制御される。車両Mが電気自動車である場合には、動力源としてのモータにECU6からの制御信号が入力されて当該駆動力が制御される。
ブレーキアクチュエータは、ECU6からの制御信号に応じてブレーキシステムを制御し、車両Mの車輪へ付与する制動力を制御する。ブレーキシステムとしては、液圧ブレーキシステムを用いることができる。操舵アクチュエータは、電動パワーステアリングシステムのうち操舵トルクを制御するアシストモータの駆動を、ECU6からの制御信号に応じて制御する。これにより、操舵アクチュエータは、車両Mの操舵トルクを制御する。
HMI8は、車両Mの乗員(例えばドライバ)と自動運転システム100との間で情報の送信及び入力をするためのインターフェイスである。また、HMI8は、車両Mの走行に対するドライバの注意力を管理する機能を有している。HMI8は、状態検出部8a、報知部8b、及びドライバ状態管理部8cを備えている。状態検出部8aは、ドライバの状態を検出する機器である。状態検出部8aは、例えば、ドライバを撮像するカメラを備えており、既知の画像処理技術等を用いてドライバの状態(姿勢、顔の向き等)を検出する。報知部8bは、ドライバに対して報知を行う機器である。報知部8bは、ドライバや車両Mの乗員に画像情報を表示するディスプレイ、音声を出力するスピーカ等のうち少なくとも一つを含む。
ドライバ状態管理部8cは、車両の走行に対するドライバの注意力を管理する。ここでの注意力を管理することとは、車両Mの走行状態(速度、舵角等)及び周囲の状況等をドライバに認識させることをいう。このため、ドライバ状態管理部8cは、状態検出部8aで検出されたドライバの状態に基づいて、報知部8bを通じて注意喚起を行うことで、ドライバの注意力を管理する。例えば、ドライバ状態管理部8cは、状態検出部8aによってドライバが横方向を見ていることが検出された場合には、前方向を向くように報知部8bを通じて報知する。これにより、自動運転制御が行われている場合であっても、車両Mの走行に対するドライバの注意力が低下することを抑制できる。また、車両Mの走行に対するドライバの注意力が高い場合、車両Mの走行状態や周囲の状況等をドライバが把握しているため、自動運転制御からドライバによる手動運転に運転操作を即座に引き継ぐことができる。
HMI8は、後述の選択部18において第1走行計画が選択されている状態で第1走行計画とは異なる走行計画が選択された場合、ドライバに対して報知部8bを通じて、ドライバが運転操作を引き継ぐ必要がある旨の報知を行ってもよい。すなわち、HMI8は、第1走行計画に基づいた自動運転制御が終了する場合、運転操作をドライバが引き継ぐようにドライバに対して報知を行ってもよい。また、HMI8は、乗員が入力操作を行うための操作ボタン又はタッチパネル等を備えている。HMI8は、乗員の入力した情報をECU6へ送信する。
次に、ECU6の機能的構成について説明する。ECU6は、位置認識部11、環境認識部12、車両状態認識部13、第1演算部14、第2演算部15、ドライバ信頼度算出部16、信頼度補正部17、選択部18、及び走行制御部19を備えている。
位置認識部11は、GPS受信部1の位置情報及び地図データベース4の地図情報に基づいて、車両Mの地図上の位置を認識する。位置認識部11は、xy直交座標系におけるx座標及びy座標の組み合わせとして、車両Mの位置を認識する。また、位置認識部11は、GPS受信部1の位置情報及び地図データベース4の地図情報に加え、車両状態認識部13で認識される車両Mの車速に基づいて車両Mの位置を認識或いは位置の補正を行ってもよい。位置認識部11は、地図データベース4の地図情報に含まれた縁石等の固定障害物の位置情報、及び外部センサ2の検出結果を利用して、SLAM技術により車両Mの位置を認識してもよい。この場合、GPS受信部1に代えて、外部センサ2が位置測定部として機能する。また、位置認識部11は、地図情報に含まれた白線の位置情報、及び外部センサ2における白線の検出結果を利用して、既存の画像処理等により車両Mの位置を認識或いは位置の補正を行ってもよい。この場合、外部センサ2も位置測定部として機能する。
車両Mの位置は、鉛直方向から見た場合(平面視の場合)における車両Mの中心位置を基準とすることができる。車両Mの中心位置は、車両Mの車幅方向の中心であり、且つ、車両Mの前後方向の中心となる位置である。
また、位置認識部11は、認識した車両Mの位置の信頼度を算出する。この車両Mの位置の信頼度とは、認識された車両Mの位置の確からしさを表している。例えば、位置認識部11は、車両Mの位置の演算周期に基づいて、車両Mの位置の信頼度を算出してもよい。この場合、位置認識部11は、演算周期が所定の周期より長い場合、演算周期が所定の周期より短い場合に比べて車両Mの位置の信頼度を低くしてもよい。
例えば、位置認識部11は、車両Mの位置の認識に用いたGPS受信部1の位置情報等の取得周期に基づいて、車両Mの位置の信頼度を算出してもよい。この場合、位置認識部11は、GPS受信部1の位置情報等の取得周期が所定の周期より長い場合、取得周期が所定の周期より短い場合に比べて車両Mの位置の信頼度を低くしてもよい。例えば、位置認識部11は、車両Mの位置の認識に用いたGPS受信部1の位置情報等の時間的な変化に基づいて、車両Mの位置の信頼度を算出してもよい。この場合、位置認識部11は、GPS受信部1の位置情報等の時間的な変化に矛盾がある場合(変化が不連続である場合)に、矛盾が無い場合(変化が不連続でない場合)に比べて車両Mの位置の信頼度を低くしてもよい。
例えば、位置認識部11は、車両Mの位置を認識する際の認識の誤差に基づいて、車両Mの位置の信頼度を算出してもよい。ここでの誤差とは、例えば、車両Mの位置を1点に絞り込めている場合には誤差が小さく、例えば、車両Mの位置が絞り込めておらず、あるエリア内に車両Mが存在すると認識されている場合には誤差が大きい。この場合、位置認識部11は、車両Mの位置の認識の誤差が大きい場合に、誤差が小さい場合に比べて、車両Mの位置の信頼度を低くしてもよい。例えば、位置認識部11は、車両Mの周囲の固定構造物及び白線等の検出結果を利用して車両Mの位置を認識する場合、認識のために用いた固定構造物及び白線等を検出できた割合に基づいて、車両Mの位置の信頼度を算出してもよい。この場合、位置認識部11は、固定構造物及び白線等を検出できた割合が低い場合に、検出できた割合が高い場合に比べて、車両Mの位置の信頼度を低くしてもよい。
例えば、位置認識部11は、場所ごとに対応付けられた自動運転制御から手動運転に切り替えられた頻度に基づいて、車両Mの位置の信頼度を算出してもよい。位置認識部11は、地図情報に基づいて、場所ごとに対応付けられた自動運転制御から手動運転に切り替えられた頻度を取得することができる。この場合、位置認識部11は、認識した車両Mの位置が、自動運転制御から手動運転に切り替えられた頻度が高い場所である場合、頻度が低い場所である場合に比べて車両Mの位置の信頼度を低くしてもよい。例えば、位置認識部11は、所定のエリア毎に対応付けられた自動運転制御で走行している時間に対して手動運転で走行している時間の割合に基づいて、車両Mの位置の信頼度を算出してもよい。位置認識部11は、地図情報に基づいて、所定のエリア毎に対応付けられた自動運転制御で走行している時間に対して手動運転で走行している時間の割合を取得することができる。この場合、位置認識部11は、認識した車両Mの位置が、手動運転の時間の割合が高いエリアである場合、割合が低いエリアである場合に比べて車両Mの位置の信頼度を低くしてもよい。
例えば、位置認識部11は、地図データベース4に記憶された地図情報の有無に基づいて、車両Mの位置の信頼度を算出してもよい。この場合、位置認識部11は、地図情報が存在しないエリア内において車両Mの位置を認識しようとするときは、地図情報が存在する場合に比べて車両Mの位置の信頼度を低くしてもよい。例えば、位置認識部11は、地図データベース4に記憶された地図情報の鮮度(新しさ)に基づいて、車両Mの位置の信頼度を算出してもよい。この場合、位置認識部11は、地図情報が更新された時期が古い場合、地図情報が更新された時期が新しい場合に比べて車両Mの位置の信頼度を低くしてもよい。
例えば、位置認識部11は、地図データベース4に記憶された場所ごとの気象を示す気象地図に基づいて、車両Mの位置の信頼度を算出してもよい。この場合、位置認識部11は、認識された車両Mの位置が気象地図上において悪天候である場合(例えば雨、雪の場合)、悪天候でない場合(例えば晴れの場合)に比べて車両Mの位置の信頼度を低くしてもよい。例えば、位置認識部11は、地図データベース4に記憶された災害が発生している場所を示す災害地図に基づいて、車両Mの位置の信頼度を算出してもよい。この場合、位置認識部11は、認識された車両Mの位置が災害地図上において災害が発生している場所である場合、災害が発生していない場所である場合に比べて車両Mの位置の信頼度を低くしてもよい。
位置認識部11は、上述した車両Mの位置の信頼度の複数の算出方法に基づいて算出された複数の信頼度に基づいて、車両Mの位置の信頼度を算出してもよい。
環境認識部12は、車両Mの外部状況を検出する外部センサ2の検出結果に基づいて、車両Mの周辺環境を認識する。環境認識部12は、カメラの撮像画像、レーダーの障害物情報、又はライダーの障害物情報に基づいて、周知の手法により、車両Mの周辺環境を認識する。具体的には、環境認識部12は、カメラの撮像情報、レーダーの障害物情報、又はライダーの障害物情報に基づいて、車両Mの周囲の障害物(固定障害物、動的障害物)を認識する。環境認識部12は、障害物として車両(他車両)を認識した場合、認識した車両の種別を認識する。ここでは車両の種別として、例えば車両が緊急車両(パトカー、救急車、消防車等)であるか、緊急車両以外の車両であるかを認識する。車両の種別は、例えば、カメラを用いた場合では、認識された車両の形状と、予め定められた緊急車両の形状とを比較することによって区別してもよい。また、環境認識部12は、障害物として車両(他車両)を認識した場合、認識した車両の状態を認識する。ここでは車両の状態として、例えば車両がハザードランプを点灯しているか否かを認識する。また、環境認識部12は、カメラの撮像情報又はライダーの障害物情報に基づいて、車両Mの走行する走行車線の白線の位置を認識する。環境認識部12は、更に白線の線種及び白線の曲率を認識してもよい。
また、環境認識部12は、認識した車両Mの周辺環境の認識の信頼度を算出する。この車両Mの周辺環境の認識の信頼度とは、認識された車両Mの周辺環境の認識の確からしさを表している。例えば、環境認識部12は、車両Mの周辺環境の認識の演算周期に基づいて、車両Mの周辺環境の認識の信頼度を算出してもよい。この場合、環境認識部12は、演算周期が所定の周期より長い場合、演算周期が所定の周期より短い場合に比べて車両Mの周辺環境の認識の信頼度を低くしてもよい。
例えば、環境認識部12は、外部センサ2の検出結果の取得周期に基づいて、車両Mの周辺環境の認識の信頼度を算出してもよい。この場合、環境認識部12は、外部センサ2の検出結果の取得周期が長い場合、取得周期が所定の周期より短い場合に比べて車両Mの周辺環境の認識の信頼度を低くしてもよい。例えば、環境認識部12は、認識した障害物の位置或いは速度の時間的な変化に基づいて、車両Mの周辺環境の認識の信頼度を算出してもよい。この場合、環境認識部12は、認識した障害物の位置或いは速度に時間的な矛盾がある場合(変化が不連続である、或いはノイズが多い場合)に、矛盾が無い場合(変化が不連続でない、或いはノイズが少ない場合)に比べて、車両Mの周辺環境の認識の信頼度を低くしてもよい。
例えば、環境認識部12は、認識した障害物の時間的な変化を見たときに、障害物が分裂或いは結合した回数に基づいて、車両Mの周辺環境の認識の信頼度を算出してもよい。この場合、環境認識部12は、障害物が分裂或いは結合した回数が多い場合、分裂或いは結合した回数が少ない場合に比べて車両Mの周辺環境の認識の信頼度を低くしてもよい。
例えば、環境認識部12は、車両Mの周囲の複数の障害物のうち、障害物の種別を識別できた障害物の割合に基づいて、車両Mの周辺環境の認識の信頼度を算出してもよい。この場合、環境認識部12は、障害物の種別を識別できた割合が少ない場合、識別できた割合が多い場合に比べて車両Mの周辺環境の認識の信頼度を低くしてもよい。例えば、環境認識部12は、認識した障害物のうち、車両Mから所定距離(Pm)以内に存在する歩行者の数に基づいて、車両Mの周辺環境の認識の信頼度を算出してもよい。この場合、環境認識部12は、所定距離以内に存在する歩行者の数が多い場合には、歩行者の数が少ない場合に比べて車両Mの周辺環境の認識の信頼度を低くしてもよい。環境認識部12は、歩行者の場合と同様に、歩行者以外の障害物のうち、車両Mから所定距離(Pm)以内に存在する歩行者以外の障害物の数に基づいて、車両Mの周辺環境の認識の信頼度を算出してもよい。この場合にも、環境認識部12は、所定距離以内に存在する歩行者以外の障害物の数が多い場合には、歩行者以外の障害物の数が少ない場合に比べて、車両Mの周辺環境の認識の信頼度を低くしてもよい。
環境認識部12は、車両Mの走行車線の幅員に基づいて車両Mの周辺環境の認識の信頼度を算出してもよい。この場合、環境認識部12は、認識した車両Mの走行する走行車線の白線の位置に基づいて走行車線の幅員を算出する。そして、環境認識部12は、算出した幅員が狭い場合には、幅員が広い場合に比べて車両Mの周辺環境の認識の信頼度を低くする。なお、環境認識部12は、認識した白線に基づいて幅員を算出し、算出した幅員に基づいて車両Mの周辺環境の認識の信頼度を算出したが、環境認識部12が幅員を算出することに限定されない。例えば、地図データベース4に車線の幅員の情報が含まれている場合、環境認識部12は、位置認識部11で認識された車両Mの位置に基づいて地図データベース4から車線の幅員を取得してもよい。そして、環境認識部12は、地図データベース4から取得した幅員に基づいて、車両Mの周辺環境の認識の信頼度を算出してもよい。また、環境認識部12は、走行車線の白線の位置以外にも、例えば、物理的な道路境界(縁石、ガードレール、壁、工事のためのパイロン等)の位置に基づいて走行車線の幅員を算出してもよい。また、環境認識部12は、白線及び物理的な道路境界以外にも、道路幅員と見なすことができる物、例えば、中央線の無い道路で対向車が来た場合には、対向車の位置に基づいて得られる道路の物理的な幅の半分を走行車線の幅員と見なしてもよい。或いは、環境認識部12は、例えば、路面標識の無い道路の路肩を歩行者等が歩いている場合において、歩行者から十分に距離を確保した位置に基づいて仮想的な幅員を算出してもよい。また、環境認識部12は、車両Mと道路境界との距離に基づいて、車両Mの周辺環境の認識の信頼度を算出してもよい。この道路境界とは、白線等の区画線であってもよく、縁石、壁、側溝などによって定まる走行可能な領域の端であってもよく、その他の道路境界として扱うことが適切な物であってもよい。
例えば、環境認識部12は、認識した車両Mの周囲の車両が緊急車両であるか否かに基づいて、車両Mの周辺環境の認識の信頼度を算出してもよい。この場合、環境認識部12は、車両Mの周囲の緊急車両の割合或いは台数が多い場合に、緊急車両の割合或いは台数が少ない場合に比べて、車両Mの周辺環境の認識の信頼度を低くしてもよい。例えば、環境認識部12は、認識した車両Mの周囲の車両がハザードランプを点灯しているか否かに基づいて、車両Mの周辺環境の認識の信頼度を算出してもよい。この場合、環境認識部12は、車両Mの周囲の車両がハザードランプを点灯している割合或いは台数が多い場合に、点灯している割合或いは台数が少ない場合に比べて、車両Mの周辺環境の認識の信頼度を低くしてもよい。
環境認識部12は、上述した車両Mの周辺環境の認識の信頼度の複数の算出方法に基づいて算出された複数の信頼度に基づいて、車両Mの周辺環境の認識の信頼度を算出してもよい。
車両状態認識部13は、内部センサ3の検出結果に基づいて、車両Mの車速、及び向き等を含む車両Mの状態を認識する。具体的には、車両状態認識部13は、車速センサの車速情報に基づいて、車両Mの車速を認識する。車両状態認識部13、ヨーレートセンサのヨーレート情報に基づいて、車両Mの向きを認識する。車両状態認識部13は、加速度センサの加速度情報に基づいて、車両Mの加速度を認識する。車両状態認識部13は、舵角センサの舵角情報に基づいて、車両Mの舵角(操舵角)を認識する。
また、車両状態認識部13は、認識した車両Mの状態の認識の信頼度を算出する。この車両Mの状態の認識の信頼度とは、認識された車両Mの状態の認識の確からしさを表している。例えば、車両状態認識部13は、車両Mの状態の認識の演算周期に基づいて、車両Mの状態の認識の信頼度を算出してもよい。この場合、車両状態認識部13は、演算周期が所定の周期より長い場合、演算周期が所定の周期より短い場合に比べて、車両Mの状態の認識の信頼度を低くしてもよい。
例えば、車両状態認識部13は、車両Mの状態の認識に用いた内部センサ3の検出結果の取得周期に基づいて、車両Mの状態の認識の信頼度を算出してもよい。この場合、車両状態認識部13は、内部センサ3の検出結果の取得周期が長い場合、取得周期が所定の周期より短い場合に比べて車両Mの状態の認識の信頼度を低くしてもよい。
車両状態認識部13は、上述した車両Mの状態の認識の信頼度の複数の算出方法に基づいて算出された複数の信頼度に基づいて、車両Mの状態の認識の信頼度を算出してもよい。
第1演算部14は、車両Mの自動運転制御を行う際に用いられる第1走行計画及び第1走行計画の信頼度を演算する。第1演算部14は、第1計画部14a、及び第1信頼度算出部14bを備えている。
第1計画部14aは、位置認識部11で認識された車両Mの位置、環境認識部12で認識された周辺環境、車両状態認識部13で認識された車両Mの状態、及び地図データベース4の地図情報に基づいて、ナビゲーションシステム5により設定された目標ルートに沿って走行するように車両Mの第1走行計画を生成する。第1計画部14aは、自動運転システム100において自動運転が可能であると判定され、且つ、ドライバが自動運転制御の開始操作を行った場合に、第1走行計画の生成を開始する。この第1走行計画は、車両Mの現在の位置から予め設定された目的地に車両Mが至るまでの走行計画となる。
第1計画部14aは、目標ルート上において車両Mが安全、法令順守、走行効率等の基準に照らして好適に走行するように第1走行計画を生成する。第1走行計画には、先行車両への追従及び走行車線の形状に沿った操舵に加え、例えば、障害物の回避及びレーンチェンジ等の運転行動が含まれる。また、第1走行計画は、HMI8が正常に作動していること、及びドライバ状態管理部8cによってドライバの注意力が適切に管理されている状態であることを前提として生成されている。第1計画部14aは、第1走行計画として、例えば、目標ルートに沿った複数の目標位置と、各目標位置での速度とを含む走行計画を生成する。すなわち、第1走行計画には、経路の計画と、速度の計画とが含まれている。
第1信頼度算出部14bは、第1計画部14aで生成された第1走行計画の信頼度を算出する。この第1走行計画の信頼度とは、車両Mが安全、法令順守、走行効率等の基準に照らして好適に走行できるか否かの度合いを表している。第1走行計画の信頼度が高い方が、例えば、周囲の障害物との距離を所定距離以上保ちつつ走行できていたり、走行効率が良いことを表している。ここでの走行効率が良いこととは、例えば、単位時間当たりに進むことができる距離が長いことをいう。或いは、走行効率が良いこととは、燃費が良いこと等が含まれていてもよい。
具体的には、第1信頼度算出部14bは、位置認識部11で認識された車両Mの位置の信頼度、環境認識部12で認識された車両Mの周辺環境の認識の信頼度、車両状態認識部13で認識された車両Mの状態の認識の信頼度、及び第1計画部14aで生成された第1走行計画の少なくともいずれかに基づいて第1走行計画の信頼度を算出する。
例えば、第1信頼度算出部14bは、第1計画部14aにおける第1走行計画の生成周期に基づいて、第1走行計画の信頼度を算出してもよい。この場合、第1信頼度算出部14bは、第1走行計画の生成周期が所定の周期より長い場合、生成周期が所定の周期より短い場合に比べて第1走行計画の信頼度を低くしてもよい。
例えば、第1信頼度算出部14bは、位置認識部11、環境認識部12、及び車両状態認識部13で算出された各種の信頼度に基づいて、第1走行計画の信頼度を算出してもよい。この場合、第1信頼度算出部14bは、位置認識部11で算出された車両Mの位置の信頼度が低い場合、車両Mの位置の信頼度が高い場合に比べて、第1走行計画の信頼度を低くしてもよい。第1信頼度算出部14bは、環境認識部12で算出された車両Mの周辺環境の認識の信頼度が低い場合、車両Mの周辺環境の認識の信頼度が高い場合に比べて第1走行計画の信頼度を低くしてもよい。第1信頼度算出部14bは、車両状態認識部13で算出された車両Mの状態の認識の信頼度が低い場合、車両Mの状態の認識の信頼度が高い場合に比べて、第1走行計画の信頼度を低くしてもよい。
例えば、第1信頼度算出部14bは、第1走行計画における経路周辺に存在する障害物の数に基づいて、第1走行計画の信頼度を算出してもよい。この場合、第1信頼度算出部14bは、生成された第1走行計画と環境認識部12で認識された周辺環境とに基づいて、第1走行計画における経路周辺に存在する障害物の数が多い場合、障害物の数が少ない場合に比べて第1走行計画の信頼度を低くしてもよい。例えば、第1信頼度算出部14bは、第1走行計画における経路周辺に存在する障害物と車両Mとの距離に基づいて、第1走行計画の信頼度を算出してもよい。この場合、第1信頼度算出部14bは、生成された第1走行計画と環境認識部12で認識された周辺環境とに基づいて、第1走行計画における経路周辺に存在する障害物と車両Mとの距離が所定距離未満の場合、障害物と車両Mと距離が所定距離以上の場合に比べて第1走行計画の信頼度を低くしてもよい。
例えば、第1信頼度算出部14bは、第1走行計画における経路と、環境認識部12で認識された障害物と、障害物によって生じる外部センサ2の物理的な死角とに基づいて、第1走行計画の信頼度を算出してもよい。ここでの外部センサ2の物理的な死角とは、外部センサ2の検出エリアであるにもかかわらず、障害物が存在することによって外部センサ2によって検出できないエリアをいう。外部センサ2の検出エリアは、車両Mに外部センサ2を設置する向き等に基づいて予め定まっている。外部センサ2の物理的な死角の具体的な一例について説明する。例えば、車両Mの前方の道路がカーブ路であり、前方の道路のそばに建物が存在しているとする。そして、この建物がカーブの先よりも手前側(車両M側)に存在し、建物に隠れて車両Mからカーブの先の部分が見えない状況とする。この場合、道路のそばの建物が遮ることによってカーブの先を外部センサ2で検出できない。この建物によって遮られたエリア(外部センサ2で検出できないエリア)が、外部センサ2の物理的な死角となる。この場合、第1信頼度算出部14bは、外部センサ2の死角が多い場合、死角が少ない場合に比べて、第1走行計画の信頼度を低くしてもよい。
例えば、第1信頼度算出部14bは、第1走行計画における経路と、地図データベース4の地図情報と、外部センサ2のセンサ死角とに基づいて、第1走行計画の信頼度を算出してもよい。ここでの外部センサ2のセンサ死角とは、そもそも外部センサ2の検出エリアでないエリアをいう。更に、この外部センサ2のセンサ死角は、第1走行計画に従って走行する場合に外部センサ2で検出すべきエリアであるにもかかわらず、そもそも外部センサ2の検出エリアとなっていないエリアをいう。例えば、車両Mの走行する経路(第1走行計画における経路)に側方から合流してくる車線が存在する場合、側方から合流してくる車線が外部センサ2で検出すべきエリアとなる。そして、車両Mに設けられた外部センサ2の検出エリアが前方のみである場合、側方から合流してくる車線は検出の向きが異なるために外部センサ2で検出できない。このため、側方から合流してくる車線が、外部センサ2のセンサ死角となる。この場合、第1信頼度算出部14bは、センサ死角が多い場合、センサ死角が少ない場合に比べて、第1走行計画の信頼度を低くしてもよい。
例えば、第1信頼度算出部14bは、第1走行計画における経路と、地図データベース4の地図情報とに基づいて得られる車両Mのレーンチェンジの回数、或いは走行車線の合流等の回数に基づいて、第1走行計画の信頼度を算出してもよい。この場合、第1信頼度算出部14bは、車両Mのレーンチェンジの回数、或いは走行車線の合流等の回数が多い場合、これらの回数が少ない場合に比べて第1走行計画の信頼度を低くしてもよい。
例えば、第1信頼度算出部14bは、生成された第1走行計画と、安定して走行ができる予め定められた走行計画のパターンとの一致度に基づいて、第1走行計画の信頼度を算出してもよい。この場合、第1信頼度算出部14bは、生成された第1走行計画と、安定して走行ができる予め定められた走行計画のパターンとの一致度が低い場合、一致度が高い場合に比べて第1走行計画の信頼度を低くしてもよい。例えば、第1走行計画に優先道路への合流が含まれている場合、第1信頼度算出部14bは、第1走行計画の信頼度を低くしてもよい。
例えば、第1信頼度算出部14bは、第1走行計画を生成する際に用いられた位置認識部11の認識結果、環境認識部12の認識結果、及び車両状態認識部13の認識結果と、安定して走行計画が生成できる予め定められた条件との一致度に基づいて、第1走行計画の信頼度を算出してもよい。この場合、第1信頼度算出部14bは、第1走行計画を生成する際に用いられた位置認識部11の認識結果等と、予め定められた条件との一致度が低い場合、一致度が高い場合に比べて第1走行計画の信頼度を低くしてもよい。
例えば、第1信頼度算出部14bは、環境認識部12で認識される車両Mの周辺の車両の動きと、生成された第1走行計画における車両Mの動きとの一致度に基づいて、第1走行計画の信頼度を算出してもよい。この場合、第1信頼度算出部14bは、周辺の車両の動きと、第1走行計画における車両Mの動きとの一致度が低い場合、第1走行計画の信頼度を低くしてもよい。例えば、信号機が存在する交差点において、周辺の車両が発進したにも関わらず第1走行計画における車両Mの動きが停止し続けている場合、第1信頼度算出部14bは、第1走行計画の信頼度を低くする。
第1信頼度算出部14bは、上述した第1走行計画の信頼度の複数の算出方法に基づいて算出された複数の信頼度に基づいて、第1走行計画の信頼度を算出してもよい。
第2演算部15は、車両Mの自動運転制御を行う際に用いられる第2走行計画及び第2走行計画の信頼度を演算する。第2演算部15は、第1演算部14と異なる方法によって、第2走行計画を生成する。第2演算部15は、第2計画部15a、及び第2信頼度算出部15bを備えている。
第2計画部15aは、第2走行計画として、第2走行計画に基づいて自動運転制御が行われている状態から、運転操作をドライバに容易に引き継ぐことができることを目的とした走行計画を生成する。具体的には、車両Mの状態を単位時間あたりに大きく変化させない走行計画となっている。第2走行計画には、第1走行計画とは異なり、例えば、障害物の回避及びレーンチェンジ等の運転行動が含まれない。第2走行計画に基づいて車両Mが走行する場合のように車両Mの動きが緩やかであると、ドライバに運転操作が引き継がれたときに、運転操作が引き継がれたときの車両Mの状態にドライバが容易に適応することができる。すなわち、第2走行計画に基づいて車両Mの自動運転制御が行われている場合には、自動運転が行われている状態からドライバが運転操作を容易に引き継ぐことができる。
第2計画部15aは、車両状態認識部13で認識された車両Mの状態に基づいて、車両Mの第2走行計画を生成する。具体的には、第2計画部15aは、車両状態認識部13で認識された現在の車両Mの状態(車速、加速度、舵角等)から、単位時間当たりの車両Mの加減速度の変化量及び操舵の変化量の少なくとも一方が予め定められた値よりも小さくなるように第2走行計画を生成する。すなわち、第2走行計画は、現在の車両Mの状態から車両Mの動きが大きく変化しない走行計画となる。このように、第2計画部15aは、第2走行計画として、第1計画部14aが生成する第1走行計画よりも緩い走行計画を生成すればよい。例えば、第2計画部15aは、現在の車両Mの車速から、予め定められた値よりも小さな減速度で車両Mを減速させる第2走行計画を生成する。このように、第2計画部15aは、位置認識部11及び環境認識部12での認識結果を用いずに、車両状態認識部13での認識結果のみを用いて第2走行計画を生成する。
第2計画部15aは、第2走行計画として、第1走行計画と同様に、例えば、車両Mが走行する複数の目標位置と、各目標位置での速度とを含む走行計画を生成する。すなわち、第2走行計画には、経路の計画と、速度の計画とが含まれている。また、第2計画部15aは、ドライバが自動運転制御の開始操作を行った場合に、第2走行計画の生成を開始する。
第2信頼度算出部15bは、第2計画部15aで生成された第2走行計画の信頼度を算出する。この第2走行計画信頼度とは、車両Mが安全、法令順守、走行効率等の基準に照らして好適に走行できるか否かの度合いを表している。なお、第2走行計画は、第1走行計画と異なり周辺環境等が考慮されていない。このため、一般には、第2走行計画の信頼度は、第1走行計画の信頼度よりも低くなる。
具体的には、第2信頼度算出部15bは、第2計画部15aが第2走行計画を生成する際に用いた認識結果の信頼度、及び第2走行計画の少なくともいずれかに基づいて第2走行計画の信頼度を算出する。ここでは、第2信頼度算出部15bは、車両状態認識部13で認識された車両Mの状態の認識の信頼度、及び第2計画部15aで生成された第2走行計画の少なくともいずれかに基づいて第2走行計画の信頼度を算出する。
例えば、第2信頼度算出部15bは、第2計画部15aにおける第2走行計画の生成周期に基づいて、第2走行計画の信頼度を算出してもよい。この場合、第2信頼度算出部15bは、第2走行計画の生成周期が所定の周期より長い場合、生成周期が所定の周期より短い場合に比べて第2走行計画の信頼度を低くしてもよい。例えば、第2信頼度算出部15bは、車両状態認識部13で算出された車両Mの状態の認識の信頼度に基づいて、第2走行計画の信頼度を算出してもよい。この場合、第2信頼度算出部15bは、車両状態認識部13で算出された車両Mの状態の認識の信頼度が低い場合、車両Mの状態の認識の信頼度が高い場合に比べて第2走行計画の信頼度を低くしてもよい。
第2信頼度算出部15bは、上述した第2走行計画の信頼度の複数の算出方法に基づいて算出された複数の信頼度に基づいて、第2走行計画の信頼度を算出してもよい。
ドライバ信頼度算出部16は、状態検出部8aの検出の信頼度、状態検出部8aの状態、報知部8bの状態、ドライバ状態管理部8cの状態、及びドライバ状態管理部8cにおけるドライバの注意力の管理状況の少なくともいずれかに基づいて、ドライバ状態管理部8cの信頼度を算出する。このドライバ状態管理部8cの信頼度とは、ドライバの注意力を適切に管理できているか否かの度合いを表している。
例えば、ドライバ信頼度算出部16は、状態検出部8aにおけるドライバの状態の検出周期に基づいてドライバ状態管理部8cの信頼度を算出してもよい。例えば、ドライバ信頼度算出部16は、状態検出部8aにおける検出周期が所定の周期より長い場合、検出周期が所定の周期より短い場合に比べてドライバ状態管理部8cの信頼度を低くしてもよい。
例えば、ドライバ信頼度算出部16は、状態検出部8aが正常に作動していない場合、状態検出部8aが正常に作動している場合に比べてドライバ状態管理部8cの信頼度を低くしてもよい。また、ドライバ信頼度算出部16は、報知部8bが正常に作動していない場合、正常に作動している場合に比べてドライバ状態管理部8cの信頼度を低くしてもよい。また、ドライバ信頼度算出部16は、ドライバ状態管理部8cが正常に作動していない場合、ドライバ状態管理部8cが正常に作動している場合に比べてドライバ状態管理部8cの信頼度を低くしてもよい。
例えば、ドライバ信頼度算出部16は、ドライバ状態管理部8cによってドライバの注意力が適切に管理されていない場合、適切に管理されている場合に比べてドライバ状態管理部8cの信頼度を低くしてもよい。ドライバの注意力が適切に管理されている場合とは、ドライバが報知部8bを通じた注意喚起に応じていたり、ドライバが車両Mの走行状態及び周囲の状況等を自ら確認していたりする場合が挙げられる。なお、ドライバが注意喚起に応じているか及び車両Mの走行状態等を確認しているか否かは、状態検出部8aの検出結果に基づいて判断することができる。
ドライバ信頼度算出部16は、上述したドライバ状態管理部8cの信頼度の複数の算出方法に基づいて算出された複数の信頼度に基づいて、ドライバ状態管理部8cの信頼度を算出してもよい。
信頼度補正部17は、ドライバ信頼度算出部16で算出されたドライバ状態管理部8cの信頼度に基づいて、第1信頼度算出部14bで算出された第1走行計画の信頼度を補正する。信頼度補正部17は、ドライバ状態管理部8cの信頼度が低い場合、第1走行計画の信頼度が低くなるように補正する。例えば、ドライバ信頼度算出部16によって算出されるドライバ状態管理部8cの信頼度が0以上1以下の値で表される場合、信頼度補正部17は、第1走行計画の信頼度にドライバ状態管理部8cの信頼度の値を乗ずることによって、第1走行計画の信頼度を補正してもよい。
選択部18は、信頼度補正部17で補正された第1走行計画の信頼度と、第2信頼度算出部15bで算出された第2走行計画の信頼度とを比較し、第1走行計画及び第2走行計画のうち、走行計画の信頼度が高い走行計画を選択する。
走行制御部19は、選択部18で選択された走行計画に基づいて、車両Mの自動運転制御を実行する。具体的には、走行制御部19は、走行計画に応じた制御信号をアクチュエータ7に出力する。これにより、走行制御部19は、走行計画に沿って車両Mが自動走行するように、車両Mの走行を制御する。
次に、ECU6で実行される処理の流れについて、図2のフローチャートを用いて説明する。なお、この処理は、車両Mのドライバによって自動運転制御の実行が指示された場合にECU6によって実行される。ECU6は、フローチャートの処理がエンドに至った場合、再びスタートから処理を繰り返す。ECU6は、車両Mのドライバによって自動運転制御の実行が取り消された場合に、図2に示す処理を終了する。
図2に示すように、位置認識部11は、車両Mの位置を認識する(S101)。環境認識部12は、車両Mの周辺環境を認識する(S102)。車両状態認識部13は、車両Mの状態を認識する(S103)。S101〜S103の処理順序は、この並び順で実行されることに限定されず、並行して処理が実行されていてもよい。第1計画部14aは、位置認識部11等の認識結果に基づいて第1走行計画を生成する(S104)。第1信頼度算出部14bは、生成された第1走行計画の信頼度を算出する(S105)。
ドライバ信頼度算出部16は、状態検出部8aの検出の信頼度等に基づいて、ドライバ状態管理部8cの信頼度を算出する(S106)。信頼度補正部17は、ドライバ状態管理部8cの信頼度に基づいて、第1走行計画の信頼度を補正する(S107)。第2計画部15aは、車両Mの状態に基づいて車両Mの第2走行計画を生成する(S108)。第2信頼度算出部15bは、生成された第2走行計画の信頼度を算出する(S109)。なお、S104〜S107の処理とS108〜S109の処理とは、S104〜S107の処理の後にS108〜S109の処理を行うことに限定されない。例えば、S104〜S107の処理と、S108〜S109の処理とが並行して実行されていてもよい。
選択部18は、補正された第1走行計画の信頼度と第2走行計画の信頼度とを比較し、走行計画の信頼度が高い走行計画を選択する(S110)。走行制御部19は、選択部18で選択された走行計画に基づいて車両Mの自動運転制御を実行する(S111)。
本実施形態は以上のように構成され、この自動運転システム100において走行制御部19は、第1走行計画及び第2走行計画のうち走行計画の信頼度が高い走行計画に基づいて車両Mの自動運転制御を行う。ここで、第1計画部14aは、位置認識部11、環境認識部12、及び車両状態認識部13における全ての認識結果を用いて第1走行計画を生成する。このため、例えば、位置認識部11、環境認識部12及び車両状態認識部13のいずれかの認識結果の信頼度が低下した場合、これらの結果を全て用いて生成される第1走行計画の信頼度は低下する。
一方、第2計画部15aは、第1計画部14aよりも少ない種類の認識結果に基づいて第2走行計画を生成する。具体的には、第2計画部15aは、位置認識部11及び環境認識部12の認識結果を用いずに、車両状態認識部13の認識結果に基づいて第2走行計画を生成する。第2走行計画は第1走行計画よりも少ない種類の認識結果に基づいて生成されるため、信頼度が低下した認識結果を用いずに第2走行計画を生成している場合には、認識結果の信頼度の低下の影響を受けることなく、第2走行計画が生成される。このようにして第2走行計画が生成される場合、信頼度が低下した認識結果を用いていないため、認識結果の信頼度の低下に起因して第2走行計画の信頼度が低下することはない。具体的には、位置認識部11の認識結果及び環境認識部12の認識結果が低下したとしても、これらの認識結果を用いずに第2走行計画が生成されているため、第2走行計画の生成に関して信頼度の低下の影響を受けることが無い。
このため、位置認識部11、及び環境認識部12のいずれかの認識結果の信頼度の低下に伴って第1走行計画の信頼度が低下し、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じた場合、選択部18によって第2走行計画が選択される。このように、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じたとしても、ドライバが運転操作を引き継ぐまでの間、第2走行計画に基づいて車両Mの自動運転制御が継続される。第2走行計画は、運転操作をドライバに容易に引き継ぐことができることを目的として生成されている。このため、車両Mが第2走行計画に基づいて自動運転制御が行われている状態では、ドライバは運転操作を容易に引き継ぐことができる。以上のように、自動運転システム100では、第1走行計画に基づく自動運転制御が困難となりドライバに運転操作を引き継ぐ場合であっても、第2走行計画に基づいて自動運転制御が継続されるため、ドライバに運転操作を引き継ぐための時間を長く確保することができる。そしてドライバは、第2走行計画に基づいて自動運転制御が行われている状態から、容易に運転操作を引き継ぐことができる。
第1走行計画は、ドライバ状態管理部8cの信頼度が高い状態、すなわち、状態検出部8a、報知部8b、及びドライバ状態管理部8cが正常に作動しており、更にドライバの注意力が適切に管理されている状態であることを前提として生成されている。このため、ドライバ状態管理部8cの信頼度が低下した場合に、信頼度補正部17が第1走行計画の信頼度を低く補正することで、選択部18によって第2走行計画が選択され易くなる。このように、ドライバ状態管理部8cの信頼度に基づいて第1走行計画の信頼度を補正することで、第1走行計画に基づいて車両Mの自動運転制御が行われることが抑制される。従って、ドライバ状態管理部8cの信頼度が低下することに伴って第1走行計画に基づく自動運転制御を終了させる場合であっても、第2走行計画に基づいて自動運転制御が行われるため、ドライバに運転操作を引き継ぐための時間を長く確保することができる。
なお、第2走行計画は、第1走行計画と異なり、運転操作をドライバに容易に引き継ぐことができることを目的として生成されている。このため、第2走行計画に基づいて自動運転制御が行われている状態から、ドライバに容易に運転操作を引き継ぐことができるため、ドライバ状態管理部8cの信頼度が低下しても第2走行計画の信頼度を補正しなくてもよい。
(第1変形例)
次に、第1変形例として、第2演算部15における第2走行計画の生成方法の変形例、及び第2信頼度算出部15bにおける第2走行計画の信頼度の算出の変形例について説明する。第1変形例において、第2計画部15aは、位置認識部11で認識された車両Mの位置、環境認識部12で認識された周辺環境、車両状態認識部13で認識された車両Mの状態、及び地図データベース4の地図情報に基づいて、ナビゲーションシステム5により設定された目標ルートに沿って走行するように車両Mの第2走行計画を生成する。なお、第2計画部15aは、第2走行計画を生成する際に、第1走行計画よりも単位時間当たりの車両Mの加減速度の変化量及び操舵の変化量の少なくとも一方が小さくなるように第2走行計画を生成する。すなわち、第2走行計画は、第1走行計画と比較して車両Mの動きが大きく変化しない走行計画となる。
第2信頼度算出部15bは、位置認識部11で認識された車両Mの位置の信頼度、環境認識部12で認識された車両Mの周辺環境の認識の信頼度、車両状態認識部13で認識された車両Mの状態の認識の信頼度、及び第2計画部15aで生成された第2走行計画の少なくともいずれかに基づいて第2走行計画の信頼度を算出する。この第2信頼度算出部15bで行われる第2走行計画の信頼度の算出は、実施形態における第1信頼度算出部14bと同様に算出することができる。更に、第2信頼度算出部15bは、算出した第2走行計画の信頼度に対して補正を行い、補正後の第2走行計画の信頼度を第2走行計画における信頼度とする。また、第2信頼度算出部15bは、第2走行計画の信頼度の補正を行う際に、第2走行計画の信頼度が小さくなるように補正を行う。例えば、第2信頼度算出部15bは、算出した第2走行計画の信頼度に対して所定の係数を用いて補正を行うことによって第2走行計画の信頼度を算出してもよい。
第1変形例に示す場合においても、自動運転システム100において走行制御部19は、第1走行計画及び第2走行計画のうち走行計画の信頼度が高い走行計画に基づいて車両Mの自動運転制御を行う。ここで、第1計画部14aは、位置認識部11、環境認識部12及び車両状態認識部13の認識結果を用いて第1走行計画を生成する。例えば、位置認識部11、環境認識部12及び車両状態認識部13のいずれかの認識結果の信頼度が低下した場合、認識結果の信頼度の低下に伴って、第1走行計画の信頼度は低下する。一方、第2計画部15aは、第1計画部14aと同じ認識結果を用いるものの、第1走行計画よりも単位時間当たりの車両Mの加減速度の変化量及び操舵の変化量の少なくとも一方が小さい第2走行計画を生成する。すなわち、第2計画部15aは、第1走行計画と比べて、車両Mの状態を大きく変化させずに車両Mを走行させる第2走行計画を生成する。
車両Mの状態を大きく変化させない場合には、例えば、車両Mの状態を大きく変化させる場合と比べて車両Mの周辺環境の認識精度が低くても走行計画を生成できる。このため、第2計画部15aは、第1計画部14aが第1走行計画を生成する場合と比べて、位置認識部11、環境認識部12及び車両状態認識部13における認識結果の信頼度が低くても第2走行計画を生成することができる。また、認識結果の信頼度が低くても第2走行計画の生成を行うことができるため、認識結果の信頼度が低下したとしても、第1走行計画と比べて第2走行計画の信頼度に与える影響は小さい。
このため、位置認識部11、環境認識部12及び車両状態認識部13のいずれかの認識結果の信頼度の低下に伴って第1走行計画の信頼度が低下し、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じても、ドライバが運転操作を引き継ぐまでの間、第2走行計画に基づいて車両Mの自動運転制御が継続される。このように、第1変形例において自動運転システム100は、第1走行計画に基づく自動運転制御が困難となりドライバに運転操作を引き継ぐ場合であっても、第2走行計画に基づいて自動運転制御が継続されるため、ドライバに運転操作を引き継ぐための時間を長く確保することができる。そしてドライバは、第2走行計画に基づいて自動運転制御が行われている状態から、容易に運転操作を引き継ぐことができる。
(第2変形例)
次に、第2変形例として、第2演算部15における第2走行計画の生成方法の変形例、及び第2信頼度算出部15bにおける第2走行計画の信頼度の算出の変形例について説明する。第2変形例において、第2計画部15aは、第1計画部14aで生成された過去の第1走行計画に基づいて第2走行計画を生成する。
ここで、第2計画部15aが過去の第1走行計画に基づいて第2走行計画を生成する第1の例について説明する。第2計画部15aは、第1演算部14から第1走行計画及び第1走行計画の信頼度をこれらが生成及び算出される毎に取得する。そして、第2計画部15aは、取得した第1走行計画の信頼度が所定の値以下となる直前の第1走行計画を第2走行計画として用いる。また、第2信頼度算出部15bは、第2計画部15aによって第2走行計画として用いられた第1走行計画の信頼度を補正し、補正した第1走行計画の信頼度を第2走行計画の信頼度とすることができる。
なお、第2走行計画は、過去に生成された第1走行計画を用いて生成されるため、第2走行計画の信頼度は、第2走行計画を生成する際に用いた第1走行計画の信頼度よりも低くなる。このため、第2信頼度算出部15bは、第2走行計画を生成するために用いられた第1走行計画の信頼度に対し、所定の補正係数を乗算する等によって信頼度が低くなるように補正し、補正後の第1走行計画の信頼度を第2走行計画の信頼度とする。なお、第1走行計画の信頼度を低く補正する際に、現在から時間が経過しているほど(古いほど)、信頼度が低くなるように補正してもよい。
次に、第2計画部15aが過去の第1走行計画に基づいて第2走行計画を生成する第2の例について説明する。第2計画部15aは、第1演算部14から第1走行計画及び第1走行計画の信頼度をこれらが生成及び算出される毎に取得する。第2計画部15aは、現在から所定時間前までの間に取得された第1走行計画の信頼度のうち、最も信頼度が高い第1走行計画を第2走行計画として用いる。なお、第2計画部15aは、時間経過に伴って値が小さくなるように第1走行計画の信頼度を補正し、補正後の信頼度が最も高い第1走行計画を第2走行計画として用いてもよい。
第2信頼度算出部15bは、第2走行計画として用いられた第1走行計画の信頼度が低くなるように補正し、補正した第1走行計画の信頼度を第2走行計画の信頼度とすることができる。なお、第1走行計画の信頼度を低く補正する際に、現在から時間が経過しているほど(古いほど)、信頼度が低くなるように補正してもよい。
なお、過去の第1走行計画に基づいて第2走行計画を生成する例として、第1の例及び第2の例を示したが、過去の第1走行計画に基づいていれば、これら以外の方法によって第2走行計画を生成してもよい。
第2変形例に示す場合においても、自動運転システム100において走行制御部19は、第1走行計画及び第2走行計画のうち走行計画の信頼度が高い走行計画に基づいて車両Mの自動運転制御を行う。ここで、第1計画部14aは、位置認識部11、環境認識部12及び車両状態認識部13の認識結果を用いて第1走行計画を生成する。例えば、位置認識部11、環境認識部12及び車両状態認識部13のいずれかの認識結果の信頼度が低下した場合、認識結果の信頼度の低下に伴って、即座に第1走行計画の信頼度が低下する。一方、第2計画部15aは、第1計画部14aで過去に生成された第1走行計画に基づいて第2走行計画を生成する。また、第2信頼度算出部15bは、過去に生成された第1走行計画の信頼度に基づいて第2走行計画の信頼度を算出するため、位置認識部11における認識結果等の信頼度が低下しても、第2走行計画の信頼度は即座には低下しない。このため、位置認識部11における認識結果等の信頼度が低下することに伴って第1走行計画の信頼度が低下した場合には、選択部18によって第2走行計画が選択される。
このように、位置認識部11、環境認識部12及び車両状態認識部13のいずれかの認識結果の信頼度の低下に伴って第1走行計画の信頼度が低下し、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じても、ドライバが運転操作を引き継ぐまでの間、第2走行計画に基づいて車両Mの自動運転制御が継続される。なお、第2走行計画は、過去に生成された第1走行計画に基づいて生成されるため、第2走行計画の信頼度は一般に低くなる。しかしながら、第1走行計画に基づく自動運転制御が困難となって自動運転制御を停止するよりも、信頼度が低くても第2走行計画に基づいて自動運転制御を継続することで、ドライバが運転操作を引き継ぐまでの時間を確保することができる。
このように、自動運転システムは、第1走行計画に基づく自動運転制御が困難となりドライバに運転操作を引き継ぐ場合であっても、第2走行計画に基づいて自動運転制御が継続されるため、ドライバに運転操作を引き継ぐための時間を長く確保することができる。そしてドライバは、第2走行計画に基づいて自動運転制御が行われている状態から、容易に運転操作を引き継ぐことができる。
なお、第2変形例において第2計画部15aは、過去の第1走行計画をそのまま第2走行計画としても用いるのではなく、単位時間当たりの車両Mの加減速度の変化量及び操舵の変化量の少なくとも一方が小さくなるように第1走行計画を補正し、補正後の第1走行計画を第2走行計画としてもよい。
(第3変形例)
次に、第3変形例として、第2演算部15における第2走行計画の生成方法の変形例、及び第2信頼度算出部15bにおける第2走行計画の信頼度の算出の変形例について説明する。第3変形例は、環境認識部12において周辺環境が認識できなくなった場合において、第2計画部15aが第2走行計画を生成する例である。第3変形例において、第2計画部15aは、環境認識部12において周辺環境が認識できなくなる直前の周辺環境の認識結果と、位置認識部11で認識された車両Mの位置、車両状態認識部13で認識された車両Mの状態、及び地図データベース4の地図情報に基づいて、ナビゲーションシステム5により設定された目標ルートに沿って走行するように生成する車両Mの第2走行計画のうち、経路の計画を生成する。例えば、環境認識部12において周辺環境が認識できなくなる直前の認識結果とは、環境認識部12が認識する車両Mの周辺環境の認識の信頼度が所定値以下となる直前の認識結果とすることができる。
なお、第2計画部15aは、第2走行計画の経路の計画を生成する際に、第1走行計画よりも単位時間当たりの車両Mの操舵の変化量が小さくなるように経路の計画を生成する。すなわち、第2走行計画は、第1走行計画と比較して車両Mの動きが大きく変化しない走行計画となる。
第2計画部15aは、第2走行計画のうち速度の計画として、例えば、生成した経路の曲率に基づいて車両Mを減速させる速度の計画、一定の減速度に基づいて車両Mを減速させる速度の計画、或いは急な動作を防ぐために加加速度(ジャーク)を抑制した速度の計画を生成する。また、速度の計画は、地図情報(カーブの曲率等)に基づいて速度が調整されていてもよい。
第2信頼度算出部15bは、第2計画部15aで生成された第2走行計画の信頼度を算出する。例えば、第2信頼度算出部15bは、位置認識部11で認識された車両Mの位置の信頼度、車両状態認識部13で認識された車両Mの状態の認識の信頼度、及び第2計画部15aで生成された第2走行計画の少なくともいずれかに基づいて第2走行計画の信頼度を算出する。
例えば、第2信頼度算出部15bは、第2計画部15aにおける第2走行計画の生成周期に基づいて、実施形態において説明した第1信頼度算出部14bと同様に、第2走行計画の信頼度を算出してもよい。例えば、第2信頼度算出部15bは、位置認識部11及び車両状態認識部13で算出された車両Mの位置の信頼度及び車両Mの状態の認識の信頼度に基づいて、実施形態において説明した第1信頼度算出部14bと同様に、第2走行計画の信頼度を算出してもよい。
このように、環境認識部12において周辺環境が認識できなくなったとしても、第2演算部15において第2走行計画の生成及び第2走行計画の信頼度の算出を行うことができる。環境認識部12において周辺環境が認識できなくなると、第1走行計画を生成することができなくなり、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じる。この場合、選択部18によって第2計画部15aで生成された第2走行計画が選択され、第2走行計画に基づいて車両Mの自動運転制御が実行される。このように、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じたとしても、ドライバが運転操作を引き継ぐまでの間、第2走行計画に基づいて車両Mの自動運転制御が継続される。以上のように、自動運転システム100では、第1走行計画に基づく自動運転制御が困難となりドライバに運転操作を引き継ぐ場合であっても、第2走行計画に基づいて自動運転制御が継続されるため、ドライバに運転操作を引き継ぐための時間を長く確保することができる。そしてドライバは、第2走行計画に基づいて自動運転制御が行われている状態から、容易に運転操作を引き継ぐことができる。
(第4変形例)
次に、第4変形例として、第2演算部15における第2走行計画の生成方法の変形例、及び第2信頼度算出部15bにおける第2走行計画の信頼度の算出の変形例について説明する。第4変形例は、位置認識部11において車両Mの位置が認識できなくなった場合において、第2計画部15aが第2走行計画を生成する例である。第4変形例において、第2計画部15aは、位置認識部11において車両Mの位置が認識できなくなる直前に第1計画部14aにおいて生成された第1走行計画に基づいて、第2走行計画の経路の計画を生成する。ここでは、車両Mの位置が認識できなくなる直前に生成された第1走行計画は正しいとして、第1走行計画の経路の計画を第2走行計画の経路の計画として用いる。また、第2計画部15aは、車両Mの位置が認識できなくなる直前の第1走行計画に限定されず、位置認識部11において車両Mの位置が認識できなくなったときから所定時間前までの間に生成された第1走行計画のうち、最も走行計画の信頼度が高い第1走行計画を用いて、第2走行計画の経路の計画を生成してもよい。
第2計画部15aは、第2走行計画の経路の計画を生成する際に、第1走行計画よりも単位時間当たりの車両Mの操舵の変化量が小さくなるように第1走行計画の経路の計画を補正し、補正した経路の計画を第2走行計画の経路の計画として用いてもよい。
第2計画部15aは、第2走行計画のうち速度の計画として、例えば、環境認識部12で認識された周辺の車両と車両Mとの車間距離或いは車間時間等に基づいて速度の計画を生成する。この場合、第2計画部15aは、第1計画部14aにおいて生成される第1走行計画よりも、車間時間或いは車間距離等が長くなるように速度の計画を生成する。また、第2計画部15aは、生成した経路の曲率に基づいて車両Mを減速させる速度の計画、一定の減速度に基づいて車両Mを減速させる速度の計画、或いは急な動作を防ぐために加加速度(ジャーク)を抑制した速度の計画を生成する。
第2信頼度算出部15bは、第2計画部15aで生成された第2走行計画の信頼度を算出する。例えば、第2信頼度算出部15bは、環境認識部12で認識された車両Mの周辺環境の認識の信頼度、車両状態認識部13で認識された車両Mの状態の認識の信頼度、及び第2計画部15aで生成された第2走行計画の少なくともいずれかに基づいて第2走行計画の信頼度を算出する。
例えば、第2信頼度算出部15bは、第2計画部15aにおける第2走行計画の生成周期に基づいて、実施形態において説明した第1信頼度算出部14bと同様に、第2走行計画の信頼度を算出してもよい。例えば、第2信頼度算出部15bは、環境認識部12及び車両状態認識部13で算出された車両Mの周辺環境の認識の信頼度及び車両Mの状態の認識の信頼度に基づいて、実施形態において説明した第1信頼度算出部14bと同様に、第2走行計画の信頼度を算出してもよい。
或いは、第2信頼度算出部15bは、第1走行計画の信頼度に基づいて、第2走行計画の信頼度を生成してもよい。この場合、第2信頼度算出部15bは、上述した第2変形例における第1の例のように、第2走行計画を生成するために用いられた第1走行計画の信頼度に対し、所定の補正係数を乗算する等によって信頼度が低くなるように補正し、補正後の第1走行計画の信頼度を第2走行計画の信頼度としてもよい。
このように、位置認識部11において車両Mの位置が認識できなくなったとしても、第2演算部15において第2走行計画の生成及び第2走行計画の信頼度の算出を行うことができる。位置認識部11において車両Mの位置が認識できなくなると、第1走行計画を生成することができなくなり、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じる。この場合、選択部18によって第2計画部15aで生成された第2走行計画が選択され、第2走行計画に基づいて車両Mの自動運転制御が実行される。このように、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じたとしても、ドライバが運転操作を引き継ぐまでの間、第2走行計画に基づいて車両Mの自動運転制御が継続される。以上のように、自動運転システム100では、第1走行計画に基づく自動運転制御が困難となりドライバに運転操作を引き継ぐ場合であっても、第2走行計画に基づいて自動運転制御が継続されるため、ドライバに運転操作を引き継ぐための時間を長く確保することができる。そしてドライバは、第2走行計画に基づいて自動運転制御が行われている状態から、容易に運転操作を引き継ぐことができる。
(第5変形例)
次に、第5変形例として、第2演算部15における第2走行計画の生成方法の変形例、及び第2信頼度算出部15bにおける第2走行計画の信頼度の算出の変形例について説明する。第5変形例は、位置認識部11において車両Mの位置が認識できなくなり、且つ環境認識部12における周辺環境の認識ができなくなった場合において、第2計画部15aが第2走行計画を生成する例である。第5変形例において、第2計画部15aは、位置認識部11及び環境認識部12において認識できなくなる直前に第1計画部14aにおいて生成された第1走行計画に基づいて、第2走行計画の経路の計画を生成する。
ここでは、位置認識部11及び環境認識部12において認識ができなくなる直前に生成された第1走行計画は正しいとして、第1走行計画の経路の計画を第2走行計画の経路の計画として用いる。また、第2計画部15aは、位置認識部11及び環境認識部12において認識ができなくなる直前の第1走行計画に限定されず、位置認識部11及び環境認識部12において認識ができなくなったときから所定時間前までの間に生成された第1走行計画のうち、最も走行計画の信頼度が高い第1走行計画を用いて、第2走行計画の経路の計画を生成してもよい。
第2計画部15aは、第2走行計画の経路の計画を生成する際に、第1走行計画よりも単位時間当たりの車両Mの操舵の変化量が小さくなるように第1走行計画の経路の計画を補正し、補正した経路の計画を第2走行計画の経路の計画として用いてもよい。
また、第2計画部15aは、生成した経路の曲率に基づいて車両Mを減速させる速度の計画、一定の減速度に基づいて車両Mを減速させる速度の計画、或いは急な動作を防ぐために加加速度(ジャーク)を抑制した速度の計画を生成する。
第2信頼度算出部15bは、第2計画部15aで生成された第2走行計画の信頼度を算出する。例えば、第2信頼度算出部15bは、車両状態認識部13で認識された車両Mの状態の認識の信頼度、及び第2計画部15aで生成された第2走行計画の少なくともいずれかに基づいて第2走行計画の信頼度を算出する。
例えば、第2信頼度算出部15bは、第2計画部15aにおける第2走行計画の生成周期に基づいて、実施形態において説明した第1信頼度算出部14bと同様に、第2走行計画の信頼度を算出してもよい。例えば、第2信頼度算出部15bは、車両状態認識部13で算出された車両Mの状態の認識の信頼度に基づいて、実施形態において説明した第1信頼度算出部14bと同様に、第2走行計画の信頼度を算出してもよい。
或いは、第2信頼度算出部15bは、第1走行計画の信頼度に基づいて、第2走行計画の信頼度を生成してもよい。この場合、第2信頼度算出部15bは、上述した第2変形例における第1の例のように、第2走行計画を生成するために用いられた第1走行計画の信頼度に対し、所定の補正係数を乗算する等によって信頼度が低くなるように補正し、補正後の第1走行計画の信頼度を第2走行計画の信頼度としてもよい。
このように、位置認識部11及び環境認識部12において認識できなくなったとしても、第2演算部15において第2走行計画の生成及び第2走行計画の信頼度の算出を行うことができる。位置認識部11及び環境認識部12において認識ができなくなると、第1走行計画を生成することができなくなり、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じる。この場合、選択部18によって第2計画部15aで生成された第2走行計画が選択され、第2走行計画に基づいて車両Mの自動運転制御が実行される。このように、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じたとしても、ドライバが運転操作を引き継ぐまでの間、第2走行計画に基づいて車両Mの自動運転制御が継続される。以上のように、自動運転システム100では、第1走行計画に基づく自動運転制御が困難となりドライバに運転操作を引き継ぐ場合であっても、第2走行計画に基づいて自動運転制御が継続されるため、ドライバに運転操作を引き継ぐための時間を長く確保することができる。そしてドライバは、第2走行計画に基づいて自動運転制御が行われている状態から、容易に運転操作を引き継ぐことができる。
以上、本発明の実施形態及び種々の変形例ついて説明したが、本発明は、上記実施形態及び種々の変形例に限定されるものではない。例えば、自動運転システム100は、2つの走行計画(第1走行計画及び第2走行計画)のうち、走行計画の信頼度の高い走行計画を選択して自動運転制御を実行したが、3つの走行計画の中から走行計画の信頼度が最も高い走行計画を選択して自動運転制御を実行してもよい。例えば、図3に示す自動運転システム100Aのように、ECU6Aは、第1演算部14、第2演算部15及び第3演算部20を備えていてもよい。第3演算部20は、第2演算部15と同様に、第3走行計画を生成し、第3走行計画の信頼度を算出する。第3演算部20は、第3計画部20a、及び第3信頼度算出部20bを備えている。第3計画部20aは、第2計画部15aと同様に、第3走行計画として、第3走行計画に基づいて自動運転制御が行われている状態から、運転操作をドライバに容易に引き継ぐことができることを目的とした走行計画を生成する。第3信頼度算出部20bは、第2信頼度算出部15bと同様に、第3走行計画の信頼度を算出する。
第2演算部15及び第3演算部20は、上記の実施形態及び第1〜第5変形例で説明した種々の第2走行計画の生成方法及び第2走行計画の信頼度の算出方法のうち、いずれかの方法を用いて、第2走行計画及び第2走行計画の信頼度と、第3走行計画及び第3走行計画の信頼度とをそれぞれ生成及び算出する。選択部18は、第1計画部14aで生成された第1走行計画、第2計画部15aで生成された第2走行計画、及び第3計画部20aで生成された第3走行計画のうち、走行計画の信頼度が最も高い走行計画を選択する。この場合においても、第1走行計画に基づく自動運転制御が困難となってドライバに運転操作を引き継ぐ状況が生じたとしても、ドライバが運転操作を引き継ぐまでの間、第2走行計画又は第3走行計画に基づいて車両Mの自動運転制御を継続することができる。そしてドライバは、第2走行計画又は第3走行計画に基づいて自動運転制御が行われている状態から、容易に運転操作を引き継ぐことができる。
なお、図1及び図3に示す自動運転システム100,100Aでは、2つ又は3つの走行計画の中から走行計画の信頼度が最も高い走行計画を選択して自動運転制御を行ったが、4つ以上の走行計画の中から走行計画の信頼度が最も高い走行計画を選択して自動運転制御を行ってもよい。
なお、自動運転システム100,100Aにおいて、第1走行計画の信頼度をドライバ状態管理部8cの信頼度に基づいて補正することは必須では無く、ドライバ信頼度算出部16及び信頼度補正部17が設けられていなくてもよい。この場合、選択部18は、補正されていない第1走行計画の信頼度を用いて、走行計画の選択を行う。
また、実施形態及び種々の変形例において、第1計画部14aは、位置認識部11で認識された車両Mの位置を用いずに、車両Mの位置以外の認識結果に基づいて第1走行計画を生成してもよい。
なお、実施形態において、第2計画部15aは、車両状態認識部13で認識された車両Mの状態に基づいて、車両Mの第2走行計画を生成したが、車両状態認識部13の認識結果のみを用いて第2走行計画を生成することに限定されない。例えば、第2計画部15aは、位置認識部11で認識された車両Mの位置、環境認識部12で認識された車両Mの周辺環境、及び車両状態認識部13で認識された車両Mの状態のうち、1つ又は2つに基づいて第2走行計画を生成してもよい。そして、第2信頼度算出部15bは、位置認識部11で認識された車両Mの位置、環境認識部12で認識された車両Mの周辺環境、及び車両状態認識部13で認識された車両Mの状態のうち、第2計画部15aが第2走行計画を生成する際に用いた認識結果の信頼度、及び第2走行計画の少なくともいずれかに基づいて第2走行計画の信頼度を算出してもよい。
1…GPS受信部(位置測定部)、2…外部センサ、3…内部センサ、8a…状態検出部、8b…報知部、8c…ドライバ状態管理部、11…位置認識部、12…環境認識部、13…車両状態認識部、14a…第1計画部、14b…第1信頼度算出部、15a…第2計画部、15b…第2信頼度算出部、16…ドライバ信頼度算出部、17…信頼度補正部、18…選択部、19…走行制御部、100,100A…自動運転システム、M…車両。

Claims (4)

  1. 車両の自動運転制御を行う自動運転システムであって、
    前記車両の位置測定部の測定結果に基づいて、前記車両の位置を認識する位置認識部と、
    前記車両の外部状況を検出する外部センサの検出結果に基づいて、前記車両の周辺環境を認識する環境認識部と、
    前記車両の状態を検出する内部センサの検出結果に基づいて、前記車両の状態を認識する車両状態認識部と、
    認識された前記車両の位置、認識された前記車両の周辺環境、及び認識された前記車両の状態に基づいて、前記車両の第1走行計画を生成する第1計画部と、
    認識された前記車両の位置の信頼度、認識された前記車両の周辺環境の認識の信頼度、認識された前記車両の状態の認識の信頼度、及び生成された前記第1走行計画の生成周期、及び前記第1走行計画と予め定められた走行計画のパターンとの一致度の少なくともいずれかに基づいて、前記第1走行計画の信頼度を算出する第1信頼度算出部と、
    認識された前記車両の位置、認識された前記車両の周辺環境、及び認識された前記車両の状態のうち、1つ又は2つに基づいて前記車両の第2走行計画を生成する第2計画部と、
    認識された前記車両の位置、認識された前記車両の周辺環境、及び認識された前記車両の状態のうち、前記第2計画部が前記第2走行計画を生成する際に用いた認識結果の信頼度、及び生成された前記第2走行計画の生成周期、及び前記第2走行計画と予め定められた走行計画のパターンとの一致度の少なくともいずれかに基づいて、前記第2走行計画の信頼度を算出する第2信頼度算出部と、
    前記第1走行計画の前記信頼度と前記第2走行計画の前記信頼度とを比較し、前記第1走行計画及び前記第2走行計画のうち、走行計画の前記信頼度が高い走行計画を選択する選択部と、
    前記選択部で選択された前記走行計画に基づいて、前記車両の自動運転制御を行う走行制御部と、を備える自動運転システム。
  2. 車両の自動運転制御を行う自動運転システムであって、
    前記車両の位置測定部の測定結果に基づいて、前記車両の位置を認識する位置認識部と、
    前記車両の外部状況を検出する外部センサの検出結果に基づいて、前記車両の周辺環境を認識する環境認識部と、
    前記車両の状態を検出する内部センサの検出結果に基づいて、前記車両の状態を認識する車両状態認識部と、
    認識された前記車両の位置、認識された前記車両の周辺環境、及び認識された前記車両の状態に基づいて、前記車両の第1走行計画を生成する第1計画部と、
    認識された前記車両の位置の信頼度、認識された前記車両の周辺環境の認識の信頼度、認識された前記車両の状態の認識の信頼度、及び生成された前記第1走行計画の生成周期、及び前記第1走行計画と予め定められた走行計画のパターンとの一致度の少なくともいずれかに基づいて、前記第1走行計画の信頼度を算出する第1信頼度算出部と、
    認識された前記車両の位置、認識された前記車両の周辺環境、及び認識された前記車両の状態に基づいて、前記第1走行計画よりも単位時間当たりの前記車両の加減速度の変化量及び操舵の変化量の少なくとも一方が小さくなるように第2走行計画を生成する第2計画部と、
    認識された前記車両の位置の信頼度、認識された前記車両の周辺環境の認識の信頼度、認識された前記車両の状態の認識の信頼度、及び生成された前記第2走行計画の生成周期、及び前記第2走行計画と予め定められた走行計画のパターンとの一致度の少なくともいずれかに基づいて前記第2走行計画の信頼度を算出する第2信頼度算出部と、
    前記第1走行計画の前記信頼度と前記第2走行計画の前記信頼度とを比較し、前記第1走行計画及び前記第2走行計画のうち、走行計画の前記信頼度が高い走行計画を選択する選択部と、
    前記選択部で選択された前記走行計画に基づいて、前記車両の自動運転制御を行う走行制御部と、を備える自動運転システム。
  3. 車両の自動運転制御を行う自動運転システムであって、
    前記車両の位置測定部の測定結果に基づいて、前記車両の位置を認識する位置認識部と、
    前記車両の外部状況を検出する外部センサの検出結果に基づいて、前記車両の周辺環境を認識する環境認識部と、
    前記車両の状態を検出する内部センサの検出結果に基づいて、前記車両の状態を認識する車両状態認識部と、
    認識された前記車両の位置、認識された前記車両の周辺環境、及び認識された前記車両の状態に基づいて、前記車両の第1走行計画を生成する第1計画部と、
    認識された前記車両の位置の信頼度、認識された前記車両の周辺環境の認識の信頼度、認識された前記車両の状態の認識の信頼度、及び生成された前記第1走行計画の生成周期、及び前記第1走行計画と予め定められた走行計画のパターンとの一致度の少なくともいずれかに基づいて、前記第1走行計画の信頼度を算出する第1信頼度算出部と、
    前記第1計画部で生成された過去の前記第1走行計画に基づいて第2走行計画を生成する第2計画部と、
    前記第2計画部が前記第2走行計画を生成する際に用いた前記過去の第1走行計画の前記信頼度に基づいて、前記第2走行計画の信頼度を算出する第2信頼度算出部と、
    前記第1走行計画の前記信頼度と前記第2走行計画の前記信頼度とを比較し、前記第1走行計画及び前記第2走行計画のうち、走行計画の前記信頼度が高い走行計画を選択する選択部と、
    前記選択部で選択された前記走行計画に基づいて、前記車両の自動運転制御を行う走行制御部と、を備える自動運転システム。
  4. 前記車両のドライバの状態を検出する状態検出部の検出結果に基づいて前記ドライバに対して報知部を通じて報知を行うことにより、前記車両の走行に対する前記ドライバの注意力を管理するドライバ状態管理部と、
    前記状態検出部の検出の信頼度、前記状態検出部の状態、前記報知部の状態、ドライバ状態管理部の状態、及び前記ドライバの注意力の管理状況の少なくともいずれかに基づいて、前記ドライバ状態管理部の信頼度を算出するドライバ信頼度算出部と、
    前記ドライバ状態管理部の信頼度に基づいて、前記第1走行計画の信頼度を補正する信頼度補正部と、を更に備える、請求項1〜3のいずれか一項に記載の自動運転システム。
JP2016045955A 2016-03-09 2016-03-09 自動運転システム Active JP6512140B2 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2016045955A JP6512140B2 (ja) 2016-03-09 2016-03-09 自動運転システム
US15/452,302 US10095227B2 (en) 2016-03-09 2017-03-07 Automatic driving system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2016045955A JP6512140B2 (ja) 2016-03-09 2016-03-09 自動運転システム

Publications (2)

Publication Number Publication Date
JP2017159789A JP2017159789A (ja) 2017-09-14
JP6512140B2 true JP6512140B2 (ja) 2019-05-15

Family

ID=59786678

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016045955A Active JP6512140B2 (ja) 2016-03-09 2016-03-09 自動運転システム

Country Status (2)

Country Link
US (1) US10095227B2 (ja)
JP (1) JP6512140B2 (ja)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10532736B2 (en) * 2015-11-06 2020-01-14 Honda Motor Co., Ltd. Vehicle travel control device
JP6539297B2 (ja) * 2017-03-31 2019-07-03 株式会社Subaru 車両の走行支援装置
JP6624150B2 (ja) 2017-04-11 2019-12-25 トヨタ自動車株式会社 自動運転システム
JP6971315B2 (ja) * 2017-06-30 2021-11-24 日立Astemo株式会社 情報管理装置
US20190120640A1 (en) 2017-10-19 2019-04-25 rideOS Autonomous vehicle routing
US10816990B2 (en) * 2017-12-21 2020-10-27 Baidu Usa Llc Non-blocking boundary for autonomous vehicle planning
JP2019156175A (ja) * 2018-03-13 2019-09-19 本田技研工業株式会社 車両制御装置、車両制御方法、及びプログラム
DE112018007121B4 (de) * 2018-03-23 2021-10-14 Mitsubishi Electric Corporation Pfaderzeugungseinrichtung und Fahrzeug-Steuerungssystem
JP7076348B2 (ja) * 2018-09-20 2022-05-27 日立Astemo株式会社 電子制御装置
CN110155231A (zh) * 2019-05-20 2019-08-23 清华大学 无人驾驶电动摩托车
US11763694B2 (en) 2020-07-22 2023-09-19 Toyota Research Institute, Inc. Systems and methods for training a driver about automated driving operation using a reliability model
CN114475631B (zh) * 2022-02-22 2023-03-24 阿波罗智能技术(北京)有限公司 驾驶数据处理方法装置、设备、自动驾驶车辆介质及产品
CN114701500B (zh) * 2022-03-30 2023-06-13 小米汽车科技有限公司 车辆变道方法、装置及介质

Family Cites Families (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4525670B2 (ja) 2006-11-20 2010-08-18 トヨタ自動車株式会社 走行制御計画生成システム
US9302678B2 (en) * 2006-12-29 2016-04-05 Robotic Research, Llc Robotic driving system
JP4737238B2 (ja) * 2008-06-20 2011-07-27 トヨタ自動車株式会社 運転支援装置
JP2011162132A (ja) 2010-02-12 2011-08-25 Toyota Motor Corp 自動運転装置
CN102939230B (zh) 2010-06-16 2015-05-20 丰田自动车株式会社 驾驶辅助装置
US20130274959A1 (en) 2010-12-15 2013-10-17 Toyota Jidosha Kabushiki Kaisha Driving support apparatus, driving support method, and vehicle
JP5609778B2 (ja) 2011-06-09 2014-10-22 トヨタ自動車株式会社 他車両認識装置及び進路評価装置
US20130197736A1 (en) * 2012-01-30 2013-08-01 Google Inc. Vehicle control based on perception uncertainty
US8457827B1 (en) 2012-03-15 2013-06-04 Google Inc. Modifying behavior of autonomous vehicle based on predicted behavior of other vehicles
JP2014106854A (ja) 2012-11-29 2014-06-09 Toyota Infotechnology Center Co Ltd 自動運転車両制御装置および方法
WO2014091611A1 (ja) * 2012-12-13 2014-06-19 株式会社日立製作所 自律走行装置
JP6217412B2 (ja) 2014-01-29 2017-10-25 アイシン・エィ・ダブリュ株式会社 自動運転支援装置、自動運転支援方法及びプログラム
JP6379551B2 (ja) 2014-03-19 2018-08-29 アイシン・エィ・ダブリュ株式会社 自動運転支援装置、自動運転支援方法及びプログラム
JP2015194798A (ja) 2014-03-31 2015-11-05 日産自動車株式会社 運転支援制御装置
US9404761B2 (en) * 2014-05-30 2016-08-02 Nissan North America, Inc. Autonomous vehicle lane routing and navigation
JP6326985B2 (ja) * 2014-06-04 2018-05-23 住友電気工業株式会社 自律運転制御装置、車両、コンピュータプログラム、及び自律運転制御方法
JP6354424B2 (ja) * 2014-07-29 2018-07-11 日産自動車株式会社 車両制御装置

Also Published As

Publication number Publication date
US10095227B2 (en) 2018-10-09
US20170261984A1 (en) 2017-09-14
JP2017159789A (ja) 2017-09-14

Similar Documents

Publication Publication Date Title
JP6512140B2 (ja) 自動運転システム
JP6624150B2 (ja) 自動運転システム
CN110395251B (zh) 一种基于多传感器融合数据的自动紧急制动决策方法
KR101901024B1 (ko) 지도 갱신 판정 시스템
US10754347B2 (en) Vehicle control device
CN110356377B (zh) 一种自动紧急制动的决策方法、车载设备及存储介质
JP6308233B2 (ja) 車両制御装置及び車両制御方法
JP6558282B2 (ja) 自動運転システム
CN112689588B (zh) 一种自动驾驶车辆的控制方法及装置
JP6380274B2 (ja) 自動運転車両用ナビゲーション装置
CN111762189B (zh) 车辆控制系统
US11900812B2 (en) Vehicle control device
US20160292998A1 (en) Vehicle traveling control device
CN110271543B (zh) 车辆控制装置、车辆控制方法及存储介质
JP6705388B2 (ja) 自動運転システム
US10754335B2 (en) Automated driving system
JP6720924B2 (ja) 車外報知装置
JP2019197467A (ja) 車両制御装置
KR20210070387A (ko) 자율 주행 차량들에 대한 폴백 거동들을 구현하기 위한 시스템
JPWO2018230530A1 (ja) 車両制御システム、車両制御方法、およびプログラム
CN115808923A (zh) 用于运载工具的方法和系统
CN114194186B (zh) 车辆行驶控制装置
CN115808924A (zh) 用于运载工具的方法和系统
CN110217228B (zh) 车辆控制装置、车辆控制方法及存储介质
JP2019040290A (ja) 自動運転装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20171026

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20180622

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20180703

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190122

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190219

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20190325

R151 Written notification of patent or utility model registration

Ref document number: 6512140

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151