JP7227763B2 - 車載処理装置、位置推定方法、出庫システム - Google Patents

Description

本発明は、車載処理装置、位置推定方法、および出庫システムに関する。

近年、自動車の自動運転実現に向けた活動が盛んとなっている。自動運転とは、車両周囲をカメラや超音波レーダ、レーダなどの外界センサでセンシングし、センシング結果に基づいて判断を行い、ユーザの操作なしで車両が自律的に走行するものである。この自動運転には車両の位置推定が必要となる。特許文献１には物体の一部を表す点の第１座標系における座標が複数含まれる点群データが格納される記憶部と、車両の周囲の情報を取得するセンサの出力を取得するセンサ入力部と、前記車両の移動に関する情報を取得する移動情報取得部と、前記センサ入力部、および前記移動情報取得部が取得する情報に基づき、第２座標系における前記車両の位置および物体の一部を表す点の前記第２座標系における座標が複数含まれる局所周辺情報を生成する局所周辺情報作成部と、前記点群データと前記局所周辺情報とに基づき前記第１座標系と前記第２座標系の関係を推定し、前記第１座標系における前記車両の位置を推定する位置推定部とを備える車載処理装置が開示されている。

特開２０１８－４３４３号公報

位置特定の精度向上および演算時間の短縮が望ましい。

本発明の第１の態様による車載処理装置は、物体の一部を表す点の第１座標系における複数の座標が含まれる点群データが格納される記憶部と、車両の周囲の情報を取得するセンサの出力を取得するセンサ入力部と、前記車両の移動に関する情報である車両移動情報を取得する移動情報取得部と、前記センサ入力部、および前記移動情報取得部が取得する情報に基づき、第２座標系における前記車両の位置および物体の一部を表す点の前記第２座標系における座標が複数含まれる局所周辺情報を生成する局所周辺情報作成部と、前記点群データと前記局所周辺情報とに基づき前記第１座標系と前記第２座標系の関係を推定し、前記第１座標系における前記車両の位置を推定する位置推定部とを備え、前記点群データには、前記第１座標系における前記車両の走行経路が含まれ、前記位置推定部は、前記車両が前記点群データに含まれる走行経路を走行していることを前提として前記第１座標系と前記第２座標系の関係を推定する。
本発明の第２の態様による位置推定方法は、物体の一部を表す点の第１座標系における複数の座標が含まれる点群データが格納される記憶部、車両の周囲の情報を取得するセンサの出力を取得するセンサ入力部、および前記車両の移動に関する情報である車両移動情報を取得する移動情報取得部を備える前記車両に備えられる車載処理装置が実行する位置推定方法であって、前記センサ入力部、および前記移動情報取得部が取得する情報に基づき、第２座標系における前記車両の位置および物体の一部を表す点の前記第２座標系における座標が複数含まれる局所周辺情報を生成することと、前記点群データと前記局所周辺情報とに基づき前記第１座標系と前記第２座標系の関係を推定し、前記第１座標系における前記車両の位置を推定することと、前記点群データには、前記第１座標系における前記車両の走行経路が含まれ、前記車両が前記点群データに含まれる走行経路を走行していることを前提として前記第１座標系と前記第２座標系の関係を推定することとを含む。
本発明の第３の態様による出庫システムは、車両に搭載される車載処理装置、および前記車載処理装置と通信する携帯端末を備える出庫システムであって、前記携帯端末は、
前記車載処理装置に第１の信号を出力する通信部を備え、前記車載処理装置は、物体の一部を表す点の第１座標系における複数の座標が含まれる点群データが格納される記憶部と、車両の周囲の情報を取得するセンサの出力を取得するセンサ入力部と、前記車両の移動に関する情報である車両移動情報を取得する移動情報取得部と、前記センサ入力部、および前記移動情報取得部が取得する情報に基づき、第２座標系における前記車両の位置および物体の一部を表す点の前記第２座標系における座標が複数含まれる局所周辺情報を生成する局所周辺情報作成部と、前記点群データと前記局所周辺情報とに基づき前記第１座標系と前記第２座標系の関係を推定し、前記第１座標系における前記車両の位置を推定する位置推定部とを備え、前記点群データには、前記第１座標系における前記車両の走行経路、および前記第１座標系における前記車両の始動位置が含まれ、前記位置推定部は、前記車両が前記点群データに含まれる走行経路を走行していることを前提として前記第１座標系と前記第２座標系の関係を推定し、前記車載処理装置はさらに、前記第１の信号を受信すると、前記位置推定部を用いて前記第１座標系における前記車両の位置を推定し、前記始動位置から遠ざかる方向に前記走行経路に沿って前記車両を走行させる応答部を備える。

本発明によれば、位置特定の精度の向上および演算時間の短縮ができる。

第１の実施の形態における自動駐車システム１００の全体構成図 駐車場点群１２４Ａの一例を示す図 車載処理装置１２０の動作環境を示す図 記録フェーズの動作を表すフローチャート 自動駐車フェーズの全体動作を表すフローチャート 自己位置推定処理の詳細を示すフローチャート 自己位置推定処理の概要を示すイメージ図 自己位置推定処理の概要を示すイメージ図 セクションごとの一致度を評価する処理の詳細を示すフローチャート 第１の実施の形態におけるステップＳ６４２の処理結果である仮想点の位置を示す図 一致度の評価の概要を示すイメージ図 角度限定比較および移動制限比較を説明する図 自動駐車処理の詳細を示すフローチャート 変形例１における駐車場点群１２４Ｂの一例を示す図 変形例３におけるステップＳ６４２の処理結果である仮想点の位置を示す図 第２の実施の形態に係る自動駐車システム１００Ａの全体構成図 自動出庫フェーズの処理を表すフローチャート 第２の実施の形態における図１７のステップＳ６８０の詳細を示すフローチャート 第２の実施の形態の変形例１における自動駐車システム１００Ｂの全体構成図 第２の実施の形態の変形例１における図１７のステップＳ６８０の詳細を示すフローチャート

―第１の実施の形態―
以下、図１～図１３を参照して、本発明にかかる車載処理装置の第１の実施の形態を説明する。

図１は、本発明にかかる車載処理装置を含む自動駐車システム１００の構成図である。自動駐車システム１００は、車両１に搭載される。自動駐車システム１００は、センサ群１０２、１０７～１０９と、入出力装置群１１０、１１１、１１４と、車両１を制御する制御装置群１３０～１３３と、車載処理装置１２０とから構成される。センサ群、入出力装置群、および制御装置群は車載処理装置１２０と信号線で接続され、車載処理装置１２０と各種データを授受する。以下では、車両１に乗車する人間を「ユーザ」と呼ぶ。

車載処理装置１２０は、演算部１２１と、ＲＡＭ１２２と、ＲＯＭ１２３と、記憶部１２４と、インタフェース１２５とを備える。車載処理装置１２０はたとえばＥＣＵ（Electronic Control Unit；電子制御装置）である。演算部１２１はＣＰＵである。ＦＰＧＡなど他の演算処理装置で全部または一部の演算処理を実行するように構成してもよい。ＲＡＭ１２２は読み書き込み可能な記憶領域であり、車載処理装置１２０の主記憶装置として動作する。ＲＡＭ１２２には、後述する局所周辺情報１２２Ａが格納される。ＲＯＭ１２３は読み取り専用の記憶領域であり、後述するプログラムが格納される。このプログラムはＲＡＭ１２２で展開されて演算部１２１により実行される。演算部１２１は、プログラムを読み込んで実行することにより、点群データ取得部１２１Ａ、局所周辺情報作成部１２１Ｂ、および位置推定部１２１Ｃとして動作する。

記憶部１２４は不揮発性の記憶装置であり、車載処理装置１２０の補助記憶装置として動作する。記憶部１２４には、駐車場点群１２４Ａが格納される。駐車場点群１２４Ａとは、１または複数の駐車場データである。駐車場データとは、ある駐車場の位置情報、すなわち緯度・経度、駐車領域を示す座標、およびその駐車場に存在するランドマークを構成する点の座標の集合である。ランドマークについては後述する。インタフェース１２５は、車載処理装置１２０と自動駐車システム１００を構成する他の機器との情報の授受を行う。インタフェース１２５は、車両１の周囲の情報を取得するカメラ１０２の出力を取得するので、センサ入力部とも呼べる。またインタフェース１２５は、車速センサ１０８および舵角センサ１０９から車両１の移動に関する情報を取得するので、移動情報取得部とも呼べる。

センサ群は、車両１の周囲を撮影するカメラ１０２と、ＧＰＳ受信機１０７と、車速センサ１０８と、舵角センサ１０９とを含む。

カメラ１０２は、撮影して得られた画像（以下、撮影画像）を車載処理装置１２０に出力する。車載処理装置１２０は、カメラ１０２の撮影画像を用いて後述するランドマークの測位を行う。カメラ１０２の焦点距離や撮像素子サイズなどの内部パラメータ、および車両１へのカメラ１０２の取り付け位置や取り付け姿勢である外部パラメータは既知であり、ＲＯＭ１２３にあらかじめ保存されている。車載処理装置１２０は、ＲＯＭ１２３に格納された内部パラメータおよび外部パラメータを用いて、被写体とカメラ１０２との位置関係を算出することができる。

