JP6699034B2 - 自律移動ロボット - Google Patents

Description

本願発明は、位置を計測しながら移動するロボットに関するものであり、より具体的には、移動に伴って累積する誤差を解消するため計測値を正規の位置に補正しながら移動するロボットに関するものである。

今後、労働人口の減少が予想される中、労働力不足を補うロボットや人工知能が期待されている。実際、ロボットや人工知能の技術進歩は著しく、１０〜２０年以内には現在の仕事の半分近くがロボットや人工知能で代替可能になるという研究結果を発表した者もいる。

ＪＩＳ（日本工業規格）では産業用ロボットを、「自動制御によるマニピュレーション機能または移動機能をもち、各種の作業をプログラムにより実行でき、産業に使用される機械」と定義しており、工場のラインの一部としてその場で所定の作業を行うロボットや、掃除機のように移動しながら所定の作業を行うロボットが対象とされている。このうち移動するロボットは、人が遠隔操作を行うことで移動するものと、ロボット自身で移動する（以下、「自律移動」という。）ものに大別することができる。

自律移動するロボット（以下、「自律移動ロボット」という。）は、人のように２足歩行する方式や、車輪（タイヤ）やキャタピラ（登録商標）によって走行する方式など、目的に応じて様々な移動手法が採用され、また、移動に当たってはナビゲーションシステムが利用されることもある。このナビゲーションシステムは、自身の現在位置をリアルタイムで計測するとともに、施設や経路を含む地図情報と照らし合わせることで、例えば目的地との相対的な位置関係を把握し、あるいは目的地までの経路を探索するものである。いわゆるカーナビはその代表例であるが、昨今ではスマートフォンなど携帯型端末機の普及に伴い、歩行者を案内するナビゲーションシステムも急速に広まっている。

このようにナビゲーションシステムが普及した背景には、測位技術の進歩とその普及がある。１９００年代、それまで軍事用としてのみ利用されていたＧＰＳ（Ｇｌｏｂａｌ Ｐｏｓｉｔｉｏｎｉｎｇ Ｓｙｓｔｅｍ）が民生用として利用されるようになり、さらに２０００年には「意図的に精度を落とす仕組み（ＳＡ：Ｓｅｌｅｃｔｉｖｅ Ａｖａｉｌａｂｉｌｉｔｙ）」も撤廃され、容易かつ高精度に、しかもリアルタイムで現在位置を計測できるようになった。

ＧＰＳに代表される衛星測位システム（ＧＮＳＳ：Ｇｌｏｂａｌ Ｎａｖｉｇａｔｉｏｎ Ｓａｔｅｌｌｉｔｅ Ｓｙｓｔｅｍ）は、衛星からの電波を受信することで測位する手法であり、電波の届く範囲であれば地球上あらゆる場所で測位できるが、建物の中など衛星からの電波が届かない場所では当然ながら測位することができない。自律移動ロボットの場合、屋外に限らず屋内で移動することも多く、衛星測位システムのみの測位では十分ではない。自律移動ロボットや歩行者用のナビゲーションの需要の高まりから、近年、種々の屋内測位技術の開発が進められている。例えば、無線ＬＡＮのアクセスポイントを利用する測位方法、室内に電波発信機を配置して測位するＩＭＥＳ（Ｉｎｄｏｏｒ Ｍｅｓｓａｇｉｎｇ Ｓｙｓｔｅｍ）、ＬＥＤの高速点滅を信号として伝送する可視光通信を利用した測位方法、赤外線通信を利用した測位方法などが挙げられる。

上記例示した屋内測位技術や衛星測位システムなどのように信号の送受信を伴う測位手法のほか、他との通信を必要としない自律航法（Ｄｅａｄ Ｒｅｃｋｏｎｉｎｇ：ＤＲ）も注目されている。自律航法は、与えられた初期位置と、その後の移動距離及び移動方向に基づいて、移動後の位置を求める手法であり、例えばカーナビの場合、トンネルや地下道など衛星からの電波が届かない場所を補完する目的で利用されている。今後は、加速度センサを備えたスマートフォンの普及、さらには眼鏡型ウェアラブル端末の登場により、自律航法を用いた歩行者用のナビゲーション（ＰＤＲ：Ｐｅｄｅｓｔｒｉａｎ Ｄｅａｄ Ｒｅｃｋｏｎｉｎｇ）が多用されることも予想され、さらには自律移動ロボットのナビゲーションにも有効に利用されることが期待される。

