JP6798894B2 - 位置推定装置、位置推定システム、及び、位置推定方法 - Google Patents

Description

本発明は、位置推定装置、位置推定システム、及び、位置推定方法に関する。

従来、車両に搭載されたカメラで撮影された車両周囲の画像に基づいて、地面に描かれた駐車枠線を認識する技術が知られている（例えば特許文献１参照）。

特開２０１０−１２８３８号公報

駐車枠線の位置情報が必要な時点において、当該駐車枠線が撮影された最新画像が取得できないことがある。このような状況は、例えば、車両が移動して当該駐車枠線から離れた場合等に生じる。また、駐車枠線の位置情報が必要な時点において、他の画像処理が実行されており、処理負荷の大きい駐車枠線の認識処理を即座に実行することができないことがある。

このような事態に対応するための補助機能として、駐車枠線の認識を行った後に、当該駐車枠線の位置を、車両の速度情報及びステアリングの操舵角情報等の車両情報を用いて一定周期で逐次推定することが考えられる。これにより、先に駐車枠線の認識が行われた枠線については、新たに駐車枠線の認識処理を行わなくても、位置推定処理結果によって枠線位置を認識することができる。

ただし、この場合、一定周期で逐次推定処理が行われるために、位置推定処理を行うタイミングが他の処理と競合し易く、処理装置に対する負荷が大きくなることが懸念される。また、複数の駐車枠線の位置を同じタイミングで推定処理することが必要になる場合もあり、このような場合にも、処理装置に対する負荷が大きくなることが懸念される。

本発明は、上記の課題に鑑み、演算処理の負荷を分散させながら位置推定処理を行うことができる技術を提供することを目的とする。

本発明に係る位置推定装置は、推定対象の位置を推定する位置推定装置であって、当該装置が搭載される車両の車両情報を取得時刻とともに一定周期でバッファに蓄積する蓄積処理部と、推定開始時刻から推定終了時刻までの前記車両情報を前記バッファから纏めて取得して前記推定対象の位置を推定する推定処理部と、を備える構成（第１の構成）である。

また、上記第１の構成の位置推定装置において、前記推定処理部は、推定開始時刻から推定終了時刻までの前記車両情報を前記バッファから纏めて取得して前記推定対象の位置を推定する第１モードと、所定周期で得られる前記車両情報毎に逐一前記推定対象の位置を推定する第２のモードと、を切り替え可能に設けられる構成（第２の構成）であってよい。

また、上記第２の構成の位置推定装置において、前記推定処理部は、前記推定対象の位置推定処理以外の、当該装置によって行われる他の処理の負荷情報に基づいて、前記第１モードと前記第２モードとの切り替えを行う構成（第３の構成）であってよい。

また、上記第２又は第３の構成の位置推定装置において、前記推定処理部は、前記車両情報に基づいて前記第１モードと前記第２モードとの切り替えを行う構成（第４の構成）であってよい。

また、上記第４の構成の位置推定装置において、前記推定処理部は、車両速度が第１閾値より遅く、操舵角の変化速度が第２閾値より遅い場合に、前記第１モードを選択する構成（第５の構成）であってよい。

また、上記第１〜第５のいずれかの構成の位置推定装置において、前記推定対象は駐車枠であり、前記推定処理部は、カメラ画像から認識された前記駐車枠の位置情報又は先の推定処理によって取得された前記駐車枠の位置情報と、前記車両情報とに基づいて前記駐車枠の位置推定を行う構成（第６の構成）であることが好ましい。

本発明に係る位置推定システムは、上記第１〜第６のいずれかの構成の位置推定装置と、前記車両の周辺を撮影するカメラと、を備える構成（第７の構成）であることが好ましい。

本発明に係る位置推定方法は、情報処理装置によって推定対象の位置を推定する位置推定方法であって、車両情報を取得時刻とともに一定周期でバッファに蓄積する蓄積処理工程と、推定開始時刻から推定終了時刻までの前記車両情報を前記バッファから纏めて取得して前記推定対象の位置を推定する推定処理工程と、を備える構成（第８の構成）である。

本発明によれば、演算処理の負荷を分散させながら位置推定処理を行うことができる技術を提供することができる。

