JP5029219B2

JP5029219B2 - 走行計画生成装置

Info

Publication number: JP5029219B2
Application number: JP2007220009A
Authority: JP
Inventors: 康治田口
Original assignee: Toyota Motor Corp
Current assignee: Toyota Motor Corp
Priority date: 2007-08-27
Filing date: 2007-08-27
Publication date: 2012-09-19
Anticipated expiration: 2027-08-27
Also published as: JP2009051356A

Description

本発明は、走行計画生成装置に関するものである。

従来、車両の走行計画を生成する装置として、所定の座標における目標速度を示す速度パターンや走行軌跡からなる下位計画を用いて車両の走行計画を生成する装置が知られている（例えば、特許文献１参照）。この装置は、仮生成した複数の下位計画について周辺車両の計画を考慮して安全性の評価を行い、所定の安全基準を満足する下位計画を走行計画として選定する装置である。
特願２００６−３１３２５８号

しかしながら、従来の走行計画生成装置にあっては、効率良く走行計画を生成する仕組みが無いため、処理時間内に安全性が確保された走行計画を生成できないおそれがある。

そこで本発明は、このような技術課題を解決するためになされたものであって、効率的に安全な走行計画を生成することができる走行計画生成装置を提供することを目的とする。

すなわち本発明に係る走行計画生成装置は、走行方針に従った走行を行うための第１走行計画を生成する手段と、緊急停止を行うための第２走行計画を生成する手段と、前記第１走行計画と前記第２走行計画とが所定の安全基準を満たすか否かを判定する安全基準判定手段と、前記第１走行計画と前記第２走行計画との各安全判定結果の組み合わせに基づいて、所定区間の速度パターンと走行軌跡の少なくとも一方を含む走行計画を生成する走行計画生成手段とを備え、前記走行計画生成手段は、前記安全判定手段によって前記第１走行計画及び前記第２走行計画が共に安全基準を満たさないと判定された場合に、前記第２走行計画に対して安全基準を満たすように補正する。

この発明によれば、通常走行用の第１走行計画を生成すると共に、危険を回避するための緊急停止用の第２走行計画を第１走行計画とは別に生成し、生成した第１走行計画及び第２走行計画が所定の安全基準を満たすか否かを判定し、判定結果を用いて車両が走行するための走行計画を生成することができる。これにより、各走行計画の判定結果の組み合わせを利用して走行計画を生成するので、安全側に動作する走行計画を効率的に生成することができる。これにより、限られた時間内で安全な走行計画を生成する可能性を高めることができる。また、通常走行用の第１走行計画及び緊急停止用の第２走行計画が安全基準を満たさない場合には、車両が緊急停止することを前提として第２走行計画を補正することにより、第１走行計画を除々に安全側に補正する場合に比べて、短時間で安全な走行計画を生成する可能を高めることができる。さらに、速度パターン又は走行軌跡からなる走行計画の生成を効率良く行うことができる。

また、走行計画生成装置において、前記走行計画生成手段は、前記安全判定手段によって前記第２走行計画のみが安全基準を満たすと判定された場合に、前記第２走行計画を前記走行計画として採用することが好適である。

このように構成することで、緊急停止用の第２走行計画のみが安全基準を満たす場合には、緊急停止用の第２走行計画を走行計画として採用することができる。これにより、緊急停止を迅速に行い、安全を確保することができる。

また、走行計画生成装置において、前記走行計画生成手段は、前記安全判定手段によって前記第１走行計画のみが安全基準を満たすと判定された場合に、前記第１走行計画に対して安全性を向上する補正を行うことが好適である。

このように構成することで、通常走行用の第１走行計画のみが安全基準を満たし、緊急停止用の第２走行計画が安全基準を満たさない場合には、第１走行計画の安全性をさらに向上させるように補正することができる。これにより、本来危険な状況を回避するために生成していた緊急停止用の走行計画が安全性を満たさない場合には、安全性が確認された第１走行計画の安全性をさらに向上させることで、不測の障害発生等に対して対応できる余裕を作り、将来の安全を確保することができる。

