JP7693284B2 - 情報処理装置、情報処理方法及びープログラム - Google Patents

Description

本発明は、移動体の位置を推定する技術に関する。

工場や物流倉庫において無人搬送車（Ａｕｔｏｍａｔｅｄ Ｇｕｉｄｅｄ Ｖｅｈｉｃｌｅ、以下ＡＧＶと呼ぶ）のような移動ロボットが用いられている。また、こうした無人搬送車の現在位置や姿勢を推定する方法として、カメラやレーザーレンジスキャナをセンサとして使用したＳＬＡＭ（Ｓｉｍｕｌｔａｎｅｏｕｓ Ｌｏｃａｌｉｚａｔｉｏｎ ａｎｄ Ｍａｐｐｉｎｇ）技術が知られている。例えば、特許文献１では、レーザーレンジスキャナを用いたＳＬＡＭ技術により走行エリアの水平面上の環境マップを作成する。それをＧＵＩ（Ｇｒａｐｈｉｃａｌ Ｕｓｅｒ Ｉｎｔｅｒｆａｃｅ）上に表示して無人搬送車の走行経路を設定するシステムが開示されている。特許文献２には、車両に搭載されているレーザスキャナから周辺物体にレーザを照射する。レーザスキャナと周辺物体との距離と方位を示す計測値から三次元点群データを生成し、ユーザによって指定された視線位置および視線方向に基づいて、その三次元点群データを二次元投影処理することで点群画像を生成する技術が記載されている。

ＷＯ１７／１８８２９２号公報 特許第６３３５３８９号公報

しかしながら、特許文献１または２の方法では、観測した三次元特徴点群すべてを二次元画像上に表示することで、経路設定に必要な特徴の位置を視認しづらくなる可能性があった。上記課題を解決する本発明にかかる情報処理装置は、三次元計測装置を有する移動体が計測した三次元計測結果をユーザに見やすいように表示することを目的とする。

上記の目的を達成する本発明に係る情報処理装置は、計測装置を有する移動体が移動する環境を示すマップを出力する情報処理装置であって、前記移動体が移動する天井を含む環境の特徴点の三次元位置を取得する取得手段と、前記特徴点の高さ方向の分布に基づいて、前記環境において前記天井の前記特徴点を除いた平面上の前記特徴点の位置を、前記環境における所定の平面に示す前記マップとして出力する出力手段と、を有することを特徴とする。

本発明によれば、三次元計測装置を有する移動体が計測した三次元計測結果をユーザに見やすいように表示できる。

情報処理装置のハードウェア構成例を示すブロック図 情報処理システムの機能構成例を示すブロック図 移動体の走行環境およびマップ画像の一例を示す図 情報処理装置が実行する処理の流れを示すフローチャート 出力部が実行する処理の流れを示すフローチャート 三次元空間中の特徴点群の水平方向の分布を示す図 三次元空間中の特徴点群の高さ方向の分布を示す度数折れ線グラフ 表示用データの投影結果の一例を示す図 位置姿勢情報の表示の一例を示す図 情報処理システムの機能構成例を示すブロック図 情報処理装置が実行する処理の流れを示すフローチャート ＧＵＩの一例を示す図 ＧＵＩの一例を示す図 情報処理装置が実行する処理の流れを示すフローチャート ＧＵＩの一例を示す図 表示用データの投影結果の一例を示す図 情報処理装置のハードウェア構成例を示すブロック図 情報処理システムの機能構成例を示すブロック図

以下、本発明の実施の形態について図面を参照して詳細に説明する。尚、以下の実施の形態は本発明の特許請求の範囲を限定するものではなく、また以下の実施の形態で説明されている特徴の組み合わせの全てが本発明を構成する上で必須のものとは限らない。

＜第１の実施形態＞
以下、本発明に係る第１の実施形態の情報処理装置について図面を参照して詳細に説明する。本実施形態では、周囲の形状を計測可能なセンサ（例えば、ステレオカメラ）等を搭載した自動運転車（以下、移動体と呼ぶ）が、周囲の環境をセンサで計測することによって、移動体自身の位置を推定する。移動体は、環境における特徴点の位置を示す環境マップにおいて事前にユーザによって設定された目的地まで走行する。なお、ここで説明する環境マップは、基本的には情報処理装置において移動体の位置を算出するために用いるマップで、環境（移動体が移動する現実空間）における特徴点の三次元位置を示す。ユーザはＧＵＩを介してこの環境マップを参照できるものとする。このとき、移動体が計測した周囲の形状を三次元の特徴点（以下、点群データと呼ぶ）として、情報処理装置と接続された表示装置に表示することができる。しかしながら、三次元の点群データすべてを単純に二次元座標系にプロットしたマップは、例えば図６ａに示すようなマップになるため、ユーザにとって地図として視認しづらい。また、環境マップに点群データを投影することで生成される図６ｂのようなマップは、例えば天井の形状といった余分な点群データを含むため、ユーザにとって視認性が低い。具体的には、一般に天井や床は特定の閉空間を構成する構造物であるため、移動体が移動する平面から所定の高さ（すなわち、床または天井の高さ）の平面において、天井または床を示す特徴点が一様に分布する。移動体の移動範囲を示す画像（すなわち、移動体を俯瞰してみたときの地図）を表示するためには、三次元特徴点を移動体が移動する平面に投影する。そのとき、高さ方向（Ｚ軸とする）が異なっていても、移動体が移動する平面を成す方向（Ｘ軸方向とＹ軸方向とする）が一致する特徴点は同じ位置に投影される。そのため、他の壁や家具等の静止物体を示す特徴点が、床または天井を示す特徴点と同じ位置に投影されてしまうことがある。そうすると、壁や静止物体の表面（端点）の位置が分かりづらいマップになってしまう可能性がある。特に、車両が室内を走行する場合は、天井や床等の観測点が多く二次元画像に射影されるため、天井や床ではない構造物（環境内の障害物）の特徴部分が見づらくなる可能性があった。そこで、第１の実施形態では、移動体が利用する環境マップ内の点群データのうち、ユーザが見るためのマップに有効なデータを用いて、よりユーザが直感的に環境内の位置を把握しやすい表示用データを生成し、表示装置上に表示する。さらに、リアルタイムで移動している移動体の現在位置を表示用データに重畳して表示装置上に表示することにより、ユーザは移動体の現在位置を容易に把握することが可能となる。

