(57)【要約】  本発明は、地図上の車両の正確な位置を推定する方法であって、地理位置情報システムによって車両の少なくとも１つの地理的位置（Ｐ０）を取得するステップと、地図上の車両を事前に配置するステップと、パーティクル（Ｐｉ）と呼ばれる車両の可能な位置が処理されるパーティクルフィルタリングステップと、を含む方法に関する。本発明によると、パーティクルフィルタリングステップは、地図上のパーティクルを分布させる予備ステップ、および、その後、地図上のパーティクルを更新するステップと、それぞれのパーティクルの尤度を算出するステップと、パーティクルの限定された集合を選択するステップと、選択されたパーティクルの尤度に関連し且つ選択されたパーティクルの数に関連する指標が閾値を下回る場合、地図上のパーティクルをリサンプリングするステップと、を含む。【選択図】図３
2021515184.tif 000002
【特許請求の範囲】
【請求項１】
地図上の車両（１０）の正確な位置（ＰＰ）を推定する方法であって、
地理位置情報システムによって前記車両（１０）の少なくとも１つの地理的位置（Ｐ０）を取得するステップと、
前記地図上の前記車両（１０）を、この地理的位置（Ｐ０）で事前に配置するステップと、
パーティクル（Ｐｉ）と呼ばれる前記車両の可能な位置が、前記地図上の前記車両（１０）の前記正確な位置（ＰＰ）を決定するように処理されるパーティクルフィルタリングステップと、を含み、
前記パーティクルフィルタリングステップは、
前記地図上の前記車両（１０）の前記地理的位置（Ｐ０）に応じて前記地図上のパーティクル（Ｐｉ）を分布させる予備ステップ、および、その後、前記地図上の前記パーティクル（Ｐｉ）を更新するステップ、
少なくとも前記地図からのデータに基づいて、それぞれのパーティクル（Ｐｉ）の尤度（ｗｉ）を算出するステップ、
パーティクル（Ｐｉ）の限定された集合を選択するステップ、ならびに、
選択された前記パーティクル（Ｐｉ）の前記尤度（ｗｉ）に関連し且つ選択されたパーティクル（Ｐｉ）の数に関連する指標（Ｎｅｆｆ）が閾値を下回る場合、前記地図上の前記パーティクル（Ｐｉ）をリサンプリングするステップを含むことを特徴とする、推定する方法。
【請求項２】
それぞれのパーティクル（Ｐｉ）の前記尤度（ｗｉ）は、前記地図からのデータのみに応じて算出される、請求項１に記載の推定する方法。
【請求項３】
それぞれのパーティクル（Ｐｉ）の前記尤度（ｗｉ）は、前記車両（１０）がこの周囲環境を感知できるようにするセンサからのデータにも応じて、これらのデータが信頼できるとみなされるという条件で算出される、請求項１に記載の推定する方法。
【請求項４】
前記パーティクルフィルタリングステップでは、前記正確な位置（ＰＰ）は、それぞれのパーティクル（Ｐｉ）の前記尤度（ｗｉ）に応じて、選択された前記パーティクル（Ｐｉ）の限定された集合の中から選定される、請求項１から３のいずれか一項に記載の推定する方法。
【請求項５】
道路区間に関するデータを記憶する前記地図によって、それぞれのパーティクル（Ｐｉ）の前記尤度（ｗｉ）は、前記パーティクル（Ｐｉ）に対して最も近い道路区間の位置に応じて算出される、請求項１から４のいずれか一項に記載の推定する方法。
【請求項６】
前記予備ステップでは、前記パーティクル（Ｐｉ）を、前記車両（１０）の前記地理的位置（Ｐ０）を中心とするディスクにおいて分布させる、請求項１から５のいずれか一項に記載の推定する方法。
【請求項７】
前記ディスクの半径は、前記車両（１０）の前記地理的位置（Ｐ０）に割り当てられた水平保護レベル（ＨＰＬ）に応じて決定される、請求項６に記載の推定する方法。
【請求項８】
前記選択するステップでは、前記パーティクル（Ｐｉ）は、これらと前記車両（１０）の前記地理的位置（Ｐ０）との間の距離に応じて選択される、請求項１から７のいずれか一項に記載の推定する方法。
【請求項９】
前記更新するステップでは、前記パーティクル（Ｐｉ）を、前記車両の動態に関する情報のみに応じて前記地図上で移動させる、請求項１から８のいずれか一項に記載の推定する方法。
【請求項１０】
前記リサンプリングするステップでは、前記パーティクル（Ｐｉ）は低分散法を使用してリサンプリングされる、請求項１から９のいずれか一項に記載の推定する方法。
【請求項１１】
車両（１０）であって、
地図を記憶するための手段と、
地理位置情報システムと、
前記地図上に前記車両（１０）を事前に配置するように設計されるコンピュータと、を含み、
前記コンピュータは、請求項１から１０のいずれか一項に記載の、前記地図上の前記車両（１０）の正確な位置（ＰＰ）を推定する方法を実施するように設計されることを特徴とする、車両（１０）。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は一般的に、地図作成の分野に関する。
【０００２】
本発明は、より詳細には、地図上の車両の正確な位置を推定する方法であって、
地理位置情報システムによって車両の少なくとも１つの地理的位置を取得するステップと、
地図上の車両を、この地理的位置で事前に配置するステップと、
パーティクルと呼ばれる車両の可能な位置が、地図上の車両の正確な位置を決定するように処理されるパーティクルフィルタリングステップと、を含む方法に関する。
【０００３】
本発明は、
地図を記憶するための手段と、
地理位置情報システムと、
地図上に車両を事前に配置するように設計されるコンピュータと、を含む車両にも関する。
【背景技術】
【０００４】
自律走行車両および部分的に自動化された車両の安全性を保証するために、これらの車両が移動している周囲環境を広範囲にわたって知ることが必要である。
【０００５】
実際には、車両は、この周囲環境を２つの異なるやり方、すなわち、地図および車両の地理位置情報システムを使用して、および外受容センサ（カメラ、レーダー、またはライダーセンサなど）を使用して、感知する。
【０００６】
地図を開発する企業は、現在、道路網の特徴（車線幅、地表標識、道標など）についての非常に詳細な情報を得ることが可能である「高精細」地図と呼ばれるものに取り組んでいる。
【０００７】
これらの地図は、地理位置情報システムを備える車両に組み込まれていることによって、これらの車両は、経度および緯度に関して推定された位置において地図上の該車両自体を位置付けることができる。
【０００８】
残念ながら、この位置は常に非常に正確で信頼できるものではなく、車両が実際に通っている経路外に位置しているという結果になることに気付く。この問題は、自律走行車両がこの情報を使用してこの車両自体を案内する場合にとりわけ危険であることを実証し得る。
【０００９】
この問題を克服するために、独国特許出願公開第１０２０１３２１７０６０号から既知の１つの解決策は、地図上の車両の位置を調節するために車両の外受容センサからの情報を考慮することにある。
【００１０】
この解決策は、「パーティクルフィルタ」法と呼ばれるものを使用する。この方法では、車両の考えられる位置に対応するパーティクルが考慮されかつ処理されることで、車両の正確な位置を見つけることを試みる。上述した文献では、パーティクルは、恐らく、車両の実際の位置に対応するただ１つのパーティクルが見つけられるまで、車両に搭載されたカメラによって観測される車線区分線の位置に応じてこのフィルタによって段階的に選択される。
【００１１】
この解決策は２つの欠点を示している。
【００１２】
この第１の欠点は、この信頼性が、路面標識の可視性に非常に大きく依存していることである。具体的には、可視ではない場合または路面標識がない場合、信頼できない結果がもたらされると理解されたい。
【００１３】
この第２の欠点は、結局、ただ１つのパーティクルを選択することが可能であるため、間違えた場合、自動車はこのことを確かめることができず、これは非常に危険であることを実証し得る。
【発明の概要】
【００１４】
先行技術の前述の欠点を克服するために、本発明は、地図上の自動車の正確な位置を確かめることが可能か否か、可能である場合、この正確な位置は何かを判断するための新規な方法を提案する。
【００１５】
より詳細には、本発明に従って提案されるのは、導入部で定められるような方法であって、パーティクルフィルタリングステップは、
地図上の車両の地理的位置に応じて地図上のパーティクルを分布させる予備ステップ、および、その後、地図上のパーティクルを更新するステップ、
少なくとも地図からのデータに基づいて、それぞれのパーティクルの尤度を算出するステップ、
パーティクルの限定された集合を選択するステップ、ならびに、
選択されたパーティクルの尤度に関連し且つ選択されたパーティクルの数に関連する指標が閾値を下回る場合、地図上のパーティクルをリサンプリングするステップを含む方法である。
【００１６】
よって、本発明により、それぞれのパーティクルの尤度は、地図からのデータに基づいて算出される。したがって、この算出は、車両の外受容センサによって読み出されるデータと無関係であってよく、したがって、地表標識の可視性および車両の周囲環境の可視性と無関係であってよい。よって、信頼性が外的条件に依存していない結果がもたらされる。
【００１７】
また、本発明により、リサンプリングするステップは、自動的に行われないことによって、潜在的に正しいパーティクルの排除をもたらし得るパーティクルの減少が回避される。
【００１８】
本発明による方法の他の有利かつ非限定的な特徴は、以下のようになる。
それぞれのパーティクルの尤度は、地図からのデータのみに応じて算出される。
それぞれのパーティクルの尤度は、車両がこの周囲環境を感知できるようにするセンサからのデータにも応じて、これらのデータが信頼できるとみなされるという条件で算出される。
パーティクルフィルタリングステップでは、正確な位置は、それぞれのパーティクルの尤度に応じて、選択されたパーティクルの限定された集合の中から選定される。
道路区間に関するデータを記憶する地図によって、それぞれのパーティクルの尤度は、パーティクルに対して最も近い道路区間の位置に応じて算出される。
予備ステップでは、パーティクルを、車両の地理的位置を中心とするディスクにおいて分布させる。
ディスクの半径は、車両の地理的位置に割り当てられた水平保護レベルに応じて決定される。
選択するステップでは、パーティクルは、これらと車両の地理的位置との間の距離に応じて選択される。
更新するステップでは、パーティクルを、車両の動態に関する情報のみに応じて地図上で移動させる。
リサンプリングするステップでは、パーティクルは低分散法を使用してリサンプリングされる。
【００１９】
本発明は、
地図を記憶するための手段と、
地理位置情報システムと、
上述されるように、地図上の車両の正確な位置を推定する方法を実施するように設計されるコンピュータと、を含む車両にも関する。
【００２０】
非限定的な例によって示される、添付の図面を参照する以下の説明によって、本発明の内容、および本発明がどのように実施され得るかについて理解されるであろう。
【図面の簡単な説明】
【００２１】
【図１】本発明による方法のさまざまなステップを示す図である。
【図２】道路上を走行する車両の平面図である。
【図３】地図上に分布させたパーティクルの概略図である。
【図４】２つの連続した道路区間に隣接している２つのパーティクルの概略図である。
【図５】４つの道路区間に隣接している４つのパーティクルの概略図である。
【発明を実施するための形態】
【００２２】
図２は、４つの車線Ｖ１、Ｖ２、Ｖ３、Ｖ４を有する道路部分上で走行する乗用車の形式の自動車１０を示す。
【００２３】
これ以降の説明では、とりわけ対象となるものは、地図上のこの自動車１０の場所であるが、本発明はこのような例に限定されるものではない。よって、本発明は、とりわけ、地図上の、いずれの陸、海、空中、または空間の車両の場所にも該当する。
【００２４】
ここで対象としている自動車１０は、従来、シャーシ、駆動列、ステアリングシステム、制動システム、ならびに、以降コンピュータと呼ばれる、電子および／またはコンピュータ処理ユニットを含む。
【００２５】
コンピュータは、車両の速度、および車両のヨー角速度を正確に測定できるようにする「固有受容」センサと呼ばれるものに接続される。
【００２６】
コンピュータは好ましくは、自動車１０の目前の周囲環境を感知できるようにする「外受容」センサと呼ばれるもの（これらは、カメラ、レーダーセンサ、ライダーセンサなどであってよい）にも接続される。
【００２７】
コンピュータはさらに、ここで、緯度および経度によって定められる、車両１０の地理的位置Ｐ０を評価できるようにする地理位置情報システムに接続される。これは例えば、ＧＰＳシステムであってよい。
【００２８】
ここで、この地理位置情報システムはさらに、「水平保護レベルＨＰＬ」と呼ばれるデータ項目をコンピュータに送信するように設計されることが検討されることになる。当業者には周知であるこのデータ項目は、地理的位置Ｐ０の測定における不確定性に対応する。この値は例えば、地理位置情報システムがデータを受信する人工衛星の数、信号の受信の品質、使用される地理位置情報システムの品質などに応じて変化する。
【００２９】
同じ考え方を受けて、ここで、この地理位置情報システムは、この同じ不確定性に関する共分散行列をコンピュータに送信するように設計されることも検討されることになる。
【００３０】
対象としている自動車１０は、このコンピュータが、例えば、運転手が危険に気付かず、かつ自身で適切な行動を起こさなかった時、非常ブレーキをトリガすることができるように、半自動化である可能性がある。
【００３１】
しかしながら、本開示のこれ以降では、自動車１０は自律的であり、かつ、コンピュータは、車両の、駆動列、ステアリングシステム、および制動システムを制御するように設計されることが検討されることになる。
【００３２】
コンピュータはさらにまた、車両の自律制御の文脈で、とりわけ、後述される方法の文脈で使用されるデータを記録するコンピュータメモリを含む。
【００３３】
該コンピュータは、とりわけ、プロセッサによる実行によってコンピュータが後述される方法を実施できる命令を含むコンピュータプログラムから成るコンピュータアプリケーションを記憶する。
【００３４】
コンピュータはまた、「高精細」地形図と呼ばれるものを記憶する。
【００３５】
この地図は、大量のデータを記憶する。
【００３６】
まず最初に、該地図は、道路の地形に関する情報を含む。この地形は、この場合、道路区間（または「連絡路」）の形式で記憶される。それぞれの道路区間は、この場合、道路のただ１つの車線の一部分として定められ、この特徴はこの全長にわたって一定である（道路区間に沿って同一の地表標識の形状、この道路区間の一定の幅など）。
【００３７】
地図はまた、車線の幅、車線の両側に位置する地表標識の形状、道路区間における道路に隣接するそれぞれの標識の位置および形状、先のおよび後の道路区間の識別子などを含む、それぞれの道路区間を特徴付ける他のデータを記憶する。
【００３８】
地図上の自動車１０の正確な位置ＰＰを推定するためにコンピュータによって実施される方法は、２つの主な動作、すなわち、パーティクルフィルタリング動作１００およびシナリオ選択動作２００を含む（図１を参照）。
【００３９】
シナリオ選択動作２００は、パーティクルフィルタリング動作１００の結果を使用するが、これはこのシナリオ選択動作２００がその後実施されることを意味する。
【００４０】
さらにまた、第１のパーティクルフィルタリング動作１００を説明することから始めることができる。
【００４１】
この動作は、再帰的に、すなわち、ループでおよび規則的な時間増分で実施される。
【００４２】
この動作は、３つの主なステップを含む。
【００４３】
第１のステップ１０１は、コンピュータが、接続されるセンサを介してさまざまなデータを取得することにある。
【００４４】
コンピュータはよって、自動車１０の地理的位置Ｐ０、およびこれと関連付けられる水平保護レベルＨＰＬを取得する。これらのデータは、緯度、経度、および水平保護レベルＨＰＬを提供する地理位置情報システムにより取得される。
【００４５】
コンピュータはまた、自動車１０の動態に関するデータを取得する。よって、該コンピュータは、車両の速度Ｖ、およびこのヨー角速度Ψを取得する。
【００４６】
第２のステップ１０２は、取得した地理的位置Ｐ０において地図上の車両１０を事前に配置するステップである。
【００４７】
第３のステップ１０３は、パーティクルＰｉと呼ばれる車両の可能な位置（またはより正確には、車両の可能な様子）が、地図上の車両１０の正確な位置ＰＰ（またはより正確には、地図上の車両の正確な様子）を決定するために処理されるパーティクルフィルタリングステップである。
【００４８】
それぞれのパーティクルＰｉは、
デカルト基準系においてパーティクルの位置を定めるための２つの座標ｘｉ、ｙｉ（これらの座標を取得した経度および緯度にリンクさせる）、
北など、一定方向に対してパーティクルによって形成される角度を定めるためのヨー角、および
パーティクルＰｉが関連付けられる地図の識別子によって定められてよい。
【００４９】
図３〜図５は、二等辺三角形の形式のパーティクルＰｉを示し、それぞれの三角形は、地図上のパーティクルの位置に対応する中心Ｍｉ、および、地図上のパーティクルのヨー角に対応する配向を有する。
【００５０】
図１に示されるように、第３のパーティクルフィルタリングステップ１０３は、より正確には、ここでより詳細に説明され得る複数のサブステップから成る。
【００５１】
第１のサブステップ１１０は、パーティクルフィルタの初期化段階が存在するか否かを判断することにあり、これは例えば、自動車１０が始動される場合である。
【００５２】
この状況は、パーティクルがまだ生成されていない場合の始動シナリオとして挙げられ得る。
【００５３】
続くサブステップ１１２はさらにまた、車両１０の地理的位置Ｐ０を想定して、地図上のパーティクルＰｉを作成しかつ分布させることにある。
【００５４】
この目的のために、パーティクルＰｉを、車両１０の地理的位置Ｐ０を中心としてディスク内で分布させ、このディスクの半径は、この場合、水平保護レベルＨＰＬに等しい。
【００５５】
これらのパーティクルを、より正確には、一定の角度オフセットによって螺旋状に分布させる。螺旋状、およびパーティクルＰｉ間の角度オフセットの特徴は、生成することが望まれるパーティクルＰｉの数に応じて選定される。
【００５６】
この数は、１００を上回る、より好ましくは、１０００ほどである。この数は、その他の場合はコンピュータに過度な負担をかけない十分な精度を得るように判断される。
【００５７】
現段階では、パーティクルＰｉはまだ配向されていない。
【００５８】
それぞれのパーティクルＰｉはよって、誤差が地理位置情報システムに影響すると想定して、車両が有することができる可能な位置に対応する。
【００５９】
図３において見ることができるようないくつかのパーティクルは、道路から離れて位置する。これは、パーティクルが地図に制限されず、これらパーティクルが２次元空間で移動してよいという事実を示す。したがって、このフィルタは、非常に柔軟であり、かつ、非常に多くの種々の解決策を最初に考えることを可能にし、これらのうち最も実現不可能なものはさらにまた、パーティクルフィルタによって排除されることになる。
【００６０】
続くサブステップ１１３では、コンピュータはそれぞれのパーティクルＰｉをこれに最も近い道路区間と関連付ける。
【００６１】
ここで選定される方法はポイントツーカーブ方法である。これは、それぞれのパーティクルＰｉを、ユークリッド距離に関して最も近い道路区間と関連付けることにある。
【００６２】
実例として、このように図４において、パーティクルＰ１が道路区間ＡＢと関連付けられることがわかる。
【００６３】
現段階では、コンピュータは、とりわけ、それぞれのパーティクルが関連付けられる道路区間の配向に応じて（および場合によっては、車両の動態にも応じて）パーティクルＰｉを配向してよい。
【００６４】
方法はその後、さらに説明されるサブステップ１１６を続ける。
【００６５】
上述されているように、第１のサブステップ１１０は、パーティクルフィルタの初期化段階が存在したか否かを判断することにある。
【００６６】
ここで、これに該当せず、かつプロセスが既に前もって初期化されていることが考えられ得る。
【００６７】
この場合、サブステップ１１４では、コンピュータは地図上のパーティクルＰｉを更新する。
【００６８】
この目的のために、パーティクルＰｉを全て、車両の動態に関する情報に応じて地図上で移動させる。
【００６９】
２つのデータ項目、すなわち、車両の速度Ｖ、および自動車１０のヨー角速度Ψは、具体的には、一定距離によってパーティクルＰｉの全てを移動させるために、および一定角度によってパーティクルを再配向するために使用される。
【００７０】
この時のこのサブステップが自動車の地理的位置Ｐ０を使用しないことは留意されたい。
【００７１】
続くサブステップ１１５では、コンピュータは、それぞれのパーティクルＰｉを道路区間と再び関連付ける。
【００７２】
より正確には、コンピュータは、どのパーティクルＰｉが新しい道路区間と関連付けられなければならないかを判断し、かつこの新しい道路区間を識別する。
【００７３】
コンピュータがどのように機能するかを理解するために、点Ｍ１、Ｍ２を中心とした２つのパーティクルＰ１、Ｐ２が示され、かつ道路区間ＡＢも示される図４を参照することができる。
【００７４】
この場合、先の時間増分で、２つのパーティクルＰ１、Ｐ２はただ１つの同じ道路区間ＡＢと関連付けられたと考えられるが、これは、それらパーティクルがサブステップ１１４において移動したからである。
【００７５】
コンピュータはさらにまた、それぞれのパーティクルが新しい道路区間と関連付けられるべきか否かを確かめるために、それぞれのパーティクルＰｉに対する比率ｒを判断する。
【００７６】
この比率ｒは以下の式を使用して算出される。
2021515184.tif 000003
【００７７】
この比率ｒが０と１との間である場合、パーティクルＰｉとこの元の道路区間との関連性は変更されるべきではない。これはここではパーティクルＰ１の場合である。
【００７８】
この比率が負である場合、パーティクルＰｉとこの道路区間との関連性は、変更されるべきである。このパーティクルはより正確には、先の道路区間と、または先の道路区間のうちの１つと関連付けられるべきである。
【００７９】
この比率が厳格に１を上回る場合、パーティクルＰｉとこの道路区間との関連性は、変更されるべきである。このパーティクルは、より正確には、後の道路区間とまたは後の道路区間のうちの１つと関連付けられるべきである。
【００８０】
そのように多くの状況に遭遇する場合がある。
【００８１】
道路区間ＡＢがただ１つの後続区間ＢＢ’を有する図４の状況において、パーティクルＰ２はこの後続区間と関連付けられる（比率ｒがこの新しい道路区間によって０と１との間である限り、他の別の後続区間が考えられる）。
【００８２】
道路区間ＡＢが複数の後続区間ＢＣ、ＢＤ、ＢＥを有する図５の状況では、先の時間増分で対象としているパーティクルＰ２は、後続区間ＢＣ、ＢＤ、ＢＥがあるのと同じ数のパーティクルＰ２１、Ｐ２２、Ｐ２３にクローン化される。
【００８３】
また、車両の動態を想定して、考えられ得る後続区間のいくつかがない場合パーティクルはより少ない回数クローン化されてよい。
【００８４】
図に示されない別の状況では、パーティクルは、（とりわけ、例えば、別の車両を追い越すために車両が横に車線を変える時に生じることになる）先の時間増分で関連付けられた道路区間に平行な別の道路区間と関連付けられなければならないことが考えられる。これは、パーティクルが同じ道路区間でのみ移動することに制限されないため、可能とされる。この状況は、パーティクルの新しい位置および地図に記憶されたデータ（地表標識情報、車線幅など）を想定して検出可能である。１つの別形では、この状況が車両に搭載されたカメラを使用しても検出されると考えることが可能である。
【００８５】
サブステップ１１５およびサブステップ１１３両方の後のサブステップ１１６では、コンピュータはそれぞれのパーティクルＰｉの尤度ｗｉを算出する。
【００８６】
パーティクルの尤度は、ここで、この重みｗｉによって表される。パーティクルの重みが大きいほど、対象としているパーティクルが自動車１０の厳密な位置に相当する可能性が高くなる。
【００８７】
この重みは、さまざまなやり方で算出されてよい。
【００８８】
第１の実施形態では、それぞれのパーティクルＰｉの重みｗｉは地図からのデータのみに応じて算出される。
【００８９】
より正確には、この重みは、対象としているパーティクルとこのパーティクルが関連付けられる道路区間との間のユークリッド距離に応じて判断される（この重みは例えば、この距離に反比例して等しい）。
【００９０】
第２の実施形態では、それぞれのパーティクルＰｉの重みｗｉは、外受容センサからのデータにも応じて、これらのデータが信頼できるとみなされるという条件で算出される。
【００９１】
具体的には、車両のカメラＣＡＭからの横情報に応じて対象としているパーティクルの重みが増加するまたは低減することを仮定することが可能である。これらのカメラは、効果的には、地表標示線を検出すること、およびこれらを多項式モデルの形式でコンピュータにフィードバックすることが可能である。コンピュータはさらにまた、これらの地表標示線の形状が地図に記録された地表標識の形状に対応するかどうかを検証し、それに応じてパーティクルの重みを調節してよい。
【００９２】
地表標識が常にカメラによって検出されるわけではないことは留意されたい。これは、例えば、点灯不良、濡れた道路、消去された標示など、センサにとって困難である条件によるものであり得る。これらの具体的な事例では、カメラは、コンピュータに低信頼度を指示し、重みの算出はさらにまた、第１の実施形態において説明されるように、地図によって提供されるデータにのみ基づく。
【００９３】
ここで、データ項目の信頼性基準は一般的に、例えば、パーセンテージの形式でデータ項目を測定するセンサによって提供されることに気付く（このパーセンテージはさらにまた、データ項目が考慮されるべきか否かを判断するために使用されることになる）。
【００９４】
使用される方法に関係なく、方法は、パーティクルＰｉの限定された集合を、自動車１０の瞬間的な地理的位置Ｐ０から離れすぎていると思われるパーティクルを排除するように選択するサブステップ１１７を続ける。
【００９５】
このサブステップを実施するために、コンピュータは、自動車１０の新しい地理的位置Ｐ０を取得し、さらにまた、それぞれのパーティクルＰｉとこの瞬間的な地理的位置Ｐ０との間の距離を算出する。
【００９６】
この距離が水平保護レベルＨＰＬを上回る場合、対応するパーティクルＰｉの重みｗｉはゼロに設定され、それによって、このパーティクルはその後自動的に排除可能となる。
【００９７】
上回らない場合、対応するパーティクルＰｉの重みｗｉは修正されない。
【００９８】
続くサブステップ１１８では、コンピュータは、地図上のパーティクルＰｉをリサンプリングすることが必要か否かを判断する。
【００９９】
この目的のために、コンピュータは、パーティクルＰｉの重みｗｉおよびパーティクルＰｉの数に応じて算出される指標Ｎｅｆｆを使用する。
【０１００】
この指標Ｎｅｆｆが（コンピュータの読み出し専用メモリに記憶される）あらかじめ定められた閾値を下回る場合、コンピュータは地図上のパーティクルＰｉをリサンプリングする。下回らない場合、パーティクルＰｉはその状態に保たれる。
【０１０１】
知られるように、リサンプリングは、（以降、元のパーティクルと呼ばれる）パーティクルを全体として考慮すること、およびこの元の集合から新しいパーティクルを引き出すことにある。
【０１０２】
パーティクルをリサンプリングするために、コンピュータは、所定の数の新しいパーティクルをパーティクルＰｉの元の集合からランダムに引き出すようにする従来の方法を使用することができ、それぞれのパーティクルＰｉを引き出す可能性はこのパーティクルＰｉの重みｗｉに比例している。しかしながら、この方法は一般的に、パーティクルの減少を引き起こすが、これは、常に、引き出されるパーティクルの重みが非常に大きいからである。
【０１０３】
この場合、コンピュータは好ましくは、むしろ、「低分散」リサンプリング方法と呼ばれるものを使用する。具体的には、この方法は、地図上のパーティクルの良好な分布の維持を促進する。この方法は、所定の数の新しいパーティクルをパーティクルＰｉの元の集合からランダムに引き出すことにあり、それぞれのパーティクルＰｉを引き出す可能性はこのパーティクルＰｉの重みｗｉに応じるものであるが、今回はこの重みに比例していない。
【０１０４】
現段階では、コンピュータは、地図上の自動車１０の正確な位置ＰＰに対応すると考えられる、全てが１つの同じ点の周りに位置するパーティクルを得るまでサブステップ１１４〜１１８をループで再開することで済ますことが可能である。
【０１０５】
しかしながら、これは、ここで選定されるオプションではない。よって、上で説明されているように、サブステップ１１８が完了すると、シナリオ選択動作２００が提供される。
【０１０６】
このシナリオ選択動作２００は、パーティクルフィルタリング動作１００が収束し、かつ限定された数の解決策が与えられると実施される（パーティクルは例えば、あらかじめ定められた閾値より低い数の点の周りに集められる）。
【０１０７】
このシナリオ選択動作２００は、再帰的に、すなわち、ループでおよび規則的な時間増分で実施される。この動作はいくつかの連続したステップを含む。
【０１０８】
第１のステップ２０１では、コンピュータは「シナリオ」を選択する。
【０１０９】
この目的のために、さまざまな集合のパーティクルＰｉが考えられ、これらのそれぞれの中で、パーティクルは全て、１つの同じ車線（または別形として、１つの同じ道路区間）と関連付けられる。
【０１１０】
シナリオに作用する利益は、さらにまた、最も可能性の高いシナリオの全てを選択することが可能になることであり、これによって、最初に、選択されたシナリオから正しいシナリオを保持し、次に、それぞれの選択されたシナリオの妥当性を検証することが可能になる。
【０１１１】
シナリオは、「車両は、基準が…である車線に位置する」というような表明の形式で表現されてよい。
【０１１２】
本開示の意味の範囲内に相当するのはどんなシナリオかを十分理解してもらうために、図３では、パーティクルを、それぞれがシナリオに対応する８の集合Ｚ１、Ｚ２、Ｚ３、Ｚ４、Ｚ５、Ｚ６、Ｚ７、Ｚ８に一斉にグループ分けする。
【０１１３】
例として、集合Ｚ１におけるパーティクルは、「車両は道路Ｒ１の右側車線に位置する」というシナリオに対応する。
【０１１４】
集合Ｚ２におけるパーティクルは、「車両は道路Ｒ１の左側車線に位置する」というシナリオに対応する。
【０１１５】
集合Ｚ３におけるパーティクルは、「車両は道路Ｒ２の左側車線に位置する」というシナリオに対応する。
【０１１６】
集合Ｚ４におけるパーティクルは、「車両は道路Ｒ１およびＲ２による分岐合流点の間の円形交差点に位置する」というシナリオなどに対応する。
【０１１７】
数「Ｊ」のシナリオ（図３ではＪ＝８）が見られることを考慮すると、それぞれのシナリオはまた、ベクトル
2021515184.tif 000004
の形式で表現されてよく、この成分はこれらのパーティクルの重みｗｉによって重み付けされた、このシナリオのパーティクルＰｉの座標の合計に対応する。
【０１１８】
コンピュータは、「信頼指数」をそれぞれのシナリオに割り当ててよく、この信頼指数はこのシナリオのパーティクルＰｉの重みｗｉの合計に等しい。
【０１１９】
第２のステップ２０２では、コンピュータは、それぞれのシナリオの共分散行列
2021515184.tif 000005
、および車両１０の地理的位置Ｐ０の共分散行列Σ−１（ＸＧＮＳＳ）を判断することになる。
【０１２０】
このような共分散行列を具体的に操作することによって、それぞれのシナリオにリンクされており、かつ地理位置情報システムによって提供される地理的位置Ｐ０にリンクされている不確定性を特徴付けることが可能になる。
【０１２１】
上で説明したように、車両１０の地理的位置Ｐ０にリンクされている共分散行列Σ−１（ＸＧＮＳＳ）はこの場合、地理位置情報システムによってコンピュータに直接送信され、この場合、２×２行列である。
【０１２２】
それぞれのシナリオにリンクされる共分散行列
2021515184.tif 000006
に関して、これは、このシナリオに関連付けられたパーティクルＰｉの全ての重みｗｉに応じて算出され、この場合も、２×２行列である。
【０１２３】
さらにまた、地理位置情報システムによって提供される地理的位置Ｐ０を想定して、かつこの地理的位置の測定にリンクされている誤差を考慮して、それぞれのシナリオが「無矛盾である」程度を判断することが必要である。
【０１２４】
この目的のために、ステップ２０３では、マハラノビス距離ＤＭｊと呼ばれる数学的対象が使用され、この数式は以下のようになる。
2021515184.tif 000007
ここで、ＸＧＮＳＳはベクトル「地理的位置Ｐ０」に対応する。
【０１２５】
マハラノビス距離は、具体的には、変数の共分散（すなわち、それぞれの変数にリンクされている疑惑）を考慮して、２つの不確定状況の間の整合性を評価することを可能にするオブジェクトである。
【０１２６】
さらにまた、ステップ２０４において、ステップ２０１で取得されたシナリオの中からシナリオの第１の限定された（あるいは空の）集合が選択される。
【０１２７】
この目的のために、それぞれのマハラノビス距離ＤＭｊに対するカイ二乗（Ｘ２）検定が行われる。
【０１２８】
実際には、それぞれのマハラノビス距離ＤＭｊはここで、対象としているシナリオが地理的位置Ｐ０と無矛盾であるか否かを判断するために臨界閾値と比較される。
【０１２９】
対象としているシナリオおよび地理的位置Ｐ０がカイ二乗検定の意味の範囲内で無矛盾である場合、シナリオは保持される。
【０１３０】
それに反して、対象としているシナリオおよび地理的位置Ｐ０がカイ二乗検定の意味の範囲内で無矛盾でない場合、シナリオは拒否される。
【０１３１】
ここで、シナリオが保持される場合、これが、必ずしも、このシナリオが真であることを意味するわけではないことは留意されたい。具体的には、現段階では、いくつかのシナリオは保持されてよい。
【０１３２】
それに反して、シナリオが拒否される場合、これは、必ずしも、このシナリオが偽であったことを意味するわけではない。具体的には、このシナリオは、大きな誤差が地理的位置Ｐ０の測定に影響する場合であり得る。この場合、真のシナリオは拒否され得る。本開示のこれ以降で疑いなく明らかになるように、これはその他の場合、ここで提案される方法の信頼性に影響することはない。
【０１３３】
後続のステップ２０５において、ステップ２０４で選択されたシナリオの中からシナリオの第２の限定（あるいは空）集合が選択される。
【０１３４】
ここで、この第２の選択が、その他の場合方法の進行状況に影響を与えることなく、第１の選択の前に行われている可能性があることは留意されたい。
【０１３５】
この第２の選択は、「可能性が高い」シナリオのみを保持することにあり、これらのシナリオに対して、このシナリオを形成するパーティクルＰｉの重みｗｉにリンクされている指標は判断された閾値より大きい。この目的は、具体的には、カイ二乗整合性検定を満たしているが可能性が低いシナリオを排除することである。
【０１３６】
この目的のために、コンピュータは、信頼指数（取り消されるものは対象としているシナリオのパーティクルＰｉの重みｗｉの合計に等しい）は、判断された閾値より低いシナリオを排除する。この閾値はこの場合、不変であり、かつコンピュータの読み出し専用メモリに記憶される。
【０１３７】
これらの２つのシナリオ選択ステップの終わりに、コンピュータは、無矛盾であるだけでなく可能性が高い、数Ｎのシナリオを保持している。
【０１３８】
ステップ２０６では、さらにまた、この数Ｎに応じて、それぞれの選択されたシナリオの使用可能または使用不可能な性質が判断される。
【０１３９】
３つの事例が考えられ得る。
【０１４０】
第１の事例は、数Ｎが１に等しい場合である。この場合、ただ１つのシナリオが保持されているため、このシナリオは、正当であるとみなされ、かつ自律走行車両に対する走行命令を生成するために使用可能である。したがって、コンピュータはこれを信用することができる。この場合、コンピュータはさらにまた、このシナリオの最高の重みのパーティクルが車両１０の正確な位置ＰＰに対応すると考慮し得る。
【０１４１】
第２の事例は、数Ｎが厳格に１より大きい場合である。この場合、いくつかのシナリオが保持されているため、これらのどれもが、自律走行車両に対する走行命令を生成するために使用可能であると考慮されない。したがって、方法は、ただ１つのシナリオが得られるまでループで再開される。
【０１４２】
最後の事例は、数Ｎが０に等しい場合である。この場合、保持されているシナリオがないため、自律走行車両に対する走行命令を生成するために使用可能であると考慮されるパーティクルはない。さらに、コンピュータは有利には、地理位置情報システムによって行われる測定と取得したシナリオとの間に矛盾があるこの状況から推論可能であり、これは恐らく、地理位置情報システムに影響を与える問題によるものである。この場合、自律走行モードの車両の運転手および／または制御ユニットに、これらが必要な測定を行う（緊急停止、低下モードでの制御など）ことができるようにアラートを送信するステップ２０７が行われる。
【図１】
2021515184.tif 000008
【図２】
2021515184.tif 000009
【図３】
2021515184.tif 000010
【図４】
2021515184.tif 000011
【図５】
2021515184.tif 000012
【国際調査報告】
2021515184.tif 000013
2021515184.tif 000014
2021515184.tif 000015
2021515184.tif 000016