また、走行計画生成装置において、前記走行計画生成手段は、前記安全判定手段によって前記第１走行計画及び前記第２走行計画が共に安全基準を満たすと判定された場合に、前記第１走行計画に対して走行の効率性と快適性の少なくとも一方を向上する補正を行うことが好適である。このように構成することで、付加価値のある走行計画を生成する前に、走行計画の安全性を確認するため、効率的に安全な走行計画を生成することができる。

本発明によれば、効率的に安全な走行計画を生成することができる。

以下、添付図面を参照して本発明の実施形態について説明する。なお、各図において同一又は相当部分には同一の符号を付し、重複する説明を省略する。

本実施形態に係る走行計画生成装置は、安全な走行計画を生成する装置であって、例えば自動運転を行う車両に好適に採用されるものである。

最初に、本実施形態に係る走行計画生成装置の構成を説明する。図１は本発明の実施形態に係る走行計画生成装置を備える車両の構成図である。走行計画生成装置２０を搭載した車両１は、車車間通信や路車間通信等により情報を入力しあるいはセンサ等によって情報を取得し、所定の間隔で行動計画を生成して自動運転する機能を有する車両であって、センサ３３、入力部３４、ＥＣＵ２、通信部３２、アンテナ３１、及びアクチュエータ３５を備えている。ここで、ＥＣＵ（Electronic Control Unit）とは、電子制御する自動車デバイスのコンピュータであり、ＣＰＵ（CentralProcessing Unit）、ＲＯＭ（Read Only Memory）、ＲＡＭ（Random Access Memory）、および入出力インターフェイスなどを備えて構成されている。

センサ３３は、車両の周辺情報を取得する機能を有しており、例えば、カメラ等の画像センサや、ミリ波レーダ、超音波センサ等である。センサ３３は、車両の周辺情報を取得し、取得した情報を入力部３４へ出力する機能を有している。

入力部３４は、センサ３３から入力した情報を使用できる形式に変換する機能を有している。また、入力部３４は、変換した情報をＥＣＵ２へ出力する機能を有している。

通信部３２は、他車両や、路側に配置された通信装置と通信する機能を有している。通信部３２は、ＥＣＵ２から送信データを入力しアンテナ３１を介して他車両や通信装置に送信する機能と、他車両や通信装置からアンテナ３１を介してデータを受信し受信データをＥＣＵ２へ出力する機能とを有している。

アクチュエータ３５は、車両の走行を制御する機械的な構成要素であり、例えば、操舵制御のためのハンドルや操舵角制御モータ、加減速制御のためのブレーキペダルやアクセルペダル、スロットルバルブ等である。また、アクチュエータ３５は、ＥＣＵ２から入力した走行制御量に基づいて動作する機能を有している。

ＥＣＵ２は、走行計画生成装置２０及び走行制御部２５を備えており、走行計画生成装置２０は、走行制御計画部２１及び安全性判定部（安全基準判定手段、走行計画生成手段）２４を有している。

走行制御計画部２１は、走行制御計画を生成する機能を有しており、制御計画生成部２２と最大減速制御計画生成部２３とを備えている。制御計画生成部２２は、主に通常走行時の走行制御計画（第１走行計画）を生成する機能を有しており、例えば、旅行時間、燃費優先度合いや休憩計画等を含む運転者の要望や走行環境条件等を考慮して、走行制御計画を生成する。走行環境条件は、入力部３４や通信部３２から入力した情報に基づいて設定される。ここで、走行制御計画とは、所定の時間内又は所定の地点までの走行をどのような制御で行うか予め決定したものである。例えば、走行制御計画には走行軌跡及び速度パターンが含まれる。また、先行車両に追従する車間距離制御を実行するのか、又は車線に沿って走行するレーンキープ走行制御を行うのか等の制御内容も含まれている。

他方、最大減速制御計画生成部２３は、緊急停止を行うための走行制御計画を予め緊急停止前に生成する機能を有している。ここで緊急停止前とは、緊急事態であるか否かを判断する前のことである。最大減速制御計画生成部２３は、例えば、所定の最大減速度、入力部３４から入力した車両周辺情報、通信部３２から入力した他車両に関する情報等を用いて、所定の最大減速度で停止するための走行制御計画（第２走行計画）を生成する。所定の最大減速度としては、例えば、運転者によって入力可能な操作ボタンを車両１に備え、その操作ボタンの操作によって設定された運転者の許容できる速度が用いられる。