第１実施形態に係る位置推定システムの構成を示すブロック図 第１実施形態に係る位置推定装置の構成を示すブロック図 第１実施形態における位置推定の手順を示すフローチャート 第２実施形態における位置推定の手順を示すフローチャート 第２実施形態におけるモードの切り替え判断処理の手順を示すフローチャート 変形例の位置推定装置を含む位置推定システムの構成を示すブロック図

以下、本発明の例示的な実施形態について、図面を参照しながら詳細に説明する。以下の説明では、車両の直進進行方向であって、運転席からハンドルに向かう方向を「前方向」とする。また、車両の直進進行方向であって、ハンドルから運転席に向かう方向を「後方向」とする。また、車両の直進進行方向及び鉛直線に垂直な方向であって、前方向を向いている運転手の右側から左側に向かう方向を「左方向」とする。また、車両の直進進行方向及び鉛直線に垂直な方向であって、前方向を向いている運転手の左側から右側に向かう方向を「右方向」とする。

＜＜１．第１実施形態＞＞
＜１−１．位置推定システムの構成＞
図１は、第１実施形態に係る位置推定システム１の構成を示すブロック図である。位置推定システム１は、推定対象の位置を推定するシステムである。図１に示すように、位置推定システム１は、位置推定装置１０と、カメラ２０と、を備える。また、位置推定装置１０は、ＣＡＮ（Controller Area Network）バス３０を介して、車速センサ４０、舵角センサ５０、及び、シフトセンサ６０に接続されている。

位置推定装置１０は、推定対象の位置を推定する情報処理装置である。本実施の形態では、一例として、推定対象は駐車枠である。より詳細には、推定対象は、駐車位置を区画する駐車枠線である。

カメラ２０は、位置推定装置１０が搭載される車両の周辺を撮影する。カメラ２０は、位置推定装置１０が搭載される車両と同一の車両に搭載される。カメラ２０の数は、特に限定されないが、本実施の形態では４つである。本実施の形態では、同一の車両に搭載する位置推定装置１０とカメラ２０とがセットになって、駐車枠の位置推定を行えるために、システム構成をコンパクトにできる。

４つのカメラ２０は、フロントカメラと、バックカメラと、左サイドカメラと、右サイドカメラとによって構成される。フロントカメラは、例えば車両の前端部に配置され、車両の前方を撮影する。バックカメラは、例えば車両の後端部に配置され、車両の後方を撮影する。左サイドカメラは、例えば車両の左側ドアミラーに配置され、車両の左側方を撮影する。右サイドカメラは、例えば車両の右側ドアミラーに配置され、車両の右側方を撮影する。カメラ２０は、有線又は無線で位置推定装置１０に接続されており、撮影情報を位置推定装置１０に送信する。カメラ２０は、例えば所定時間毎にカメラ画像を位置推定装置１０に送信する。

車速センサ４０は、位置推定装置１０が搭載される車両の速度を検出する。本実施の形態では、車速センサ４０は、車両の車輪軸に設けられた不図示のロータの回転をパルス信号として出力する磁気センサ又は光センサである。舵角センサ５０は、不図示のステアリングホイール（ハンドル）の回転角を検出する。シフトセンサ６０は、不図示のトランスミッションからギアポジション（シフトポジション）を検出する。位置推定装置１０は、ＣＡＮバス３０を介して、車速情報、操舵角情報、及び、シフトポジション情報を含む車両情報を取得する。

＜１−２．位置推定装置の詳細＞
図２は、第１実施形態に係る位置推定装置１０の構成を示すブロック図である。図２に示すように、位置推定装置１０は、制御部１１と、記憶部１２と、を備える。

制御部１１は、図示しないＣＰＵ（Central Processing Unit）、ＲＡＭ（Random Access Memory）、及びＲＯＭ（Read Only Memory）を備えるコンピュータである。制御部１１は、記憶部１２に接続され、相互にデータの送受信を行い、位置推定装置１０の全体を制御する。また、制御部１１は、画像処理部１１１と、蓄積処理部１１２と、推定処理部１１３と、を備える。制御部１１が備えるこれらの各部は、プログラムに従ってＣＰＵが演算処理を行うことによって実現される機能である。

