JP2020515451A

JP2020515451A - 制御装置並びに方法

Info

Publication number: JP2020515451A
Application number: JP2019540450A
Authority: JP
Inventors: ユ・ヨンホ; ドイシュ・ヘンドリク; エドリング・フランク
Original assignee: コンティネンタル・テーベス・アクチエンゲゼルシヤフト・ウント・コンパニー・オッフェネ・ハンデルスゲゼルシヤフト
Priority date: 2017-04-05
Filing date: 2018-02-26
Publication date: 2020-05-28
Anticipated expiration: 2038-02-26
Also published as: KR102509852B1; WO2018184637A1; DE112018000155A5; JP7125405B2; DE102017205782A1; US20190367013A1; KR20190137767A

Abstract

本発明は、車両（１００，３００，４００，５００，６００，７００，８００）の周辺部の空いている及び空いていない領域を捕捉し、対応する周辺情報（１０６）を出力する様に構成された周辺把握システム（１０５）と、スタートポジション（１０３，３０３，４０３，５０３，６０３，７０３，８０３）を起点とする該周辺情報（１０６）を基に、車両用の衝突なく実施し得る第一軌道（１００，３００，４００，５００，６００，７００，８００）を算出し、続いて、該エンドポジション（１０４，３０４，３１０，３１１，４０４，５０４，６０４，７０４，８０４）を起点として、車両用の衝突なく実施し得る第二軌道（１００，３００，４００，５００，６００，７００，８００）を算出する様に構成された軌道算出手段（１０７）とを備えた、スタートポジション（１０３，３０３，４０３，５０３，６０３，７０３，８０３）を起点としエンドポジション（１０４，３０４，３１０，３１１，４０４，５０４，６０４，７０４，８０４）までの走行軌道（１０２）を算出するための車両（１００，３００，４００，５００，６００，７００，８００）用の制御装置であって、且つ、該軌道算出手段（１０７）が、更に、それらの軌道エンドポジション（７１３，８１３，８１４）が、互いに、予め定められている許容範囲内にある衝突なく実施し得る第一軌道と衝突なく実施し得る第二軌道の少なくとも一つのペアを割り出し、少なくとも一つのペアを該車両軌道（１０２）として出力する様に構成されている制御装置（１０１）を開示している。本発明は更に、対応する方法も開示している。

Description

本発明は、スタートポジションからエンドポジションへの走行軌道を算出するための車両用の制御装置に関する。更に、本発明は、対応する方法にも関する。

本発明は、以下、主に乗用自動車との関連において説明されるが、それに制限されることなく、如何なる種類の車両においても使用可能である。

最新の車両では、ドライバーは、より頻繁に、自動化された、或いは、少なくとも、部分的に自動化された走行を可能にするアシスタント・システムによってサポートされる。

例えば、あるドライバー・アシスタント・システムは、ドライバーのために、車両の駐車を請け負うことができる。そのためには、該ドライバー・アシスタント・システムは、その時点の車両のポジションからの、その上を通って車両が、駐車スペースに移動する軌道が、選択されなければならない。

可能な軌道の算出は、通常、非常に煩雑であり、且つ、高い計算能力を必要とする。

よって、本発明の課題は、車両用の効率の良い軌道計画を可能にすることである。

この課題は、独立特許請求項１の特徴を有する制御装置によって、並びに、独立特許請求項９の特徴を有する方法によって解決される。

それによれば：
車両の周辺部の空いている、即ち、走行可能な、及び、空いていない、即ち、走行できない、領域を捕捉し、対応する周辺情報を出力する様に構成された周辺把握システムと、スタートポジションを起点とする該周辺情報を基に、車両用の衝突なく実施し得る第一軌道を算出し、続いて、該エンドポジションを起点として、車両用の衝突なく実施し得る第二軌道を算出する様に構成された軌道算出手段とを備えた、スタートポジションを起点としエンドポジションまでの走行軌道を算出するための車両用の制御装置であるが、該軌道算出手段は、更に、それらの軌道エンドポジションが、互いに、予め定められている許容範囲内にある衝突なく実施し得る第一軌道と衝突なく実施し得る第二軌道の少なくとも一つのペアを割り出し、少なくとも一つのペアを該車両軌道として出力する様に構成されている。