走行制御計画部２１は、制御計画生成部２２で生成した走行制御計画を安全性判定部２４へ出力する機能を有している。また、走行制御計画部２１は、最大減速制御計画生成部２３で生成した緊急停止を行うための走行制御計画を安全性判定部２４へ出力する機能を有している。

安全性判定部２４は、車両の走行制御計画が安全か否かを判定する機能を有している。安全性判定部２４は、走行制御計画部２１から走行制御計画又は緊急停止を行うための走行制御計画を入力し、安全基準を満たしているか否かを判定する機能を有している。安全基準の判定方法としては、例えば、自車両と他車両の相対速度や相対位置から衝突余裕時間（TTC：Time To Collision）を算出して、所定の閾値以上であれば安全基準を満たしていると判定する方法が挙げられる。また、例えば、自車両の走行制御計画に基づいて所定時間経過後の自車両の存在位置を推定し、推定した存在位置に基づいて自車両が存在すると予想される領域を確率分布で表した干渉推定領域を算出し、算出した干渉推定領域と他車両の干渉推定領域との積和によって求められる干渉確率が所定の閾値以下であれば安全基準を満たしていると判定する方法が挙げられる。また、安全性判定部２４は、各走行制御計画についての判定結果を記録する機能を有している。さらに、安全性判定部２４は、各走行制御計画の安全性を組み合わせて、採用すべき走行制御計画を選定し、選定した走行制御計画を走行制御部２５へ出力する機能を有している。

走行制御部２５は、安全性判定部２４から入力した走行制御計画に基づいて、制御命令をアクチュエータ３５へ出力する機能を有している。

次に、本実施形態に係る走行計画生成装置の動作について説明する。図２及び図３は、本実施形態に係る走行計画生成装置の動作を示すフローチャートである。図２及び図３の制御処理は、ＥＣＵ２で実行され、例えばイグニッションオンされてから所定のタイミングで繰り返し実行される。繰り返し周期は、例えば１００ｍｓである。

図２に示すように、走行計画生成装置２０は、情報入力処理から開始する（Ｓ１０）。Ｓ１０の処理は、制御計画生成部２２で実行され、仮の走行制御計画を生成する処理である。例えば、走行計画生成装置２０は、車線を保持しながら前方の車両に追従するといった１００ｍｓ後までの仮の走行制御計画を生成する。Ｓ１０の処理が終了すると、安全性評価処理へ移行する（Ｓ１２）。

Ｓ１２の処理は、安全性判定部２４で実行され、Ｓ１０の処理で生成した仮の走行制御計画の安全性を評価する処理である。例えば、ＴＴＣや干渉確率等を用いて、予め設定された安全基準を満たすか否かを判定する。また、安全性判定部２４は、ＴＴＣや干渉確率等の判定に使用したデータと、判定した結果とを記録する。判定結果の記録方法としては、例えば、ＥＣＵ２のメモリ上に走行制御計画ごとに安全フラグを用意し、安全性判定部２４が安全性を満たしていないと判定した場合には判定した走行制御計画に対応する安全フラグを０から１へ変更する方法により行う。安全性の評価が終了すると、最大減速制御計画の生成処理へ移行する（Ｓ１４）。

Ｓ１４の処理は、最大減速制御計画生成部２３で実行され、緊急停止用の走行制御計画を生成する処理である。例えば、運転者が予め設定した最大減速度に基づいて、所定の最大減速度で停止するための走行制御計画を生成する。このように、最大の減速度で停止するための走行制御計画を、仮の走行制御計画よりも快適な走行制御計画を模索・算出する前に生成することで、以下の処理において説明する安全性の確認を優先して行うことが可能となる。Ｓ１４の処理が終了すると、安全性評価処理へ移行する（Ｓ１６）。