ＧＰＳ受信機１０７は、衛星航法システムを構成する複数の衛星から信号を受信し、受信した信号に基づく演算によりＧＰＳ受信機１０７の測地系における位置、すなわち緯度および経度を算出する。なおＧＰＳ受信機１０７により算出される緯度および経度の精度は高精度でなくてもよく、たとえば数ｍ～１０ｍ程度の誤差が含まれてもよい。ＧＰＳ受信機１０７は、算出した緯度および経度を車載処理装置１２０に出力する。

車速センサ１０８、および舵角センサ１０９はそれぞれ、車両１の車速と舵角を測定し車載処理装置１２０に出力する。車載処理装置１２０は、車速センサ１０８および舵角センサ１０９の出力を用いて公知のデッドレコニング技術によって、車両１の移動量および移動方向を算出する。

入力装置１１０には、ユーザによる車載処理装置１２０への動作指令が入力される。入力装置１１０は、記録開始ボタン１１０Ａと、記録完了ボタン１１０Ｂと、自動駐車ボタン１１０Ｃとを含む。表示装置１１１はたとえば液晶ディスプレイであり、車載処理装置１２０から出力される情報が表示される。なお、入力装置１１０と表示装置１１１とが一体として、たとえばタッチ操作に対応する液晶ディスプレイとして構成されてもよい。この場合は、液晶ディスプレイの所定の領域がタッチされることにより、記録開始ボタン１１０Ａ、記録完了ボタン１１０Ｂ、または自動駐車ボタン１１０Ｃが押されたと判断してもよい。

通信装置１１４は、車両１の外部の機器と車載処理装置１２０とが無線で情報を授受するために用いられる。例えば、ユーザが車両１の外にいるときに、ユーザが身に着けている携帯端末と通信を行い情報を授受する。通信装置１１４が通信を行う対象はユーザの携帯端末に限定されない。

車両制御装置１３０は、車載処理装置１２０の動作指令に基づき、操舵装置１３１、駆動装置１３２、および制動装置１３３を制御する。操舵装置１３１は、車両１のステアリングを操作する。駆動装置１３２は、車両１に駆動力を与える。駆動装置１３２はたとえば、車両１が備えるエンジンの目標回転数を増加させることにより車両１の駆動力を増加させる。制動装置１３３は、車両１に制動力を与える。

（ランドマーク測位）
ランドマークとはセンサにより識別可能な特徴を有する物体であり、たとえば路面ペイントの１種である駐車枠線や、車両の走行の妨げとなる障害物である建物の壁などである。本実施の形態では、移動体である車両や人間はランドマークに含めない。車載処理装置１２０は、カメラ１０２から入力される情報に基づき、車両１の周辺に存在するランドマーク、すなわちセンサにより識別可能な特徴を有する点を検出する。以下では、外界センサ、すなわちカメラ１０２から入力される情報に基づくランドマークの検出を「ランドマーク測位」と呼ぶ。

車載処理装置１２０は、カメラ１０２の撮影画像を対象に、以下のように画像認識プログラムを動作させることで駐車枠などの路面ペイントなどを検出する。駐車枠の検出は、まず入力画像からソーベルフィルタなどでエッジを抽出する。次に、たとえば白から黒への変化であるエッジの立ち上がりと、黒から白への変化であるエッジの立ち下がりのペアを抽出する。そしてこのペアの間隔が、あらかじめ定めた第１の所定の距離、すなわち駐車枠を構成する白線の太さと略一致すると、このペアを駐車枠の候補とする。同様の処理により駐車枠の候補を複数検出し、駐車枠の候補同士の間隔があらかじめ定めた第２の所定の距離、すなわち駐車枠の白線の間隔と略一致すると、それらを駐車枠として検出する。駐車枠以外の路面ペイントは以下の処理を実行する画像認識プログラムで検出される。まず入力画像からソーベルフィルタなどでエッジを抽出する。エッジ強度があらかじめ定めた一定の値よりも大きく、エッジ同士の間隔が白線の幅に相当するあらかじめ定めた距離である画素を探索することにより検出できる。

車載処理装置１２０はたとえば既知のテンプレートマッチングにより車両や人間を検出し、測定結果から除外する。また、以下のようにして検出した移動体を測定結果から除外してもよい。すなわち車載処理装置１２０は、内部パラメータおよび外部パラメータを用いて撮影画像における被写体とカメラ１０２との位置関係を算出する。次に車載処理装置１２０は、カメラ１０２が連続して取得した撮影画像において被写体を追跡することで車両１と被写体の相対的な速度を算出する。最後に車載処理装置１２０は、車速センサ１０８および舵角センサ１０９の出力を用いて車両１の速度を算出し、被写体との相対的な速度と一致しなければ被写体が移動体であると判断し、この移動体に関する情報を測定結果から除外する。

（駐車場点群１２４Ａ）
図２は、記憶部１２４に格納される駐車場点群１２４Ａの一例を示す図である。図２では、駐車場点群１２４Ａとして２つの駐車場データが格納されている例を示している。１つの駐車場データは、その駐車場の位置、すなわち緯度および経度（以下、緯度経度と呼ぶ）と、駐車領域の座標と、車両１の走行経路と、ランドマークを構成する点の二次元平面上の座標とから構成される。

駐車場の位置とは、たとえば駐車場の入り口付近、駐車場の中央付近、または駐車位置の緯度経度である。駐車領域の座標、車両１の走行経路、およびランドマークを構成する点の座標は、その駐車場データに固有の座標系における座標である。以下では駐車場データにおける座標系を「駐車場座標系」や「第１座標系」と呼ぶ。駐車場座標系は、たとえば記録開始時の車両１の座標が原点とされ、記録開始時の車両１の進行方向前方がＹ軸、記録開始時の車両１の右方向がＸ軸とされる。駐車領域の座標は、たとえば駐車領域を矩形とした場合にその矩形領域の４つの頂点の座標として記録される。ただし、駐車領域は矩形に限定されず矩形以外の多角形や楕円形状でもよい。ただし駐車場点群１２４Ａに記録する情報は、広がりを持つ領域である駐車領域の代わりに、代表的な点たとえば駐車領域の中心点を示す駐車位置を記録してもよい。

なお車両１の走行経路は、車両１が駐車場の入り口付近から駐車位置まで走行した経路における、一定距離ごとまたは一定時間ごとの車両１の座標である。一定距離とはたとえば０．１ｍや０．５ｍであり、一定時間とは１秒や１０秒である。

（局所周辺情報１２２Ａ）
局所周辺情報１２２Ａには、車載処理装置１２０が後述する自動駐車フェーズにおいて検出したランドマークを構成する点の座標が格納される。この座標は局所周辺情報１２２Ａの記録を開始した際の車両１の位置および姿勢を基準に、たとえばその位置を原点とし、車両１の進行方向前方をＹ軸とし、進行方向右をＸ軸とする座標系である。この座標系を以下では「局所座標系」や「第２座標系」と呼ぶ。

（前提条件）
図３は、車載処理装置１２０の動作環境を示す図であり、この図を参照して本実施の形態における前提条件である、車両１が常に同一の経路を走行することを説明する。図３は、車載処理装置１２０の動作環境の一例である駐車場９０１を示す平面図である。駐車場９０１は建物９０２の周囲に設けられる。駐車場９０１の出入り口は図示左下の第１出入り口Ｅ１、図示右上の第２出入り口Ｅ２、図示左上の第３出入り口Ｅ３の３か所である。図３に示す四角は路面ペイントである駐車領域を表しており、ハッチングで示す駐車領域９０３が車両１の駐車領域、すなわち駐車が完了した際に駐車位置となる領域である。

本実施の形態では、車両１は第１出入り口Ｅ１を必ず使用し、図３に示す破線の走行経路を走行して駐車領域９０３まで進む。たとえば第１出入り口Ｅ１から駐車領域９０３までの走行経路として、図３に一点鎖線で示す経路も存在するが、本実施の形態では車両１が一点鎖線で示す経路を走行することは想定しない。すなわちユーザが車両１を自ら運転する際だけでなく、車載処理装置１２０が車両１を動作させる際にも本実施の形態では、車両１は破線で示す同一の走行経路を走行する。ただし「同一」とは、経路が完全に同一でたとえば１ｍｍもずれていないことを示すのではなく、図３の破線と一点鎖線のように異なる経路を排除することを示す。なお本実施の形態における図示する例では、ランドマークは駐車枠線のみとして説明する。

（車載処理装置１２０の動作概要）
車載処理装置１２０は、主に２つの動作フェーズ、すなわち記録フェーズと自動駐車フェーズを有する。車載処理装置１２０はユーザからの特別の指示がなければ自動駐車フェーズで動作する。すなわち、記録フェーズはユーザの指示で開始される。