更に、以下も想定されている：
車両の周辺部の空いている及び空いていない領域を捕捉し、対応する周辺情報を出力するステップ、スタートポジションを起点として該周辺情報に基づいて衝突なく実施し得る第一軌道を算出するステップ、エンドポジションを起点として該周辺情報に基づいて衝突なく実施し得る第二軌道を算出するステップ、それらの軌道エンドポジションが、互いに、予め定められている許容範囲内にある衝突なく実施し得る第一軌道と衝突なく実施し得る第二軌道の少なくとも一つのペアを割り出ステップ、並びに、少なくとも一つのペアを車両軌道として出力するステップを包含するスタートポジションを起点としエンドポジションまでの走行軌道を算出するための方法。

本発明は、上の従来の技術において記した如く、スタートポジションからエンドポジションへの可能な中間ステップを含む全ての可能な走行軌道を、算出することは、非常に手間暇がかかると言う認識に基づくものである。

よって、本発明は、例えば、自動駐車プロセス用の走行軌道の算出に係る計算負荷を、車両のスタートポジションからと同時に望まれるエンドポジションからも衝突なく実施し得る軌道を算出すれば、有意に低減できると言う認識に基づくものである。

本発明は、例えば、車両の駐車プロセス用の走行軌道の算出に、使用することができる。該スタートポジションは、例えば、その時点における車両のポジションとして与えることができる。エンドポジションは、例えば、予め、可能な駐車ポジションを割りだすことができる、駐車アシスタントなど、アシスタント機能によって与えることができる。

該周辺把握手段は、例えば、車両の周辺部を捕捉することに適したセンサを有していることができる。この様なセンサは、例えば、超音波センサ、レーダセンサ、ライダセンサや同様なものであることができる。しかしながら、該周辺把握センサは、例えば、他のシステムのセンサデータに基づいて、該車両用の周辺モデルを作成し、例えば、本発明に係る制御装置などの他の車両システムに提供する車両の中央制御装置であることもできる。

本発明は、更に、軌道算出手段も想定している。該軌道算出手段は、既に上述した如く、スタートポジションを起点に、衝突なく実施し得る第一軌道を、エンドポジションを起点に衝突なく実施し得る第二軌道を算出する。

ここで言う「衝突なく実施し得る軌道」とは、車両が、車両周辺部にある障害物に衝突することなく走行できる車両の軌道であると解釈できる。当然のことながら、例えば、オブジェクト乃至障害物までのこれを下回ってはならない最短間隔は、予め与えることができる。

軌道算出手段が、第一軌道と第二軌道を算出した場合、これは、少なくとも一つの第一及び第二軌道の軌道エンドポジションが、互いに、予め与えられている公差範囲内にあるか否かを確かめる。

該許容範囲は、車両が、第一軌道の軌道エンドポジションから、第二軌道の軌道エンドポジションに移行できる様に選択することができる。

その結果、車両は、スタートポジションからエンドポジションに到達するために、選択された第一軌道に追従し、その後、選択された第二軌道を追従することも可能である。該制御装置は、例えば、ドライバーが何もしなくても、該車両が、エンドポジションに到達するために、先ず、選択された第一軌道を、続いて、選択された第二軌道を操縦することができる様に構成されていることができる。代案的には、該制御装置は、選択された第一軌道と選択された第二軌道を適宜なアシスタント・システムに出力することも可能である。

スタートポジションからエンドポジションへの車両軌道を算出する計算負荷は、本発明に係る両方向からのアプローチでは、確認されなければならないバリエーションが非常に少ないため、低減する。

好ましい実施形態と発展形態は、従属請求項並びに図に基づいた説明によって開示される。

ある実施形態では、該軌道算出手段は、第一軌道と第二軌道を、可能な最も短い軌道として算出する様に構成されていることができる。

この様な軌道を算出する方法としては、例えば、ＢｅｒｎｈａｒｄＲｏｂｅｒｔＭuｌｌｅｒの博士論文「Ｔｗｏ−ｓｔｅｐＴｒａｊｅｃｔｏｒｙＰｌａｎｎｉｎｇｆｏｒＡｕｔｏｍａｔｉｃＰａｒｋｉｎｇ」に、特に、「３．２．２ＳｈｏｒｔｅｓｔＡｄｍｉｓｓｉｂｌｅＴｒａｊｅｃｔｏｒｙＳｅｑｕｅｎｃｅｓａｃｃｏｒｄｉｎｇｔｏＲｅｅｄｓａｎｄＳｈｅｐｐ」に開示されている方法が挙げられる。

ある実施形態では、該許容範囲は、該車両の走行力学的パラメータに基づいて、第一軌道のエンドポジションから第二軌道のエンドポジションに移行し、且つ、これに追従できる様に、予め定められていることができる。