画像処理部１１１は、カメラ２０が撮影したカメラ画像の処理を行う。本実施の形態では、画像処理部１１１は、例えば、カメラ画像に基づいて駐車場に描かれた駐車枠の認識を行う。換言すると、本実施の形態の位置推定装置１０は、駐車枠の認識装置としての機能も有する。画像処理部１１１は、カメラ画像に基づいて、認識した駐車枠内に車両を駐車することができるか否かの判断も行う。例えば、認識した駐車枠に車両が存在していると判断される場合、画像処理部１１１は、認識した駐車枠内に車両を駐車できないと判断する。画像処理部１１１は、認識した駐車枠に基づいて駐車領域を検出する機能も有する。駐車領域情報は、例えば、駐車支援を行う運転支援装置（不図示）に送信される。運転支援装置は、駐車領域情報に基づいて駐車支援制御を実行する。

画像処理部１１１は、特に限定する趣旨ではないが、例えばサイドカメラで撮影されるカメラ画像に基づいて駐車枠の認識を行う。例えば、サイドカメラの代わりにリアカメラが用いられてもよいし、サイドカメラとリアカメラとの両方が用いられてもよい。駐車枠の認識処理は、適宜実施される。画像処理部１１１は、カメラ画像中に存在する複数の駐車枠の認識処理を行う場合もある。

画像処理部１１１は、カメラ画像中の輝度変化に基づいて、車両の駐車領域を区画する駐車枠線の検出を行う。駐車枠線は、一般的に白色又は黄色等の明るい色彩が施されるために、画像中における輝度が高い。このために、駐車枠線の輝度と駐車場の路面表面の輝度との間に輝度差が発生する。当該輝度差に基づく輝度変化は一定範囲になるために、輝度変化が一定範囲となるエッジを検出することにより、駐車枠線の検出を行うことができる。なお、「エッジ」は、画像中において、画素間の輝度が所定以上の大きさで変化する部分を指す。

画像処理部１１１は、検出された２つの駐車枠線のエッジ間の距離が所定の距離であると判断される場合に、検出された２つの駐車枠線間の領域を駐車枠として認識する。所定の距離とは、例えば、駐車場に関する法令等で規定される一般公共用の標準的な駐車枠の幅であり、２．５ｍである。

本実施の形態では、画像処理部１１１は、認識した駐車枠の駐車枠線の座標値について記憶部１２の駐車枠管理メモリ１２１に記憶する。記憶する座標値は、駐車枠線の代表的な位置でよく、１つでも複数でもよい。画像処理部１１１は、駐車枠線の座標値と共に、当該座標位置に駐車枠線が存在していたと判断される時刻も駐車枠管理メモリ１２１に記憶する。

なお、上述の座標値は、実空間上における車両の所定位置を基準とした座標（いわゆるワールド座標）上の値であってよい。カメラで撮影した画像における各画素の座標は、実際の空間における車両に対する座標に１対１で対応しているために、画像で検出した駐車枠線の座標位置からワールド座標の座標値を算出することができる。

蓄積処理部１１２は、位置推定装置１０が搭載される車両の車両情報を取得時刻とともに一定周期でバッファに蓄積する。本実施の形態では、車両情報は、ＣＡＮバス３０を介して車速センサ４０、舵角センサ５０、及び、シフトセンサ６０から取得される。詳細には、車両情報は、車輪速パルス積算値、ハンドルの操舵角、及び、シフトポジションである。蓄積処理部１１２は、車両情報だけでなく、当該車両情報を取得した時刻についてもバッファに記憶させる。

本実施の形態では、バッファは、記憶部１２に備えられる車両情報メモリ１２２である。蓄積処理部１１２は、車両情報メモリ１２２をリングバッファとして、リングバッファ制御を実行する。リングバッファ制御とは、蓄積処理部１１２が、車両情報メモリ１２２における最後の領域までデータを記憶すると、最初の領域に戻って新たなデータを記憶する制御である。これにより、リングバッファである車両情報メモリ１２２は、最も古いデータに対して新たなデータが順次上書きされていく。車両情報メモリ１２２においては、常に過去一定時間分の車両情報が記憶された状態にできる。

本実施の形態では、蓄積処理部１１２は、例えば２４ｍｓ周期で車両情報を車両情報メモリ１２２に記憶する。また、蓄積処理部１１２は、画像処理部１１１による駐車枠検知に関する処理が開始される時点においては、車両情報の蓄積処理を開始している。すなわち、駐車枠線の座標値の取得に用いられたカメラ画像が撮影された時点、又は、それ以前に、車両情報の蓄積処理は開始されている。