Ｓ１６の処理は、安全性判定部２４で実行され、Ｓ１４の処理で生成した緊急停止用の走行制御計画の安全性を評価する処理である。評価方法及び評価結果の記録方法はＳ１２の処理と同様である。Ｓ１６の処理が終了すると、判定処理へ移行する（Ｓ１８）。

Ｓ１８の処理は、安全性判定部２４で実行され、仮の走行制御計画及び緊急停止用の走行制御計画の安全評価の組み合わせを判定する処理であり、仮の走行制御計画及び緊急停止用の走行制御計画のどちらも安全でないと判定したか否かを判定する処理である。例えば、その時点での仮の走行制御計画を採用して走行すると、衝突等の危険を回避することが困難な状況となり、緊急停止してもその危険を回避することが困難であるか、あるいは減速・停止することによって別の危険が発生する状況に該当するか否かを判定する処理である。この判定は、例えば、仮の走行制御計画に対応する安全フラグ及び緊急停止用の走行制御計画に対応する安全フラグがそれぞれ１であることを確認することによって実現できる。Ｓ１８の処理において、仮の走行制御計画及び緊急停止用の走行制御計画のどちらも安全でないと判定した場合には、暫定計画設定処理へ移行する（Ｓ２０）。

Ｓ２０の処理は、安全性判定部２４で実行され、緊急停止用の走行制御計画を暫定の走行制御計画として採用する処理である。仮の走行制御計画及び緊急停止用の走行制御計画のどちらも安全でないということは、その時点での仮の走行制御計画を採用して走行すると、他車両との衝突などの危険を回避することが困難な状況となり、さらに緊急停止した場合であっても危険を回避することが困難な状況であるといえる。しかしながら、仮に危険を回避することが困難であるとしても、まずは緊急停止用の走行制御計画を暫定の走行制御計画に採用することで、衝突等によって発生する損害や被害を緩和する方法の検討を早期に開始することができる。Ｓ２０の処理が終了すると、走行制御計画の生成処理へ移行する（Ｓ２２）。

Ｓ２２の処理は、制御計画生成部２１で実行され、安全性に重点を置いた走行制御計画を生成する処理である。例えば、減速だけでなく操舵制御も考慮して走行制御計画を生成することで、緊急停止のみでは回避できない危険を回避できる可能性がある。具体的には、減速と共に路肩側にレーンチェンジして停止する走行制御計画が挙げられる。制御計画生成部２１は、センサ３４から入力した車両周辺情報や通信部３２から入力した他車両に関する情報に基づいて走行制御計画を生成する。Ｓ２２の処理が終了すると、安全性評価処理へ移行する（Ｓ２４）。

Ｓ２４の処理は、安全性判定部２４で実行され、Ｓ２２の処理で生成した走行制御計画の安全性を評価する処理である。評価方法及び評価結果の記録方法はＳ１２の処理と同様である。Ｓ２４の処理が終了すると、走行計画採用処理へ移行する（Ｓ２６）。

Ｓ２６の処理は、安全性判定部２４で実行され、Ｓ１６の処理で評価した緊急停止用の走行制御計画の安全性と、Ｓ２４の処理で評価した走行制御計画の安全性とを比較してより安全な走行制御計画を、今後の走行制御計画として採用する処理である。例えば、それぞれ算出した干渉確率やＴＴＣ等を用いて、より安全な走行制御計画を今後の走行制御計画として採用する。これにより、緊急停止用の走行制御計画の安全性を向上する補正が可能となる。Ｓ２６の処理が終了すると、図２及び図３に示す制御処理を終了する。

一方、Ｓ１８の処理において、仮の走行制御計画及び緊急停止用の走行制御計画の少なくとも何れか一方が安全であると判定した場合には、判定処理へ移行する（Ｓ２８）。Ｓ２８の処理は、安全性判定部２４で実行され、仮の走行制御計画及び緊急停止用の走行制御計画の安全評価の組み合わせを判定する処理であり、仮の走行制御計画及び緊急停止用の走行制御計画のうち、緊急停止用の走行制御計画のみが安全基準を満たしているか否かを判定する処理である。この判定は、例えば、仮の走行制御計画に対応する安全フラグが１であり、緊急停止用の走行制御計画に対応する安全フラグが０であることを確認することによって実現できる。Ｓ２８の処理において、緊急停止用の走行制御計画のみが安全基準を満たしていると判定した場合には、走行計画採用処理へ移行する（Ｓ３０）。

