JP7770295B2 - 走行経路決定装置及び自動運転システム - Google Patents

走行経路決定装置及び自動運転システム

Info

Publication number
JP7770295B2
JP7770295B2 JP2022196107A JP2022196107A JP7770295B2 JP 7770295 B2 JP7770295 B2 JP 7770295B2 JP 2022196107 A JP2022196107 A JP 2022196107A JP 2022196107 A JP2022196107 A JP 2022196107A JP 7770295 B2 JP7770295 B2 JP 7770295B2
Authority
JP
Japan
Prior art keywords
obstacle
travel
vehicle
information
moving object
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
JP2022196107A
Other languages
English (en)
Other versions
JP2024082330A (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.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric 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 Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP2022196107A priority Critical patent/JP7770295B2/ja
Priority to US18/473,555 priority patent/US12466434B2/en
Priority to DE102023211801.7A priority patent/DE102023211801A1/de
Publication of JP2024082330A publication Critical patent/JP2024082330A/ja
Application granted granted Critical
Publication of JP7770295B2 publication Critical patent/JP7770295B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • 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/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • B60W30/0956Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
    • 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/001Planning or execution of driving tasks
    • B60W60/0011Planning or execution of driving tasks involving control alternatives for a single driving scenario, e.g. planning several paths to avoid obstacles
    • 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/001Planning or execution of driving tasks
    • B60W60/0015Planning or execution of driving tasks specially adapted for safety
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/164Centralised systems, e.g. external to vehicles
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/166Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
    • 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
    • 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)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Description