推定処理部１１３は、推定開始時刻から推定終了時刻までの車両情報をバッファ１２２から纏めて取得して推定対象の位置を推定する。推定開始時刻及び推定終了時刻は、推定を行う状況に応じて適宜設定される。本実施の形態によれば、バッファ１２２に一定周期で車両情報を蓄積しておき、必要に応じて車両情報をバッファ１２２から纏めて取得して位置推定が行われる。このために、一定周期で位置推定が繰り返される構成に比べて、位置推定装置１０における演算処理の負荷を分散させることができる。

本実施の形態では、推定処理部１１３は、カメラ画像から認識された駐車枠の位置情報、又は、先の推定処理によって取得された駐車枠の位置情報と、車両情報と、に基づいて駐車枠の位置推定を行う。本実施の形態では、詳細には、駐車枠管理メモリ１２１に記憶される駐車枠線の位置情報と、車両情報とに基づいて駐車枠線の位置推定を行う。本実施形態によれば、最新のカメラ画像から目標とする駐車枠線の位置を認識することが出来ない場合でも、位置推定機能によって駐車枠線の位置を認識することができる。

駐車枠管理メモリ１２１には、上述のように、画像処理部１１１によって認識された駐車枠線の位置情報が記憶される。また、駐車枠管理メモリ１２１には、推定処理部１１３によって推定された駐車枠線の位置情報も記憶される。推定処理部１１３は、例えば、最も直近のカメラ画像から認識された駐車枠線の位置情報を用いて位置推定処理を行う。推定処理部１１３は、推定処理によって得られた駐車枠線の位置情報を用いて位置推定処理を行うこともある。

推定処理部１１３は、車両情報に含まれるシフトポジション情報によって、推定開始時刻から推定終了時刻までの間において、車両が前進したのか後退したのかを把握できる。また、推定処理部１１３は、車両情報に含まれる操舵角情報によって、推定開始時刻から推定終了時刻までの間におけるハンドルの向きを把握することができる。すなわち、推定処理部１１３は、シフトポジション情報と操舵角情報とによって、車両の進行方向を把握することができる。推定処理部１１３は、更に車両情報に含まれる車速情報を組み合わせることによって、推定開始時刻から推定終了時刻までの間に、車両がどの方向にどれだけの距離を移動したのかを把握することができる。このために、推定処理部１１３は、駐車枠管理メモリ１２１から読み出される、推定開始時刻における駐車枠線の位置情報から、推定終了時刻における駐車枠線の位置を推定することができる。

図３は、第１実施形態における位置推定の手順を示すフローチャートである。なお、図３に示す位置推定の手順は例示に過ぎない。推定処理部１１３は、例えば、画像処理部１１１が認識した駐車枠線の位置情報が駐車枠管理メモリ１２１に記憶された時点で位置推定に関する処理を開始する。

推定処理部１１３は、推定処理結果が必要なタイミングか否かを判断する（ステップＳ１）。推定処理結果が必要なタイミングとして、例えば、駐車枠線情報を利用した処理が要求されるタイミングが挙げられる。詳細には、カメラ画像に駐車枠を重ねて表示することが要求されたタイミングが例示される。また、推定処理結果が必要なタイミングとして、例えば、車両情報メモリ１２２によって記憶される情報によって推定処理が実行できなくなる前の適当なタイミングが挙げられる。これは、車両情報メモリ１２２がリングバッファとして構成されており、古い車両情報が上書きにより消去されることを考慮するものである。また、推定処理結果が必要なタイミングとして、例えば、推定対象となる駐車枠線がカメラ画像において認識できなくなったタイミングが挙げられる。また、位置推定装置１０における演算処理負荷が少ないタイミングが、推定処理結果が必要なタイミングとされてもよい。

推定処理結果が必要なタイミングとなるまで、推定処理部１１３は、当該タイミングか否かの判断を繰り返す。推定処理部１１３は、推定処理結果が必要なタイミングであると判断すると（ステップＳ１でＹｅｓ）、駐車枠管理メモリ１２１から推定対象となる駐車枠線の位置情報を読み出す（ステップＳ２）。駐車枠管理メモリ１２１から読み出される位置情報は、例えば、最も直近のカメラ画像から認識された駐車枠線の位置情報や、最も直近の推定処理によって得られた駐車枠線の位置情報である。