自律航法は、他機器との通信を必要としないため、屋内・屋外を問わず採用できるのが一つの特徴である。しかしながら、現状の技術水準では解決し難い問題点も抱えている。すなわち自律航法システムは、過去の位置に基づく逐次計算によって現在位置を算出するものであり、センサ誤差および演算誤差の累積により位置精度が徐々に劣化していくことが知られている。また、自律航法において欠かせない移動距離や移動方向の取得は、ジャイロセンサや加速度センサを用いるのが主流となっているが、ジャイロセンサや加速度センサは動作環境によってその計測が不安定になることがあり（例えば磁気センサは、強い磁場で用いると正しい結果が得られない）、この点でも精度上の問題を指摘することができる。

そこで、自律航法による測位精度を向上させるため、経路途中の要所で位置補正を行う技術が種々提案されている。例えば特許文献１では、走行距離が一定距離以上になると座標既知点（マーカ）まで移動し、これまでの誤差を把握した上で補正を行うという技術を提案している。

特開２００４−１３９２６５号公報

特許文献１のように、ある限られた範囲（例えば、掃除を行う室内）を対象とする場合であれば、定期的（一定距離以上の走行のたび）に所定のポイントまでいわば寄り道することはそれほど問題とはならないが、例えば目的の店舗に向かうケースを考えると定期的に寄り道するようでは実用的な技術とは言えない。

自律航法による測位精度を向上させる手段として、特許文献１に開示される技術のほか、経路上の要所に情報発信機を設置し、そのポイントを通過するたびに位置情報を補正するという試みも行われている。しかしながら、「そのポイントを通過する」という判断を自動的（機械的）に行うことは、必ずしも容易ではない。図８は、自律航法によって自律移動ロボットの位置を計測する状況を示す平面図である。この図では、あらかじめ壁面に設置された情報発信機Ｗから信号が送られており、その信号を検知したとき、自律移動ロボットの現在位置が情報発信機Ｗの設置位置（ｘ，ｙ）に補正される仕組みとなっている。この仕組みによれば、自律移動ロボットＲ１のように実際の移動経路と測位結果が大きく相違しているようなケースでは極めて有効となる。情報発信機Ｗからの信号を受信したタイミングで現在位置が補正され、つまりそれまでに生じた累積誤差が解消され、その結果、以降は正しい位置計測が期待できるわけである。

ところが、図８に示す自律移動ロボットＲ２のようなケースでは、実際の移動経路と測位結果が概ね一致しているにもかかわらず、情報発信機Ｗからの信号を受信することで、かえって誤った位置に補正されてしまうことになる。このような不具合は、信号強度の閾値を設定することである程度は解消できるものの、閾値を極端に高く設定すると補正される範囲（情報発信機Ｗからの距離）が極めて限定的となり、実用性に欠けることとなる。また、適当な信号強度の閾値を設定したとしても、運用環境によっては想定した距離を超えて受信したとして判断されることもあり、自律移動ロボットＲ２のケースのように誤った補正が行われるおそれもある。

本願発明の課題は、上記問題を解決することであり、すなわち自律航法のように移動しながら現在位置を計測する手法において、定期的な寄り道を必要とせず、適宜正しい位置情報に補正することでより正確な測位の継続を図るとともに、あらかじめ補正される領域を限定し、誤った位置への補正を防止し得る自律移動ロボットを提供することである。

本願発明は、自律移動しながらの測位結果を補正するにあたって、誤った位置への補正を防止すべく、あらかじめ補正すべき領域を設定するという点に着目したものであり、従来にはなかった発想に基づいてなされた発明である。

本願発明の自律移動ロボットは、現在位置を把握しながら自律移動するロボットであり、移動手段と、測位手段、受信手段、補正手段を備えたものである。このうち測位手段は、移動途中における現在位置を計測するものであり、受信手段は、所定位置に設置された拠点局から発信される信号を受信するもので、補正手段は、測位手段で計測された現在位置を補正するものである。なお補正手段は、現在位置が拠点領域（拠点局の設置位置を基準に設定される領域）内にあって、且つこの拠点領域に対応する拠点局から受信手段が所定強度（閾値）以上の信号を受信したときに、現在位置を基準点（拠点領域内であらかじめ定められた地点）に補正する。