（情報処理装置および情報処理システムの構成）
図１は、本実施形態に係る情報処理装置１０１および移動体１２０のハードウェア構成の一例を示す図である。情報処理装置１０１は一般的なＰＣ機器の機能を備えており、ＣＰＵ１０２、ＲＯＭ１０３、ＲＡＭ１０４、ＨＤＤやＳＳＤ等の記憶部１０５、ＵＳＢ等の汎用Ｉ／Ｆ１０６およびシステムバス１０７で構成される。ＣＰＵ１０２は、ＲＡＭ１０４をワークメモリとして、ＲＯＭ１０３、記憶部１０５等に格納されたオペレーティングシステム（ＯＳ）や各種プログラムを実行し、システムバス１０７を介して各部を制御する。例えばＣＰＵ１０２が実行するプログラムには、後述する処理を実行するためのプログラムが含まれる。また、情報処理装置１０１には汎用Ｉ／Ｆ１０６を通じてキーボード等の操作部１１１、ディスプレイ等の表示装置１１２、通信部１１３が接続されており、あわせて情報処理システム１１０を形成している。さらに、情報処理システム１１０は通信部１１３を通じて１つ以上の移動体（１２０Ａ等）とネットワーク接続されている。移動体１２０Ａおよび１２０Ｂは、三次元環境マップの作成と三次元環境マップ内での自律走行が可能な無人搬送車である。移動体１２０Ａには情報処理装置１０１と同様に、ＣＰＵ１０２ａ、ＲＯＭ１０３ａ、ＲＡＭ１０４ａ、記憶部１０５ａ、通信Ｉ／Ｆ１０６ａがバス１０７ａによって接続されている。移動体１２０Ａは、通信Ｉ／Ｆ１０６ａを介して情報処理装置１０１や他の移動体と無線通信を行う。

情報処理システム１１０は、情報処理装置１０１の機能を用い、通信部１１３を通じて取得した移動体の情報を表示装置１１２が表示することによってユーザに提示する。また、本実施形態では詳細の説明を省略するが、操作部１１１を通じてユーザから移動体に指示を与える役割を持つ。

（情報処理装置の論理構成）
以下、本実施形態に係る情報処理装置の論理的な構成について説明する。以下に示す各部の処理は、ＲＯＭ１０３等からコンピュータプログラムをＲＡＭ１０４上に読み込んだ後、ＣＰＵ１０２によって該プログラムを実行することによってソフトウェアとして実施される。図２は、情報処理装置１０１、情報処理システム１１０および移動体１２０Ａの論理的な構成を示すブロック図である。

三次元特徴点群取得部２０１は、移動体が有する三次元計測装置によって計測された特徴点であって、移動体が移動する環境の形状を示す特徴点を取得する。例えば、記憶部１０５や移動体１２０Ａ上に保存された特徴点群データを取得する。三次元特徴点群取得部２０１は記憶部１０５に保存されている三次元環境マップを読み出し、環境マップ内の特徴点群データを取得する。環境マップの詳細については後述する。

表示用データ生成部２０２は、取得された特徴点群の一部から、環境における移動体の障害物の端部や境界を示す特徴点の位置を示すための特徴点を生成する。移動体にとって障害物になるかどうかは、移動体の高さを判断基準にすることができる。その他、天井・床の特徴は障害物にならないと判断することができる。特徴点群データを基に、天井または床の位置を示す特徴点を除いた画面表示用の三次元データを生成する。

投影部２０３は、環境における移動体の障害物の端部や境界を示す特徴点の位置を、環境における所定の平面に示したマップを投影する。すなわち、画面表示用の三次元データを所定の平面へ投影した２Ｄデータに変換する。所定の平面として、具体的には移動体が移動する平面（走行面）に対して特徴点群を射影する。これによって、移動体が移動可能な範囲をマップ上で示すことができる。

出力部２０４は、特徴点の一部に基づいて、環境において移動体が移動するときに障害となる物体の端部を示す特徴点の位置を、環境における所定の平面に示すマップとして出力する。境界とは具体的には壁や窓または物体（什器等）の他の物体との境界であり、移動体が移動する空間を仕切るものである。環境マップに存在する三次元特徴点群のうち、これらの境界の位置を示す特徴点は一部であるので、それ以外の特徴点を間引いて表示するために床や天井を示す特徴点群を除外して出力する。さらに、投影部２０３が、生成した２Ｄデータをはじめとする各種データを画像データに変換し、表示装置１１２上に表示する。位置姿勢取得部２０５は、通信部１１３を通じ、ネットワーク接続された移動体１２０Ａや移動体１２０Ｂが後述する位置姿勢計測部２１３で計測した位置姿勢をリアルタイムに取得する。移動体１２０の装置上で自己位置推定した結果を取得してもよい。移動体の位置を推定する方法は既存の技術を用いればよい。移動体の位置を推定する方法は位置推定部２１３の説明において後述する。他の方法では、例えば、客観カメラから撮った画像から移動体の特徴（マーカやＬＥＤライト）を検出して、環境マップにおける位置を特定してもよい。

（移動体の論理構成）
続いて、本実施形態において情報処理装置に接続されている移動体１２０Ａの論理的な構成について説明する。なお、移動体１２０Ｂは、移動体１２０Ａと同様の構成を持つ別個体である。環境マップは共通のものを使用すると仮定する。

計測装置２１７は、移動体に搭載され、移動体の周囲の環境を三次元特徴として計測する装置である。計測装置とは例えば、撮像装置（カメラ）や距離センサである。ここでは、計測装置として撮像装置を用いて、移動体の周囲の環境を撮像する。撮像した画像は画像取得部２１１に送信される。なお、計測装置には、グレースケールやカラーの輝度画像を取得するカメラやデプスカメラ、三次元－ＬｉＤＡＲなどを利用する。また、ステレオカメラを使用したり、複数のカメラを移動体の各方向を向くように並べたりしても良い。本実施形態においては、移動体の正面方向に固定されたグレースケールの輝度画像を取得可能なステレオカメラを使用する。

画像取得部２１１は、計測装置によって移動体の周囲の環境を計測したデータ（画像）を取得する。具体的には、移動体の周囲の輝度画像や深度画像をデジタルデータとして取得する。ステレオカメラや距離センサを用いて、各画素に距離値を示す距離画像を取得してもよい。

記憶部２１２は、移動体１２０Ａが利用する環境マップや経路情報を保存しているストレージである。例えば、計測装置によって計測された環境の形状を示す特徴点を環境マップとして記憶している。環境マップは事前に計測した特徴点群を用いて生成する。

位置姿勢計測部２１３は、画像取得部２１１が取得した画像と環境マップとに基づいて、移動体１２０Ａの環境マップ上での現在の位置姿勢を計測する。ここで位置姿勢とは、三次元空間上での座標と回転との組み合わせからなら６自由度の情報である。

三次元環境マップ作成部２１４は、環境内を移動している移動体１２０Ａ上の画像取得部２１１で連続的に取得した画像をもとに、位置姿勢計測部２１３で利用可能な環境マップを生成する。

本実施形態では、位置姿勢計測部２１３および三次元環境マップ作成部２１４の処理は、公知のステレオ画像を用いてＳＬＡＭとして実装されている。（例えばＭｕｒ－Ａｒｔａｌ， ＯＲＢ－ ＳＬＡＭ２： ａｎ Ｏｐｅｎ－Ｓｏｕｒｃｅ ＳＬＡＭ Ｓｙｓｔｅｍ ｆｏｒ Ｍｏｎｏｃｕｌａｒ， Ｓｔｅｒｅｏ ａｎｄ ＲＧＢ－Ｄ Ｃａｍｅｒａｓ． ＩＥＥＥ． ２０１７．）。 Ｖｉｓｕａｌ ＳＬＡＭでは移動体上に搭載したカメラで連続的に画像を撮影する。そして、各時刻の画像から画像平面上の特徴点を抽出し、ステレオペアあるいは直近の別の時刻の画像の画像平面上の特徴点との対応をもとに、三次元空間上での特徴点の座標とカメラの位置姿勢を同時かつ連続的に推定する技術である。推定された三次元空間上での特徴点は後述する環境マップに随時登録され、以降の時刻でのカメラの位置姿勢の推定に利用される。