本願は、走行経路決定装置及び自動運転システムに関するものである。
道路等を走行するある注目車両に対して、他車両及び歩行者と衝突することなく、安全に走行するための経路を生成するシステムが提案されている。この経路生成システムでは、車両に搭載したセンサ、あるいは路側に設置したセンサで、エリア内を移動する他車両及び歩行者を検知し、注目車両との衝突が生じる可能性がある場合に、それを回避するための走行経路を生成する。
このような走行経路の生成システムでは、レーダ、カメラ及びライダーといった複数のセンシング手段の結果を融合することにより、障害物となる物体を検知して走行経路を生成している。しかし、これらのセンシング手段では、物体の有無を検知することはできたとしも、物体の正確な輪郭すなわち境界を精度良く求めることは難しい。そのため、これらセンシング手段により検出された物体に基づいて走行経路を生成したとしても、必ずしも衝突を回避できるとは限らない。完全に衝突を回避するために、余裕をもたせて必要以上に大きく迂回する、あるいは必要以上に減速する、あるいは長い時間にわたり一時停止する、といった効率の悪い結果となる場合もある。
この問題を解決するために、物体が存在しないフリースペースを検知する手段と、物体を検知する手段と、を組み合わせることで、衝突は発生しないかについて、車両が辿るべき目標軌跡を2回検査するという方法が提案されている(例えば、特許文献1参照)。
特許第6545279号公報
特許文献1では、1回は、車両周囲のフリースペース測定に基づいて検査を行い、もう1回は、車両周囲の物体測定に基づいて検査を行うという2回の検査が必要のため、障害物である物体の数が増加すると、処理負荷が増大してしまう。処理負荷が一定の限界を超えると、走行に必要な経路の生成が間に合わなくなり、結果として運転速度を低下させる、あるいは停止させる等の処置が必要となり、自動運転車両を効率よく走行させることができなくなる可能性がある。
本願は、上記のような課題を解決するための技術を開示するものであり、走行経路の演算量を削減した走行経路決定装置、及びこの走行経路決定装置により効率よく生成された走行経路に基いて車両の走行が可能な自動運転システムを提供することを目的とする。
本願に開示される走行経路決定装置は、
路側センシング装置から第1の障害物の情報及び車両に搭載した車載センサから前記車両周辺の第2の障害物の情報を一定間隔で取得する障害物情報取得部と、
前記障害物情報取得部で取得した前記第1の障害物の情報及び前記第2の障害物の情報に基づいて、取得された前記第1の障害物及び前記第2の障害物を含むすべての障害物に対し移動物体か静止物体かを判定する障害物判定部と、
前記障害物判定部で、前記障害物が移動体であると判定された場合、その障害物を移動物体リストに登録する移動物体リスト更新部と、
前記障害物判定部で、前記障害物が静止物体と判定された場合、その障害物を包含する領域を走行禁止領域として登録し、前記障害物のうち再度静止物体と判定された場合は、登録された前記走行禁止領域を継続する走行禁止領域更新部と、
前記移動物体リスト更新部で更新された前記移動物体リスト及び前記走行禁止領域更新部で更新された走行禁止領域に基づいて、すべての前記障害物との衝突を回避するように演算し、前記車両の予め設定された走行経路を修正する走行経路決定部と、を備え、
前記走行経路決定部は、前記走行禁止領域更新部で継続された前記走行禁止領域については衝突を回避する演算を行わない、ように構成されたものである。
本願によれば、検知した障害物を移動物体と静止物体とに判定し、静止物体については移動するまでは走行禁止領域として維持されるので、衝突回避の演算処理を繰り返し実行する必要がなくなり、走行経路決定装置の演算処理の負荷が低減する。これにより、この走行経路決定装置を備えた自動運転システムにおいて、自動運転を行う車両に効率よく走行経路を提供することが可能となる。
実施の形態1に係る自動運転システムの構成を示す機能ブロック図である。 実施の形態1に係る自動運転システムの適用例を示す図である。 自動運転を行う車両の走行経路を生成する方法を説明するための図である。 道路領域を走行中の車両の走行経路を説明するための図である。 図4において、道路に障害物がある場合に生成された車両の走行経路を説明するための図である。 実施の形態1に係る自動運転システムの動作を示すフローチャートである。 図5において、走行禁止領域が設定された状態を説明するための図である。 図7において、一部の障害物が移動する場合の車両の走行経路の例を説明するための図である。 実施の形態1係る自動運転システムのハードウエア構成の例を示す図である。
以下、本願で開示される自動運転システムの実施の形態について図を参照して説明する。なお、以下の実施の形態では自動運転システムが適用される移動体として自動車の例を示す。自動車は、例えば米国自動車技術会(SAE International)の定義するレベル3または4相当の自動運転走行が可能なものとする。また、各図中、同一符号は、同一または相当する部分を示すものとする。したがって、それらについての詳細な説明を、重複を避けるために省略する場合がある。
実施の形態1.
以下に、実施の形態1に係る自動運転システムについて図を用いて説明する。
<自動運転システムの構成>
図1は、実施の形態1に係る自動運転システムの構成を示す機能ブロック図である。図1において、自動運転システム1は、路側センシング装置10、走行経路決定装置20及び車両30を備えている。
路側センシング装置10は、例えば路側帯に設けられた路側機である。路側センシング装置10は路側センサ11を備えており、路側センサ11で検知した道路周辺の障害物情報を出力として走行経路決定装置20の障害物情報取得部21に送信する。
なお、路側センサ11は、例えばカメラ、レーダ、LiDAR(Light Detection And Ranging:ライダー)およびソナーセンサ(超音波センサ)のうちの少なくとも1つを備えている。
自動運転を行う車両30は、車両30の周辺の障害物を検知する車載センサ31及び走行経路決定装置20からの情報を受信する情報受信部32を備える。車載センサ31は検知した障害物情報を出力として走行経路決定装置20の障害物情報取得部21に送信する。
車載センサ31は、路側センサ11と同様、例えばカメラ、レーダ、LiDARおよびソナーセンサのうちの少なくとも1つを備えている。車載センサ31は車両30の周辺を網羅するように、それぞれの車載センサ31の検知範囲を考慮して、複数設けることが望ましい。
走行経路決定装置20は、障害物情報取得部21、障害物判定部22、移動物体リスト更新部23、走行禁止領域更新部24、走行経路決定部25、情報通知部26を備えている。また、走行経路決定装置20は、予め地図情報28を有している。
走行経路決定装置20は、路側センサ11及び車両30の具備する車載センサ31からの出力を一定間隔で受信し、受信した全ての障害物の位置、移動速度、移動方向及び静止等の状態を地図情報28に反映させ、地図情報28を動的地図とする。
障害物情報取得部21には、路側センサ11及び車両30の具備する車載センサ31から出力された車両30の周辺の他車両及び歩行者等の情報が障害物情報として入力される。なお、路側センサ11からの障害物情報を第1の障害物情報、車載センサ31からの障害物情報を第2の障害物情報とすると、第1の障害物情報及び第2の障害物情報は重複数するものがあってもよい。障害物情報取得部21には第1の障害物情報及び第2の障害物情報に基づく障害物を全ての障害物の情報として扱う。
障害物判定部22は、障害物情報取得部21で取得された全ての障害物に対し、取得された全ての障害物の位置、移動速度、移動方向等の情報に基づいて、それぞれの障害物が移動物体であるか静止物体であるか判定し、動的地図に反映させる。
移動物体リスト更新部23は、障害物情報取得部21で取得された障害物情報に基づき、障害物リストの更新を行う。障害物情報取得部21で取得された障害物が移動物体の場合、障害物リストに登録される。障害物リストに登録された移動物体の移動速度がゼロとなり、すなわち静止した場合、障害物判定部22で、静止物体と判定されるため、障害物リストから削除される。一方、静止状態から移動する物体は、障害物リストに登録される。更新された障害物リストの情報は動的地図に反映される。
走行禁止領域更新部24は、障害物情報取得部21で取得された障害物情報に基づき、走行禁止領域の更新を行う。走行禁止領域とは、車両30の走行する走行経路周辺に静止している障害物の存在する領域で、静止している障害物を包含し、その障害物の大きさより例えば幅、長さで10~20%程度余裕のある領域、あるいは0.5~1m程度余裕のある領域である。静止状態が継続する障害物については、一定間隔で障害物情報取得部21が受信し検知する障害物情報に変化はない。すなわち、障害物判定部22で再度あるいは繰り返し静止物体と判定される障害物については設定される走行禁止領域が継続される。また、上述したが、移動物体として障害物リストに更新されていたものが静止し、障害物リストから削除された場合は、その静止場所は新たな走行禁止領域に追加される。一方、静止状態から移動する物体は、その物体のいた場所は走行禁止領域から除外される。更新された走行禁止領域の情報は動的地図に反映される。
走行経路決定部25は、車両30が障害物との衝突を避けた経路を演算し、決定する。自動運転を行う車両30は、現在位置から最終目的位置までの移動する場合、地図上に予め演算された走行経路を有する。走行経路決定部25は、動的地図上の移動物体の移動状態の情報、障害物リスト情報に基づく移動物体情報及び走行禁止領域に基づく静止物体情報を参照し、車両30が障害物との衝突を避けるように、予め演算された走行経路(後述する、第1の走行経路)を更新する。
具体的には、移動物体である障害物リスト及びその移動状態と、走行禁止領域とが反映された動的地図に基づき、車両30の運動方程式、移動物体の運動方程式を解くことで、車両30とすべての障害物との衝突の有無を予測し、予め設定された第1の走行経路から、いずれの障害物との衝突も避けるように、修正された走行経路を生成し、新しい走行経路とする。車両30と障害物との衝突の有無の判定には、障害物として静止物体との判定も行われるが、静止物体はそれを包含する走行禁止領域が設定されるとともに、移動を開始するまではその領域に変化はない。そのため、走行禁止領域と車両30との衝突判定及び衝突回避についての演算は走行禁止領域が継続される場合は行う必要がなく、走行禁止領域に変更が生じたら行えばよく、判定処理等の演算量を削減することができる。
情報通知部26は、走行経路決定部25で決定した走行経路を車両30の情報受信部32に送信する。
なお、走行経路決定装置20は車両30に搭載することも可能である。
<自動運転システム1の適用例>
次に、自動運転システム1を適用した例について説明する。
図2は、実施の形態1に係る自動運転システム1の適用を示す図で、自動運転システムの管轄エリア101全体を取りまとめる中央管制センター120が一つ設置されており、駅エリア141をとりまとめる第1の走行経路決定装置121と、交差点エリア142をとりまとめる第2の走行経路決定装置122とを束ねている。ここで中央管制センター120も1つの走行経路決定装置である。
第1の走行経路決定装置121は、駅エリア141内の障害物を検知する第1の路側センシング装置111及び第2の路側センシング装置112と通信を行う。第1の路側センシング装置111は、例えば駅施設の乗降スペースにおける車両130の到着と発車とを主に検知するので、車両130の干渉回避のためのセンシング手段となる。第2の路側センシング装置112は、例えば駅施設の乗降スペースにおける車両130と歩行者131とを主に検知するので、車両130と歩行者131との接触を回避するためのセンシング手段となる。
第2の走行経路決定装置122は、信号のない交差点エリア142において、第3の路側センシング装置113と通信を行う。第3の路側センシング装置113は、例えば交差点エリア142内の車両130を主に検知するので、車両130同士の衝突、及びお見合いによる交通の停止を回避するためのセンシング手段となる。
<走行経路の生成>
次に、自動運転車両の走行経路の生成方法について説明する。
図3は、自動運転車両の走行経路の生成方法を説明するための図である。図において、自動運転を行う車両301は、現在位置から最終目的位置まで移動する場合、地図上の途中経路311、312、313、314の群と、GNSS(Global Navigation Satellite System:衛星測位システム)センサあるいは周囲のランドマーク情報を取得する車載センサ31によって得た自己位置の測位位置302との整合を取り、ある一定時間の未来の走行経路320を逐次算出しながら走行する。図3では、測位結果として、緯度、経度を取得し、途中経路をマッピングした例である。走行経路320を第1の走行経路とする。なお、車両301は図1の車両30と同様に、自動運転システム1の走行経路決定装置20と通信し、車載センサ31、情報受信部32を備える。
図4は、実際の道路を走行する車両301における走行経路の生成例を説明する図である。図4において、交差点を含む道路領域330と道路外領域331、332、333、334が定義されており、走行経路321は道路領域330内で生成されている。車両301は、目標地点に向かってこの道路領域330における交差点を右折した方向へ走行する例である。
図5は、図4において、道路に障害物がある場合に生成された車両の走行経路を説明するための図である。図5において、移動物体(例えば、走行中の他車両等)である障害物413、412及び静止物体(例えば、停車中の車両、荷物等)である障害物411、414、415、416が交差点を含む道路領域330に存在する。これら障害物は、路側センシング装置10の路側センサ11及び車両301の車載センサ31により検知され、走行経路決定装置20の障害物判定部22で障害物が移動物体か静止物体かが判定されて地図情報に反映されている。そして、自動運転を行う車両301の走行経路322は、これら全ての障害物411、412、413、414、415、416との衝突を回避するように図4の走行経路321から修正されて生成されている。なお、この道路領域330の障害物を検知する路側センシング装置10が複数設けられている場合は、複数の路側センシング装置10から障害物情報を取得すればよい。
具体的な走行経路の生成手順について、図6を用いて説明する。図6は、本実施の形態1に係る自動運転システムの動作を示すフローチャートである。
まず、路側センシング装置10の路側センサ11及び車両301の車載センサ31により道路領域330で検知された全ての障害物411、412、413、414、415、416の情報が走行経路決定装置20の障害物情報取得部21に送信される(ステップS101、ステップS102)。
次に、ステップS103において、障害物情報取得部21で取得された障害物情報及び障害物判定部22で演算された障害物の移動状態に基づいて、障害物が移動物体と判定された場合(ステップS103でYes)、ステップS104に進み、移動物体リスト更新部23は移動物体を障害物リストに登録し、更新する。
ステップS103において、障害物が移動物体でない、静止物体と判定された場合(ステップS103でNo)、ステップS105に進み、走行禁止領域更新部24は、静止物体を包含する領域に走行禁止領域を設定し、走行禁止領域に追加する。
図7は、図5において、走行禁止領域が設定された状態を説明するための図である。図7において、静止物体である障害物411を包含するように走行禁止領域521が、静止物体である障害物414、415は近接しているので両者を包含するように走行禁止領域522が、及び静止物体である障害物416を包含するように走行禁止領域523が設定されている。
次に、ステップS106において、走行経路決定部25は、移動物体である障害物リスト及びその移動状態と走行禁止領域とが反映された動的地図である地図情報28に基づき、車両301と道路領域330に存在するすべての障害物との衝突の有無を予測し、予め設定された第1の走行経路321から、いずれの障害物との衝突を避けるように、修正された走行経路322を生成し、新しい走行経路を生成する。
具体的には、道路領域330に存在するすべての障害物411、412、413、414、415、416に対して、それぞれの位置、速度、加速度、サイズ(縦横サイズ)、姿勢(方位角)等から、予め設定された時間経過後までの間の運動方程式及び車両301の運動方程式を解くことで、衝突の有無を予測する。
ステップS107において、走行経路決定部25で決定した新しい走行経路322の情報が、情報通知部26から送信され、車両301の情報受信部32で新しい走行経路322の情報を受信する。
車両301の走行中はステップS101からステップS107の動作が繰り返される。この時、障害物判定部22において、障害物が移動物体か静止物体かの判定が行われ、静止物体の障害物については走行禁止領域として扱われる。そのため、ステップS106において、走行経路決定部25は、走行禁止領域が継続される場合は逐次移動状態の演算及び衝突判定、衝突回避の演算を行う必要がなくなり、演算量が減少する。
障害物情報取得部21は、路側センサ11及び車両30の具備する車載センサ31からの出力を一定間隔で受信し、障害物判定部22で移動物体か静止物体かが判定されるが、障害物のうち、再度あるいは繰り返し静止物体と判定される障害物については、その障害物の移動を検知するまで(移動物体と判定されるまで)は、継続して走行禁止領域として扱うことができる。一方、図8に示すように、静止物体である障害物415、416の移動がそれぞれ検知された場合は、走行禁止領域522は再設定され、走行禁止領域523は削除されるとともに、移動物体となった障害物415、416は障害物リストに登録され障害物リストは更新される。この時、静止物体である障害物411の移動が検知されなかった場合は、走行禁止領域は継続され、走行禁止領域を設定する演算等を行う必要はない。そして、新たな動的地図に基づいて、新たな走行経路323に修正される。
なお、ステップS107において、新しい走行経路322の情報を受信した車両301は、受信した走行経路322に従って、ブレーキ(制動手段)、ハンドル(操舵手段)等の各アクチェータを駆動、制御して走行する。
車両301には、走行中の障害物との衝突の有無を予測し、いずれの障害物との衝突をも避けるように生成された走行経路が提供され、それに基づいて、車両301は操舵、加減速、一時停止をも含めた走行動作をリアルタイムで行う必要がある。例えば、市街地等においては対向車、右折待ちの車両、渋滞車両、路上駐車車両、道路を横断しようとする歩行者といった複雑な状況への対応が必要となる。このとき、もし障害物の数が増加して、処理負荷がある限界を超えると、障害物との衝突を回避した走行経路の生成が間に合わなくなり、自動運転を行う車両を適切に走行させることができなくなる可能性がある。
また、実際の交通環境において、全ての障害物が常に移動しているわけではなく、例えば右折待ち、渋滞、路肩への駐車等、さらには走行してきて停止した後、そのまま止まり続ける障害物も多い。もし、これら静止した車両を、障害物としてとらえるのではなく、走行禁止領域として取り扱えば、常に一定時間未来までの衝突判定を実施する必要が無くなり、大幅な処理負荷の軽減が可能となる
さらに、移動物体リストと走行禁止領域のそれぞれが動的地図に反映され、各障害物が移動物体か静止物体かに応じて逐次更新する機能を備えることで、たとえ障害物の数が増大したとしても、極端な処理負荷の増大を起こさず、結果として自動運転を行う車両の走行効率の低下を抑制することを可能にする、
以上のように、実施の形態1によれば、走行経路決定装置は、障害物の情報を一定間隔で取得する障害物情報取得部と、障害物情報取得部で取得した障害物の情報に基づいて、すべての障害物に対し移動物体か静止物体かを判定する障害物判定部と、障害物が移動体であると判定された場合、その障害物を移動物体リストに登録する移動物体リスト更新部と、障害物が静止物体と判定された場合、その障害物を包含する領域に走行禁止領域として登録するとともに、再度あるいは繰り返し静止物体と判定される場合は走行禁止領域を継続する走行禁止領域更新部と、更新された移動物体リスト及び走行禁止領域に基づいて、車両の予め設定された走行経路を修正する走行経路決定部と、を備えている。この構成により障害物を移動物体と静止物体とにわけ、障害物のうち静止物体は走行禁止領域として継続されるものについては移動が開始するまでは衝突の有無についての演算を繰り返す必要がなくなり、演算量が低減するとともに演算処理の負荷が低減する。
また、実施の形態1によれば、自動運転システムは、この走行経路決定装置、車両周辺の障害物情報を検知する車両及び障害物情報を検知する路側センシング装置を備えているので、検知する障害物が増加しても、自動運転を行う車両に衝突を回避するために修正された走行経路を効率よく提供することが可能となる。
上述の実施の形態1における自動運転システム1は、図9にハードウエアの一例を示すが、演算処理装置1001、各機能部の機能を実行するプログラムが格納されたROM(Read Only Memory)及びプログラムによる演算結果である各機能部の実行結果の各データを保存するRAM(Random Access Memory)を含む記憶装置1002、入出力装置1003、通信装置1004を具備する。演算処理装置1001は、記憶装置1002から入力されたプログラムを実行する。走行経路決定装置20は同様なハードウエア構成を具備しても良いし、自動運転システム1のハードウエア構成の中で各機能を実現してもよい。
通信装置1004は通信モジュールとして、広域通信部と狭域通信部とを備える。広域通信部は、所定の広域無線通信規格、例えばLTE(Long Term Evolution)あるいは4G、5G(5th Generation;第5世代移動通信システム)に準拠したものを用いる。狭域通信部は例えば、DSRC(Dedicated Short Range Communications)などを用いる。これら通信は、一定の通信速度が担保されている。路側センシング装置10と走行経路決定装置20との間、車両30と走行経路決定装置20との間はこれら通信を用いればよい。
走行経路決定装置20は車両30に搭載することも可能である。その場合、路側センシング装置10からの障害物情報は走行経路決定装置20へは例えばLTEあるいは5Gを用いた通信が利用される。
車載センサ31の各センサは、車両に搭載されており、各センサからは通信線で車両内の情報取得部(図示せず)に情報が集約され、走行経路決定装置20へ送信される。社内の通信線は例えばCAN(Control Area Network:登録商標)等を用いて接続されている。
なお、演算処理装置1001には、CPU(Central Processing Unit)、DSP(DigitalSignal Processor)などのプロセッサが適用される。また、演算処理装置1001には、専用のハードウエアが適用されても良い。演算処理装置1001が専用のハードウエアである場合、演算処理装置1001は、たとえば、単一回路、複合回路、プログラム化したプロセッサ、並列プログラム化したプロセッサ、ASIC(Application Specific Integrated Circuit)、FPGA(Field-Programmable Gate Array)、またはこれらを組み合わせたもの等が該当する。
また、走行経路決定装置20及び自動運転システム1は各機能部が個別の演算処理装置で実現されていても良いし、それらがまとめて1つの演算処理装置で実現されていてもよい。
さらに、走行経路決定装置20及び自動運転システム1の各機能部は、一部の機能については専用のハードウエアとして演算処理装置でその機能を実現し、他の機能についてはソフトウエアで実現する等、ハードウエア、ソフトウエア等、またはこれらの組み合わせによって、上述の各機能を実現することができる。
また、以上に記載された実施の形態で記載されたそれぞれの構成要素は、ソフトウエア
またはファームウエアとしても、それと対応するハードウエアとしても想定され、その双
方の概念において、それぞれの構成要素は「部」または「処理回路」などと称される。
本願は、例示的な実施の形態が記載されているが、実施の形態に記載された様々な特徴、態様、及び機能は特定の実施の形態の適用に限られるのではなく、単独で、または様々な組み合わせで実施の形態に適用可能である。
従って、例示されていない無数の変形例が、本願明細書に開示される技術の範囲内において想定される。例えば、少なくとも1つの構成要素を変形する場合、追加する場合または省略する場合が含まれるものとする。
1:自動運転システム、 10:路側センシング装置、 11:路側センサ、 20:走行経路決定装置、 21:障害物情報取得部、 22:障害物判定部、 23:移動物体リスト更新部、 24:走行禁止領域更新部、 25:走行経路決定部、 26:情報通知部、 28:地図情報、 30、130、301:車両、 31:車載センサ、 32:情報受信部、 101:管轄エリア、 111:第1の路側センシング装置、 112:第2の路側センシング装置、 113:第3の路側センシング装置、 120:中央管制センター、 121:第1の走行経路決定装置、 122:第2の走行経路決定装置、 131:歩行者、 141:駅エリア、 142:交差点エリア、 302:測位位置、 311、312、313,314:途中経路、 320、321、322、323:走行経路、 330:道路領域、 331、332、333、334:道路外領域、 411、412、413、414、415、416:障害物、 521、522、523:走行禁止領域、 1001:演算処理装置、 1002:記憶装置、 1003:入出力装置、 1004:通信装置。