本願発明の自律移動ロボットは、代表信号強度に基づいて補正判断を行うものとすることもできる。ここで代表信号強度とは、現在位置を含む拠点領域に対応する拠点局から受信した受信履歴（過去の複数の受信信号）に基づいて設定されるもので、複数の受信信号の信号強度を代表する値である。この場合、制御手段は、代表信号強度が所定強度（閾値）以上であるときに現在位置を補正するとして補正手段に指令する。

本願発明の自律移動ロボットは、自律航法を用いた計測を行う測位手段を備えたものとすることもできる。ここで自律航法とは、現在位置を起点とし、移動者等の移動距離及び移動方向に基づいて次の現在位置を推定する計測手法である。

本願発明の自律移動ロボットは、ひとつの拠点局に対して、２以上の拠点領域が設定され、これら２以上の拠点領域ごとに基準点が設定された方法とすることもできる。

本願発明の自律移動ロボットは、補正手段が現在位置を基準点に補正した後、所定期間は補正後の位置を維持し、当該期間中は条件にかかわらず現在位置を補正しないものとすることもできる。

本願発明の自律移動ロボットは、現在位置が拠点領域内にあって、且つ現在位置と基準点との距離が最小基準値以上であって、しかも受信手段が所定強度以上の信号を受信したときに、現在位置を基準点に補正する補正手段を備えたものとすることもできる。

本願発明の自律移動ロボットには、次のような効果がある。
（１）自律航法は、移動しながらの測位であり累積誤差を生じやすいが、要所で正しい位置に補正するため、比較的正確な測位を継続することができる。
（２）あらかじめ補正すべき領域を設定するため、誤った位置への補正を防止することができる。
（３）衛星測位システムや特別な屋内測位システムに依存しないため、屋内・屋外を問わず広く実施することができる。

本願発明の主な処理の流れを示すフロー図。 本願発明の自律移動ロボットを説明するブロック図。 本願発明の自律移動ロボットが現在位置を把握しながら目的地まで到達する状況を示す平面図。 ひとつの拠点局に対して、２つの拠点領域が設定された例を示す平面図。 現在位置を補正した後、一定の時間が経過しないと補正しないことを補正条件とするフロー図。 基準点からの距離を考慮した条件で補正の判断を行うフロー図。 測位手段が取得した「暫定的な現在位置」の位置精度が著しく低下している場合、その旨警告する処理を示すフロー図。 自律航法によって自律移動ロボットの位置を計測する状況を示す平面図。

本願発明の自律移動ロボットの実施形態の一例を、図に基づいて説明する。

１．全体概要
図１は、本願発明の主な処理の流れを示すフロー図であり、中央の列に実施する処理を示し、左列にはその処理に必要な入力情報を、右列にはその処理から生まれる出力情報を示している。まずはこのフロー図を参考に、本願発明の全体概要について説明する。

自律移動ロボットが自律移動を開始すると、随時、自律移動ロボットの現在位置を計測する（Ｓｔｅｐ１０）。この測位方法は、前記例示した屋内測位技術や衛星測位システムなど、種々の手法を採用することができるが、本願発明が累積誤差を解消するものであることを考えれば、自律航法を採用するとより効果的となる。自律航法で測位した場合、定期的、断続的、あるいは連続的に自律移動ロボットの現在位置が取得され、そして測位するたびに「暫定的な現在位置」として出力される。ここで「暫定的」としたのは、後述するように位置を補正する可能性を残しているためである。

予想される移動範囲内には、あらかじめ数箇所の拠点局が設置され、さらにこの拠点局の設置位置を基準として拠点領域が設定されている。暫定的な現在位置が得られると、その位置座標が拠点領域内にあるか否か判断される（Ｓｔｅｐ２０）。ここで、拠点領域内にはないと判断されれば、補正されることなくそのまま現在位置として確定され（Ｓｔｅｐ５０）、暫定的な現在位置が拠点領域内にあると判断されれば、受信信号の強度に基づいて補正の是非を判断する（Ｓｔｅｐ３０）。