通信部２１５は、情報処理システム１１０内の各種装置と相互にネットワーク接続を行い、各種データの送受信を行う。各種データとは、例えば、計測装置によって計測された特徴点や、環境マップ、移動体の位置姿勢情報等である。なお、情報処理装置１０１に送る特徴点は、三次元マップに登録された特徴点をすべて送ってもよいし、天井または床を示す特徴点を省いた有効な特徴点のみを送ってもよい。送信する特徴点の選択方法については、後述する表示用データ生成部で行う処理と同様にして決定する。

移動制御部２１６は、位置姿勢計測部が計測した現在位置姿勢および経路情報に基づき、移動手段（タイヤ）を駆動して移動体を移動させる。あるいは、図示しないインターフェースに基づいて前進・後退・旋回・停止などの指示をユーザから直接取得し、移動体を移動させる。移動手段は例えば一部が動力と連動した複数のタイヤであり、移動体１２０Ａは略平面である床面上を走行する。なお、移動体が走行する床面を所定の平面として三次元特徴点を投影する基準とする。これによって、走行経路と環境における障害物の端部や境界（壁の位置）とをユーザに見やすく表示できる。

（移動体の走行環境）
図３は、以降の処理の説明に用いる環境３００の水平面のレイアウトを示した模式図である。図３中のグレーで示した領域は壁などの障害物であり、白で示された領域は走行可能で水平な床面である。この環境は室内であり、所定の高さの水平な天井で覆われているものとする。障害物の例として、物体３０１は、移動体が自力で飛び越えて走行できないような高さがある物体（具体的には、段差や階段）である。障害物の天面や障害物上の天井が走行する移動体１２０Ａの画像取得部２１１から観測可能である。（ドアレール等の多少の窪みであれば移動体はそのまま走行できるものとする。）物体３０２は断面が円形の柱、物体３０３は断面が矩形の柱である。領域３０４は比較的薄い壁で覆われた、移動体１２０Ａで進入可能な部屋である。３０２～３０４の柱や壁は床から天井まで垂直に伸びている。また、ここでは説明の都合上環境３００には窓やガラスといった透明物体は、その透明物体の端部の特徴点を検出できるものとして説明する。

（環境マップ）
本実施形態で利用する環境マップは、公知のＶｉｓｕａｌ ＳＬＡＭ処理で生成あるいは利用可能な（二次元または三次元の）データである。環境マップは、三次元空間上の離散的な特徴点群と、離散的な複数のキーフレーム（環境内で撮像された画像と、撮影時のカメラパラメータと、その画像から観測される三次元空間上の特徴点群との対応関係を記述したもの）を含む。またカメラパラメータは、カメラの位置姿勢を記述した外部パラメータと、カメラの画角や光学系の歪曲特性を記述した内部パラメータを含む。

本実施形態では画像取得部２１１にグレースケール画像を取得するステレオカメラを使用しているため、各キーフレームについてステレオカメラの左右それぞれに対応したグレースケール画像とカメラパラメータが保存されている。外部パラメータについては、例えば左カメラの撮影時の位置姿勢のみを記録し、右カメラの位置姿勢は左カメラとの相対位置姿勢に基づいて算出する方式をとっても良い。

環境マップの作成は一例として、移動体１２０Ａ上の三次元環境マップ作成部２１４を起動した状態でユーザが移動体１２０Ａを手動で操作して移動させ、環境内の自律移動を予定している領域をくまなく移動することで生成される。本実施形態のように移動体が走行する領域が水平な床面である場合、環境マップ作成中の移動体１２０Ａの位置の履歴を平面近似することで水平面（床面）を推定する。水平面の取得は、姿勢が既知かつ画像からカメラとの相対姿勢を取得可能なマーカーを撮影することで推定してもよい。あるいは、移動体１２０Ａに加速度センサを組み込み、静止時に得られる鉛直方向を元に水平面を取得してもよい。

（移動体の位置姿勢表示処理）
次に、本発明に係る情報処理装置を使用した情報処理方法に関わる、三次元情報の表示方法および移動体の位置姿勢表示方法について図４～図１０を参照し説明する。ここでは、作成済みの環境マップの領域内を走行中の移動体１２０Ａの現在位置を、同じ環境マップデータ中の特徴点群を元に生成した表示用データに重畳して表示する手順を説明する。

図４は、本実施形態における情報処理装置が実行する処理の流れを示すフローチャートである。以下の説明では、各工程（ステップ）について先頭にＳを付けて表記することで、工程（ステップ）の表記を省略する。図４のフローチャートに示した処理は、コンピュータである図２のＣＰＵ１０１により記憶装置１０４に格納されているコンピュータプログラムに従って実行される。

Ｓ４０１では、情報処理装置１０１が、初期化を行う。ソフトウェアとして起動し、通信部１１３を通じて移動体１２０Ａとの通信を確立し、移動体１２０Ａが利用している三次元環境マップデータを記憶部１０５にコピーする。先述の通り、この三次元環境マップデータには三次元空間上の離散的な特徴点が含まれている。

Ｓ４０２では、出力部２０４が、特徴点の一部に基づいて、環境において移動体が移動するときに障害となる物体の端部を示す特徴点の位置を、環境における所定の平面に示すマップとして出力する。具体的には、出力部２０４が、記憶部１０５に保存された環境マップデータ中の特徴点データから表示用のデータを生成し、二次元の画像として表示装置１１２上に表示する、三次元情報の表示処理を行う。Ｓ４０２の処理は本実施形態の基幹となる部分であるため、詳細については後述する。

続くＳ４０３からＳ４０５の処理は、移動体の移動に伴いリアルタイムで反復的に実行される処理である。

Ｓ４０３では、位置姿勢取得部２０５が、環境を計測したデータと環境マップとに基づいて、移動体の位置姿勢を取得する。ここでは、各移動体がそれぞれ撮像した画像からＳＬＡＭの手法を用いて自己位置姿勢推定を行った結果を情報処理装置が取得するものとして説明する。なお、ステレオ画像による位置姿勢推定の方法は、上述した位置姿勢計測部２１３と同様にＳＬＡＭ技術等を用いる。または、通信部１１３を通じて移動体１２０Ａで算出された位置姿勢情報を取得してもよい。