即ち、該許容範囲は、エンドポジション間の間隔であることができる。しかしながら同時に、該許容範囲は、軌道の互いの角度も考慮することができる。例えば、それぞれのエンドポイントにおける第一と第二軌道との間の最大許容される角度は、車両が、走行できる最大の角度に相当する。

ある実施形態では、該軌道算出手段は、第一軌道と第二軌道を、円弧と直線の組合せとして、及び／或いは、円弧と円弧の組合せとして、及び／或いは、円弧と円弧及び直線の組合せとして算出できる様に構成されていることができる。

軌道用に許される形状を限定することにより、軌道の容易な算出が可能になる。

ある実施形態では、該軌道算出手段は、各々の開始ポジションを起点に、予め与えられている角解像度において軌道を算出する様に構成されていることができる。

ここで言う「角解像度」と言う定義は、その角度において車両の周りがセンシングされる角解像度であると解釈できる。例えば、角解像度９０°の場合は、前方、後方、下方、上方それぞれ１本のラインのみが確認される。解像度が、２°の場合、１８０本のライン（これらのラインは、全て、車両原点を通っている）である。軌道の算出は、オブジェクト乃至障害物との衝突が割り出された場合、停止される。

ある実施形態では、軌道算出手段は、軌道エンドポジションを、エンドポジションの座標系に転換し、軌道エンドポジションが、互いに、予め定められている許容範囲内にあるか否かを確認する様に構成されていることができる。

双方の軌道が、同じ座標系にある場合、軌道エンドポジションの比較が、容易になる。エンドポジションの座標系は、原点、例えば、エンドポジションを有することができる。

ある実施形態では、該軌道算出手段は、どの第一軌道と第二軌道とのペアにおいても、それぞれの軌道エンドポジションが、互いに、予め定められている許容範囲にない場合、互いの間隔が最も小さい第一軌道と第二軌道の軌道エンドポジションを割り出し、割り出された第二軌道の軌道エンドポジションを中間エンドポジションとして選択する様に構成されていることができる。該軌道算出手段は、更に、該中間エンドポジションを起点として、該車両用の衝突なく実施し得る第二軌道の候補を算出し、衝突なく実施し得る第一軌道と中間エンドポジションを基に算出された衝突なく実施し得る第二軌道との、それらの軌道エンドポジションが、互いに予め定められている許容範囲内にある少なくとも一つのペアを割り出す様に構成されていることもできる。

第一軌道と第二軌道のエンドポイントが、互いに許容範囲内に無い場合、本発明では、先に算出された第一軌道と第二軌道を、次の計算のベースとなる中間結果として使用することが想定されている。互いに最も近い軌道エンドポジションを起点として、元の計算が、少なくとも第二軌道様に繰り返される。

ある実施形態では、該軌道算出手段は、回帰的に、第一軌道と第二軌道の、互いの間隔が最も小さい軌道エンドポジションを割り出し、それぞれの第二軌道の中間エンドポジションを起点として、該車両用の衝突なく実施し得る第二軌道の候補を、少なくとも、衝突なく実施し得る第一軌道と該中間エンドポジションを基にして算出された衝突なく実施し得る第二軌道の、それらの軌道エンドポジションが、互いに予め定められている許容範囲内にあるペアを割り出すことができるまで計算する様に構成されていることができる。

前述した如く、本発明では、先の計算ステップの結果が使用され、適した軌道を選択するために、全ての候補が、算出される訳ではない。これにより、計算負荷は、有意に削減される。

軌道サーチの回帰的な解決案では、更に、回帰の最多回数などの中止条件を予め定めておくこともできる。

上記の実施形態やその発展形態は、有意義である限り、互いに自由に組み合わせることが可能である。更なる可能な形態や発展形態、並びに、本発明の実施形態には、上記の本発明に係る特徴や以下に実施例と関連して述べる本発明に係る特徴の具体的には記述されない組み合わせも包含される。更に、本発明の各々の基本形に対する改善や捕捉として当業者が個別的アスペクトを加えた場合も包含される。

該制御装置は、例えば、車載制御装置として構成されていることができる。更に、該制御装置は、複数の制御装置の組合せとして構成されていることもできる。該制御装置は、更に、ハードウェアとソフトウェアの組合せとして構成されていることもできる。例えば、該制御装置の機能は、ある計算手段内の、又は、複数の計算手段からなるある群内のコンピュータープログラムとして実施されることもできる。

以下本発明を、概略的な図として描かれている実施例を参照しながら詳しく説明する。図の説明：