受信信号とは、拠点局から発信された信号を、自律移動ロボットが備える受信手段が受信したものである。自律移動ロボットが受信した信号強度が、あらかじめ設定した閾値より大きい（強い）場合は、補正することとし（Ｓｔｅｐ４０）、閾値より小さい（弱い）場合は補正せずそのまま確定させる（Ｓｔｅｐ５０）。暫定的な現在位置が拠点領域にあることで自律移動ロボットが拠点局に近づいたことは予測できるが、自律航法の累積誤差を考えればこの段階で確定することはやや危険である。受信した信号強度の強弱によって、すなわち拠点局からの距離を推測することによって、自律移動ロボットが拠点局に近づいたことの確証を得るわけである。

暫定的な現在位置が拠点領域内にあると判断され、しかも受信した信号強度が設定した閾値より大きい場合は、暫定位置は補正される（Ｓｔｅｐ４０）。具体的には、暫定的な現在位置の座標が、あらかじめ設定された基準点の座標に変更される。この基準点は、現地の状況や用途等に応じて適宜設定することができ、例えば、拠点局の設置位置、拠点領域内の中心点、あるいは拠点領域内の任意点などを示すことができる。補正された現在位置は、そのまま確定した現在位置として記憶される（Ｓｔｅｐ５０）。

確定した現在位置は、自律移動ロボットとは別に用意される表示手段に表示させることができる。この場合、予想される自律移動ロボットの移動範囲を地図として表示し、その上に確定した現在位置を表示すると、自律移動ロボットを監視する者（以下、「ロボット管理者」という。）が地図上で現在位置を把握できるとともに、目的地までの経路や位置関係なども予測できる。以上、Ｓｔｅｐ１０〜Ｓｔｅｐ６０の処理が、目的地に到達するまで繰り返される。

次に、本願発明の自律移動ロボットの主な構成について説明する。図２は、本願発明の自律移動ロボット１００を説明するブロック図である。この図に示すように自律移動ロボット１００は、移動手段１０１と、測位手段１０２、受信手段１０４、補正手段１０８を備えており、さらに現在位置記憶手段１０３や、信号データ記憶手段１０５、制御手段１０６、条件記憶手段１０７、基準点記憶手段１０９を備えることもできる。なお、現在位置記憶手段１０３や、信号データ記憶手段１０５、制御手段１０６、条件記憶手段１０７、基準点記憶手段１０９は外部に設置し、通信手段によって自律移動ロボット１００と情報を伝達する仕組みとしてもよい。

この図に示すうち移動手段１０１は、自律移動ロボット１００が移動するための手段であり、人のように２足歩行する方式や、車輪（タイヤ）やキャタピラ（登録商標）によって走行する方式など、目的に応じて様々な移動方式を採用することができる。また測位手段１０２は、自律航法等によって移動中の自律移動ロボット１００の現在地を随時計測するもので、ここで取得された現在位置はひとまず「暫定的な現在位置」として現在位置記憶手段１０３に記憶される。要所に設置された拠点局２００から発信される信号を受けるのが受信手段１０４であり、定期的、断続的、あるいは連続的に拠点局２００から信号を受信し、受信した記録は信号データ記憶手段１０５に記憶される。

制御手段１０６は、種々の判断や指令を行うものである。まず制御手段１０６は、暫定的な現在位置が現在位置記憶手段１０３に記憶されると、拠点局２００を基礎とする拠点領域内に暫定的な現在位置があるか否かを判断する。ここで暫定的な現在位置が拠点領域内にあると判断されれば、制御手段１０６は、いくつかの拠点局２００の中からその拠点領域に紐づく拠点局２００を特定するとともに、補正すべきか否かの判断を行う。具体的には、特定した拠点局２００から受信した信号強度が、条件記憶手段１０７から読み出した信号強度の閾値以上であれば「補正する」と、そうでない場合は「補正しない」と判断する。一方、暫定的な現在位置が拠点領域内にないとされた場合も「補正しない」と判断する。そして、補正しないと判断されたとき制御手段１０６は、暫定的な現在位置を「確定した現在位置」として現在位置記憶手段１０３に記憶させる。