Ｓ４０４では、出力部２０４が、環境において移動体が移動するときに障害となる物体の端部を示す前記特徴点の位置を、環境における所定の平面に示したマップに移動体１２０Ａの位置姿勢情報を示したマップを出力する。具体的には、出力部２０４はＳ４０３で取得した６自由度の位置姿勢情報を水平面上の座標と向きを示す３自由度の情報に変換し、座標と向きとを把握可能な画像データに変換して表示データ上に重畳表示する。図９は重畳表示結果の一例を示す図である。９０１は移動体１２０Ａの位置姿勢を示すグラフィックオブジェクトであり、移動体１２０Ａの現在位置が物体「３０１と断面が円形の柱３０２の間であり、図中右方向を向いていることを示している。

Ｓ４０５は、位置姿勢表示処理を終了するか継続するかの分岐である。例えばユーザから処理終了の指示があった場合や、移動体１２０Ａとの通信状態の悪化により位置姿勢情報の表示の継続が困難な場合、表示処理を終了する。そうでない場合、Ｓ４０３へもどり処理を継続する。処理を継続する際。Ｓ４０３からＳ４０５の処理が所定の頻度（例えば、１秒に１回）となるような待機時間を設けても良い。

なお、上記では移動体１２０Ａの処理時点での位置姿勢情報を表示装置１１２上に表示する例について説明したが、ネットワーク上の他の移動体１２０Ｂや、複数の移動体の位置姿勢情報を表示しても良い。また、移動体の位置姿勢情報の履歴をＲＡＭ１０４上に保存し、移動の軌跡を表示するような形態をとっても良い。

（三次元情報の表示処理）
続いて、Ｓ４０２で実行される三次元情報の表示処理の詳細について説明する。図５は、三次元情報の表示処理の詳細な流れを示すフローチャートである。

Ｓ５０１では、三次元特徴点群取得部２０１が、移動体が移動する環境の特徴点を取得する。なお、三次元特徴点は記憶部１０５に保存された環境マップデータから特徴点群データを取得する。または、画像から三次元特徴点を検出することによって取得してもよい。

Ｓ５０２では、表示用データ生成部２０２が、取得された特徴点群の一部から、環境において移動体が移動するときに障害となる物体の端部を示す特徴点を生成する。すなわち、表示用データ生成部２０２が、読み込んだ特徴点群から水平面への投影に適した点群を抽出する。この処理の流れは大きく３つの処理に分けられる。（１）三次元特徴点の高さの分布取得（２）分布においてピーク（突出する値、コントラストが大きい範囲等）を検出（３）検出されたピークに含まれる三次元特徴点以外を変換用のデータとして取得する。

環境マップデータ上の三次元の特徴点群は壁・床・天井・物体３０１の天面などに由来する点が混在している。全ての点を水平面に投影した場合、床面や、移動体よりも背が低い物体３０１の領域にも床・天井・物体３０１の天面に由来する特徴点が投影される。そのため、投影画像から物体３０１や部屋３０４の壁面の認識が困難な場合がある。

図６ａは環境マップデータ中のすべての特徴点を水平面に投影した場合の一例を示した図である。図６ｂは説明のため、投影した点群をマップ画像と重畳した図である。このような場合、図６ａでは断面が円形の柱３０２や断面が矩形の柱３０３の存在した領域には点群の空白が認められるが、物体３０１や部屋３０４の壁、および通行可能なエリアの区別は困難と言える。従って、点群の投影に際しては、レイアウトの把握や走行上の障害物の判別に適した点群を事前に抽出する必要がある。本実施形態では、天井・床に由来する点を除外し、壁や物体３０１に由来する点のみを表示用の特徴点群として抽出する。このような点を抽出することによって、移動体が移動する環境において移動可能な範囲を示すことができるため、ユーザにとって見やすい表示ができる。

図７中の実線部分は、環境マップ中の特徴点の分布を高さ方向の度数折れ線グラフとして表示したものである。縦軸は高さ値であり、横軸は度数である。高さ値は移動体１２０Ａの画像取得部２１１の高さを０とし、正方向に天井、負方向に床が存在する。ここで床面と天井はおよそ水平であるため、高さ方向の度数分布は天井に相当する高さにピーク７０１、床面に相当する高さにピーク７０２を持つ。低いピーク７０３は物体３０１に由来する特徴点の分布を示している。

表示用データ生成部２０２は度数分布からピークを検出した後、各々のピークに対してガウス関数による近似を行う。図７中の点線７０４は天井側のピークに対する近似結果を示しており、破線７０５はガウス関数のピークから原点側に半値半幅移動した高さを示している。同様に点線７０６は天井側のピークに対する近似結果を示しており、破線７０７はその原点側に半値半幅移動した高さを示している。表示用データ生成部２０２は破線７０５の高さを上限、破線７０７の高さを下限として特徴点の抽出を行うことで、壁や物体３０１に由来する点のみを自動的に抽出する。

なお上記では上限・下限値の高さの設定にガウス関数の半値の高さを用いているが、これはあくまで説明のための一例である。例えば天井・床に由来する特徴点をより積極的に除外する目的で、各々のピークから半値全幅（半値半幅の２倍）移動した高さを上限・下限値に用いても良い。また、ピーク値の検出にはガウス関数による近似以外の方法をとっても良く、例えば他の関数による近似や、天井側・床側それぞれの最大度数を階級の階級値を使用しても良い。あるいはＧＵＩなどを通じたユーザからの指示によりピーク値あるいは上限・下限値を決定しても良い。

Ｓ５０３では、投影部２０３が、移動体が移動するときに障害となる物体の端部を示す特徴点の位置を所定の平面に示したマップと、移動体の位置とを投影する。すなわち、Ｓ５０２で抽出した表示用の特徴点群を水平面に投影し、投影データを生成する。図８ａは投影結果を示した図である。図８ｂは説明のため、投影した点群を図３と重畳した図である。図８では図６と比較し、障害物と通路の区別、すなわち境界部分の視認が容易となっている。Ｓ５０４では、出力部２０４が投影データを表示装置１１２上に表示する。例えば、物体３０２や物体３０３は柱の内部に投影されていた特徴点が除去され、柱の外周を示す特徴点のみが投影されている。また、物体３０１は天井よりも低い位置にあるため、特徴点が残っている。なお、領域３０４は、移動体が内部まで移動して計測した特徴点が壁を示す特徴点として投影されている。そのため、最初の状態よりも領域３０４のような小部屋があることが視認しやすくなる。同時に領域３０４の内部は移動体が走行可能な領域であることがわかる。

以上、Ｓ４０２において図５で示した処理を実施することにより、情報処理装置１０１はユーザが環境内の位置関係を直感的に把握しやすい情報を表示装置１１２上に表示する。

（変形例１）
出力部２０４によって出力される特徴点群は、特徴点の高さ方向のピークに基づいて抽出したが、それ以外の方法を組み合わせて表示すべき特徴点を抽出してもよい。例えば、画像認識の学習モデルを用いることによって、移動体が回避すべき物体の位置またはその物体の特徴点の位置をマップに出力してもよい。具体的には、ＣＮＮ（畳み込みニューラルネットワーク）を用いて、移動体に搭載された撮像装置で撮像された画像から、環境に存在する物体を検出し、その物体が何かを出力する。画像においてある物体が存在する領域を示すセマンティックセグメンテーションの技術を用いてもよい。これらの技術によって、例えば、ドアやガラスの窓や壁を認識する。ドアが開いている場合は、三次元計測装置からドアの特徴点を取得できず、結果としてドアの位置に何もないマップになってしまう可能性がある。この場合は、ドアの位置を認識させることによって、マップにドアの位置を出力できる。また、透明なガラス等の透明物体は三次元計測装置によって計測が難しい物体である。そのため、あらかじめガラス等の透明物体の特徴を学習したモデルを用いて、透明物体が存在しそうな位置を認識する。このように認識処理を組み合わせることによって、移動体が移動可能な範囲をより正確にユーザに提示できる。

