(57)【要約】【課題】従来、一つの観測データから移動体の位置認識と周辺オブジェクト認識を行い、移動体と周辺オブジェクトとの位置関係を出力できなかった。【解決手段】移動体の周辺に存在するオブジェクトの三次元空間における位置を特定する元になる１以上の元情報を取得する元情報取得部と、当該１以上の元情報を用いて、移動体位置情報を取得する移動体位置情報取得部と、当該１以上の元情報を用いて、１以上のオブジェクトを特定し、１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付けるオブジェクト認識部と、移動体位置情報と１以上の各オブジェクトの２以上のオブジェクト位置情報とを用いて、移動体と１以上の各オブジェクトの相対的な位置関係が認識可能な三次元の図である出力図を構成する出力図構成部と、出力図を出力する図出力部とを具備する情報処理装置により、課題を解決できる。【選択図】図１
2019075037.tif 000002
【特許請求の範囲】
【請求項１】
移動する移動体の周辺に存在するオブジェクトの三次元空間における位置を特定する元になる１または２以上の元情報を取得する元情報取得部と、
前記元情報取得部が取得した１以上の元情報を用いて、移動体の三次元空間における位置を特定する移動体位置情報を取得する移動体位置情報取得部と、
前記元情報取得部が取得した１以上の元情報を用いて、１以上のオブジェクトを特定し、当該１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付けるオブジェクト認識部と、
前記移動体位置情報と前記１以上の各オブジェクトの２以上のオブジェクト位置情報とを用いて、前記移動体と前記１以上の各オブジェクトの相対的な位置関係が認識可能な三次元の図である出力図を構成する出力図構成部と、
前記出力図を出力する図出力部とを具備する情報処理装置。
【請求項２】
前記元情報取得部は、
前記移動体の周辺の３６０度をカバーする１以上の元情報を取得し、
前記オブジェクト認識部は、
前記１以上の元情報を用いて、前記３６０度の範囲に存在する１以上のオブジェクトを特定し、当該１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付ける請求項１記載の情報処理装置。
【請求項３】
前記元情報取得部が取得した２以上の時点における２以上の元情報を用いて、前記オブジェクト認識部が特定した１以上の各オブジェクトの動作に関する動作情報を取得し、当該動作情報が予め決められた条件に合致するか否かを判断する判断部と、
前記判断部が前記条件に合致すると判断した場合に、当該判断に関する判断情報を出力する判断情報出力部とをさらに具備する請求項１または請求項２記載の情報処理装置。
【請求項４】
レーザー発信手段を識別するレーザー識別子と当該レーザー発信手段の位置を特定する発信手段位置情報と当該レーザー発信手段のレーダー発信の方向を特定する発信手段方向情報とを有する２以上のレーザー発信手段情報が格納される格納部をさらに具備し、
前記元情報取得部は、
２以上の各レーザー発信手段により発信されたレーザーの反射を受信し、レーザーの発信からその反射の受信までの戻り時間を取得し、当該戻り時間と前記レーザー発信手段を識別するレーザー識別子との組であるレーザー情報を、レーザー発信手段ごとに取得し、
前記オブジェクト認識部は、
前記元情報取得部が取得した２以上の各レーザー情報が有するレーザー識別子と対になる発信手段位置情報と発信手段方向情報と、当該レーザー情報が有する戻り時間とを用いて、オブジェクトのオブジェクト位置情報をレーザー情報ごとに取得し、当該取得した２以上のオブジェクト位置情報を用いて、１以上のオブジェクトを特定し、当該１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付ける請求項１から請求項３いずれか一項に記載の情報処理装置。
【請求項５】
前記元情報取得部は、
２以上の各時点における１以上の元情報を取得し、
前記移動体位置情報取得部は、
２以上の各時点における移動体位置情報を取得し、
前記オブジェクト認識部は、
２以上の各時点において、１以上のオブジェクトを特定し、当該１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付け、
前記出力図構成部は、
２以上の各時点において、前記オブジェクト認識部が認識した１以上のオブジェクトが含まれる図であり、前記移動体位置情報取得部が取得した２以上の各時点における移動体位置情報により構成される移動体の移動軌跡を示す軌跡情報が含まれる図である出力図を構成する請求項１から請求項４いずれか一項に記載の情報処理装置。
【請求項６】
元情報取得部、移動体位置情報取得部、オブジェクト認識部、出力図構成部、および図出力部により実現される情報処理方法であって、
前記元情報取得部が、移動する移動体の周辺に存在するオブジェクトの三次元空間における位置を特定する元になる１または２以上の元情報を取得する元情報取得ステップと、
前記移動体位置情報取得部が、前記元情報取得ステップで取得された１以上の元情報を用いて、移動体の三次元空間における位置を特定する移動体位置情報を取得する移動体位置情報取得ステップと、
前記オブジェクト認識部が、前記元情報取得ステップで取得された１以上の元情報を用いて、１以上のオブジェクトを特定し、当該１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付けるオブジェクト認識ステップと、
前記出力図構成部が、前記移動体位置情報と前記１以上の各オブジェクトの２以上のオブジェクト位置情報とを用いて、前記移動体と前記１以上の各オブジェクトの相対的な位置関係が認識可能な三次元の図である出力図を構成する出力図構成ステップと、
前記図出力部が、前記出力図を出力する図出力ステップとを具備する情報処理方法。
【請求項７】
コンピュータを、
移動する移動体の周辺に存在するオブジェクトの三次元空間における位置を特定する元になる１または２以上の元情報を取得する元情報取得部と、
前記元情報取得部が取得した１以上の元情報を用いて、移動体の三次元空間における位置を特定する移動体位置情報を取得する移動体位置情報取得部と、
前記元情報取得部が取得した１以上の元情報を用いて、１以上のオブジェクトを特定し、当該１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付けるオブジェクト認識部と、
前記移動体位置情報と前記１以上の各オブジェクトの２以上のオブジェクト位置情報とを用いて、前記移動体と前記１以上の各オブジェクトの相対的な位置関係が認識可能な三次元の図である出力図を構成する出力図構成部と、
前記出力図を出力する図出力部として機能させるためのプログラム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、移動体の周辺のオブジェクトの認識と当該移動体の位置認識とを共に行い、周辺オブジェクトと移動体との位置的関係が把握可能な図を構成し、出力する情報処理装置等に関するものである。
【背景技術】
【０００２】
従来、ＬＩＤＡＲという技術があった（例えば、非特許文献１参照）。ＬＩＤＡＲは、光を用いたリモートセンシング技術の一つで、パルス状に発光するレーザー照射に対する散乱光を測定し、遠距離にある対象までの距離やその対象の性質を分析するものである。
【０００３】
また、従来、距離画像カメラという技術があった（例えば、非特許文献２参照）。距離画像カメラは、立体的な距離情報がリアルタイムで得られるカメラである。
【先行技術文献】
【非特許文献】
【０００４】
【非特許文献１】ウィキペディア、"ＬＩＤＡＲ"、［online］、［平成２９年８月２６日検索］、インターネット［URL：https://ja.wikipedia.org/wiki/LIDAR］
【非特許文献２】"TOF 距離画像カメラの実力"、［online］、［平成２９年８月２６日検索］、インターネット［URL：http://www.brainvision.co.jp/wp/support/tech/capability_of_tofcamera.pdf#search=%27%E8%B7%9D%E9%9B%A2%E7%94%BB%E5%83%8F%E3%82%AB%E3%83%A1%E3%83%A9%27］
【発明の概要】
【発明が解決しようとする課題】
【０００５】
しかしながら、従来技術を用いた場合、自動運転などの複雑かつ高度な認識が必要なアプリケーションでは、センサ・フュージョンが必要とされる。なお、センサ・フュージョンとは、アプリケーションやシステムの性能を向上させるために、複数 のセンサからのデータをインテリジェントに組み合わせるソフトウェアである。そして、センサ・フュージョンは異なる性質を持つセンサの組み合わせにより、短所を補完してより堅牢な認識を可能とする技術であるが、システムの構築には困難が伴う。
【０００６】
また、例えば、３Ｄセンサと従来の２次元カメラ等、異なる特徴を持つセンサを用いた認識結果を組み合わせて有用なデータとして活用するためには、単一の座標系においてそれらの認識結果を解釈できなければならず、精緻な設置及びキャリブレーションを必要とする。また異なる種類の認識（例えば、周辺のオブジェクトの認識と自己位置の認識）をそれぞれ異なるセンサの観測データを用いて実現する場合、各センサの短所（暗所に弱い等）が異なることで、特定の状況で当該の認識が不可能となってしまい、結果としてシステムの機能が不完全なものとなってしまう。さらに、異なる種類のセンサの観測データに対して独立した認識処理を個々に実行する必要があるため、多くの計算能力を必要とし、高度なアプリケーションで必要とされるリアルタイム性に悪影響を与える。
【０００７】
つまり、従来技術において、一つの観測データ（後述する元情報）から移動体の位置の認識と当該移動体の周辺のオブジェクトの認識とを両方を行い、移動体と当該移動体の周辺のオブジェクトとの位置関係を出力できなかった。
【０００８】
かかる背景に鑑み、本発明は、センサから取得できた同一のデータに基づき、移動体の周辺の「オブジェクト認識」と移動体の「自己位置認識」という２つの異なる情報の認識を実現することを目的とする。
【課題を解決するための手段】
【０００９】
本第一の発明の情報処理装置は、移動する移動体の周辺に存在するオブジェクトの三次元空間における位置を特定する元になる１または２以上の元情報を取得する元情報取得部と、前記元情報取得部が取得した１以上の元情報を用いて、移動体の三次元空間における位置を特定する移動体位置情報を取得する移動体位置情報取得部と、元情報取得部が取得した１以上の元情報を用いて、１以上のオブジェクトを特定し、１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付けるオブジェクト認識部と、移動体位置情報と１以上の各オブジェクトの２以上のオブジェクト位置情報とを用いて、移動体と１以上の各オブジェクトの相対的な位置関係が認識可能な三次元の図である出力図を構成する出力図構成部と、出力図を出力する図出力部とを具備する情報処理装置である。
【００１０】
かかる構成により、センサから取得できた同一のデータに基づき、移動体の位置の認識と当該移動体の周辺のオブジェクトの認識を行い、移動体と当該移動体の周辺のオブジェクトとの位置関係を出力できる。
【００１１】
また、本第二の発明の情報処理装置は、第一の発明に対して、元情報取得部は、移動体の周辺の３６０度をカバーする１以上の元情報を取得し、オブジェクト認識部は、１以上の元情報を用いて、３６０度の範囲に存在する１以上のオブジェクトを特定し、１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付ける情報処理装置である。
【００１２】
かかる構成により、センサから取得できた同一のデータに基づき、移動体の位置の認識と当該移動体の全方位のオブジェクトの認識を行い、移動体と当該移動体の周辺のオブジェクトとの位置関係を出力できる。
【００１３】
また、本第三の発明の情報処理装置は、第一または第二の発明に対して、元情報取得部が取得した２以上の時点における２以上の元情報を用いて、オブジェクト認識部が特定した１以上の各オブジェクトの動作に関する動作情報を取得し、動作情報が予め決められた条件に合致するか否かを判断する判断部と、判断部が条件に合致すると判断した場合に、判断に関する判断情報を出力する判断情報出力部とをさらに具備する情報処理装置である。
【００１４】
かかる構成により、センサから取得できた同一のデータに基づき、移動体の位置の認識と当該移動体の周辺のオブジェクトの認識を行い、かつオブジェクトの動作が条件に合致した場合（例えば、危険な場合）に、その旨を報知できる。
【００１５】
また、本第四の発明の情報処理装置は、第一から第三いずれか１つの発明に対して、レーザー発信手段を識別するレーザー識別子とレーザー発信手段の位置を特定する発信手段位置情報とレーザー発信手段のレーダー発信の方向を特定する発信手段方向情報とを有する２以上のレーザー発信手段情報が格納される格納部をさらに具備し、元情報取得部は、２以上の各レーザー発信手段により発信されたレーザーの反射を受信し、レーザーの発信からその反射の受信までの戻り時間を取得し、戻り時間とレーザー発信手段を識別するレーザー識別子との組であるレーザー情報を、レーザー発信手段ごとに取得し、オブジェクト認識部は、元情報取得部が取得した２以上の各レーザー情報が有するレーザー識別子と対になる発信手段位置情報と発信手段方向情報と、レーザー情報が有する戻り時間とを用いて、オブジェクトのオブジェクト位置情報をレーザー情報ごとに取得し、取得した２以上のオブジェクト位置情報を用いて、１以上のオブジェクトを特定し、１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付ける情報処理装置である。
【００１６】
かかる構成により、レーザーの技術を用いて、センサから取得できた同一のデータに基づき、移動体の位置の認識と当該移動体の周辺のオブジェクトの認識を行い、移動体と当該移動体の周辺のオブジェクトとの位置関係を出力できる。
【００１７】
また、本第五の発明の情報処理装置は、第一から第四いずれか１つの発明に対して、元情報取得部は、２以上の各時点における１以上の元情報を取得し、移動体位置情報取得部は、２以上の各時点における移動体位置情報を取得し、オブジェクト認識部は、２以上の各時点において、１以上のオブジェクトを特定し、１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付け、出力図構成部は、２以上の各時点において、オブジェクト認識部が認識した１以上のオブジェクトが含まれる図であり、移動体位置情報取得部が取得した２以上の各時点における移動体位置情報により構成される移動体の移動軌跡を示す軌跡情報が含まれる図である出力図を構成する情報処理装置である。
【００１８】
かかる構成により、センサから取得できた同一のデータに基づき、移動体の位置の認識と当該移動体の周辺のオブジェクトの認識を行い、移動体移動履歴と、移動体と当該移動体の周辺のオブジェクトとの位置関係を出力できる。
【発明の効果】
【００１９】
本発明による情報処理装置によれば、センサから取得できた同一のデータに基づき、移動体の位置の認識と当該移動体の周辺のオブジェクトの認識を行い、移動体と当該移動体の周辺のオブジェクトとの位置関係を出力できる。
【図面の簡単な説明】
【００２０】
【図１】実施の形態１における情報処理装置１のブロック図
【図２】同情報処理装置１の動作例について説明するフローチャート
【図３】同元情報取得処理について説明するフローチャート
【図４】同オブジェクト認識処理について説明するフローチャート
【図５】同出力図構成処理について説明するフローチャート
【図６】同判断処理について説明するフローチャート
【図７】同情報処理装置１の概念図
【図８】同出力例を示す図
【図９】同出力例を示す図
【図１０】同出力例を示す図
【図１１】同出力例を示す図
【図１２】同出力例を示す図
【図１３】同コンピュータシステムの概観図
【図１４】同コンピュータシステムのブロック図
【発明を実施するための形態】
【００２１】
以下、情報処理装置等の実施形態について図面を参照して説明する。なお、実施の形態において同じ符号を付した構成要素は同様の動作を行うので、再度の説明を省略する場合がある。
【００２２】
（実施の形態１）
【００２３】
本実施の形態において、周辺オブジェクト認識と移動体の位置認識とを共に行い、周辺オブジェクトと移動体との位置的関係が把握可能な図を構成し、出力する情報処理装置について説明する。なお、本実施の形態において、移動体に対して、３６０度の方向のオブジェクトを認識する情報処理装置について説明する。なお、移動体は、自動車、ロボットなどである。ただし、移動体の種類は問わない。
【００２４】
また、本実施の形態において、オブジェクトの動作に関する動作情報を取得し、動作情報が予め決められた条件に合致する場合に、合致する旨を出力する情報処理装置について説明する。
【００２５】
さらに、本実施の形態において、移動体の移動履歴も出力できる情報処理装置について説明する。
【００２６】
図１は、本実施の形態における情報処理装置１のブロック図である。情報処理装置１は、格納部１１、受付部１２、処理部１３、および出力部１４を備える。なお、情報処理装置１は、移動体に設置されていても良いし、移動体から情報を取得して、所定の処理を行う装置でも良い。
【００２７】
処理部１３は、元情報取得部１３１、移動体位置情報取得部１３２、オブジェクト認識部１３３、出力図構成部１３４、および判断部１３５を備える。
【００２８】
出力部１４は、図出力部１４１、および判断情報出力部１４２を備える。
【００２９】
格納部１１には、各種の情報が格納される。各種の情報とは、例えば、２以上のレーザー発信手段情報である。レーザー発信手段情報とは、レーザー発信手段を識別するレーザー識別子とレーザー発信手段の位置を特定する発信手段位置情報とレーザー発信手段のレーダー発信の方向を特定する発信手段方向情報とを有する情報である。なお、レーザー発信手段とは、レーザーを発信し、その反射の信号を受信する手段である。例えば、ＬＩＤＡＲは、多数のレーザー発信手段を具備する。
【００３０】
また、各種の情報とは、例えば、後述する元情報である。元情報は、元情報取得部１３１が取得した情報である。
【００３１】
また、各種の情報とは、例えば、オブジェクト情報である。オブジェクト情報とは、認識したいオブジェクト（例えば、人、自動車、障害物など）に関する情報である。オブジェクト情報は、例えば、オブジェクトを識別するオブジェクト識別子と、オブジェクトの輪郭に関する情報（例えば、輪郭を構成する複数の点の座標情報）を有する。オブジェクト識別子は、オブジェクト名（例えば、人、自動車など）でも良い。オブジェクト情報は、例えば、オブジェクト識別子と、１以上のオブジェクトの画像である。また、オブジェクト情報は、例えば、オブジェクト識別子と、１以上のオブジェクトの画像から抽出された２以上の特徴量である。また、オブジェクト情報は、例えば、オブジェクト識別子と、１以上のオブジェクトの画像から抽出された２以上の特徴量とを学習させた学習情報でも良い。なお、学習は、例えば、深層学習、サポートベクターマシン、決定木等を用いた学習であり、機械学習の種類は問わない。なお、オブジェクトとは、シーンにおいて独立して存在する、人、移動体（自動車など）や機器等の物であり、「動く物体」（動体）とは限らない。何をオブジェクトとするかはアプリケーションに依存し、例えば、ポストや標識、あるいは建物をオブジェクトとして認識するシステムも有り得る。また、シーンとは、観測装置が観測している情景である。
【００３２】
また、各種の情報とは、例えば、予め決められた条件である。予め決められた条件は、判断部１３５が使用する条件であり、例えば、動作情報を用いた条件である。予め決められた条件は、例えば、動作情報が「移動体とオブジェクトとの距離が閾値以内であり、かつ移動体とオブジェクトとの距離が縮まっていることを示す情報であること」である。また、予め決められた条件は、例えば、「動作情報「移動体位置情報が示す移動体の位置とオブジェクト位置情報が示すオブジェクトの位置との距離」が閾値値以内であること」である。
【００３３】
また、各種の情報とは、例えば、判断情報である。また、各種の情報とは、例えば、「予め決められた条件」に対応付けられている判断情報である。判断情報は、例えば、注意を喚起するための情報であり、例えば、ブザー音、注意を喚起する文字列、図柄等である。
【００３４】
受付部１２は、各種の指示や情報等を受け付ける。各種の指示や情報等とは、例えば、情報処理装置１の動作開始指示、動作終了指示である。また、動作開始指示は、情報処理装置１の動作の開始の指示であるが、移動体の移動の開始の指示でも良い。動作終了指示は、情報処理装置１の動作の終了の指示である。ここで、受け付けとは、キーボードやマウス、タッチパネルなどの入力デバイスから入力された情報の受け付け、有線もしくは無線の通信回線を介して送信された情報の受信、光ディスクや磁気ディスク、半導体メモリなどの記録媒体から読み出された情報の受け付けなどを含む概念である。
【００３５】
各種の指示や情報等の入力手段は、タッチパネルやキーボードやマウスやメニュー画面によるもの等、何でも良い。受付部１２は、タッチパネルやキーボード等の入力手段のデバイスドライバーや、メニュー画面の制御ソフトウェア等で実現され得る。
【００３６】
処理部１３は、各種の処理を行う。各種の処理とは、例えば、元情報取得部１３１、移動体位置情報取得部１３２、オブジェクト認識部１３３、出力図構成部１３４、判断部１３５が行う処理である。
【００３７】
元情報取得部１３１は、１または２以上の元情報を取得する。元情報取得部１３１は、移動体の周辺の３６０度をカバーする１以上の元情報を取得することは好適である。元情報取得部１３１は、２以上の各時点における１以上の元情報を取得することは好適である。元情報取得部１３１は、一度に、一の時点における、移動体の周辺の３６０度をカバーする１以上の元情報を取得することは好適である。なお、元情報取得部１３１は、３６０度をカバーする２以上の元情報を取得する場合に、３６０度の範囲内の領域によって、時間遅れが発生していても良い。
【００３８】
元情報は、移動体の周辺に存在するオブジェクトの三次元空間における位置を特定する元になる情報である。元情報は、図示しない観測装置の３次元データの集合を有する。元情報は、観測装置から観測される、周辺に存在する人やモノなどの特定の部分の３Ｄ座標を表す点の集合であり、例えば、距離画像データまたは点群（Point Cloud）データである。なお、観測装置は、観測データとして、３Ｄデータを連続的に取得可能な装置である。観測装置は、例えば、上述したＬＩＤＡＲ、３次元カメラ、ＴｏＦセンサ、ステレオカメラ等である。観測装置は、結果として同一の座標系の３Ｄデータを出力するものであれば、２以上の装置を組み合わせて構成されるシステムであってもよい。また、元情報取得部１３１は、観測装置を含むと考えても良いし、観測装置から元情報を取得すると考えても良い。また、３次元データは、例えば、観測装置または移動体を原点とする３次元の座標値である。
【００３９】
元情報は、例えば、レーザー情報である。レーザー情報は、戻り時間とレーザー識別子との組である。レーザー識別子は、レーザー発信手段を識別する情報である。レーザー識別子は、照射したレーザーの位置を特定する情報でも良い。元情報取得部１３１は、例えば、２以上の各レーザー発信手段により発信されたレーザーの反射を受信し、レーザーの発信からその反射の受信までの戻り時間を取得し、戻り時間とレーザー発信手段を識別するレーザー識別子との組であるレーザー情報を、レーザー発信手段ごとに取得するし。元情報取得部１３１は、レーザーを発信するＬＩＤＡＲを含むと考えても良いし、ＬＩＤＡＲから元情報を取得するソフトウェアとＭＰＵ等から実現されても良い。なお、ＬＩＤＡＲは、ＬｉＤＡＲと言っても良い。
【００４０】
元情報は、例えば、距離画像でも良い。元情報取得部１３１は、例えば、距離画像カメラが撮影した１または２以上の距離画像を取得する。なお、距離画像は、画像の中の各画素の３次元空間上の座標値を含む。また、元情報取得部１３１は、距離画像を撮影するカメラ（距離画像センサと言っても良い）を含むと考えても良いし、カメラが撮影した距離画像を取得するソフトウェアとＭＰＵ等から実現されても良い。
【００４１】
移動体位置情報取得部１３２は、元情報取得部１３１が取得した１以上の元情報を用いて、移動する移動体の移動体位置情報を取得する。移動体位置情報は、通常、三次元空間（以下、単に「空間」という場合がある。）における位置を特定する情報である。移動体位置情報とは、通常、（ｘ，ｙ，ｚ）の構造を有する。また、移動体位置情報は、通常、相対的な位置を示す情報である。移動体位置情報が相対的な位置を示す情報である場合、例えば、移動体の出発地点が原点（０，０，０）である。なお、移動体の出発地点の絶対位置（通常、（緯度，経度，高度））が分かれば、移動体位置情報は、絶対的な位置を示す情報に変換し得る。つまり、本明細書で扱う移動体位置情報やオブジェクト位置情報等の位置情報は、相対的な位置を示す情報でも良いし、絶対的な位置を示す情報でも良い。
【００４２】
移動体位置情報取得部１３２は、通常、１以上の元情報を用いて、２以上の各時点における移動体位置情報を取得する。
【００４３】
さらに具体的には、移動体位置情報取得部１３２は、例えば、異なる時点の２つの各元情報から特徴点を抽出し、２つの元情報の対応する２つの特徴点（例えば、（ｘ１１，ｙ１１，ｚ１１）と（ｘ１２，ｙ１２，ｚ１２））を検知し、当該特徴点の差異から移動量（例えば、（ｘ１２−ｘ１１，ｙ１２−ｙ１１，ｚ１２−ｚ１１）を算出する。そして、移動体位置情報取得部１３２は、例えば、移動体の直前の位置を示す移動体位置情報（例えば、（ｘ０，ｙ０，ｚ０））と移動量（例えば、（ｘ１２−ｘ１１，ｙ１２−ｙ１１，ｚ１２−ｚ１１）とを用いて、現時点の移動体位置情報（例えば、（ｘ０＋ｘ１２−ｘ１１，ｙ０＋ｙ１２−ｙ１１，ｚ０＋ｚ１２−ｚ１１））を算出する。なお、特徴点とは、オブジェクトの角の点、オブジェクトの輪郭線上の特定の点などである。３次元データの集合である元情報から特徴点を取得する技術は公知技術である。
【００４４】
オブジェクト認識部１３３は、元情報取得部１３１が取得した１以上の元情報を用いて、１以上のオブジェクトを特定（「特定」を「認識」、と言っても良い）し、当該１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付ける。なお、オブジェクト認識部１３３は、移動体の周辺のすべてのオブジェクトを認識する必要はなく、特定のオブジェクト（例えば、人、車など）のみを認識しても良い。また、オブジェクト位置情報とは、オブジェクトを構成する点の位置を示す情報であり、通常、三次元の座標情報である。オブジェクト位置情報は、通常、移動体位置情報に対して、相対的な位置を示す座標情報である。
【００４５】
オブジェクト認識部１３３は、オブジェクト位置情報は、通常、元情報が有する各三次元の座標情報と移動体位置情報とを用いて、２以上のオブジェクト位置情報を算出する。つまり、オブジェクト認識部１３３は、元情報が有する三次元の座標情報（例えば、（ｘａ，ｙａ，ｚａ））にオフセットとして移動体位置情報（例えば、（ｘｂ，ｙｂ，ｚｂ））を加えて、相対的な三次元の座標情報であるオブジェクト位置情報（例えば、（ｘａ＋ｘｂ，ｙａ＋ｙｂ，ｚａ＋ｚｂ））を算出する。
【００４６】
また、オブジェクト認識部１３３は、元情報取得部１３１が取得した１以上の元情報を用いて、移動体の周辺のすべてのオブジェクトを構成するすべての座標情報を取得することは好適である。この座標情報は、オブジェクト位置情報である。
【００４７】
また、オブジェクト認識部１３３は、通常、元情報取得部１３１が取得した１以上の元情報を用いて、移動体の周辺のオブジェクトのすべてのオブジェクト位置情報を取得する。次に、オブジェクト認識部１３３は、当該すべてのオブジェクト位置情報から、１以上のオブジェクトを特定し、１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付ける。
【００４８】
オブジェクト認識部１３３は、１以上の元情報を用いて、３６０度の範囲に存在する１以上のオブジェクトを特定し、１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付けることは好適である。なお、３６０度をカバーする１以上の元情報を取得する場合に時間遅れが発生する場合、オブジェクト認識部１３３は、通常、当該時間遅れを考慮して、オブジェクト位置情報を取得する。なお、時間遅れを考慮することは、例えば、時間遅れの分の移動量を算出し、取得された座標値を移動量の分だけ修正（補正）することである。
【００４９】
また、オブジェクト認識部１３３は、特定したオブジェクトの属性値を取得することは好適である。属性値とは、例えば、オブジェクトの種類、形状特徴量等である。なお、形状特徴量は、例えば、サイズ、平面度等である。
【００５０】
オブジェクト認識部１３３は、例えば、以下の（１）〜（３）のいずれかの処理を行う。
（１）オブジェクト認識部１３３の第一の処理例
【００５１】
第一の処理例は、独立した認識処理によりオブジェクト認識と自己位置認識を行う場合のオブジェクト認識の処理である。
【００５２】
オブジェクト認識部１３３は、例えば、１以上の元情報が有する３次元座標値（「３Ｄ点」という。）の集合を用いて、以下のような処理を行う。まず、オブジェクト認識部１３３は、１または２以上の３Ｄ点の集合を用いて、オブジェクト認識処理を行う。オブジェクト認識処理は、一つのオブジェクトを構成する３Ｄ点の集合を特定する処理である。次に、オブジェクト認識部１３３は、例えば、各オブジェクトの３Ｄ点の集合から、各オブジェクトの形状に関する特徴量である１または２以上の形状特徴量を取得する。形状特徴量は、例えば、サイズ（例えば、幅、高さ、奥行き）、平面度等である。次に、オブジェクト認識部１３３は、例えば、１以上の形状特徴量を用いて、オブジェクトの種類（オブジェクトの属性値の一例）を決定する。なお、オブジェクトの種類を決定する処理は、例えば、決定木、深層学習、サポートベクターマシン、決定木等の機械学習の技術が利用可能である。次に、オブジェクト認識部１３３は、決定したオブジェクトの種類の情報に対応付けて、３Ｄ点（オブジェクト位置情報と言っても良い。）の集合を取得する。
【００５３】
なお、オブジェクト認識処理は、具体的には、例えば、以下の方法がある。まず、第一のオブジェクト認識処理について説明する。オブジェクト認識部１３３は、複数の各３Ｄ点の距離が予め決められた条件を満たすほど近い点の集合を同一のオブジェクトを構成する点である、と判断し、オブジェクトごとに３Ｄ点をまとめる。
【００５４】
また、オブジェクト認識部１３３は、例えば、以下のグリッドマップの手法である第二の方法によるオブジェクト認識処理を行っても良い。つまり、オブジェクト認識部１３３は、３次元空間の複数のＢＯＸに区切る。そして、オブジェクト認識部１３３は、各ＢＯＸに存在するすべての３Ｄ点を同一のオブジェクトを構成する３Ｄ点である、と仮定する。次に、オブジェクト認識部１３３は、各ＢＯＸの３Ｄ点から特徴点（例えば、最も中心に近い点、複数の点の中央値など）を取得する。次に、特徴点が予め決められた条件を満たすほど近いＢＯＸを同一のオブジェクトを構成するＢＯＸである、と判断する。以上により、一のオブジェクトを構成する３Ｄ点の集合が検知できた（オブジェクト認識ができた）。なお、ＢＯＸとは、通常、３次元の立方体または直方体である。
【００５５】
そして、例えば、オブジェクト認識部１３３は、同一の元情報から取得された移動体位置情報に対応付けて、各オブジェクトの２以上のオブジェクト位置情報を図示しないバッファに蓄積する。なお、オブジェクト認識部１３３は、各オブジェクトの属性値をも一緒に、図示しないバッファに蓄積することは好適である。
（２）オブジェクト認識部１３３の第二の処理例
【００５６】
第二の処理例は、過去に認識したオブジェクトの履歴を保存しておき、自己位置の変化を踏まえて、今回のオブジェクトに該当する過去のオブジェクトを取得する処理である。第二の処理例では、オブジェクトの位置変化量（速度）をオブジェクト認識に利用できる。また、第二の処理例では、過去に認識済みの属性も利用できる。
【００５７】
なお、第二の処理例では、過去の各オブジェクトの（基準座標系での）位置と移動ベクトルの履歴」から、過去の各オブジェクトが今回存在し得る（基準座標系での）位置を推定し、それを基に過去の各オブジェクトと現在のオブジェクトの関連付けを行うものである。かかる位置推定の処理には、カルマンフィルタ等が利用可能である。なお、この処理の実現には、少なくとも過去の１以上の時点における、移動体の位置と各オブジェクトの位置が保存されている必要がある。
【００５８】
さらに具体的には、まず、移動体位置情報取得部１３２は、上述した処理により、特徴点の移動量（例えば、（ｘｔ−ｘｔ−１，ｙｔ−ｙｔ−１，ｚｔ−ｚｔ−１））算出する。そして、移動体位置情報取得部１３２は、過去の一時点（例えば、その直前の時点）（ｔ−１）の移動体位置情報（例えば、（ｘｔ−１，ｙｔ−１，ｚｔ−１））と移動量とから、現時点（ｔ）の移動体位置情報（例えば、（ｘｔ，ｙｔ，ｚｔ））を取得する。
【００５９】
次に、オブジェクト認識部１３３は、現時点の１以上の元情報が有する３Ｄ点の集合を用いて、上記のオブジェクト認識処理により、オブジェクトを認識する。次に、オブジェクト認識部１３３は、例えば、各オブジェクトの３Ｄ点の集合から、各オブジェクトの形状に関する特徴量である１または２以上の形状特徴量を取得する。次に、オブジェクト認識部１３３は、例えば、１以上の形状特徴量から現時点のオブジェクトの属性値（例えば、オブジェクトの種類）を取得する。
【００６０】
次に、オブジェクト認識部１３３は、過去の１以上の時点のオブジェクトと現時点のオブジェクトの対応付けを行うために、現時点のオブジェクトのオブジェクト位置情報を、移動体位置情報を用いて補正する。次に、過去の各オブジェクトの現時点における位置を、過去の移動量の履歴から推定する。なお、かかる処理において、カルマンフィルタ等を用いる処理がある。次に、現時点のオブジェクトの属性値と過去のオブジェクトの属性値とを比較し、現時点のオブジェクトと過去のオブジェクトとの対応付けを行う。なお、対応付けられる現時点のオブジェクトと過去のオブジェクトとは、同一または類似の属性値を有し、現時点における位置に対応する座標値と予測位置に対応する座標値との差異が予め決められた範囲の差異に留まるオブジェクトである。また、過去の１以上の時点のオブジェクトと現時点のオブジェクトの対応付けが行えた場合、現時点のオブジェクトの１または２以上のオブジェクト位置情報が取得される。
【００６１】
そして、例えば、オブジェクト認識部１３３は、同一の元情報から取得された移動体位置情報に対応付けて、各オブジェクトの１または２以上のオブジェクト位置情報を図示しないバッファに蓄積する。なお、オブジェクト認識部１３３は、各オブジェクトの属性値をも一緒に、図示しないバッファに蓄積することは好適である。
（３）オブジェクト認識部１３３の第三の処理例
【００６２】
第三の処理例は、過去の３Ｄ点の集合を保存しておき、自己位置の変化を反映した３Ｄ点の集合と比較し、動体と非動体に分けて３Ｄ点の集合を検知する方法である。第三の処理例において、定点観測時の差分処理と同様の効果があるため、移動観測の場合でも、オブジェクト点群の取得をより堅牢に行うことが可能となる。なお、ここで「動体」とは、「一部または全体の（基準座標系における）位置が変化するオブジェクト」である。一部の位置が変化するオブジェクトは、例えば、手だけが動いている人間である。  さらに具体的には、まず、移動体位置情報取得部１３２は、上述した処理により、特徴点の移動量（例えば、（ｘｔ−ｘｔ−１，ｙｔ−ｙｔ−１，ｚｔ−ｚｔ−１））算出する。そして、移動体位置情報取得部１３２は、過去の一時点（例えば、その直前の時点）（ｔ−１）の移動体位置情報（例えば、（ｘｔ−１，ｙｔ−１，ｚｔ−１））と移動量とから、現時点（ｔ）の移動体位置情報（例えば、（ｘｔ，ｙｔ，ｚｔ））を取得する。
【００６３】
次に、オブジェクト認識部１３３は、過去の１以上の時点（例えば、直前の時点）の３Ｄ点の集合と現時点の３Ｄ点の集合との同期を取るために、現時点の３Ｄ点の集合を、移動体位置情報を用いて補正する。
【００６４】
次に、オブジェクト認識部１３３は、現時点の３Ｄ点の集合に対してオブジェクト認識処理を行う。
【００６５】
具体的には、オブジェクト認識部１３３は、過去の３Ｄ点と同じ位置に存在するかどうかを考慮して、現在の各３Ｄ点が動体に属するかどうかを判定しながら、現時点の３Ｄ点の集合に対してオブジェクト認識処理を行う。ここで、考慮するとは、例えば、複数の各３Ｄ点の距離を基準としてオブジェクトを構成する３Ｄ点の集合を特定する際に、その複数の３Ｄ点が双方とも過去の３Ｄ点と同じ位置に存在するかどうかによって距離に重みづけを行うことをいう。  次に、オブジェクト認識部１３３は、過去の時点（例えば、直前の時点）の３Ｄ点の集合から得られた各オブジェクトの１または２以上の各オブジェクト位置情報または／および属性値と、現時点の３Ｄ点の集合に対する各オブジェクトの１または２以上の各オブジェクト位置情報または／および属性値とを対比し、過去の時点の３Ｄ点の集合から得られた各オブジェクトと現時点の３Ｄ点の集合に対する各オブジェクトとの対応を決定する。
【００６６】
なお、過去の時点において動体または非動体であったオブジェクトが、現時点においては、過去の判断とは異なり、非動体または動体として判断される場合がある。例えば、立ち止まっていた人間が歩き始めた、動いていた車が駐車した等の場合である。また、オブジェクトが動体であるか非動体であるかのフラグ情報は、オブジェクトの属性値の一種である、とする。なお、ここで、（２）で説明した、過去のオブジェクトの移動量を考慮したオブジェクトの対応付けを行ってもよい。
【００６７】
そして、例えば、オブジェクト認識部１３３は、同一の元情報から取得された移動体位置情報に対応付けて、各オブジェクトの１または２以上のオブジェクト位置情報を図示しないバッファに蓄積する。なお、オブジェクト認識部１３３は、各オブジェクトの属性値をも一緒に、図示しないバッファに蓄積することは好適である。
【００６８】
オブジェクト認識部１３３は、例えば、元情報取得部１３１が取得した２以上の各レーザー情報が有するレーザー識別子と対になる発信手段位置情報と発信手段方向情報と、レーザー情報が有する戻り時間とを用いて、オブジェクトのオブジェクト位置情報をレーザー情報ごとに取得し、取得した２以上のオブジェクト位置情報を用いて、１以上のオブジェクトを特定し、１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付ける。
【００６９】
オブジェクト認識部１３３は、２以上の各時点において、１以上のオブジェクトを特定し、１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付けることは好適である。
【００７０】
元情報がレーザー識別子と戻り時間との組である場合、オブジェクト認識部１３３は、元情報から、移動体位置情報に対する三次元空間内の相対位置を示すオブジェクト位置情報を取得する。例えば、２以上のオブジェクト位置情報からオブジェクトの輪郭抽出を行い、輪郭に対応する格納部１１のオブジェクト情報を選択し、オブジェクト情報が有するオブジェクト識別子を取得する。そして、オブジェクト識別子で識別されるオブジェクトの輪郭を構成する２以上のオブジェクト位置情報とオブジェクト識別子とを対にして保持する。かかる場合、格納部１１には、１以上のオブジェクト情報が格納されている。なお、オブジェクト認識部１３３は、オブジェクトの輪郭を構成する２以上のオブジェクト位置情報に加えて、オブジェクトの内部のオブジェクト位置情報をもオブジェクト識別子と対にして保持しても良いことは言うまでもない。
【００７１】
また、元情報が距離画像の場合、距離画像から空間内のオブジェクトを認識し、オブジェクト識別子を取得する。画像からオブジェクトを認識する技術は公知技術である。オブジェクト認識部１３３は、深層学習などの機械学習技術やオブジェクト情報とのパターンマッチングの技術等が利用可能である。そして、オブジェクト認識部１３３は、オブジェクト識別子と認識したオブジェクトを構成する２以上のオブジェクト位置情報とを対にして保持する。
【００７２】
なお、オブジェクト認識部１３３がオブジェクト識別子と２以上のオブジェクト位置情報とを対にして保持する場所は、格納部１１でも良いし、図示しないバッファ等でも良い。
【００７３】
出力図構成部１３４は、移動体位置情報と１以上の各オブジェクトの２以上のオブジェクト位置情報とを用いて、出力図を構成する。出力図とは、移動体と１以上の各オブジェクトの相対的な位置関係が認識可能な三次元の図である。出力図の具体例は後述する。なお、出力図構成部１３４が用いる移動体位置情報とオブジェクト位置情報とは、同一の１以上の元情報から取得された情報である。また、１以上の各オブジェクトの２以上のオブジェクト位置情報とは、１以上の各オブジェクトの認識結果である、と言っても良い。  出力図構成部１３４は、２以上の各時点において、オブジェクト認識部１３３が認識した１以上のオブジェクトが含まれる図であり、移動体位置情報取得部１３２が取得した２以上の各時点における移動体位置情報により構成される移動体の移動軌跡を示す軌跡情報が含まれる図である出力図を構成する。
【００７４】
判断部１３５は、元情報取得部１３１が取得した２以上の時点における２以上の元情報を用いて、オブジェクト認識部１３３が特定した１以上の各オブジェクトの動作に関する動作情報を取得し、動作情報が予め決められた条件に合致するか否かを判断する。動作情報は、例えば、移動体とオブジェクトとの距離の変化の履歴（例えば、「１５ｍ，１２ｍ，６ｍ等」）である。動作情報は、例えば、移動体とオブジェクトとの距離が縮まっていることを示す情報である。動作情報は、例えば、オブジェクトのオブジェクト位置情報群の２以上の時点の集合である。オブジェクト位置情報群は、一のオブジェクトを特定する２以上のオブジェクト位置情報の集合である。
【００７５】
出力部１４は、各種の情報を出力する。ここで、出力とは、通常、ディスプレイへの表示であるが、プロジェクターを用いた投影、プリンタでの印字、外部の装置（通常、表示装置）への送信、記録媒体への蓄積、他の処理装置や他のプログラムなどへの処理結果の引渡しなどを含む概念である。
【００７６】
図出力部１４１は、出力図構成部１３４が構成した出力図を出力する。出力図の態様は問わない。出力図の例は後述する。出力図において、オブジェクト認識部１３３が認識したオブジェクトを特定する２以上のオブジェクト位置情報が、他のオブジェクト位置情報と区別可能な態様であることは好適である。出力図において、オブジェクト認識部１３３が認識したオブジェクトが認識可能な態様であることは好適である。また、出力図は、動体と非動体とが区別可能な態様であることは好適である。
【００７７】
判断情報出力部１４２は、判断部１３５が条件に合致すると判断した場合に、判断に関する判断情報を出力する。判断情報出力部１４２は、判断部１３５が条件に合致すると判断した場合に、当該条件に対応する判断情報を格納部１１から取得し、当該情報を用いて、判断情報を出力する。
【００７８】
ここで、出力とは、ディスプレイへの表示、プロジェクターを用いた投影、プリンタでの印字、音出力、部の装置（通常、表示装置）への送信、記録媒体への蓄積、他の処理装置や他のプログラムなどへの処理結果の引渡しなどを含む概念である。
【００７９】
格納部１１は、不揮発性の記録媒体が好適であるが、揮発性の記録媒体でも実現可能である。格納部１１に情報が記憶される過程は問わない。例えば、記録媒体を介して情報が格納部１１で記憶されるようになってもよく、通信回線等を介して送信された情報が格納部１１で記憶されるようになってもよく、あるいは、入力デバイスを介して入力された情報が格納部１１で記憶されるようになってもよい。
【００８０】
処理部１３、元情報取得部１３１、移動体位置情報取得部１３２、オブジェクト認識部１３３、出力図構成部１３４、および判断部１３５は、通常、ＭＰＵやメモリ等から実現され得る。処理部１３等の処理手順は、通常、ソフトウェアで実現され、当該ソフトウェアはＲＯＭ等の記録媒体に記録されている。但し、ハードウェア（専用回路）で実現しても良い。
【００８１】
出力部１４、図出力部１４１、および判断情報出力部１４２は、ディスプレイやスピーカー等の出力デバイスを含むと考えても含まないと考えても良い。出力部１４等は、出力デバイスのドライバーソフトまたは、出力デバイスのドライバーソフトと出力デバイス等で実現され得る。
【００８２】
次に、情報処理装置１の動作例について、図２のフローチャートを用いて説明する。
【００８３】
（ステップＳ２０１）受付部１２は、動作開始指示を受け付けたか否かを判断する。動作開始指示を受け付けた場合はステップＳ２０２に行き、動作開始指示を受け付けない場合はステップＳ２０１に戻る。
【００８４】
（ステップＳ２０２）元情報取得部１３１は、元情報を取得する。かかる元情報取得処理について、図３のフローチャートを用いて説明する。
【００８５】
（ステップＳ２０３）移動体位置情報取得部１３２は、移動体位置情報を取得する。なお、移動体位置情報取得部１３２が相対的な位置を示す移動体位置情報を取得する場合、最初は、例えば、原点（０，０，０）を取得する。移動体位置情報取得処理の例について、図４のフローチャートを用いて説明する。
【００８６】
（ステップＳ２０４）オブジェクト認識部１３３は、オブジェクト認識処理を行う。かかるオブジェクト認識処理の例について、図５のフローチャートを用いて説明する。
【００８７】
（ステップＳ２０５）出力図構成部１３４は、出力図の構成を行う。かかる出力図構成処理について、図６のフローチャートを用いて説明する。
【００８８】
（ステップＳ２０６）図出力部１４１は、ステップＳ２０５で構成された出力図を出力する。
【００８９】
（ステップＳ２０７）判断部１３５は、移動物に対する判断処理を行う。かかる判断処理について、図７のフローチャートを用いて説明する。
【００９０】
（ステップＳ２０８）判断情報出力部１４２は、ステップＳ２０７における判断処理の結果、判断情報が得られたか否かを判断する。判断情報が得られた場合はステップＳ２０９に行き、判断情報が得られない場合はステップＳ２１０に行く。
【００９１】
（ステップＳ２０９）判断情報出力部１４２は、ステップＳ２０７で得られた１以上の判断情報を出力する。
【００９２】
（ステップＳ２１０）受付部１２は、動作終了指示を受け付けたか否かを判断する。動作終了指示を受け付けた場合は処理を終了し、動作終了指示を受け付けない場合はステップＳ２０１に戻る。
【００９３】
次に、ステップＳ２０３の元情報取得処理の例について、図３のフローチャートを用いて説明する。
【００９４】
（ステップＳ３０１）元情報取得部１３１は、カウンタｉに１を代入する。
【００９５】
（ステップＳ３０２）元情報取得部１３１は、ｉ番目のレーザー発信手段が存在するか否かを判断する。ｉ番目のレーザー発信手段が存在する場合はステップＳ３０３に行き、ｉ番目のレーザー発信手段が存在しない場合はステップＳ３０７に行く。
【００９６】
（ステップＳ３０３）元情報取得部１３１は、ｉ番目のレーザー発信手段のレーザー識別子を取得する。なお、レーザー識別子は、通常、格納部１１に格納されている。
【００９７】
（ステップＳ３０４）元情報取得部１３１は、ｉ番目のレーザー発信手段が発信したレーザーの戻り時間を取得する。なお、かかる処理は、ＬＩＤＡＲの公知技術である。
【００９８】
（ステップＳ３０５）元情報取得部１３１は、ステップＳ３０３で取得したレーザー識別子とステップＳ３０４で取得した戻り時間とを有する元情報を構成する。なお、元情報取得部１３１は、レーザー識別子と戻り時間とから３次元座標値を算出し、当該３次元座標値を有する元情報を構成しても良い。かかる場合、元情報取得部１３１は、戻り時間から原点に対する距離を取得し、レーザー識別子に対応する原点に対する角度を取得し、当該距離と角度とから、原点に対する３次元座標値を算出する。かかる処理は公知技術である。また、レーザー識別子に対応付けて、原点に対する角度が、格納部１１に格納されている。
【００９９】
（ステップＳ３０６）元情報取得部１３１は、カウンタｉを１、インクリメントする。ステップＳ３０２に戻る。
【０１００】
（ステップＳ３０７）元情報取得部１３１は、この時点の元情報群を構成し、図示しないバッファに一時蓄積する。上位処理にリターンする。なお、元情報群は、ステップＳ３０５で構成された２以上の元情報の集合である。
【０１０１】
なお、図３のフローチャートにおいて、この時点の元情報群は、例えば、一時点における移動体の周辺、３６０度（一周）分の元情報の集合であることは好適である。
【０１０２】
また、図３のフローチャートにおいて、元情報取得部１３１は、移動体の周辺の１以上の距離画像を取得しても良い。
【０１０３】
次に、ステップＳ２０３の移動体位置情報取得処理の例について、図４のフローチャートを用いて説明する。
【０１０４】
（ステップＳ４０１）移動体位置情報取得部１３２は、元情報取得部１３１が取得した１以上の各元情報が有する３次元空間上の座標値の集合、または１以上の各元情報から取得される３次元空間上の座標値の集合から、１以上の特徴点を取得し、図示しないバッファに一時蓄積する。なお、特徴点は、３Ｄの座標値である。
【０１０５】
（ステップＳ４０２）移動体位置情報取得部１３２は、図示しないバッファに、直前の時点の１以上の特徴点が格納されているか否かを判断する。１以上の特徴点が格納されている場合はステップＳ４０３に行き、格納されていない場合はステップＳ４０８に行く。
【０１０６】
（ステップＳ４０３）移動体位置情報取得部１３２は、移動体位置情報取得部１３２は、図示しないバッファから、直前の時点の１以上の特徴点を読み出す。
【０１０７】
（ステップＳ４０４）移動体位置情報取得部１３２は、ステップＳ４０１で取得した１以上の特徴点のうちのいずれか１以上の各特徴点に対応する特徴点であり、直前の時点の１以上の特徴点を決定する。
【０１０８】
（ステップＳ４０５）移動体位置情報取得部１３２は、対応する２つの特徴点の差異である移動量を算出する。なお、対応する２つの特徴点は、ステップＳ４０１で取得した現時点の特徴点と、直前の時点の特徴点である。対応するとは、例えば、周辺の点の集合から構成される形状が類似し、距離が一定範囲に留まることである。また、ここで、移動量を算出するために使用する特徴点は、非動体のオブジェクトの特徴点である。また、移動体位置情報取得部１３２は、２以上の特徴点の組の差異を算出し、最も多い値の差異を移動量としても良い。なお、特徴点の組とは、対応する２つの特徴点である。
【０１０９】
（ステップＳ４０６）移動体位置情報取得部１３２は、図示しないバッファから、直前の時点の移動体位置情報を読み出す。
【０１１０】
（ステップＳ４０７）移動体位置情報取得部１３２は、ステップＳ４０６で読み出した移動体位置情報と、ステップＳ４０５で取得した移動量とから、現時点の移動体位置情報を算出する。上位処理にリターンする。
【０１１１】
（ステップＳ４０８）移動体位置情報取得部１３２は、ステップＳ４０１で取得した１以上の特徴点に対して、原点を対応付ける。なお、原点は、開始時の移動体位置情報である。上位処理にリターンする。  次に、ステップＳ２０４のオブジェクト認識処理の例について、図５のフローチャートを用いて説明する。
【０１１２】
（ステップＳ５０１）オブジェクト認識部１３３は、カウンタｉに１を代入する。
【０１１３】
（ステップＳ５０２）オブジェクト認識部１３３は、図示しないバッファに一時蓄積された元情報群の中に、i番目の元情報が存在するか否かを判断する。i番目の元情報が存在する場合はステップＳ５０３に行き、i番目の元情報が存在しない場合はステップＳ５０６に行く。
【０１１４】
（ステップＳ５０３）オブジェクト認識部１３３は、i番目の元情報からｉ番目のオブジェクト位置情報を取得する。オブジェクト認識部１３３は、例えば、i番目の元情報が有するレーザー識別子と対になる発信手段位置情報と発信手段方向情報とを格納部１１から取得し、当該発信手段位置情報と発信手段方向情報とi番目の元情報が有する戻り時間とを用いて、i番目の元情報に対応する移動体位置情報に対する相対的な三次元座標値を取得する。そして、オブジェクト認識部１３３は、例えば、当該移動体位置情報と当該三次元座標値とを用いて、ｉ番目のオブジェクト位置情報を取得する。
【０１１５】
（ステップＳ５０４）オブジェクト認識部１３３は、ステップＳ５０３で取得したｉ番目のオブジェクト位置情報を図示しないバッファに一時蓄積する。
【０１１６】
（ステップＳ５０５）オブジェクト認識部１３３は、カウンタｉを１、インクリメントする。ステップＳ５０２に戻る。
【０１１７】
（ステップＳ５０６）オブジェクト認識部１３３は、カウンタｊに１を代入する。
【０１１８】
（ステップＳ５０７）オブジェクト認識部１３３は、図示しないバッファにｊ番目のオブジェクト位置情報が存在するか否かを判断する。ｊ番目のオブジェクト位置情報が存在する場合はステップＳ５０８に行き、ｊ番目のオブジェクト位置情報が存在しない場合は上位処理にリターンする。
【０１１９】
（ステップＳ５０８）オブジェクト認識部１３３は、図示しないバッファからｊ番目のオブジェクト位置情報を取得する。
【０１２０】
（ステップＳ５０９）オブジェクト認識部１３３は、ステップＳ５０８で取得したｊ番目のオブジェクト位置情報を含むオブジェクト位置情報群であり、ｊ番目のオブジェクト位置情報が構成する一のオブジェクトを構成するオブジェクト位置情報群を取得する。なお、このオブジェクト位置情報群は、当該一のオブジェクトを構成するオブジェクト位置情報の集合であり、ｊ番目のオブジェクト位置情報を含む。なお、一のオブジェクトを構成するオブジェクト位置情報の集合は、例えば、予め決められた関係を満たすほど近い位置のオブジェクト位置情報の集合である。
【０１２１】
（ステップＳ５１０）オブジェクト認識部１３３は、直前の時点のオブジェクト位置情報群の中に、ステップＳ５０９で取得したオブジェクト位置情報群に対応するオブジェクト位置情報群が存在するか否かを判断する。存在する場合はステップＳ５１１に行き、存在しない場合はステップＳ５１４に行く。
【０１２２】
なお、ステップＳ５０９で取得したオブジェクト位置情報群に対応するオブジェクト位置情報群とは、ステップＳ５０９で取得したオブジェクト位置情報群と同じオブジェクトのオブジェクト位置情報群である。なお、このオブジェクト位置情報群により特定されるオブジェクトは、静止しているオブジェクトでも、移動物のオブジェクトでも良い。静止しているオブジェクトの場合、時点が異なる同一のオブジェクトを特定する２つのオブジェクト位置情報群は、同じ情報または一方が他方に含まれる情報である。また、移動物のオブジェクトの場合、時点が異なる同一のオブジェクトを特定する２つのオブジェクト位置情報群は、複数のオブジェクト位置情報が一定割合以上、同一幅でずれている情報である。なお、一度に移動体の３６０度の周辺のオブジェクト認識を行う場合、現在の時点がＮ回目の周辺オブジェクトの認識を行う時点である場合、直前の時点とは、（Ｎ−１）回目の周辺オブジェクトの認識を行った時点である。
【０１２３】
（ステップＳ５１１）オブジェクト認識部１３３は、ステップＳ５０９で取得したオブジェクト位置情報群と、ステップＳ５０９で取得したオブジェクト位置情報群に対応するオブジェクト位置情報群（以前の時点のオブジェクト位置情報群）とから、当該オブジェクト位置情報群に対応するオブジェクトが移動しているか否かを判断する。移動している場合はステップＳ５１２に行き、移動していない場合はステップＳ５１３に行く。なお、オブジェクト認識部１３３は、移動体の移動量を用いて、オブジェクトが移動しているか否かを判断する。
【０１２４】
（ステップＳ５１２）オブジェクト認識部１３３は、ステップＳ５０９で取得したオブジェクト位置情報群に対応付けて、当該オブジェクトが移動物であることを示す移動物フラグを付加する。
【０１２５】
（ステップＳ５１３）オブジェクト認識部１３３は、ステップＳ５０９で取得したオブジェクト位置情報群に対応付けて、当該オブジェクトが移動物でないことを示す非移動物フラグを付加する。
【０１２６】
（ステップＳ５１４）カウンタｉをＮだけ、インクリメントする。ステップＳ５０７に戻る。なお、Ｎは、一のオブジェクトを構成するオブジェクト位置情報の数である。
【０１２７】
なお、図５のフローチャートにおいて、上述した他のオブジェクト認識処理のアルゴリズムを用いても良い。  次に、ステップＳ２０５の出力図構成処理の例について、図６のフローチャートを用いて説明する。
【０１２８】
（ステップＳ６０１）出力図構成部１３４は、直前の出力図が存在するか否かを判断する。直前の出力図が存在する場合はステップＳ６０２に行き、直前の出力図が存在しない場合はステップＳ６０３に行く。なお、直前の出力図とは、直前の時点で出力した出力図である。直前の時点で出力した出力図とは、現時点の直前の時点で取得した元情報の集合を用いて構成された出力図である。
【０１２９】
（ステップＳ６０２）出力図構成部１３４は、図示しないバッファから、直前の出力図を構成したオブジェクト位置情報を取得する。
【０１３０】
（ステップＳ６０３）出力図構成部１３４は、カウンタｉに１を代入する。
【０１３１】
（ステップＳ６０４）出力図構成部１３４は、移動物フラグに対応するｉ番目のオブジェクト位置情報群が存在するか否かを判断する。存在する場合はステップＳ６０５に行き、存在しない場合はステップＳ６０７に行く。なお、移動物フラグに対応するオブジェクト位置情報群とは、移動物であるオブジェクトのオブジェクト位置情報群である。
【０１３２】
（ステップＳ６０５）出力図構成部１３４は、移動物フラグに対応するｉ番目のオブジェクト位置情報群に対して、削除フラグを付加する。なお、削除フラグが付加されたオブジェクト位置情報群は、出力図を構成するために使用されない。削除フラグを付加することは、削除することでも良い。
【０１３３】
（ステップＳ６０６）出力図構成部１３４は、カウンタｉを１、インクリメントする。ステップＳ６０４に戻る。
【０１３４】
（ステップＳ６０７）出力図構成部１３４は、現時点に取得したオブジェクト位置情報の集合を、出力図を構成するオブジェクト位置情報の集合に付加する。なお、ここで、現時点に取得したオブジェクト位置情報の集合の中で、同一オブジェクトを構成する同一のオブジェクト位置情報が、出力図を構成するオブジェクト位置情報の集合の中に存在する場合、出力図構成部１３４は、当該オブジェクト位置情報を、出力図を構成するオブジェクト位置情報の集合の中に付加しないことは好適である。
【０１３５】
（ステップＳ６０８）出力図構成部１３４は、ステップＳ２０２で取得されてきた１以上の移動体位置情報を用いて、移動体の移動軌跡を示す軌跡情報を取得する。
【０１３６】
（ステップＳ６０９）出力図構成部１３４は、ステップＳ６０７で取得したオブジェクト位置情報の集合と、ステップＳ６０８で取得した軌跡情報とを用いて、出力図を構成する。上位処理にリターンする。
【０１３７】
なお、図６のフローチャートにおいて、軌跡情報に代えて、現時点の移動体の位置を示す移動体位置情報に基づいて、移動体の現在の位置を示す出力図を構成しても良い。
【０１３８】
次に、ステップＳ２０７の判断処理の例について、図７のフローチャートを用いて説明する。
【０１３９】
（ステップＳ７０１）判断部１３５は、カウンタｉに１を代入する。
【０１４０】
（ステップＳ７０２）判断部１３５は、バッファの中のオブジェクト位置情報群を用いて、ｉ番目の移動物が存在するか否かを判断する。ｉ番目の移動物が存在する場合はステップＳ７０３に行き、ｉ番目の移動物が存在しない場合は上位処理にリターンする。
【０１４１】
（ステップＳ７０３）判断部１３５は、ｉ番目の移動物のオブジェクト位置情報群を、図示しないバッファから取得する。
【０１４２】
（ステップＳ７０４）判断部１３５は、カウンタｊに１を代入する。
【０１４３】
（ステップＳ７０５）判断部１３５は、ｊ番目の予め決められた条件が格納部１１に存在するか否かを判断する。条件が存在する場合はステップＳ７０６に行き、条件が存在しない場合は、ステップＳ７０９に行く。
【０１４４】
（ステップＳ７０６）判断部１３５は、ステップＳ７０３で取得したｉ番目の移動物のオブジェクト位置情報群に対応するｉ番目の移動物のオブジェクトが、ｊ番目の予め決められた条件に合致するか否かを判断する。合致する場合はステップＳ７０７に行き、合致しない場合は」ステップＳ７０８に行く。ここで、判断部１３５は、ｉ番目の移動物の、異なる２以上の時点のオブジェクト位置情報群（移動の軌跡を示す情報）を、ｊ番目の予め決められた条件に適用し、当該条件を満たすか否かを判断することは好適である。
【０１４５】
（ステップＳ７０７）判断部１３５は、ｊ番目の予め決められた条件に対応する判断情報を取得する。なお、この判断情報は、ｉ番目の移動物のオブジェクト位置情報群にも対応していることは好適である。かかる場合、判断情報は、ｉ番目の移動物のオブジェクトを特定する情報を含む。ｉ番目の移動物のオブジェクトを特定する情報は、ｉ番目の移動物のオブジェクト位置情報群でも良いし、ｉ番目の移動物のオブジェクト識別子でも良い。なお、判断部１３５は、例えば、ｊ番目の予め決められた条件に対応する判断情報を格納部１１から読出す。
【０１４６】
（ステップＳ７０８）判断部１３５は、カウンタｊを１、インクリメントする。ステップＳ７０５に戻る。
【０１４７】
（ステップＳ７０９）判断部１３５は、カウンタｉを１、インクリメントする。ステップＳ７０２に戻る。
【０１４８】
以下、本実施の形態における情報処理装置１の具体的な動作について説明する。情報処理装置１の概念図は図８である。図８において、８０１は、情報処理装置１である。８０２は、ＬＩＤＡＲであり、多数のレーザー発信手段を有する。また、情報処理装置１は、ここでは、例えば、ロボット、または自動車等の移動体、ＡＧＶ（無人搬送車）等である。かかる場合、以下の４つの具体例を説明する。
（具体例１）
【０１４９】
情報処理装置１の元情報取得部１３１は、上述した処理により、ＬＩＤＡＲ８０２から多数の元情報を取得する。なお、ＬＩＤＡＲ８０２は、移動体の周辺の３６０度に対してレーザーを発信し、当該レーザーの反射を受信し、一度に元情報を取得する、とする。
【０１５０】
次に、移動体位置情報取得部１３２は、元情報取得部１３１が取得した元情報を用いて、上述した処理により、移動体位置情報を取得する。
【０１５１】
次に、オブジェクト認識部１３３は、移動体位置情報取得部１３２が使用した元情報と同じ元情報を用いて、上述した処理により、移動体である情報処理装置１の周辺のオブジェクトを認識する。
【０１５２】
そして、オブジェクト認識部１３３は、同じ元情報を用いて取得された移動体位置情報とオブジェクトの認識結果とを、対応付けてバッファに蓄積する。なお、オブジェクトの認識結果とは、例えば、各オブジェクトの２以上のオブジェクト位置情報、１以上の属性値である。
【０１５３】
そして、出力図構成部１３４は、上述した処理により、例えば、複数のオブジェクトを含む出力図を構成し、図出力部１４１は、かかる出力図を出力する。出力図の例は、図９である。図９において、オブジェクト認識部１３３が認識したオブジェクト９０１、９０２、９０３は、直方体のＢＯＸにより囲われている。
【０１５４】
図９において、移動体の周辺から人やモノを検出し、識別・解析・追跡することができる。また、例えば、情報処理装置１によれば、特定の範囲に存在する人間や車輌などを検知してトラッキングすることで、自律移動システムにおける状況判断や、人流・動線の解析などが可能となる。
（具体例２）
【０１５５】
情報処理装置１の元情報取得部１３１は、上述した処理により、ＬＩＤＡＲ８０２から多数の元情報を取得する。
【０１５６】
次に、オブジェクト認識部１３３は、上述した処理により、移動体である情報処理装置１の周辺のオブジェクトを認識する。
【０１５７】
また、移動体位置情報取得部１３２は、上述した処理により、移動体位置情報を取得する。
【０１５８】
なお、移動体位置情報取得部１３２もオブジェクト認識部１３３も、同一の元情報を用いて、処理を行う。なお、同一の元情報を用いることは、例えば、移動体位置情報取得部１３２が元情報を用いて取得した情報を、オブジェクト認識部１３３が用いることも含む、とする。
【０１５９】
そして、出力図構成部１３４は、上述した処理により、例えば、複数のオブジェクト、および移動体の軌跡を示す軌跡情報を含む出力図を構成する。
【０１６０】
次に、図出力部１４１は、かかる出力図を出力する。出力図の例は、図１０である。図１０において、１００１が現在の移動体の位置を示す図である。
【０１６１】
移動体位置情報取得部１３２は、連続的な３Ｄデータから観測点（情報処理装置１）の移動量を推定する（移動体位置情報を取得する）。そして、図１０において、情報処理装置１は、実世界における移動体の位置をリアルタイムで認識することができる。かかることは、自動運転における自己位置の認識や、搬送機器のトレースによる貨物配置の把握などを可能とすることを示す。
（具体例３）
【０１６２】
情報処理装置１の元情報取得部１３１は、上述した処理により、ＬＩＤＡＲ８０２から多数の元情報を取得する。
【０１６３】
次に、移動体位置情報取得部１３２は、上述した処理により、移動体位置情報を取得する。
【０１６４】
次に、オブジェクト認識部１３３は、上述した処理により、移動体である情報処理装置１の周辺のオブジェクトを認識する。
【０１６５】
また、判断部１３５は、上述した処理により、例えば、近接する人間について、手の動きや姿勢といった動作を認識することが可能である。そして、判断部１３５は、危険なシーンの検出や、サービスロボットにおけるインタラクションなど、多様な機能の実現を可能とする（図１１参照）。
【０１６６】
なお、判断情報出力部１４２は、例えば、「危険であることを示す情報」等を出力したり、危険な人を出力図の中で目立つ態様で出力したりする。
（具体例４）
【０１６７】
情報処理装置１の元情報取得部１３１は、上述した処理により、ＬＩＤＡＲ８０２から多数の元情報を取得する。
【０１６８】
次に、オブジェクト認識部１３３は、上述した処理により、移動体である情報処理装置１の周辺のオブジェクトを認識する。
【０１６９】
また、移動体位置情報取得部１３２は、上述した処理により、移動体位置情報を取得する。そして、出力図構成部１３４は、上述した処理により、例えば、複数のオブジェクト、および移動体の軌跡を示す軌跡情報を含む出力図を構成する。なお、かかる出力図は、移動体による移動観測により得られるデータを自己位置認識に基づき統合した３次元マップである。
【０１７０】
そして、図出力部１４１は、出力図を出力する。また、かかる出力例は、図１２である。図１２によれば、例えば、特定の範囲を立体的に把握することが可能となり、施工結果の確認や計画との差異の検証に使用することができる。
【０１７１】
以上、本実施の形態によれば、移動体の位置の認識と当該移動体の周辺のオブジェクトの認識を同時に行い、移動体と周辺のオブジェクトとの位置関係をリアルタイムに出力できる。
【０１７２】
また、本実施の形態によれば、移動体の位置の認識と当該移動体の全方位のオブジェクトの認識を同時に行い、移動体と周辺のオブジェクトとの位置関係をリアルタイムに出力できる。
【０１７３】
また、本実施の形態によれば、移動体の位置の認識と当該移動体の周辺のオブジェクトの認識を同時に行い、かつオブジェクトの動作が条件に合致した場合（例えば、危険な場合）に、その旨を報知できる。
【０１７４】
さらに、本実施の形態によれば、移動体の位置の認識と当該移動体の周辺のオブジェクトの認識を同時に行い、移動体移動履歴と、移動体と周辺のオブジェクトとの位置関係をリアルタイムに出力できる。
【０１７５】
なお、本実施の形態における情報処理装置１によれば、例えば、自動車・建設機械・搬送機器・サービスロボットなどの自律移動システムにおいて、実世界における自己の位置を認識しつつ、周辺環境に存在する人やモノを検出・識別し、行動計画の策定を可能とする。また、情報処理装置１によれば、例えば、施設内や地下といった、ＧＰＳの使用が困難な場所においても自己位置を認識することができる。また、情報処理装置１は、周辺の車輌・作業員の検出や、寸法などの施工状態のリアルタイムな計測により、無人化施工を総合的に支援できる。また、情報処理装置１において、搬送機器の移動経路をトレースし、運搬された貨物の場所を記録できる。また、サイズなどの問題で管理が難しかった資材についても、必要になった時点で容易に配置を確認・把握することが可能である。さらに、広い視野を持つＬＩＤＡＲにより、広範囲を対象とした人流の計測が可能である。また、複数のセンサを効率的に配置することで、空港などの大規模施設においても滞留箇所などの解析を実現することができる。
【０１７６】
なお、本実施の形態における処理は、ソフトウェアで実現しても良い。そして、このソフトウェアをソフトウェアダウンロード等により配布しても良い。また、このソフトウェアをＣＤ−ＲＯＭなどの記録媒体に記録して流布しても良い。なお、このことは、本明細書における他の実施の形態においても該当する。なお、本実施の形態における情報処理装置１を実現するソフトウェアは、以下のようなプログラムである。つまり、このプログラムは、例えば、コンピュータを、移動する移動体の周辺に存在するオブジェクトの三次元空間における位置を特定する元になる１または２以上の元情報を取得する元情報取得部と、前記元情報取得部が取得した１以上の元情報を用いて、移動する移動体の三次元空間における位置を特定する移動体位置情報を取得する移動体位置情報取得部と、前記元情報取得部が取得した１以上の元情報を用いて、１以上のオブジェクトを特定し、当該１以上の各オブジェクトと各オブジェクトの２以上のオブジェクト位置情報とを対応付けるオブジェクト認識部と、前記移動体位置情報と前記１以上の各オブジェクトの２以上のオブジェクト位置情報とを用いて、前記移動体と前記１以上の各オブジェクトの相対的な位置関係が認識可能な三次元の図である出力図を構成する出力図構成部と、前記出力図を出力する図出力部として機能させるためのプログラムである。
【０１７７】
図１３は、本実施の形態におけるプログラムを実行して、情報処理装置１を実現するコンピュータシステム３００の外観図である。
【０１７８】
本実施の形態の各装置は、コンピュータハードウェアおよびその上で実行されるコンピュータプログラムによって実現され得る。図１３において、コンピュータシステム３００は、ディスクドライブ３０５を含むコンピュータ３０１と、キーボード３０２と、マウス３０３と、ディスプレイ３０４とを備える。なお、キーボード３０２やマウス３０３やディスプレイ３０４をも含むシステム全体をコンピュータと呼んでもよい。
【０１７９】
図１４は、コンピュータシステム３００の内部構成の一例を示す図である。図１４において、コンピュータ３０１は、ＭＰＵ３０１３と、ブートアッププログラム等のプログラムを記憶するためのＲＯＭ３０１５と、ＭＰＵ３０１３等に接続され、アプリケーションプログラムの命令を一時的に記憶すると共に、一時記憶空間を提供するＲＡＭ３０１６と、アプリケーションプログラム、システムプログラム、およびデータを記憶するハードディスク３０１７と、ＭＰＵ３０１３やＲＯＭ３０１５等を相互に接続するバス３０１４と等を備える。
【０１８０】
コンピュータシステム３００に、情報処理装置１の機能を実行させるプログラムは、例えば、ＣＤ−ＲＯＭ等のディスク３１０１に記憶されて、ディスクドライブ３０１２に挿入され、ハードディスク３０１７に転送されてもよい。これに代えて、そのプログラムは、ネットワークを介してコンピュータ３０１に送信され、ハードディスク３０１７に記憶されてもよい。プログラムは、実行の際にＲＡＭ３０１６にロードされる。なお、プログラムは、ハードディスク３０１６、またはネットワークから直接、ロードされてもよい。また、ハードディスク３０１６に代えて他の着脱可能な記録媒体（例えば、ＤＶＤやメモリカード等）を介して、プログラムがコンピュータシステム３００に読み込まれてもよい。
【０１８１】
プログラムは、コンピュータの詳細を示す９０１に、情報処理装置１の機能を実行させるオペレーティングシステム（ＯＳ）、またはサードパーティプログラム等を必ずしも含んでいなくてもよい。プログラムは、制御された態様で適切な機能やモジュールを呼び出し、所望の結果が得られるようにする命令の部分のみを含んでいてもよい。コンピュータシステム３００がどのように動作するのかについては周知であり、詳細な説明は省略する。なお、以上は例示であり、情報処理装置１を実現するコンピュータのハードウェア構成は問わない。
【０１８２】
また、上記プログラムを実行するコンピュータは、単数であってもよく、複数であってもよい。すなわち、集中処理を行ってもよく、あるいは分散処理を行ってもよい。
【０１８３】
また、上記各実施の形態において、各処理は、単一の装置によって集中処理されることによって実現されてもよく、あるいは、複数の装置によって分散処理されることによって実現されてもよい。
【０１８４】
本発明は、以上の実施の形態に限定されることなく、種々の変更が可能であり、それらも本発明の範囲内に包含されるものであることはいうまでもない。
【産業上の利用可能性】
【０１８５】
以上のように、本発明にかかる情報処理装置は、移動体の位置の認識と当該移動体の周辺のオブジェクトの認識を同時に行い、移動体と周辺のオブジェクトとの位置関係をリアルタイムに出力できるという効果を有し、情報処理装置等として有用である。
【符号の説明】
【０１８６】
１  情報処理装置
１１  格納部
１２  受付部
１３  処理部
１４  出力部
１３１  元情報取得部
１３２  移動体位置情報取得部
１３３  オブジェクト認識部
１３４  出力図構成部
１３５  判断部
１４１  図出力部
１４２  判断情報出力部
【図１】
2019075037.tif 000003
【図２】
2019075037.tif 000004
【図３】
2019075037.tif 000005
【図４】
2019075037.tif 000006
【図５】
2019075037.tif 000007
【図６】
2019075037.tif 000008
【図７】
2019075037.tif 000009
【図８】
2019075037.tif 000010
【図９】
2019075037.tif 000011
【図１０】
2019075037.tif 000012
【図１１】
2019075037.tif 000013
【図１２】
2019075037.tif 000014
【図１３】
2019075037.tif 000015
【図１４】
2019075037.tif 000016