また、推定処理部１１３は、推定対象時間を決定する（ステップＳ３）。詳細には、推定処理部１１３は、推定開始時刻及び推定終了時刻を決定する。推定処理部１１３は、駐車枠管理メモリ１２１から読み出した駐車枠線の位置情報と共に記憶されている時刻を推定開始時刻とする。駐車枠線の位置情報と共に記憶されている時刻は、当該位置情報に示される座標位置に推定対象となる駐車枠線が存在していたと判断される時刻である。また、推定処理部１１３は、例えば、推定処理結果が必要とされたタイミングを推定終了時刻にする。

推定処理部１１３は、決定した推定開始時刻から推定終了時刻までの車両情報を、車両情報メモリ１２２から読み出す（ステップＳ４）。車両情報には、上述のように、車速情報、操舵角情報、及び、シフトポジション情報が含まれる。推定処理部１１３は、ステップＳ２で読み出した駐車枠線の位置情報と、ステップＳ４で読み出した車両情報とに基づいて、駐車枠線の位置を推定する（ステップＳ５）。推定処理部１１３は、推定した駐車枠線の位置（座標値）を、その位置に当該駐車枠線があったと判断される時刻と共に、駐車枠管理メモリ１２１に記憶する。

推定処理部１１３は、推定処理を行った後、更に推定処理が行われるか否かを確認する（ステップＳ６）。推定処理が必要な場合には（ステップＳ６でＹｅｓ）、ステップＳ１に戻る。推定処理が不要な場合には（ステップＳ６でＮｏ）、位置推定に関する処理が終了される。

本実施の形態の構成によれば、ＣＡＮバス３０を介して取得される車両情報は、即座に使用されるのではなく、一旦、バッファである車両情報メモリ１２２に記憶される。そして、位置推定装置１０は、必要なタイミングに、車両情報メモリ１２２から車両情報を纏めて取得して、当該車両情報を用いて駐車枠線の位置を推定する構成になっている。このために、例えば、一定周期でＣＡＮバス３０を介して車両情報を取得するたびに、逐一駐車枠線の位置推定を行う構成と比べて、演算処理のタイミングを分散させることができる。例えば、複数の駐車線枠の位置推定が必要な場合でも、それらの演算処理が行われるタイミングを互いにずらすことも可能であり、位置推定装置１０における演算処理の負荷が一時期に過度に大きくなるといった事態の発生を低減することができる。

＜＜２．第２実施形態＞＞
第２実施形態の位置推定システム及び位置推定装置の構成は、第１実施形態の構成と同様である。第１実施形態と重複する部分については、同一の符号を付して説明し、特に必要が無い場合には説明を省略する。

第２実施形態においては、推定処理部１１３が、推定開始時刻から推定終了時刻までの車両情報をバッファから纏めて取得して推定対象の位置を推定する第１モードと、所定周期で得られる車両情報毎に逐一推定対象の位置を推定する第２モードと、を切り替え可能に設けられる。この点、第１実施形態と異なる。

第１モードは、第１実施形態の位置推定処理手法と同じである。バッファは車両情報メモリ１２２である。第２モードにおける所定周期は、本実施の形態では、蓄積処理部１１２が車両情報メモリ１２２に蓄積する一定周期と同じ周期である。例えば、所定周期は２４ｍｓ周期である。第２実施形態の構成によれば、例えば車両状況や、位置推定装置１０の処理状況に応じて位置推定処理の方法を切り替えることができるので、演算処理の負荷の分散に加えて、精度の高い位置推定を行うことが可能になる。

図４は、第２実施形態における位置推定の手順を示すフローチャートである。なお、図４に示す位置推定の手順は例示である。推定処理部１１３は、例えば、画像処理部１１１が認識した駐車枠線の位置情報が駐車枠管理メモリ１２１に記憶された時点で位置推定に関する処理を開始する。

図４に示すように、推定処理部１１３は、まず、推定処理手法が第１モードで良いか否かを確認する（ステップＳ１１）。第１モードで良いか否かは、例えば、車両情報や位置推定装置１０の演算処理の負荷状況に基づいて決定される。モードの切り替え判断処理の詳細については後述する。