（本実施形態における効果）
以上、本実施形態において説明した情報処理装置ならびに情報処理方法を実施することにより、ユーザが環境マップ内での物体の位置関係や障害物の有無を直感的に把握しやすい画面表示を実現することができる。また、ユーザはそれを利用し、移動体の現在位置を用意に把握することが可能となる。

＜第２の実施形態＞
第１の実施形態では、環境マップデータ中の特徴点群から生成した表示用データを移動体の位置姿勢情報と重畳表示する手法について説明した。しかしながら、表示用データの利用方法はこれに限らない。本実施形態では、生成した表示用データを利用して移動体の経路設定を行う手法について説明する。本実施形態における情報処理装置および移動体の構成、走行環境、環境マップデータは第１の実施形態と同様であるため、説明は省略する。

（情報処理装置の論理構成）
図１０は、本実施形態における情報処理システム１１０の論理構成を示す図である。ＧＵＩ制御部１００１は、ユーザから情報処理システム１１０への指示に必要なＧＵＩコンポーネント等を表示装置１１２上に表示する。また、操作部１１１を通じ、ユーザから情報処理システム１１０への指示を受け取る。経路設定部１００２は、ユーザからの指示に基づき、環境マップ上の目標点座標の配列で構成された経路情報を生成する。

（マップ画像）
本実施形態で利用するマップ画像は、移動体が走行する空間の水平方向のレイアウトをユーザが視覚的に利用しやすい状態で提示可能なデジタル画像や、デジタル画像をレンダリング可能なアウトラインデータである。例として、部屋の間取り図やＣＡＤ図面などが好適である。以降の説明では、マップ画像の例として図３の図をとして用いる。

（経路設定処理）
次に、本発明に係る情報処理装置を使用した情報処理方法に関わる、移動体の経路設定方法について説明する。図１１は、本実施形態における経路設定の処理の流れを示すフローチャートである。Ｓ４０１およびＳ４０２の処理については、第１の実施形態と同等であるため説明を省略する。Ｓ１１０３では、経路設定部１００２が、記憶部１０５上に保存されたマップ画像の読み込みを行う。

Ｓ１１０４では、ＧＵＩ制御部１００１が表示用データおよびマップ画像を画面上に表示し、ユーザの指示に基づいて両者の位置合わせを行う。図１２は位置合わせ処理のためにユーザに提示されるＧＵＩの一例を示した図である。１２０１は投影データの点群１２０２およびマップ画像１２０３を表示する画像表示領域である。本実施形態で使用している環境マップデータは水平面については定義しているが、水平面上の上下左右の方向については特に定義していないため、表示用データとマップ画像との水平面上での向きが一致していない場合がある。また双方で縮尺が定義されているのでない場合、縮尺が一致しない場合がある。あるいは環境マップやマップ画像の精度により、両者の縦横比が一致しない場合も考えられる。

領域１２０４はユーザが位置合わせに利用する各種ボタン等を表示する操作領域である。ボタン１２０５は投影された点群（ｐｏｉｎｔ ｃｌｏｕｄ）あるいはマップ画像（ｍａｐ ｉｍａｇｅ）いずれに変形を施すかを選択するラジオボタンである。ボタン１２０６は変形の種類を選択するラジオボタンである。ここでは平行移動（ｔｒａｎｓｌａｔｉｏｎ）、回転（ｒｏｔａｔｉｏｎ）、拡大縮小（ｓｃａｌｉｎｇ）が選択可能である。ユーザは変形対象と変形の種類を選択し、マウス等のポインティングデバイスを利用して画像表示領域１２０１上の変形対象を操作することで、図８ｂのように特徴点群とマップ画像の示す座標が互いに一致した状態にする。ボタン１２０７は位置合わせ処理を完了するボタンである。

なお、変形の種類は上記に限らず、せん断や歪曲を含めても良い。あるいはオブジェクト上に複数の制御点を設定し、部分的な変形などより複雑な処理を行ってもよい。あるいは位置合わせのための変形を自動的に行ってもよい。一例としてはマップ画像から線分検出や輪郭抽出によって壁面に相当する領域を線として抽出し、投影データの点群とマップ画像から抽出した壁面との距離の二乗和が最小となるような最適化計算によって変形パラメータを算出してもよい。

Ｓ１１０５では、経路設定部１００２が、ＧＵＩ制御部１００１を通じて経路設定用ＵＩをユーザに提示し、ユーザの指示に基づいて経路データの生成を行う。

図１３は経路設定時のＧＵＩを示した図である。領域１３０１はユーザが経路設定に用いる各種ボタン等を表示する操作領域である。ボタン１３０２は画像表示領域に点群１２０２やマップ画像１２０３を表示するか否かを選択可能なトグルボタンである。図では双方を表示する状態になっている。

リスト１３０３は経路の目標地点（ｗａｙｐｏｉｎｔ）を管理する目標地点リストである。一例として目標地点の番号と座標が表示されている。また、画像表示領域１２０１上には目標地点の番号と対応づいた丸数字で各目標地点の座標が示されている。矢印は目標地点を番号順に繋いだものであり、移動体が自律走行する経路を示す。目標地点の数は任意に設定可能であり、例えばユーザが目標地点リスト１３０３の＋の部分を押下した場合、新たな目標地点を追加する。

ボタン１３０４は経路設定を完了するボタンである。ユーザが経路設定の完了を指示すると、経路設定部１００２はＧＵＩ上のｗａｙｐｏｉｎｔの座標を取得する。その後、Ｓ１１０４でユーザが投影データに施した変形処理のパラメータを基に各ｗａｙｐｏｉｎｔの座標を環境マップの座標系に変換し、環境マップデータとセットで利用可能な経路データを生成する。

Ｓ１１０６では、経路設定部１００２が、移動体１２０Ａに経路データを送信する。移動体１２０Ａは、自身の記憶部２１２に受信した経路データを保存する。記憶部２１２にはすでに環境マップデータが保存されているため、移動体１２０Ａは受信した経路データに基づいた自律走行が可能となる。

あるいは経路設定部１００２は、別の移動体１２０Ｂに対して経路データと環境マップデータをセットで送信しても良い。この場合も、移動体１２０Ｂは受信した経路データと環境マップデータに基づいた自律走行が可能となる。

＜変形例＞
本実施形態は移動体上で経路設定処理および三次元情報の表示処理を実施することでも実現可能である。