図１は、本発明に係る制御手段のある実施形態のブロック図を、図２は、本発明に係る方法のある実施形態のフローチャートを、図３は、軌道の候補のグラフを、図４は、車両周辺部並びに、スタートポジションとエンドポジションのグラフを、図５は、衝突なく実施し得る第一軌道のグラフを、図６は、衝突なく実施し得る第二軌道のグラフを、図７は、軌道エンドポジションと中間ポジションのグラフを、そして、図８は、最終軌道のグラフを示している。

全ての図において、同じ、或いは、同じ機能を有するエレメント、並びに、手段に対しては − 特に記さない限り − 同じ符号がつけられている。

図１は、車両１００内に配置されている制御装置１０１の実施形態のブロック図を示している。

該制御装置１０１は、軌道算出手段１０７と組み合わされている周辺把握システム１０５を有している。

該周辺把握システム１０５は、車両１００の周辺部の空いている及び空いていない領域を捕捉し、対応する周辺情報１０６を出力する。

軌道算出手段１０７は、該周辺情報１０６に基づいて、スタートポジション１０３を起点として、該車両１００用の衝突なく実施し得る第一軌道の候補を算出する。更に、該軌道算出手段１０７は、予め定められているエンドポジション１０４から、該車両１００用の衝突なく施し得る第二軌道の候補も算出する。

続いて、該軌道算出手段１０７は、衝突なく実施し得る第一軌道と衝突なく実施し得る第二軌道との少なくとも一つの、それらの軌道エンドポジションが、互いに予め定められている許容範囲内にあるペアを割り出す。該少なくとも一つのペアは、続いて、車両軌道１０２として出力される。

第軌道算出手段１０７は、第一軌道と第二軌道を、例えば、可能な最も短い軌道として算出することができる。この様な軌道を算出する方法としては、例えば、ＢｅｒｎｈａｒｄＲｏｂｅｒｔＭuｌｌｅｒの博士論文「Ｔｗｏ−ｓｔｅｐＴｒａｊｅｃｔｏｒｙＰｌａｎｎｉｎｇｆｏｒＡｕｔｏｍａｔｉｃＰａｒｋｉｎｇ」に、特に、「３．２．２ＳｈｏｒｔｅｓｔＡｄｍｉｓｓｉｂｌｅＴｒａｊｅｃｔｏｒｙＳｅｑｕｅｎｃｅｓａｃｃｏｒｄｉｎｇｔｏＲｅｅｄｓａｎｄＳｈｅｐｐ」に開示されている方法が挙げられる。

更に、該第一軌道と第二軌道は、例えば、円弧と直線の組合せとして、及び／或いは、円弧と円弧の組合せとして、及び／或いは、円弧と円弧及び直線の組合せとして算出することもできる。

計算負荷を低減するために、該軌道算出手段１０７は、各々の開始ポジションを起点に、予め与えられている角解像度において軌道を算出する様に構成されていることもできる。

第一軌道と第二軌道からなるペアを割り出すための該許容範囲は、該車両１００の走行力学的パラメータに基づいて、第一軌道の軌道エンドポジションから第二軌道の軌道エンドポジション１０４に移行し、且つ、これに追従できる様に、予め定められていることができる。

該軌道算出手段１０７は、更に、軌道エンドポジションをエンドポジション１０４の座標系に転換し、該エンドポジション１０４の座標系において、軌道エンドポジションが、互いに、予め定められている許容範囲内にあるか否かを確認することもできる。

どの第一軌道と第二軌道とのペアにおいても、それぞれの軌道エンドポジションが、互いに、予め定められている許容範囲にない場合、該軌道算出手段１０７は、回帰的方法を実施することができる。該軌道算出手段１０７は、互いの間隔が最も小さい第一軌道と第二軌道の軌道エンドポジションを割り出し、割り出された第二軌道の軌道エンドポジションを中間エンドポジションとして選択することができる。該中間エンドポジションを用いて、該軌道算出手段１０７は、該車両１００用の衝突なく実施し得る第二軌道の候補を算出し、衝突なく実施し得る第一軌道と中間エンドポジションを基に算出された衝突なく実施し得る第二軌道との、それらの軌道エンドポジションが、互いに予め定められている許容範囲内にある少なくとも一つのペアを割り出す様に構成されていることもできる。

この二巡目においても適切なペアが見つからない場合、該軌道算出手段１０７は、更に、回帰的方法を進めることができる

