JP2021163452A - 汎用ナビゲーションシステムを有する車両のための目標指向型ナビゲーションシステム、方法、および非一時的コンピュータ可読媒体 - Google Patents

Abstract

【課題】汎用ハードウェアコンポーネントを使用して車両の自律ナビゲーションを提供するための費用対効果の高いソリューションを提供する。
【解決手段】汎用ナビゲーションシステムを有する車両のための目標指向型ナビゲーションシステムは、ひとつ以上のプロセッサと、メモリを備える。メモリは、プロセッサに、知覚データを受信させ、知覚データを複数の格子に離散化させ、複数の格子に対応する複数のセルを有する衝突確率配列を生成させ、衝突確率配列のどのセルが安全基準を満たすかを決定させ、衝突確率配列の複数のセルに対応する複数のセルを有する人工ポテンシャルフィールド配列を受信させ、衝突確率配列のセルに対応する複数のセルを有する目標スコア配列を生成させ、最も高い値を有する目標スコア配列内のセルを表す場所に車両制御システムが車両を誘導するように指示させる、ひとつ以上のモジュールを含む。
【選択図】図２

Description

この明細書で説明する手段は、たとえば一般的な知覚システムのような車両の一般的なコンポーネントを利用する目標指向型ナビゲーションシステムを使用して車両を操縦するためのシステムおよび方法に関する。

提供された背景技術の説明は、開示のおおよその概要を示している。この背景技術の項で説明される範囲における発明者の活動、および、出願時において先行技術と見なされない説明の側面は、この技術に対する先行技術として、明示的にも、または、黙示的にも、自認されたものではない。

一部の車両には、乗員の入力がほとんどないか、まったくない状態で車両を操縦できる完全自律システムが装備されている。完全自律システムは、非常に複雑で高価であり、多数の専用センサ、計算ハードウェアなどを使用する必要がある。

あるいは、一部の車両は、警告を発したり、特定の状況下で車両を制御したりできるひとつ以上のアクティブセーフティシステムを有する。アクティブセーフティシステムは、レーンキープアシスト、アダプティブクルーズコントロール、物体検出、緊急ブレーキなどのシステムを含むことができる。アクティブセーフティシステムは、完全自律的型の動作を提供するものではない。しかしながら、完全自律システムが必要とするいくつかの動作を実行する。たとえば、これらのシステムは、ひとつ以上の知覚センサから情報を収集し、この情報を汎用ナビゲーション意思決定システムに中継する。

このセクションは一般的に開示を要約したものであり、その全範囲またはそのすべての機能を包括的に説明するものではない。

一実施形態では、汎用ナビゲーションシステムを有する車両のための目標指向型ナビゲーションシステムは、ひとつ以上のプロセッサと、ひとつ以上のプロセッサと通信可能なメモリと、を備える。メモリは、受信モジュール、離散化モジュール、衝突確率モジュール、目標スコア配列モジュール、および車両制御モジュールを格納している。受信モジュールは、ひとつ以上のプロセッサによって実行されると、ひとつ以上のプロセッサに、車両の知覚システムから知覚データを受信させる命令を含む。離散化モジュールは、ひとつ以上のプロセッサによって実行されると、ひとつ以上のプロセッサに、知覚データを、車両の現在位置に隣接し、複数の格子で構成される領域に離散化させる命令を含む。

衝突確率モジュールは、ひとつ以上のプロセッサによって実行されると、ひとつ以上のプロセッサに、複数の格子に対応する複数のセルを有する衝突確率配列を生成させる命令を含む。衝突確率配列のセルは、車両が衝突確率配列のセルで表される領域に移動した場合の衝突の可能性を示す。衝突確率モジュールは、また、衝突確率配列のどのセルが安全基準を満たすかをひとつ以上のプロセッサに決定させる。

目標スコア配列モジュールは、ひとつ以上のプロセッサによって実行されると、ひとつ以上のプロセッサに、安全基準を満たす衝突確率配列のセルに対応する複数のセルを有する目標スコア配列を生成させる命令を含む。目標スコア配列のセルの値は、衝突確率配列の対応するセルの値と、人工ポテンシャルフィールド配列の対応するセルの値とに基づいている。車両制御モジュールは、ひとつ以上のプロセッサによって実行されると、車両制御システムが車両をある場所に誘導するように、ひとつ以上のプロセッサに指示させる命令を含む。

別の実施形態では、汎用ナビゲーションシステムおよび目標指向型ナビゲーションシステムを有する車両を操作するための方法は、車両の知覚システムから知覚データを受信するステップと、知覚データを、車両の現在位置に隣接し、複数の格子で構成された領域に離散化するステップと、複数の格子に対応する複数のセルを有する衝突確率配列を生成するステップと、衝突確率配列のどのセルが安全基準を満たすかを決定し、安全基準を満たす衝突確率配列のセルに対応する複数のセルを有する目標スコア配列を生成するステップと、車両の車両制御システムに、最も望ましい値を有する目標スコア配列のセルの表す場所に車両を誘導するように指示するステップを含む。

衝突確率配列のセルは、車両が衝突確率配列のセルで表される領域に移動した場合の衝突の可能性を示す。人工ポテンシャルフィールド配列の複数のセルの値は、目標位置からの車両の現在位置の近接度の関数である。目標スコア配列のセルの値は、衝突確率配列と人工ポテンシャルフィールド配列の対応するセルの値に基づいている。

さらに別の実施形態では、汎用ナビゲーションシステムおよび目標指向型ナビゲーションシステムを有する車両を操作するための非一時的コンピュータ可読媒体は、ひとつ以上のプロセッサによって実行されると、ひとつ以上のプロセッサに、車両の知覚システムから知覚データを受信し、知覚データを車両の現在位置に隣接する領域に離散化し、複数の格子に対応する複数のセルを有する衝突確率配列を生成し、衝突確率配列のどのセルが安全基準を満たすかを決定し、安全基準を満たす衝突確率配列のセルに対応する複数のセルを有する目標スコア配列を生成し、最高値を有する目標スコア配列内のセルを表す場所に車両を誘導するように車両制御システムに指示する命令を含む。

前述同様、衝突確率配列のセルは、車両が衝突確率配列のセルで表される領域に移動した場合の衝突の可能性を示す。人工ポテンシャルフィールド配列の複数のセルの値は、目標位置からの車両の現在位置の近接度の関数である。目標スコア配列のセルの値は、衝突確率配列と人工ポテンシャルフィールド配列の対応するセルの値に基づいている。

適用可能なさらなる領域、および、開示される技術を拡張するさまざまな方法が、提供されている説明から明らかにされる。この概要における説明および特定の実施形態は、図示のためだけを意図されており、この開示の範囲を限定するものではない。

この明細書に組み込まれ、その一部を構成する添付図面は、本開示の様々なシステム、方法、および他の実施形態を示している。図中の図示された要素の境界（たとえば、ボックス、ボックスのグループ、または他の形状）は、境界の一実施形態を表すことが理解されるであろう。いくつかの実施形態では、ひとつの要素が複数の要素として設計されてもよく、または複数の要素がひとつの要素として設計されてもよい。いくつかの実施形態では、別の要素の内部コンポーネントとして示される要素は、外部コンポーネントとして実装されてもよく、その逆もあり得る。さらに、要素は縮尺どおりに描かれない場合がある。
目標指向型ナビゲーションシステムを組み込んだ車両のブロック図である。 目標指向型ナビゲーションシステムを示すブロック図である。 汎用ナビゲーションシステムを示すフロー図である。 汎用ナビゲーションシステムのコンポーネントを利用する目標指向型ナビゲーションシステムを示すフロー図である。 目標指向型ナビゲーションシステムを利用する車両の例示的なシーンを示す図である。 目標指向型ナビゲーションシステムと汎用ナビゲーションシステムとの間でハンドオーバ操作を行う目標指向型ナビゲーションシステムを利用する車両の例示的なシーンを示す図である。 汎用ナビゲーションシステムとともに目標指向型ナビゲーションシステムを利用するための方法を示す図である。 中間目標位置を用いて最終目標位置に到達するために、汎用ナビゲーションシステムとともに目標指向型ナビゲーションシステムを利用するための方法を示す図である。 目標指向型ナビゲーションシステムと汎用ナビゲーションシステムとの間でハンドオーバ操作を行う汎用ナビゲーションシステムとともに目標指向型ナビゲーションシステムを利用するための方法を示す図である。

この明細書の開示は、ある場所から別の場所へ車両を操縦するために、目標指向型ナビゲーションシステムによる車両の汎用ナビゲーションシステムを利用するシステム、方法、および非一時的な媒体を含む。目標指向型ナビゲーションシステムは、衝突確率配列を決定するために、汎用ナビゲーションシステムからの情報を利用する。衝突確率配列の各セルは、車両が衝突確率配列のセルに対応する場所に向かって操縦された場合の衝突の可能性を示す。システムは、衝突確率配列のどのセルが安全基準を満たすかを判断する。安全基準は、車両が他の物体と衝突する可能性がたとえば５％未満のように極めて低い場合に満たされる。

目標指向型ナビゲーションシステムは、人工ポテンシャルフィールド配列とともに、安全基準を満たす衝突確率配列のセルを考慮する。人工ポテンシャルフィールド配列は、目的地への車両の近さを表すセルの配列である。配列は、アレイ、行列と称されることがある。システムは、衝突確率配列（車両の安全性）と人工ポテンシャルフィールド（車両が走行したい目的地）の両方を満たす、車両をどこに向けて操縦すべきかを表す値を有する複数のセルを含む目標スコア配列を生成する。次いで、ひとつ以上の車両制御システムは、最も望ましいスコアを有する目標スコア配列のセルに向かって車両を操縦するように作動させることができる。このように、目標指向型ナビゲーションシステムは、汎用ハードウェアコンポーネントを使用して車両の自律ナビゲーションを提供するための費用対効果の高いソリューションを提供する。