（移動体の構成）
図１７は、本実施形態に係る移動体１７０１の構成の一例を示す図である。移動体１７０１は情報処理システム１１０の機能に加え、移動体１２０Ａと同様の画像取得部２１１および移動手段を備えている。

（情報処理装置の論理構成）
以下、移動体の論理的な構成について説明する。図１８は、移動体１７０１の論理的な構成を示すブロック図である。各部の挙動については、第２の実施形態で説明した情報処理装置１０１、情報処理システム１１０および移動体１２０Ａと同様であるため省略する。

（経路設定方法）
本実施形態の移動体を使用した情報処理方法に関わる、環境マップデータの表示方法および移動体の経路設定方法については、第２の実施形態で説明したものと同様であるため、詳細な説明は省略する。なお、Ｓ４０１における環境マップデータの取得は移動体１７０１自身の記憶部１０５から取得しよい。また、Ｓ１１０６における経路情報の送信は、代わりに移動体１７０１自身の記憶部１０５に経路情報を保存してよい。

（本実施形態における発明の効果）
以上、本実施形態において説明した情報処理装置ならびに情報処理方法を実施することにより、ユーザが環境マップ内での物体の位置関係や障害物の有無を直感的に把握しやすい画面表示を実現することができる。また、それを利用し、移動体に対する経路設定を行うことが容易となる。

＜第３の実施形態＞
第１の実施形態では、環境マップデータ中の特徴点から水平面への投影に適した点群の抽出を高さ方向の分布に基づいて実施する手法について説明した。しかしながら、環境中に異なる高さの複数の天井が存在したり、天井が傾きを持っていたりする場合など、環境がより複雑な構造を持っている場合、高さ方向の分布だけでは天井の区別が難しい場合がある。本実施形態では、環境マップデータ中の特徴点にアノテーションや面近似を行うことで水平面への投影に適した情報を抽出する手法について説明する。

本実施形態における情報処理装置および移動体の構成、環境、環境マップは第１の実施形態と同様であるため、説明は省略する。ただし、本実施形態における環境には透明物体や特徴点の取得が難しい物体（繰り返しパターンを有する物体）があることで、表示すべき特徴点の一部が、画像からうまく検出されていない場合も考える。また、本実施形態における三次元情報の表示処理についても、Ｓ５０２における表示用データの生成処理を除き第１の実施形態と同様であるため、他の部分の説明は省略する。

また、本実施形態で説明する三次元情報の表示処理は、第１の実施形態で説明した移動体の位置姿勢情報表示処理、第２の実施形態で説明した移動体の経路設定処理のいずれにも利用可能である。

（三次元情報の表示処理）
本実施形態における、本発明に係る情報処理装置処が実行する処理について図１４～図１６を参照し説明する。

図１４は、本実施形態における情報処理装置１０１が実行する、Ｓ５０２の処理の詳細な流れを示すフローチャートである。

Ｓ１４０１では、表示用データ生成部２０２が、記憶部１０５上の環境マップから環境画像を取得する。具体的には環境マップ中のキーフレーム群から環境内で撮像された画像と撮影時のカメラパラメータの組み合わせのデータを取得する。

Ｓ１４０２では、操作部１１１が、環境マップから取得した環境画像を用い、ユーザによって指示された、環境マップ中の特徴点に対し所属面のアノテーションの入力を受け付ける。

図１５はアノテーション作業を行うＧＵＩの一例を示した図である。１５０１は環境画像を表示する環境画像表示領域、１５０２は水平面に投影された特徴点とカメラの位置姿勢を表示する投影画像表示領域、１５０３はユーザがアノテーションに用いる各種ボタン等を表示する操作領域である。

領域１５０４は操作対象の環境画像を選択するプルダウンメニューである。環境マップ中の各キーフレームに対応した番号を選択可能である。環境画像表示領域１５０１にはここで選択したキーフレームの環境画像と画像上の特徴点が表示される。また投影画像表示領域１５０２にはその環境画像撮影時の位置姿勢と画角が１５０８のように表示される。

リスト１５０５はユーザがアノテーションした所属面を管理する所属面リストである。一例として０番と１番の２つの所属面が表示されている。ｃｏｌｏｒの列は環境画像表示領域１５０１に表示する際の色を示している。例えば領域１５０９は０番の所属面としてユーザが選択した領域であり、２つに分かれている１５１０は１番の所属面としてユーザが選択した領域である。

ｃｕｔの列は水平面に投影する際に該当の所属面を除外するか否かを示しており、各所属面に対しユーザが選択可能である。図中では０番の所属面は矩形の柱３０３の壁面である。ここは投影に適しているため除外しない設定（ＮＯ）となっている。一方、１番の所属面は天井であるため、投影に際し除外する設定（ＹＥＳ）となっている。所属面の数は任意に設定可能であり、例えばユーザがリスト中の＋の部分を押下した場合、新たな所属面を追加する。

領域１５０６は所属面に対する操作を選択するボタン群の領域である。操作対象の所属面を選択するプルダウンメニューと、領域を追加（ａｄｄ）するか削除（ｅｒａｓｅ）するかを選択するラジオボタンが表示されている。図中では０番の所属面の領域を追加するモードが選択されており、この状態でマウス等のポインティングデバイスを利用して環境画像表示領域１５０１の該当の所属面を塗ることで、領域１５０９のような領域を選択する。

ボタン１５０７はアノテーション処理を完了するボタンである。ユーザがこのボタンを押下した場合、処理はＳ１４０２へ進む。

Ｓ１４０３では、表示用データ生成部２０２が、特徴点と所属面の対応付けと近似面の生成を行う。例えば０番の所属面について、１２０９の領域と重なっている４つの特徴点との対応付けが行われ、また４つの特徴点の三次元座標から近似面が算出される。また、領域１２０９の範囲から、近似面の広さが決定される。近似に際しては、図示していないＧＵＩに基づくユーザの指示に応じて水平あるいは水平面に垂直であるというような拘束条件を適用しても良い。あるいは平面や円筒の側面であるというような形状に関する拘束条件を適用しても良い。

Ｓ１４０４では、表示用データ生成部２０２が、投影に適した面および特徴点の抽出を行う。ここでは、Ｓ１４０３で除外対象として設定されなかった所属面に対応する近似面と、近似面に対応する特徴点群を表示用データとして抽出する。ここで近似面に対応する特徴点群は、各近似面からの距離閾値に応じて選択され、近似面の元となった所属面に対応づけられた特徴点群とは必ずしも一致しない。またある特徴点について距離閾値内に複数の近似面が存在する場合、特徴点は最も近い近似面に対応づけられる。あるいは、全体の近似面と点群から、除外対象とした所属面に対応する近似面とそれに対応する点群を除外し、残りを表示用データとしても良い。

図１６ａは、上記１４０３において抽出した面および点群データを、Ｓ５０３において投影した結果を示した図である。三次元空間中の面を平面に投影した場合の形状は一般には面であるが、抽出した近似面は投影面に対しておおよそ垂直であるため、投影結果は線分に近い形状となる。本実施形態では説明の簡便のため、投影部２０３が投影した面の形状を線分で近似したものとし、図１６ａでは投影結果を線分として表示している。しかしながら、投影した面の形状をそのまま表示しても良い。