第１モードで良いと判断された場合（ステップＳ１１でＹｅｓ）、推定処理部１１３は、ステップＳ１２〜ステップＳ１７までの処理を行う。ステップＳ１２〜ステップＳ１７までの処理は、第１実施形態で説明した処理（図３のステップＳ１〜ステップＳ６）と同じである。このために、詳細な説明は省略する。

一方、第１モードで良くないと判断された場合（ステップＳ１１でＮｏ）、第２モードにしたがった推定処理が実行される。推定処理部１１３は、一定時間が経過したか否かを確認する（ステップＳ１８）。この確認は、一定時間が経過するまで行われる。本実施の形態では、一定時間は、蓄積処理部１１２が車両情報を取得する周期（例えば２４ｍｓ）と同じ長さである。

推定処理部１１３は、一定時間が経過すると（ステップＳ１８でＹｅｓ）、車両情報を取得する（ステップＳ１９）。車両情報には、車速情報、操舵角情報、及び、シフトポジション情報が含まれる。本実施の形態では、蓄積処理部１１２によって車両情報メモリ１２２に記憶された情報を読み出す。ただし、本実施の形態では、車両情報が車両情報メモリ１２２に蓄積される周期と、推定処理部１１３が推定処理を行う周期は同じである。このために、実質的には、推定処理部１１３は、ＣＡＮバス３０を介して得られる最新の車両情報を即座に利用することになる。

また、推定処理部１１３は、一定時間が経過すると（ステップＳ１８でＹｅｓ）、駐車枠管理メモリ１２１から駐車枠線の位置情報を読み出す（ステップＳ２０）。駐車枠管理メモリ１２１から読み出される位置情報は、最も直近のカメラ画像から認識された駐車枠線の位置情報や、最も直近の推定処理によって得られた駐車枠線の位置情報である。なお、ステップＳ１９とステップＳ２０は、ほぼ同時に処理され、ステップＳ１９とステップＳ２０とは逆であってもよい。

推定処理部１１３は、ステップＳ１９で取得した車両情報と、ステップＳ２０で読み出した駐車枠線の位置情報とに基づいて、駐車枠線の位置を推定する（ステップＳ２１）。推定処理部１１３は、推定した駐車枠線の位置（座標値）を、その位置に駐車枠線があったと判断される時刻と共に、駐車枠管理メモリ１２１に記憶する。

推定処理部１１３は、ステップＳ１６における推定処理後と同様に、ステップＳ２１における推定処理を行った後、更に推定処理が行われるか否かを確認する（ステップＳ１７）。推定処理が必要な場合には（ステップＳ１７でＹｅｓ）、ステップＳ１１に戻る。推定処理が不要な場合には（ステップＳ１７でＮｏ）、位置推定に関する処理が終了される。

本実施の形態では、第１モードが選択された場合、バッファ１２２に一定周期で車両情報が蓄積される。そして、バッファ１２２に記憶された車両情報が必要に応じて必要な量だけ纏めて取得され、位置推定が行われる。このために、一定周期で位置推定が繰り返される構成に比べて、位置推定装置１０における演算処理の負荷を分散させることができる。また、第２モードが選択されている場合には、その間、一定周期で位置推定が繰り返されることになるために、位置推定の精度を向上させることができる。

本実施の形態では、推定処理部１１３は、推定対象の位置推定処理以外の、当該位置推定装置１０によって行われる他の処理の負荷情報に基づいて、第１モードと第２モードとの切り替えを行う。他の演算処理の負荷が小さい場合には、位置推定処理を一定周期で繰り返しても、位置推定装置１０の負荷が高くなりすぎることはない。このために、位置推定処理の優先度を上げ、位置推定処理を一定周期で繰り返すことによって位置推定の精度を向上させることができる。一方、他の演算処理の負荷が大きい場合には、バッファによる車両情報の蓄積を利用して、位置推定処理の優先度を下げることができる。このために、位置推定装置１０に一時期に大きな負荷が加わることを避けることができる。他の演算処理の負荷情報として、例えば、画像処理部１１１における演算処理の負荷情報が挙げられる。例えば、駐車に使用する駐車枠が決定されている場合、更に駐車枠の検出処理を行う必要がないために、演算処理の負荷が小さいと判断される。