図１を参照すると、目標指向型ナビゲーションシステム２００を組み込んだ車両１００が示されている。車両１００は、ある場所から別の場所へ乗員および／または物品の輸送を可能にする動力輸送機の任意の形態であり得る。車両１００は、自動車であってもよいが、小型トラック、大型トラック、トラクターなどの農業用車両、スポーツユーティリティビークル、トラクタ・トレーラ、軍用車両、鉱業用車両などであってもよい。さらに、車両１００は、陸上車両に限定されず、たとえば、船舶や航空機などの他の種類の車両であってもよい。

車両１００は、図１に示される構成要素を、より多く含んでもよいし、より少なく含んでもよい。この例では、車両１００は、ひとつ以上のバス１１１を介して、他の車両システムおよびサブシステムと通信できるプロセッサ１１０を備える。この明細書で後述するように、プロセッサ１１０の一部またはすべては、車両１００内に配置されてもよく、車両１００の外部に配置されて、ひとつ以上の計算の実行を支援してもよい。

車両１００は、また、ひとつ以上の知覚センサ１２０を備えることができる。知覚センサ１２０は、車両１００が動作している環境および／またはその環境内の任意の物体を検出する。たとえば、知覚センサ１２０は、環境および車両１００の外部にある環境内の任意の物体を検出するためのひとつ以上の異なるタイプのセンサを含んでもよい。

一例的に、車両１００は、知覚センサ１２０として、ＬｉＤＡＲセンサ１２１、カメラ１２２、レーダセンサ１２３、ソナーセンサ１２４などのセンサを含むことができる。カメラ１２２は、高ダイナミックレンジの撮像カメラであってもよい。さらに、カメラ１２２は、ひとつ以上の単眼カメラまたはひとつ以上のステレオカメラを含んでもよい。知覚センサ１２０を構成するセンサは、一般に、車両１００の外部の環境を知覚できるように、車両１００に取り付けられている。

車両１００は、また、汎用ナビゲーションシステム１３０を備えることができる。汎用ナビゲーションシステム１３０は、汎用知覚システム１３１および汎用ナビゲーション意思決定システム１３２を含んでもよい。汎用知覚システム１３１は、たとえばＲＧＢ画像、レーダデータ、ソナーデータ、３次元点群などの情報を、知覚センサ１２０から受信する。なお、汎用は、一般的と称されることがある。

知覚センサ１２０から情報を受信した後、汎用知覚システム１３１は、次に、知覚情報を汎用ナビゲーション意思決定システム１３２に出力する。知覚情報は、車両１００の近傍の環境内に位置するひとつ以上の物体の存在、位置、および他の情報を含んでもよい。汎用ナビゲーション意思決定システム１３２は、汎用知覚システム１３１から知覚情報を受信し、この情報に基づいてひとつ以上の意思決定を行う。

汎用ナビゲーション意思決定システム１３２は、汎用知覚システム１３１からの情報を利用して、ある種の行動をとるいくつかの異なるシステムのうちのひとつであり得る。汎用ナビゲーション意思決定システム１３２は、レーンキープアシストシステムであり得る。レーンキープアシストシステムは、車線を規定するひとつ以上の道路標示に関連して車両１００の位置を検出することができるシステムであってもよい。車線に対する車両１００の位置に基づいて、レーンキープアシストシステムは、車両１００が車線から逸脱しているか、または逸脱中であることを車両１００の乗員に警告し、および／または、車両を車線内に維持するように車両１００を制御することができる。レーンキープアシストシステムは、一般に、車両１００を目的地まで操縦するのではなく、車両１００を車線内に維持し、車両１００を意図した目的地まで操縦するために、車両１００の乗員が適切な時間に車両１００を制御することを要求する。

汎用ナビゲーションシステム１３０は、他のタイプのシステムであってもよい。たとえば、汎用ナビゲーションシステム１３０は、汎用知覚システム１３１を用いて物体の存在を本質的に検出し、検出された物体に対する車両１００の位置を決定し、検出された物体との差し迫った衝突を回避するために緊急ブレーキまたは操舵を実行する物体検出システムおよび緊急ブレーキシステムを含んでもよい。

汎用ナビゲーションシステム１３０は、アダプティブクルーズコントロールシステムであってもよく、車両１００は、クルーズコントロールが作動しているときに、車両１００の外部にある物体を検出し、検出された物体と衝突しないように車両の速度を調整することができる。検出された物体が車両１００から遠ざかるにつれて、車両１００は、クルーズコントロールシステムを作動させるときに、車両１００の乗員によって設定された速度を回復してもよい。アダプティブクルーズコントロールシステムは、他の車両または物体に対する車両の速度を調整するだけでなく、車両１００を指定された車線内に維持するレーンキープアシスト機能を含んでもよい。

別の例では、汎用ナビゲーションシステム１３０は、自由空間推定システムからの入力を受信する自由空間追従システムであってもよい。たとえば、自由空間推定システムは、知覚センサ１２０から情報を受信して、車両１００の前方にある自由空間の存在を決定することができる。車両１００の前方の自由空間の存在に基づいて、自由空間追従システムは、別の車両および／または自由空間に追従するように車両を操縦することができる。

汎用ナビゲーションシステム１３０に関する上記した例は、単なる例示に過ぎない。汎用ナビゲーションシステム１３０は、上記した例の要素、または特に記載されていない他の要素を含む、いくつかの異なる形態のうちの任意のひとつをとることができる。

車両１００は、車両１００のひとつ以上のシステムまたはサブシステムが車両１００の位置を決定することを可能にするひとつ以上の位置決めセンサ１４０を備えることができる。たとえば、位置決めセンサ１４０は、車両１００の加速度、速度、ステアリングホイールの角度などを測定するセンサを含むことができる。具体的には、加速度センサ、コンパスセンサ、車輪速センサ、操舵角センサ、それらの組み合わせなどを含むことができる。

車両１００は、また、全地球的航法衛星システム（ＧＮＳＳ）１４５を備えることができる。ＧＮＳＳ１４５は、ＧＰＳ、ＧＬＯＮＡＳＳ、ガリレオ、および／またはベイドゥーなどの任意のタイプの全地球航法衛星システムであってもよい。ＧＮＳＳ１４５は、ひとつ以上の衛星から信号を受信し、衛星から受信した信号に基づいて、車両１００の位置を決定することができる。後述するように、ＧＮＳＳ１４５は、中間または最終の目標（ターゲット）に対する車両１００の位置を決定するために利用されてもよい。

車両１００は、また、経路計画システム１５０および地図データベース１６０を備えることができる。経路計画システム１５０は、車両１００が初期位置から目的地まで移動するためにとるべき経路（ルート）を決定することができる。経路計画システム１５０は、車両１００の乗員から、目的地の入力を受けてもよい。車両１００の乗員は、車両１００の入力システム１８０を利用して、目的地情報を提供してもよい。入力システム１８０は、乗員が情報を入力することができる任意のタイプの入力システムであってもよい。たとえば、音声入力マイク、タッチスクリーン、キーボード、アナログ入力などとすることができる。

入力システム１８０から目的地を受信した後、経路計画システム１５０は、ＧＮＳＳ１４５から車両位置情報を受信する。したがって、この情報を受け取った後、経路計画システム１５０は、車両の初期位置と目的位置の両方を有する。次いで、経路計画システム１５０は、この情報を地図データベース１６０からの地図情報とともに使用して、車両１００の初期位置から目的地までのひとつ以上の経路を決定する。一例では、経路は、出力システム１８１に指示とともに表示されてもよく、出力システム１８１は、車両１００を目的地に導くための指示を提供するためのディスプレイおよび／または可聴出力装置であってもよい。

車両１００は、また、車両１００の動きに関連するひとつ以上の車両システムおよびサブシステムを制御することができる車両運動コントローラ１９０を備えることができる。たとえば、車両運動コントローラ１９０は、車両１００の動きを制御するひとつ以上のシステムを作動させるアクチュエータコントローラ１８５と通信することができる。たとえば、アクチュエータコントローラ１８５は、ペダル位置、ブレーキ、ステアリングホイール角度、トランスミッション選択などを制御する。車両運動コントローラ１９０は、アクチュエータコントローラ１８５に指示を送信することにより、汎用ナビゲーションシステム１３０から車両１００の動きを制御するための情報を受信してもよい。たとえば、汎用ナビゲーションシステム１３０がレーンキープアシストシステムである場合、車両運動コントローラ１９０は、信号をアクチュエータコントローラ１８５に送信して、車線内の車両１００の位置を制御してもよい。

車両１００は、また、ポテンシャルフィールド画像化システム１９５を備えることができる。ポテンシャルフィールド画像化システム１９５は、「Systems and Methods for Controlling an Autonomous Vehicle Using Target-Orientated Artificial Intelligence」と題する米国特許出願第１６／５０２，６０２号に開示された方法を使用して、人工ポテンシャルフィールド画像（ポテンシャルフィールド画像と呼ばれる）を生成してもよく、その記載の全体が参照によりこの明細書に組み込まれる。人工ポテンシャルフィールド画像は、「目標状態」によって放出される仮想のポテンシャルフィールドである。目標状態とは、システムが到達しようとしている目標である。たとえば、自律運転ナビゲーションの場合、目標は、車両が到達しようとしている目的地である場合がある。ポテンシャルフィールド画像は、物体が電位源に近いほど、物体がより強く電位の影響を受けるという点で、電位場と概念が似ている。ポテンシャルフィールド画像の場合、車両１００が目標状態に近づくほど、車両１００によってポテンシャルが強くなる。直感的に、車両１００により経験されるポテンシャルは、車両１００が目標の場所に図的にどれだけ近いかを表す。

車両１００が目標にどれだけ近いかを画像的に表現することは、特に計算能力の向上に関連して、いくつかの利点がある。画像プロセッシングユニット（ＧＰＵ）の最近の進歩により、ＧＰＵは一定時間内に大量の画像データを処理できる。この大量のデータを処理できるＡＩライブラリとフレームワークのその後の開発により、驚くほど正確な結果を得ことができる。このように、この開示は、コンピュータ技術の革新、つまり、車両１００が目標位置にどれだけ近いかを示す画像的な形式のデジタル画像処理を可能とし、この場合、コンピュータの機能の改善と、目標指向型のナビゲーションの技術の改善との両方が反映される。

