(57)【要約】【課題】自律移動装置に備えられる地図情報作成装置において、精度の良い地図情報を作成する。【解決手段】地図情報作成装置１は、周囲の環境を認識して周囲情報を取得する環境認識部２と、環境認識部２が取得した周囲情報に基づいて地図情報を作成する地図情報作成部３と、自己の位置及び向きを変化させる駆動装置４と、地図情報作成部３が作成した地図情報に基づいて駆動装置４の動作を制御する制御部５と、地図情報を記憶する記憶部６と、地図情報と周囲情報とを照合して自己の位置情報を取得する位置認識部７と、を備える。地図情報作成部３は、地図情報と周囲情報とを照合した結果、位置情報の取得には使用されなかった周囲情報を基にして地図情報を更新するので、地図情報作成装置１は、自律的に移動しながら精度の良い地図情報を作成することができる。【選択図】図１
2008305255.tif 000002
【特許請求の範囲】
【請求項１】
周囲の環境を認識して周囲情報を取得する環境認識手段と、前記環境認識手段が取得した周囲情報に基づいて地図情報を作成する地図情報作成手段と、自己の位置及び向きを変化させる移動手段と、前記移動手段の動作を制御する制御手段と、を備えた地図情報作成装置であって、
前記地図情報を記憶する記憶手段と、
前記地図情報と前記周囲情報とを照合して自己の位置情報を取得する位置認識手段と、をさらに備え、
前記地図情報作成手段は、前記位置認識手段が前記地図情報と前記周囲情報とを照合した結果、位置情報の取得には使用されなかった周囲情報を基にして地図情報を更新することを特徴とする地図情報作成装置。
【請求項２】
前記地図情報及び周囲情報は、特徴物を示す線情報又は特徴物に設けられた標識を示す点情報を含むことを特徴とする請求項１に記載の地図情報作成装置。
【請求項３】
前記地図情報及び周囲情報は、特徴物を示す線情報を含み、
前記位置認識手段は、前記線情報のうち、平行でない２つの線情報を使用して自己の位置情報を取得することを特徴とする請求項１に記載の地図情報作成装置。
【請求項４】
前記２つの線情報は、前記線情報のうち最も長い線と、この線と最も直角に近い角度で交わる線であることを特徴とする請求項３に記載の地図情報作成装置。
【請求項５】
前記地図情報及び周囲情報は、特徴物を示す線情報を含み、
前記記憶手段は、前記線情報の角度情報を記憶しており、
前記地図情報作成手段は、地図情報の更新時に、位置情報の取得には使用されなかった周囲情報を地図情報として登録する登録処理を行い、登録される線情報の角度を前記記憶手段に記憶された角度に合わせることを特徴とする請求項１に記載の地図情報作成装置。
【請求項６】
前記地図情報作成手段は、前記地図情報の更新時に、位置情報の取得には使用されなかった周囲情報を地図情報として登録する登録処理を行い、登録された地図情報から所定範囲内に削除対象となる点情報又は線情報が存在するかを検索し、削除対象が検出されると、検出された線情報又は点情報を削除する削除処理を行うことを特徴とする請求項２に記載の地図情報作成装置。
【請求項７】
請求項１乃至請求項６のいずれか一項に記載の地図情報作成装置を備え、該装置が作成した地図情報に基づいて移動する自律移動装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、周囲環境情報を取得して地図情報を作成する地図情報作成装置及びそれを備えた自律移動装置に関する。
【背景技術】
【０００２】
従来から、自律的に移動する車両やロボットといった自律移動体が開発され、例えば、病院で入院患者に食事を運搬する配膳ロボット等に試みられている。これらの自律移動体が自律的に移動するためには、壁面等の障害物を検出してそれを回避すると共に、地図上における自己の位置座標や向きといった自己の位置情報を取得する必要がある。自律移動体が自己の位置情報を取得する方法としては、例えば、車両においては、駆動輪のモータに取り付けられたエンコーダから求められる車輪の回転数や、ジャイロから求められる自律移動体の回転角度等の内部データを用いて移動距離や移動方向を決定する、いわゆるデッドレコニング（dead reckoning推定航法）が知られている。
【０００３】
しかし、デッドレコニングでは、例えば、車輪がスリップする等によって位置情報に誤差が生じることがある。そこで、上記のような自律移動体では、通常、マップマッチングによる位置情報の補正が行われる。すなわち、自律移動体は予め地図情報を記憶しておく記憶媒体と、周囲情報を取得する種々のセンサ等とを備え、記憶された地図情報と、センサ等を用いて取得した周囲情報とを照合して、その照合結果に基づき、デッドレコニングによって取得された位置情報を補正することにより、より正確な位置情報を取得することができる。
【０００４】
また、この種の自律移動体では、例えば、レーザレンジファインダを用いて一定角度又は一定間隔で水平スキャンを行い、物体からの反射波を受信して二次元平面内に分布する一群のスキャンポイントを取得し、これらのスキャンポイントの中から、所定条件でスキャンポイントを選択し、選択されたスキャンポイントを連結して線分の集合を形成し、この線分の集合から壁面の位置を取得することにより、地図情報を作成し、この地図情報に基づいて自律移動するロボットが知られている（例えば、非特許文献１参照）。
【０００５】
また、例えば、ＣＣＤカメラで撮像したイメージから、所定の基準位置となる認識標識と比較される対象ターゲットを抽出し、この対象ターゲットの形状が認識標識の形状と一致するかを判断すると共に、この対象ターゲットとの距離が上記の認識標識との間の距離と一致するかを判断する等により、自己の位置情報を正確に抽出することができるロボットが知られている（例えば、特許文献１参照）。
【非特許文献１】Li Zhang & Bijoy K. Ghosh, "Line Segment Based Map Building and Localization Using 2D Laser Rangefinder", IEEE Int. Conf. On Robotics & Automation, pp.2538-2543,2000
【特許文献１】特許第３８８３００６号公報
【発明の開示】
【発明が解決しようとする課題】
【０００６】
しかしながら、非特許文献１に示される自律移動体は、レーザレンジファインダによってスキャンされたスキャンポイントを基に、これらを連結して線分の集合を形成して地図情報を作成するものであり、地図情報を作成する際に基準となる線分を有していない。そのため、例えば、周回する経路を作成するようなとき、地図情報作成位置と地図情報作成終了位置とが一致するような正確な地図情報を作成することは困難であった。また、特許文献１に示される自律移動体は、予め基準位置となる認識標識を壁面や天井等に設けておく必要があるので、例えば、自律移動体の稼動領域において、壁面等の領域を特徴づける特徴物の配置が変更されたとき等に、自己の位置を特定することができず、また、予め取得されていた地図情報を更新することもできなかった。
【０００７】
本発明は、上記課題を解決するものであり、自己の位置情報を正確に取得すると共に、地図情報を適宜に更新して、精度の良い地図情報を作成することができる地図情報作成装置及びそれを備えた自律移動装置を提供することを目的とする。
【課題を解決するための手段】
【０００８】
上記課題を解決するため、請求項１の発明は、周囲の環境を認識して周囲情報を取得する環境認識手段と、前記環境認識手段が取得した周囲情報に基づいて地図情報を作成する地図情報作成手段と、自己の位置及び向きを変化させる移動手段と、前記移動手段の動作を制御する制御手段と、を備えた地図情報作成装置であって、前記地図情報を記憶する記憶手段と、前記地図情報と前記周囲情報とを照合して自己の位置情報を取得する位置認識手段と、をさらに備え、前記地図情報作成手段は、前記位置認識手段が前記地図情報と前記周囲情報とを照合した結果、位置情報の取得には使用されなかった周囲情報を基にして地図情報を更新するものである。
【０００９】
請求項２の発明は、請求項１に記載の地図情報作成装置において、前記地図情報及び周囲情報は、特徴物を示す線情報又は特徴物に設けられた標識を示す点情報を含むものである。
【００１０】
請求項３の発明は、請求項１に記載の地図情報作成装置において、前記地図情報及び周囲情報は、特徴物を示す線情報を含み、前記位置認識手段は、前記線情報のうち、平行でない２つの線情報を使用して自己の位置情報を取得するものである。
【００１１】
請求項４の発明は、請求項３に記載の地図情報作成装置において、前記２つの線情報は、前記線情報のうち最も長い線と、この線と最も直角に近い角度で交わる線としたものである。
【００１２】
請求項５の発明は、請求項１に記載の地図情報作成装置において、前記地図情報及び周囲情報は、特徴物を示す線情報を含み、前記記憶手段は、前記線情報の角度情報を記憶しており、前記地図情報作成手段は、地図情報の更新時に、位置情報の取得には使用されなかった周囲情報を地図情報として登録する登録処理を行い、登録される線情報の角度を前記記憶手段に記憶された角度に合わせるものである。
【００１３】
請求項６の発明は、請求項２に記載の地図情報作成装置において、前記地図情報作成手段は、前記地図情報の更新時に、位置情報の取得には使用されなかった周囲情報を地図情報として登録する登録処理を行い、登録された地図情報から所定範囲内に削除対象となる点情報又は線情報が存在するかを検索し、削除対象が検出されると、検出された線情報又は点情報を削除する削除処理を行うものである。
【００１４】
請求項７の発明は、請求項１乃至請求項６のいずれか一項に記載の地図情報作成装置を備え、該装置が作成した地図情報に基づいて移動する自律移動装置である。
【発明の効果】
【００１５】
請求項１の発明によれば、周囲情報と地図情報とを照合して、自己の位置情報を修正した後に、地図情報を更新するので、精度の良い地図情報を作成することができる。
【００１６】
請求項２の発明によれば、線情報又は点情報といった簡単なアルゴリズムを用いることにより、精度の良い自己の位置情報を取得することができる。
【００１７】
請求項３の発明によれば、照合する線情報の数が少なくなるので、少ない計算量で位置情報を取得することができるようになり、また、地図情報上の線情報に誤差があるとき、照合に使用しなかった線情報に基づいて地図情報を更新することができる。
【００１８】
請求項４の発明によれば、最も長い線は、一般に多くのスキャンデータ等から成るので、この線情報を基準として照合を行うことにより、少ない線情報を使用したときでも、誤差が少なく、より精度の高い位置情報を取得することができる。
【００１９】
請求項５の発明によれば、地図情報として記憶された線情報の微妙なズレを回避することができ、地図情報作成手段は、直線から成るきれいな地図情報を作成することができる。
【００２０】
請求項６の発明によれば、取得された位置情報にズレがあっても、地図情報作成手段は、削除対象を的確に検出し、間違った地図情報の更新を行わないようすることができる。
【００２１】
請求項７の発明によれば、位置情報の取得には使用されなかった情報を基にして地図情報を正確に更新するので、自律移動装置の駆動領域において壁面等の特徴物のレイアウトが変更されたときでも、自律移動装置は特徴物に接触することなく、正確に自律移動することができる。
【発明を実施するための最良の形態】
【００２２】
本発明の一実施形態に係る地図情報作成装置及びそれを備えた自律移動装置を備えた自律移動装置について、図１を参照して説明する。本実施形態の地図情報作成装置１は、周囲環境情報を取得しながら移動することにより、指示された作業を遂行する自律移動装置に備えられるものである。
【００２３】
本実施形態の地図情報作成装置１は、周囲の環境を認識して周囲情報を取得する環境認識部２（環境認識手段）と、環境認識部２が取得した周囲情報に基づいて地図情報を作成する地図情報作成部３（地図情報作成手段）と、自己の位置及び向きを変化させる駆動装置４（移動手段）と、地図情報作成部３が作成した地図情報に基づいて駆動装置４の動作を制御する制御部５（制御手段）と、を備える。また、地図情報作成装置１は、地図情報を記憶するメモリ等から成る記憶部６（記憶手段）と、地図情報と周囲情報とを照合して自己の位置情報を取得する位置認識部７（位置認識手段）と、走行領域内の目的地や走行のためのパラメータなどを入力するためのインタフェース８と、をさらに備える。また、地図情報作成装置１は、電池９を備え、上記の各手段は電池９の給電により動作する。
【００２４】
環境認識部２は、地図情報作成装置１の本体の特定の位置を原点とし、その原点から臨む空間を、例えば、レーザレンジファインダ等の環境認識センサを用いて一定角度又は一定間隔でスキャンして、原点からの方向毎にその方向にある壁面等の特徴物上にある点の位置座標を検出し、スキャンの時系列に従って順序付けられた複数の位置座標の集合を、周囲情報における線情報Ｌとして取得する。また、レーザレンジファインダが、壁面等の特徴物からの反射光を受光して、受光した光量を評価できる場合、反射時の光量損失が少ない回帰反射板を予め壁面等の特徴物や天井等に設けておき、この回帰反射板で反射された光の光量からその位置座標を特定して、これを周囲情報における点情報Ｐとして取得してもよい。なお、上述したレーザによるスキャンは必ずしも水平である必要はなく、傾斜していてもよいし、照射されるレーザは一定の拡がりを有していてもよい。
【００２５】
また、環境認識部２として、ＣＣＤカメラを備え、また、壁面や天井面に予め設置された位置認識標識の配置や形状等を記憶部６に記憶させておき、ＣＣＤカメラで撮像したイメージから、比較される対象物を抽出し、記憶部６に記憶された認識標識の形状と、抽出された対象物の形状とが一致するかを判断することにより、特徴物の点情報Ｐを取得してもよい。さらに、環境認識部２には障害物検知用超音波センサ等が適用されてもよく、地図情報作成装置１が自己の位置情報を特定することができるように、少なくとも上述した線情報Ｌ又は点情報Ｐといった周囲情報を取得することができれば、その検出装置や検出方法については特に限定されない。
【００２６】
記憶部６は、地図情報作成装置が搭載する自律移動装置の稼働領域において、壁、フェンス、柵等の平面状の特徴物を表現する線分の集合がマップセグメントとして予め設定され、これらの線分の、少なくとも始点及び終点の座標を線情報として記憶し、また、壁面や天井等に配置された回帰反射板等の位置座標を点情報として記憶している。また、位置認識部７は、記憶部６に記憶された地図情報と周囲情報とを照合するための種々のプログラム及びこれを実行するマイコン等から成る。
【００２７】
インタフェース８は、人が直接操作できるタッチパネルやキーボードや、人又は他の装置から遠隔操作可能な通信手段等により構成される。地図情報作成装置１は、このインタフェース８を介して目的地を指示されると、記憶部６に記憶された地図情報、又は地図情報作成部３により更新された地図情報に基づいて、目的地までの走行経路を生成し、制御部５が駆動装置４を駆動させることにより移動を開始する。または、インタフェース８から移動量を指示されると、制御部５が駆動装置４を駆動させることにより移動を開始する。
【００２８】
駆動装置４は、電池９の電力で駆動されるモータ及びこのモータの駆動出力を床面に伝える車輪等を備える。上記のモータ又は車輪等には、その回転数や回転速度を計測するエンコーダが設けられている。また、地図情報作成装置１は、好ましくは、自己の回転方向の移動を検出するためのジャイロセンサ（図示せず）を備え、上記のエンコーダの出力及びジャイロセンサの検出角度を用いて移動距離や移動方向を知ることができ、それらに基づいてデッドレコニングを行い、環境認識部２が取得した周囲情報と記憶部６に記憶された地図情報とを照合する範囲を限定することができる。
【００２９】
以下、本実施形態の地図情報作成装置１における動作の概略を図２に示したフローを参照して説明する。地図情報作成装置１は、インタフェース８において動作開始の操作信号が入力されると、まず、環境認識部２が、周囲情報を取得する（Ｓ１）。次に、位置認識部７は、環境認識部２が取得した周囲情報と、記憶部６に予め記憶されていた地図情報とを照合して、自己の位置情報を取得できたかを判断する（Ｓ２）。位置情報が取得されると、地図情報作成部３は、位置認識部７が地図情報と周囲情報とを照合した結果、位置情報の取得には使用されなかった周囲情報を基に地図情報として更新できる情報があるかを判断する（Ｓ３）。具体的には、位置情報の取得には使用されなかった周囲情報には存在するが地図情報には存在しない情報、すなわち地図情報として新たに登録できる情報があるか、又は、位置情報の取得には使用されなかった周囲情報には存在しないが地図情報には存在する情報、すなわち地図情報から削除できる情報があるかを判断する。そして、これら登録対象又は削除対象となる情報があるとき、地図情報作成部３は、これらの情報に基づいて地図情報を更新する（Ｓ４）。ここで「更新」とは、新たに登録できる情報を地図情報上に登録する登録処理を行うこと、及び地図情報上から削除できる情報を削除する削除処理を行うことをいう。地図情報作成装置１は、インタフェース８において終了指示が入力されるまで、上述のＳ１〜Ｓ４の動作を繰り返し、終了指示が入力されると上述の動作を終了する（Ｓ５）。
【００３０】
次に、上述した地図情報作成装置１の各動作のうち、環境認識部２が周囲情報を取得して、位置認識部７が周囲情報と記憶部６に予め記憶されていた地図情報とを照合して、自己の位置情報を取得する手順について、更に詳細に説明する。まず、環境認識部２が周囲情報を線情報Ｌとして取得するときの手順について、図３（ａ）〜（ｃ）を参照して説明する。図中の実線は記憶部６に地図情報として記憶された特徴物の位置を表す線情報（以下、線分ｌという）を示し、点線は環境認識部２が取得した周囲情報に含まれる線情報Ｌを示す。
【００３１】
地図情報作成装置１は、例えば、駆動装置４に備えられたエンコーダ等を用いてデットレコニングを行い、自己の推定位置（ｘ，ｙ，ａ）を割り出す。上記ｘ、ｙは夫々（ｘ，ｙ）座標系における地図情報作成装置１の位置座標を示す。また、上記ａは地図情報作成装置１の向きを示しており、例えば、地図情報作成装置１の進行方向（ｘｒ軸）とｘ軸とのなす角により表される。次に、環境認識部２は、レーザレンジファインダ等を用いて、壁面等の特徴物を線情報Ｌとして検出する。この線情報Ｌは、地図情報作成装置１の相対位置（図中の（ｘｒ，ｙｒ）座標系）として検出された後、地図情報作成装置１の推定位置を基に、位置認識部７で用いられる（ｘ，ｙ）座標系の座標データに変換される。例えば、環境認識部２が、地図情報作成装置１の推定位置（ｘ，ｙ，ａ）から距離ｒ、ｘｒ軸に対する角度θの位置にスキャンポイントｓｐを検出したとき、このスキャンポイントｓｐは（ｘ，ｙ）座標系における座標データ（ｘ＋ｒ・ｃｏｓ（ａ＋θ），ｙ＋ｒ・ｓｉｎ（ａ＋θ））と変換される。なお、線情報Ｌは、線分の始点及び終点を含む少なくとも２点の座標データによって表される。
【００３２】
取得された線情報Ｌは、位置認識部７において、記憶部６に記憶された地図情報と照合される。図３（ａ）に示されるように、２本の線情報Ｌが取得され、それらの重心Ｇから予め定められた範囲に、地図情報として記憶された線分ｌが存在し、それらの線分ｌとの角度差（図中のα１，α２）が所定の範囲にあるとき、位置認識部７は、取得された線情報Ｌと地図情報における線分ｌとが一致するものと判断する。本実施形態において、位置認識部７は、環境認識部２が取得した周囲情報のうち、一定の領域にある周囲情報と地図情報とを照合してもよいし、環境認識部２が取得した周囲情報の全ての領域と地図情報とを照合してもよい。
【００３３】
線情報Ｌと地図情報の線分ｌとが一致するものと判断されると、位置認識部７は、線情報Ｌと線分ｌとの角度差（α１，α２）から、図３（ｂ）に示されるように、地図情報作成装置１の推定位置の角度を補正する。通常、上記角度差α１，α２は一致するが、微小な検出誤差を生じることがあるので、これらの平均角度を算出して地図情報作成装置１の角度を補正することにより、精度の良い位置情報が取得される。次に、位置認識部７は、線情報Ｌと線分ｌとの相対距離（図中のｄｘ，ｄｙ）から、図３（ｃ）に示されるように、地図情報作成装置１の推定位置の座標を補正する。これにより、地図情報作成装置１は、自己の位置情報を正確に取得することができる。
【００３４】
上記の環境認識部２において、複数の線情報Ｌが取得されたとき、位置認識部７は、取得された線情報Ｌのうち、平行でない２本の線情報Ｌを使用し、これを地図情報と照合して自己の位置情報を取得する。このようにすると、照合する線情報Ｌ及び線分ｌの数が少なくなるので、少ない計算量で位置情報を取得することができるようになり、また、地図情報上の線分間に誤差があるとき、照合に使用しなかった線情報Ｌに基づいて地図情報を更新することができる。また、地図情報との照合に用いられる２つの線情報Ｌは、好ましくは、最も長い線情報Ｌと、この線情報Ｌと最も直角に近い角度で交わる線情報Ｌとする。最も長い線情報Ｌは、多くのスキャンデータ等から成るので、この線情報Ｌを基準として照合を行うことにより、２本の線情報Ｌを使用したときでも、誤差が少なく、より精度の高い位置情報を取得することができる。
【００３５】
次に、環境認識部２が周囲情報を点情報Ｐとして取得するときの手順について、図４（ａ）（ｂ）を参照して説明する。図中の○印は、記憶部６に地図情報として記憶された、予め壁面等の特徴物や、天井等に配置される回帰反射板等の点情報（以下、標識ｐ１，ｐ２，…，ｐｎ）であり、図中の■印は、環境認識部２がレーザレンジファインダ等を用いて取得した周囲情報に含まれる点情報Ｐ（Ｐ１，Ｐ２）を示す。この例においても、位置認識部７は、取得された点情報Ｐと地図情報として記憶された標識ｐを照合して、少なくとも２点の点情報Ｐ（Ｐ１，Ｐ２）の位置から予め定められた範囲（図中の点線円）に、地図情報として記憶された回帰反射板等の標識ｐ１，ｐ２が存在するとき、これら点情報Ｐ（Ｐ１，Ｐ２）と、標識ｐ１，ｐ２とが一致するものと判断する。そして、上述の線情報Ｌを使用した位置情報の取得と同様に、位置認識部７は、図４（ｂ）に示されるように、地図情報作成装置１の位置座標及び角度を補正して、自己の位置情報を取得する。
【００３６】
次に、地図情報作成部３が、位置情報の取得する際の照合に使用されなかった周囲情報に基づいて地図情報を更新するときの手順の一例を、図５（ａ）乃至（ｈ）及び図６を参照して説明する。ここでは、図５（ａ）に示されるように、デフォルトの地図情報として線分ｌｂ，ｌｃが記憶部６に記憶され、照合に使用されなかった周囲情報として線情報Ｌａが抽出されたものとする。この例のように、周囲情報として抽出された情報が線情報（線分）であるとき（Ｓ６）、地図情報作成部３は、その線分とのなす角度及び距離が所定範囲内にある地図情報が存在するかを判断する（Ｓ７）。図５（ａ）の例では、線情報Ｌａとのなす角度γ及び距離ｖが所定範囲内にある地図情報上の線分ｌｃの存在が確認されたものとする。このとき、地図情報作成部３は、図５（ｂ）に示されるように、線情報Ｌａを、線分の中心ｇに回転させ、線分ｌｃとの角度を一致させると共に、図５（ｃ）に示されるように、線情報Ｌａを、線分ｌｃの方向に対する垂線ｖの長さがゼロになるように移動させ（Ｓ８）、回転及び移動後の線情報Ｌａ’は、線分ｌｃと重複する部分ｗがあるかを判断する（Ｓ９）。そして、重複する部分ｗがあるとき、地図情報作成部３は、回転及び移動後の線情報Ｌａ’を地図情報上の線分ｌａとして登録する登録処理を行う。このとき、線分ｌａと線分ｌｃとの重複する部分ｗについては、新たに登録される線分ｌａに含まれるものとして地図情報を修正する（Ｓ１０）。ここで、回転及び移動後の線情報Ｌａ’を線分ｌａに合成したものを、新たな一本の線分ｌａとして地図情報を修正するようにしてもよい。
【００３７】
次に、地図情報作成部３は、図５（ｄ）に示されるように、地図情報作成装置１に備えられた環境認識センサの座標ｓ及び線分ｌａの両端の座標によって囲まれる三角形の領域Ａ１に、削除対象となる地図情報上の線分が含まれているかを判断する（Ｓ１１）。そして、領域Ａ１に地図情報上の線分が含まれているとき、この線分のうち、領域Ａ１に含まれる線分を削除する（Ｓ１２）。図５（ｄ）の例では、線分ｌｂのうち、線分Ｄｂの部分を削除する。次に、地図情報作成部３は、図５（ｅ）に示されるように、環境認識センサの座標ｓと、線分ｌａの両端の座標のうち座標ｓに近い座標ｐａとを結ぶ線分を、予め設定された距離ｄａだけ延伸した線分ｒａを半径とする扇型の領域Ａ２に、削除対象となる地図情報上の線分が含まれているかを判断する（Ｓ１３）。そして、領域Ａ２に地図情報上の線分が含まれているとき、この線分のうち、領域Ａ２に含まれる線分を削除する（Ｓ１４）。図５（ｅ）の例では、線分ｌｃのうち、線分Ｄｃの部分を削除する。なお、地図情報上の線分の削除は、上述のように、領域Ａ１，Ａ２に含まれる部分のみを削除してもよいし、図５（ｆ）に示されるように、削除される線分を含む線分ｌｂ，ｌｃの全体を削除するようにしてもよい。なお、上述のように、扇型の領域Ａ２の半径ｒａを、線分ｌａの両端の座標のうち、座標ｓに近い座標ｐａを延伸した所定の長さにすると、削除対象を検索する領域が大きくなり過ぎないので、削除処理の高速化を図ることができる。
【００３８】
また、地図情報作成部３は、地図情報作成部３は、図５（ｇ）に示されるように、線情報Ｌａとのなす角度及び距離が所定範囲内にある地図情報が存在しないとき（Ｓ７）、又は、線情報Ｌａを回転及び移動させても所定の回転角度内及び移動範囲内に地図情報が存在しないとき（Ｓ９）、線情報Ｌａを、地図情報上の線分ｌａとして登録する（Ｓ１５）。次に、図５（ｈ）に示されるように、上述と同様の手順で定められた領域Ａ１，Ａ２に含まれる地図情報上の線分を削除する（Ｓ１１〜Ｓ１４）。また、照合に使用されなかった周囲情報が点情報であるとき等、その情報が線分（線情報）でないとき、地図情報作成部３は、照合に使用されなかった周囲情報を地図情報として登録し（Ｓ１６）、登録された地図情報と同種の地図情報が、その周囲情報の位置から予め設定された範囲内にあるかを判断し（Ｓ１７）、その範囲内に含まれる地図情報を削除する（Ｓ１８）。これらの動作は、照合に使用されなかった周囲情報の数だけ繰り返される。上述のように、地図情報作成部３は、位置情報の取得に用いられなかった周囲情報を基に、この周囲情報から所定範囲にある地図情報のうち、削除対象を的確に検出する。そのため、例え取得された位置情報にズレがあっても、地図情報作成部３は、削除対象を的確に検出して間違った地図情報の更新を行わないようすることができる。なお、本実施形態において、地図情報の更新手順は、上述した例に限られない。
【００３９】
次に、地図情報作成部３が地図情報の削除処理を行う際の好ましい動作例について、図７（ａ）〜（ｃ）を参照して説明する。ここでは、図７（ａ）に示されるように、デフォルトの地図情報として線分ｌｃが存在し、周囲情報として線情報Ｌａが取得されたものとする。この例において、地図情報作成部３は、周囲情報と地図情報との照合時に、線情報又は線分を構成するスキャンポイント等の各点列において、始点と終点を予め定めておく。そして、領域Ａ１，Ａ２に登録又は削除対象となる情報が存在するとき、地図情報作成部３は、図７（ｂ）に示されるように、線情報Ｌａと線分ｌｃとの夫々の始点Ｓａ，ｓｃから終点Ｆａ，ｆｃのベクトルのなす角度を検出し、検出された角度が予め設置された条件を満たす場合（例えば、９０°以上等）には、線分の削除処理を行わないようにする。こうすれば、図７（ｃ）に示されるように、稼動領域にブロック状の特徴物Ｂが設置され、線分ｌｃが地図情報作成装置１からは周囲情報として取得されない特徴物Ｂの側面を表しているときでも、地図情報作成装置１は線分ｌｃを削除しないようにすることができる。
【００４０】
次に、地図情報作成装置１が実行する自己の位置情報の取得から地図情報の更新までの一連の手順について、３パターンの例示により説明する。まず、第１のパターンを図８（ａ）〜（ｅ）に示す。ここでは、図８（ａ）に示されるように、記憶部６が、デフォルトの地図情報として線分ｌ１，ｌ２を記憶しているものとする。上述のように、地図情報作成装置１は、地図情報を更新する前に、まず、環境認識部２が周囲情報を取得する。取得された周囲情報は、図８（ｂ）に示されるように、線情報Ｌ１，Ｌ２，Ｌ３とする。そして、位置認識部７は、記憶部６に記憶されたデフォルトの地図情報と取得された周囲情報を照合して、自己の位置情報を取得する。図８（ｂ）の例では、線情報Ｌ１，Ｌ２から所定の座標位置及び角度に、線分ｌ１，ｌ２があることから、位置認識部７は、これらの一致するものと判断して、図８（ｃ）に示されるように、自己の推定位置の座標及び角度を修正して、正確な位置情報を取得する。位置情報が取得されると、地図情報作成部３は、位置認識部７が地図情報と周囲情報とを照合した結果、位置情報の取得には使用されなかった情報の中に、地図情報として更新できる情報があるかを判断する。図８（ｄ）の例では、線情報Ｌ３が更新できる情報として抽出される。そして、地図情報作成部３は、図８（ｄ）に示されるように、抽出された線情報Ｌ３を地図情報上に線分ｌ３として新たに登録して、これを記憶部６に記憶させる。このように、本実施形態の地図情報作成装置１は、周囲情報と地図情報とを照合して、自己の位置情報を修正した後に、地図情報を更新するので、精度の良い地図情報を作成することができる。
【００４１】
続いて、第２のパターンを図９（ａ）〜（ｅ）に示す。図９（ａ）に示されるように、記憶部６が、デフォルトの地図情報として、回帰反射板等の標識ｐ１，ｐ２を記憶しているものとする。このときも、上述の線情報Ｌを用いたときと同様の手順により地図情報が更新される。すなわち、環境認識部２が、図９（ｂ）に示されるように、周囲情報として、点情報Ｐ１，Ｐ２，Ｐ３が取得されると、位置認識部７は、標識ｐ１，ｐ２及び点情報Ｐ１，Ｐ２とを照合して、図９（ｃ）に示されるように、位置情報を取得する。その後、地図情報作成部３は、地図情報と周囲情報との照合の結果、図９（ｄ）に示されるように、位置情報の取得には使用されなかった点情報Ｐ３を抽出して、図９（ｅ）に示されるように、これを地図情報上の標識ｐ３として新たに登録して、これを記憶部６に記憶させる。
【００４２】
次に、第３のパターンを図１０（ａ）〜（ｅ）に示す。図１０（ａ）に示されるように、記憶部６が、デフォルトの地図情報として線分ｌ１，ｌ２，ｌ４を記憶していて、環境認識部２が、図１０（ｂ）に示されるように、周囲情報として線情報Ｌ１，Ｌ２，Ｌ３，Ｌ５を取得したものとする。このときも上述の同様に、位置認識部７は、周囲情報の線情報Ｌ１，Ｌ２と、地図情報の線分ｌ１，ｌ２とを照合して、図１０（ｃ）に示されるように、位置情報を取得する。また、地図情報作成部３は、図１０（ｄ）に示されるように、位置情報の取得には使用されなかった情報の中に、地図情報として更新できる情報を抽出する。このとき、地図情報として更新できる情報として線分ｌ３，ｌ５が抽出されている。線情報Ｌ３に関しては、図６のフロー中で、Ｓ６→Ｓ７→Ｓ１５→Ｓ１１→Ｓ１３の順に処理を行うことにより、地図情報上に線分ｌ３として新たに登録される。一方、線情報Ｌ５に関しては、Ｓ６→Ｓ７→Ｓ１５→Ｓ１１→Ｓ１２→Ｓ１３の順に処理を行うことにより、地図情報上に線分ｌ５として新たに登録されると共に、図１０（ｅ）に示されるようにデフォルトの地図情報にあり、周囲情報として取得されなかった線分ｌ４が削除される。なお、図６のフローに示される登録及び削除処理は、照合に使用されなかった周囲情報の数だけ繰り返し実行される。
【００４３】
上述の図１０（ｄ）の線分ｌ４のように、地図情報の更新において、削除される情報があるとき、地図情報作成部３は、周囲情報のサーチ範囲を広げて、削除対象が存在しないことを確認する。すなわち、位置情報を取得する際に地図情報との照合に使用された周囲情報が、環境認識部２が取得した周囲情報の一部の領域であるときは、地図情報との照合で使用されなかった領域にも削除対象が存在しないことを確認した後に地図情報の更新を行う。こうすれば、取得された位置情報にズレがあったときでも、地図情報作成部３は、間違った地図情報の更新を行わないようすることができる。なお、位置情報を取得する際に地図情報との照合に使用された周囲情報が、環境認識部２が取得した周囲情報と一致するときは、環境認識部２において、より広い範囲について再度のセンシングを行い、削除対象となる情報の座標位置を確実にカバーする広い範囲の周囲情報を取得する。
【００４４】
自己の位置情報を取得するには、上述したパターン以外にも、図１１（ａ）（ｂ）に示されるように、周囲情報として１本の線情報Ｌ１及び１点の点情報Ｐ１を取得できれば、図１１（ｃ）（ｄ）に示されるように、位置認識部７は、これらをデフォルトの地図情報として記憶された線分ｌ１，ｌ２及び標識ｐ１と照合して、地図情報における線分ｌ１及び標識ｐ１から自己の位置情報を一意的に取得することができる。このように、線情報と点情報とを組み合わせることにより、例えば、長い一方向の壁しかないような通路といった線情報の取得が制限されうる環境においても、位置認識部７は自己の位置情報を正確に取得することができる。
【００４５】
好ましくは、記憶部６は、地図情報における線分(線情報）の角度情報を記憶していている。そして、地図情報作成部３は、地図情報の更新において新たに登録される線情報の角度を、記憶部６に記憶された角度に合わせる。ここで角度情報とは、線情報と基準座標軸（例えば、ｘ軸）とのなす角をいう。図１１の例では、記憶部６は、予め線分ｌ１の角度を記憶していて、図１１（ｅ）に示されるように、線情報Ｌ１が新たな線分ｌ１’として登録されるとき、この新たに登録される線分ｌ１’の角度と、予め記憶された線分ｌ１の角度情報とが所定の角度差以内であれば、地図情報作成部３は、これらが同一直線上にあるものと判断して、線分ｌ１’の角度を線分ｌ１の角度情報に合わせて、これを新たな地図情報として登録する処理を行う。このようにすれば、地図情報として記憶された線分の微妙なズレを回避することができ、地図情報作成部３は、直線から成るきれいな地図情報を作成することができる。また、地図情報作成装置１を備えた自律移動体の稼動領域における通路等が、直角に交わる壁で構成されていることがある。この場合、壁方向を座標軸と一致させておくと、地図情報の線情報の向きは、ｘ軸又はｙ軸のどちらかと一致することになる。また、壁面が突出しているような使用環境においては、地図情報として登録される線分の近傍に、登録される線分とは角度の異なる線分が記憶されていることがある。上述のように、地図情報における線分(線情報）の角度情報を記憶し、各々の線分の角度差が所定の範囲以上であるときは、登録される線分の近傍にある、角度の異なる線分の削除処理を行わないようにすることにより、地図情報作成部３は、削除するべき情報と、削除すべきでない情報とを識別することができ、必要な地図情報を誤って削除することがない。なお、登録される線分は、自身の角度情報と予め記憶された特定の角度（例えば、ｘ軸との角度が０°、４５°、９０°…等）との差が所定範囲内である場合に、自身の角度情報をこの特定の角度と一致するように、その座標を合わせるようにしてもよい。
【００４６】
また、地図情報作成部３は、図１１（ｆ）に示されるように、線分ｌ１’及び線分ｌ１を１本の線分ｌ１として記憶部６に記憶させてもよい。このようにすれば、重複する線情報（線分）を１本の線情報として処理することができるので、位置情報取得時の照合に要する計算量を少なくして、迅速に照合を行えるようになり、また、記憶部６の記憶容量を効率的に使用できる。
【００４７】
また、本実施形態の地図情報作成装置１を備えた自律移動装置は、周囲情報と予め記憶された地図情報とを照合して自己の位置情報を取得して、この位置情報の取得には使用されなかった情報を基にして地図情報を正確に更新するので、自律移動装置の稼動領域において、例えば、新たな棚が設置されたり、パーティションのレイアウトが変更される等、特徴物の配置が変更されたときでも、位置を誤認識することなく、正確に自律移動することができる。
【００４８】
なお、本発明は、種々の変形が可能であり、地図情報と周囲情報とを照合して自己の位置情報を取得する際に、位置情報の取得には使用されなかった情報を基にして地図情報を更新するものであれば、上記構成に限られない。また、自己の位置情報の取得に使用される情報は、本実施形態で説明した線情報や点情報に限られない。
【図面の簡単な説明】
【００４９】
【図１】本発明の一実施形態に係る地図情報作成装置のブロック構成図。
【図２】同地図情報作成装置における動作フローを示す図。
【図３】（ａ）乃至（ｃ）は同地図情報作成装置が周囲情報として得られた線情報に基づいて自己の位置情報を取得するときの動作パターンを示す図。
【図４】（ａ）（ｂ）は同地図情報作成装置が周囲情報として得られた点情報に基づいて自己の位置情報を取得するときの動作パターンを示す図。
【図５（ａ）−（ｃ）】（ａ）乃至（ｃ）は同地図情報作成装置が地図情報の更新時の動作パターンを示す図。
【図５（ｄ）−（ｆ）】（ｄ）乃至（ｆ）は同地図情報作成装置が地図情報の更新時の動作パターンを示す図。
【図５（ｇ）−（ｈ）】（ｇ）（ｈ）は同地図情報作成装置が地図情報の更新時の動作パターンを示す図。
【図６】同地図情報作成装置における地図情報の更新時の動作フローを示す図。
【図７】（ａ）乃至（ｃ）は同地図情報作成装置が地図情報を削除するときの好ましい動作パターン例を示す図。
【図８】（ａ）乃至（ｅ）は同地図情報作成装置が周囲情報として取得された線情報に基づいて地図情報を登録するときの動作パターンを示す図。
【図９】（ａ）乃至（ｅ）は同地図情報作成装置が、周囲情報として取得された点情報に基づいて地図情報を登録するときの動作パターンを示す図。
【図１０】（ａ）乃至（ｅ）は同地図情報作成装置が周囲情報として取得された線情報に基づいて地図情報を登録及び削除するときの動作パターンを示す図。
【図１１】（ａ）乃至（ｆ）は同地図情報作成装置が周囲情報として取得された線情報及び点情報に基づいて地図情報を登録するときの動作パターンを示す図。
【符号の説明】
【００５０】
１    地図情報作成装置（自律移動装置）
２    環境認識部（環境認識手段）
３    地図情報作成部（地図情報作成手段）
４    駆動装置（移動手段）
５    制御部（制御手段）
６    記憶部（記憶手段）
７    位置認識部（位置認識手段）
Ｌ    線情報
Ｐ    点情報
【図１】
2008305255.tif 000003
【図２】
2008305255.tif 000004
【図３】
2008305255.tif 000005
【図４】
2008305255.tif 000006
【図５（ａ）−（ｃ）】
2008305255.tif 000007
【図５（ｄ）−（ｆ）】
2008305255.tif 000008
【図５（ｇ）−（ｈ）】
2008305255.tif 000009
【図６】
2008305255.tif 000010
【図７】
2008305255.tif 000011
【図８】
2008305255.tif 000012
【図９】
2008305255.tif 000013
【図１０】
2008305255.tif 000014
【図１１】
2008305255.tif 000015