記録フェーズではユーザにより車両１が運転され、車載処理装置１２０は車両１が備えるセンサからの情報に基づき駐車場データ、すなわち駐車場に存在する白線や障害物の情報、車両１の走行経路、および駐車位置の情報を収集する。車載処理装置１２０は、収集した情報を駐車場点群１２４Ａとして記憶部１２４に格納する。

自動駐車フェーズでは車載処理装置１２０により車両１が制御され、記憶部１２４に格納された駐車場点群１２４Ａ、および車両１が備えるセンサからの情報に基づき、あらかじめ定められた駐車位置に車両１が駐車される。車載処理装置１２０は、センサからの情報に基づき車両１の周囲に存在する白線や障害物を検出し、記録されている車両１の走行経路に基づき選択した駐車場点群１２４Ａのランドマークと照合することにより現在位置を推定する。すなわち車載処理装置１２０はＧＰＳ受信機１０７から得られる情報を用いることなく、駐車場座標系における車両１の現在位置を推定する。

（記録フェーズのフローチャート）
図４は、車載処理装置１２０の記録フェーズの動作を表すフローチャートである。以下に説明する各ステップの実行主体は車載処理装置１２０の演算部１２１である。演算部１２１は、図４に示す処理を行う場合に点群データ取得部１２１Ａとして機能する。

ステップＳ５０１では、記録開始ボタン１１０Ａが押されたか否かが判断される。記録開始ボタン１１０Ａが押されたと判断する場合はステップＳ５０１Ａに進み、押されていないと判断する場合はステップＳ５０１に留まる。ステップＳ５０１Ａでは、ＲＡＭ１２２に新たな記録領域を確保する。この記憶領域には、抽出した点群と車両１の走行経路が前述の局所座標系の座標で記録される。

ステップＳ５０２では、センサ群から情報を取得して前述のランドマーク測位、すなわちカメラ１０２の撮影画像を用いたランドマークを構成する点群の抽出を行う。続くステップＳ５０３では、カメラ１０２が前回撮影してから最新の撮影を行うまでの時間における車両１の移動量を推定し、ＲＡＭ１２２に記録されている車両１の現在位置を更新する。ただし最終的には車両１が移動した座標の履歴を走行経路として記録するので、ステップＳ５０３では実際には現在位置を上書きするのではなく、従前の位置情報も残したまま新たに位置情報を記録する。

なお車両１の移動量は複数の手段により推定可能であり、たとえば前述のようにカメラ１０２の撮影画像における路面に存在する被写体の位置の変化から車両１の移動量を推定できる。また、ＧＰＳ受信機１０７として誤差が小さい高精度なＧＰＳ受信機が搭載されている場合には、その出力を利用してもよい。次にステップＳ５０４に進む。

ステップＳ５０４では、ステップＳ５０２において抽出した点群を、ステップＳ５０３において更新した現在位置に基づき、局所座標系の座標としてＲＡＭ１２２に保存する。続くステップＳ５０５では、記録完了ボタン１１０Ｂが押されたか否かを判断し、記録完了ボタン１１０Ｂが押されたと判断する場合はステップＳ５０６に進み、記録完了ボタン１１０Ｂが押されていないと判断する場合はステップＳ５０２に戻る。ステップＳ５０６では、ＧＰＳ受信機１０７から車両１の現在の緯度経度を取得するとともに、駐車位置、すなわち車両１の現在位置であって車両１の四隅の局所座標系における座標を記録する。次にステップＳ５０７に進む。

ステップＳ５０６では、ステップＳ５０５Ａにおいて取得した車両１の現在の緯度経度と略一致する緯度経度を有する駐車場データが、駐車場点群１２４Ａに記録されているか否かを判断する。車両１の現在の緯度経度が駐車場点群１２４Ａに記録されているいずれかの駐車場データの緯度経度と略一致すると判断する場合はステップＳ５０７に進み、それ以外の場合はステップＳ５１０に進む。ステップＳ５１０では、ＲＡＭ１２２に保存した点群データ、およびステップＳ５０５Ａにおいて記録した車両１の緯度経度、および駐車位置を新たな駐車場データとして駐車場点群１２４Ａに記録する。以上で図４のフローチャートを終了する。

（自動駐車フェーズ）
ユーザが車両１を運転して駐車場点群１２４Ａに記録されているいずれかの駐車場の付近まで移動させると、表示装置１１１に自動駐車可能な旨が表示される。この際にユーザが自動駐車ボタン１１０Ｃを押すと、車載処理装置１２０による自動駐車処理が開始される。車載処理装置１２０の動作をフローチャートを用いて以下説明する。

（自動駐車処理の全体フロー）
図５は、車載処理装置１２０の自動駐車フェーズの全体動作を表すフローチャートである。以下に説明する各ステップの実行主体は車載処理装置１２０の演算部１２１である。

車載処理装置１２０は、まずＧＰＳ受信機１０７を用いて現在の緯度経度を測位し（ステップＳ６０１）、その緯度経度が、駐車場点群１２４Ａのいずれかの駐車場データの緯度経度と略一致するか否かを判定する。換言すると車両１の位置から所定の距離以内に存在する駐車場の有無を判断する（ステップＳ６０２）。いずれかの駐車場データの緯度経度と車両１の緯度経度が略一致すると判断する場合はステップＳ６０３に進み、いずれの駐車場データの緯度経度とも略一致しないと判断する場合はステップＳ６０１に戻る。なおステップＳ６０１に戻る場合は、ユーザの運転により車両１が移動することによりステップＳ６０２において肯定判断される可能性がある。

そして車載処理装置１２０は、駐車場点群１２４Ａに含まれる複数の駐車場データのうち、車両１の現在位置と略一致する緯度経度を有する駐車場データを特定する（ステップＳ６０３）。次に車載処理装置１２０は、初期化処理としてＲＡＭ１２２に格納される局所周辺情報１２２Ａの初期化、およびＲＡＭ１２２に保存される車両１の現在位置の初期化を行う。具体的には従前の情報が記録されていたら消去し、新たな座標系を設定する。本実施の形態では前述のとおり、この座標系を「局所座標系」と呼んでいる。この局所座標系はステップＳ６０３Ａが実行された際の車両１の位置および姿勢に基づき設定される。たとえばステップＳ６０３Ａが実行された際の車両１の位置が局所座標系の原点に設定され、ステップＳ６０３Ａが実行された際の向きによりＸ軸およびＹ軸が設定される。また車両１の現在位置の初期化は、車両１の現在位置が原点（０、０）に設定される。

次に車載処理装置１２０は、図６に示す手順により自己位置推定、すなわち車両１の駐車場座標系における位置を推定し（ステップＳ６０４）、ステップＳ６０５では自己位置が推定できたか否かを判断する。車載処理装置１２０は、推定できたと判断する場合はステップＳ６０６に進み、推定できないと判断する場合はステップＳ６０４に戻る。

ステップＳ６０６では、車載処理装置１２０は表示装置１１１に自動駐車が可能な旨を表示し、続くステップＳ６０７ではユーザにより自動駐車ボタン１１０Ｃが押されたか否かを判断する。車載処理装置１２０は、自動駐車ボタン１１０Ｃが押されたと判断する場合はステップＳ６０８に進んで図７に示す手順により自動駐車処理を実行し、自動駐車ボタン１１０Ｃが押されていないと判断する場合はステップＳ６０６に戻る。

（自己位置推定処理）
図６～図８を参照して、図５のステップＳ６０４において実行される自己位置推定処理の詳細を説明する。図６は、自己位置推定処理の詳細を示すフローチャートである。図７～図８は、自己位置推定処理の概要を示すイメージ図である。演算部１２１は、図６のステップＳ６２３～Ｓ６２５に示す処理を行う場合に局所周辺情報作成部１２１Ｂとして機能する。

ステップＳ６２０では車載処理装置１２０は、図５のステップＳ６０３において特定した駐車場点群１２４Ａに含まれる車両１の走行経路を読み込み、距離方向にＮ個に分割する。以下では、走行経路を分割したそれぞれの領域を「セクション」と呼ぶ。走行経路は、１台の車両１が駐車場の入り口から駐車位置まで走行した一本の軌跡なので、任意の数に分割可能である。なお分割は等分が望ましいが必ずしも等分でなくてもよい。分割数Ｎは２以上の規定値である。図７に示す例では、分割数Ｎを「７」にしており、走行経路Ｔが７分割される。これにより図７に示す例では、第１セクションＴ１～第７セクションＴ７までの７つのセクションに分割される。

続くステップＳ６２１では車載処理装置１２０は、図５のステップＳ６０３において特定した駐車場点群１２４Ａに含まれる駐車領域を読み込み、車両１がこれから走行する走行方向を特定する。本実施の形態ではこれから車両１が駐車領域に向かうので、ステップＳ６２１では具体的には走行経路の両端のうち、駐車領域に遠い端部から駐車領域に近い端部へ向かう方向に走行すると判断する。