本実施の形態では、推定処理部１１３は、車両情報に基づいて第１モードと第２モードとの切り替えを行う。例えば、車両情報から、車両が、その位置を大きく変化させる動作を行っていないと判断される場合には、バッファの車両情報を纏めて処理して位置推定を行う第１モードとされる。これにより、位置推定の推定誤差が大きくなることを避けつつ、他の処理を優先させることができる。一方、車両情報から、車両が、その位置を大きく変化させる動作を行っていると判断される場合には、推定誤差が大きくなることを抑制するために、位置推定処理が一定周期で行われる第２モードとされる。これにより、精度の高い位置推定を確保することが可能になる。車両情報としては、例えば、車速情報や操舵角情報が挙げられる。

図５は、第２実施形態におけるモードの切り替え判断処理の手順を示すフローチャートである。推定処理部１１３は、駐車に使用する駐車枠が決定済みであるか否かを確認する（ステップＳ１１１）。駐車枠が決定済みであるか否かは、画像処理部１１１からの情報で判断できる。推定処理部１１３は、駐車枠が決定済みでない場合（ステップＳ１１１でＮｏ）、推定処理手法を第１モードと決定する（ステップＳ１１２）。駐車に使用するための駐車枠が決定していない場合には、駐車枠を検出する処理を行う必要があり、画像処理部１１１の演算処理を優先して行える状態が望まれるためである。

推定処理部１１３は、駐車枠が決定済みの場合（ステップＳ１１１でＹｅｓ）、車両速度が第１閾値より遅いか否かを確認する（ステップＳ１１３）。本実施の形態では、車速情報は、例えばＣＡＮバス３０を介して車速センサ４０から取得することができる。第１閾値は予め決められた値であり、例えば記憶部１２に記憶されている。

推定処理部１１３は、車両速度が第１閾値より遅い場合（ステップＳ１１３でＹｅｓ）、操舵角の変化速度が第２閾値より遅いか否かを確認する（ステップＳ１１４）。本実施の形態では、操舵角情報は、例えばＣＡＮバス３０を介して舵角センサ５０から取得することができる。第２閾値は予め決められた値であり、例えば記憶部１２に記憶されている。

推定処理部１１３は、操舵角の変化速度が第２閾値より遅い場合（ステップＳ１１４でＹｅｓ）、推定処理手法を第１モードに決定する（ステップＳ１１２）。すなわち、推定処理部１１３は、車両速度が第１閾値より遅く、操舵角の変化速度が第２閾値より遅い場合に、第１モードを選択する。車速が遅く、且つ、操舵角の変化速度が遅い場合、車両の位置が大きく変化しないと判断される。このため、バッファに蓄積される車両情報を纏めて利用して位置推定を行っても、推定誤差を小さく抑えることができるためである。

推定処理部１１３は、車速が第１閾値以上である場合（ステップＳ１１３でＮｏ）、及び、操舵角の変化速度が第２閾値以上である場合（ステップＳ１１４でＮｏ）、推定処理手法を第２モードに決定する（ステップＳ１１５）。車速が速い場合や、操舵角の変化速度が速い場合には、車両の位置が大きく変化する可能性があるために、位置推定処理の優先度を上げて、位置推定の精度を向上するためである。

なお、本実施の形態では、第１モードと第２モードとの切り替え判断に３つの指標を用いているが、これは例示である。判断指標の種類及び数は適宜変更されてよい。

＜＜３．留意点＞＞
本明細書中に開示されている種々の技術的特徴は、上記実施形態のほか、その技術的創作の主旨を逸脱しない範囲で種々の変更を加えることが可能である。また、以上に示した複数の実施形態及び変形例は可能な範囲で組み合わせて実施されてよい。

例えば、以上に示した実施形態では、位置推定装置１０が画像処理部１１１を備える構成とした。ただし、これは例示にすぎない。位置推定装置は、画像処理部を備えない構成であってよい。この場合には、位置推定装置が、カメラ画像の処理を行う画像処理装置と情報のやり取りを行う構成とすればよい。

また、以上においては、位置推定装置が、当該装置を搭載する車両を基準とした、駐車枠の位置を推定する構成とした。ただし、これは例示であり、位置推定装置は、当該装置を搭載する車両自身の位置（以下、自車位置という場合がある）を推定する構成であってもよい。図６は、当該変形例に係る位置推定装置１０´を含む位置推定システム２の構成を示すブロック図である。