該軌道算出手段１０７は、改めて、第一軌道と第二軌道の、互いの間隔が最も小さい軌道エンドポジションを割り出し、それぞれの第二軌道の中間エンドポジションを起点として、該車両１００用の衝突なく実施し得る第二軌道の候補を、少なくとも、衝突なく実施し得る第一軌道と該中間エンドポジションを基にして算出された衝突なく実施し得る第二軌道の、それらの軌道エンドポジションが、互いに予め定められている許容範囲内にあるペアを割り出すことができるまで計算することもできる。中止条件としては、例えば、回帰の回数を用いることができる。

図２は、本発明に係る車両１００，３００，４００，５００，６００，７００，８００用のスタートポジション１０３，３０３，４０３，５０３，６０３，７０３，８０３を起点としてエンドポジション１０４，３０４，３１０，３１１，４０４，５０４，６０４，７０４，８０４までの車両軌道１０２を算出するための方法の実施形態のグラフを示している。

該方法は、車両１００，３００，４００，５００，６００，７００，８００の周辺部の空いている及び空いていない領域を捕捉Ｓ１し、対応する周辺情報１０６を出力するステップを有している。更には、該車両１００，３００，４００，５００，６００，７００，８００用のスタートポジション１０３，４０３，５０３，６０３，７０３，８０３を起点として該周辺情報１０６に基づいて衝突なく実施し得る第一軌道が算出Ｓ２される。

該車両１００用の該エンドポジション１０４，４０４，５０４，６０４，７０４，８０４を起点として該周辺情報１０６に基づいて衝突なく実施し得る第二軌道も算出Ｓ３される。

該方法では、それらの軌道エンドポジション７１３，８１３，８１４が、互いに、予め定められている許容範囲内にある衝突なく実施し得る第一軌道と衝突なく実施し得る第二軌道の少なくとも一つのペアを割り出しＳ４、並びに、該少なくとも一つのペアを車両軌道１０２として出力Ｓ５することも想定されている。

該許容範囲は、車両１００，３００，４００，５００，６００，７００，８００が、走行力学的パラメータに基づいて、第一軌道のエンドポジション１０４，３０４，３１０，３１１，４０４，５０４，６０４，７０４，８０４から第二軌道のエンドポジション１０４，３０４，３１０，３１１，４０４，５０４，６０４，７０４，８０４へ移行でき、且つ、これに追従できる様に予め定められていることができる。

更に、第一軌道と第二軌道は、例えば、可能な最短の軌道として算出されることができる。更に、該第一軌道と第二軌道は、円弧と直線の組合せとして、及び／或いは、円弧と円弧の組合せとして、及び／或いは、円弧と円弧及び直線の組合せとしても算出することができる。

該方法では、更に、各々の開始ポジションを起点に、予め与えられている角解像度において軌道を算出することを想定していても良い。

更に、該軌道エンドポジション７１３，８１３，８１４は、エンドポジション１０４，３０４，３１０，３１１，４０４，５０４，６０４，７０４，８０４の座標系に転換され、該エンドポジション１０４，３０４，３１０，３１１，４０４，５０４，６０４，７０４，８０４の座標系において、該軌道エンドポジション７１３，８１３，８１４が、互いに、予め定められている許容範囲内にあるか否かを確認することができる。

該方法の第一巡目において結果が得られなかった場合、例えば、第一軌道と第二軌道から、それぞれの軌道エンドポジション７１３，８１３，８１４が、互いに予め定められている許容範囲内にあるペアが無い場合、互いの間隔が最少である第一軌道と第二軌道のそれぞれの軌道エンドポジション７１３，８１３，８１４を割り出すことができる。

割り出された第二軌道の該軌道エンドポジション７１３，８１３，８１４は、中間エンドポジションとして選択することができる。該中間エンドポジションを起点として、該車両１００，３００，４００，５００，６００，７００，８００用の衝突なく実施し得る第二軌道の候補を算出し、衝突なく実施し得る第一軌道と中間エンドポジションを基に算出された衝突なく実施し得る第二軌道との、それらの軌道エンドポジション７１３，８１３，８１４が、互いに予め定められている許容範囲内にある少なくとも一つのペアを割り出すこともできる。

該方法は、結果が得られるまで、回帰的に実施できる。その際、第一軌道と第二軌道の互いの間隔が最も小さい軌道エンドポジション７１３，８１３，８１４を回帰的に割り出す。それぞれの第二軌道の該中間エンドポジションを起点として、該車両１００，３００，４００，５００，６００，７００，８００用の衝突なく実施し得る第二軌道の候補が、衝突なく実施し得る第一軌道と中間エンドポジションを基に算出された衝突なく実施し得る第二軌道との、それらの軌道エンドポジション７１３，８１３，８１４が、互いに予め定められている許容範囲内にある少なくとも一つのペアが割り出されるまで、計算される。