図８に示す例では、ステップＳ６２０において読み込んだ走行経路Ｔと、ステップＳ６２１において読み込んだ駐車領域９０３が示されている。ここでは、走行経路Ｔの両端を第１端４０３と第２端４０４とした。図８に示す例では、第１端４０３の方が第２端４０４よりも駐車領域９０３に近いので、車両１の走行方向は、車載処理装置１２０により第２端４０４から第１端４０３に向かう方向４０２であると特定される。図６に示すフローチャートに戻って説明を続ける。

続くステップＳ６２２では車載処理装置１２０は、各セクションにおける車両１の初期位置および初期方向を特定してステップＳ６２３に進む。ただしここで特定する位置および方向は、自動駐車フェーズを実行している現在の車両１ではなく、記録フェーズが実行された過去の車両１に関するものである。初期位置は、各セクションの端部のうち走行方向と逆側の端部である。初期方向は、ステップＳ６２０において読み込んだ走行経路を構成する車両１の位置同士の位置関係であって、初期位置とその前、初期位置とその後、または初期位置とその前後との位置関係により決定される。

図８の第２セクションＴ２を例に初期位置と初期方向を説明する。第２セクションＴ２の両端は符号４１０と符号４２０の位置である。この両端のうち、進行方向４０２の逆側の端部、すなわち符号４１０の位置が初期位置である。なお仮に進行方向が逆の場合には、第２セクションＴ２の初期位置は符号４２０の位置となる。符号４１０の位置付近を拡大した拡大図を図８の中央に示す。ステップＳ６２０において読み込んだ走行経路を構成する車両１の位置は、進行方向４０２に向かって、符号４０９、符号４１０、符号４１１、符号４１２の順番で存在する。この場合に、初期方向は、符号４０９から符号４１０に向かう矢印４２１の方向でもよいし、符号４１０から符号４１１に向かう矢印４２２の方向でもよいし、矢印４２１と矢印４２２を合成して得られる方向でもよい。なお２つの矢印の合成とは、それぞれの矢印をベクトルとして扱い、ベクトル合成により得られる方向である。図６に示すフローチャートに戻って説明を続ける。

ステップＳ６２２の次に、または後述するステップＳ６２７において否定判断されるとステップＳ６２３～Ｓ６２５が実行される。ステップＳ６２３のランドマーク測位、ステップＳ６２４の自車移動量推定、およびステップＳ６２５の局所周辺情報１２２Ａの記録はそれぞれ、図４のステップＳ５０２～Ｓ５０４の処理と概ね同じである。相違点はＲＡＭ１２２に記憶されるデータが局所周辺情報１２２Ａとして記録される点である。ステップＳ６５３の実行が完了すると、車載処理装置１２０は図９に詳細を示すセクションごとの一致度の評価を行う（ステップＳ６２６）。

ステップＳ６２６の処理が完了すると、車載処理装置１２０は次にステップＳ６２７を実行する。ステップＳ６２７では車載処理装置１２０は、ステップＳ６２６における評価の結果、一致度が減少しないセクションが１つのみ存在するか否か、すなわち車両１が移動しても一致度が一定、または一致度が増加するセクションが１つのみ存在するか否かを判断する。車載処理装置１２０は肯定判断する場合はステップＳ６２８に進み、否定判断する場合はステップＳ６２３に戻る。ステップＳ６２８では車載処理装置１２０は、ステップＳ６２７において肯定判断されたセクションにおける位置情報を採用して図６に示す処理を終了する。

ただし車載処理装置１２０はステップＳ６２６において一致度が減少しないセクションが複数存在する場合にもステップＳ６２７において肯定判断し、ステップＳ６２８ではそれらのセクションの中で一致度が最も高いセクションの位置情報を採用してもよい。

（セクションごとの一致度評価）
図９～図１２を参照して、図６のステップＳ６２６において実行される、セクションごとの一致度評価の詳細を説明する。図９は、セクションごとの一致度を評価する処理の詳細を示すフローチャートである。図１０～図１１は、一致度の評価の概要を示すイメージ図である。なお図１０～図１１は、先に示した図７および図８の例と同一の場面である。図１２は、マッチングの制限を示す図である。

図９に示す処理の概要を説明する。車両１は常に同一の経路を走行するので、自動駐車フェーズを開始した際の車両１の現在位置は、読み込んだ走行経路上に存在することが想定される。ただし走行経路上の具体的な位置を直ちに特定することは不可能なので、次のように処理する。すなわち記録フェーズに記録した走行経路を複数のセクションに分割し、それぞれのセクションにおいて自動駐車フェーズで収集するランドマークと記録済みのランドマークとの一致を評価する。

セクションごとの評価を詳述すると、あらかじめセクションごとに駐車場点群１２４Ａを用いて駐車場座標系における初期位置と初期方向を算出しておく。そして、自動駐車フェーズを開始した際の車両１の位置および方向が、各セクションにおける算出済みの初期位置と初期方向に一致していると仮定する。以下では、駐車場座標系における車両１の仮想的な位置を「仮想点」とも呼ぶ。本実施の形態では仮想点はセクションと同じ数だけ存在し、そのうち１つのみが実際の車両１の位置に非常に近い。

自動駐車フェーズにおいて車両１が移動するたび、進行方向が変更になるたびに、仮想点の位置と仮想的な車両１の進行方向を更新する。このように仮想点の位置と向きを更新し、駐車場座標系における仮想的な車両１の周辺のランドマークを駐車場点群１２４Ａから読み出して、実際に自動駐車フェーズにおいて車両１が取得したランドマークと比較する。

この比較を複数のセクションで実行すると、実際に車両１が存在するセクションでは、仮想的な車両１の周辺のランドマークと実際に自動駐車フェーズにおいて車両１が取得したランドマークとが高い一致率を示す。その他のセクションでは少なくともランドマーク同士の一致率は低くなる。そして、車両１が存在するセクション内の車両１の詳細な位置を算出して車両１の現在位置とする。以下、図９の処理を説明する。

図９に示す処理では車載処理装置１２０は、それぞれのセクションについて、ステップＳ６４０およびステップＳ６４６で挟まれた各ステップの処理を実行する。換言すると車載処理装置１２０は、処理対象とするセクションを次々に変更して、全てのセクションを対象としてステップＳ６４１からステップＳ６４５までの処理を行う。それらの処理は順番に行われてもよいし、他のセクションの処理の完了を待たず並列に行われてもよい。以下ではステップＳ６４１からステップＳ６４５までの各ステップの処理を説明する。

ステップＳ６４１では車載処理装置１２０は、自動駐車フェーズを開始した際の車両１の位置および進行方向と、現在の車両１の位置および進行方向の差を算出し、移動量および方向変化を取得する。ステップＳ６４１において得られる情報はたとえば、”１ｍ直進、方向変化なし”、や”初期方向に１０ｍ、右方向に３ｍ、方向変化＋９０度”などである。

続くステップＳ６４２では車載処理装置１２０は、ステップＳ６０３において特定した駐車場点群の駐車場座標系における仮想的な車両１の位置と向きを算出する。各セクションにおける初期位置および初期方向はステップＳ６２２において算出済みであり、初期状態からの変化量はステップＳ６４１において算出済みである。そのためステップＳ６４２では具体的には、ステップＳ６２２の算出結果と、ステップＳ６４１の算出結果の和を算出する。

図１０は、ステップＳ６４１の演算結果が所定距離の直進のみであった場合の、ステップＳ６４２の処理結果である仮想的な車両１の位置を示す図である。第１セクションＴ１～第７セクションＴ７のそれぞれにおいて進行方向の後方に示す符号、たとえばＴ１１やＴ２１などが初期位置であり、進行方向の前方に示す符号、たとえばＴ１２やＴ２２などがステップＳ６４２において算出された位置である。第１～第３セクションでは図示上方への移動、第４セクションでは斜め上への移動、第５～第７セクションでは図示右側への移動となっている。これは、直進が初期の車両１の進行方向の影響を受けたためである。すなわちセクションごとに初期状態における車両１の進行方向が異なっていたので、仮想的な車両１の位置変化がセクションごとに異なる結果となった。フローチャートに戻って説明を続ける。

続くステップＳ６４３では車載処理装置１２０は、Ｓ６４２において算出した位置および進行方向に基づき駐車場点群からランドマークを抽出する。たとえばＳ６４２において算出した位置を中心とし、Ｓ６４２において算出した進行方向を正面として、車両の幅方向に第１の所定長さ、車両の前後方向に第２の所定長さの領域に含まれるランドマークを抽出する。

図１１は、ステップＳ６４３の処理結果の一例を示す図である。ただし図１１は図１０に示した処理結果を前提としている。図１１に示すように、第１セクションＴ１では位置Ｔ１２を中心とした図示縦長の領域Ｔ１２Ａに含まれるランドマークが抽出される。同様に、第２セクションＴ２では領域Ｔ２２Ａに含まれるランドマークが抽出される。ただし領域Ｔ２２Ａは、図示の都合により少し右にずらして記載している。第３セクションＴ３では、車両１の初期の進行方向が斜め上方向であり、進行方向の変化がなかったことから、ランドマークを抽出する領域Ｔ４２Ａも傾いている。第５～第７セクションでは、車両１は図示右方向を向いているので、横長の領域からランドマークを抽出する。フローチャートに戻って説明を続ける。