車両１００は、また、目標指向型ナビゲーションシステム２００を備えてもよい。目標指向型ナビゲーションシステム２００は、車両１００に目標指向型ナビゲーションを提供するために、車両１００内の汎用コンポーネントを使用してもよい。より簡単に言えば、目標指向型ナビゲーションシステム２００は、車両１００に目標指向型ナビゲーションを提供するために、汎用ナビゲーションシステム１３０の汎用知覚システム１３１を使用してもよい。これがどのように行われるかの大まかな概要を提供するために、図３を参照する。図３には、知覚センサ１２０により検出された情報を汎用ナビゲーションシステム１３０に提供する従来のシステムフロー３００が示されている。汎用ナビゲーションシステム１３０の汎用知覚システム１３１は、知覚センサ１２０からの情報（Ｓｔ）を、汎用ナビゲーション意思決定システム１３２によって利用可能な情報（Ｏｔ）に変換する。前述したように、汎用ナビゲーション意思決定システム１３２は、車両１００を車線内に維持するレーンキープアシストシステムであり得る。汎用ナビゲーション意思決定システム１３２は、この情報（Ｔ’ｔ）を、アクチュエータコントローラ１８５に指示を送信する車両運動コントローラ１９０に提供する。アクチュエータコントローラ１８５は、車両運動コントローラ１９０からの指示（Ａｃｃ、ＳＡ）を受信すると、車両１００の動きを制御して車両１００を所定の車線内に維持するひとつ以上のアクチュエータを制御する。

図４は、汎用ナビゲーションシステム１３０の汎用知覚システム１３１などの汎用コンポーネントを利用する目標指向型ナビゲーションシステム２００を含むシステムフロー４００を示している。ここで、目標指向型ナビゲーションシステム２００は、汎用知覚システム１３１の出力（Ｏｔ）を受信する。そうすることにより、別の知覚センサ１２０および／または汎用知覚システム１３１が、目標指向型ナビゲーションシステム２００を利用するために実装される必要がない。これによれば、追加の知覚センサや知覚システムが不要であり、システムのコストと複雑さを低減できるため、有利な場合がある。図４に示されるように、ポテンシャルフィールド画像化システム１９５は、ポテンシャルフィールド（Ｖｔ）を生成するために、位置決めセンサ１４０および／またはデータストア２１０から情報（Ｅｘ、Ｅｘ，Ｅｙ、Ｔｘ、Ｔｙ）を受信する。前述したように、ポテンシャルフィールドの生成は米国特許出願第１６／５０２，６０２号に記載されており、その記載の全体が参照により援用される。そして、ポテンシャルフィールドは、目標指向型ナビゲーションシステム２００に提供される。

目標指向型ナビゲーションシステム２００は、また、汎用知覚システム１３１から情報を受信する。この明細書の後半でより詳細に説明するように、目標指向型ナビゲーションシステム２００は、汎用知覚システム１３１からの情報を使用して、衝突確率配列を決定する。衝突確率配列の各セルは、車両１００が衝突確率配列のセルに対応する場所に向かって操縦される場合の衝突の可能性を示す。目標指向型ナビゲーションシステム２００は、衝突確率配列のどのセルが安全基準を満たすかを判断することができる。安全基準は、車両１００が他の物体と衝突する可能性が５％未満など、極めて低いものであってもよい。

目標指向型ナビゲーションシステム２００は、人工ポテンシャルフィールド配列とともに、安全基準を満たす衝突確率配列のセルを考慮する。人工ポテンシャルフィールド配列は、車両１００の目的地への近さを表すセルの配列である。目標指向型ナビゲーションシステム２００は、衝突確率配列（車両の安全性）と人工ポテンシャルフィールド（車両が走行したい目的地）の両方を満たす、車両１００がどこに向かって操縦されるべきかを表す値を有する複数のセルを含む目標スコア配列を生成する。車両運動コントローラ１９０は、アクチュエータコントローラ１８５を介してアクチュエータを作動させ、最も望ましいスコアを有する目標スコア配列のセルに向かって車両１００を操縦することができる。このように、目標指向型ナビゲーションシステム２００は、汎用ナビゲーションシステム１３０の汎用知覚システム１３１のような汎用ハードウェアコンポーネントを使用して、車両の自律ナビゲーションを提供するための費用対効果の高いソリューションを提供する。

図２を参照すると、目標指向型ナビゲーションシステム２００の一実施形態が示されている。図２に示されるように、目標指向型ナビゲーションシステム２００は、プロセッサ１１０を備える。プロセッサ１１０は、目標指向型ナビゲーションシステム２００の一部であってもよく、または目標指向型ナビゲーションシステム２００が、データバスまたは別の通信経路を介してプロセッサ１１０にアクセスしてもよい。ひとつ以上の実施形態において、プロセッサ１１０は、受信モジュール２４１、離散化モジュール２４２、衝突確率モジュール２４３、目標スコア配列モジュール２４４、車両制御モジュール２４５、目標更新モジュール２４６、および／またはハンドオーバモジュール２４７に関連する機能を実装するように構成された特定用途向け集積回路である。より一般的には、ひとつ以上の態様において、プロセッサ１１０は、モジュール２４１〜２４７をロードし、それに関連する符号化機能を実行するときに、この明細書に記載の様々な機能を実行できるマイクロプロセッサなどの電子プロセッサである。

一実施形態において、目標指向型ナビゲーションシステム２００は、モジュール２４１〜２４７を格納するメモリ２４０を備える。メモリ２４０は、ランダムアクセスメモリ（ＲＡＭ）、リードオンリーメモリ（ＲＯＭ）、ハードディスクドライブ、フラッシュメモリ、またはモジュール２４１〜２４７を格納するための他の適切なメモリである。モジュール２４１〜２４７は、たとえば、プロセッサ１１０によって実行されると、プロセッサ１１０にこの明細書に開示された様々な機能を実行させるコンピュータ可読命令である。ひとつ以上の実施形態において、モジュール２４１〜２４７は、メモリ２４０に具現化された命令であるが、さらなる態様では、モジュール２４１〜２４７は、ハードウェア、たとえば、この明細書に開示された機能のひとつ以上を独立して実行するための処理コンポーネント（たとえば、コントローラ）、回路などを含む。

さらに、一実施形態では、目標指向型ナビゲーションシステム２００は、データストア２１０を備える。データストア２１０は、一実施形態では、情報を格納するための電子ベースのデータ構造である。少なくともひとつの実施形態では、データストア２１０は、メモリ２４０または別の適切な媒体に格納され、格納されたデータの分析、格納されたデータの提供、格納されたデータの整理などのためにプロセッサ１１０によって実行可能なルーチンで構成されるデータベースである。いずれの場合も、一実施形態では、データストア２１０は、様々な機能を実行する際にモジュール２４１〜２４７によって使用されるデータを格納する。一実施形態では、データストア２１０はセンサデータ２２０を含み、センサデータは、知覚センサ１２０によって収集されたデータおよび／または汎用知覚システム１３１によって処理されたデータであってもよい。データストア２１０は、また、目標情報２３０を含み、目標情報２３０は、車両１００の中間的および／または最終的な目標情報および／または車両１００の現在位置情報を含んでもよい。

モジュール２４１〜２４７に関して、受信モジュール２４１は、プロセッサ１１０によって実行されると、プロセッサ１１０に、車両１００の汎用知覚システム１３１から知覚データを受信させる命令を含むことができる。汎用知覚システム１３１からの知覚データは、ひとつ以上の画像、点群、ソナーデータ、および／またはレーダデータの形式であってもよく、あるいはひとつ以上の画像、点群、ソナーデータ、および／またはレーダデータ内に位置するひとつ以上の物体の存在に関する情報を提供する処理データであってもよい。たとえば、図５Ａを参照すると、この図は道路を走行する車両１００を示しており、同じ道路を走行する他の車両も示している。図５Ｂでは、知覚データ５０１は、車両１００に関連したひとつ以上の物体の存在に関する情報の形態である。

離散化モジュール２４２は、プロセッサ１１０によって実行されると、プロセッサ１１０に、車両１００の現在位置に隣接する領域に知覚データを離散化させる命令を含むことができる。さらに、図５Ｃに最もよく示されているように、図５Ｂの知覚データ５０１は複数の格子５０２に離散化されている。離散化モジュール２４２は、プロセッサ１１０によって実行されると、プロセッサ１１０に、車両１００の現在位置に隣接する車両前方のＫ×Ｋ（ｍ^２）の領域を、ふたつ以上の軸に沿って複数の格子を有するグリッドに分割する命令をさらに含むことができる。ｍ^２は、平方メートルを意味する。

衝突確率モジュール２４３は、プロセッサ１１０によって実行されると、プロセッサ１１０に、複数の格子５０２に対応する複数のセルを有する衝突確率配列を生成させる命令を含むことができる。衝突確率配列のセルは、車両１００が衝突確率配列のセルによって表される領域に移動した場合の衝突の可能性を示し、衝突確率配列のどのセルが安全基準を満たすかを決定する。たとえば、図５Ｄを参照すると、衝突確率配列５０３が示されている。衝突確率配列５０３は、安全基準を満たすことを示すために陰影が付けられたセルの一部を含む。安全基準は、車両１００が衝突確率配列５０３の安全基準を満たすひとつ以上のセルによって表される位置に移動した場合に、車両１００が他の物体と衝突する可能性が低いようなものとすることができる。このように、衝突確率配列５０３の陰影付き領域は、安全基準を満たすセルを示し、車両１００が安全基準を満たすセルによって表される位置に移動した場合に、車両１００が他の物体と衝突する可能性が低いことを示す。

受信モジュール２４１は、また、プロセッサ１１０によって実行されると、プロセッサ１１０に、人工ポテンシャルフィールド配列を受信させる命令を含むことができる。たとえば、図５Ｅを参照すると、人工ポテンシャルフィールド配列５０４が示されており、車両１００が移動しようとする目標を示している。前述したように、人工ポテンシャルフィールド配列は、車両１００の目的地への近さを表すセルの配列である。人工ポテンシャルフィールド配列の複数のセルの値は、目標位置または目的地からの車両１００の現在位置の近接度の関数である。目的地は、中間目標であってもよいし、最終目標であってもよい。中間目標は、車両の現在位置と最終目標との間に位置する目的地である。中間目標は、最終目標への足がかりの役割を果たすことができる。