制御手段１０６の指令によって補正を行うのが補正手段１０８である。補正手段１０８は、制御手段１０６によって特定された拠点局２００に紐づく基準点を、基準点記憶手段１０９から読み出す。そして、暫定的な現在位置を基準点に変更し、「確定した現在位置」として現在位置記憶手段１０３に記憶させる。確定した現在位置が記憶されると、地図および地図上における確定した現在位置は、自律移動ロボット１００とは別に設けられる表示手段３００に表示される。

以下、本願発明の自律移動ロボット１００を構成する主な要素ごとに詳述する。

２．測位手段
既述のとおり本願発明は、屋内測位技術や衛星測位システムなど様々な手法の測位手段１０２を用いることができるが、自律航法による測位手段１０２とするとより効果が顕著となる。自律航法は、移動する自律移動ロボット１００が通過する地点の位置座標を逐次計測して記録するもので、過去の通過点（起点）座標に基づいて移動後の座標を求める手法である。したがって測位手段１０２には、自律移動ロボット１００が移動した距離と方向（方位）を取得するための軌跡計測手段と、座標を求めるための座標演算手段が必要である。

軌跡計測手段は、移動しながら距離を計測するもの（以下、「距離計測器」という。）と、移動しながら方向（方位）を計測するもの（以下、「方位計測器」という。）を具備する。例えば、距離計測器としては、加速度を計る加速度センサや、車輪（タイヤ）の回転から距離を計測するＤＭＩ（Ｄｉｓｔａｎｃｅ Ｍｅａｓｕｒｉｎｇ Ｉｎｄｉｃａｔｏｒ）といったものが例示できる。一方、方位計測器としては、角速度を計るジャイロセンサや、地磁気を検知する地磁気センサ（例えば、電子コンパス）などを例示することができる。なお、距離計測器と方位計測器は、それぞれ別体として用意することもできるし、両者を搭載した一体型のものを利用することもできる。座標演算手段は、コンピュータによって実行されるプログラムを用いるとよい。

３．拠点局
拠点局２００は、自律移動ロボット１００が移動すると想定される経路の要所に設置されるものであり、例えば図３では壁面に４箇所（１０３Ａ〜１０３Ｄ）設置されている。なお図３は、本願発明の自律移動ロボット１００が自律移動した例であり、現在位置を把握しながら目的地まで到達する状況を示す平面図で、自律移動ロボット１００の軌跡を破線で示している。

拠点局２００は信号を発信するもので、例えば、ＧＰＳや、ＩＭＥＳ、ＷｉＦｉ（登録商標）、Ｂｌｕｅｔｏｏｔｈ（登録商標）、ＢＬＥ（Ｂｌｕｅｔｏｏｔｈ Ｌｏｗ Ｅｎｅｒｇｙ）等で利用される電波信号、可視光や赤外線といった光信号、そのほか超音波などの音波信号を発信するものが、拠点局２００として例示できる。なお、この信号には、その信号を発信した拠点局２００の情報が埋め込まれている。その手法としては、例えば、無線ＬＡＮで多用されているＳＳＩＤ（Ｓｅｒｖｉｃｅ Ｓｅｔ Ｉｄｅｎｔｉｆｉｅｒ）といった技術が利用できる。図３の例のように複数の拠点局２００が設置されている場合、異なる拠点局２００から同時に信号を受信することも考えられるが、後述するように、どの拠点局２００からの信号かを識別する必要があり、そのため信号に拠点局情報を埋め込むわけである。

図３に示すように、拠点局２００の周囲には拠点領域２０１が設定される。拠点領域２０１は、自律移動ロボット１００が拠点局２００に近づいたことを推定するための範囲であり、拠点局２００の設置位置を基準に設定される。例えば、拠点局２００の設置位置を中心とする円形や、長円、矩形、他の多角形など、現地状況に合わせて任意の形状で設定することができる。また、拠点領域２０１は、平面形状（２次元領域）に限らず、直方体や球形といった立体形状（３次元領域）とすることもできる。さらに、受信手段１０４の機種や受信時刻に応じて、拠点領域２０１の大きさ（面積や容積）や形状を動的に変更することもできる。

