(57)【要約】【課題】移動ロボットの向いている方向を高精度に検出可能とする。【解決手段】複数の区画に分割された床下空間内にて床下地面上を移動する移動ロボットであって、移動ロボットの床下地面上での回動角を算出する積算型センサ（角速度センサ１４１、回動角算出部１０４）と、複数の区画のうち互いに隣接する区画間に設けられた通気口に関する情報を検出する通気口検出部（側部距離センサ１４２、通過検出部１０６、進入角度算出部１０７）と、上記回動角と上記通気口に関する情報とに基づき、床下空間内で移動ロボットの向いている方向を検出する方向検出部（方向検出部１０５）とを備え、方向検出部は、通気口に関する情報を用いて、積算型センサの累積誤差を補正する。【選択図】図４
2008070236.tif 000002
【特許請求の範囲】
【請求項１】
複数の区画に分割された床下空間内にて床下地面上を移動する移動ロボットであって、
前記移動ロボットの前記床下地面上での回動角を算出する積算型センサと、
前記複数の区画のうち互いに隣接する区画間に設けられた通気口に関する情報を検出する通気口検出部と、
前記回動角と前記通気口に関する情報とに基づき、前記床下空間内で前記移動ロボットの向いている方向を検出する方向検出部と
を備え、前記方向検出部は、前記通気口に関する情報を用いて、前記積算型センサの累積誤差を補正することを特徴とする移動ロボット。
【請求項２】
前記通気口検出部は、
前記移動ロボットの側方又は上方に向けて距離計測を行う距離センサと、
前記距離計測の結果に基づき、前記移動ロボットが前記通気口を通過したことを検出する通過検出部と、
前記距離計測の結果に基づき、前記通気口に対する前記移動ロボットの進入角度を算出する進入角度算出部とを備え、
前記方向検出部は、前記前記移動ロボットが前記通気口を通過したタイミングにて、前記進入角度を用いて前記累積誤差を補正することを特徴とする請求項１に記載の移動ロボット。
【請求項３】
複数の区画に分割された床下空間内の床下地面上を移動する移動ロボットと、前記移動ロボットを遠隔操作する操作端末とを具備する遠隔操作システムであって、
前記移動ロボットの前記床下地面上での回動角を算出する積算型センサと、
前記複数の区画のうち互いに隣接する区画間に設けられた通気口に関する情報を検出する通気口検出部と、
前記移動ロボット又は前記操作端末は、前記回動角と前記通気口に関する情報とに基づき、前記床下空間内で前記移動ロボットの向いている方向を検出する方向検出部と
を備え、前記方向検出部は、前記通気口に関する情報を用いて、前記積算型センサの累積誤差を補正することを特徴とする遠隔操作システム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、複数の区画に分割された床下空間内を移動する移動ロボット、この移動ロボットを用いた遠隔操作システムに関する。
【背景技術】
【０００２】
近年、建造物などのリフォームや防災に関する関心が高まってきており、建造物の点検を行う機会が増加している。特に、建造物の床下（以下、単に「床下」という）については、人目に触れにくい一方で、建造物の基幹部分であるため、点検のニーズが高いと考えられる。
【０００３】
しかし、床下は、一般的に、非常に狭い空間であり、衛生状態も悪いため、作業員による目視点検が困難である。このため、カメラを搭載し、撮像データを操作端末へ送信しつつ、床下を点検（撮像）するロボットの開発が進んでいる。
【０００４】
また、通常、床下内の地図（基礎伏図と呼ばれる設計図）は、移動ロボット及び遠隔操作システムには組み込まれていないので、ユーザは移動ロボットからの撮像データを地図と照らし合わせながら移動ロボットを遠隔操作することになる。
【０００５】
しかし、床下内の風景が単調であることから、移動ロボットの向いている方向を極めて見失い易い。移動ロボットを床下内で効率よく移動させるためには、移動ロボットの位置や向いている方向を検出する機能が重要である。
【０００６】
ただし、床下では、ＧＰＳ（Global Positioning System）衛星からの電波を受信困難であるために、ＧＰＳは不適である。更に、鉄筋による地磁気の乱れから、方位磁石も利用できないという、床下特有の問題がある。
【０００７】
このような事情から、検査対象空間内にペイント又はテープなどを設け、ライントレーサーによってこれらをセンシングすることで、ロボットを自律移動させる手法が提案されている（特許文献１参照）。
【０００８】
また、画像処理を行って自律移動のためのデータとしたり、レーザー光を２つのＣＣＤカメラで捉えて三角測量によって対象物の位置計測をしたりするロボットが提案されている（特許文献２参照）。
【０００９】
更に、方向検出用にエンコーダを設ける構成や、壁との距離を計測して壁面に沿って移動したり、家屋に塗布した発光塗料を補助的に検出したりするロボットが提案されている（特許文献３参照）。
【特許文献１】特開２００４−１２５７７３号公報
【特許文献２】特開平１１−１３７１４８号公報
【特許文献３】特許第２５９４８８０号公報
【発明の開示】
【発明が解決しようとする課題】
【００１０】
上述した特許文献１においては、ロボットがトレースするためのペイント又はテープなどをあらかじめ設置する必要がある。また、ペイント又はテープなどを設置したとしても、床下では地表が露出していることが多く、ペイント又はテープなどを恒久的に維持することは困難である。
【００１１】
特許文献２においては、ロボットが自己の位置や進行方向を検出するための具体的な技術は開示していないので、移動ロボットの位置や向いている方向を高精度に検出できない可能性がある。
【００１２】
特許文献３においては、エンコーダを使用するために、段差、砂利、コンクリ、炭などにより、クローラがスリップすることがあり、エンコーダ値に大幅な誤差が生じる。このため、高精度な位置検出及び方向検出が困難である。また、床下内には束と呼ばれる支柱が数多く立ち、ロボットの移動経路が限定されるので、壁との距離を計測して壁面に沿って移動することも困難である。更に、家屋に発光塗料を塗布することは、上述した特許文献１と同様の問題が生じる。
【００１３】
このように、従来のロボットでは、移動ロボットの位置や向いている方向を検出する機能に問題があり、ロボットの向いている位置や方向を容易且つ高精度に検出することが困難であった。
【００１４】
一方で、ロボットの位置を検出するよりも、ロボットの向いている方向を検出できたる方が、下記の（１）〜（３）の理由から有効である。
【００１５】
（１）床下は区画単位で分割されており、どの区画にロボットが存在するか程度であればユーザが判断できる。
【００１６】
（２）区画単位では、ロボットの視界を完全に遮る物はほとんどなく、移動目標の方向が分かれば有視界で到達できる。
【００１７】
（３）主な移動目標は通気口であるが、どの通気口も形状が類似するために区別し難い。しかし、通気口は各区画に２〜３箇所程度であり、ロボットの向いている方向が分かれば判別可能である。
【００１８】
上記問題点に鑑み、本発明は、移動ロボットの向いている方向を高精度に検出可能な移動ロボット及び遠隔操作システムを提供することを目的とする。
【課題を解決するための手段】
【００１９】
上記目的を達成するために、本発明の特徴は、複数の区画に分割された床下空間内にて床下地面上を移動する移動ロボットであって、移動ロボットの床下地面上での回動角を算出する積算型センサ（角速度センサ１４１、回動角算出部１０４）と、複数の区画のうち互いに隣接する区画間に設けられた通気口に関する情報を検出する通気口検出部（側部距離センサ１４２、通過検出部１０６、進入角度算出部１０７）と、上記回動角と上記通気口に関する情報とに基づき、床下空間内で移動ロボットの向いている方向を検出する方向検出部（方向検出部１０５）とを備え、方向検出部は、上記通気口に関する情報を用いて、積算型センサの累積誤差を補正する移動ロボットであることを要旨とする。
【００２０】
ここで、「回動角」とは、例えば、移動ロボットの前後軸と、床下空間に定義された基準軸とのなす角度を意味し、床下地面に対する移動ロボットの相対的な方向を意味する。「積算型センサ」には、例えばジャイロセンサやエンコーダ（ロータリエンコーダ）などが使用できる。また、「通気口」とは、例えば、隣接する区画間の基礎に設けられた開口部であり、空気又は作業員などの通り道を意味する。「通気口に関する情報」とは、通気口の位置、大きさ、範囲、形状などの情報を含む。これらの情報は、カメラや距離センサなどで得ることができる。位置の情報は、例えば、距離センサで得ることができるほか、移動ロボットが通気口をまたいだ（通過した）ことで検知したり、カメラ映像やフォーカス距離値から検知できる。通気口の大きさ、範囲、形状の情報は、例えば、移動ロボットが通気口を通過する際に、距離センサで測定するほか、カメラ映像からも得ることができる。
【００２１】
このような特徴によれば、移動ロボットの床下地面上での回動角と、複数の区画のうち互いに隣接する区画間に設けられた通気口に関する情報とを併用して、床下空間内で移動ロボットの向いている方向を検出する構成としている。回動角から移動ロボットの向いている方向を大まかに常時検出しつつ、通気口に関する情報から移動ロボットの向いている方向を高精度に検出するので、移動ロボットの向いている方向を高精度に検出可能となる。また、通気口に関する情報を用いて積算型センサの累積誤差を補正するので、床下という特殊な環境下であっても積算型センサの誤差を補正可能となる。
【００２２】
上記の特徴に係る移動ロボットにおいて、通気口検出部は、移動ロボットの側方又は上方に向けて距離計測を行う距離センサ（側部距離センサ１４２又は上部距離センサ１４５）と、距離計測の結果に基づき、移動ロボットが通気口を通過したことを検出する通過検出部（通過検出部１０６）と、距離計測の結果に基づき、通気口に対する移動ロボットの進入角度を算出する進入角度算出部（進入角度算出部１０７）とを備え、方向検出部は、移動ロボットが通気口を通過したタイミングにて、上記進入角度を用いて累積誤差を補正することが好ましい。
【００２３】
本発明の他の特徴は、複数の区画に分割された床下空間内の床下地面上を移動する移動ロボットと、移動ロボットを遠隔操作する操作端末とを具備する遠隔操作システムであって、移動ロボットの床下地面上での回動角を算出する積算型センサ（角速度センサ１４１、回動角算出部１０４）と、複数の区画のうち互いに隣接する区画間に設けられた通気口に関する情報を検出する通気口検出部（側部距離センサ１４２、通過検出部１０６、進入角度算出部１０７）と、移動ロボット又は操作端末は、上記回動角と上記通気口に関する情報とに基づき、床下空間内で移動ロボットの向いている方向を検出する方向検出部（方向検出部１０５）とを備え、方向検出部は、上記通気口に関する情報を用いて、積算型センサの累積誤差を補正することを要旨とする。
【発明の効果】
【００２４】
本発明によれば、移動ロボットの向いている方向を高精度に検出可能な移動ロボット及び遠隔操作システムを提供できる。
【発明を実施するための最良の形態】
【００２５】
次に、図面を参照して、本発明の実施形態を説明する。以下の実施形態における図面の記載において、同一又は類似の部分には同一又は類似の符号を付している。
【００２６】
（遠隔操作システムの全体構成例）
先ず、本実施形態に係る遠隔操作システムの全体構成例について説明する。図１は、本実施形態に係る遠隔操作システムの全体構成図である。
【００２７】
本実施形態に係る遠隔操作システムは、移動ロボット１と、無線通信によって移動ロボット１を遠隔操作する操作端末２とを有する。操作端末２としては、例えばノートＰＣが使用できる。
【００２８】
移動ロボット１は、操作端末２の制御下で、床下の床下地面上を移動して床下を撮像する。具体的には、移動ロボット１は、床下内を撮像し、撮像して得られた撮像データを操作端末２へ送信する。また、操作端末２は、移動ロボット１から受信した撮像データや、移動ロボット１の向いている方向（以下、単に「移動ロボット１の方向」という）をリアルタイムに表示する。
【００２９】
操作端末２は、ユーザ入力に応じて、移動ロボット１を操作する遠隔操作コマンドを移動ロボット１へ送信し、移動ロボット１を遠隔操作する。この遠隔操作コマンドには、移動に関するコマンドや、撮像に関するコマンドなどが存在する。
【００３０】
なお、図１においては、移動ロボット１及び操作端末２が建造物内に存在する場合を例示しているが、操作端末２は、建造物の外部から移動ロボット１を遠隔操作することも可能である。
【００３１】
（床下環境の一例）
次に、床下環境の一例について説明する。図２は、床下環境の一例を示す図である。
【００３２】
床下は、高さ３２ｃｍ〜３７ｃｍ程度の空間であり、基礎により長方形の区画に区切られている。なお、移動ロボット１が床下点検時に確認すべき内容としては、小動物の死骸や、基礎のクラックなどがある。区画間には通気口と呼ばれる高さ３０ｃｍ、幅６０ｃｍ程度の開口部が存在（１区画当たり２箇所程度）する。
【００３３】
移動ロボット１は、床下点検時にはこの通気口を通過して隣の区画へと移動する。また、ケーブルやパイプなどが、床下天井からぶら下がっていたり、床下地面を這い回っていたりする。
【００３４】
更に、基礎近くには配管が存在し、束と呼ばれる細い柱があらゆる場所に存在する。束を固定するための束基礎と呼ばれる５ｃｍ程度の高さのコンクリ台が存在する。なお、床下地面がコンクリである場合には、床下地面に束が直接固定されており、束基礎が存在しない場合もある。
【００３５】
移動ロボット１が床下地面上を移動する際には、地面の凹凸による走行振動や、鉄筋による地磁気の乱れの影響を受けるが、移動ロボット１は、これらの影響に関わらず、自己の向いている方向を検出可能なように構成されている。
【００３６】
（移動ロボットの構成例）
次に、移動ロボット１の構成例について説明する。
【００３７】
（１）移動ロボットの外観例
図３（ａ）は移動ロボット１の側面視を示す図であり、図３（ｂ）は移動ロボット１の上面視を示す図であり、図３（ｃ）は移動ロボット１の正面視を示す図である。
【００３８】
移動ロボット１は、床下内において、床下地面Ｓｒ上を移動する。具体的には、移動ロボット１は、前輪１１ａと、後輪１１ｂと、クローラ１２と、撮像ユニット１３と、前側部距離センサ１４２ａと、後側部距離センサ１４２ｂとを備える。
【００３９】
前輪１１ａ又は後輪１１ｂは、クローラ１２を回転させる駆動輪である。また、左クローラ１２ｌと右クローラ１２ｒとは独立して駆動可能であり、左右輪独立駆動型の移動機構を構成している。したがって、移動ロボット１は、超信地旋回（その場旋回）により方向転換可能である。
【００４０】
クローラ１２は、前輪１１ａ及び後輪１１ｂに掛け渡されており、床下地面Ｓｒの凹凸などを吸収する。
【００４１】
撮像ユニット１３は、床下地面Ｓｒと平行及び垂直な面内で、回動可能に構成されており、床下内を撮像するカメラ１３１を有している。具体的には、撮像ユニット１３は、カメラ１３１を左右方向（パン方向）に回動させるとともに、カメラ１３１を上下方向（チルト方向）に回動させる。
【００４２】
前側部距離センサ１４２ａ及び後側部距離センサ１４２ｂは、例えば光学距離センサ又は超音波距離センサなどであり、移動ロボット１の両側面に設けられ、移動ロボット１と移動ロボット１の側方に存在する物との間の距離を計測する。本実施形態では、床下内の通気口を検出するために、後側部距離センサ１４２ｂを使用する。
【００４３】
（２）移動ロボットの機能構成例
図４は、移動ロボット１の構成例を示す機能ブロック図である。
【００４４】
移動ロボット１は、撮像ユニット１３と、移動機構１２０と、センサ１４と、制御部１００と、方向情報記憶部１５１と、無線通信部１６１とを備える。
【００４５】
撮像ユニット１３は、床下内の被写体を撮像する。具体的には、撮像ユニット１３は、カメラ１３１と、チルト機構１３２と、パン機構１３３と、ズーム機構１３４と、フォーカス機構１３５と、照明装置１３６とを備える。
【００４６】
カメラ１３１は例えばＣＣＤカメラであり、カメラ１３１から得られた撮像データは、制御部１００及び無線通信部１６１を介して操作端末２に送信される。チルト機構１３２は、カメラ１３１をチルト方向に回動させる。パン機構１３３は、カメラ１３１をパン方向に回動させる。ズーム機構１３４は、例えばカメラ１３１の光学ズーム率を変更する。フォーカス機構１３５は、カメラ１３１をオートフォーカス制御する。照明装置１３６は床下内を照明する。
【００４７】
移動機構１２０は、床下地面上を移動するためのものであり、クローラ１２やモータ１２１などを備える。
【００４８】
無線通信部１６１は、例えば無線ＬＡＮ又はブルートゥースなどの近距離無線通信方式に準拠した構成を有し、操作端末２と無線通信を行う。
【００４９】
センサ１４は、角速度センサ１４１と、側部距離センサ１４２と、移動距離センサ１４３とを備える。
【００５０】
角速度センサ１４１は例えばジャイロセンサであり、移動ロボット１が床下地面上を回動する際の角速度を検出する。側部距離センサ１４２には、上述した前側部距離センサ１４２ａ及び後側部距離センサ１４２ｂが含まれる。移動距離センサ１４３としては、クローラ１２ｌ，１２ｒを回転させる各車輪の回動角を検出するロータリエンコーダが使用できる。
【００５１】
制御部１００は、撮像制御部１０１と、移動制御部１０２と、通信制御部１０３と、回動角算出部１０４と、方向検出部１０５と、通過検出部１０６と、進入角度算出部１０７とを備える。
【００５２】
撮像制御部１０１は、操作端末２から受信した撮像コマンドに応じて撮像ユニット１３を制御する。移動制御部１０２は、操作端末２から受信した移動コマンドに応じて移動機構１２０を制御する。通信制御部１０３は、無線通信部１６１を用いて操作端末２と無線通信を実行する。
【００５３】
回動角算出部１０４は、角速度センサ１４１が検出した角速度を積分（単位時間毎に積算）することによって、移動ロボット１の回動角を算出する。このように、角速度センサ１４１及び回動角算出部１０４は、角速度の積算値によって、移動ロボット１の方向を検出するための積算型センサとして機能する。
【００５４】
また、回動角算出部１０４が算出した回動角は、移動ロボット１の方向を示す方向情報γ’として方向情報記憶部１５１に記憶される。なお、一般的に、ジャイロセンサなどの角速度センサ１４１が検出する角速度には、ノイズや信号電圧の温度ドリフトなどに伴う誤差が含まれている。したがって、角速度の積算によって誤差が累積的に蓄積される。累積的に蓄積される誤差を「累積誤差」と称する。
【００５５】
通過検出部１０６は、側部距離センサ１４２による距離計測結果に応じて、移動ロボット１が通気口を通過したことを検出する。進入角度算出部１０７は、側部距離センサ１４２による側方距離計測結果と、移動距離センサ１４３による移動距離計測結果とに基づき、通気口に対する移動ロボット１の進入角度を算出する。通過検出部１０６による通過検出処理、及び進入角度算出部１０７による進入角度算出処理の詳細については後述する。このように、側部距離センサ１４２、通過検出部１０６、及び進入角度算出部１０７は、通気口に関する情報を検出するための通気口検出部として機能する。
【００５６】
方向検出部１０５は、回動角算出部１０４が算出した回動角と、上記通気口検出部が検出した通気口に関する情報とに基づき、移動ロボット１の方向を検出する。具体的には、方向検出部１０５は、移動ロボット１が通気口を通過したタイミングにて、進入角度算出部１０７が算出した進入角度を用いて、方向情報記憶部１５１に記憶されている方向情報γ’を更新する。この結果、累積誤差が補正され、移動ロボット１の正確な方向情報γ’が得られる。
【００５７】
なお、移動ロボット１には、図示を省略するバッテリが搭載されている。このバッテリは、移動ロボット１の動作に用いる電力を蓄積可能なバッテリであって、移動ロボット１に電力を供給する。例えば、バッテリは、リチウム電池などの一次電池、リチウムイオン電池やニッケル水素電池などの二次電池である。
【００５８】
（方向検出動作）
次に、移動ロボット１による方向検出動作について説明する。移動ロボット１による方向検出動作の説明の前に、図５を参照して、移動ロボット１の方向について説明する。移動ロボット１の方向は、上述したように、移動ロボット１の回動角（ヨー角）を基に検出される。回動角は、移動ロボット１の前後軸と、床下空間に定義された基準軸とのなす角度であり、床下地面に対する移動ロボットの相対的な方向である。一方、移動ロボット１の方向は、床下内において、移動ロボット１の前方がどの方向を向いているかを表している。
【００５９】
移動ロボット１の前方がどの方向を向いているかを検出するために、図６に示すように、床下空間に座標軸Ｘ，Ｙを定義する。また、図６（ａ）に示すように、移動ロボット１の前後軸が区画の一辺（座標軸Ｘ）と平行になるように設置して、移動ロボット１の移動を開始させる。
【００６０】
図６（ｂ）に示すように、移動開始直後では、移動ロボット１の実際の方向γと移動ロボット１の方向情報γ’とは略一致している。その後、図６（ｃ）に示すように、時間経過とともに移動ロボット１の方向情報γ’にて累積誤差が増大し、移動ロボット１の実際の方向γと移動ロボット１の方向情報γ’との誤差が大きくなる。
【００６１】
図６（ｄ）は、移動ロボット１が通気口１を通過した際の状態を示している。ここで、通気口１は、座標軸Ｙ方向に通過可能に設けられており、移動ロボット１の方向は座標軸Ｙ方向であるとみなすことができる。したがって、通気口１を通過時に、簡易的に、移動ロボット１が座標軸Ｙ方向を向いていると判断できる。
【００６２】
更に、移動ロボット１が、通気口１に対する進入角度αを算出することによって、更に高精度に移動ロボット１の方向を検出可能となる。図６（ｄ）においては、“９０°−α”の値が移動ロボット１の正確な方向である。
【００６３】
このように、本実施形態では、床下地面と平行な平面視において各区画が矩形であることに着目して、移動ロボット１の方向を容易且つ高精度に推定可能としている。
【００６４】
（通過検出動作及び進入角度算出動作）
次に、移動ロボット１による通過検出動作及び進入角算出動作について説明する。図７は、床下地面と平行な平面視において、移動ロボット１が通気口を通過する様子を示す図である。図８は、移動ロボット１が通気口を通過する際の、側部距離センサ１４２（左右の後側部距離センサ１４２ｂ）の検出距離を示している。以下においては、移動ロボット１の左側に設けられる後側部距離センサを「左側部距離センサ」と呼び、移動ロボット１の右側に設けられる後側部距離センサを「右側部距離センサ」と呼ぶ。
【００６５】
ここでは、移動ロボット１が、通過検出動作時及び進入角度算出動作時に、通気口の左右側面の各点ａ，ｂ，ｃ，ｄのうち、移動ロボット１の進行方向上で奥側の点ｂ，ｄを利用する一例を説明する。これは、床下地面と通気口の下面との間に段差がある場合に、通過動作の後半で検出した方が、地面凹凸の影響が少ない、すなわち、点ａ，ｃよりも点ｂ，ｄを利用した方が検出精度が良いためである。
【００６６】
したがって、通過検出動作時においては、右側部距離センサ及び左側部距離センサの検出距離Ｌ１及びＬ２が急激に長くなったかに応じて、移動ロボット１が通気口を通過したことが検出される。
【００６７】
次に、進入角度αは、通気口の開口方向に対する移動ロボット１の進行方向のなす角であり、進入角度αの検出には、間接検出、直接検出の２つの方法が使用できる。
【００６８】
間接検出では、図７に示すように、次の式（１）により進入角度αが算出される。
【００６９】
α＝ＡＴＡＮ（Ｌ３／Ｌ４）      ・・・（１）
ここで、“Ｌ３”は、図７において、移動ロボット１の前後軸上での点ｂと点ｄとの間の距離（長さ）を示し、“Ｌ４”は、移動ロボット１の左右軸上での点ｂと点ｄとの間の距離（長さ）を示している。
【００７０】
また、“Ｌ４”は、左側部距離センサ及び左側部距離センサのそれぞれの検出距離と、移動ロボット１の幅とを足すことで得ることができる。ここでは、移動ロボット１の左右方向の中心位置と点ｂとの間の距離を“Ｌ１”とし、移動ロボット１の左右方向の中心位置と点ｄとの間の距離を“Ｌ２”とする。この結果、式（１）は、
α＝ＡＴＡＮ（Ｌ３／Ｌ１＋Ｌ２）  ・・・（２）
と変換できる。“Ｌ３”は、クローラ１２の回転量、又は移動ロボット１の移動速度と時間によって算出することができる。移動ロボット１の移動速度と時間により“Ｌ３”を算出する場合には、前側部距離センサと後側部距離センサとのタイミング差で測定しても良い。
【００７１】
一方、直接検出では、図８（ｂ）に示すように、進入角度αが角度βと等しいことを利用して進入角度αが算出される。
【００７２】
（方向検出処理の概略処理フロー例）
次に、移動ロボットにおける方向検出処理フローについて説明する。図９は、移動ロボットにおける方向検出処理フロー例を示すフローチャートである。
【００７３】
ステップＳ１０１において、移動ロボット１が、座標軸Ｘ（Ｘ軸）と平行になるようにして、床下に投入される。詳細には、移動ロボット１は、移動ロボット１の方向が、ある区画の壁面に対して平行であると目視で確認された方向に向けて設置される。
【００７４】
ステップＳ１０２において、方向検出部１０５は、移動ロボット１の方向γ’を“０”に初期化する。
【００７５】
ステップＳ１０３において、通過検出部１０６は、移動ロボット１が通気口を通過したかを判定する。移動ロボット１が通気口を通過した場合には、ステップＳ１０４の処理に進む。一方、移動ロボット１が通気口を通過していない場合には、ステップＳ１０５の処理に進む。
【００７６】
ステップＳ１０４において、進入角度算出部１０７は、通気口に対する移動ロボット１の進入角度αを算出する。
【００７７】
ステップＳ１０５においては、方向検出部１０５は、角速度センサ１４１からの角速度情報を積分して、移動ロボット１の方向情報γ’を得る。
【００７８】
（方向検出処理の詳細処理フロー例）
次に、移動ロボット１における方向検出処理フローについて説明する。図９は、移動ロボット１における方向検出処理フロー例を示すフローチャートである。
【００７９】
ステップＳ２０１において、通過検出部１０６は、右側部距離センサ又は左側部距離センサの検出距離Ｌ１又はＬ２が急激に長くなったかを判定する。具体的には、検出距離Ｌ１又はＬ２の単位時間当たりの増加量が、あらかじめ設定された閾値を超えると、検出距離Ｌ１又はＬ２が急激に長くなったと判定される。検出距離Ｌ１又はＬ２が急激に長くなったと判定された場合には、ステップＳ２０２の処理に進む。
【００８０】
ステップＳ２０２において、通過検出部１０６は、検出距離Ｌ１又はＬ２が急激に長くなったことで、移動ロボット１が通気口を通過する可能性ありと判断する。なお、ステップＳ２０２は、ステップＳ２０１にて検出距離Ｌ１又はＬ２が急激に長くなったと判定されるのとほぼ同時に実行される。
【００８１】
ステップＳ２０３において、通過検出部１０６は、移動ロボット１が通気口を通過する可能性ありと判断されてから、移動ロボット１の移動距離が一定の距離以上になったかを判定する。移動ロボット１の移動距離が一定の距離以上になったと判定された場合には、ステップＳ２０１の処理に戻る。一方、移動ロボット１の移動距離が一定の距離未満であると判定された場合には、ステップＳ２０４の処理に進む。
【００８２】
ステップＳ２０４において、通過検出部１０６は、右側部距離センサ又は左側部距離センサの検出距離Ｌ１又はＬ２が急激に長くなったかを判定する。この処理では、ステップＳ２０１にて、右側部距離センサの検出距離が急激に長くなったと判定されている場合には、左側部距離センサの検出距離が急激に長くなったか否かが判定される。また、ステップＳ２０１にて、左側部距離センサの検出距離が急激に長くなったと判定されている場合には、右側部距離センサの検出距離が急激に長くなったか否かが判定される。なお、検出距離Ｌ１又はＬ２が急激に長くなったかの判定は、ステップＳ２０１と同様にして行われる。右側部距離センサ又は左側部距離センサの検出距離Ｌ１又はＬ２が急激に長くなったと判定された場合には、ステップＳ２０５の処理に進む。一方、右側部距離センサ又は左側部距離センサの検出距離Ｌ１又はＬ２が急激に長くなっていないと判定された場合には、ステップＳ２０３の処理に戻る。
【００８３】
ステップＳ２０５において、通過検出部１０６は、移動ロボット１が通気口を通過したと判断する。移動ロボット１が通気口を通過したと判断されると、ステップＳ２０６の処理に進む。
【００８４】
ステップＳ２０６において、進入角度算出部１０７は、通気口に対する移動ロボット１の進入角度αを算出する。
【００８５】
ステップＳ２０７において、進入角度算出部１０７は、移動ロボット１が、軸Ｘに平行な通気口に進入したかを判定する。具体的には、方向情報記憶部に記憶されている方向情報γ’が、９０°又は−９０°付近である場合には、移動ロボット１が軸Ｘに平行な通気口に進入したと判定されて、ステップＳ２０８の処理に進む。一方、方向情報記憶部に記憶されている方向情報γ’が、９０°又は−９０°付近でない場合には、移動ロボット１が軸Ｙに平行な通気口に進入したと判定されて、ステップＳ２０９の処理に進む。
【００８６】
ステップＳ２０８においては、方向検出部１０５は、ステップＳ２０６で算出された進入角度αと、軸Ｘに平行な通気口の角度（つまり９０°又は−９０°）を用いて方向情報γ’を補正する。図６の例では、“９０°−α”の値が、補正後の方向情報γ’として方向情報記憶部１５１に記憶される。
【００８７】
ステップＳ２０９においては、方向検出部１０５は、ステップＳ２０６で算出された進入角度αと、軸Ｙに平行な通気口の角度（つまり０°又は−１８０°）を用いて方向情報γ’を補正する。補正後の方向情報γ’は、方向情報記憶部１５１に記憶される。
【００８８】
（作用・効果）
以上詳細に説明したように、本実施形態によれば、移動ロボット１の回動角と通気口に関する情報とを用いて、床下空間内で移動ロボット１の方向を検出することで容易且つ高精度に移動ロボット１の方向を検出することができる。また、通気口に関する情報を用いて積算型センサの累積誤差を補正するので、床下という特殊な環境下であってもジャイロセンサなどの誤差を補正可能となる。
【００８９】
（第１変形例）
上述した実施形態においては、側部距離センサにより通気口を検出する構成について説明した。本発明の実施形態の第１変形例では、図１２に示すように、移動ロボット１の上部に設けられた上部距離センサ１４５ｌ，１４５ｒにより、通気口を検出する。上部距離センサ１４５ｌ，１４５ｒは、移動ロボット１の左右両端部の前側に実装されている。あるいは、側部距離センサと上部距離センサとを併用する構成としてもよい。
【００９０】
（第２変形例）
上述した実施形態においては、移動ロボット１自身が、自己の方向を検出する構成について説明した。本発明の実施形態の第２変形例として、移動ロボット１ではなく、操作端末２側で、移動ロボット１の方向を検出する構成について説明する。
【００９１】
本変形例に係る操作端末２は、図１２に示すように、入力部２１と、表示部２２と、方向情報記憶部２３と、制御部２００と、無線通信部２４とを備える。
【００９２】
入力部２１は、例えばキーボード又はマウス等により構成され、ユーザ入力を受け付ける。無線通信部２４は、例えば無線ＬＡＮ又はブルートゥース等の近距離無線通信方式に準拠した構成を有し、移動ロボット１側の無線通信部１６１と無線通信を実行する。表示部２２は、撮像データやセンサ情報などを表示する。
【００９３】
制御部２００は、通信制御部２０１と、コマンド制御部２０２と、表示制御部２０３と、方向検出部２０４と、通過検出部２０５と、進入角度算出部２０６とを備える。
【００９４】
通信制御部２０１は、無線通信部２４を用いて移動ロボット１と通信を行う。コマンド制御部２０２は、入力部２１が受け付けたユーザ入力に応じて、移動ロボット１に送信するコマンドを制御する。表示制御部２０３は、無線通信部２４が移動ロボット１から受信したデータ、例えば撮像データ及びセンサ情報を表示部２２上に表示させる。
【００９５】
通過検出部２０５は、移動ロボット１から受信した、左側部距離センサ及び右側部距離センサの検出距離に基づいて、移動ロボット１が通気口を通過したことを検出する。進入角度算出部２０６は、移動ロボット１から受信した、左側部距離センサ及び右側部距離センサの検出距離や、移動距離センサ１４３の検出距離などに基づいて、移動ロボット１が通気口を通過したことを検出する。方向検出部１０５は、移動ロボット１から受信した回動角の情報や、進入角度算出部２０６が算出した進入角度の情報に基づき、移動ロボット１の方向を検出して、方向情報を方向情報記憶部２３に格納する。
【００９６】
（その他の実施形態）
上記のように、本発明は実施形態によって記載したが、この開示の一部をなす論述及び図面はこの発明を限定するものであると理解すべきではない。この開示から当業者には様々な代替実施形態、実施例及び運用技術が明らかとなる。
【００９７】
上述した実施形態では、通気口に対する移動ロボット１の進入角度により方向情報を更新する一例を説明した。しかし、精度は劣るが、移動ロボット１が通気口を通過した場合に壁面と直角であるとみなして、方向情報を更新する構成であっても良い。
【００９８】
また、上述した実施形態では、積算型センサの一例としてジャイロセンサを挙げたが、これに限定されるものではない。例えば、積算型センサは、移動ロボット１に設けられた左右のクローラの回転数（又は、左右のクローラを駆動するモータの回転数）をデジタル値で検出するロータリエンコーダであってもよい。
【００９９】
さらに、上述した実施形態では、床下地面Ｓｒと平行な平面視において閉空間が長方形であるが、これに限定されるものではない。例えば、床下地面Ｓｒと平行な平面視において、各区画は正三角形などの形状であってもよい。
【０１００】
上述した実施形態では、移動ロボット１の方向検出に、後側部距離センサを使用する一例について説明したが、前側部距離センサを使用しても良い。
【０１０１】
前側部距離センサを使用した場合には、障害物センサとして併用することができ、障害物を早く発見できる。具体的には、移動ロボット１からの映像越しに遠隔操作が行われるが、車体側面は死角となっていることが多く、旋回時に障害物に衝突することがある。対策として障害物センサを設けることが公知であるが、通気口センサを障害物センサに兼用する場合、進行方向前部にあるほうが、障害物をより早く発見できる。
【０１０２】
ただし、前側部距離センサを使用した場合には、後側部距離センサの場合と比較して、通気口進入角度を検出する精度が悪化する。具体的には、通気口に段差があった場合、地面凹凸の影響で、通気口通過中に移動ロボット１の向きが変わる可能性がある。通気口への進入角度検出には、通過序盤で検出するより、通過終盤で検出したほうが、地面凹凸の影響を受けにくく、検出精度が向上する。
【０１０３】
また、通気口に関する情報の一部が、基礎伏図などから既知の場合には、移動ロボット及び遠隔操作システムに設定しておくことで、検出精度を高めたり、計算やセンサを簡略化することができる。検出精度を高める方法としては、例えば、通気口の幅が既知の場合は、移動距離を使用せずに進入角度αを算出することができる。
【０１０４】
具体的には、通気口の幅（図７の例では点ｂと点ｄの間の距離）が既知である場合、通気口の幅をＬ５とすると、進入角度αは、
α＝ａｃｏｓ（Ｌ４／Ｌ５）      ・・・（３）
によって算出可能である。つまり、Ｌ３が不要となり、Ｌ３を求めるための移動距離センサ１４３などを無くすことが可能となる。
【０１０５】
このように本発明は、ここでは記載していない様々な実施形態などを包含するということを理解すべきである。したがって、本発明はこの開示から妥当な特許請求の範囲の発明特定事項によってのみ限定されるものである。
【図面の簡単な説明】
【０１０６】
【図１】本発明の実施形態に係る遠隔操作システムの全体構成図である。
【図２】本発明の実施形態に係る移動ロボットが点検する床下の環境の一例を示す図である。
【図３】図３（ａ）は移動ロボットの側面視を示す図であり、図３（ｂ）は移動ロボットの上面視を示す図であり、図３（ｃ）は移動ロボットの正面視を示す図である。
【図４】本発明の実施形態に係る移動ロボットの機能構成例を示す機能ブロック図である。
【図５】本発明の実施形態に係る移動ロボットの向いている方向を説明するための図である。
【図６】本発明の実施形態に係る移動ロボットによる方向検出動作を説明するための図である。
【図７】本発明の実施形態に係る移動ロボットによる通気口への進入角度検出動作を説明するための図である（その１）。
【図８】本発明の実施形態に係る移動ロボットによる通気口への進入角度検出動作を説明するための図である（その２）。
【図９】本発明の実施形態に係る移動ロボットにおける方向検出処理の概略処理フロー例を示すフローチャートである。
【図１０】本発明の実施形態に係る移動ロボットにおける方向検出処理の詳細処理フロー例を示すフローチャートである。
【図１１】本発明の実施形態の第１変形例に係る移動ロボットを説明するための図である。
【図１２】本発明の実施形態の第２変形例に係る操作端末の機能構成例を示す機能ブロック図である。
【符号の説明】
【０１０７】
１…移動ロボット、２…操作端末、１１ａ…前輪、１１ｂ…後輪、１２…クローラ、１２ｌ…左クローラ、１２ｒ…右クローラ、１３…撮像ユニット、１４…センサ、２１…入力部、２２…表示部、２３…方向情報記憶部、２４…無線通信部、１００…制御部、１０１…撮像制御部、１０２…移動制御部、１０３…通信制御部、１０４…回動角算出部、１０５…方向検出部、１０６…通過検出部、１０７…進入角度算出部、１２０…移動機構、１２１…モータ、１３１…カメラ、１３２…チルト機構、１３３…パン機構、１３４…ズーム機構、１３５…フォーカス機構、１３６…照明装置、１４１…角速度センサ、１４２…側部距離センサ、１４２ａ…前側部距離センサ、１４２ｂ…後側部距離センサ、１４３…移動距離センサ、１４５…上部距離センサ、１５１…方向情報記憶部、１６１…無線通信部、２００…制御部、２０１…通信制御部、２０２…コマンド制御部、２０３…表示制御部、２０４…方向検出部、２０５…通過検出部、２０６…進入角度算出部
【図１】
2008070236.tif 000003
【図２】
2008070236.tif 000004
【図３】
2008070236.tif 000005
【図４】
2008070236.tif 000006
【図５】
2008070236.tif 000007
【図６】
2008070236.tif 000008
【図７】
2008070236.tif 000009
【図８】
2008070236.tif 000010
【図９】
2008070236.tif 000011
【図１０】
2008070236.tif 000012
【図１１】
2008070236.tif 000013
【図１２】
2008070236.tif 000014