また、矩形の柱３０３の一部の面のように、拘束条件なしで所属する特徴点が３点に満たない場合など、近似面が生成できない場合がある。このような場合、投影面上には該当の面は表示されない。図１６ｂは説明のため、抽出した面を投影した線分を図３と重畳した図である。

なお、ガラス等の透明物体が存在する領域は、そもそも特徴点の位置がうまく検出できていない可能がある。そのような領域に対して、透明物体であることを示すアノテーションを入力する。その領域が撮像範囲に含まれる場合は、所定の指標（例えば、ガラスの壁があることを示す標識）を表示させてもよい。ドアに対してもドアであることを示すアノテーションを入力してもよい。この場合、ドアが開いている場合と閉まっている場合で、撮像された画像に含まれる特徴点が変わってくる。このような変化に対応するために、ドアや移動可能な物体がある領域に対してはドアがあることを示す指標を対応する位置に表示させてもよい。ユーザは上記で説明したＧＵＩを用いて、ドアのある領域にドアがあることを示すアノテーションを入力する。出力部は、ドアがあることを示されるアノテーションに対しては、その領域にドアがあることを示す指標（例えば、ドアのアイコン）を出力する。このようにアノテーションを入力することによって、ユーザが環境についての補助的な情報を付与できるので、より視認性の高いマップ表示を実現できる。

（本実施形態における発明の効果）
以上、本実施形態において説明した情報処理装置ならびに情報処理方法を実施することにより、環境がより複雑な構造を持っている場合においても、ユーザが環境マップ内での物体の位置関係や障害物の有無を直感的に把握しやすい画面表示を実現することができる。

＜その他の実施形態＞
第１の実施形態では、環境マップデータ中の特徴点群から抽出された点群を水平面上に投影し表示する手法について説明した。しかしながら、本実施形態における特徴点群の取得方法はこれに限定されない。例えば環境マップ中の特徴点の分布が著しく疎である場合や、壁や障害物に由来する特徴点の割合が小さい場合など、投影時に視覚的に十分な量の点群が得られない場合がある。そのような場合の、環境マップデータからより密な点群を生成して利用しても良い。具体的には環境マップデータ中のキーフレーム群から環境内で撮像された画像と撮影時のカメラパラメータの組み合わせのデータを取得する。そして、公知のＭｕｌｔｉ Ｖｉｅｗ Ｓｔｅｒｅｏ（ＭＶＳ）等の手法によって壁面・障害物・天井・床などのより密な点群データを得る。（例えば、Ｙａｓｕｔａｋａ Ｆｕｒｕｋａｗａ ａｎｄ Ｊｅａｎ Ｐｏｎｃｅ ， Ａｃｃｕｒａｔｅ， Ｄｅｎｓｅ， ａｎｄ Ｒｏｂｕｓｔ Ｍｕｌｔｉ－Ｖｉｅｗ Ｓｔｅｒｅｏｐｓｉｓ， ＰＡＭＩ ２００８）。

密な点群データの生成は、環境マップの特徴点群より密で、投影時に視覚的に十分な量と精度となる点群が得られるのであれば他の手法を用いても良く、また必ずしも正確で欠損のない点群の生成を行う必要はない。例えば特徴点検出と対応点探索によって新たな特徴点を追加する方式であっても良い。あるいは既知のＳｅｍｉ－Ｇｌｏｂａｌ Ｍａｔｃｈｉｎｇ（ＳＧＭ）手法によって各キーフレームの位置姿勢から密なデプス画像を生成し、各画素をカメラパラメータとデプス値に基づいて三次元の点に変換しても良い。画像取得部２１１がデプスカメラである場合も同様に処理する。

また、第１の実施形態では表示用データの生成の後に投影処理を実施しているが、表示用データの生成処理と投影処理の順序は可換である。第１の実施形態の例で言えば、あらかじめ床・天井・物体「３０１の天面等に由来するものを含む全ての点を投影したデータを生成しておき、上限値・下限値の設定に従って各点の表示・非表示を切り替えるような形態をとっても良い。特にユーザの指示によって上限値・下限値の調整を行いながら画面表示を行うような場合、投影済みの各特徴点の表示・非表示のみを切り替えることで調整結果を迅速に表示に反映することができる。

また、第１の実施形態では、移動体１２０Ａと移動体１２０Ｂを同じ構成の別個体であるとしたが、両者の構成に差異があっても良い。例えば移動体１２０Ａは自律移動機能を持たない、三次元環境マップの作成に特化した装置であっても良い。このような場合、さらには移動制御部２１６や移動手段を省略し、ユーザが手持ちで搬送しつつ三次元環境マップを作成するような装置であっても良い。一例としては、本実施形態はカメラを装着したタブレットＰＣのような形態をとる。また、移動体１２０Ｂは三次元環境マップ作成部２１４を省略し、他の装置から三次元環境マップと経路情報を受け取って自律走行するための装置であっても良い。

また、第２の実施形態における移動体１７０１も、移動体１２０Ａと同様に、自律移動機能を持たない、三次元環境マップの作成のための装置であっても良い。また同様に、移動制御部２１６や移動手段を省略し、ユーザが手持ちで搬送しつつ三次元環境マップを作成するような装置であっても良い。

あるいは移動体１７０１の三次元環境マップ作成部２１４を省略し、他の装置から三次元環境マップを取得した上で経路情報を設定し、自律走行するための装置としても良い。

また、上記実施形態で説明した移動体は略水平な平面である床面上を走行することを前提としていたが、本実施形態はそれ以外の面上を移動するものや、三次元の移動が可能な移動体に対しても適用可能である。例えば壁面上を移動する移動体であれば投影面は地面に垂直な面となりうる。さらなる例として、円筒形の柱の壁面を移動するような場合は、曲面である円筒側面を投影面とし、極座標を用いて投影を行っても良い。そのような場合、投影面を平面に展開した図をＧＵＩ上の表示等に使用することが望ましい。三次元の移動が可能な移動体を用いる場合、画面上に移動体の現在位置の高さ（投影面と垂直な方向の座標値）を表示したり、経路設定時に各目標点に個別に高さを設定するＵＩを設けたりすることが望ましい。

また、第３の実施形態では、ユーザのアノテーションに基づいて特徴点の面近似を行う手法について説明したが、面近似の方法はこれに限らず、またユーザによるアノテーションも必須ではない。例えば既知のＲａｎｄｏｍ Ｆｏｒｅｓｔ法などを用いて特徴点群を複数のグループに分類し、各グループに対して面近似を行うような手法を取っても良い。

また、表示用データの生成処理は、第１の実施形態のように移動体が主に移動する面からの高さ値と、特徴点に紐づけられた面の向きの双方に基づいて特徴点や面の表示用データへの抽出を行ってもよい。