図３は、軌道算出手段１０７によって算出された可能な軌道３２０，３２１，３２２のグラフを示している。

該軌道３２０，３２１，３２２は、一つのスタートポジション３０３を起点とし、それぞれエンドポイント３０４，３１０，３１１において終了している。

軌道３２０は、円弧、乃至、円弧と直線のセグメント（前進）から構成されている。

軌道３２１は、円弧、乃至、後進する円弧のセグメント、並びに、円弧、乃至、前進する円弧のセグメントから構成されている。

軌道３２２は、円弧、乃至、後進する円弧のセグメント、円弧、乃至、前進する円弧のセグメント、並びに、直線から構成されている。

ここで述べられている軌道の種類３２０，３２１，３２２は、軌道算出手段による第一及び第二軌道の算出のためのベースである。言うまでも無く、バリエーションにおいては、他の軌道の種類も使用できる。

図４は、一台の車両４００の車両周辺部、並びに、スタートポジション４０３とエンドポジション４０４のグラフを示している。車両周辺部は、境界４１２によって区画されている。これは、そこを走行できない、乃至、その上を乗り越えることができないオブジェクトや障害物を表している。エンドポジション４０４は、その中に車両４００が、進入する（駐車）空間内に配置されている。

図４の配置は、図５から８の本発明に係る方法の説明の基礎になっている。

図５は、衝突なく実施し得る第一軌道のグラフを示している。車両５００のスタートポジション５０３を起点として、車両５００が走行可能な軌道の候補が、算出されていることが認識できる。これは、前進用にも後進用にも実施される。それぞれのエンドポジションも、同様に示されてはいるが、見やすさを考慮して、個別に符号は付けていない。

第一軌道を算出するために、上述した如く、予め与えられた、角解像度が、はっきりと認識できる。

図６は、衝突なく実施し得る第二軌道のグラフを示している。図５と同様、車両６００のスタートポジション６０３を起点として、車両６００が走行可能な軌道の候補が、算出されていることが認識できる。これも、前進用にも後進用にも実施される。それぞれのエンドポジションも、同様に示されてはいるが、見やすさを考慮して、個別に符号は付けていない。

ここでも、予め与えられている角解像度が、維持される。

図７は、軌道エンドポジション７１３を有するグラフを示している。該軌道エンドポジション７１３は、図５の第一軌道と図６の第二軌道からは、それらの軌道エンドポジションが、互いに予め定められている許容範囲内にあるペアを、割り出すことができなかったため、中間ステップとしての役割を果たす。

その結果、該軌道エンドポジション７１３は、正に、第一軌道のうちの一つの軌道エンドポジションと最も小さな間隔を有する第二軌道の軌道エンドポジションを示している。

図８は、方法を複数回回帰した結果得られた最終軌道のフラフを示している。

先ず、最終軌道は、軌道エンドポジション８１４を通っている。ここから、軌道エンドポジション８１５を通る。そして、軌道エンドポジション８１５から、該最終軌道は、軌道エンドポジション８１３を経て、最後に、エンドポジション８０４に達している。

好ましい実施例によって上記のごとく説明されはしたが、本発明は、これらに制限されるものではなく、多種多様な方法や構成によって変更することが可能である。特に、本発明は、本発明の趣旨から逸脱することなく、多種多様に変更や修正することが可能である。

１００，３００，４００車両
５００，６００，７００，８００車両
１０１制御装置
１０２車両軌道
１０３，４０３スタートポジション
５０３，６０３，７０３，８０３スタートポジション
１０４，３０４，３１０，３１１エンドポジション
４０４，６０４，７０４，８０４エンドポジション
１０５周辺把握システム
１０６周辺情報
１０７軌道算出手段
３２０，３２１，３２２軌道
４１２，５１２，６１２，７１２，８１２境界
７１３，８１３，８１４軌道エンドポジション
Ｓ１ - Ｓ５方法ステップ

Claims