続くステップＳ６４４では車載処理装置１２０は、Ｓ６３４において抽出したランドマークと、局所周辺情報とのマッチングを行う。このマッチングには、既知の手法であるＩＣＰ（Iterative Closest Point）などを用いることができる。ステップＳ６４４では並進や回転を組み合わせて両者が最もよく一致する状態を探索し、その一致の度合いを一致度として評価する。すなわちステップＳ６４４の演算結果として、処理対象のセクションに車両１が存在すると仮定した場合の、駐車場座標系における車両１の位置と一致度が得られる。

なお、駐車場座標系における車両１の位置が特定されることは、駐車場座標系と局所座標系の対応関係が数式として算出されることと等価である。またステップＳ６４４では、車両１が従前に記録された走行経路を移動していることを前提とすれば、回転角度に制限を設けること（以下、「角度限定比較」とも呼ぶ）、および並進移動量に制限を設けること（以下、「移動限定比較」とも呼ぶ）が望ましい。たとえば角度限定比較では、±１５度、正負の合計で３０度までしか回転させずにマッチングを行わせる。

図１２は、角度限定比較および移動制限比較を説明する図である。図１２（ａ）は局所周辺情報１２２Ａにおけるランドマークの概念図であり、図１２（ｂ）はステップＳ６４３の処理により駐車場点群から抽出されたランドマークの概念図である。図１２（ａ）および図１２（ｂ）において、矢印は車両１の進行方向を示し、四角の枠はランドマークの範囲を示す。なお図１２では、位置と角度の相違を矢印だけで視覚的に表現することが困難なためにランドマークの範囲を示す四角を表示しているにすぎない。図１２（ａ）と図１２（ｂ）では便宜的に両者のランドマークの範囲を同一としているが、両者の範囲が同一であることは必須ではない。

図１２（ｃ）～（ｆ）では並進や回転の例を示しているが、ここでは便宜的に局所周辺情報１２２Ａにおけるランドマークの位置を固定し、駐車場点群から抽出されたランドマークだけを移動させている。図１２（ｃ）は、並進移動量と回転角度がともにゼロであるマッチングを示す概念図である。図１２（ｃ）では、図１２（ａ）と図１２（ｂ）に示した四角がぴったりと重なっており、仮想点における車両１の進行方向と局所周辺情報を生成した際の車両１の進行方向とが一致しており、並進移動もない。

図１２（ｄ）は、回転角度はゼロで車両１の進行方向の並進移動のみゼロではないマッチングを示す概念図である。図１２（ｄ）では２つの矢印が同じ方向を向いているので回転角度がゼロであることがわかり、２つの四角の位置が矢印方向にずれているので、並進移動がゼロではないことがわかる。

図１２（ｅ）は、並進移動がゼロ、回転角度が２０度のマッチングを示す概念図である。図１２（ｆ）は、並進移動がゼロ、回転角度が４０度のマッチングを示す概念図である。図１２（ｅ）に示す回転角度が２０度の状態は、仮想点における車両１の進行方向と局所周辺情報を生成した際の車両１の進行方向とが一致する角度から２０度回転させた状態とも言える。角度限定比較では、この回転角度に制限を設けることでマッチングを高速化する。本実施の形態では、角度の推定も行っているので車両１が実際に存在するセクションでは少ない回転角度で最適なマッチングが得られることが見込まれるので、角度限定比較が有効である。図９に戻ってフローチャートの説明を続ける。

続くステップＳ６４５では車載処理装置１２０は、ステップＳ６４４におけるマッチングの結果を評価する。結果の評価には、たとえばＩＣＰの評価値をそのまま用いてもよいし、対応する特徴点同士の距離が所定値以下の特徴点の数で評価してもよい。以上、ステップＳ６４１～ステップＳ６４５の処理を説明した。車載処理装置１２０は、ステップＳ６４１～ステップＳ６４５の処理を全てのセクションについて実行すると図９の処理を終了する。

（自動駐車処理）
図１３を参照して図５のステップＳ６０８において実行される自動駐車処理の詳細を説明する。以下に説明する各ステップの実行主体は車載処理装置１２０である。ステップＳ６６１では、駐車場座標系における車両１の位置を推定する。本ステップにおける処理は図５のステップＳ６０４と同様なので説明を省略する。続くステップＳ６６２では、ステップＳ６６１において推定した位置から、駐車場点群１２４Ａに格納されている駐車位置までの走行経路を既知の経路生成手法により生成する。次にステップＳ６６３に進む。

ステップＳ６６３では、車両制御装置１３０を介して操舵装置１３１、駆動装置１３２、および制動装置１３３を制御し、ステップＳ６６２において生成した経路に沿って車両１を駐車位置まで移動させる。ただし自動駐車ボタン１１０Ｃがユーザにより押され続けている場合だけ駆動装置１３２に動作指令を出力してもよい。また、カメラ１０２の撮影画像から人物や移動車両などが抽出されたら制動装置１３３を動作させて車両１を停止させる。続くステップＳ６６４ではステップＳ６６１と同様に車両１の位置を推定する。続くステップＳ６６５では駐車が完了したか否か、すなわち車両１が駐車位置に到達したか否かを判断し、駐車が完了していないと判断する場合はステップＳ６６３に戻り、駐車が完了したと判断する場合は図１３のフローチャートを終了する。

上述した第１の実施の形態によれば、次の作用効果が得られる。
（１）車載処理装置１２０は、物体の一部を表す点の第１座標系、すなわち駐車場座標系における複数の座標が含まれる点群データである駐車場点群１２４Ａが格納される記憶部１２４と、車両１の周囲の情報を取得するセンサの出力を取得するセンサ入力部、すなわちＩＦ１２５と、車両１の移動に関する情報である車両移動情報を取得する移動情報取得部、すなわちＩＦ１２５と、センサ入力部、および移動情報取得部が取得する情報に基づき、第２座標系、すなわち局所座標系における車両１の位置および物体の一部を表す点の座標が複数含まれる局所周辺情報１２２Ａを生成する局所周辺情報作成部１２１Ｂと、駐車場点群１２４Ａと局所周辺情報とに基づき駐車場座標系と局所座標系の関係を推定し、駐車場座標系における車両の位置を推定する位置推定部１２１Ｃとを備える。駐車場点群１２４Ａには、駐車場座標系における車両の走行経路が含まれる。位置推定部１２１Ｃは、車両１が駐車場点群１２４Ａに含まれる走行経路を走行していることを前提として駐車場座標系と局所座標系の関係を推定する。そのため位置推定部１２１Ｃは局所座標系の点群と比較すべき駐車場座標系の領域を絞り込めるので、位置特定の精度が向上し、演算の速度も向上できる。

（２）位置推定部１２１Ｃは、図９のステップＳ６４３に記載したように、点群データのうち、走行経路上のいずれかの点を起点とし、車両移動情報に基づき移動した点である仮想点を中心とする領域に含まれる記録済み特徴点と、局所周辺情報とを比較することで駐車場座標系と局所座標系の関係を推定する。そのため車両１の移動を駐車場座標系に反映したうえで点群同士を比較できる。

（３）位置推定部１２１Ｃは、図６のステップＳ６２２に記載したように、走行経路に含まれる複数の座標を用いて駐車場座標系における車両１の進行方向を推定する。位置推定部１２１Ｃは、仮想点における車両１の進行方向と局所周辺情報を生成した際の車両１の進行方向とが一致する角度から所定範囲の角度で、仮想点を中心とする領域に含まれる記録済み特徴点と局所周辺情報との比較を行う。

（４）位置推定部１２１Ｃは、走行経路を複数のセクションに分割し、セクションにおける走行経路の端部を起点として車両１の移動にあわせて仮想点を移動させる。位置推定部１２１Ｃは、図９のステップＳ６４４において、仮想点の移動に伴う角度限定比較の結果の変化に基づき複数のセクションから１つのセクションを選択し、選択した一つのセクションに車両が存在するとして駐車場座標系と局所座標系の関係を推定する。そのため、図１２を参照して説明したように、マッチングの回転角度を制限することで処理を高速化できる。

（５）点群データには、駐車場座標系における車両１の目的地、すなわち駐車領域の座標が含まれる。位置推定部１２１Ｃは、走行経路における車両の走行方向を、目的地の座標に近づく方向と推定する。そのため記録フェーズにおいて車両１の進行方向を記録していなくても車両１の進行方向を推定することで、進行方向を利用した演算が可能となる。

（変形例１）
図１４は、変形例１における駐車場点群１２４Ｂの一例を示す図である。図１４に示すように、駐車場点群１２４Ｂには、走行経路を構成する各座標における車両１の進行方向の情報が記録されていてもよい。この場合は図４のステップＳ５０４において、車両１の進行方向も記録する。また図６のステップＳ６２２では、駐車場点群１２４Ｂから記録されている進行方向を読み出せばよい。