当然ながら拠点領域２０１は拠点局２００ごとに設定され、図３では拠点局２００Ａに対して拠点領域２０１Ａが、拠点局２００Ｂに対して拠点領域２０１Ｂが、拠点局２００Ｃに対して拠点領域２０１Ｃが、拠点局２００Ｄに対して拠点領域２０１Ｄが、それぞれ設定されている。なお、図３のようにひとつの拠点局２００に対してひとつの拠点領域２０１を設定することもできるし、ひとつの拠点局２００に対して複数の拠点領域２０１を設定することもできる。要は、拠点領域２０１からひとつの拠点局２００を特定できればよい。図４では、拠点局２００Ｅに対して、拠点領域２０１Ｅ−１と拠点領域２０１Ｅ−２の２つの拠点領域２０１が設定されている。

また、拠点領域２０１には、その領域内を代表する基準点２０２が設定される。この基準点２０２は、拠点領域２０１のうちの任意点とすることも、拠点局２００の設置位置とすることもできる。基準点２０２は、拠点領域２０１ごとに設定され、図３では拠点領域２０１Ａに対して基準点２０２Ａが、拠点領域２０１Ｂに対して基準点２０２Ｂが、拠点領域２０１Ｃに対して基準点２０２Ｃが、拠点領域２０１Ｄに対して基準点２０２Ｄが、それぞれ設定されている。ひとつの拠点局２００に対して複数の拠点領域２０１が設定されている場合は、それぞれの拠点領域２０１で基準点２０２が設定される。図４では、拠点領域２０１Ｅ−１に対して基準点２０２Ｅ−１が、拠点領域２０１Ｅ−２に対して基準点２０２Ｅ−２が、それぞれ設定されている。

４．制御手段
既述のとおり制御手段１０６は、測位手段１０２が取得した「暫定的な現在位置」が、拠点領域２０１内にあるか否かを判断する。暫定的な現在位置が拠点領域２０１内にある場合、当該拠点領域２０１に対応する拠点局２００を特定するとともに、当該拠点局２００からの信号強度があらかじめ設定した閾値以上か否かを判断する。そして、その信号強度が閾値以上であれば「補正する」として補正手段１０８に指令する。例えば図３の場合、自律移動ロボット１００が拠点領域２０１Ａ内にいると判断され、しかも拠点局２００Ａから受信した信号強度が閾値以上であれば、制御手段１０６は「補正する」と判断し、暫定的な現在位置であるＡ地点が基準点２０２Ａに補正される。あるいは、自律移動ロボット１００が拠点領域２０１Ｃ内にいると判断されるものの、拠点局２００Ｃから受信した信号強度が閾値を下回れば、補正せずそのまま現在位置として確定する。なお、受信手段１０４の機種や受信時刻に応じて、信号強度の閾値を動的に変更することもできる。

現在位置を補正する決め手となるのは受信手段１０４で受信された信号強度であるが、信号強度のばらつきを考えると１回の受信信号で補正判断するのはやや危ういともいえる。そこで制御手段１０６が、過去複数回の受信履歴に基づいて代表的な信号強度（以下、「代表信号強度」という。）を設定し、この代表信号強度と信号強度の閾値を照らし合わせて補正判断するとよい。具体的には、暫定的な現在位置を含む拠点領域２０１に対応する拠点局２００を特定し、この拠点局２００から受信した所定回数（例えば１０回）の受信信号を信号データ記憶手段１０５から読み出す。このとき最新のものから順に遡って読み出すとよい。そして、所定数（例えば１０個）の信号データに基づいて、代表信号強度を設定する。例えば、所定数の信号データ（信号強度）の平均値や中央値、最大値や最小値、あるいは上位ｎ番目の値、など種々の方法で代表信号強度を設定する。この代表信号強度が閾値以上であれば「補正する」こととし、そうでなければ補正せずにそのまま現在位置として確定するわけである。

制御手段１０６は、拠点領域２０１内の有無と受信した信号強度の組み合わせからなる補正条件のほか、種々の補正条件によって補正の是非を判断することができる。例えば、図５に示すように、現在位置を補正した後、一定の時間が経過していなければ、たとえ補正条件が整っていたとしても補正せずそのまま現在位置として確定することもできる。繰り返し同じ基準点２０２に補正すると、かえって誤った現在位置を確定することになるからである。したがって、補正しない「一定の時間」は、おおよそ自律移動ロボット１００が拠点領域２０１から出て行くまでにかかる時間とするのがよい。