目標スコア配列モジュール２４４は、プロセッサ１１０によって実行されると、プロセッサ１１０に、安全基準を満たす衝突確率配列のセルに対応する複数のセルを有する目標スコア配列を生成させる命令を含むことができる。目標スコア配列のセルの値は、衝突確率配列と人工ポテンシャルフィールド配列の対応するセルの値に基づいている。たとえば、図５Ｆを参照すると、衝突確率配列５０３および人工ポテンシャルフィールド配列５０４の対応するセルに基づく値を有するセルを含む目標スコア配列５０５が示されている。また、最も望ましい値を有すると決定されたセルによって表される場所５０６も示されている。最も望ましい値は、車両１００が他の物体との衝突を回避するために移動すべき場所（位置）を表すが、同時に中間目標または最終目標に向かって移動すべき場所を表す。最も望ましい値は、高い値であってもよいし、低い値であってもよい。

目標スコア配列の複数のセルの値は、下記（１）式により表される。

ここで、ｏｉは目標スコア配列の複数のセルの値であり、φ’ｉは人工ポテンシャルフィールド配列の複数のセルの値であり、s’ｉは衝突確率配列の複数のセルの値であり、βは安全性の相対的重要度を表す攻撃性係数である。
目標スコア配列の中で最も高い値を有するセルＴ’ｔは、ｏｉを変数とするａｒｇｍａｘ関数を用いて下記式（２）により表される。

車両制御モジュール２４５は、プロセッサ１１０によって実行されると、最高値を有する目標スコア配列内のセルを表す場所に車両運動コントローラ１９０が車両１００を誘導するように、プロセッサ１１０に指示させる命令を含むことができる。たとえば、図５Ｆおよび図５Ｇを参照すると、車両１００の車両運動コントローラ１９０は、車両１００を、目標スコア配列５０５の最も望ましい値を表す場所５０６に誘導する。このように、目標指向型ナビゲーションシステム２００は、衝突確率配列５０３（車両の安全性）および人工ポテンシャルフィールド配列５０４（車両が移動したい目的地）の両方を満たす目標に向かって車両１００を操縦することができる。

目標更新モジュール２４６は、プロセッサ１１０によって実行されると、車両１００が目標位置に到達したときに、プロセッサ１１０に目標位置を新しい目標位置に更新させる命令を含むことができる。たとえば、図５Ｇを参照すると、車両が場所５０６に到達した後、目標指向型ナビゲーションシステム２００は、前述した方法を再び実行して、車両１００が移動する新たな目標位置を決定することができる。このように、目標指向型ナビゲーションシステム２００は、移動する最終目標を決定することができ、その後、経路計画システム１５０を使用して経路を決定することができる。経路は、車両１００が移動する場所を表す中間目標に分割することができる。車両がひとつの中間目標から別の目標に移動するにつれて、車両１００は最終目標に近づいていく。

たとえば、図６は、車両１００が出発位置６０２と最終目標６０４を有することを示している。出発位置６０２は、車両１００が出発する場所であり、最終目標６０４は、車両１００の目的地が終わる場所である。ここで、経路計画システム１５０は、道路に沿った経路を考案する。経路は、いくつかの中間目標６０６、６０８、６１０、６１２を含む。ここで、中間目標６０６は、人工ポテンシャルフィールドの中心を表してもよい。前述したように、目標指向型ナビゲーションシステム２００は、汎用ナビゲーションシステム１３０からの情報とともに人工ポテンシャルフィールドを利用して、車両を目標、この場合は中間目標６０６に向けて操縦する。中間目標６０６に到達した後、目標指向型ナビゲーションシステム２００は、別の中間目標６０８を追加する。中間目標６０８に到達した後、目標指向型ナビゲーションシステム２００は、中間目標６１０、次いで中間目標６１２、最後に最終目標６０４に向けてコースを設定する。

ハンドオーバモジュール２４７は、プロセッサ１１０によって実行されると、プロセッサ１１０に、目標指向型ナビゲーションシステム２００と汎用ナビゲーションシステム１３０との間のハンドオーバ制御を行わせる命令を含むことができる。図６を参照すると、出発位置６０２から最終目標６０４への経路は、中間目標６０６、６０８、６１０、および６１２に分割されてもよく、それぞれの目標は、それを取り囲む人工ポテンシャルフィールドを有する。車両１００が経路に沿って位置する場所に応じて、目標指向型ナビゲーションシステム２００が車両１００を制御してもよいし、汎用ナビゲーションシステム１３０が車両１００を制御してもよい。

たとえば、図６に示される経路は、出発位置６０２と中間目標６０６間との間の期間６２１を含む。拡張された期間（期間６２１および６２２）の間、ハンドオーバモジュール２４７は、プロセッサ１１０に、目標指向型ナビゲーションシステム２００が車両１００を制御すべきであると決定させることができる。これは、車両１００が多数の車両が走行する高速道路に合流しようとしており、目標指向型ナビゲーションシステム２００が高速道路の入口を管理できるのに対し、単にレーンキープシステムであってもよい汎用ナビゲーションシステム１３０は、一般的にはできないためである。

車両１００が経路に沿って走行を続けると、車両は中間目標６０８に到達する。中間目標６０８において、ハンドオーバモジュール２４７は、プロセッサ１１０に、車両１００が直線道路に沿って走行しているので、目標指向型ナビゲーションシステム２００の代わりに汎用ナビゲーションシステム１３０を利用することができる(期間６２３)と判断させることができる。ここで、車両１００は単に直線道路に沿って走行しているので、ハンドオーバモジュール２４７は、プロセッサ１１０に、レーンキープアシストシステムが道路の車線に沿って車両を操縦するのに適切であると判断させることができる。

車両１００が中間目標６１０に向けて道路に沿って進み続けると、ハンドオーバモジュール２４７は、プロセッサ１１０に、目標指向型ナビゲーションシステム２００が車両１００のコマンドを汎用ナビゲーションシステム１３０から引き継ぐべきであると決定させることができる。（期間６２４、６２５、および６２６）。ここでは、車両１００が車線を変更し、最終目標６０４に通じる出口ランプに向かって移動しているので、ハンドオーバモジュール２４７は、プロセッサ１１０に、車両１００の安全性と車両１００が移動しようとする目的地の両方を考慮して、目標指向型ナビゲーションシステム２００が車両１００を制御すべきであると決定させることができる。

ハンドオーバモジュール２４７は、プロセッサ１１０に、汎用ナビゲーションシステム１３０が車両１００を操縦するのに適切である状況、および、目標指向型ナビゲーションシステム２００が車両１００を操縦するのに利用されるべき他の状況を決定させる。前述した例では、汎用ナビゲーションシステム１３０は、車両１００が直線道路に沿って走行しているとき、または、他の方法で同じ車線に留まろうとしているときに利用することができる。しかしながら、車両１００が、最終目標または中間目標に到達するために、より複雑な操作を実行する必要がある場合、ハンドオーバモジュール２４７は、プロセッサ１１０に、車両１００の制御を目標指向型ナビゲーションシステム２００に切り替えさせることができる。

図７は、汎用ナビゲーション制御システムおよび目標指向型ナビゲーションシステムを有する車両のための方法７００を示している。方法７００は、図１の車両１００および図２の目標指向型ナビゲーションシステム２００の観点から説明される。しかしながら、方法７００は、図１の車両１００および／または図２の目標指向型ナビゲーションシステム２００によって必ずしも実行されるとは限らず、いくつかの異なる状況のうちの任意のひとつで実行されるように適合されてもよい。

ここで、方法７００はステップ７０２から始まり、目標更新モジュール２４６がプロセッサ１１０に目標位置を受信させる。目標位置は、経路の開始と経路の終了との間の中間目標位置であってもよいし、経路の終了を表す最終目標であってもよい。ステップ７０４において、受信モジュール２４１は、プロセッサ１１０に車両１００の位置（現在位置）を受信させる。車両１００の位置は、車両１００のＧＮＳＳ１４５によって生成されてもよい。

ステップ７０６において、目標更新モジュール２４６は、プロセッサ１１０に、車両１００がステップ７０２で示された目標位置に到達したか否かを判定させる。これは、目標位置と車両の位置とを比較することによって行うことができる。実質的に一致する場合、方法７００は終了する。しかしながら、車両が目標位置に到達していない場合、方法は方法７１０に進む。方法７１０は、目標指向型ナビゲーションシステム２００を利用するための一連のステップに関する。方法７１０は、すべてのステップ７１２〜７２２またはステップのサブセットを含むことができる。さらに、方法７１０は、記載された順序で実行されなくてもよい。

方法７１０は、ステップ７１２から始まり、受信モジュール２４１は、プロセッサ１１０に、車両１００の汎用知覚システム１３１から知覚データを受信させる。前述したように、知覚データは、車両１００の外部にあるひとつ以上の物体に関する情報を含むことができる。

ステップ７１４において、離散化モジュール２４２は、プロセッサ１１０に、知覚データを車両１００の現在位置に隣接する領域に離散化させる。図５Ｃに最もよく示されているように、図５Ｂの知覚データ５０１は、複数の格子５０２に離散化されている。離散化モジュール２４２は、プロセッサ１１０によって実行されると、プロセッサ１１０に、車両１００の現在位置に隣接する車両前方のＫ×Ｋの領域を、ふたつ以上の軸に沿って複数の格子を有するグリッドに分割させる命令をさらに含むことができる。

ステップ７１６において、衝突確率モジュール２４３は、プロセッサ１１０に、複数の格子に対応する複数のセルを有する衝突確率配列を生成させる。衝突確率配列のセルは、車両１００が衝突確率配列のセルによって表される領域に移動した場合の衝突の可能性を示し、衝突確率配列のどのセルが安全基準を満たすかを決定する。たとえば、図５Ｄを参照すると、衝突確率配列５０３が示されている。