なお、上述した各処理部のうち、表示用データ生成部、三次元特徴点群取得部等 については、その代わりとして、機械学習された学習済みモデルを代わりに用いて処理しても良い。その場合には、例えば、その処理部への入力データと出力データとの組合せを学習データとして複数個準備し、それらから機械学習によって知識を獲得し、獲得した知識に基づいて入力データに対する出力データを結果として出力する学習済みモデルを生成する。学習済みモデルは、例えばニューラルネットワークモデルで構成可能である。そして、その学習済みモデルは、前記処理部と同等の処理をするためのプログラムとして、ＣＰＵあるいはＧＰＵなどと協働で動作することにより、前記処理部の処理を行う。なお、上記学習済みモデルは、必要に応じて一定の処理後に更新しても良い。

また、本発明は、以下の処理を実行することによっても実現される。即ち、上述した実施形態の機能を実現するソフトウェア（プログラム）を、データ通信用のネットワーク又は各種記憶媒体を介してシステム或いは装置に供給する。そして、そのシステム或いは装置のコンピュータ（またはＣＰＵやＭＰＵ等）がプログラムを読み出して実行する処理である。また、そのプログラムをコンピュータが読み取り可能な記録媒体に記録して提供してもよい。本発明は上述したコンピュータプログラムを記載した記憶媒体の形態をとってもよい。本発明を構成するコンピュータプログラムの供給には様々な方法を取ることが可能であり、インターネット等のネットワークを介して配布される場合や、プログラムが暗号化或いは分割されて配布される場合も本発明の範疇である。

１１０ 情報処理システム
１０１ 情報処理装置
１１２ 表示装置
２１２ 記憶部
２１７ 計測装置
１２０Ａ，１２０Ｂ 移動体

Claims (21)

1. 計測装置を有する移動体が移動する環境を示すマップを出力する情報処理装置であって、
   前記移動体が移動する天井を含む環境の特徴点の三次元位置を取得する取得手段と、
   前記環境の前記特徴点から、前記特徴点の高さ方向の度数分布から検出した高さ方向のピークに基づいて前記天井の前記特徴点を除き、前記天井の前記特徴点を除いた前記特徴点の位置を、前記環境における所定の平面に投影した前記マップを出力する出力手段と、を有することを特徴とする情報処理装置。
2. 前記出力手段は、前記所定の平面として前記移動体が走行する平面に前記特徴点の位置を出力することを特徴とする請求項１に記載の情報処理装置。
3. 前記出力手段は、前記環境における天井または床を示す前記特徴点を除いて出力することを特徴とする請求項１に記載の情報処理装置。
4. 前記出力手段は、前記特徴点の高さ方向の分布に基づいて、所定の範囲に分布する前記特徴点を出力することを特徴とする請求項１乃至３の何れか１項に記載の情報処理装置。
5. 前記出力手段は、前記特徴点の高さ方向の分布に基づいて、前記環境における床から天井の間の高さに分布する前記特徴点を出力することを特徴とする請求項４に記載の情報処理装置。
6. 前記出力手段は、前記移動体の高さよりも所定の値だけ高い位置に分布する前記特徴点を除いて出力することを特徴とする請求項１乃至５の何れか１項に記載の情報処理装置。
7. 前記特徴点の一部を抽出するための所定の条件を設定する設定手段をさらに有し、
   前記出力手段は、前記設定手段によって設定された前記所定の条件に基づいて、前記特徴点の一部を出力することを特徴とする請求項１乃至６の何れか１項に記載の情報処理装置。
8. 前記設定手段は、ユーザによって指定された前記特徴点の高さ方向についての前記所定の条件を設定することを特徴とする請求項７に記載の情報処理装置。
9. 前記出力手段は、前記移動体の位置を示した前記マップを出力することを特徴とする請求項１乃至８の何れか１項に記載の情報処理装置。
10. 前記計測装置は撮像装置であって、
    前記取得手段は、前記撮像装置によって前記移動体の周囲の環境を撮像した画像データに基づいて生成された前記マップから、前記特徴点の三次元位置を取得することを特徴とする請求項９に記載の情報処理装置。
11. 前記計測装置は距離センサであって、
    前記取得手段は、前記撮像装置によって前記移動体の周囲の環境を計測した三次元点群データに基づいて生成された前記マップから、前記特徴点の三次元位置を取得することを特徴とする請求項１０に記載の情報処理装置。
12. 前記環境における前記特徴点の位置を投影した前記マップを記憶する記憶手段を更に有し、
    前記取得手段は、前記マップに基づいて前記特徴点の位置を取得することを特徴とする請求項１乃至８の何れか１項に記載の情報処理装置。
13. 前記出力手段によって出力された前記マップを表示装置に表示させる制御手段を更に有することを特徴とする請求項１乃至１２の何れか１項に記載の情報処理装置。
14. 前記出力手段によって出力された前記マップに対して、前記移動体が移動する経路を指定された結果を受け付ける受け付け手段をさらに有することを特徴とする請求項１乃至１３の何れか１項に記載の情報処理装置。
15. 前記計測装置によって計測されたデータに基づいて、所定の物体を認識する認識手段を更に有し、
    前記出力手段は、前記認識手段によって認識された前記物体の位置を更に出力することを特徴とする請求項１乃至１４の何れか１項に記載の情報処理装置。
16. 前記認識手段は、前記所定の物体としてドアを認識し、
    前記出力手段は、前記認識手段によって認識された前記ドアの位置を前記マップに示すことを特徴とする請求項１５に記載の情報処理装置。
17. 前記認識手段は、前記所定の物体として透明物体を認識し、
    前記出力手段は、前記透明物体の端部の位置を前記マップに出力することを特徴とする請求項１５または１６に記載の情報処理装置。
18. 前記認識手段は、三次元計測装置である撮像装置によって撮像された画像から所定の物体を検出する学習モデルであることを特徴とする請求項１５乃至１７の何れか１項に記載の情報処理装置。
19. コンピュータを、請求項１乃至１８のいずれか１項に記載の情報処理装置が有する各手段として機能させるためのプログラム。
20. 計測装置を有する移動体が移動する環境を示すマップを出力する情報処理方法であって、
    前記移動体が移動する天井を含む環境の特徴点の三次元位置を取得する取得工程と、
    前記環境の前記特徴点から、前記特徴点の高さ方向の度数分布から検出した高さ方向のピークに基づいて前記天井の前記特徴点を除き、前記天井の前記特徴点を除いた前記特徴点の位置を、前記環境における所定の平面に投影した前記マップを出力する出力工程と、を有することを特徴とする情報処理方法。
21. 計測装置を有する移動体が移動する環境を示すマップを出力する情報処理システムであって、
    前記移動体には情報処理装置と表示装置とを有し、
    前記情報処理装置は、
    前記移動体が移動する天井を含む環境の特徴点の三次元位置を取得する取得手段と、
    前記環境の前記特徴点から、前記特徴点の高さ方向の度数分布から検出した高さ方向のピークに基づいて前記天井の前記前記天井の前記特徴点を除いた前記特徴点の位置を、前記環境における所定の平面に投影した前記マップを出力する出力手段と、を有し、
    前記表示装置は、
    前記出力手段によって出力された前記マップを表示する表示手段を有することを特徴とする情報処理装置。

Images