Ｓ３０の処理は、安全性判定部２４で実行され、緊急停止用の走行制御計画を今後の走行制御計画として採用する処理である。仮の走行制御計画及び緊急停止用の走行制御計画のうち、仮の走行制御計画で走行した場合には危険が発生する恐れがあり、緊急停止用の走行制御計画が安全であると判定されているので、緊急停止用の走行制御計画を今後の走行制御計画として採用し、緊急停止によって危険を回避することができる。Ｓ３０の処理が終了すると、図２及び図３に示す制御処理を終了する。

一方、Ｓ２８の処理において、仮の走行制御計画及び緊急停止用の走行制御計画のうち、緊急停止用の走行制御計画のみが安全基準を満たしていると判定しなかった場合には、判定処理へ移行する（図３のＳ３２）。すなわち、Ｓ３２の処理は、安全性判定部２４で実行され、仮の走行制御計画及び緊急停止用の走行制御計画の安全評価の組み合わせを判定する処理であり、仮の走行制御計画及び緊急停止用の走行制御計画のうち、仮の走行制御計画のみが安全基準を満たしているか否かを判定する処理である。この判定は、例えば、仮の走行制御計画に対応する安全フラグが０であり、緊急停止用の走行制御計画に対応する安全フラグが１であることを確認することによって実現できる。Ｓ３２の処理において、仮の走行制御計画のみが安全基準を満たしていると判定した場合には、暫定計画設定処理へ移行する（Ｓ３４）。

Ｓ３４の処理は、安全性判定部２４で実行され、仮の走行制御計画を暫定の走行制御計画として採用する処理である。仮の走行制御計画及び緊急停止用の走行制御計画のうち、仮の走行制御計画のみ安全であるということは、仮の走行制御計画を採用して走行すると、他車両との衝突などの危険が無いが、現状の走行において新たな危険が発生した場合には、緊急停止しても危険を回避することが困難な状況であるといえる。よって、まずは仮の走行制御計画を暫定の走行制御計画に採用することで安全性を確保した後に、現状の走行において新たな危険が発生しても対処できる方法の検討を早期に開始することができる。Ｓ３４の処理が終了すると、走行制御計画の生成処理へ移行する（Ｓ３６）。

Ｓ３６の処理は、制御計画生成部２１で実行され、安全性に重点を置いた走行制御計画を生成する処理である。Ｓ３６の処理は、Ｓ２２の処理と同様の処理である。Ｓ３６の処理が終了すると、安全性評価処理へ移行する（Ｓ３８）。

Ｓ３８の処理は、安全性判定部２４で実行され、Ｓ３６の処理で生成した走行制御計画の安全性を評価する処理である。評価方法及び評価結果の記録方法はＳ１２の処理と同様である。Ｓ３８の処理が終了すると、走行計画採用処理へ移行する（Ｓ４０）。

Ｓ４０の処理は、安全性判定部２４で実行され、Ｓ１２の処理で評価した仮の走行制御計画の安全性と、Ｓ３８の処理で評価した走行制御計画の安全性とを比較してより安全な走行制御計画を今後の走行制御計画として採用する処理である。処理の内容は、Ｓ２６と同様である。これにより、仮の走行制御計画の安全性を向上する補正が可能となる。Ｓ４０の処理が終了すると、図２及び図３に示す制御処理を終了する。

一方、Ｓ３２の処理において、仮の走行制御計画及び緊急停止用の走行制御計画のうち、仮の走行制御計画のみが安全基準を満たしていると判定しなかった場合、すなわち、仮の走行制御計画及び緊急停止用の走行制御計画のいずれもが安全基準を満たしていると判定した場合には、走行制御計画の再作成処理へ移行する（Ｓ４２）。