ステップ７１８において、衝突確率モジュール２４３は、プロセッサ１１０に、衝突確率配列のどのセルが安全基準を満たすかを決定させる。衝突確率配列５０３は、それらが安全基準を満たすことを示すために陰影が付けられたセルの一部を含む。安全基準は、車両１００が衝突確率配列５０３の安全基準を満たすひとつ以上のセルによって表される位置に移動した場合に、車両１００が他の物体と衝突する可能性が低いようなものとすることができる。したがって、衝突確率配列５０３の陰影付き領域は、安全基準を満たすセルを示し、車両１００が安全基準を満たすセルによって表される位置に移動した場合、車両１００が他の物体と衝突する可能性が低いことを示す。

ステップ７１９において、受信モジュール２４１は、プロセッサ１１０に人工ポテンシャルフィールド配列を受信させる。前述したように、人工ポテンシャルフィールド配列は、目的地に対する車両１００の近さを表すセルの配列である。人工ポテンシャルフィールド配列の複数のセルの値は、目標位置または目的地からの車両１００の現在位置の近接度の関数である。目的地は、中間目標でもよいし、最終目標でもよい。

ステップ７２０において、目標スコア配列モジュール２４４は、プロセッサ１１０に、目標スコア配列を生成させる。目標スコア配列は、安全基準を満たした衝突確率配列のセルに対応する複数のセルを含むことができる。目標スコア配列のセルの値は、衝突確率配列と人工ポテンシャルフィールド配列の対応するセルの値に基づいている。たとえば、図５Ｆを参照すると目標スコア配列５０５が示されており、目標スコア配列５０５は、衝突確率配列５０３および人工ポテンシャルフィールド配列５０４の対応するセルに基づく値を有するセルを含む。また、最も望ましい値を有すると決定された、セルによって表される場所５０６も示されている。最も望ましい値は、車両１００が他の物体との衝突を回避するために移動すべき位置を表すが、同時に中間目標または最終目標に向かって移動すべき位置を表す。最も望ましい値は、高い値でもよいし、低い値でもよい。

ステップ７２２において、車両制御モジュール２４５は、最高値を有する目標スコア配列内のセルを表す場所に車両運動コントローラ１９０が車両１００を誘導するように、プロセッサ１１０に指示させる。たとえば、図５Ｆおよび図５Ｇを参照すると、車両運動コントローラ１９０は、車両１００を、目標スコア配列５０５の最も望ましい値を表す場所５０６に誘導する。このように、目標指向型ナビゲーションシステム２００は、衝突確率配列５０３（車両の安全性）および人工ポテンシャルフィールド配列５０４（車両が移動したい目的地）の両方を満たす目標に向かって車両１００を操縦することができる。

方法７１０が完了した後、方法７００はステップ７０２に戻り、再び処理が開始される。この例では、方法７００を完了した後に受信した目標位置は、新たな目標位置であってもよい。

図８を参照すると、汎用ナビゲーション制御システムおよび目標指向型ナビゲーションシステムを有する車両のための別の方法８００が示されている。方法８００は、図１の車両１００および図２の目標指向型ナビゲーションシステム２００の観点から説明される。しかしながら、方法８００は、図１の車両１００および／または図２の目標指向型ナビゲーションシステム２００によって必ずしも実行されるとは限らず、いくつかの異なる状況のうちの任意のひとつで実行されるように適合されてもよい。

方法８００は、図６に示され、説明されたものと同様に、最終目標および一連の中間目標を利用するための方法を記述している。方法８００はステップ８０２から始まり、目標更新モジュール２４６は、プロセッサ１１０に最終的な目標位置を受信させる。最終目標位置は、入力システム１８０を介して車両１００の乗員により提供されてもよい。ステップ８０４において、目標更新モジュール２４６は、プロセッサ１１０に現在の車両位置を受信させる。現在の車両位置は、ＧＮＳＳ１４５によって提供されてもよい。

ステップ８０６において、目標更新モジュール２４６は、プロセッサ１１０に、車両１００が最終目標位置に到達したか否かを判定させる。車両１００が最終目標位置に到達した場合、方法８００は終了する。そうでなければ、方法はステップ８０８に進む。ステップ８０８において、目標更新モジュール２４６は、プロセッサ１１０に、現在の車両位置から最終目標位置への経路を決定させる。これは、最終目標、現在の車両位置、および地図データベース１６０からの地図を利用して、最終目標に到達するために車両１００が走行するための経路を生成する経路計画システム１５０によって実行することができる。さらに、プロセッサ１１０は、ステップ８１０に示されるように、ひとつ以上の中間目標位置を決定することもできる。

ステップ８１２において、受信モジュール２４１は、プロセッサ１１０に、目標位置に基づいて人工ポテンシャルフィールド配列を受信させる。目標位置は、中間目標位置であってもよいし、最終目標であってもよい。前述したように、人工ポテンシャルフィールド配列は、米国特許出願第１６／５０２，６０２号に記載されているように生成することができ、この出願は、前述したように、その全体が参照により組み込まれる。

ステップ８１４において、図７の方法７１０が実行される。ただし、ステップ７１９に代えて、ステップ８１２を実行している。前述したように、図７の方法７１０は、人工ポテンシャルフィールド配列と、車両１００の汎用ナビゲーションシステム１３０の汎用知覚システム１３１からの情報を利用して、車両１００を目標に誘導することができる。

ステップ８１６において、車両１００が中間目標位置に到達すると、中間目標位置は消去され、方法８００はステップ８０４に戻り、現在の車両位置を決定して、車両が最終目標に到達したか否かを判定する（ステップ８０６）。前述したように、車両が最終目標に到達した場合、方法８００は終了し、そうでない場合、方法８００は、車両が最終目標に到達するまで継続する。

図９を参照すると、汎用ナビゲーション制御システムおよび目標指向型ナビゲーションシステムを有する車両のための別の方法９００が示されている。方法９００は、図１の車両１００および図２の目標指向型ナビゲーションシステム２００の観点から説明される。しかしながら、方法９００は、図１の車両１００および／または図２の目標指向型ナビゲーションシステム２００によって必ずしも実行されるとは限らず、いくつかの異なる状況のうちの任意のひとつで実行されるように適合されていてもよい。

方法９００は、図８の方法８００に幾分類似している。このように、前述の説明が方法９００にも同様に適用可能であることを理解した上で、同様のステップを簡単に説明する。目標更新モジュール２４６は、ステップ９０２、９０４に示されるように、プロセッサ１１０に最終目標位置および現在の車両位置を受信させる。車両１００が最終目標に到達した場合、方法９００は終了する。

しかしながら、ステップ９０６で判定されるように、最終目標にまだ到達していない場合、方法９００は、ステップ９０８に進む。ステップ９０８において、ハンドオーバモジュール２４７は、プロセッサ１１０に、車両１００の制御を、汎用ナビゲーションシステム１３０から目標指向型ナビゲーションシステム２００に引き渡すべきか否か判定させる。たとえば、車両１００が直線道路を走行している場合、方法９００は、汎用ナビゲーションシステム１３０が車両１００を道路に沿って操縦するのにより適切であると判断し、ステップ９１７に進む。

しかしながら、ハンドオーバモジュール２４７が、プロセッサ１１０に、より複雑な操縦が車両１００によって必要であると判断させる場合、方法９００はステップ９１０に進み、車両１００の制御が目標指向型ナビゲーションシステム２００に引き渡され、中間目標位置が決定される。その後、ステップ９１２において、前述したようにステップ９１０の中間目標位置に基づいて人工ポテンシャルフィールド配列が生成され、次いでステップ９１４に示されるように方法７１０が実行される。方法７１０が実行された後、中間目標位置はステップ９１６に示されるように消去され、方法はステップ９０４に戻る。

この明細書で説明されるシステムのいずれも、別個の集積回路、および／または、チップを用いて様々な構成によって構成できることが理解されるべきである。回路は接続パスを介して接続され、個別の回路間で信号を通信する。もちろん、別個の集積回路が論じられているが、様々な実施形態では、回路は、共通の集積回路基板に統合されてもよい。さらに、集積回路は、より少ない集積回路に組み合わせるか、またはより多くの集積回路に割することができる。

別の実施形態では、説明された方法、および／または、それらの等価物は、コンピュータ実行可能命令で実装されてもよい。したがって、一実施形態では、非一時的なコンピュータ可読媒体は、格納されたコンピュータ実行可能命令とともに構成されている。格納されたコンピュータ実行可能命令は、機械（たとえば、プロセッサ、コンピュータなど）によって実行されると、機械、および／または、関連するコンポーネントに方法を実行させる。

説明を簡単にするために、図に示されている方法論は一連のブロックとして示され説明されているが、いくつかのブロックは異なる順序で実行されることがあり、および／または、図示および説明から他のブロックと同時に実行されることがあり、方法論はブロックの順序によって制限されないことが理解されるべきである。さらに、例示されたブロックのすべてが、例示的な方法論を実装するために使用されてもよい。ブロックは、複数のコポーネントに結合、または、分離されることがある。さらに、追加の、および／または、代替の方法論は、図示されていない追加のブロックを使用することができる。

この明細書では詳細な実施形態が開示されている。しかしながら、開示された実施形態は、例としてのみ意図されていることが理解されるべきである。したがって、この明細書に開示される特定の構造的および機能的詳細は、限定事項として解釈されるべきではなく単に請求項の基礎として、および、実質的に任意の適切な詳細な構造でこの明細書の態様をさまざまに使用することを当業者に教示するための代表的な基礎としてのみ解釈されるべきである。さらに、この明細書で使用される用語および語句は、限定することを意図するものではなく、可能な実装の理解可能な説明を提供することを意図している。

図中のフローチャート、および、ブロック図は、様々な実施形態による、システム、方法、および、コンピュータプログラム製品の可能な実装のアーキテクチャ、機能、および、動作を示している。これに関して、フローチャート、または、ブロック図の各ブロックは、指定された論理機能を実装するためのひとつ以上の実行可能な命令を含むコードのモジュール、セグメント、または、部分を表すことができる。また、一部の代替実装では、ブロックに記載されている機能が、図に記載されている順序とは異なる順序で発生する場があることにも注意されるべきである。たとえば、連続して示されたふたつのブロックは、実際には実質的に同時実行されてもよいし、関係する機能に応じて、ブロックが逆の順序で実行されることもある。