Claims (3)

  1. 路側センシング装置から第1の障害物の情報及び車両に搭載した車載センサから前記車両周辺の第2の障害物の情報を一定間隔で取得する障害物情報取得部と、
    前記障害物情報取得部で取得した前記第1の障害物の情報及び前記第2の障害物の情報に基づいて、取得された前記第1の障害物及び前記第2の障害物を含むすべての障害物に対し移動物体か静止物体かを判定する障害物判定部と、
    前記障害物判定部で、前記障害物が移動体であると判定された場合、その障害物を移動物体リストに登録する移動物体リスト更新部と、
    前記障害物判定部で、前記障害物が静止物体と判定された場合、その障害物を包含する領域を走行禁止領域として登録し、前記障害物のうち再度静止物体と判定された場合は、登録された前記走行禁止領域を継続する走行禁止領域更新部と、
    前記移動物体リスト更新部で更新された前記移動物体リスト及び前記走行禁止領域更新部で更新された走行禁止領域に基づいて、すべての前記障害物との衝突を回避するように演算し、前記車両の予め設定された走行経路を修正する走行経路決定部と、を備え、
    前記走行経路決定部は、前記走行禁止領域更新部で継続された前記走行禁止領域については衝突を回避する演算を行わない、走行経路決定装置。
  2. 前記走行禁止領域が設定された前記障害物が移動する場合、前記走行禁止領域更新部は前記走行禁止領域を解除するとともに、前記移動物体リスト更新部は前記移動物体リストに追加し、
    前記移動物体リストに登録された前記障害物が静止し、前記障害物判定部で静止物体と判定された場合、前記移動物体リスト更新部は前記移動物体リストから前記障害物を削除するとともに、前記走行禁止領域更新部はその障害物を包含する領域を走行禁止領域として追加する、請求項1に記載の走行経路決定装置。
  3. 請求項1または2に記載の走行経路決定装置、前記車両及び前記路側センシング装置を備えた自動運転システムであって、
    前記路側センシング装置から前記走行経路決定装置へ前記第1の障害物の情報が一定間隔で送信され、前記車両から前記走行経路決定装置へ前記第2の障害物の情報が一定間隔で送信され、前記走行経路決定装置から修正された前記走行経路が前記車両へ送信され、前記車両は修正された前記走行経路に基づき走行する、自動運転システム。