図６は、基準点２０２からの距離を考慮した条件を用いて、補正の判断を行うフロー図である。この図では、測位手段１０２が取得した「暫定的な現在位置」が、著しく基準点２０２に近づいている場合は、補正せずそのまま現在位置として確定することとしている。つまり、基準点２０２に近いということは測位手段１０２の測位精度が相当程度であると考えられるからである。具体的には、暫定的な現在位置と基準点２０２との離れ（距離）を計算し、その距離が閾値以上のときは補正するが、閾値を下回るときは補正せずそのまま現在位置として確定する。

図７は、測位手段１０２が取得した「暫定的な現在位置」の位置精度が著しく低下している場合、その旨警告する処理を示すフロー図である。この図に示すように、測位手段１０２が取得した「暫定的な現在位置」が拠点領域２０１の範囲外であるにもかかわらず、当該拠点領域２０１に対応する拠点局２００からの受信信号が閾値を超える場合、異常を伝える処理を行う。受信信号の情報が正しいとすれば、測位した位置が拠点領域２０１を外れているのは異常な状態であると考え、その旨をロボット管理者に通知して対処を促すわけである。もちろん、測位手段１０２が取得した「暫定的な現在位置」が拠点領域２０１の範囲外であり、当該拠点領域２０１に対応する拠点局２００からの受信信号が閾値を下回る場合は、そのまま確定した現在位置として記憶する。

本願発明の自律移動ロボット１００は、屋内に限らず屋外の広い範囲でも利用可能であり、工場や、学校、病院など、様々な施設内で効果的に利用することができる。

１００ 測位システム
１０１ 移動手段
１０２ 測位手段
１０３ 現在位置記憶手段
１０４ 受信手段
１０５ 信号データ記憶手段
１０６ 制御手段
１０７ 条件記憶手段
１０８ 補正手段
１０９ 基準点記憶手段
２００ 拠点局
２０１ 拠点領域
２０２ 基準点
３００ 表示手段

Claims (6)

1. 現在位置を把握しながら自律移動するロボットにおいて、
   移動手段と、
   現在位置を計測する測位手段と、
   所定位置に設置された拠点局から発信される信号を受信する受信手段と、
   前記拠点局の設置位置を基準に設定される拠点領域に基づいて、前記測位手段で計測された前記現在位置を補正する補正手段と、を備え、
   前記補正手段は、前記現在位置が前記拠点領域内にあって、且つ該拠点領域に対応する前記拠点局から所定強度以上の信号を受信したとき、前記現在位置を、前記拠点領域内であらかじめ定められた基準点に補正する、ことを特徴とする自律移動ロボット。
2. 前記補正手段は、現在位置を含む前記拠点領域に対応する前記拠点局から受信した複数の受信信号に基づいて、代表信号強度を設定し、該代表信号強度が所定強度以上であるときに前記現在位置を補正する、ことを特徴とする請求項１記載の自律移動ロボット。
3. 前記測位手段が、前記現在位置を起点とし、移動者又は移動体の移動距離及び移動方向に基づいて、次の現在位置を推定する自律航法を用いた計測を行う、ことを特徴とする請求項１又は請求項２記載の自律移動ロボット。
4. ひとつの前記拠点局に対して、２以上の前記拠点領域が設定され、該２以上の拠点領域ごとに前記基準点が設定される、ことを特徴とする請求項１乃至請求項３のいずれかに記載の自律移動ロボット。
5. 前記補正手段は、前記現在位置を前記基準点に補正した後、所定期間は補正後の位置を維持し、当該期間中は条件にかかわらず前記現在位置を補正しない、ことを特徴とする請求項１乃至請求項４のいずれかに記載の自律移動ロボット。
6. 前記補正手段は、前記現在位置が前記拠点領域内にあって、且つ前記現在位置と前記基準点との距離が最小基準値以上であって、且つ前記受信手段が所定強度以上の信号を受信したとき、前記現在位置を前記基準点に補正する、ことを特徴とする請求項１乃至請求項５のいずれかに記載の自律移動ロボット。

Images