上記のシステム、コンポーネント、および／または、プロセスは、ハードウェア、または、ハードウェアとソフトウェアの組み合わせで実現でき、ひとつの処理システムで集中方式によって、または、複数の相互接続された処理システムに異なる要素が分散している分散方式によって実現することができる。この明細書に記載の方法を実行するように適合されたあらゆる種類の処理システム、または、別の装置が適している。ハードウェアとソフトウェアの組み合わせは、コンピュータで使用可能なプログラムコードを備えた処理システムであり、読み込まれて実行されると、ここで説明する方法を実行するように処理システムを制御する。システム、コンポーネント、および／または、処理は、たとえば、機械によって読み取り可能であって、ここに記述された処理、および、方法を実行するために機械によって実行可能な指令のプログラムに実体的に実装された、コンピュータプログラム製品の記憶装置、または、他のデータプログラムの記憶装置として、コンピュータによって読み取り可能な記憶装置に埋め込むことができる。これらの要素は、この明細書に記載の方法の実施を可能にし、処理システムにロードされたときにこれらの方法を実行できるすべての機能を含むアプリケーション製品に組み込むこともできる

さらに、この明細書で説明された構成は、たとえば記憶されるなどして、実施されるコンピュータ可読プログラムコードを有するひとつ以上のコンピュータ可読媒体に具現化されるコンピュータプログラム製品の形をとることができる。ひとつ以上のコンピュータ可読媒体の任意の組み合わせが利用されてもよい。コンピュータ可読媒体は、コンピュータ可読信号媒体またはコンピュータ可読記憶媒体であり得る。「コンピュータ可読記憶媒体」という語句は、非一時的な記憶媒体を意味する。コンピュータ可読媒体は、限定されるものではないが、不揮発性媒体および揮発性媒体を含む、形態をとってもよい。不揮発性媒体には、たとえば、光ディスク、磁気ディスクなどが含まれる。揮発性媒体には、たとえば、半導体メモリ、ダイナミックメモリなどが含まれる。そのようなコンピュータ可読媒体の限定的ではない例には、フロッピーディスク、フレキシブルディスク、ハードディスク、磁気テープ、および、その他の磁気媒体、または、ＡＳＩＣ、または、グラフィックスプロセッシングユニット（ＧＰＵ）、または、ＣＤ、および、その他の光学媒体、または、ＲＡＭ、または、ＲＯＭ、または、メモリチップ、または、メモリカード、または、メモリスティック、または、他の媒体を含むことができ、これらは、コンピュータ、プロセッ、または、他の電子デバイスが読み取り可能である。この明細書の文脈において、コンピュータ可読記憶媒体は、命令実行システム、装置、またはデバイスによって、またはそれに関連して使用するためのプログラムを含むか、または、記憶することができる任意の有形の媒体であり得る。

以下の説明は、この明細書で使用される選択された用語の定義を含んでいる。定義には、用語の範囲に含まれ、さまざまな実装に使用できるコンポーネントのさまざまな例や形式が含まれている。例は、制限することを意図したものではない。用語の単数形と複数形の両方が定義内にある場合がある。

「ひとつの実施形態」、「一実施形態」、「ひとつの例」、「一例」などへの言及は、そのように説明された実施形態、または、例が、特定の特徴、構造、特性、内部特性、要素、または、制限を含み得ることを示すが、それらの実施形態、または、例が、必須のものとして、特定の特徴、構造、特性、内部特性、要素、または、制限を含むことを示すものではない。さらに、「一実施形態では」という語句の繰り返しの使用は、同じ実施形態を指す場合があるが、必ずしもそうであるとは限らない。

この明細書で使用される「モジュール」は、コンピュータ、または、電気ハードウェアコンポーネント、ファームウェア、命令を格納する非遷移的なコンピュータ可読媒体、および／または、これらのコンポーネントの組み合わせを含み、これらは、機能、または、アクションを実行するか、および／または、別のロジック、方法、および／または、システムに、機能、または、アクションを発揮させるように構成されている。モジュールは、アルゴリズムによって制御されるマイクロプロセッサ、多数の電気素子を含む論理回路（たとえば、ＡＳＩＣ）、アナログ回路、デジタル回路、プログラムされた論理デバイス、実行時にアルゴリズムを実行する命令を含むメモリデバイスなどを含むことができる。モジュールは、ひとつ以上の実施形態では、ひとつ以上のＣＭＯＳゲート、ゲートの組み合わせ、または他の回路構成要素を含む。複数のモジュールが説明される場合、ひとつ以上の実施形態は、複数のモジュールをひとつの物理モジュール構成要素に組み込むことを含む。同様に、単一のモジュールが説明される場合、ひとつ以上の実施形態は、複数の物理的構成要素に、単一のモジュールを分配することを含む。

さらに、この明細書で使用されるモジュールには、タスクを実行したりデータ型を実装したりするルーチン、プログラム、オブジェクト、コンポーネント、データ構造などが含まれる。さらなる態様では、メモリは一般に、言及されたモジュールを格納する。モジュールに関連付けられたメモリは、プロセッサ、ＲＡＭ、ＲＯＭ、フラッシュメモリ、または、別の適切な電子記憶媒体内に埋め込まれたバッファ、または、キャッシュである場合ある。さらに別の態様では、この開示によって想定されるモジュールは、特定用途向け集積回路（ＡＳＩＣ）、システムオンチップ（ＳｏＣ）のハードウェアコンポーネント、プログラマブルロジックアレイ（ＰＬＡ）、グラフィックス処理装置（ＧＰＵ）、または開示された機能を実行するための定義された構成セット（たとえば、命令）が組み込まれた別の適切なハードウェアコンポーネントとして実装される。

ひとつ以上の構成では、この明細書で説明されるひとつ以上のモジュールは、人工知能要素、または、計算知能要素、たとえば、ニューラルネットワーク、ファジーロジック、または、他の機械学習アルゴリズムを含むことができる。さらに、ひとつ以上の構成では、ひとつ以上のモジュールを、この明細書で説明する複数のモジュール間で分散させることできる。ひとつ以上の構成では、この明細書で説明されているふたつ以上のモジュールを組み合わせて単一のモジュールにすることができる。

コンピュータ可読媒体上で実施されるプログラムコードは、無線、有線、光ファイバ、ケーブル、ＲＦなど、または、前述要素の任意の適切な組み合わせを含むがこれらに限定されない任意の適切な媒体を使用して送信することができる。この構成の態様の動作を実行するためのコンピュータプログラムコードは、Ｊａｖａ（登録商標）、Ｓｍａｌｌｔａｌｋ、Ｃ＋＋などのオブジェクト指向プログラミング言語、および、Ｃプログラミング言語、同様のプログラミング言語などを含む従来の手続き型プログラミング言語を含むひとつ以上のプログラミング言語の任意の組み合わせで書くことができる。プログラムコードは、完全にユーザのコンピュータにおいて、一部はユーザのコンピュータにおいて、スタンドアロンソフトウェアパッケージとして、一部はユーザのコンピュータにおいて、残る一部はリモートコンピュータにおいて、または、完全にリモートコンピュータ、または、サーバーで実行することができる。後者のシナリオでは、リモートコンピュータは、ローカルエリアネットワーク（ＬＡＮ）またはワイドエリアネットワーク（ＷＡＮ）を含む任意のタイプのネットワークを介してユーザのコンピュータに接続されてもよく、または接続は、外部コンピュータ（たとえば、インターネットサービスプロバイダを使用してインターネットを介して）に接続されてもよい。

この明細書で使用される要素の数は、ひとつ、または、ふたつ以上として定義される。この明細書で使用される「複数」という用語は、ふたつ、または、ふたつ以上として定義される。この明細書で使用される「別の」という用語は、少なくとも第２、または、それ以上として定義される。この明細書で使用される「含む」、および／または、「有する」という用語は、「備える」を意味し、すなわち、他の要素の存在を許容する用語として定義される。「・・・と・・・との少なくともひとつ」という表現は、関連付けて列挙された項目のひとつ、または、複数のありとあらゆる可能な組み合わせを指し、それらを包含するものとして解釈されるべきである。一例として、「Ａ、Ｂ、および、Ｃのうちの少なくともひとつ」という語句は、Ａのみ、Ｂのみ、Ｃのみ、またはそれらの任意の組み合わせ（たとえば、ＡＢ、ＡＣ、ＢＣ、または、ＡＢＣ）を含む。

この明細書の態様は、その精神、または、本質的な属性から逸脱することなく、他の形態で具体化することができる。したがって、この明細書の範囲を示すために、前述の明細書ではなく、以下の特許請求の範囲を参照する必要がある。

この明細書には、上記実施形態によって、以下に列挙する複数の技術的思想が開示されていることが当業者に理解される。＜技術的思想１＞汎用ナビゲーションシステムを有する車両のための目標指向型ナビゲーションシステムであって、ひとつ以上のプロセッサと、ひとつ以上の前記プロセッサと通信するメモリと、を備え、前記メモリは、受信モジュールと、離散化モジュールと、衝突確率モジュールと、目標スコア配列モジュールと、車両制御モジュールとを格納しており、前記受信モジュールは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに、前記車両の知覚システムから知覚データを受信させる命令を含み、前記離散化モジュールは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに、前記知覚データを前記車両の現在位置に隣接し、複数の格子で構成される領域に離散化させる命令を含み、前記衝突確率モジュールは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに、前記複数の格子に対応する複数のセルを有する衝突確率配列を生成させる命令を含み、前記衝突確率配列のセルは、前記衝突確率配列のセルによって表される領域に前記車両が移動した場合の衝突の可能性を示しており、前記衝突確率配列のどのセルが安全基準を満たすかを決定させる命令を含み、前記受信モジュールは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに、前記衝突確率配列の複数のセルに対応する複数のセルを有する人工ポテンシャルフィールド配列を受信させる命令を含み、前記人工ポテンシャルフィールド配列の複数のセルの値は、目標位置からの前記車両の現在位置の近接度の関数であり、前記目標スコア配列モジュールは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに、安全基準を満たす前記衝突確率配列のセルに対応する複数のセルを有する目標スコア配列を生成させる命令を含み、前記目標スコア配列のセルの値は、前記衝突確率配列と前記人工ポテンシャルフィールド配列の対応するセルの値に基づいており、前記車両制御モジュールは、ひとつ以上の前記プロセッサによって実行されると、最高値を有する前記目標スコア配列内のセルを表す場所に車両制御システムが前記車両を誘導するように、ひとつ以上の前記プロセッサに指示させる命令を有する、目標指向型ナビゲーションシステム。