Ｓ４２の処理は、制御計画生成部２１で実行され、より積極的な走行制御計画を生成する処理である。積極的な走行制御計画とは、快適面や環境面などにおいてより優れた走行制御計画を生成する処理である。快適面としては、例えば走行軌跡をより緩やかに設定し、環境面としては、例えば、燃費効率、時間効率、道路効率等において、効率性の良い走行制御計画を生成する。これにより、仮の走行制御計画に対して走行の効率性と快適性の少なくとも一方を向上する補正を行うことができる。Ｓ４２の処理が終了すると、安全性評価処理へ移行する（Ｓ４４）。

Ｓ４４の処理は、安全性判定部２４で実行され、Ｓ４２の処理で生成したより積極的な走行制御計画の安全性を評価する処理である。評価方法及び評価結果の記録方法はＳ１２の処理と同様である。Ｓ４４の処理が終了すると、判定処理へ移行する（Ｓ４６）。

Ｓ４６の処理は、安全性判定部２４で実行され、より積極的な走行制御計画が安全性を満たしているか否かを判定する処理である。Ｓ４６の処理において、より積極的な走行制御計画が安全性を満たしていると判定した場合には、走行計画採用処理へ移行する（Ｓ４８）。

Ｓ４８の処理は、安全性判定部２４で実行され、Ｓ４２の処理で生成した積極的な走行制御計画を今後の走行制御計画として採用する処理である。Ｓ４８の処理が終了すると、図２及び図３に示す制御処理を終了する。

一方、Ｓ４６の処理において、より積極的な走行制御計画が安全性を満たしていないと判定した場合には、時間的猶予の確認処理へ移行する（Ｓ５０）。Ｓ５０の処理は、Ｓ４２の処理において生成した優れた走行制御計画が安全面に劣るため、再度検討する時間的な余裕があるか否かを判定する処理である。時間的な余裕があるか否かの判定は、危険発生時刻までに再計算を終えることができるか否かを判定すればよく、具体的には、危険発生時刻が現在時刻から１０ｍｓ後であって、再計算の周期が４ｍｓである場合には時間的余裕があると判定する。また、危険発生時刻が現在時刻から２ｍｓ後であって、再計算の周期が４ｍｓである場合には時間的余裕がないと判定する。Ｓ４６の処理において、時間的猶予がないと判定した場合には、走行計画採用処理へ移行する（Ｓ５２）。

Ｓ５２の処理は、安全性判定部２４で実行され、走行制御計画を再計算する時間的余裕がないため、安全性が確認されている仮の走行制御計画を今後の走行制御計画として採用する処理である。Ｓ５２の処理が終了すると、図２及び図３に示す制御処理を終了する。

一方、Ｓ５０の処理において、時間的猶予があると判定した場合には、走行制御計画の再生成処理へ移行する（Ｓ５４）。Ｓ５４の処理は、制御計画生成部２１で実行され、仮の走行制御計画と、Ｓ４２の処理で生成したより積極的な走行制御計画との中間の走行制御計画を生成する処理である。このように、時間的猶予がある場合には、安全性と快適面・環境面のバランスがよい走行制御計画を探索することができる。Ｓ５４の処理が終了すると、図２及び図３に示す制御処理を終了する。

以上、本実施形態に係る走行計画生成装置２０によれば、通常走行用の走行制御計画を生成すると共に、危険を回避するための緊急停止用の走行制御計画を走行制御計画とは別に生成し、生成した通常走行用の走行制御計画及び緊急停止用の走行制御計画が所定の安全基準を満たすか否かを判定し、判定結果を用いて車両１が走行するための走行制御計画を生成することができる。これにより、各走行制御計画の判定結果の組み合わせを利用して走行制御計画を生成するので、安全側に動作する走行計画を効率的に生成することができる。これにより、限られた時間内で安全な走行計画を生成する可能性を高めることができる。

また、本実施形態に係る走行計画生成装置２０によれば、通常走行用の走行制御計画及び緊急停止用の走行制御計画が安全基準を満たさない場合には、車両が緊急停止することを前提として走行制御計画を補正することにより、走行制御計画を除々に安全側に補正する場合に比べて、短時間で安全な走行制御計画を生成する可能を高めることができる。

また、本実施形態に係る走行計画生成装置２０によれば、緊急停止用の走行制御計画のみが安全基準を満たす場合には、緊急停止用の走行制御計画を走行制御計画として採用することができる。これにより、緊急停止を迅速に行い、安全を確保することができる。