車両（１００，３００，４００，５００，６００，７００，８００）の周辺部の空いている及び空いていない領域を捕捉し、対応する周辺情報（１０６）を出力する様に構成された周辺把握システム（１０５）と、
スタートポジション（１０３，３０３，４０３，５０３，６０３，７０３，８０３）を起点とする該周辺情報（１０６）を基に、車両用の衝突なく実施し得る第一軌道（１００，３００，４００，５００，６００，７００，８００）を算出し、続いて、該エンドポジション（１０４，３０４，３１０，３１１，４０４，５０４，６０４，７０４，８０４）を起点として、車両用の衝突なく実施し得る第二軌道（１００，３００，４００，５００，６００，７００，８００）を算出する様に構成された軌道算出手段（１０７）とを備えた、
スタートポジション（１０３，３０３，４０３，５０３，６０３，７０３，８０３）を起点としエンドポジション（１０４，３０４，３１０，３１１，４０４，５０４，６０４，７０４，８０４）までの走行軌道を算出するための車両（１００，３００，４００，５００，６００，７００，８００）用の制御装置であって、
該軌道算出手段（１０７）が、更に、
それらの軌道エンドポジション（７１３，８１３，８１４）が、互いに、予め定められている許容範囲内にある衝突なく実施し得る第一軌道と衝突なく実施し得る第二軌道の少なくとも一つのペアを割り出し、少なくとも一つのペアを該車両軌道（１０２）として出力する様に構成されていることを特徴とする制御装置（１０１）。
該軌道算出手段（１０７）が、第一軌道と第二軌道を、可能な最も短い軌道として算出することを特徴とする請求項１に記載の制御装置（１０１）。
該許容範囲が、該車両（１００，３００，４００，５００，６００，７００，８００）が、その走行力学的パラメータにおいて、該第一軌道の軌道エンドポジション（７１３，８１３，８１４）から第二軌道の軌道エンドポジション（７１３，８１３，８１４）へ移行し、それを追従できる様に、予め与えられていることを特徴とする先行請求項のうち何れか一項に記載の制御装置（１０１）。
該軌道算出手段（１０７）は、第一軌道と第二軌道を、円弧と直線の組合せとして、及び／或いは、円弧と円弧の組合せとして、及び／或いは、円弧と円弧及び直線の組合せとして算出する様に構成されていることを特徴とする先行請求項のうち何れか一項に記載の制御装置（１０１）。
該軌道算出手段（１０７）が、予め与えられている角解像度において、各々の開始ポジションを起点に、軌道を算出する様に構成されていることを特徴とする先行請求項のうち何れか一項に記載の制御装置（１０１）。
該軌道算出手段（１０７）が、該軌道エンドポジション（７１３，８１３，８１４）を、エンドポジション（１０４，３０４，３１０，３１１，４０４，５０４，６０４，７０４，８０４）の座標系に転換し、該エンドポジション（１０４，３０４，３１０，３１１，４０４，５０４，６０４，７０４，８０４）の座標系において、該軌道エンドポジション（７１３，８１３，８１４）が、互いに、予め定められている許容範囲内にあるか否かを確認することができる様に構成されていることを特徴とする先行請求項のうち何れか一項に記載の制御装置（１０１）。
該軌道算出手段（１０７）が、どの第一軌道と第二軌道とのペアにおいても、それぞれの軌道エンドポジション（７１３，８１３，８１４）が、互いに、予め定められている許容範囲にない場合、互いの間隔が最も小さい第一軌道と第二軌道の軌道エンドポジション（７１３，８１３，８１４）を割り出し、割り出された第二軌道の軌道エンドポジション（７１３，８１３，８１４）を中間エンドポジションとして選択する様に構成されており、且つ、
該軌道算出手段（１０７）が、
該中間エンドポジションを起点として、該車両（１００，３００，４００，５００，６００，７００，８００）用の衝突なく実施し得る第二軌道の候補を算出し、衝突なく実施し得る第一軌道と中間エンドポジションを基に算出された衝突なく実施し得る第二軌道との、それらの軌道エンドポジション（７１３，８１３，８１４）が、互いに予め定められている許容範囲内にある少なくとも一つのペアを割り出す様に構成されている
ことを特徴とする先行請求項のうち何れか一項に記載の制御装置（１０１）。
該軌道算出手段（１０７）が、回帰的に、第一軌道と第二軌道の、互いの間隔が最も小さい軌道エンドポジション（７１３，８１３，８１４）を割り出し、それぞれの第二軌道の中間エンドポジションを起点として、該車両（１００，３００，４００，５００，６００，７００，８００）用の衝突なく実施し得る第二軌道の候補を、少なくとも、衝突なく実施し得る第一軌道と該中間エンドポジションを基にして算出された衝突なく実施し得る第二軌道の、それらの軌道エンドポジション（７１３，８１３，８１４）が、互いに予め定められている許容範囲内にあるペアを割り出すことができるまで計算する様に構成されていることを特徴とする請求項７に記載の制御装置（１０１）。
以下のステップを包含することを特徴とする、車両（１００，３００，４００，５００，６００，７００，８００）用のスタートポジション（１０３，３０３，４０３，５０３，６０３，７０３，８０３）を起点としてエンドポジション（１０４，３０４，３１０，３１１，４０４，５０４，６０４，７０４，８０４）に至る車両軌道（１０２）を算出するための方法：
車両（１００，３００，４００，５００，６００，７００，８００）の周辺部の空いている及び空いていない領域を捕捉し、対応する周辺情報（１０６）を出力するステップ（Ｓ１）、
該車両（１００，３００，４００，５００，６００，７００，８００）用のスタートポジション（１０３，４０３，５０３，６０３，７０３，８０３）を起点として該周辺情報（１０６）に基づいて衝突なく実施し得る第一軌道を算出するステップ（Ｓ２）、
該車両（１００，３００，４００，５００，６００，７００，８００）用の該エンドポジション（１０４，４０４，５０４，６０４，７０４，８０４）を起点として該周辺情報（１０６）に基づいて衝突なく実施し得る第二軌道を算出するステップ（Ｓ３）、
それらの軌道エンドポジション（７１３，８１３，８１４）が、互いに、予め定められている許容範囲内にある衝突なく実施し得る第一軌道と衝突なく実施し得る第二軌道の少なくとも一つのペアを割り出すステップ（Ｓ４）、並びに、
少なくとも一つのペアを車両軌道（１０２）として出力するステップ（Ｓ５）
を包含する
スタートポジションを起点としエンドポジションまでの走行軌道を算出するための方法。
第一軌道と第二軌道は、可能な最短の軌道として算出されることを特徴とする請求項９に記載の方法。
該許容範囲が、該車両（１００，３００，４００，５００，６００，７００，８００）が、その走行力学的パラメータにおいて、該第一軌道の軌道エンドポジション（７１３，８１３，８１４）から第二軌道の軌道エンドポジション（７１３，８１３，８１４）へ移行し、それを追従できる様に、予め与えられていることを特徴とする先行請求項９及び１０のうち何れか一項に記載の方法。
第一軌道と第二軌道を、円弧と直線の組合せとして、及び／或いは、円弧と円弧の組合せとして、及び／或いは、円弧と円弧及び直線の組合せとして計算されることを特徴とする先行請求項９から１１のうち何れか一項に記載の方法。
それぞれの開始ポジションを起点として、予め与えられている角解像度において、軌道を算出する；
及び／或いは、
軌道エンドポジション（７１３，８１３，８１４）を、エンドポジション（１０４，３０４，３１０，３１１，４０４，５０４，６０４，７０４，８０４）の座標系に転換し、該エンドポジション（１０４，３０４，３１０，３１１，４０４，５０４，６０４，７０４，８０４）の座標系において、該軌道エンドポジション（７１３，８１３，８１４）が、互いに、予め定められている許容範囲内にあるか否かを確認する
ことを特徴とする先行請求項９から１２のうち何れか一項に記載の方法。
どの第一軌道と第二軌道とのペアにおいても、それぞれの軌道エンドポジション（７１３，８１３，８１４）が、互いに、予め定められている許容範囲にない場合、互いの間隔が最も小さい第一軌道と第二軌道の軌道エンドポジション（７１３，８１３，８１４）を割り出し、割り出された第二軌道の軌道エンドポジション（７１３，８１３，８１４）を中間エンドポジションとして選択し、且つ、
該中間エンドポジションを起点として、該車両（１００，３００，４００，５００，６００，７００，８００）用の衝突なく実施し得る第二軌道の候補を算出し、衝突なく実施し得る第一軌道と中間エンドポジションを基に算出された衝突なく実施し得る第二軌道との、それらの軌道エンドポジション（７１３，８１３，８１４）が、互いに予め定められている許容範囲内にある少なくとも一つのペアを割り出す
ことを特徴とする先行請求項９から１３のうち何れか一項に記載の方法。
回帰的に、第一軌道と第二軌道の、互いの間隔が最も小さい軌道エンドポジション（７１３，８１３，８１４）を割り出し、それぞれの第二軌道の中間エンドポジションを起点として、該車両（１００，３００，４００，５００，６００，７００，８００）用の衝突なく実施し得る第二軌道の候補を、少なくとも、衝突なく実施し得る第一軌道と該中間エンドポジションを基にして算出された衝突なく実施し得る第二軌道の、それらの軌道エンドポジション（７１３，８１３，８１４）が、互いに予め定められている許容範囲内にあるペアを割り出すことができるまで計算することを特徴とする請求項１４に記載の方法。