この変形例１によれば、次の作用効果が得られる。
（６）点群データには、走行経路を走行した際の車両１の進行方向の情報が含まれている。位置推定部１２１Ｃは、仮想点における車両の進行方向と局所周辺情報を生成した際の車両の進行方向とが一致する角度から所定範囲の角度で、仮想点を中心とする領域に含まれる記録済み特徴点と局所周辺情報との比較である角度限定比較を行う。そのため記録時の車両１の進行方向を演算する必要がなく、記録された正確な進行方向を用いることができる。

（変形例２）
図９に示すセクションごとの一致度の評価において、経路の乖離を理由として詳細なマッチングを行うことなく候補から除外してもよい。すなわちステップＳ６４２において算出した位置と走行経路Ｔとの距離が所定の距離以上の場合には、ステップＳ６４３およびステップＳ６４４を演算することなく一致度合いを最低の値、たとえばゼロとしてもよい。たとえば図１の第４セクションＴ４では、位置Ｔ４２は走行経路Ｔから外れているので第４セクションＴ４はステップＳ６４３およびステップＳ６４４を実行しなくてもよい。

この変形例２によれば、経路情報を利用することで偶然に無関係な位置を推定することを防止しつつ計算量を削減できる。

（変形例３）
上述した第１の実施の形態では、仮想点を自動駐車フェーズにおける車両１の移動量および進行方向に同期して移動させた。しかし仮想点を車両１の移動量のみに同期させて移動させてもよい。この場合には、図９のステップＳ６４１では方向変化の算出を省略し、ステップＳ６４２では仮想点の位置のみを算出する。そしてステップＳ６４３では車載処理装置１２０は、記録フェーズにおける仮想点での車両１の進行方向を推定してその進行方向を用いる。車両１の進行方向の推定方法は、図６のステップＳ６２２において説明したとおりである。

図１５は、変形例３におけるステップＳ６４１の演算結果が所定距離の直進のみであった場合の、ステップＳ６４２の処理結果である仮想点の位置を示す図であり、第１の実施の形態における図１０に対応する。第１の実施の形態では、車両１の移動に合わせて仮想点を移動させていたので、走行経路Ｔがカーブしている第４セクションＴ４では仮想点Ｔ４２が走行経路Ｔから外れていた。しかし本実施の形態では車両１の移動量に基づき、車両１を進行方向に移動させるだけなので、仮想点は常に経路Ｔの上に存在する。

この変形例３によれば、次の作用効果が得られる。
（７）位置推定部１２１Ｃは、点群データのうち、走行経路上のいずれかの点である仮想点を中心とする領域に含まれる記録済み特徴点と、局所周辺情報とを比較することで駐車場座標系と局所座標系の関係を推定する。そのため車両１の移動量だけを考慮して仮想点を移動させればよいので第１の実施の形態に比べて計算が簡略できる。また計算を簡略した影響は車両１が存在するセクションではほとんど影響を受けないのでデメリットが少ない。

なお図１５に示した例では第４セクションＴ４の演算結果が第１の実施の形態の図１０と大きく異なるが、これは車両１が実際には存在しないセクションについての演算結果なので問題ない。仮に車両１が第４セクションＴ４を走行していたら、図１０でも仮想点は経路上に算出されたはずである。

（変形例４）
上述した第１の実施の形態では、ステップＳ６２６の演算は全てのセクションについて同様に繰り返し演算が実行された。しかし一致度が低いセクションについては演算を途中で打ち切ってもよい。たとえば一致度が所定の閾値よりも低いセクションは演算を停止し、残りのセクションだけステップＳ６２６の演算を継続する。

（変形例５）
車両１はカメラ１０２以外に車両１の周囲の情報を取得するセンサ、たとえば超音波センサやレーザーレンジファインダを備えてもよい。また車両１がカメラを備えることは必須ではなく、超音波センサやレーザーレンジファインダなどのランドマークを測定できるセンサを備えればよい。

―第２の実施の形態―
図１６～図１８を参照して、車載処理装置の第２の実施の形態を説明する。以下の説明では、第１の実施の形態と同じ構成要素には同じ符号を付して相違点を主に説明する。特に説明しない点については、第１の実施の形態と同じである。本実施の形態では、主に、駐車位置から駐車場の入り口まで自動走行する点で、第１の実施の形態と異なる。

（構成）
図１６は、第２の実施の形態に係る自動駐車システム１００Ａの全体構成図である。なお第２の実施の形態における自動駐車システム１００Ａは、車両１が駐車場から出る動作に注目しているので出庫システム１００Ａとも呼べる。自動駐車システム１００Ａは、第１の実施の形態における構成に加えて、携帯端末２と基地局３とを備える。また第２の実施の形態における車載処理装置１２０Ａは、第１の実施の形態における車載処理装置１２０と比較して、演算部１２１に応答部１２１Ｄをさらに備える。

携帯端末２はユーザが所持する移動可能な通信端末、たとえば携帯電話、スマートフォン、またはタブレット端末である。携帯端末２は通信部２Ａ、呼び出しアプリ２Ｂ、および不図示のユーザインタフェースを備える。通信部２Ａは、移動体通信事業者が提供する無線通信サービスを利用可能な通信モジュールであり、基地局３を経由して車載処理装置１２０Ａと通信する。呼び出しアプリ２Ｂは、携帯端末２に内蔵されるＣＰＵなどを利用して動作可能なアプリケーションであり、ユーザによる操作に基づき車載処理装置１２０Ａに信号を出力する。本実施の形態では２種類の信号を出力可能であり、第１の信号は駐車場の入り口に車両１を召喚する信号、第２の信号は車両１を停止させる信号である。呼び出しアプリ２Ｂは、起動されて１回目にボタンが押されると第１の信号を出力し、２回目にボタンが押されると第２の信号を出力する。あるいはボタンを押している間は第１の信号を出力し、ボタンを離すと第２の信号を出すようにしてもよい。

基地局３は、移動体通信事業者が無線通信サービスのために設置した無線通信施設である。図１６では基地局３は１つしか記載していないが、複数の基地局３が存在しており、それぞれの基地局３が相互に通信可能であってもよい。

車両１に備えられる通信装置１１４は、本実施の形態では基地局３を経由して携帯端末２と通信を行う。通信装置１１４は携帯端末２から信号を受信すると車載処理装置１２０Ａの演算部１２１に伝達する。応答部１２１Ｄは、通信装置１１４から伝達される信号に基づき車両１を後述するように制御する。なお以下では、応答部１２１Ｄが動作する動作フェーズを、自動出庫フェーズと呼ぶ。

（動作の概要）
本実施の形態では、車両１が駐車位置に停車しており、ユーザが車両１から降車して駐車場内にいる状態を想定する。なお車両１は、自動駐車フェーズを利用して車載処理装置１２０Ａにより駐車された、または記録フェーズを有効にしてユーザにより駐車されたとする。すなわち車両１が現在駐車されている駐車場の情報は、駐車場点群１２４Ａに含まれている。この前提において、ユーザは呼び出しアプリ２Ｂを用いて以下のことを実現する。ユーザが携帯端末２の呼び出しアプリ２Ｂを起動して第１の信号を送信すると、車載処理装置１２０Ａは車両１を駐車時と同じ経路に沿って走行させる。ユーザは、車両１が自分に近づくと呼び出しアプリ２Ｂを用いて第２の信号を送信し、車両１を停止させて乗車する。

（自動出庫フェーズのフローチャート）
図１７は、応答部１２１Ｄによる自動出庫フェーズの処理を表すフローチャートである。以下に説明する各ステップの実行主体は車載処理装置１２０ＡのＣＰＵである。応答部１２１Ｄは、第１の信号を受信すると図１７に示す処理を開始する。図１７に示す処理の一部は第１の実施の形態における図５と一部は同一である。同一する処理には同一のステップ番号を付して説明を省略する。ステップＳ６０１～ステップＳ６０３Ａまでの処理は図５と同様なので説明を省略する。

続くステップＳ６０３Ｂでは車載処理装置１２０Ａは、微速での進行を開始する。なお本ステップで開始する微速での進行はステップＳ６８０が実行されるまで継続する。このとき車載処理装置１２０は駐車場点群１２４Ａに記録されている駐車領域と走行経路の位置関係を用いて、適切にステアリング角度を操作する。たとえば図３に示すような走行経路Ｔと駐車領域９０３の関係の場合は、駐車領域から出るとすぐに左に曲がる。なおこのときは車両１の詳細な位置が判明していないので駐車車両などの障害物に接触する可能性が通常より高くなる。そのため、カメラ１０２から得られる情報だけでなく、車両１に他のセンサ、たとえば超音波センサやレーザレンジファインダが搭載される場合には、それらから得られる情報も用いて障害物を回避することが望ましい。

続くステップＳ６０４では車載処理装置１２０Ａは、自己位置推定を開始する。なお自己位置推定の手法は第１の実施の形態と概ね同じであるが、相違点を後述する。ステップＳ６０４の次に車載処理装置１２０ＡはステップＳ６０５を実行し、肯定判断するとステップＳ６８０に進んで自動出庫を開始し、否定判断するとステップＳ６０４に戻る。自動出庫の処理は後述する。