JP2022196107A 2022-12-08 2022-12-08 走行経路決定装置及び自動運転システム Active JP7770295B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2022196107A JP7770295B2 (ja) 2022-12-08 2022-12-08 走行経路決定装置及び自動運転システム
US18/473,555 US12466434B2 (en) 2022-12-08 2023-09-25 Traveling route deciding device and automated driving system
DE102023211801.7A DE102023211801A1 (de) 2022-12-08 2023-11-27 Fahrrouten-entscheidungsvorrichtung und automatisiertes fahrsystem

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2022196107A JP7770295B2 (ja) 2022-12-08 2022-12-08 走行経路決定装置及び自動運転システム

Publications (2)

Publication Number Publication Date
JP2024082330A JP2024082330A (ja) 2024-06-20
JP7770295B2 true JP7770295B2 (ja) 2025-11-14

Family

ID=91186376

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2022196107A Active JP7770295B2 (ja) 2022-12-08 2022-12-08 走行経路決定装置及び自動運転システム

Country Status (3)

Country Link
US (1) US12466434B2 (ja)
JP (1) JP7770295B2 (ja)
DE (1) DE102023211801A1 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP4579629A3 (en) * 2023-12-26 2025-08-27 IT Telecom Co., Ltd. System for expanding recognition area of vehicle based on surrounding environment information

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009116790A (ja) 2007-11-09 2009-05-28 Nissan Motor Co Ltd 車両用運転支援装置および運転支援方法
JP2012037980A (ja) 2010-08-04 2012-02-23 Toyota Central R&D Labs Inc 移動物予測装置及びプログラム
WO2012033173A1 (ja) 2010-09-08 2012-03-15 株式会社豊田中央研究所 移動物予測装置、仮想可動物予測装置、プログラム、移動物予測方法、及び仮想可動物予測方法
JP6792160B2 (ja) 2017-01-31 2020-11-25 富士通株式会社 移動支援システム、移動支援装置、移動支援端末、移動支援方法、地図作成システム、地図作成装置、及び情報取得端末

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102015205048A1 (de) 2015-03-20 2016-09-22 Robert Bosch Gmbh Verfahren und Vorrichtung zum Überwachen einer von einem Fahrzeug abzufahrenden Soll-Trajektorie auf Kollisionsfreiheit
US10823574B2 (en) * 2017-06-01 2020-11-03 Panasonic Intellectual Property Corporation Of America Communication method, roadside unit, and communication system
EP3802254B1 (en) * 2018-05-31 2024-07-10 Nissan North America, Inc. Trajectory planning
US11402842B2 (en) * 2019-01-18 2022-08-02 Baidu Usa Llc Method to define safe drivable area for automated driving system
US20210035442A1 (en) * 2019-07-31 2021-02-04 Nissan North America, Inc. Autonomous Vehicles and a Mobility Manager as a Traffic Monitor
US12071127B2 (en) * 2021-07-16 2024-08-27 Nissan North America, Inc. Proactive risk mitigation

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009116790A (ja) 2007-11-09 2009-05-28 Nissan Motor Co Ltd 車両用運転支援装置および運転支援方法
JP2012037980A (ja) 2010-08-04 2012-02-23 Toyota Central R&D Labs Inc 移動物予測装置及びプログラム
WO2012033173A1 (ja) 2010-09-08 2012-03-15 株式会社豊田中央研究所 移動物予測装置、仮想可動物予測装置、プログラム、移動物予測方法、及び仮想可動物予測方法
JP6792160B2 (ja) 2017-01-31 2020-11-25 富士通株式会社 移動支援システム、移動支援装置、移動支援端末、移動支援方法、地図作成システム、地図作成装置、及び情報取得端末