変形例の位置推定システム２は、カメラ２０の代わりにＧＰＳ（Global Positioning System）受信機７０を備える。位置推定装置１０´は、画像処理部１１１の代わりに位置情報処理部１１４を備える。位置情報処理部１１４は、ＧＰＳ受信機７０から送信されるＧＰＳデータを演算処理して、車両の空間上の位置を経度及び緯度として算出する。位置情報処理部１１４は、算出した位置情報を位置情報メモリ１２３に記憶する。位置情報処理部１１４は、プログラムに従ってＣＰＵが演算処理を行うことによって実現される機能である。

変形例の位置推定装置１０´においては、推定処理部１１３は、第１実施形態と同様に（図３参照）、必要なタイミングにおいて、最も直近にＧＰＳ受信機７０から得られた情報と、車両情報とに基づいて自車位置の推定を行う。必要なタイミグとしては、例えば、ＧＰＳ受信機７０からＧＰＳデータを取得できない場合が挙げられる。本変形例では、バッファ（車両情報メモリ１２２）に蓄積された車両情報を必要なタイミングで纏めて取得して、位置推定処理を行うことができる。このために、ＧＰＳ受信機７０によって自車位置が把握できる場合には、一定周期で取得される車両情報を逐一用いて位置推定処理を行わない構成にできる。この結果、位置推定処理は、必要な場合に適宜実行されることになり、位置推定処理による負荷を分散させることができる。

また、以上に示した実施形態では、プログラムに従ったＣＰＵの演算処理によってソフトウェア的に各種の機能が実現されていると説明したが、これらの機能のうちの少なくとも一部は電気的なハードウェア回路により実現されてもよい。また逆に、ハードウェア回路によって実現されるとした機能のうちの少なくとも一部は、ソフトウェア的に実現されてもよい。

１、２・・・位置推定システム
１０、１０´・・・位置推定装置
２０・・・カメラ
１１２・・・蓄積処理
１１３・・・推定処理部
１２２・・・車両情報メモリ（バッファ）

Claims (8)

1. 推定対象の位置を推定する位置推定装置であって、
   当該装置が搭載される車両の車両情報を取得時刻とともに一定周期でバッファに蓄積する蓄積処理部と、
   推定開始時刻から推定終了時刻までの前記車両情報を前記バッファから纏めて取得して前記推定対象の位置を推定する推定処理部と、
   を備える、位置推定装置。
2. 前記推定処理部は、
   推定開始時刻から推定終了時刻までの前記車両情報を前記バッファから纏めて取得して前記推定対象の位置を推定する第１モードと、
   所定周期で得られる前記車両情報毎に逐一前記推定対象の位置を推定する第２のモードと、
   を切り替え可能に設けられる、請求項１に記載の位置推定装置。
3. 前記推定処理部は、前記推定対象の位置推定処理以外の、当該装置によって行われる他の処理の負荷に基づいて、前記第１モードと前記第２モードとの切り替えを行う、請求項２に記載の位置推定装置。
4. 前記推定処理部は、前記車両情報に基づいて前記第１モードと前記第２モードとの切り替えを行う、請求項２又は３に記載の位置推定装置。
5. 前記推定処理部は、車両速度が第１閾値より遅く、操舵角の変化速度が第２閾値より遅い場合に、前記第１モードを選択する、請求項４に記載の位置推定装置。
6. 前記推定対象は駐車枠であり、
   前記推定処理部は、カメラ画像から認識された前記駐車枠の位置情報又は先の推定処理によって取得された前記駐車枠の位置情報と、前記車両情報とに基づいて前記駐車枠の位置推定を行う、請求項１から５のいずれか１項に記載の位置推定装置。
7. 請求項１から６のいずれか１項に記載の位置推定装置と、
   前記車両の周辺を撮影するカメラと、
   を備える位置推定システム。
8. 情報処理装置によって推定対象の位置を推定する位置推定方法であって、
   車両情報を取得時刻とともに一定周期でバッファに蓄積する蓄積処理工程と、
   推定開始時刻から推定終了時刻までの前記車両情報を前記バッファから纏めて取得して前記推定対象の位置を推定する推定処理工程と、
   を備える、位置推定方法。

Images