（自己位置推定処理）
自己位置推定処理の第１の実施の形態との違いを説明する。第１の実施の形態と第２の実施の形態とでは、車両１の走行方向が異なる。そのため第２の実施の形態では、ステップＳ６２１において特定される方向が、第１の実施の形態とは逆になる。第１の実施の形態では車載処理装置１２０は、走行経路の両端のうち、駐車領域に遠い端部から駐車領域に近い端部へ向かう方向に走行すると判断した。しかし第２の実施の形態では車載処理装置１２０Ａは、走行経路の両端のうち、駐車領域に近い端部から駐車領域に遠い端部へ向かう方向に走行すると判断する。

ステップＳ６２１において特定した走行方向が異なるので、ステップＳ６２２における初期位置、および初期方向もこれに合わせて変更される。ステップＳ６２３以降の処理は第１の実施の形態と同様である。ステップＳ６２６の詳細を示す図９の処理も第１の実施の形態と同様である。

（自動出庫）
図１８は、図１７のステップＳ６８０の詳細を示すフローチャートである。ステップＳ６８１では車載処理装置１２０Ａは、駐車場の入り口、すなわち記録されている走行経路の端部のうち、駐車領域から遠いほうの端部の座標までの経路を生成する。続くステップＳ６８２では車載処理装置１２０Ａは、ステップＳ６８１において生成した経路に沿うように車両１を制御する。続くステップＳ６８３では車載処理装置１２０Ａは自己位置推定を行う。

続くステップＳ６８４では車載処理装置１２０Ａは、第２の信号を受信したか否かを判断する。車載処理装置１２０Ａは第２の信号を受信したと判断する場合はステップＳ６８６に進み、第２の信号を受信していないと判断する場合はステップＳ６８５に進む。ステップＳ６８５では車載処理装置１２０Ａは、車両１が入り口に到達したか否かを判断し、入り口に到達したと判断する場合はステップＳ６８６に進み、入り口に到達していないと判断する場合はステップＳ６８２に戻る。ステップＳ６８６では車載処理装置１２０Ａは、車両１を停止させて図１６に示す処理を終了する。

上述した第２の実施の形態によれば、次の作用効果が得られる。
（８）出庫システム１００Ａは、車両１に搭載される車載処理装置１２０Ａ、および車載処理装置１２０Ａと通信する携帯端末２を備える。携帯端末２は、車載処理装置１２０Ａに第１の信号を出力する通信部２Ａを備える。車載処理装置１２０Ａは、物体の一部を表す点の第１座標系、すなわち駐車場座標系における複数の座標が含まれる点群データである駐車場点群１２４Ａが格納される記憶部１２４と、車両１の周囲の情報を取得するセンサの出力を取得するセンサ入力部、すなわちＩＦ１２５と、車両１の移動に関する情報である車両移動情報を取得する移動情報取得部、すなわちＩＦ１２５と、センサ入力部、および移動情報取得部が取得する情報に基づき、第２座標系、すなわち局所座標系における車両１の位置および物体の一部を表す点の局所座標系における座標が複数含まれる局所周辺情報１２２Ａを生成する局所周辺情報作成部１２１Ｂと、駐車場点群１２４Ａと局所周辺情報とに基づき駐車場座標系と局所座標系の関係を推定し、駐車場座標系における車両の位置を推定する位置推定部１２１Ｃとを備える。駐車場点群１２４Ａには、駐車場座標系における車両１の走行経路および車両１の始動位置、すなわち駐車領域が含まれる。位置推定部１２１Ｃは、車両１が駐車場点群１２４Ａに含まれる走行経路を走行していることを前提として駐車場座標系と局所座標系の関係を推定する。車載処理装置１２０Ａは、第１の信号を受信すると、位置推定部１２１Ｃを用いて駐車場座標系における車両の位置を推定し、車両制御装置１３０に動作指令を出力して始動位置から遠ざかる方向に走行経路に沿って車両を走行させる応答部１２１Ｄを備える。そのため、駐車位置に止めた車両１を駐車場の入り口まで召喚できる。

（９）携帯端末２の通信部２Ａはさらに、第２の信号を出力可能である。車載処理装置１２０Ａの応答部１２１Ｄは、第２の信号を受信すると車両を停止させる。そのためユーザは車両１を任意の位置で停車させることができる。

（第２の実施の形態の変形例１）
応答部１２１Ｄは、携帯端末２から位置情報を受信し、車載処理装置１２０Ａの位置が受信した位置情報が示す位置から所定距離以内の場合に車両１を停止させてもよい。

図１９は、第２の実施の形態の変形例１における自動駐車システム１００Ｂの全体構成図である。本変形例では、第２の実施の形態の構成に加えて、携帯端末２は携帯位置推定部２Ｃを備える点が異なる。また携帯端末２の呼び出しアプリ２Ｂの動作、および車載処理装置１２０Ａの応答部１２１Ｄの動作が第２の実施の形態と異なる。

携帯位置推定部２Ｃは、衛星航法システムを構成する複数の衛星から信号を受信し、受信した信号に基づく演算によりＧＰＳ受信機１０７の測地系における位置、すなわち緯度および経度を算出する。なお以下では、携帯位置推定部２Ｃが算出する測地系における位置を「携帯位置」とも呼ぶ。また携帯位置推定部２Ｃによる携帯位置の「算出」は、携帯位置の「推定」とも呼ぶ。

なお携帯位置推定部２Ｃは、通信部２Ａを介して位置の補正信号を受信し、その補正信号を利用して携帯位置の推定精度を向上させてもよい。また携帯位置推定部２Ｃは、無線ＬＡＮの通信モジュールをさらに備え、無線ＬＡＮを介して得られる補正信号を利用して携帯位置の推定精度を向上させてもよい。

本変形例では呼び出しアプリ２Ｂは、ユーザが携帯端末２の呼び出しアプリ２Ｂを起動して第１の信号を送信すると、携帯位置推定部２Ｃが推定した携帯位置を車載処理装置１２０Ａに送信する。呼び出しアプリ２Ｂによる携帯位置の送信は、第１の信号の送信とともに一度だけ送信してもよいし、所定時間ごと、たとえば１０秒ごとや１分毎に繰り返し送信してもよい。さらに繰り返し送信する場合は、過去に推定した携帯位置を送信するのではなく、その都度改めて携帯位置推定部２Ｃが携帯位置を推定し、新たに推定して得られた携帯位置を送信することが望ましい。

図２０は、本変形例における図１７のステップＳ６８０の詳細を示すフローチャートである。すなわち図２０は、第２の実施の形態における図１８に相当する。図２０は、図１８におけるステップＳ６８４の次にステップＳ６８４Ａが追加されている。以下では図１８との相違点を説明する。本変形例では車載処理装置１２０Ａは、ステップＳ６８４を肯定判断する場合は第２の実施の形態と同様にステップＳ６８６に進むが、ステップＳ６８４を否定判断する場合はステップＳ６８４Ａに進む。

ステップＳ６８４Ａでは車載処理装置１２０Ａは、ＧＰＳ受信機１０７が算出する車両位置と、携帯端末２から受信した携帯位置との距離が所定距離以内、たとえば３ｍ以内であるか否かを判断する。車載処理装置１２０Ａは、２つの位置の距離が所定距離以内と判断する場合はステップＳ６８６に進み、２つの位置の距離が所定距離よりも遠いと判断する場合はステップＳ６８５に進む。これ以降の処理は第２の実施の形態と同様なので説明を省略する。

本変形例によれば、次の作用効果が得られる。
（１０）携帯端末２は、携帯端末２の測地系における位置である携帯位置を推定する携帯位置推定部２Ｃを備える。携帯端末２の通信部２Ａは携帯位置を出力可能である。車載処理装置１２０Ａのインタフェース１２５は、車両１の測地系における位置である車両位置を推定するＧＰＳ受信機１０７から車両位置を取得する。車載処理装置１２０Ａの応答部１２１Ｄは、携帯端末２から受信した携帯位置と車両位置との差が所定の距離以内になると車両を停止させる。そのため、ユーザによる明示的な停止指令がなくても、携帯端末２を所持するユーザの近く車両１を停止させることができる。

（第２の実施の形態の変形例２）
第２の実施の形態の変形例１において、携帯端末２は第２の信号を出力できなくてもよい。この場合は車載処理装置１２０Ａは、図２０に示すフローチャートにおいて、ステップＳ６８３の処理が完了すると、ステップＳ６８４Ａに進む。

上述した各実施の形態および変形例において、車載処理装置１２０が実行するプログラムは不図示のＲＯＭ１２３に格納されるとしたが、プログラムは記憶部１２４に格納されていてもよい。また、車載処理装置１２０が不図示の入出力インタフェースを備え、必要なときに入出力インタフェースと車載処理装置１２０が利用可能な媒体を介して、他の装置からプログラムが読み込まれてもよい。ここで媒体とは、たとえば入出力インタフェースに着脱可能な記憶媒体、または通信媒体、すなわち有線、無線、光などのネットワーク、または当該ネットワークを伝搬する搬送波やディジタル信号、を指す。また、プログラムにより実現される機能の一部または全部がハードウエア回路やＦＰＧＡにより実現されてもよい。