また、本実施形態に係る走行計画生成装置２０によれば、通常走行用の走行制御計画のみが安全基準を満たし、緊急停止用の走行制御計画が安全基準を満たさない場合には、走行制御計画の安全性をさらに向上させるように補正することができる。これにより、本来危険な状況を回避するために生成していた緊急停止用の走行制御計画が安全性を満たさない場合に、安全性が確認された走行制御計画の安全性をさらに向上させることで、不測の障害発生等に対して対応できる余裕を作り、将来の安全を確保することができる。

また、本実施形態に係る走行計画生成装置２０によれば、前記走行制御計画生成手段は、前記安全判定手段によって前記走行制御計画及び前記走行制御計画が共に安全基準を満たすと判定された場合に、前記走行制御計画に対して走行の効率性と快適性の少なくとも一方を向上する補正を行うことが好適である。このように構成することで、付加価値のある走行制御計画を生成する前に、走行制御計画の安全性を確認するため、効率的に安全な走行制御計画を生成することができる。

さらに、本実施形態に係る走行計画生成装置２０によれば、速度パターン又は走行軌跡からなる走行制御計画の生成を効率良く行うことができる。

なお、上述した各実施形態は本発明に係る走行計画生成装置の一例を示すものである。本発明に係る走行計画生成装置は、これらの実施形態に係る走行計画生成装置に限られるものではなく、各請求項に記載した要旨を変更しない範囲で、実施形態に係る走行計画生成装置を変形し、又は他のものに適用したものであってもよい。

例えば、上記実施形態においては、緊急回避用の走行制御計画を仮の走行制御計画よりも後に生成している（Ｓ１０〜Ｓ１６）が、緊急回避用の走行制御計画を仮の走行制御計画よりも前に生成した場合や、組み合わせの評価（Ｓ１８、Ｓ２８及びＳ３２）の順番が実施形態で示す順番でない場合であっても、効率的に安全な走行制御計画を生成することができ、要は、走行制御計画を決定する前に緊急停止用の走行制御計画を作成し、安全性の評価を行えればよい。

本実施形態に係る走行計画生成装置を備えた車両の構成図である。図１の走行計画生成装置の動作を示すフローチャートである。図１の走行計画生成装置の動作を示すフローチャートである。

符号の説明

１…車両、２０…走行計画生成装置、２２…制御計画生成部（第１走行計画を生成する手段）、２３…最大減速制御計画生成部（第２走行計画を生成する手段）、２４…安全性判定部（安全基準判定手段、走行計画生成手段）。

Claims

走行方針に従った走行を行うための第１走行計画を生成する手段と、
緊急停止を行うための第２走行計画を生成する手段と、
前記第１走行計画と前記第２走行計画とが所定の安全基準を満たすか否かを判定する安全基準判定手段と、
前記第１走行計画と前記第２走行計画との各安全判定結果の組み合わせに基づいて、所定区間の速度パターンと走行軌跡の少なくとも一方を含む走行計画を生成する走行計画生成手段と、
を備え、
前記走行計画生成手段は、前記安全判定手段によって前記第１走行計画及び前記第２走行計画が共に安全基準を満たさないと判定された場合に、前記第２走行計画に対して安全基準を満たすように補正する走行計画生成装置。
前記走行計画生成手段は、前記安全判定手段によって前記第２走行計画のみが安全基準を満たすと判定された場合に、前記第２走行計画を前記走行計画として採用することを特徴とする請求項１に記載の走行計画生成装置。
前記走行計画生成手段は、前記安全判定手段によって前記第１走行計画のみが安全基準を満たすと判定された場合に、前記第１走行計画に対して安全性を向上する補正を行うことを特徴とする請求項１又は２に記載の走行計画生成装置。
前記走行計画生成手段は、前記安全判定手段によって前記第１走行計画及び前記第２走行計画が共に安全基準を満たすと判定された場合に、前記第１走行計画に対して走行の効率性と快適性の少なくとも一方を向上する補正を行うことを特徴とする請求項１〜３の何れか一項に記載の走行計画生成装置。