＜技術的思想２＞前記離散化モジュールは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに、前記車両の現在位置に隣接する車両前方のＫ×Ｋの領域を、ふたつ以上の軸に沿って複数の格子を有するグリッドに分割する命令をさらに含む、技術的思想１に記載の目標指向型ナビゲーションシステム。＜技術的思想３＞前記衝突確率モジュールは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに、前記衝突確率配列のどのセルが前記安全基準を満たすかを決定するために、前記衝突確率配列の複数のセルの値を反転させる命令をさらに含む、技術的思想１に記載の目標指向型ナビゲーションシステム。＜技術的思想４＞前記目標スコア配列の複数のセルの値は、上記（１）式により表され、ここで、ｏｉは前記目標スコア配列の複数のセルの値、φ’ｉは前記人工ポテンシャルフィールド配列の複数のセルの値、ｓ’ｉは前記衝突確率配列の複数のセルの値で、βは、安全性の相対的な重要度を表す攻撃性係数である、技術的思想１に記載の目標指向型ナビゲーションシステム。＜技術的思想５＞前記目標スコア配列の中で最高値を有するセルが、上記（２）式により表される、技術的思想４に記載の目標指向型ナビゲーションシステム。

＜技術的思想６＞前記メモリは、ひとつ以上の前記プロセッサによって実行されると、前記車両が前記目標位置に到達したときに、ひとつ以上の前記プロセッサに前記目標位置を新しい目標位置に更新させる命令を含む目標更新モジュールをさらに備える、技術的思想１に記載の目標指向型ナビゲーションシステム。＜技術的思想７＞前記新しい目標位置は、最終的な目標位置への経路に基づいて決定される、技術的思想６に記載の目標指向型ナビゲーションシステム。＜技術的思想８＞前記メモリは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに以下を実行させる命令を含むハンドオーバ制御モジュールをさらに備え、前記ハンドオーバ制御モジュールがひとつ以上の前記プロセッサに実行させる命令は、経路に沿った前記車両の位置を決定し、ハンドオーバ制御システムにより、前記経路に沿った前記車両の位置に基づいて、前記目標指向型ナビゲーションシステムまたは前記汎用ナビゲーションシステムからのコマンドを利用するように前記車両制御システムに指示することである、技術的思想１に記載の目標指向型ナビゲーションシステム。

＜技術的思想９＞汎用ナビゲーションシステムおよび目標指向型ナビゲーションシステムを有する車両を操作するための方法であって、前記車両の知覚システムから知覚データを受信するステップと、前記目標指向型ナビゲーションシステムによって、前記知覚データを、前記車両の現在位置に隣接し、複数の格子で構成される領域に離散化するステップと、前記目標指向型ナビゲーションシステムによって、前記複数の格子に対応する複数のセルを有する衝突確率配列を生成するステップと、前記目標指向型ナビゲーションシステムによって、前記衝突確率配列のどのセルが安全基準を満たすかを決定するステップと、前記目標指向型ナビゲーションシステムによって、前記衝突確率配列の複数のセルに対応する複数のセルを有する人工ポテンシャルフィールド配列を受信するステップと、前記目標指向型ナビゲーションシステムによって、前記安全基準を満たす前記衝突確率配列のセルに対応する複数のセルを有する目標スコア配列を生成するステップと、前記目標指向型ナビゲーションシステムによって、前記車両の車両制御システムに、最高値を有する前記目標スコア配列内のセルを表す場所に前記車両を誘導するように指示するステップと、を含み、前記衝突確率配列のセルは、前記衝突確率配列のセルによって表される領域に前記車両が移動した場合の衝突の可能性を示し、前記人工ポテンシャルフィールド配列の複数のセルの値は、目標位置からの前記車両の現在位置の近接度の関数であり、前記目標スコア配列のセルの値は、前記衝突確率配列と前記人工ポテンシャルフィールド配列の対応するセルの値に基づいている、方法。

＜技術的思想１０＞前記目標指向型ナビゲーションシステムによって、前記車両の現在位置に隣接する車両前方のＫ×Ｋの前記領域を、ふたつ以上の軸に沿って複数の格子を有するグリッドに分割するステップをさらに含む、技術的思想９に記載の方法。＜技術的思想１１＞前記衝突確率配列のどのセルが前記安全基準を満たすかを決定するために、前記衝突確率配列の複数のセルの値を反転するステップをさらに含む、技術的思想９に記載の方法。＜技術的思想１２＞前記目標スコア配列の複数のセルの値は、上記（１）式により表され、ここで、ｏｉは前記目標スコア配列の複数のセルの値、φ’ｉは前記人工ポテンシャルフィールド配列の複数のセルの値、ｓ’ｉは前記衝突確率配列の複数のセルの値で、βは、安全性の相対的な重要度を表す攻撃性係数である、技術的思想９に記載の方法。＜技術的思想１３＞前記目標スコア配列の中で最高値を有するセルが、上記（２）式により表される、技術的思想１２に記載の方法。

＜技術的思想１４＞前記車両が前記目標位置に到達したときに、前記目標位置を新しい目標位置に更新するステップをさらに含む、技術的思想９に記載の方法。＜技術的思想１５＞前記新しい目標位置は、最終的な目標位置への経路に基づいて決定される、技術的思想１４に記載の方法。＜技術的思想１６＞経路に沿った前記車両の位置を決定するステップと、ハンドオーバ制御システムによって、前記経路に沿った前記車両の位置に基づいて、前記目標指向型ナビゲーションシステムまたは前記汎用ナビゲーションシステムからのコマンドを利用するように前記車両制御システムに指示するステップと、をさらに含む技術的思想９に記載の方法。

＜技術的思想１７＞汎用ナビゲーションシステムおよび目標指向型ナビゲーションシステムを有する車両を操作するための非一時的コンピュータ可読媒体であって、ひとつ以上のプロセッサによって実行されたときに、ひとつ以上の前記プロセッサに実行させる命令として、前記車両の知覚システムから知覚データを受信し、前記目標指向型ナビゲーションシステムによって、前記知覚データを、前記車両の現在位置に隣接し、複数の格子で構成される領域に離散化し、前記目標指向型ナビゲーションシステムによって、前記複数の格子に対応する複数のセルを有する衝突確率配列を生成し、前記目標指向型ナビゲーションシステムによって、前記衝突確率配列のどのセルが安全基準を満たすかを決定し、前記目標指向型ナビゲーションシステムによって、前記衝突確率配列の複数のセルに対応する複数のセルを有する人工ポテンシャルフィールド配列を受信し、前記目標指向型ナビゲーションシステムによって、前記安全基準を満たす前記衝突確率配列のセルに対応する複数のセルを有する目標スコア配列を生成し、前記目標指向型ナビゲーションシステムによって、前記車両の車両制御システムに、最高値を有する前記目標スコア配列内のセルを表す場所に前記車両を誘導するように指示すること、を含み、前記衝突確率配列のセルは、前記衝突確率配列のセルによって表される領域に前記車両が移動した場合の衝突の可能性を示し、前記人工ポテンシャルフィールド配列の複数のセルの値は、目標位置からの前記車両の現在位置の近接度の関数であり、前記目標スコア配列のセルの値は、前記衝突確率配列と前記人工ポテンシャルフィールド配列の対応するセルの値に基づいている、非一時的コンピュータ可読媒体。

＜技術的思想１８＞ひとつ以上の前記プロセッサによって実行されると、前記車両が前記目標位置に到達したときに、ひとつ以上の前記プロセッサに前記目標位置を新しい目標位置に更新させる命令をさらに含む、技術的思想１７に記載の、非一時的コンピュータ可読媒体。＜技術的思想１９＞前記新しい目標位置は、最終的な目標位置への経路に基づいて決定される、技術的思想１８に記載の非一時的コンピュータ可読媒体。＜技術的思想２０＞経路に沿った前記車両の位置を決定し、ハンドオーバ制御システムにより、前記経路に沿った前記車両の位置に基づいて、前記目標指向型ナビゲーションシステムまたは前記汎用ナビゲーションシステムからのコマンドを利用するように前記車両制御システムに指示する命令をさらに含む、技術的思想１７に記載の非一時的コンピュータ可読媒体。

１００…車両、１１１…バス、１１０…プロセッサ、１２０…知覚センサ、１２１…ＬｉＤＡＲ、１２２…カメラ、１２３…レーダ、１２４…ソナー、１３０…汎用ナビゲーションシステム、１３１…汎用知覚システム、１３２…汎用ナビゲーション意思決定システム、１４０…位置決めセンサ、１４５…ＧＮＳＳ、１５０…経路計画システム、１６０…地図データベース、１８０…入力システム、１８１…出力システム、１８５…アクチュエータコントローラ、１９０…車両運動コントローラ、１９５…ポテンシャルフィールド画像化システム、２００…目標指向型ナビゲーションシステム、２１０…データストア、２２０…センサデータ、２３０…目標情報、２４０…メモリ、２４１…受信モジュール、２４２…離散化モジュール、２４３…衝突確率モジュール、２４４…目標スコア配列モジュール、２４５…車両制御モジュール、２４６…目標更新モジュール、２４７…ハンドオーバモジュール、３００、４００…システムフロー、５０１…知覚データ、５０２…格子、５０３…衝突確率配列、５０４…人工ポテンシャルフィールド配列、５０５…目標スコア配列、５０６…場所、６０２…出発位置、６０４…最終目標、６０６、６０８、６１０、６１２…中間目標