上述した各実施の形態および変形例は、それぞれ組み合わせてもよい。上記では、種々の実施の形態および変形例を説明したが、本発明はこれらの内容に限定されるものではない。本発明の技術的思想の範囲内で考えられるその他の態様も本発明の範囲内に含まれる。

１ … 車両
２ … 携帯端末
２Ａ … 通信部
２Ｃ … 携帯位置推定部
１００、１００Ａ、１００Ｂ … 自動駐車システム
１０２ … カメラ
１０７ … ＧＰＳ受信機
１０８ … 車速センサ
１０９ … 舵角センサ
１２０ … 車載処理装置
１２１ … 演算部
１２１Ａ … 点群データ取得部
１２１Ｂ … 局所周辺情報作成部
１２１Ｃ … 位置推定部
１２１Ｄ … 応答部
１２２Ａ … 局所周辺情報
１２４ … 記憶部
１２４Ａ … 駐車場点群
１２５ … インタフェース
１３０ … 車両制御装置

Claims (9)

1. 物体の一部を表す点の第１座標系における複数の座標が含まれる点群データが格納される記憶部と、
   車両の周囲の情報を取得するセンサの出力を取得するセンサ入力部と、
   前記車両の移動に関する情報である車両移動情報を取得する移動情報取得部と、
   前記センサ入力部、および前記移動情報取得部が取得する情報に基づき、第２座標系における前記車両の位置および物体の一部を表す点の前記第２座標系における座標が複数含まれる局所周辺情報を生成する局所周辺情報作成部と、
   前記点群データと前記局所周辺情報とに基づき前記第１座標系と前記第２座標系の関係を推定し、前記第１座標系における前記車両の位置を推定する位置推定部とを備え、
   前記点群データには、前記第１座標系における前記車両の走行経路が含まれ、
   前記点群データには、前記走行経路を走行した際の前記車両の進行方向の情報が含まれ、
   前記位置推定部は、前記車両が前記点群データに含まれる走行経路を走行していることを前提として、前記点群データのうち、前記走行経路上のいずれかの点を起点とし、前記車両移動情報に基づき移動した点である仮想点を中心とする領域に含まれる記録済み特徴点と、前記局所周辺情報とを比較することで前記第１座標系と前記第２座標系の関係を推定し、
   前記位置推定部は、前記第１座標系と前記第２座標系の関係を推定する際に、前記仮想点における前記車両の進行方向と前記局所周辺情報を生成した際の前記車両の進行方向とが一致する角度から所定範囲の角度で、前記仮想点を中心とする領域に含まれる記録済み特徴点と前記局所周辺情報との比較である角度限定比較を行う車載処理装置。
2. 請求項１に記載の車載処理装置において、
   前記位置推定部は、前記走行経路に含まれる複数の座標を用いて前記第１座標系における前記車両の進行方向を推定し、
   前記位置推定部は、前記仮想点における前記車両の進行方向と前記局所周辺情報を生成した際の前記車両の進行方向とが一致する角度から所定範囲の角度で、前記仮想点を中心とする領域に含まれる記録済み特徴点と前記局所周辺情報との比較である角度限定比較を行う車載処理装置。
3. 請求項１に記載の車載処理装置において、
   前記位置推定部は、前記走行経路を複数のセクションに分割し、前記セクションにおける前記走行経路の端部を前記起点として前記車両の移動にあわせて前記仮想点を移動させ、
   前記仮想点の移動に伴う前記角度限定比較の結果の変化に基づき前記複数のセクションから１つの前記セクションを選択し、選択した一つの前記セクションに前記車両が存在するとして前記第１座標系と前記第２座標系の関係を推定する車載処理装置。
4. 請求項２に記載の車載処理装置において、
   前記点群データには、前記第１座標系における前記車両の目的地の座標が含まれ、
   前記位置推定部は、前記走行経路における前記車両の走行方向を、前記目的地の座標に近づく方向と推定する車載処理装置。
5. 請求項１に記載の車載処理装置において、
   前記位置推定部は、前記点群データのうち、前記走行経路上のいずれかの点である仮想点を中心とする領域に含まれる記録済み特徴点と、前記局所周辺情報とを比較することで前記第１座標系と前記第２座標系の関係を推定する車載処理装置。
6. 物体の一部を表す点の第１座標系における複数の座標が含まれる点群データが格納される記憶部、車両の周囲の情報を取得するセンサの出力を取得するセンサ入力部、および前記車両の移動に関する情報である車両移動情報を取得する移動情報取得部を備える前記車両に備えられる車載処理装置が実行する位置推定方法であって、
   前記センサ入力部、および前記移動情報取得部が取得する情報に基づき、第２座標系における前記車両の位置および物体の一部を表す点の前記第２座標系における座標が複数含まれる局所周辺情報を生成することと、
   前記点群データと前記局所周辺情報とに基づき前記第１座標系と前記第２座標系の関係を推定し、前記第１座標系における前記車両の位置を推定することと、
   前記点群データには、前記第１座標系における前記車両の走行経路が含まれ、
   前記点群データには、前記走行経路を走行した際の前記車両の進行方向の情報が含まれ、
   前記車両が前記点群データに含まれる走行経路を走行していることを前提として、前記点群データのうち、前記走行経路上のいずれかの点を起点とし、前記車両移動情報に基づき移動した点である仮想点を中心とする領域に含まれる記録済み特徴点と、前記局所周辺情報とを比較することで前記第１座標系と前記第２座標系の関係を推定することとを含み、
   前記第１座標系と前記第２座標系の関係を推定する際に、前記仮想点における前記車両の進行方向と前記局所周辺情報を生成した際の前記車両の進行方向とが一致する角度から所定範囲の角度で、前記仮想点を中心とする領域に含まれる記録済み特徴点と前記局所周辺情報との比較である角度限定比較を行う位置推定方法。
7. 車両に搭載される車載処理装置、および前記車載処理装置と通信する携帯端末を備える出庫システムであって、
   前記携帯端末は、
   前記車載処理装置に第１の信号を出力する通信部を備え、
   前記車載処理装置は、
   物体の一部を表す点の第１座標系における複数の座標が含まれる点群データが格納される記憶部と、
   車両の周囲の情報を取得するセンサの出力を取得するセンサ入力部と、
   前記車両の移動に関する情報である車両移動情報を取得する移動情報取得部と、
   前記センサ入力部、および前記移動情報取得部が取得する情報に基づき、第２座標系における前記車両の位置および物体の一部を表す点の前記第２座標系における座標が複数含まれる局所周辺情報を生成する局所周辺情報作成部と、
   前記点群データと前記局所周辺情報とに基づき前記第１座標系と前記第２座標系の関係を推定し、前記第１座標系における前記車両の位置を推定する位置推定部とを備え、
   前記点群データには、前記第１座標系における前記車両の走行経路、および前記第１座標系における前記車両の始動位置が含まれ、
   前記点群データには、前記走行経路を走行した際の前記車両の進行方向の情報が含まれ、
   前記位置推定部は、前記車両が前記点群データに含まれる走行経路を走行していることを前提として、前記点群データのうち、前記走行経路上のいずれかの点を起点とし、前記車両移動情報に基づき移動した点である仮想点を中心とする領域に含まれる記録済み特徴点と、前記局所周辺情報とを比較することで前記第１座標系と前記第２座標系の関係を推定し、
   前記位置推定部は、前記第１座標系と前記第２座標系の関係を推定する際に、前記仮想点における前記車両の進行方向と前記局所周辺情報を生成した際の前記車両の進行方向とが一致する角度から所定範囲の角度で、前記仮想点を中心とする領域に含まれる記録済み特徴点と前記局所周辺情報との比較である角度限定比較を行い、
   前記車載処理装置はさらに、
   前記第１の信号を受信すると、前記位置推定部を用いて前記第１座標系における前記車両の位置を推定し、前記始動位置から遠ざかる方向に前記走行経路に沿って前記車両を走行させる応答部を備える出庫システム。
8. 請求項７に記載の出庫システムにおいて、
   前記携帯端末の通信部はさらに、第２の信号を出力可能であり、
   前記車載処理装置の前記応答部は、前記第２の信号を受信すると前記車両を停止させる出庫システム。
9. 請求項７に記載の出庫システムにおいて、
   前記携帯端末は、前記携帯端末の測地系における位置である携帯位置を推定する携帯位置推定部をさらに備え、
   前記携帯端末の通信部はさらに、前記携帯位置を出力可能であり、
   前記車載処理装置は、前記車両の測地系における位置である車両位置を推定する車両位置推定部から前記車両位置を取得し、
   前記車載処理装置の前記応答部は、前記携帯端末から受信した前記携帯位置と前記車両位置との差が所定の距離以内になると前記車両を停止させる出庫システム。
   

Images