Also Published As

Publication number Publication date
JP2024082330A (ja) 2024-06-20
DE102023211801A1 (de) 2024-06-13
US12466434B2 (en) 2025-11-11
US20240190468A1 (en) 2024-06-13

Similar Documents

Publication Publication Date Title
CN112810628B (zh) 车辆控制系统
JP7466396B2 (ja) 車両制御装置
JP7207256B2 (ja) 車両制御システム
CN112298181B (zh) 车辆控制装置、车辆控制方法及存储介质
US11807234B2 (en) Automated driving trajectory generating device and automated driving device
CN110281920B (zh) 车辆控制装置、车辆控制方法以及存储介质
US20190135281A1 (en) Vehicle control device, vehicle control method, and recording medium
US11059481B2 (en) Vehicle control system, vehicle control method, and vehicle control program
US12128888B2 (en) Behavior prediction method and behavior prediction device for mobile unit, and vehicle
JP7098366B2 (ja) 車両制御装置、車両制御方法、およびプログラム
CN110271542B (zh) 车辆控制装置、车辆控制方法及存储介质
CN115884908A (zh) 路径确认装置以及路径确认方法
CN110053617A (zh) 车辆控制装置、车辆控制方法及存储介质
JP7000202B2 (ja) 車両制御システム、車両制御方法、およびプログラム
US12036978B2 (en) Driving assistance method and driving assistance device
CN112172826B (zh) 车辆控制装置、车辆控制方法及存储介质
JP6765357B2 (ja) 走行制御装置、走行制御方法およびプログラム
JP7791678B2 (ja) 車両の走行制御装置
JP7650653B2 (ja) 道路交通制御システム
JP7598215B2 (ja) 車両の走行制御装置
JP2021009624A (ja) 車両制御装置、車両制御方法、およびプログラム
JP7770295B2 (ja) 走行経路決定装置及び自動運転システム
US11760345B2 (en) Vehicle traveling control apparatus
US20240010193A1 (en) Vehicle control apparatus
US12227173B2 (en) Secondary fallback software stack for autonomous vehicle

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20250109

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20250926

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20251104

R150 Certificate of patent or registration of utility model

Ref document number: 7770295

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150