Claims (20)

1. 汎用ナビゲーションシステムを有する車両のための目標指向型ナビゲーションシステムであって、
   ひとつ以上のプロセッサと、
   ひとつ以上の前記プロセッサと通信するメモリと、を備え、
   前記メモリは、受信モジュールと、離散化モジュールと、衝突確率モジュールと、目標スコア配列モジュールと、車両制御モジュールとを格納しており、
   前記受信モジュールは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに、前記車両の知覚システムから知覚データを受信させる命令を含み、
   前記離散化モジュールは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに、前記知覚データを前記車両の現在位置に隣接し、複数の格子で構成される領域に離散化させる命令を含み、
   前記衝突確率モジュールは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに、前記複数の格子に対応する複数のセルを有する衝突確率配列を生成させる命令を含み、前記衝突確率配列のセルは、前記衝突確率配列のセルによって表される領域に前記車両が移動した場合の衝突の可能性を示しており、前記衝突確率配列のどのセルが安全基準を満たすかを決定させる命令を含み、
   前記受信モジュールは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに、前記衝突確率配列の複数のセルに対応する複数のセルを有する人工ポテンシャルフィールド配列を受信させる命令を含み、前記人工ポテンシャルフィールド配列の複数のセルの値は、目標位置からの前記車両の現在位置の近接度の関数であり、
   前記目標スコア配列モジュールは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに、安全基準を満たす前記衝突確率配列のセルに対応する複数のセルを有する目標スコア配列を生成させる命令を含み、前記目標スコア配列のセルの値は、前記衝突確率配列と前記人工ポテンシャルフィールド配列の対応するセルの値に基づいており、
   前記車両制御モジュールは、ひとつ以上の前記プロセッサによって実行されると、最高値を有する前記目標スコア配列内のセルを表す場所に車両制御システムが前記車両を誘導するように、ひとつ以上の前記プロセッサに指示させる命令を有する、目標指向型ナビゲーションシステム。
2. 前記離散化モジュールは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに、前記車両の現在位置に隣接する車両前方のＫ×Ｋの領域を、ふたつ以上の軸に沿って複数の格子を有するグリッドに分割する命令をさらに含む、請求項１に記載の目標指向型ナビゲーションシステム。
3. 前記衝突確率モジュールは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに、前記衝突確率配列のどのセルが前記安全基準を満たすかを決定するために、前記衝突確率配列の複数のセルの値を反転させる命令をさらに含む、請求項１に記載の目標指向型ナビゲーションシステム。
4. 前記目標スコア配列の複数のセルの値は、下記式（１）により表され、
   

   

   ここで、ｏｉは前記目標スコア配列の複数のセルの値、φ’ｉは前記人工ポテンシャルフィールド配列の複数のセルの値、s’ｉは前記衝突確率配列の複数のセルの値で、βは、安全性の相対的な重要度を表す攻撃性係数である、請求項１に記載の目標指向型ナビゲーションシステム。
5. 前記目標スコア配列の中で最高値を有するセルが、下記式（２）により表される、請求項４に記載の目標指向型ナビゲーションシステム。
   

   
6. 前記メモリは、ひとつ以上の前記プロセッサによって実行されると、前記車両が前記目標位置に到達したときに、ひとつ以上の前記プロセッサに前記目標位置を新しい目標位置に更新させる命令を含む目標更新モジュールをさらに備える、請求項１に記載の目標指向型ナビゲーションシステム。
7. 前記新しい目標位置は、最終的な目標位置への経路に基づいて決定される、請求項６に記載の目標指向型ナビゲーションシステム。
8. 前記メモリは、ひとつ以上の前記プロセッサによって実行されると、ひとつ以上の前記プロセッサに以下を実行させる命令を含むハンドオーバ制御モジュールをさらに備え、
   前記ハンドオーバ制御モジュールがひとつ以上の前記プロセッサに実行させる命令は、
   経路に沿った前記車両の位置を決定し、
   ハンドオーバ制御システムにより、前記経路に沿った前記車両の位置に基づいて、前記目標指向型ナビゲーションシステムまたは前記汎用ナビゲーションシステムからのコマンドを利用するように前記車両制御システムに指示することである、請求項１に記載の目標指向型ナビゲーションシステム。
9. 汎用ナビゲーションシステムおよび目標指向型ナビゲーションシステムを有する車両を操作するための方法であって、
   前記車両の知覚システムから知覚データを受信するステップと、
   前記目標指向型ナビゲーションシステムによって、前記知覚データを、前記車両の現在位置に隣接し、複数の格子で構成される領域に離散化するステップと、
   前記目標指向型ナビゲーションシステムによって、前記複数の格子に対応する複数のセルを有する衝突確率配列を生成するステップと、
   前記目標指向型ナビゲーションシステムによって、前記衝突確率配列のどのセルが安全基準を満たすかを決定するステップと、
   前記目標指向型ナビゲーションシステムによって、前記衝突確率配列の複数のセルに対応する複数のセルを有する人工ポテンシャルフィールド配列を受信するステップと、
   前記目標指向型ナビゲーションシステムによって、前記安全基準を満たす前記衝突確率配列のセルに対応する複数のセルを有する目標スコア配列を生成するステップと、
   前記目標指向型ナビゲーションシステムによって、前記車両の車両制御システムに、最高値を有する前記目標スコア配列内のセルを表す場所に前記車両を誘導するように指示するステップと、を含み、
   前記衝突確率配列のセルは、前記衝突確率配列のセルによって表される領域に前記車両が移動した場合の衝突の可能性を示し、
   前記人工ポテンシャルフィールド配列の複数のセルの値は、目標位置からの前記車両の現在位置の近接度の関数であり、
   前記目標スコア配列のセルの値は、前記衝突確率配列と前記人工ポテンシャルフィールド配列の対応するセルの値に基づいている、方法。
10. 前記目標指向型ナビゲーションシステムによって、前記車両の現在位置に隣接する車両前方のＫ×Ｋの前記領域を、ふたつ以上の軸に沿って複数の格子を有するグリッドに分割するステップをさらに含む、請求項９に記載の方法。
11. 前記衝突確率配列のどのセルが前記安全基準を満たすかを決定するために、前記衝突確率配列の複数のセルの値を反転するステップをさらに含む、請求項９に記載の方法。
12. 前記目標スコア配列の複数のセルの値は、下記式（１）により表され、
    

    

    ここで、ｏｉは前記目標スコア配列の複数のセルの値、φ’ｉは前記人工ポテンシャルフィールド配列の複数のセルの値、s’ｉは前記衝突確率配列の複数のセルの値で、βは、安全性の相対的な重要度を表す攻撃性係数である、請求項９に記載の方法。
13. 前記目標スコア配列の中で最高値を有するセルが、下記式（２）により表される、請求項１２に記載の方法。
    

    
14. 前記車両が前記目標位置に到達したときに、前記目標位置を新しい目標位置に更新するステップをさらに含む、請求項９に記載の方法。
15. 前記新しい目標位置は、最終的な目標位置への経路に基づいて決定される、請求項１４に記載の方法。
16. 経路に沿った前記車両の位置を決定するステップと、
    ハンドオーバ制御システムによって、前記経路に沿った前記車両の位置に基づいて、前記目標指向型ナビゲーションシステムまたは前記汎用ナビゲーションシステムからのコマンドを利用するように前記車両制御システムに指示するステップと、をさらに含む請求項９に記載の方法。
17. 汎用ナビゲーションシステムおよび目標指向型ナビゲーションシステムを有する車両を操作するための非一時的コンピュータ可読媒体であって、
    ひとつ以上のプロセッサによって実行されたときに、ひとつ以上の前記プロセッサに実行させる命令として、
    前記車両の知覚システムから知覚データを受信し、
    前記目標指向型ナビゲーションシステムによって、前記知覚データを、前記車両の現在位置に隣接し、複数の格子で構成される領域に離散化し、
    前記目標指向型ナビゲーションシステムによって、前記複数の格子に対応する複数のセルを有する衝突確率配列を生成し、
    前記目標指向型ナビゲーションシステムによって、前記衝突確率配列のどのセルが安全基準を満たすかを決定し、
    前記目標指向型ナビゲーションシステムによって、前記衝突確率配列の複数のセルに対応する複数のセルを有する人工ポテンシャルフィールド配列を受信し、
    前記目標指向型ナビゲーションシステムによって、前記安全基準を満たす前記衝突確率配列のセルに対応する複数のセルを有する目標スコア配列を生成し、
    前記目標指向型ナビゲーションシステムによって、前記車両の車両制御システムに、最高値を有する前記目標スコア配列内のセルを表す場所に前記車両を誘導するように指示すること、を含み、
    前記衝突確率配列のセルは、前記衝突確率配列のセルによって表される領域に前記車両が移動した場合の衝突の可能性を示し、
    前記人工ポテンシャルフィールド配列の複数のセルの値は、目標位置からの前記車両の現在位置の近接度の関数であり、
    前記目標スコア配列のセルの値は、前記衝突確率配列と前記人工ポテンシャルフィールド配列の対応するセルの値に基づいている、非一時的コンピュータ可読媒体。
18. ひとつ以上の前記プロセッサによって実行されると、前記車両が前記目標位置に到達したときに、ひとつ以上の前記プロセッサに前記目標位置を新しい目標位置に更新させる命令をさらに含む、請求項１７に記載の、非一時的コンピュータ可読媒体。
19. 前記新しい目標位置は、最終的な目標位置への経路に基づいて決定される、請求項１８に記載の非一時的コンピュータ可読媒体。
20. 経路に沿った前記車両の位置を決定し、
    ハンドオーバ制御システムにより、前記経路に沿った前記車両の位置に基づいて、前記目標指向型ナビゲーションシステムまたは前記汎用ナビゲーションシステムからのコマンドを利用するように前記車両制御システムに指示する命令をさらに含む、請求項１７に記載の非一時的コンピュータ可読媒体。

Images