JP4337421B2 - 移動する物体の位置計測方法及び位置計測システム - Google Patents
移動する物体の位置計測方法及び位置計測システム Download PDFInfo
- Publication number
- JP4337421B2 JP4337421B2 JP2003174356A JP2003174356A JP4337421B2 JP 4337421 B2 JP4337421 B2 JP 4337421B2 JP 2003174356 A JP2003174356 A JP 2003174356A JP 2003174356 A JP2003174356 A JP 2003174356A JP 4337421 B2 JP4337421 B2 JP 4337421B2
- Authority
- JP
- Japan
- Prior art keywords
- signal
- unit
- position measurement
- robot
- reception
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Lifetime
Links
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は、監視領域内を移動する物体の位置を計測する位置計測方法及び位置計測システムに関する
ものである。
【０００２】
【従来の技術】
近年、移動機能を有する作業ロボットの機能が高まり、移動ロボットを利用した多くのシステムが開発されている。ロボットの移動を制御及び管理するためには、作業領域内を移動するロボットの位置把握が不可欠である。ロボットの位置把握技術には、自身の移動台車の車輪回転量でロボット自身が移動量を把握し、自身の初期位置と移動量とを用いて逐次の自己位置を把握する方法、ロボットと周囲環境の固定な目印との位置関係を、超音波及び光を媒体としたロボットと周囲環境との間でのセンシング技術で把握し、ロボット位置を特定する手法がある。本発明は後者の手法に関わる。
【０００３】
従来の技術を、図５を用いて解説する。移動ロボット４０１は、監視領域を移動するものであり、タイミングパルス送信部４０２は、位置検出の基準時間となるタイミングパルスを発信するものであり、タイミングパルス受信部４０６−１〜２は、タイミングパルスを受信し、超音波の送信を促すものであり、超音波送信部４０３−１〜２は、監視領域に固定設置された複数の周波数の異なる超音波を、タイミングパルスの受信後に出力するものである。
【０００４】
また、超音波受信部４０４は、複数の周波数の超音波を受信し、周波数分離するものであり、位置検出部４０５は、超音波の周波数から超音波送信部を認識し、タイミングパルスの送信時間と超音波の受信時間とから監視領域内の位置を検
出するものである。
【０００５】
なお、移動ロボット４０１は、タイミングパルス送信部４０２、超音波受信部４０４及び位置検出部４０５を含む構成である。
（例えば、特許文献１参照）。
【０００６】
【特許文献１】
特開平６−３５５３５号公報（第３頁、第１図）
【０００７】
【発明が解決しようとする課題】
しかしながら、従来の構成では、超音波の特性上、領域内に配置される構造物からの反射波が避けられないため、この反射波を検出してしまうことで、位置検出に誤差を生じるという課題を有していた。
【０００８】
また、ソフトウェア的に反射波からの情報を特定しようとすると、直接波、反射波による検出値の混在する複数の受信器から得られた距離情報の内から、複数の距離情報の組み合わせを準備し、各距離情報の組み合わせと受信器間の位置情報や移動領域の形状情報と合わせて検出した組み合わせの数だけの位置情報の間で、一致度合いを判断基準として一致度の低い組み合わせの中から反射波受信による情報を特定するというような方法が考えられるが、処理量が多く実現が困難なだけでなく、検出された反射波の数が直接波の数よりも多い場合は、反射波の除去が確実に行われないままロボット位置の誤検出を招いてしまうという課題を有していた。
【０００９】
本発明は、従来の課題を解決するものであり、反射超音波による位置検出のための外乱情報を、軽微な装置構成と計算処理を伴わない方法で排除することで、位置検出誤りを軽減し、検出精度を向上させた位置計測装置を提供することを目的とする。
【００１０】
上記課題を解決するために、本発明は、監視領域内の既知の位置に予め配置された複数の受信部と、位置計測装置用無線送受信部と、位置検出部とを備えた位置計測装置が、
移動ロボット用無線送受信部を備え、前記監視領域内を移動するロボットの位置を計測する方法であって、前記ロボットが、超音波信号と光信号と位置計測要求信号を同時に送信する第１工程と、前記複数の受信部が前記光信号と前記超音波信号を受信し、前記位置計測装置用無線送受信部が位置計測要求信号とを受信する第２の工程と、前記位置検出部が、前記複数の受信部が受信した光信号が予め定めた光強度の閾値以上である場合、前記超音波信号が直接波であると判断する第３の工程とを有し、前記第３の工程で、前記超音波信号が直接波でないと判断した場合、前記位置計測装置用無線送受信部が前記移動ロボット用無線送受信部に位置変更を要請する信号を送信する位置計測方法を用いて位置計測を行う。
【００１１】
本発明の方法によって、超音波の反射波による影響を抑制した位置計測を行うことができる。
【００１２】
【発明の実施の形態】
以下、本発明に記載の発明について、図面を参照しながら説明する。
【００１３】
（実施の形態１）
図１は、本発明第１の実施の形態による位置計測装置の構成を示す図である。
【００１４】
移動ロボット１０１は、監視領域内を移動するものであり、位置計測装置１０２は、移動ロボット１０１の監視領域内の位置を計測するものであり、光源部１０４は、移動ロボット１０１と位置計測装置１０２との間に遮蔽物の有無を判断するための光信号を出力するものであり、超音波発振部１０５は、超音波を出力するものである。
【００１５】
また、移動ロボット制御部１０３は、自己の位置計測を要求する信号である位置計測要求信号を出力し、光源部１０４と超音波発振部１０５とに光信号と超音波の出力を要求するものであり、移動ロボット用無線送受信部１０６は、位置計測要求信号を送信し、位置計測装置１０２が計測した移動ロボット１０１の位置情報を受信するものである。
【００１６】
また、受信部１０７−１〜ｎ（ｎは自然数）は、監視領域内の既知の場所に予め配置され、光信号及び超音波を受信するものであり、発振部１１１は、移動ロボット１０１の位置計測の基準となる連続パルス信号出力するものであり、位置検出部１０９は、受信部１０７−１〜ｎをリセットし、光信号と超音波信号の受信時間の差から移動ロボット１０１との距離を算出するものである。
【００１７】
また、地図記憶部１１０は、監視領域の形状と受信部１０７−１〜ｎの配置位置とを含む地図情報が予め記憶されているものであり、無線送受信部１０８は、移動ロボット１０１から位置計測要求信号を受信し、光信号の受信を示す光信号確認信号と、算出した移動ロボット１０１の位置情報とを送信するものである。
【００１８】
移動ロボット１０１は、移動ロボット制御部１０３、光源部１０４、超音波発振部１０５及び移動ロボット用無線送受信部１０６を含む構成であり、位置計測装置１０２は、受信部１０７−１〜ｎ、発振部１１１、位置検出部１０９、地図記憶部１１０及び無線送受信部１０８を含む構成である。
【００１９】
まず、移動ロボット１０１の動作について、図２を用いて説明する。
【００２０】
まず、Ｓ２０１にて、監視領域内を移動する移動ロボット１０１は、自己の進行方法を決定するために、移動ロボット制御部１０３が、自己の位置の計測を要求する位置計測要求信号を出力し、光信号及び超音波信号を出力する送信要求信号を、移動ロボット用無線送受信部１０６、光源部１０４及び超音波発振部１０５に出力する。
【００２１】
次に、Ｓ２０２にて、移動ロボット用無線送受信部１０６が、位置計測要求信号を位置計測装置１０２に送信し、光源部１０４が、光信号を出力し、超音波発振部１０５が、超音波信号を出力する。
【００２２】
次に、Ｓ２０３にて、移動ロボット用送受信部が、位置計測装置１０２から送信される光信号の受信確認を示した光信号確認信号を受信した場合は、Ｓ２０４に移行し、位置計測装置１０２から送信される移動ロボット１０１の位置の変更を要請する位置変更要請信号を受信した場合は、Ｓ２０６に移行する。
【００２３】
次に、Ｓ２０４にて、移動ロボット用無線送受信部１０６が、位置計測装置１０２が算出した移動ロボット１０１の位置情報である位置情報信号を受信し、移動ロボット制御部１０３に出力する。
【００２４】
次に、Ｓ２０５にて、移動ロボット制御部１０３が、位置情報信号から自己の現在位置を認識する。
【００２５】
次に、Ｓ２０６にて、移動ロボット制御部１０３が、移動ロボット１０１の位置を変更し、再度、Ｓ２０２に移行する。
【００２６】
次に、位置計測装置１０２の動作について説明する。
【００２７】
まず、無線送受信部１０８が、移動ロボット１０１からの位置計測要求信号を受信する。
【００２８】
次に、受信部１０７−１〜ｎが、光信号を受信した場合は、受信部１０７−１〜ｎに含まれる時間計測カウンタを始動する。なお、光信号を受信するまでは、時間計測カウンタの値は０である。
【００２９】
また、位置検出部１０９は、無線送受信部１０８が位置計測要求信号を受信し、受信部１０７−１〜ｎが光信号を受信した場合は、遮蔽物が存在しないことを示した光信号確認信号を無線送受信部１０８から移動ロボット１０１に送信し、無線送受信部１０８が位置計測要求信号を受信したが、受信部１０７−１〜ｎが光信号を受信しない場合は、遮蔽物が存在することを示した位置変更要請信号を無線送受信部１０８から移動ロボット１０１に送信する。
【００３０】
位置測定装置が、光信号確認信号を移動ロボット１０１に返信することにより、移動ロボット１０１は、移動ロボット１０１と位置計測装置１０２との間の遮蔽物の有無を認識することが可能となり、自己位置の変更を行い、遮蔽物を回避することができる。
【００３１】
ここで、一般に光信号は超音波に比較して、外壁等の監視領域内の構造物に対する反射率が圧倒的に低く、構造物からの拡散による信号強度の減衰も激しいという特性を持つことから、移動ロボット１０１の光源部１０４と位置計測装置１０２の受信部１０７−１〜ｎの間に障害物が存在した場合、光信号の直接波を受信する可能性は、超音波の直接波を受信する可能性に比べて格段に小さくなり、また、到達したとしても光信号強度は直接光受信強度よりも極端に小さくなる。
【００３２】
このため、受信部１０７−１〜ｎが光信号を受信した場合は、超音波の直接波を受信する可能性が高いと考えられる。
【００３３】
次に、受信部１０７−１〜ｎが、超音波を受信した場合は、時間計測カウンタを停止する。
【００３４】
次に、位置検出部１０９が、時間計測カウンタの値に、連続パルス信号のパルス間隔と音速とを乗ずることで移動ロボット１０１から受信部１０７−１〜ｎまでの距離情報を算出する。
【００３５】
なお、受信部１０７−１〜ｎは、受信可能な光強度の閾値を有限の移動距離範囲での直接受信強度程度に設定しておくことで、反射光の信号入力を排除できる。
【００３６】
さらに、光源部１０４を点光源とすることで、点光源の光強度分布の指向性は超音波発振器のそれよりも小さいということから、反射光を除外するために、均一の閾値処理を全方位に対して実施しても、方位依存性は少なく、同等な効果を得ることができる。
【００３７】
即ち、特定強度以上の光信号が直接受光できた移動ロボット１０１と受信部の間では、超音波の直接波の通路が確保されており、超音波の反射波を排除することが容易にできる。
【００３８】
次に、位置検出部１０９が、複数の受信部から得られた距離情報と、地図記憶手段より読み出した予め記憶された各受信部１０７−１〜ｎの位置情報と、移動領域の形状情報とを合わせて、三角測量法を用いることにより、移動ロボット１０１の位置を検出することができる。
【００３９】
次に、無線送受信部１０８が、検出した移動ロボット１０１の位置情報を一般的な無線プロトコルによって、移動ロボット１０１に伝達する。
【００４０】
また、無線通信を用いることで、位置計測装置１０２からの位置検出要求を移動ロボット１０１に通知することで、位置計測装置１０２を起点とする位置検出も容易に実現できる。
【００４１】
次に、図３に受信部１０７の構成を示す。
【００４２】
受信部１０７は、近接した位置に光センサ２０１と超音波受信部２０２を持つことを特徴とする。
【００４３】
光センサ２０１は、移動ロボット１０１が送信した光信号を受信するものであり、超音波受信部２０２は、移動ロボット１０１が送信した超音波信号を受信するものであり、閾値処理部２０３は、光センサ２０１が受信した光信号の信号強度を閾値処理することで、２値信号を出力するものである。
【００４４】
また、ゲート回路部２０５は、全ての受信部１０７−１〜ｎに共通の発振器から出力される連続パルス信号が入力され、２値信号の立ち上がりエッジによりゲートをオープンすることで、連続パルス信号を出力し、超音波信号の立ち上がりエッジによりゲートをクローズするものであり、カウンタ部２０６は、ゲート回路部２０５が入力された連続パルス信号により、カウントを行い、位置検出部１０９から入力されるリセット信号によりカウンタ値をクリアするものである。
【００４５】
また、遅延部２０４は、カウントのストップが確立するために、超音波信号の立ち上がりエッジを十分に遅延させるものであり、カウントメモリ部は、遅延した超音波信号の立ち上がりエッジによりカウンタ部２０６から入力されたカウント値を記憶し、位置検出部１０９から入力されるリセット信号によりカウンタ値をクリアするものである。
【００４６】
次に、本発明の位置検出処理の進行手順を図４に示す。
【００４７】
まず、Ｓ３０１にて、無線送受信部１０８が、移動ロボット１０１から送信された位置計測要求信号を受信する。
【００４８】
次に、Ｓ３０２にて、光センサ２０１が、移動ロボット１０１から送信された光信号を受信した場合は、Ｓ３０３に移行し、光信号を受信しない場合は、Ｓ３１１に移行する。
【００４９】
次に、Ｓ３０３にて、位置検出部１０９が、光信号及び位置計測要求信号の受信を確認した後に、光信号確認信号を無線送受信部１０８から出力する。
【００５０】
次に、Ｓ３０４にて、カウンタ部２０６が、時間計測のためのカウンタのカウントが開始される。
【００５１】
次に、Ｓ３０５にて、超音波受信部２０２が、移動ロボット１０１から送信された超音波信号を受信する。
【００５２】
次に、Ｓ３０６にて、カウンタ部２０６が、時間計測カウンタを停止し、カウンタメモリ部２０７が、カウンタ値を記憶し、位置検出部１０９に出力する。
【００５３】
次に、Ｓ３０７にて、位置検出部１０９が、カウンタ値に、パルス間隔と音速とを乗ずることで移動ロボット１０１から受信部１０７−１〜ｎまでの距離情報を算出する。
【００５４】
次に、Ｓ３０８にて、位置検出部１０９が、移動ロボット１０１の位置検出のための距離情報が充分であるかを判断する。
【００５５】
次に、Ｓ３０９にて、位置検出部１０９が、移動ロボット１０１と受信部１０７−１〜ｎの距離と地図情報記憶部に予め記憶した受信部１０７−１〜ｎの位置情報と移動領域の形状情報とから、移動ロボット１０１の位置を検出する。
【００５６】
次に、Ｓ３１０にて、無線送受信部１０８が、算出した移動ロボット１０１の位置情報を移動ロボット１０１に送信する。
【００５７】
次に、Ｓ３１１にて、位置検出部１０９が、位置計測要求信号の受信を確認し、光信号が受信されない場合に、位置変更要請信号を無線送受信部１０８から出力する。
【００５８】
かかる構成によれば、光信号と超音波信号とを併用することで、超音波信号の直接波のみを用いて位置計測を行うことで、監視領域の複雑化に伴って増大する反射超音波信号によるロボット位置の誤検出を防止することができる。
【００５９】
なお、光源部１０４を熱源部とし、光センサ２０１を熱センサとしても、同様の効果を得ることができる。
【００６０】
なお、本実施の形態では、単体の移動ロボットを用いた位置計測システムについて説明したが、複数の移動ロボットを用いた位置計測システムについても、超音波の周波数を移動ロボット毎に変更することで、同様の効果を得ることができる。
【００６１】
【発明の効果】
以上に記載の通り、本発明の位置計測装置及び移動ロボットによれば、超音波の直接波のみをを用いて位置検出処理を実施することで、移動ロボットの位置検出誤りを減らし、位置精度の向上を図ることができる。
【図面の簡単な説明】
【図１】 本発明の第１の実施の形態による位置計測装置の構成を示す斜視図
【図２】 本発明の第１の実施の形態による移動ロボットの動作を示すフローチャート
【図３】 本発明の第１の実施の形態による位置検出手段の構成を示す図
【図４】 本発明の第１の実施の形態による位置検出処理の流れを示すフローチャート
【図５】 従来の位置計測装置の構成を示す図
【符号の説明】
１０１ 移動ロボット
１０２ 位置計測装置
１０３ 移動ロボット制御部
１０４ 光源部
１０５ 超音波発振部
１０６ 移動ロボット用無線送受信部
１０７−１〜ｎ 受信部
１０８ 無線送受信部
１０９ 位置検出部
１１０ 地図記憶部
１１１ 発振部
２０１ 光センサ
２０２ 超音波受信部
２０３ 閾値処理部
２０４ 遅延部
２０５ ゲート回路部
２０６ カウンタ部
２０７ カウンタメモリ部
【発明の属する技術分野】
本発明は、監視領域内を移動する物体の位置を計測する位置計測方法及び位置計測システムに関する
ものである。
【０００２】
【従来の技術】
近年、移動機能を有する作業ロボットの機能が高まり、移動ロボットを利用した多くのシステムが開発されている。ロボットの移動を制御及び管理するためには、作業領域内を移動するロボットの位置把握が不可欠である。ロボットの位置把握技術には、自身の移動台車の車輪回転量でロボット自身が移動量を把握し、自身の初期位置と移動量とを用いて逐次の自己位置を把握する方法、ロボットと周囲環境の固定な目印との位置関係を、超音波及び光を媒体としたロボットと周囲環境との間でのセンシング技術で把握し、ロボット位置を特定する手法がある。本発明は後者の手法に関わる。
【０００３】
従来の技術を、図５を用いて解説する。移動ロボット４０１は、監視領域を移動するものであり、タイミングパルス送信部４０２は、位置検出の基準時間となるタイミングパルスを発信するものであり、タイミングパルス受信部４０６−１〜２は、タイミングパルスを受信し、超音波の送信を促すものであり、超音波送信部４０３−１〜２は、監視領域に固定設置された複数の周波数の異なる超音波を、タイミングパルスの受信後に出力するものである。
【０００４】
また、超音波受信部４０４は、複数の周波数の超音波を受信し、周波数分離するものであり、位置検出部４０５は、超音波の周波数から超音波送信部を認識し、タイミングパルスの送信時間と超音波の受信時間とから監視領域内の位置を検
出するものである。
【０００５】
なお、移動ロボット４０１は、タイミングパルス送信部４０２、超音波受信部４０４及び位置検出部４０５を含む構成である。
（例えば、特許文献１参照）。
【０００６】
【特許文献１】
特開平６−３５５３５号公報（第３頁、第１図）
【０００７】
【発明が解決しようとする課題】
しかしながら、従来の構成では、超音波の特性上、領域内に配置される構造物からの反射波が避けられないため、この反射波を検出してしまうことで、位置検出に誤差を生じるという課題を有していた。
【０００８】
また、ソフトウェア的に反射波からの情報を特定しようとすると、直接波、反射波による検出値の混在する複数の受信器から得られた距離情報の内から、複数の距離情報の組み合わせを準備し、各距離情報の組み合わせと受信器間の位置情報や移動領域の形状情報と合わせて検出した組み合わせの数だけの位置情報の間で、一致度合いを判断基準として一致度の低い組み合わせの中から反射波受信による情報を特定するというような方法が考えられるが、処理量が多く実現が困難なだけでなく、検出された反射波の数が直接波の数よりも多い場合は、反射波の除去が確実に行われないままロボット位置の誤検出を招いてしまうという課題を有していた。
【０００９】
本発明は、従来の課題を解決するものであり、反射超音波による位置検出のための外乱情報を、軽微な装置構成と計算処理を伴わない方法で排除することで、位置検出誤りを軽減し、検出精度を向上させた位置計測装置を提供することを目的とする。
【００１０】
上記課題を解決するために、本発明は、監視領域内の既知の位置に予め配置された複数の受信部と、位置計測装置用無線送受信部と、位置検出部とを備えた位置計測装置が、
移動ロボット用無線送受信部を備え、前記監視領域内を移動するロボットの位置を計測する方法であって、前記ロボットが、超音波信号と光信号と位置計測要求信号を同時に送信する第１工程と、前記複数の受信部が前記光信号と前記超音波信号を受信し、前記位置計測装置用無線送受信部が位置計測要求信号とを受信する第２の工程と、前記位置検出部が、前記複数の受信部が受信した光信号が予め定めた光強度の閾値以上である場合、前記超音波信号が直接波であると判断する第３の工程とを有し、前記第３の工程で、前記超音波信号が直接波でないと判断した場合、前記位置計測装置用無線送受信部が前記移動ロボット用無線送受信部に位置変更を要請する信号を送信する位置計測方法を用いて位置計測を行う。
【００１１】
本発明の方法によって、超音波の反射波による影響を抑制した位置計測を行うことができる。
【００１２】
【発明の実施の形態】
以下、本発明に記載の発明について、図面を参照しながら説明する。
【００１３】
（実施の形態１）
図１は、本発明第１の実施の形態による位置計測装置の構成を示す図である。
【００１４】
移動ロボット１０１は、監視領域内を移動するものであり、位置計測装置１０２は、移動ロボット１０１の監視領域内の位置を計測するものであり、光源部１０４は、移動ロボット１０１と位置計測装置１０２との間に遮蔽物の有無を判断するための光信号を出力するものであり、超音波発振部１０５は、超音波を出力するものである。
【００１５】
また、移動ロボット制御部１０３は、自己の位置計測を要求する信号である位置計測要求信号を出力し、光源部１０４と超音波発振部１０５とに光信号と超音波の出力を要求するものであり、移動ロボット用無線送受信部１０６は、位置計測要求信号を送信し、位置計測装置１０２が計測した移動ロボット１０１の位置情報を受信するものである。
【００１６】
また、受信部１０７−１〜ｎ（ｎは自然数）は、監視領域内の既知の場所に予め配置され、光信号及び超音波を受信するものであり、発振部１１１は、移動ロボット１０１の位置計測の基準となる連続パルス信号出力するものであり、位置検出部１０９は、受信部１０７−１〜ｎをリセットし、光信号と超音波信号の受信時間の差から移動ロボット１０１との距離を算出するものである。
【００１７】
また、地図記憶部１１０は、監視領域の形状と受信部１０７−１〜ｎの配置位置とを含む地図情報が予め記憶されているものであり、無線送受信部１０８は、移動ロボット１０１から位置計測要求信号を受信し、光信号の受信を示す光信号確認信号と、算出した移動ロボット１０１の位置情報とを送信するものである。
【００１８】
移動ロボット１０１は、移動ロボット制御部１０３、光源部１０４、超音波発振部１０５及び移動ロボット用無線送受信部１０６を含む構成であり、位置計測装置１０２は、受信部１０７−１〜ｎ、発振部１１１、位置検出部１０９、地図記憶部１１０及び無線送受信部１０８を含む構成である。
【００１９】
まず、移動ロボット１０１の動作について、図２を用いて説明する。
【００２０】
まず、Ｓ２０１にて、監視領域内を移動する移動ロボット１０１は、自己の進行方法を決定するために、移動ロボット制御部１０３が、自己の位置の計測を要求する位置計測要求信号を出力し、光信号及び超音波信号を出力する送信要求信号を、移動ロボット用無線送受信部１０６、光源部１０４及び超音波発振部１０５に出力する。
【００２１】
次に、Ｓ２０２にて、移動ロボット用無線送受信部１０６が、位置計測要求信号を位置計測装置１０２に送信し、光源部１０４が、光信号を出力し、超音波発振部１０５が、超音波信号を出力する。
【００２２】
次に、Ｓ２０３にて、移動ロボット用送受信部が、位置計測装置１０２から送信される光信号の受信確認を示した光信号確認信号を受信した場合は、Ｓ２０４に移行し、位置計測装置１０２から送信される移動ロボット１０１の位置の変更を要請する位置変更要請信号を受信した場合は、Ｓ２０６に移行する。
【００２３】
次に、Ｓ２０４にて、移動ロボット用無線送受信部１０６が、位置計測装置１０２が算出した移動ロボット１０１の位置情報である位置情報信号を受信し、移動ロボット制御部１０３に出力する。
【００２４】
次に、Ｓ２０５にて、移動ロボット制御部１０３が、位置情報信号から自己の現在位置を認識する。
【００２５】
次に、Ｓ２０６にて、移動ロボット制御部１０３が、移動ロボット１０１の位置を変更し、再度、Ｓ２０２に移行する。
【００２６】
次に、位置計測装置１０２の動作について説明する。
【００２７】
まず、無線送受信部１０８が、移動ロボット１０１からの位置計測要求信号を受信する。
【００２８】
次に、受信部１０７−１〜ｎが、光信号を受信した場合は、受信部１０７−１〜ｎに含まれる時間計測カウンタを始動する。なお、光信号を受信するまでは、時間計測カウンタの値は０である。
【００２９】
また、位置検出部１０９は、無線送受信部１０８が位置計測要求信号を受信し、受信部１０７−１〜ｎが光信号を受信した場合は、遮蔽物が存在しないことを示した光信号確認信号を無線送受信部１０８から移動ロボット１０１に送信し、無線送受信部１０８が位置計測要求信号を受信したが、受信部１０７−１〜ｎが光信号を受信しない場合は、遮蔽物が存在することを示した位置変更要請信号を無線送受信部１０８から移動ロボット１０１に送信する。
【００３０】
位置測定装置が、光信号確認信号を移動ロボット１０１に返信することにより、移動ロボット１０１は、移動ロボット１０１と位置計測装置１０２との間の遮蔽物の有無を認識することが可能となり、自己位置の変更を行い、遮蔽物を回避することができる。
【００３１】
ここで、一般に光信号は超音波に比較して、外壁等の監視領域内の構造物に対する反射率が圧倒的に低く、構造物からの拡散による信号強度の減衰も激しいという特性を持つことから、移動ロボット１０１の光源部１０４と位置計測装置１０２の受信部１０７−１〜ｎの間に障害物が存在した場合、光信号の直接波を受信する可能性は、超音波の直接波を受信する可能性に比べて格段に小さくなり、また、到達したとしても光信号強度は直接光受信強度よりも極端に小さくなる。
【００３２】
このため、受信部１０７−１〜ｎが光信号を受信した場合は、超音波の直接波を受信する可能性が高いと考えられる。
【００３３】
次に、受信部１０７−１〜ｎが、超音波を受信した場合は、時間計測カウンタを停止する。
【００３４】
次に、位置検出部１０９が、時間計測カウンタの値に、連続パルス信号のパルス間隔と音速とを乗ずることで移動ロボット１０１から受信部１０７−１〜ｎまでの距離情報を算出する。
【００３５】
なお、受信部１０７−１〜ｎは、受信可能な光強度の閾値を有限の移動距離範囲での直接受信強度程度に設定しておくことで、反射光の信号入力を排除できる。
【００３６】
さらに、光源部１０４を点光源とすることで、点光源の光強度分布の指向性は超音波発振器のそれよりも小さいということから、反射光を除外するために、均一の閾値処理を全方位に対して実施しても、方位依存性は少なく、同等な効果を得ることができる。
【００３７】
即ち、特定強度以上の光信号が直接受光できた移動ロボット１０１と受信部の間では、超音波の直接波の通路が確保されており、超音波の反射波を排除することが容易にできる。
【００３８】
次に、位置検出部１０９が、複数の受信部から得られた距離情報と、地図記憶手段より読み出した予め記憶された各受信部１０７−１〜ｎの位置情報と、移動領域の形状情報とを合わせて、三角測量法を用いることにより、移動ロボット１０１の位置を検出することができる。
【００３９】
次に、無線送受信部１０８が、検出した移動ロボット１０１の位置情報を一般的な無線プロトコルによって、移動ロボット１０１に伝達する。
【００４０】
また、無線通信を用いることで、位置計測装置１０２からの位置検出要求を移動ロボット１０１に通知することで、位置計測装置１０２を起点とする位置検出も容易に実現できる。
【００４１】
次に、図３に受信部１０７の構成を示す。
【００４２】
受信部１０７は、近接した位置に光センサ２０１と超音波受信部２０２を持つことを特徴とする。
【００４３】
光センサ２０１は、移動ロボット１０１が送信した光信号を受信するものであり、超音波受信部２０２は、移動ロボット１０１が送信した超音波信号を受信するものであり、閾値処理部２０３は、光センサ２０１が受信した光信号の信号強度を閾値処理することで、２値信号を出力するものである。
【００４４】
また、ゲート回路部２０５は、全ての受信部１０７−１〜ｎに共通の発振器から出力される連続パルス信号が入力され、２値信号の立ち上がりエッジによりゲートをオープンすることで、連続パルス信号を出力し、超音波信号の立ち上がりエッジによりゲートをクローズするものであり、カウンタ部２０６は、ゲート回路部２０５が入力された連続パルス信号により、カウントを行い、位置検出部１０９から入力されるリセット信号によりカウンタ値をクリアするものである。
【００４５】
また、遅延部２０４は、カウントのストップが確立するために、超音波信号の立ち上がりエッジを十分に遅延させるものであり、カウントメモリ部は、遅延した超音波信号の立ち上がりエッジによりカウンタ部２０６から入力されたカウント値を記憶し、位置検出部１０９から入力されるリセット信号によりカウンタ値をクリアするものである。
【００４６】
次に、本発明の位置検出処理の進行手順を図４に示す。
【００４７】
まず、Ｓ３０１にて、無線送受信部１０８が、移動ロボット１０１から送信された位置計測要求信号を受信する。
【００４８】
次に、Ｓ３０２にて、光センサ２０１が、移動ロボット１０１から送信された光信号を受信した場合は、Ｓ３０３に移行し、光信号を受信しない場合は、Ｓ３１１に移行する。
【００４９】
次に、Ｓ３０３にて、位置検出部１０９が、光信号及び位置計測要求信号の受信を確認した後に、光信号確認信号を無線送受信部１０８から出力する。
【００５０】
次に、Ｓ３０４にて、カウンタ部２０６が、時間計測のためのカウンタのカウントが開始される。
【００５１】
次に、Ｓ３０５にて、超音波受信部２０２が、移動ロボット１０１から送信された超音波信号を受信する。
【００５２】
次に、Ｓ３０６にて、カウンタ部２０６が、時間計測カウンタを停止し、カウンタメモリ部２０７が、カウンタ値を記憶し、位置検出部１０９に出力する。
【００５３】
次に、Ｓ３０７にて、位置検出部１０９が、カウンタ値に、パルス間隔と音速とを乗ずることで移動ロボット１０１から受信部１０７−１〜ｎまでの距離情報を算出する。
【００５４】
次に、Ｓ３０８にて、位置検出部１０９が、移動ロボット１０１の位置検出のための距離情報が充分であるかを判断する。
【００５５】
次に、Ｓ３０９にて、位置検出部１０９が、移動ロボット１０１と受信部１０７−１〜ｎの距離と地図情報記憶部に予め記憶した受信部１０７−１〜ｎの位置情報と移動領域の形状情報とから、移動ロボット１０１の位置を検出する。
【００５６】
次に、Ｓ３１０にて、無線送受信部１０８が、算出した移動ロボット１０１の位置情報を移動ロボット１０１に送信する。
【００５７】
次に、Ｓ３１１にて、位置検出部１０９が、位置計測要求信号の受信を確認し、光信号が受信されない場合に、位置変更要請信号を無線送受信部１０８から出力する。
【００５８】
かかる構成によれば、光信号と超音波信号とを併用することで、超音波信号の直接波のみを用いて位置計測を行うことで、監視領域の複雑化に伴って増大する反射超音波信号によるロボット位置の誤検出を防止することができる。
【００５９】
なお、光源部１０４を熱源部とし、光センサ２０１を熱センサとしても、同様の効果を得ることができる。
【００６０】
なお、本実施の形態では、単体の移動ロボットを用いた位置計測システムについて説明したが、複数の移動ロボットを用いた位置計測システムについても、超音波の周波数を移動ロボット毎に変更することで、同様の効果を得ることができる。
【００６１】
【発明の効果】
以上に記載の通り、本発明の位置計測装置及び移動ロボットによれば、超音波の直接波のみをを用いて位置検出処理を実施することで、移動ロボットの位置検出誤りを減らし、位置精度の向上を図ることができる。
【図面の簡単な説明】
【図１】 本発明の第１の実施の形態による位置計測装置の構成を示す斜視図
【図２】 本発明の第１の実施の形態による移動ロボットの動作を示すフローチャート
【図３】 本発明の第１の実施の形態による位置検出手段の構成を示す図
【図４】 本発明の第１の実施の形態による位置検出処理の流れを示すフローチャート
【図５】 従来の位置計測装置の構成を示す図
【符号の説明】
１０１ 移動ロボット
１０２ 位置計測装置
１０３ 移動ロボット制御部
１０４ 光源部
１０５ 超音波発振部
１０６ 移動ロボット用無線送受信部
１０７−１〜ｎ 受信部
１０８ 無線送受信部
１０９ 位置検出部
１１０ 地図記憶部
１１１ 発振部
２０１ 光センサ
２０２ 超音波受信部
２０３ 閾値処理部
２０４ 遅延部
２０５ ゲート回路部
２０６ カウンタ部
２０７ カウンタメモリ部
Claims (6)
- 監視領域内の既知の位置に予め配置された複数の受信部と、
位置計測装置用無線送受信部と、位置検出部とを備えた位置計測装置が、
移動ロボット用無線送受信部を備え、前記監視領域内を移動するロボットの位置を計測する方法であって、
前記ロボットが、超音波信号と光信号と位置計測要求信号を同時に送信する第１工程と、
前記複数の受信部が前記光信号と前記超音波信号を受信し、前記位置計測装置用無線送受信部が位置計測要求信号とを受信する第２の工程と、
前記位置検出部が、前記複数の受信部が受信した光信号が予め定めた光強度の閾値以上である場合、前記超音波信号が直接波であると判断する第３の工程とを有し、
前記第３の工程で、前記超音波信号が直接波でないと判断した場合、
前記位置計測装置用無線送受信部が前記移動ロボット用無線送受信部に位置変更を要請する信号を送信する位置計測方法。 - 前記第３の工程で、前記超音波信号が直接波であると判断した場合、前記受信部の配置位置を含む地図情報と、前記光信号と前記超音波信号の受信時間差とを用いて前記ロボットの位置情報を算出する請求項１に記載の位置計測方法。
- 前記ロボットが、さらに、点光源から構成される光源部を備えた請求項１または２のいずれかに記載の位置計測方法において、
前記第１工程で、点光源からなる光源部が前記光信号を送信し、
前記第３工程で、前記複数の受信部が受信した光信号に対して前記閾値を均一にする位置計測方法。 - 超音波信号と光信号と位置計測要求信号とを同時に送信する監視領域内を移動するロボットの位置を計測するシステムであって、
前記光信号と前記超音波信号とを受信する前記監視領域内の既知の位置に予め配置された複数の受信部と、
前記位置計測要求信号を受信する位置計測装置用送受信部と、
前記位置計測装置用送受信部が前記位置計測要求信号を受信し、かつ、前記複数の受信部が受信した前記光信号が、予め定めた光強度の閾値以上である場合、前記超音波信号が直接波であると判断する位置検出部とを備え、
前記位置計測装置用無線送受信部は、前記位置検出部が前記超音波信号を直接波でないと判断した場合、前記移動するロボットの位置変更を要請する信号を送信する位置計測システム。 - 前記位置検出部が、前記超音波信号が直接波であると判断した場合、前記受信部の配置位置を含む地図情報と、前記光信号と前記超音波信号の受信時間差とを用いて前記ロボットの位置情報を算出する請求項４に記載の位置計測システム。
- 請求項４または５のいずれかに記載の位置計測システムにおいて、
前記ロボットが、点光源から構成される光源部を備え、前記光源部から前記光信号が送信され、前記複数の受信部が受信した光信号に対して前記閾値を均一にすることを特徴とする位置計測システム。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003174356A JP4337421B2 (ja) | 2003-06-19 | 2003-06-19 | 移動する物体の位置計測方法及び位置計測システム |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003174356A JP4337421B2 (ja) | 2003-06-19 | 2003-06-19 | 移動する物体の位置計測方法及び位置計測システム |
Publications (3)
| Publication Number | Publication Date |
|---|---|
| JP2005010011A JP2005010011A (ja) | 2005-01-13 |
| JP2005010011A5 JP2005010011A5 (ja) | 2006-06-15 |
| JP4337421B2 true JP4337421B2 (ja) | 2009-09-30 |
Family
ID=34097864
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2003174356A Expired - Lifetime JP4337421B2 (ja) | 2003-06-19 | 2003-06-19 | 移動する物体の位置計測方法及び位置計測システム |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4337421B2 (ja) |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR100709073B1 (ko) | 2005-08-17 | 2007-04-18 | 삼성전자주식회사 | 위치정보 송출장치 및 로봇 |
| JP4741937B2 (ja) * | 2005-11-21 | 2011-08-10 | Ｎｅｃディスプレイソリューションズ株式会社 | 距離測定システムおよび距離測定方法 |
| JP4199785B2 (ja) | 2006-08-04 | 2008-12-17 | Ｎｅｃディスプレイソリューションズ株式会社 | 距離測定システム及び距離測定方法 |
| EP2063287A1 (en) * | 2006-08-30 | 2009-05-27 | NEC Corporation | Localization system, robot, localization method, and sound source localization program |
| JP2011129095A (ja) * | 2009-12-18 | 2011-06-30 | Korea Electronics Telecommun | 自律走行ロボットを利用した地図生成方法、これを利用した最適走行経路算出方法およびこれらを遂行するロボット制御装置 |
-
2003
- 2003-06-19 JP JP2003174356A patent/JP4337421B2/ja not_active Expired - Lifetime
Also Published As
| Publication number | Publication date |
|---|---|
| JP2005010011A (ja) | 2005-01-13 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US6141293A (en) | Ultrasonic positioning and tracking system | |
| KR100904681B1 (ko) | 하나의 무선수신국을 이용한 무선발신기의 위치측정 방법및 장치 | |
| JP4647515B2 (ja) | 座標検出装置、筆記具および座標入力システム | |
| JP2007500348A (ja) | 超音波を用いる距離の測定方法と装置 | |
| WO2013088951A1 (ja) | 位置測定装置 | |
| US20110025494A1 (en) | Relative Location Determination of Mobile Sensor Nodes | |
| JP2016128765A (ja) | 位置情報特定システム | |
| US10234548B2 (en) | Ultrasonic detection device to determine interference source by an additional reception mode | |
| KR20110012584A (ko) | 초음파 기반 3차원 위치 추정 장치 및 방법 | |
| CN105203996A (zh) | 移动设备及其室内定位方法、系统及装置、锚节点 | |
| JP2005069892A (ja) | 移動体の自己位置算出システム | |
| JP2015166705A (ja) | 障害物検知装置 | |
| CN108169752B (zh) | 一种基于无线通信的超声波测距方法及系统 | |
| JP2003279648A (ja) | 距離測定方法及び位置特定方法 | |
| KR101408089B1 (ko) | 초음파 센서 어레이를 이용한 3차원 위치측정 장치 및 그방법 | |
| JP4337421B2 (ja) | 移動する物体の位置計測方法及び位置計測システム | |
| CN108267740B (zh) | 信息处理方法、超声波装置、移动设备和存储介质 | |
| KR100699083B1 (ko) | 위치 추정 방법 | |
| JP2006145222A (ja) | 測距システム、及び測距方法 | |
| KR102263722B1 (ko) | 차량 초음파센서의 노이즈 감지장치 및 이의 노이즈 감지방법 | |
| JP3538183B2 (ja) | パルスレーダ装置 | |
| JP2002131426A (ja) | 超音波センサ装置 | |
| KR100757102B1 (ko) | 로봇 청소기에서 거리 측정 방법 및 그 장치 | |
| JPH0720223A (ja) | 無人搬送車の測位装置 | |
| JP3586247B2 (ja) | パルスレーダ装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060421 |
|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060421 |
|
| RD01 | Notification of change of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7421 Effective date: 20060512 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20080611 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20080617 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20080818 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20081224 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090105 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20090609 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20090622 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 4337421 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120710 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120710 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130710 Year of fee payment: 4 |
|
| EXPY | Cancellation because of completion of term |