(57)【要約】  自車両に搭載されて自車両の周囲に存在する物標と自車両との相対位置を検出する物標位置検出部と、自車両の移動量を推定する移動量推定部と、物標位置検出部が検出した相対位置を移動量推定部が推定した移動量だけ移動させて物標位置データとして蓄積する物標位置蓄積部と、地図上に存在する物標の物標位置情報を含む地図情報を取得する地図情報取得部と、自車両が走行する走行路のカーブ開始位置を推定するカーブ開始位置推定部と、物標位置蓄積部に蓄積した物標位置データのうち少なくとも自車両の周囲に存在する物標位置データ、及び自車両の現在位置からカーブ開始位置推定部が推定したカーブ開始位置までの間に存在する物標位置データと、地図情報取得部が取得した地図情報に含まれる物標位置情報とを照合して、自車両の現在位置である自己位置を推定する自己位置推定部と、を備える。
2017017705.tif 000002
【特許請求の範囲】
【請求項１】
自車両に搭載され、前記自車両の周囲に存在する物標と自車両との相対位置を検出する物標位置検出部と、
前記自車両の移動量を推定する移動量推定部と、
前記検出した相対位置を前記推定した移動量だけ移動させて物標位置データとして蓄積する物標位置蓄積部と、
地図上に存在する物標の物標位置情報を含む地図情報を取得する地図情報取得部と、
前記自車両が走行する走行路のカーブ開始位置を推定するカーブ開始位置推定部と、
前記蓄積した物標位置データのうち少なくとも前記自車両の周囲に存在する物標位置データ、及び前記自車両の現在位置から前記推定したカーブ開始位置までの間に存在する物標位置データと、前記地図情報に含まれる物標位置情報と、を照合して前記自車両の現在位置である自己位置を推定する自己位置推定部と、を備えることを特徴とする自己位置推定装置。
【請求項２】
前記自己位置推定部は、前記自車両の直進走行距離が予め設定した推定用閾値距離以上の場合に、前記自己位置を推定することを特徴とする請求項１に記載した自己位置推定装置。
【請求項３】
前記自己位置推定部は、前記自車両が予め設定した閾値速度以下の車速で走行した場合に、前記自己位置を推定することを特徴とする請求項１または請求項２に記載した自己位置推定装置。
【請求項４】
前記自己位置推定部は、前記蓄積した物標位置データのうち前記自車両の走行経路を予め設定した閾値距離で遡った範囲内に存在する物標位置データと、前記地図情報に含まれる物標位置情報と、を照合して、前記自己位置を推定し、
前記閾値距離は、前記蓄積した物標位置データのうち前記自車両の現在位置から前記推定したカーブ開始位置までの間に存在する物標位置データを含めた距離であることを特徴とする請求項１から請求項３のうちいずれか１項に記載した自己位置推定装置。
【請求項５】
前記自己位置推定部は、前記照合を複数回行い、さらに、前記複数回の照合の結果から各照合における複数の最小誤差を算出し、前記複数の最小誤差の和が予め設定した誤差閾値以上の場合に、前記自己位置を推定することを特徴とする請求項１から請求項４のうちいずれか１項に記載した自己位置推定装置。
【請求項６】
前記自己位置推定部は、前記自車両の周囲に存在する物標位置データ、及び前記自車両の現在位置から前記推定したカーブ開始位置までの間のみに存在する物標位置データと、前記地図情報に含まれる物標位置情報と、を照合して前記自己位置を推定することを特徴とする請求項１から請求項５のうちいずれか１項に記載した自己位置推定装置。
【請求項７】
自車両の周囲に存在する物標と前記自車両との相対位置を検出し、
前記自車両の移動量と、前記自車両が走行する走行路のカーブ開始位置と、を推定し、
前記検出した相対位置を前記推定した移動量だけ移動させて物標位置データとして蓄積し、
地図上に存在する物標の物標位置情報を含む地図情報を取得し、
前記蓄積した物標位置データのうち少なくとも前記自車両の周囲に存在する物標位置データ、及び前記自車両の現在位置から前記推定したカーブ開始位置までの間に存在する物標位置データと、前記地図情報に含まれる物標位置情報と、を照合して前記自車両の現在位置である自己位置を推定することを特徴とする自己位置推定方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、自己位置推定装置及び自己位置推定方法に関する。
【背景技術】
【０００２】
移動体の現在位置である自己位置を推定する技術としては、例えば、特許文献１に記載されている構成のものがある。特許文献１に記載されている技術は、移動体を基準として予め定めた領域内に存在する周囲の環境情報を限定し、この限定した環境情報を、予め保持している環境地図と照合して、自己位置を推定する。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２００８‐２５０９０６号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
しかしながら、上述した特許文献１の構成では、例えば、移動体が車両である場合、直線路の走行において、前後方向の位置推定を、左右輪の回転角と回転角速度に応じて移動体の移動距離と方向を求める方法（オドメトリ）によって行われる。
直線路からカーブ路への進入直後は、カーブ路よりも直線部における環境情報が多いため、オドメトリで自己位置を推定する技術では、カーブ路における環境情報が蓄積されるまでは、前後方向の位置に対する推定精度が低下する。したがって、オドメトリで自己位置を推定する技術では、直線路から進入したカーブ路で自己位置を推定する際に、自己位置の推定精度が低下するという問題が発生するおそれがある。【０００５】
本発明は、上記のような問題点に着目してなされたもので、カーブ路における自己位置の推定精度低下を抑制することが可能な、自己位置推定装置及び自己位置推定方法を提供することを目的とする。
【課題を解決するための手段】
【０００６】
上記課題を解決するために、本発明の一態様は、自車両の周囲に存在する物標と自車両との相対位置を検出し、自車両の移動量と、自車両が走行する走行路のカーブ開始位置を推定する。さらに、検出した相対位置を推定した移動量だけ移動させて、物標位置データとして蓄積する。また、地図上に存在する物標の物標位置情報を含む地図情報を取得する。
これに加え、蓄積した物標位置データのうち少なくとも自車両の周囲に存在する物標位置データ、及び自車両の現在位置から推定したカーブ開始位置までの間に存在する物標位置データと、地図情報に含まれる物標位置情報とを照合して、自己位置を推定する。
【発明の効果】
【０００７】
本発明の一態様によれば、自車両が直線路からカーブ路へ進入しても、カーブの形状に沿った物標位置データを用いて、自己位置を推定する。なお、カーブの形状に沿った物標位置データは、少なくとも自車両の周囲に存在する物標位置データ及び自車両の現在位置からカーブ路開始位置までの間に存在するデータである。
これにより、カーブ路における自己位置の推定を、少なくとも自車両の周囲の走路に沿った物標位置データ及びカーブの形状に沿った物標位置データで行うことが可能となる。このため、カーブ路における自己位置の推定精度低下を抑制することが可能な自己位置推定装置及び自己位置推定方法を提供することが可能となる。
【図面の簡単な説明】
【０００８】
【図１】本発明の第一実施形態の自己位置推定装置の構成を表すブロック図である。
【図２】本発明の第一実施形態の自己位置推定装置を搭載した車両の構成を表す図である。
【図３】カーブ開始位置と、データ選択処理の説明図である。
【図４】データ選択処理の説明図である。
【図５】データ選択処理の説明図である。
【図６】データ照合処理の説明図である。
【図７−１】本発明の第一実施形態の自己位置推定装置が行う処理を表すフローチャートである。
【図７−２】本発明の第一実施形態の自己位置推定装置が行う処理を表すフローチャートである。
【図８−１】本発明の第二実施形態の自己位置推定装置が行う処理を表すフローチャートである。
【図８−２】本発明の第二実施形態の自己位置推定装置が行う処理を表すフローチャートである。
【発明を実施するための形態】
【０００９】
以下の詳細な説明では、本発明の実施形態について、完全な理解を提供するように、特定の細部について記載する。しかしながら、かかる特定の細部が無くとも、一つ以上の実施形態が実施可能であることは明確である。また、図面を簡潔なものとするために、周知の構造及び装置を、略図で表す場合がある。
【００１０】
（第一実施形態）
以下、本発明の第一実施形態について、図面を参照しつつ説明する。
（自己位置推定装置の構成）
図１から図６を用いて、第一実施形態の自己位置推定装置１の構成を説明する。
図１中に表すように、自己位置推定装置１は、物標位置検出部１０と、移動量推定部２０と、物標位置蓄積部３０と、地図情報取得部４０と、カーブ開始位置推定部５０と、自己位置推定部６０を備える。
物標位置検出部１０は、例えば、図２中に表すように、広角カメラ等の撮像装置２や、レーザーレンジファインダ（ＬＲＦ）等の距離測定装置４を用いて形成する。
撮像装置２は、図２中に表すように、自己位置推定装置１を備える車両（以降の説明では、「自車両」と記載する場合がある）に搭載する。また、撮像装置２は、自車両ＭＣの車室内に取り付けて、自車両ＭＣの前方領域を撮像する。
【００１１】
距離測定装置４は、図２中に表すように、自車両ＭＣの車室外に取り付けて、自車両ＭＣに搭載する。また、距離測定装置４は、自車両ＭＣの前方領域に電磁波を照射し、その反射波を検出する。なお、距離測定装置４を取り付ける位置は、例えば、ボンネット、バンパー、ナンバープレート、ヘッドライト、サイドミラー周辺である。
また、物標位置検出部１０は、撮像装置２や距離測定装置４により、自車両ＭＣの周囲、特に、自車両ＭＣの前方に存在する物標を検出する。さらに、物標位置検出部１０は、物標と自車両ＭＣとの相対位置を検出する。物標と自車両ＭＣとの相対位置を検出した物標位置検出部１０は、検出した相対位置を含む情報信号（以降の説明では、「相対位置信号」と記載する場合がある）を、物標位置蓄積部３０へ出力する。
【００１２】
ここで、物標とは、例えば、自車両ＭＣが走行する走行路面ＲＯ上の線（車線区分線等）や、路肩の縁石、ガードレール等である。
以上により、物標位置検出部１０は、自車両ＭＣに搭載し、自車両ＭＣの周囲に存在する物標と自車両ＭＣとの相対位置を検出する。
移動量推定部２０は、例えば、車輪速センサ６、操舵角センサ８、ジャイロセンサ（図示せず）等のセンサを用いて形成する。
車輪速センサ６は、図２中に表すように、自車両ＭＣに搭載する。また、車輪速センサ６は、自車両ＭＣが備える車輪Ｗの一回転について、予め設定した数の車輪速パルスを発生させる。
【００１３】
操舵角センサ８は、例えば、ステアリングホイール（図示せず）を回転可能に支持するステアリングコラム（図示せず）に設けて、図２中に表すように、自車両ＭＣに搭載する。また、操舵角センサ８は、操舵操作子であるステアリングホイールの現在の回転角度（操舵操作量）である現在操舵角を検出する。
ジャイロセンサは、自車両ＭＣに搭載し、自車両ＭＣに発生するヨーレートを検出する。
また、移動量推定部２０は、各センサが検出したパラメータを用いて、前回処理周期からの自車両ＭＣの移動量ΔＰを推定する。自車両ＭＣの移動量ΔＰを推定した移動量推定部２０は、推定した移動量ΔＰを含む情報信号（以降の説明では、「移動量信号」と記載する場合がある）を、物標位置蓄積部３０へ出力する。
以上により、移動量推定部２０は、自車両ＭＣに搭載し、自車両ＭＣの移動量を推定する。
【００１４】
物標位置蓄積部３０は、物標位置検出部１０から自車両ＭＣの周囲に存在する物標の相対位置信号の入力を受け、移動量推定部２０から移動量信号の入力を受ける。
そして、物標位置蓄積部３０は、自車両ＭＣの周囲に存在する物標の相対位置信号が含む相対位置を蓄積するとともに、過去に蓄積した物標の相対位置を、現在までの経過時間と、移動量信号が含む移動量を用いて、現在の自車両ＭＣに対する相対位置へ補正する。さらに、物標位置蓄積部３０は、補正した相対位置である物標位置のデータ（以降の説明では、「物標位置データ」と記載する場合がある）として蓄積する。
また、物標位置蓄積部３０は、既に物標位置データを蓄積している場合には、蓄積している物標位置データを、移動量信号が含む移動量を用いて更新する。
【００１５】
物標位置データの更新は、既に蓄積している物標位置データが含む相対位置を、移動量信号が含む移動量ΔＰ分だけ相対移動させる。これに加え、移動量ΔＰ分だけ相対移動させた相対位置を、蓄積している物標位置データに上書きして、物標位置データの更新を行う。
以上により、物標位置蓄積部３０は、自車両ＭＣに搭載する。また、物標位置蓄積部３０は、物標位置検出部１０が検出した相対位置のデータを蓄積する。これに加え、物標位置蓄積部３０は、過去に蓄積した物標の相対位置のデータを、移動量推定部２０が推定した現在までの経過時間の移動量ΔＰだけ自車両ＭＣの移動方向と逆方向に移動させて、物標位置データとして蓄積する。
【００１６】
地図情報取得部４０は、自車両ＭＣに搭載し、地図データと、地図データ上に存在する物標の位置情報を取得する。例えば、地図情報取得部４０は、カーナビゲーションシステムや地図データベース等である。
なお、地図情報取得部４０は、無線通信（路車間通信、または、車車間通信でも可）等の通信システムを介して外部から地図情報を取得しても良い。この場合、地図情報取得部４０は、定期的に最新の地図情報を入手して、保有する地図情報を更新しても良い。また、地図情報取得部４０は、自車が実際に走行した走路を、地図情報として蓄積しても良い。
以上により、地図情報取得部４０は、地図上に存在する物標の物標位置情報を含む地図情報を取得する。
【００１７】
カーブ開始位置推定部５０は、自車両ＭＣが走行している走行路が、カーブ区間であるか否かを判定する。自車両ＭＣが走行している走行路がカーブ区間であるか否かを判定したカーブ開始位置推定部５０は、判定結果を含む情報信号（以降の説明では、「判定結果信号」と記載する場合がある）を、自己位置推定部６０へ出力する。
これに加え、カーブ開始位置推定部５０は、自車両ＭＣが走行している走行路がカーブ区間であると判定すると、カーブ区間の開始位置（以降の説明では、「カーブ開始位置」と記載する場合がある）を推定する。
【００１８】
ここで、カーブ開始位置は、図３中に表すように、自車両ＭＣが走行している走行路において、走行路が直線区間からカーブ区間へ変化する位置である。また、図３中では、カーブ開始位置を符号「Ｃ０」で表す。また、図３中では、自車両ＭＣの重心を、符号「ＣＧ」で表す。
カーブ開始位置Ｃ０を推定したカーブ開始位置推定部５０は、推定したカーブ開始位置Ｃ０を含む情報信号（以降の説明では、「カーブ開始位置信号」と記載する場合がある）を、自己位置推定部６０へ出力する。
カーブ開始位置推定部５０が、自車両ＭＣが走行している走行路がカーブ区間であるか否かを判定する処理（カーブ区間判定処理）としては、例えば、以下のカーブ区間判定処理ＡＩ〜ＡＩＩＩのうち、少なくとも一つの処理を用いる。
【００１９】
（カーブ区間判定処理ＡＩ）
操舵角センサ８が検出した現在操舵角の絶対値が、予め設定した操舵角閾値未満から操舵角閾値以上となると、自車両ＭＣが走行している走行路が、カーブ区間であると判定する。
（カーブ区間判定処理ＡＩＩ）
ジャイロセンサが検出したヨーレートの絶対値が、予め設定したヨーレート閾値未満からヨーレート閾値以上となると、自車両ＭＣが走行している走行路が、カーブ区間であると判定する。
（カーブ区間判定処理ＡＩＩＩ）
地図情報取得部４０が取得した地図データに、前回の処理で自己位置推定部６０が推定した自己位置を入力する。そして、前回の処理で自己位置推定部６０が推定した自己位置が、地図データのカーブ区間上である場合に、自車両ＭＣが走行している走行路が、カーブ区間であると判定する。
以上により、カーブ開始位置推定部５０は、自車両ＭＣに搭載し、自車両ＭＣが走行する走行路のカーブ開始位置Ｃ０を推定する。
【００２０】
自己位置推定部６０は、物標位置蓄積部３０が蓄積している物標位置データから、自車両ＭＣの現在位置（自己位置）の推定に用いる物標位置データを選択する。なお、以降の説明では、自己位置の推定に用いるために選択した物標位置データを、「選択済物標位置データ」と記載する場合がある。また、自己位置の推定に用いる物標位置データを選択する処理の説明は、後述する。
さらに、自己位置推定部６０は、選択済物標位置データを、地図情報取得部４０が取得した物標の位置情報と照合することにより、自己位置を推定する。なお、選択済物標位置データを、地図情報取得部４０が取得した物標位置情報と照合する処理の説明は、後述する。
【００２１】
第一実施形態では、自己位置推定部６０の構成を、自車両ＭＣの周囲に存在する物標位置データ、及び自車両ＭＣの現在位置からカーブ路開始位置までの間の物標位置データを用いて自己位置を推定する構成とした場合について説明する。
ここで、自己位置の推定は、自車両ＭＣが直進走行した距離である直進走行距離ＬＳが、予め設定した推定用閾値距離ＬＳ０（例えば、ＬＳ０＝１００［ｍ］）以上の場合に行う。なお、直進走行距離ＬＳを算出する処理の説明は、後述する。
自己位置を推定した自己位置推定部６０は、推定した自己位置を含む情報信号（以降の説明では、「自己位置信号」と記載する場合がある）を、図２中に表すように、運転支援システム１００へ出力する。
運転支援システム１００は、公知のシステムであり、自車両ＭＣに搭載する。
また、運転支援システム１００は、自己位置推定装置１から入力を受けた自己位置信号が含む自己位置を用いて、自車両ＭＣの運転者に対する警報等の情報提供や、自車両ＭＣの制動等の運転支援を行う。また、運転支援システム１００の構成は公知技術であるため、説明は省略する。
【００２２】
（直進走行距離ＬＳを算出する処理）
以下、図１から図３を参照して、自己位置推定部６０が、直進走行距離ＬＳを算出する処理（直進走行距離算出処理）について説明する。
直進走行距離算出処理では、まず、自車両ＭＣが直進走行中であるか否かを判定する。そして、自車両ＭＣが直進走行中であると判定した時点から、走行距離のカウントを開始し、自車両ＭＣが直進走行中ではないと判定した時点で、走行距離のカウントを停止する。さらに、カウントの開始から停止までに自車両ＭＣが移動した距離を、直進走行距離ＬＳとして算出する。
自己位置推定部６０が、自車両ＭＣが直進走行中であるか否かを判定する処理（直進走行判定処理）としては、例えば、以下の直進走行判定処理Ｉ〜ＩＩＩのうち、少なくとも一つの処理を用いる。
【００２３】
（直進走行判定処理Ｉ）
操舵角センサ８が検出した現在操舵角の絶対値が、操舵角閾値未満である場合に、自車両ＭＣが直進走行中であると判定する。
（直進走行判定処理ＩＩ）
ジャイロセンサが検出したヨーレートの絶対値が、予め設定したヨーレート閾値未満であると、自車両ＭＣが直進走行中であると判定する。
【００２４】
（直進走行判定処理ＩＩＩ）
地図情報取得部４０が取得した地図データに、前回の処理で自己位置推定部６０が推定した自己位置を入力する。そして、前回の処理で自己位置推定部６０が推定した自己位置が、地図データの直線区間上である場合に、自車両ＭＣが直進走行中であると判定する。例えば、直線区間は、地図データに含まれる道路区間の曲率が１０００Ｒ以上など、所定の閾値を設けて、判定することが可能である。また、地図データのノード点を曲線近似することで、道路区間の曲率を推定しても良い。
なお、操舵角センサ８が検出した操舵角の絶対値や、ジャイロセンサが検出したヨーレートの絶対値は、例えば、操舵角センサ８やジャイロセンサから取得する。また、操舵角センサ８が検出した操舵角の絶対値や、ジャイロセンサが検出したヨーレートの絶対値は、例えば、移動量推定部２０から取得してもよい。
【００２５】
（自己位置の推定に用いる物標位置データを選択する処理）
以下、図１から図３を参照しつつ、図４及び図５を用いて、自己位置推定部６０が、物標位置蓄積部３０が蓄積している物標位置データから、自己位置の推定に用いる物標位置データを選択する処理（データ選択処理）について説明する。
データ選択処理では、まず、以下の条件ＢＩ〜ＢＩＩＩが成立しているか否かを判定する。
【００２６】
（条件ＢＩ）
カーブ開始位置推定部５０が推定したカーブ開始位置Ｃ０の直前の直進走行距離ＬＳが推定用閾値距離ＬＳ０以上である。または、カーブ開始位置推定部５０が推定したカーブ開始位置Ｃ０の直前の直進走行中に移動速度が移動速度閾値以下である。
なお、直進走行距離ＬＳは、上述した（直進走行距離ＬＳを算出する処理）にて算出される。
（条件ＢＩＩ）
自車両ＭＣと、カーブ開始位置推定部５０が推定したカーブ開始位置Ｃ０との距離が、予め設定した第一閾値距離Ｌ１（例えば、Ｌ１＝１００［ｍ］）以下である。
ここで、第一閾値距離Ｌ１は、例えば、移動量推定部２０が推定する移動量の蓄積される誤差が許容できる距離範囲から設定する。
【００２７】
（条件ＢＩＩＩ）
自車両ＭＣと、カーブ開始位置推定部５０が推定したカーブ開始位置Ｃ０との距離が、予め設定した第二閾値距離Ｌ２（例えば、Ｌ２＝２０［ｍ］）以上である。
そして、上記の各条件のうち、条件ＢＩ、条件ＢＩＩ及び条件ＢＩＩＩの全てが成立している場合、物標位置蓄積部３０が蓄積している物標位置データから、自車両ＭＣの周囲に存在する物標位置データを選択する。これに加え、物標位置蓄積部３０が蓄積している物標位置データから、自車両ＭＣの現在位置からカーブ開始位置Ｃ０までの間の物標位置データを選択する。
【００２８】
すなわち、物標位置蓄積部３０が蓄積している物標位置データから、図３中に表すように、自車両ＭＣの周囲及び自車両ＭＣの現在位置からカーブ開始位置Ｃ０までの間の領域Ｒ１内に存在する物標位置データのみを、選択済物標位置データとして選択する。
なお、図３中では、自車両ＭＣの進行方向でカーブ開始位置Ｃ０よりも前に、相対位置を検出した選択済物標位置データを、符号「Ｅｉ」で表す。同様に、図３中では、自車両ＭＣの進行方向で自車両ＭＣの現在位置からカーブ開始位置Ｃ０までの間に、相対位置を検出した選択済物標位置データを、符号「Ｓｉ」で表す。
【００２９】
また、上記の各条件のうち、条件ＢＩ及び条件ＢＩＩのみが成立している場合、物標位置蓄積部３０が蓄積している物標位置データから、自車両ＭＣとの相対距離が第二閾値距離Ｌ２以下の領域に存在する物標位置データを選択する。
なお、第二閾値距離Ｌ２は、物標位置蓄積部３０が蓄積した物標位置データのうち、自車両ＭＣの現在位置からカーブ開始位置推定部５０が推定したカーブ開始位置Ｃ０までの間に存在する物標位置データを含めた距離である。
すなわち、物標位置蓄積部３０が蓄積している物標位置データから、図４中に表すように、自車両ＭＣが走行済みの領域内で、自車両ＭＣから第二閾値距離Ｌ２以下の領域Ｒ２内に存在する物標位置データを、選択済物標位置データとして選択する。第二閾値距離Ｌ２は、地図情報取得部４０が取得した物標の位置情報と照合して、自己位置を推定するために必要な物標位置データを最低限に確保できる距離範囲として設定する。
【００３０】
なお、図４中では、自車両ＭＣが走行済みの領域内で、自車両ＭＣから第二閾値距離Ｌ２を超える領域Ｒ２内に存在する選択済物標位置データを、符号「Ｅｉ」で表す。同様に、図４中では、自車両ＭＣが走行済みの領域内で、自車両ＭＣから第二閾値距離Ｌ２以下の領域Ｒ２内に存在する選択済物標位置データを、符号「Ｓｉ」で表す。また、図４中では、領域Ｒ２を、自車両ＭＣの重心ＣＧから第二閾値距離Ｌ２以下の領域とする。
また、上記の各条件のうち、条件ＢＩのみが成立している場合、物標位置蓄積部３０が蓄積している物標位置データから、自車両ＭＣとの相対距離が、予め設定した第三閾値距離Ｌ３以下の領域に存在する物標位置データを選択する。また、上記の各条件が成立していない場合も同様に、物標位置蓄積部３０が蓄積している物標位置データから、自車両ＭＣとの相対距離が第三閾値距離Ｌ３以下の領域に存在する物標位置データを選択する。
【００３１】
ここで、第三閾値距離Ｌ３は、地図情報取得部４０が取得した物標の位置情報と照合して、自己位置を推定するために必要な物標位置データを十分に確保できる距離範囲として設定する。すなわち、第三閾値距離Ｌ３は、例えば、第一閾値距離Ｌ１未満の距離であるとともに、第二閾値距離Ｌ２よりも大きい距離に設定（Ｌ１＞Ｌ３＞Ｌ２）することが可能である。
なお、第三閾値距離Ｌ３は、物標位置蓄積部３０が蓄積した物標位置データのうち、自車両ＭＣの現在位置からカーブ開始位置推定部５０が推定したカーブ開始位置Ｃ０までの間に存在する物標位置データを含めた距離である。
【００３２】
すなわち、物標位置蓄積部３０が蓄積している物標位置データから、図５中に表すように、自車両ＭＣが走行済みの領域内で、自車両ＭＣから第三閾値距離Ｌ３以下の領域Ｒ３内に存在する物標位置データを、選択済物標位置データとして選択する。
なお、図５中では、自車両ＭＣが走行済みの領域内で、自車両ＭＣから第三閾値距離Ｌ３を超える領域Ｒ３内に存在する選択済物標位置データを、符号「Ｅｉ」で表す。同様に、図５中では、自車両ＭＣが走行済みの領域内で、自車両ＭＣから第三閾値距離Ｌ３以下の領域Ｒ３内に存在する選択済物標位置データを、符号「Ｓｉ」で表す。また、図５中では、領域Ｒ３を、自車両ＭＣの重心ＣＧから第三閾値距離Ｌ３以下の領域とする。
【００３３】
（選択済物標位置データを、地図情報取得部４０が取得した物標の位置情報と照合する処理）
以下、図１から図５を参照しつつ、図６を用いて、自己位置推定部６０が、選択済物標位置データを、地図情報取得部４０が取得した物標の位置情報と照合する処理（データ照合処理）について説明する。
データ照合処理では、データ選択処理で選択した選択済物標位置データを、地図情報取得部４０が取得した物標の位置情報と照合する。
具体的には、図６中に示すように、選択済物標位置データのうち、選択した一つの選択済物標位置データＳｉと、地図情報取得部４０が取得した物標の位置情報のうち、一つの選択済物標位置データＳｉに最も近い位置情報Ｍｊとの距離Ｄｉｊを算出する。したがって、選択済物標位置データＳｉと位置情報Ｍｊは、同じ領域（Ｒ１、Ｒ２、Ｒ３）内に存在する。
また、距離Ｄｉｊの算出は、選択済物標位置データの全てに対して行う。
さらに、距離Ｄｉｊの平均Ｓを、以下の式（１）を用いて算出する。
【００３４】
【数１】
2017017705.tif 000003
【００３５】
なお、式（１）中の「Ｎ」は、データ選択処理で選択した選択済物標位置データの数である。
そして、数値解析により、平均Ｓが最小となる自車両ＭＣの位置及び姿勢を算出して、算出した自車両ＭＣの位置及び姿勢を、自己位置の推定値とする。
以上説明したように、自己位置推定部６０は、自車両ＭＣの周囲に存在する物標位置データ及び自車両ＭＣの現在位置からカーブ開始位置Ｃ０までの間に存在する選択済物標位置データと、地図データ情報に含まれる物標位置情報を照合して、自己位置を推定する。また、自己位置推定部６０は、自車両ＭＣに搭載する。
【００３６】
これに加え、自己位置推定部６０は、物標位置蓄積部３０に蓄積した物標位置データのうち、自車両ＭＣの走行経路を閾値距離（第二閾値距離Ｌ２、第三閾値距離Ｌ３）で遡った範囲（領域Ｒ２、Ｒ３）内に存在する物標位置データを選択する。さらに、自己位置推定部６０は、地図情報取得部４０が取得した物標位置情報のうち、自車両ＭＣの走行経路を閾値距離で遡った範囲内に存在する物標の位置と、選択済物標位置データと、を照合して、自己位置を推定する。
【００３７】
（動作）
図１から図６を参照しつつ、図７−１及び図７−２を用いて、第一実施形態の自己位置推定装置１を用いて行なう動作の一例を説明する。
図７−１及び図７−２中に表すように、自己位置推定装置１を用いて行なう動作を開始（ＳＴＡＲＴ）すると、まず、ステップＳ１００の処理を行う。
ステップＳ１００では、物標位置検出部１０により、自車両ＭＣの前方を含む自車両ＭＣの周囲に存在する物標を検出し、検出した物標と自車両ＭＣとの相対位置を検出（図中に表す「物標位置検出」）する。ステップＳ１００において、物標と自車両ＭＣとの相対位置を検出すると、自己位置推定装置１を用いて行なう動作は、ステップＳ１０２へ移行する。
【００３８】
ステップＳ１０２では、移動量推定部２０により、前回処理周期からの自車両ＭＣの移動量ΔＰを推定（図中に表す「移動量推定」）する。ステップＳ１０２において、自車両ＭＣの移動量ΔＰを推定すると、自己位置推定装置１を用いて行なう動作は、ステップＳ１０４へ移行する。
ステップＳ１０４では、物標位置蓄積部３０が、ステップＳ１００で検出した相対位置を、ステップＳ１０２で推定した自車両ＭＣの移動量を用いて補正する。さらに、ステップＳ１０４では、物標位置蓄積部３０が、物標位置データを蓄積（図中に表す「物標位置情報蓄積」）する。ステップＳ１０４において、物標位置データを蓄積すると、自己位置推定装置１を用いて行なう動作は、ステップＳ１０６へ移行する。
【００３９】
ステップＳ１０６では、カーブ開始位置推定部５０により、自車両ＭＣが走行している走行路が、カーブ区間であるか否かを判定する。これにより、ステップＳ１０６では、自車両ＭＣが、カーブ区間の走行を開始したか否かを判定する処理（図中に表す「カーブ開始」）を行う。
ステップＳ１０６において、自車両ＭＣがカーブ区間の走行を開始した（図中に表す「Ｙｅｓ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１０８へ移行する。
【００４０】
一方、ステップＳ１０６において、自車両ＭＣがカーブ区間の走行を開始していない（図中に表す「Ｎｏ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１２２へ移行する。
ステップＳ１０８では、カーブ開始位置推定部５０により、カーブ開始位置Ｃ０を推定（図中に表す「カーブ開始位置Ｃ０推定」）する。ステップＳ１０８において、カーブ開始位置Ｃ０を推定すると、自己位置推定装置１を用いて行なう動作は、ステップＳ１１０へ移行する。
【００４１】
ステップＳ１１０では、自己位置推定部６０により、カーブ開始位置Ｃ０の直前の直進走行距離ＬＳが推定用閾値距離ＬＳ０以上であるか否かを判定する処理（図中に表す「カーブ開始位置の直前の直進走行距離が推定用閾値距離以上」）を行う。
ステップＳ１１０において、カーブ開始位置Ｃ０の直前の直進走行距離ＬＳが推定用閾値距離ＬＳ０以上である（図中に表す「Ｙｅｓ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１１４へ移行する。
一方、ステップＳ１１０において、カーブ開始位置Ｃ０の直前の直進走行距離ＬＳが推定用閾値距離ＬＳ０未満である（図中に表す「Ｎｏ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１１２へ移行する。
【００４２】
ステップＳ１１２では、自己位置推定部６０により、カーブ開始位置Ｃ０の直前の直進走行区間での移動速度ＶＰが、予め設定した閾値速度ＶＰ０（例えば、ＶＰ０＝１．４［ｍ／ｓｅｃ］）以下であるか否かを判定する処理を行う。すなわち、ステップＳ１１２では、図中に表す「カーブ開始位置の直前の直進走行区間での移動速度が閾値速度以下」であるか否かを判定する処理を行う。なお、移動速度は、車速であってもよい。この場合、閾値速度ＶＰ０は、例えば、５［ｋｍ／ｈ］と設定することが可能である。
ステップＳ１１２において、カーブ開始位置Ｃ０の直前の直進走行区間での移動速度ＶＰが閾値速度ＶＰ０以下である（図中に表す「Ｙｅｓ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１１４へ移行する。
【００４３】
一方、ステップＳ１１２において、カーブ開始位置Ｃ０の直前の直進走行区間での移動速度ＶＰが閾値速度ＶＰ０を超えている（図中に表す「Ｎｏ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１２２へ移行する。
ステップＳ１１４では、自己位置推定部６０により、上記の条件ＢＩＩが成立しているか否かを判定する処理を行う。すなわち、ステップＳ１１４では、自車両ＭＣとカーブ開始位置Ｃ０との距離Ｌ（図３参照）が、第一閾値距離Ｌ１以下であるか否かを判定する処理（図中に表す「カーブ開始位置から第一閾値距離以下」）を行う。なお、自車両ＭＣとカーブ開始位置Ｃ０との距離Ｌは、具体的には、自車両ＭＣの重心ＣＧとカーブ開始位置Ｃ０との距離Ｌである。
【００４４】
ステップＳ１１４において、自車両ＭＣとカーブ開始位置Ｃ０との距離Ｌが第一閾値距離Ｌ１以下である（図中に表す「Ｙｅｓ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１１６へ移行する。
一方、ステップＳ１１４において、自車両ＭＣとカーブ開始位置Ｃ０との距離Ｌが第一閾値距離Ｌ１を超えている（図中に表す「Ｎｏ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１２２へ移行する。
ステップＳ１１６では、自己位置推定部６０により、上記の条件ＢＩＩＩが成立しているか否かを判定する処理を行う。すなわち、ステップＳ１１６では、自車両ＭＣとカーブ開始位置Ｃ０との距離Ｌ（図３参照）が、第二閾値距離Ｌ２以上であるか否かを判定する処理（図中に表す「カーブ開始位置から第二閾値距離以上」）を行う。
ステップＳ１１６において、自車両ＭＣとカーブ開始位置Ｃ０との距離Ｌが第二閾値距離Ｌ２以上である（図中に表す「Ｙｅｓ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１１８へ移行する。
【００４５】
一方、ステップＳ１１６において、自車両ＭＣとカーブ開始位置Ｃ０との距離Ｌが第二閾値距離Ｌ２未満である（図中に表す「Ｎｏ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１２０へ移行する。
ステップＳ１１８では、自己位置推定部６０により、カーブ開始位置Ｃ０と自車両ＭＣとの間の領域Ｒ１内に存在する物標位置データを、選択済物標位置データＳｉとして選択する（図３参照）。すなわち、ステップＳ１１８では、選択済物標位置データＳｉとして、自車両ＭＣの周囲に存在する物標位置データ及び自車両ＭＣの現在位置からカーブ開始位置Ｃ０までの間の領域Ｒ１内に存在する物標位置データを選択する。したがって、ステップＳ１１８では、図中に表す「自車両からカーブ開始位置までの間の物標情報を選択」する処理を行う。ステップＳ１１８において、領域Ｒ１内に存在する物標位置データを選択済物標位置データＳｉとして選択すると、自己位置推定装置１を用いて行なう動作は、ステップＳ１２４へ移行する。
【００４６】
ステップＳ１２０では、自己位置推定部６０により、自車両ＭＣとの相対距離が第二閾値距離Ｌ２以下の領域Ｒ２内に存在する物標位置データを、選択済物標位置データＳｉとして選択する（図４参照）。すなわち、ステップＳ１２０では、選択済物標位置データＳｉとして、自車両ＭＣとの相対距離が第二閾値距離Ｌ２以下の領域Ｒ２内に存在する物標位置データを選択（図中に表す「自車両との距離がＬ２以下の物標情報を選択」）する。ステップＳ１２０において、領域Ｒ２内に存在する物標位置データを選択済物標位置データＳｉとして選択すると、自己位置推定装置１を用いて行なう動作は、ステップＳ１２４へ移行する。
【００４７】
ステップＳ１２２では、自己位置推定部６０により、自車両ＭＣとの相対距離が第三閾値距離Ｌ３以下の領域Ｒ３内に存在する物標位置データを、選択済物標位置データＳｉとして選択する（図５参照）。すなわち、ステップＳ１２２では、選択済物標位置データＳｉとして、自車両ＭＣとの相対距離が第三閾値距離Ｌ３以下の領域Ｒ３内に存在する物標位置データを選択（図中に表す「自車両との距離がＬ３以下の物標情報を選択」）する。ステップＳ１２２において、領域Ｒ３内に存在する物標位置データを選択済物標位置データＳｉとして選択すると、自己位置推定装置１を用いて行なう動作は、ステップＳ１２４へ移行する。
【００４８】
ステップＳ１２４では、自己位置推定部６０により、ステップＳ１１８、Ｓ１２０、Ｓ１２２のうちいずれか一つのステップで選択した選択済物標位置データＳｉを、地図情報取得部４０が取得した物標の位置情報と照合する。これにより、ステップＳ１２４では、ステップＳ１１８、Ｓ１２０、Ｓ１２２のうちいずれか一つのステップで選択した選択済物標位置データＳｉを用いて、自己位置を推定（図中に表す「自己位置推定」）する。ステップＳ１２４において、自己位置を推定すると、自己位置推定装置１を用いて行なう動作は、ステップＳ１２６へ移行する。
【００４９】
ステップＳ１２６では、自車両ＭＣのイグニッションスイッチ（図示せず）が停止状態であるか否かを判定する処理（図中に表す「ＩＧＮ  ＯＦＦ」）を行う。
ステップＳ１２６において、自車両ＭＣのイグニッションスイッチが停止状態である（図中に表す「Ｙｅｓ」）と判定した場合、自己位置推定装置１を用いて行なう動作を終了（ＥＮＤ）する。
一方、ステップＳ１２６において、自車両ＭＣのイグニッションスイッチが停止状態ではない（図中に表す「Ｎｏ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１００へ復帰する。
【００５０】
上述したように、第一実施形態の自己位置推定装置１の動作で実施する自己位置推定方法では、自車両ＭＣの周囲に存在する物標と自車両ＭＣとの相対位置を検出し、自車両ＭＣの移動量と、自車両ＭＣが走行する走行路のカーブ開始位置Ｃ０を推定する。そして、物標位置データのうち自車両ＭＣの周囲に存在する物標位置データ及び自車両ＭＣの現在位置から推定したカーブ開始位置Ｃ０までの間に存在する物標位置データと、地図データに含まれる物標位置情報とを照合して、自己位置を推定する。
なお、上述した第一実施形態は、本発明の一例であり、本発明は、上述した第一実施形態に限定されることはなく、この実施形態以外の形態であっても、本発明に係る技術的思想を逸脱しない範囲であれば、設計等に応じて種々の変更が可能である。
【００５１】
（第一実施形態の効果）
第一実施形態の自己位置推定装置１であれば、以下に記載する効果を奏することが可能となる。
（１）カーブ開始位置推定部５０が、自車両ＭＣが走行する走行路のカーブ開始位置Ｃ０を推定する。これに加え、自己位置推定部６０が、自車両ＭＣの周囲に存在する物標位置データ及び自車両ＭＣの現在位置からカーブ開始位置Ｃ０までの間に存在する物標位置データと、地図情報に含まれる物標位置情報とを照合して、自己位置を推定する。
このため、自車両ＭＣが直線路からカーブ路へ進入しても、カーブの形状に沿った物標位置データを用いて、自己位置を推定することとなる。ここで、カーブの形状に沿った物標位置データは、自車両ＭＣの周囲に存在する物標位置データ及び自車両ＭＣの現在位置からカーブ路開始位置Ｃ０までの間に存在するデータである。
その結果、カーブ路における自己位置の推定を、カーブの形状に沿った物標位置データで行うため、カーブ路における自己位置の推定精度低下を抑制することが可能となる。
【００５２】
（２）自己位置推定部６０が、自車両ＭＣが直進走行した距離である直進走行距離ＬＳが、予め設定した推定用閾値距離ＬＳ０以上の場合に、自己位置を推定する。
このため、直線走行距離ＬＳが推定用閾値距離ＬＳ０以上の場合に、自車両ＭＣの周囲に存在する物標位置データ及び自車両ＭＣの現在位置からカーブ開始位置Ｃ０までの間に存在する物標の位置を用いて、自己位置を推定する。
その結果、カーブ路の直前の直線路の走行距離が長かった場合、すなわち、オドメトリの誤差が蓄積しやすい走行があった場合でも、カーブの形状に沿った物標位置データで自己位置を推定することが可能となる。これにより、カーブ路における自己位置の推定精度低下を抑制することが可能となる。
【００５３】
（３）自己位置推定部６０が、自車両ＭＣが閾値速度以下の移動速度（車速）で走行した場合に、自己位置を推定する。
このため、自車両ＭＣが閾値速度以下の移動速度（車速）で走行した場合に、自車両ＭＣの周囲に存在する物標位置データ及び自車両ＭＣの現在位置からカーブ開始位置Ｃ０までの間に存在する物標の位置を用いて自己位置を推定することが可能となる。
その結果、停止や発進等、極低速の走行後、すなわち、オドメトリの誤差が蓄積しやすい走行後であっても、カーブ路における自己位置の推定精度低下を抑制することが可能となる。
【００５４】
（４）自己位置推定部６０が、自車両ＭＣの走行経路を閾値距離で遡った範囲内に存在する物標位置データと、地図情報に含まれている物標位置情報を照合して、自己位置を推定する。
このため、自車両ＭＣの走行経路を閾値距離で遡った範囲内に存在する物標位置データと、地図情報に含まれている物標位置情報を用いて、自己位置を推定する。ここで、自車両ＭＣの走行経路を閾値距離で遡った範囲内に存在する物標位置データには、自車両ＭＣの周囲に存在する物標位置データ及び自車両ＭＣの現在位置からカーブ開始位置Ｃ０までに間に存在する物標を含む。
【００５５】
その結果、直線路からカーブ路への進入時や、直線路からカーブ路への進入直後であっても、必要最低限の閾値距離の範囲内に存在する物標位置データを用いて自己位置を推定することが可能となる。ここで、必要最低限の閾値距離の範囲内に存在する物標位置データは、自車両ＭＣの周囲に存在する物標位置データ及び自車両ＭＣの現在位置からカーブ開始位置Ｃ０までの間に存在する物標を含む。これにより、カーブの形状に沿った物標位置データを含めて自己位置を推定することが可能となるため、カーブ路における自己位置の推定精度低下を抑制することが可能となる。
【００５６】
（５）自己位置推定部６０が、自車両ＭＣの周囲に存在する物標位置データ及び自車両ＭＣの現在位置からカーブ開始位置推定部５０が推定したカーブ開始位置Ｃ０まので間のみに存在する物標位置データと、地図情報に含まれている物標位置情報とを照合する。そして、自己位置を推定する。この推定は、上記の各条件のうち、条件ＢＩ、条件ＢＩＩ及び条件ＢＩＩＩが全て成立している場合に行う。
このため、自車両ＭＣが直線路からカーブ路へ進入しても、直線路で検出したデータを用いずに、カーブの形状に沿った物標位置データを用いて、自己位置を推定することとなる。ここで、カーブの形状に沿った物標位置データは、自車両ＭＣの周囲に存在する物標位置データおよび自車両ＭＣの現在位置からカーブ路開始位置Ｃ０までの間に存在する物標位置データである。
その結果、カーブ路における自己位置の推定を、カーブの形状に沿った物標位置データのみで行うため、カーブ路における自己位置の推定精度低下を抑制することが可能となる。
【００５７】
（６）第一実施形態の自己位置推定装置１の動作で実施する自己位置推定方法では、自車両ＭＣの周囲に存在する物標と自車両ＭＣとの相対位置を検出し、自車両ＭＣの移動量と、自車両ＭＣが走行する走行路のカーブ開始位置Ｃ０を推定する。そして、物標位置データのうち、自車両ＭＣの周囲に存在する物標位置データ及び自車両ＭＣの現在位置から推定したカーブ開始位置Ｃ０までの間に存在する物標位置データと、地図データに含まれている物標位置情報とを照合して、自己位置を推定する。
このため、自車両ＭＣが直線路からカーブ路へ進入しても、カーブの形状に沿った物標位置データを用いて、自己位置を推定することとなる。ここで、カーブの形状に沿った物標位置データは、自車両ＭＣの周囲に存在する物標位置データおよび自車両ＭＣの現在位置からカーブ路開始位置Ｃ０までの間に存在する物標位置データである。
その結果、カーブ路における自己位置の推定を、カーブの形状に沿った物標位置データで行うため、カーブ路における自己位置の推定精度低下を抑制することが可能となる。
【００５８】
（第一実施形態の変形例）
（１）第一実施形態では、移動量推定部２０、物標位置蓄積部３０、地図情報取得部４０、カーブ開始位置推定部５０及び自己位置推定部６０を自車両ＭＣに搭載したが、この構成に限定するものではない。
すなわち、移動量推定部２０、物標位置蓄積部３０、地図情報取得部４０、カーブ開始位置推定部５０及び自己位置推定部６０のうち少なくとも一つを、例えば、データセンター（基地局）が備える構成としてもよい。
【００５９】
（第二実施形態）
以下、本発明の第二実施形態について、図面を参照しつつ説明する。
（自己位置推定装置の構成）
第二実施形態の自己位置推定装置１の構成は、自己位置推定部６０が行う処理を除き、第一実施形態と同様の構成である。このため、第二実施形態の自己位置推定装置１の構成については、自己位置推定部６０の構成のみを説明する。
自己位置推定部６０は、物標位置蓄積部３０が蓄積している物標位置データから、選択済物標位置データを選択する。なお、自己位置の推定に用いる物標位置データを選択する処理は、上述した第一実施形態と同様である。
さらに、自己位置推定部６０は、選択済物標位置データを、地図情報取得部４０が取得した物標の位置情報と照合することにより、自己位置を推定する。なお、選択済物標位置データを、地図情報取得部４０が取得した物標の位置情報と照合する処理は、上述した第一実施形態と同様である。
【００６０】
第二実施形態では、自己位置推定部６０の構成を、選択済物標位置データと物標の位置情報との照合を複数回行う構成とする。さらに、自己位置推定部６０の構成を、複数回の照合の結果から、各照合における複数の最小誤差を算出し、複数の最小誤差の和が予め設定した誤差閾値（例えば、1[ｍ]）以上の場合に、自己位置を推定する構成とした場合について説明する。
自己位置を推定した自己位置推定部６０は、自己位置信号を、運転支援システム１００へ出力する（図２参照）。
その他の構成は、自車両ＭＣの構成も含め、上述した第一実施形態と同様である。
【００６１】
（動作）
図１から図６を参照しつつ、図８−１及び図８−２を用いて、第二実施形態の自己位置推定装置１を用いて行なう動作の一例を説明する。
図８−１及び図８−２中に表すように、自己位置推定装置１を用いて行なう動作を開始（ＳＴＡＲＴ）すると、まず、ステップＳ１００の処理を行う。
ステップＳ１００からステップＳ１０４の処理は、上述した第一実施形態と同様であるため、その説明を省略する。
【００６２】
ステップＳ１０６では、カーブ開始位置推定部５０により、自車両ＭＣが走行している走行路が、カーブ区間であるか否かを判定する。これにより、ステップＳ１０６では、自車両ＭＣが、カーブ区間の走行を開始したか否かを判定する処理（図中に表す「カーブ開始」）を行う。
ステップＳ１０６において、自車両ＭＣがカーブ区間の走行を開始した（図中に表す「Ｙｅｓ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１０８へ移行する。
【００６３】
一方、ステップＳ１０６において、自車両ＭＣがカーブ区間の走行を開始していない（図中に表す「Ｎｏ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１２２へ移行する。
ステップＳ１０８では、カーブ開始位置推定部５０により、カーブ開始位置Ｃ０を推定（図中に表す「カーブ開始位置Ｃ０推定」）する。ステップＳ１０８において、カーブ開始位置Ｃ０を推定すると、自己位置推定装置１を用いて行なう動作は、ステップＳ２００へ移行する。
【００６４】
ステップＳ２００では、自己位置推定部６０により、過去に行った処理の結果を用いて、過去に行った複数回の、選択済物標位置データと物標の位置情報との照合の結果を取得する。これに加え、ステップＳ２００では、複数回の照合の結果から、各照合における複数の最小誤差の平均値を算出（図中に表す「誤差平均算出」）する。ステップＳ２００において、複数回の照合における複数の最小誤差の平均値を算出すると、自己位置推定装置１を用いて行なう動作は、ステップＳ２０２へ移行する。
ここで、ステップＳ２００では、上述した第一実施形態と同様の方法により、式（１）を用いて、距離Ｄｉｊの平均Ｓを算出する（図６参照）。但し、第二実施形態では、平均Ｓの算出に用いる選択済物標位置データＳｉを、領域Ｒ３内に存在する選択済物標位置データＳｉに限定する（図５参照）。
【００６５】
ステップＳ２０２では、自己位置推定部６０により、ステップＳ２００で算出した最小誤差の平均値が誤差閾値以下であるか否かを判定する処理（図中に表す「誤差平均値が誤差閾値以下」）を行う。
ステップＳ２０２において、ステップＳ２００で算出した最小誤差の平均値が誤差閾値以下である（図中に表す「Ｙｅｓ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１１４へ移行する。
一方、ステップＳ２０２において、ステップＳ２００で算出した最小誤差の平均値が誤差閾値を超えている（図中に表す「Ｎｏ」）と判定した場合、自己位置推定装置１を用いて行なう動作は、ステップＳ１２２へ移行する。
ステップＳ１１４からステップＳ１２６の処理は、上述した第一実施形態と同様であるため、その説明を省略する。
なお、上述した第二実施形態は、本発明の一例であり、本発明は、上述した第二実施形態に限定されることはなく、この実施形態以外の形態であっても、本発明に係る技術的思想を逸脱しない範囲であれば、設計等に応じて種々の変更が可能である。
【００６６】
（第二実施形態の効果）
第二実施形態の自己位置推定装置１であれば、以下に記載する効果を奏することが可能となる。
（１）自己位置推定部６０が、選択済物標位置データと物標の位置情報との複数回の照合の結果から、各照合における複数の最小誤差を算出し、複数の最小誤差の和が予め設定した誤差閾値以上の場合に、自己位置を推定する。
このため、複数の最小誤差の和が予め設定した誤差閾値以上の場合に、自車両ＭＣの周囲に存在する物標位置データ及び自車両ＭＣの現在位置からカーブ開始位置Ｃ０までの間に存在する物標の位置を用いて、自己位置を推定する。
その結果、自車両ＭＣに対し、前後位置の推定精度が低下しやすい状況であっても、カーブの形状に沿った物標位置データで自己位置を推定するため、カーブ路における自己位置の推定精度低下を抑制することが可能となる。
【符号の説明】
【００６７】
１…自己位置推定装置、２…撮像装置、４…距離測定装置、６…車輪速センサ、８…操舵角センサ、１０…物標位置検出部、２０…移動量推定部、３０…物標位置蓄積部、４０…地図情報取得部、５０…カーブ開始位置推定部、６０…自己位置推定部、１００…、ＭＣ…自車両、ＲＯ…走行路面、Ｗ…車輪、Ｃ０…カーブ開始位置、ＣＧ…自車両ＭＣの重心、Ｒ１…カーブ開始位置Ｃ０と自車両ＭＣとの間の領域、Ｒ２…自車両ＭＣから第二閾値距離Ｌ２以下の領域、Ｒ３…自車両ＭＣから第三閾値距離Ｌ３以下の領域、Ｅｉ…自車両ＭＣの進行方向でカーブ開始位置Ｃ０よりも前に、相対位置を検出した選択済物標位置データ、Ｓｉ…自車両ＭＣの進行方向で自車両ＭＣの現在位置からカーブ開始位置Ｃ０までの間に、相対位置を検出した選択済物標位置データ、Ｌ…自車両ＭＣとカーブ開始位置Ｃ０との距離、Ｌ２…第二閾値距離、Ｌ３…第三閾値距離、Ｍｊ…地図情報取得部４０が格納している物標の位置情報のうち選択した一つの選択済物標位置データＳｉに最も近い位置情報、Ｄｉｊ…選択した一つの選択済物標位置データＳｉと位置情報Ｍｊとの距離
【図１】
2017017705.tif 000004
【図２】
2017017705.tif 000005
【図３】
2017017705.tif 000006
【図４】
2017017705.tif 000007
【図５】
2017017705.tif 000008
【図６】
2017017705.tif 000009
【図７−１】
2017017705.tif 000010
【図７−２】
2017017705.tif 000011
【図８−１】
2017017705.tif 000012
【図８−２】
2017017705.tif 000013
【国際調査報告】
2017017705.tif 000014
2017017705.tif 000015
2017017705.tif 000016
2017017705.tif 000017