JP3731123B2

JP3731123B2 - Object position detection method and apparatus

Info

Publication number: JP3731123B2
Application number: JP2002369325A
Authority: JP
Inventors: 幸悦田中; 晋太郎酒本; 誠梶谷
Original assignee: Shinryo Corp
Current assignee: Shinryo Corp
Priority date: 2002-12-20
Filing date: 2002-12-20
Publication date: 2006-01-05
Anticipated expiration: 2022-12-20
Also published as: JP2004198330A

Description

【０００１】
【発明の属する技術分野】
本発明は、ロボットを用いて移動物体の位置を検出する方法と装置に関し、特に一定のエリア内にある対象物体に向けてロボットからレーザ光を照射することにより、その対象物体の正確な現在位置を測定する方法及び装置に関する。
【０００２】
【従来の技術】
移動物体の現在位置を検出するには、移動経路中の要所に各種のランドマーク（誘導標識）を設置しておいて移動物体側からそのランドマークを見て現在位置を検出する方法と、固定位置に設置した観測装置から移動物体を見て移動物体の現在位置を検出する方法とがある。
【０００３】
特開平１１−１８３１７４号「移動体の位置計測装置」では、２個以上の反射物体を移動経路の周囲に配置し、移動体からレーザ光などを投射し、その反射光などから相対距離・進行方向・相対角度などを計測し演算している。この場合、２個以上の反射物体は既知の位置に正確に設置する必要があるから、設置の手間が煩雑で、基準の数が増えるほど作業量が多くなる。また測角と測距の２つの手段が必要となる。
特開平８−１５０５８２号「移動ロボット走行システム」では、２つの光学装置からそれぞれレーザ光を照射し、各光学系の光軸と規準線とのなす角度及び規準線の長さを用いて、三角測量の原理により位置を求めている。この場合、レーザ照射装置を２カ所に正確に設置する必要がある。
【０００４】
特開平７−５２４２号「移動体の位置計測装置」では、反射手段を有する標識位置から位置計測装置までの距離及び方位を光ビームと画像処理手段を用いて算出しており、特に移動体の近傍に障害物があった場合でも、赤外線発光ダイオードとビデオカメラを用いて物体を検出している。この場合、ビデオカメラによる画像が複雑となるため、制御手段が高度な構成となる。
本発明者等の先願である特開平９−１２８０４１号（特許第３３４０６０６号）「移動ロボットの誘導方法と誘導システム」では、１枚の標識に複数の基準点を設定し移動体の位置計測を行っている。このように基準点間の角度を参照して位置計測する方法では、基準点間距離が大きければ大きいほど位置計測誤差は小さくなるが、１枚の標識に採用できる基準点間距離は通常２００ｍｍ程度であり、精度を上げることが難しい。
【０００５】
一般にレーザ光を用いて位置を検出する方法では、レーザ光などを検出するためにＰＳＤ（Position Sensitive Device ）などの半導体位置検出素子を用いているが、ＰＳＤの大きさが小さいので（最大で２０×２０ｍｍ程度）、レーザ光を素子に当てるための制御が複雑になるという欠点がある。
【０００６】
【発明が解決しようとする課題】
本発明の主たる目的は、多数の標識を設置することなく、一定のエリア内における移動物体の位置を正確に検出する方法と装置を提供することにある。
本発明の他の目的は、床面の凹凸による誤差を吸収して正確な位置検出を可能とする位置検出装置を提供することにある。
【０００７】
【課題を解決するための手段】
前述した目的を達成するため、本発明はその第１の態様において、一定のエリア内に存在する物体の位置を検出する方法であって、エリア内の基準位置にレーザポインタロボットを設置し、前記レーザポインタロボットの単独のレーザ光源から、対象とする物体に対してエリア座標系における既知の２点に向けて２本のレーザ光を順次照射し、それら２本のレーザ光を前記物体内部のポイントレシーバで受け、前記ポイントレシーバ上の第１のレーザスポットの重心位置と第２のレーザスポットの重心位置をそれぞれ前記物体の物体内座標系で計測し、これにより対象物体のエリア座標系での位置を検出する物体の位置検出方法を提供する。
【０００８】
【作用】
本発明の方法によれば次のような作用効果が得られる。
１多数のマーカーを設置する必要がない。基準が１つであり、設置の手間が少ない。また、測距手段が無く装置が簡略化できる
２基準の設置は１カ所でよいので手間が少ない
３標識に相当する基準点がアクティブにレーザ光を照射して位置を示すので、移動物体から標識を選び出す必要が無く装置が簡略化できる
４標識を大きくする必要がない
５スクリーンから距離をとってＣＣＤカメラを配置すれば、レーザスポットの検出範囲は大きくとれる（実施例で１００×１００ｍｍ）。これにより、概略座標データと実座標データとに誤差が生じても、レーザスポットを検出することができる。
【０００９】
さらに本発明はその第２の態様として、物体の位置検出装置を提供する。この装置は、一定のエリア内で複数のレーザ光を水平下方又は水平上方に向けて照射可能な単独のレーザ光源を有するレーザポインタロボットと、位置を検出する対象物体上に搭載可能なポイントレシーバとを備え、前記ポイントレシーバは、レーザ光のスポット照射を受けるための水平スクリーンと、この水平スクリーン上のレーザスポットを撮影するＣＣＤカメラと、前記ＣＣＤカメラの映像から対象物体の物体内座標系におけるレーザスポットの位置を計測する画像処理機構と、前記画像処理機構により測定された値に基づいて対象物体のエリア座標系における位置を計算する制御機構とを有しており、前記レーザポインタロボットのレーザ光源から照射される複数のレーザ光が前記スクリーンに照射する位置を計測することにより対象物体の位置を検出する。
【００１０】
このような装置を実際に使用する際に問題となるのが、床面の凹凸によって生じる移動体のＺ軸方向の位置の変化、すなわちレーザポインタロボットとポイントレシーバの床面のレベルが変化した際の測定誤差の問題である。そこで本発明では、前記ポイントレシーバにさらに、前記レーザポインタロボットからの水平レーザ照射を受けて高さを計測し水平スクリーン上へ照射する位置を補正するための高さ測定機構を設けることができる。この高さ測定機構は受光板とＣＣＤカメラを包含することが好適である。
【００１１】
本発明による方法及び装置は測定対象物体とレーザポインタロボットで構成される。測定対象物体は、ワイヤレスモデム、コンピュータ、傾斜計、レーザポインタロボットからのレーザ光を受光する測定対象物体に水平に設置されたスクリーン、スクリーンからの反射光を検出するＣＣＤカメラからなるポイントレシーバ、高さ測定装置、などから構成されている。
レーザポインタロボット（ＬＰＲ）は、ワイヤレスモデム、コンピュータ、レーザポインタ、レーザポインタを水平・垂直方向に回転させる機構及び実際のレーザ光投射角度を測定するための機構などから構成されている。
レーザポインタロボットは、レーザ光源を水平（α：レーザ光源の含まれる水平面（Ｘ−Ｙ平面）上において、レーザ光軸がｘ軸となす角）・垂直（β：レーザ光軸が水平面となす角）方向に回転させて、２次元平面における任意の位置をレーザスポットで指し示すことができる。
上記２台はそれぞれコンピュータで制御され、２つのコンピュータは無線による通信ができる。
【００１２】
このシステムを用いて測定対象物体の自己位置検出を行う過程を以下に示す
（１）レーザポインタロボットを基準位置に設置する
（２）測定対象物体をエリア内に置く
（３）測定対象物体の位置における概略の座標データ（ｘ，ｙ）をレーザポインタロボットに入力する
（４）レーザポインタロボットから水平方向にレーザ光を照射する。測定対象物体は高さ測定装置によりレーザ光を受光し、レーザ光の高さを測定する
（５）測定対象物体の傾斜（高さのずれ）を前記レーザ光の高さから計算して高さの補正を行い、測定対象物体の正しい高さを計算し、そのデータをレーザポインタロボットへ送信する
（６）レーザポインタロボットは、測定対象物体の既知の概略の座標データと正しい高さから、測定対象物体の床面高さの補正を行った概略座標位置に対するレーザ光照射角α１，β１を算出する
【００１３】
（７）レーザポインタロボットは、算出された角α１，β１に向けてレーザ光を照射する
（８）測定対象物体はレーザ光をスクリーンで受光し、受光したことをレーザポインタロボットに送信する。スクリーン上の第１受光ポイントの位置をコンピュータに記録する
（９）レーザポインタロボットは概略位置から規定値だけ離れた近傍の位置に対する照射角α２，β２を計算し、その角度にレーザ光を照射する
（１０）測定対象物体は、スクリーン上に第２受光ポイントを検出し、受光したことをレーザポインタロボットに送信する。スクリーン上の第２受光ポイントの位置をコンピュータに記録する
（１１）測定対象物体は、記録された第１受光ポイントと第２受光ポイントの記録データから、自己の正確な位置をコンピュータで検出する。
【００１４】
さらに具体的には、レーザスポットの位置を検出するために、広い面積を有するスクリーンを測定対象物体に水平に取り付け、スクリーン内で受光したレーザスポットを撮像できるようにＣＣＤカメラを取り付け、画像処理装置を用いてスポットの重心位置を計測する。
以下、本発明による好適な実施形態を添付図面を参照しながら説明する。
【００１５】
【発明の実施の形態】
まず本発明による自己位置計測法の基本原理について説明する。
図１に示すように本発明は、レーザ光により目標位置を示すレーザポインタロボット（ＬＰＲ）１２と、レーザ光を受光して自己位置を算出するポイントレシーバ（ＰＲＶ）１４を搭載した測定対象物体１０とで構成される。測定対象物体１０は一定のエリアＳ内を移動し、レーザポインタロボット１２は原則として一定の位置Ｓ１に設置される。
【００１６】
図２はレーザポインタロボット１２が床面へレーザ光を照射して投射位置Ｔを指示する様子を示している。ここでは、レーザポインタロボットのｘｙ平面は床面のＸＹ平面と平行であり、ｘ軸ｙ軸はそれぞれ対応するＸ軸Ｙ軸と平行とする。レーザポインタロボットのレーザ光照射部の回転中心は、床面から高さＨのところにある。レーザ光照射部を水平角α，仰角βの方向に向けると、床面上の投射位置Ｔ（ｘ，ｙ）にレーザスポットを照射して位置を指示することができる。これらの関係式は次式で表される。
ｘ＝ｒ・ｃｏｓα
ｙ＝ｒ・ｓｉｎα
ｒ＝ｈ／ｔａｎβ
【００１７】
ポイントレシーバ（ＰＲＶ）は一定の大きさのスクリーンを持ち、スクリーンに照射されたレーザ光（これをレーザポイントと呼ぶ）の座標を測定する装置である。ここでは、原理を簡単に説明するために、レーザ光が照射される床面とポイントレシーバのスクリーンは同一平面にあるものとする。図３に示すようにエリアの床面の座標系（ＸＹ座標系）において、レーザポインタロボットによって床面に照射されたスポットＡ（ｘ_A ，ｙ_A ）は測定対象物体上のスクリーン（ＵＶ座標系）ではスポットＡ（ｕ_A ，ｖ_A ）と測定される。ロボット位置Ｒ（ｘ_R，ｙ_R ）と姿勢θ_R は２点Ａ，Ｂから以下の手順で求めることができる。
【００１８】
まず、姿勢θ_R は、スポットを通る直線と２つの座標系とのなす角θ_AB，φ_ABとの関係により、次式から求められる。負の値は絶対値とする。
θ_R ＝θ_AB−φ_AB
ここで、θ_ABとφ_ABはそれぞれ次式で与えられる。
【数１】

【００１９】
次に、位置Ｒ（ｘ_R ，ｙ_R ）は次式から求められる。
ｘ_R ＝ｘ_A −ｒ_A ｃｏｓ（θ_R ＋φ_A ）
ｙ_R ＝ｙ_A −ｒ_A ｓｉｎ（θ_R ＋φ_A ）
ここで、φ_A はロボットから見たスポットＡの方向、ｒ_A はロボット中心とスポットＡとの距離で、それぞれ次式で与えられる。
【数２】

【００２０】
【実施例】
一般にレーザ光などを検出するためにＰＳＤ（Position Sensitive Device ）などの半導体位置検出素子を用いるが、ＰＳＤの大きさが小さいので（最大で２０×２０ｍｍ程度）、レーザ光を素子に当てるための制御が複雑になる。
本発明では、レーザスポットの位置を検出するために、スクリーン内で受光したレーザスポットをＣＣＤカメラで撮像して、画像処理装置を用いてスポットの重心位置を計測する。
本発明のように、スクリーンから距離をとってＣＣＤカメラを配置すれば、レーザスポットの検出範囲は大きくとれる（実施例で１００×１００ｍｍ）。これにより、オドメトリ情報（自動車の走行距離計に対応する走行距離データ）での移動の際に誤差が生じても、レーザスポットを検出することができる。
【００２１】
レーザポインタロボット（ＬＰＲ）は、レーザ光を水平方向（回転角α）と垂直方向（回転角β）に回転させて、作業領域内にレーザ光を投射する機能を持つ投光部とその制御装置で構成される。
図４はレーザポインタロボット１２の投光部の外観を表している。レーザ光源２６には素子出力５ｍＷ、波長６７０ｎｍの半導体レーザを使用し、コリメータレンズを用いて距離５ｍでスポット径５ｍｍにしている。レーザ光源２６は垂直回転軸に取り付けられている。投光部の各軸は、減速機付きＤＣサーボモータ２８，２９とスチールベルトによる減速機構（減速比１／３００）により駆動される。位置決め分解能は軸換算で１．０７”（０．０００３°）である。レーザ光の投射角度の測定には、各軸に直接取り付けたエンコーダ３２，３３（目盛本数１８０００本）を使用し、波形成形回路（内挿回路）とカウンタ回路により測定分解能は１．８”（０．０００５°）である。投光部のベース３６は、水平調整を行うため３点支持機構（図示せず）とした。
制御装置２４は、無線モデムを通じて移動ロボットや他のシステムと通信し、レーザを投射している方向の情報（α，β）を提供したり、指令を受けて指定された方向へレーザ光を位置決めする機能を持つ。
【００２２】
図５に示すように、移動体１０には、レーザポインタロボット１２により照射されたレーザポイントを受光して自己位置を算出するためのポイントレシーバ１４が搭載されている。本システムの自己位置計測法は、レーザポインタロボットが指示した目標位置まで移動体がオドメトリ情報（走行距離データ）のみで移動し、レーザポイントを受光した後に正確な自己位置を算出するという方法である。従って、ＰＳＤなどの受光面積の小さなセンサを用いると、移動体には高い移動精度が要求されることになり、オドメトリのみの自律移動性能と床面の状況を考えると実用的ではない。そこで、移動体にレーザポイントを受光するスクリーンを用意し、この反射光をＣＣＤカメラにより画像計測するポイントレシーバシステムを構築している。
【００２３】
図５に示すように、レーザポイントの検出部は、スクリーン４０（反射板）とＣＣＤカメラ４２で構成されている。スクリーン４０に対して斜めに入射するレーザ光はレーザポインタロボット１２からの距離が長くなるに従ってポイントの長軸が長くなる。ここではポイントレシーバの受光範囲をレーザポインタロボットから１０ｍと設定し、そのために必要なカメラ視野が得られるように設計した。このときのカメラレンズの焦点距離は１６ｍｍ、有効画素は５１２×４８０の正方格子配列で、スクリーン上での検出範囲は約１００ｍｍ四方、カメラの測定分解能は０．２２ｍｍ／ピクセルとした。画像処理装置では、二値化、平滑化、ノイズ除去、面積フィルタの前処理を行い、ポイントの重心位置と面積を測定する。
【００２４】
本システムを実際に使用する際に問題となるのが、床面の凹凸によって生じる移動体のＺ軸方向の位置の変化、すなわちレーザポインタロボット（ＬＰＲ）とポイントレシーバ（ＰＲＶ）との高度差ｄの変化である（図６参照）。これを測定して補正するために、図７に示すように移動体１０上に高さ測定装置（機構）５０を装備している。この高さ測定装置５０は、レーザポインタロボット１２から水平に照射されたレーザ光を受光板５２で受光し、それをＣＣＤカメラ５４で検出してレーザポイントの位置を計測する。あらかじめ床面からの距離ｈ_LPR の位置を高さ測定装置の座標系で求めているので、ｄは装置内の高度差Δｄにより以下の式で求められる。
ｄ＝（ｈ_LPR −ｈ_PRV ）＋Δｄ
測定装置５０の測定分解能は０．１５３ｍｍ／ピクセルである。
【００２５】
上述したように、自己位置を求めるためには、ポイントレシーバ面上に照射された投射位置Ｔの座標（Ｘ，Ｙ）（ＬＰＲ座標系）と、ロボットから見たポイントレシーバ面上のＴの座標（Ｕ，Ｖ）（移動体＝ＰＲＶ座標系）が必要である。ここで床面の凹凸の影響などで移動体１０が傾くとポイントレシーバ１４も傾くので、レーザポインタロボット１２の指示した投射位置Ｔを正しく測定することができなくなる。そこで、傾きによる誤差を補正するために、移動体のピッチング方向（Ｖ軸回り）とローリング方向（Ｕ軸回り）に取り付けた傾斜計で傾き角を測定し、測定座標（Ｕ，Ｖ）を補正する。
【００２６】
本システムによる自己位置検出の手順と各装置の動作は次の通りである。
（１）レーザポインタロボットから移動体へ、移動体の現在位置座標と移動目標位置座標を無線モデムで送信する
（２）移動体はオドメトリ情報により目標位置へ移動し、レーザポインタロボットへ移動完了メッセージを送信する
（３）レーザポインタロボットは高さ測定のためにα軸を水平にして、レーザ光を移動体へ向けて照射する
（４）移動体は高さ測定装置によりレーザポイントの位置を測定する。次に、計測したロボットの傾斜角度に基づいて高さ測定値を補正し、その結果をレーザポインタロボットに送信する
【００２７】
（５）レーザポインタロボットは、補正された高さ測定情報に基づいてα，β角度を計算し、移動目標位置にレーザ光を照射する。その後、照射完了メッセージを移動体へ送信する
（６）移動体はポイントレシーバにより照射されたレーザポイントの位置を測定する。第１点目の測定が完了したことをレーザポインタロボットに送信する
（７）レーザポインタロボットは移動目標位置のＸ座標Ｙ座標にそれぞれ１０ｍｍ加えた位置に第２点目のレーザ光を照射する。その後、照射完了メッセージを移動体へ送信する
（８）移動体は第２点目をポイントレシーバにより測定する。１点目と２点目の測定結果から自己位置を計算する。自己位置測定結果は、現在位置座標情報としてレーザポインタロボットに送信する。
【００２８】
もし移動体が何らかの原因で目標位置へ移動できず、ポイントレシーバでレーザポイントが受光できなかった場合は、移動体側で判断してサーチモードに入る。同時に、無線モデムでレーザポインタロボットにサーチモードに入るよう指示する。サーチモードでは、レーザポインタロボットはレーザ光の走査を行い、移動体はポイントレシーバにポイントの検出を連続して行わせる。ポイントレシーバがポイントを捕捉した時、レーザポインタロボットの指示した座標とポイントレシーバが測定したポイント座標より移動体の位置のずれを算出し、目標位置へ復帰する。以降（３）から制御を行う。
【００２９】
図８は、移動体１０及びレーザポインタロボット１２のそれぞれに搭載されるコンピュータ制御通信システム６０，７０を含む制御装置２４の概略接続図を表している。これらのシステムは周知のワイヤレスモデム、ＲＳ２３２Ｃ回路、コンピュータ、Ａ／Ｄ変換器、傾斜計、画像処理装置、ＣＣＤカメラ、モータコントローラ、エンコーダ、ＤＣサーボモータ、カウンタボード、波形成形回路などで構成される。
【００３０】
【発明の効果】
以上詳細に説明した如く、本発明によれば、多数のマーカーを設置する必要がなく、基準の設置は１カ所でよく、測距手段が無いので装置が簡略化できる。標識に相当する基準点がアクティブにレーザ光を照射して位置を示すので、移動物体から標識を選び出す必要が無く、標識を大きくする必要もない。スクリーンから距離をとってＣＣＤカメラを配置すれば、レーザスポットの検出範囲は大きくとれるので、概略座標データと実座標データとに誤差が生じても、レーザスポットを検出することができる等の利点が得られ、その技術的効果には極めて顕著なものがある。
【図面の簡単な説明】
【図１】本発明による測定装置の概略斜視図である。
【図２】レーザ光の照射角度と距離の測定原理を表す概略図である。
【図３】２つの座標系における測定原理を表す概略図である。
【図４】レーザポインタロボットの正面図である。
【図５】ポイントレシーバの一部破断側面図である。
【図６】高さ測定の原理説明図である。
【図７】高さ測定装置の概略斜視図である。
【図８】２つの装置間でのデータ送信システムを表す概略図である。
【符号の説明】
Ｓエリア
１０測定対象物体
１２レーザポインタロボット
１４ポイントレシーバ
２４制御装置
２６レーザ光源
２８，２９ＤＣサーボモータ
４０スクリーン
４２，５４ＣＣＤカメラ
５０高さ測定装置
５２受光板
６０，７０通信システム[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a method and apparatus for detecting the position of a moving object using a robot, and in particular, by irradiating a laser beam from a robot toward a target object in a certain area, the accurate current position of the target object. The present invention relates to a method and an apparatus for measuring.
[0002]
[Prior art]
In order to detect the current position of the moving object, various landmarks (guidance signs) are installed at important points in the moving path, and the current position is detected by looking at the landmark from the moving object side, There is a method of detecting a current position of a moving object by looking at the moving object from an observation device installed at a fixed position.
[0003]
In Japanese Patent Application Laid-Open No. 11-183174 “Moving Object Position Measuring Device”, two or more reflecting objects are arranged around a moving path, a laser beam or the like is projected from the moving object, and a relative distance / progress from the reflected light or the like. The direction and relative angle are measured and calculated. In this case, since it is necessary to accurately install two or more reflecting objects at known positions, the installation work is complicated, and the amount of work increases as the number of references increases. Two means of angle measurement and distance measurement are required.
In Japanese Patent Application Laid-Open No. 8-150582, “mobile robot traveling system”, laser light is emitted from two optical devices, and the angle between the optical axis of each optical system and the reference line and the length of the reference line are used to form a triangle. The position is determined by the principle of surveying. In this case, it is necessary to accurately install laser irradiation devices at two locations.
[0004]
In Japanese Patent Laid-Open No. 7-5242 “Position Measurement Device for Moving Object”, the distance and direction from the marker position having the reflection means to the position measurement device are calculated using the light beam and the image processing means. Even when there is an obstacle in the vicinity, an object is detected using an infrared light emitting diode and a video camera. In this case, since the image by the video camera becomes complicated, the control means has an advanced configuration.
In the prior application of the present inventors, Japanese Patent Laid-Open No. 9-128041 (Patent No. 3340606) “Mobile Robot Guidance Method and Guidance System”, a plurality of reference points are set on a single sign to measure the position of the moving body. It is carried out. As described above, in the method of measuring the position by referring to the angle between the reference points, the larger the distance between the reference points, the smaller the position measurement error. However, the distance between the reference points that can be adopted for one sign is usually about 200 mm. It is difficult to improve accuracy.
[0005]
In general, in a method of detecting a position using laser light, a semiconductor position detecting element such as PSD (Position Sensitive Device) is used to detect laser light or the like. However, since the size of PSD is small (maximum 20 × 20 mm), and there is a drawback that the control for applying the laser beam to the element becomes complicated.
[0006]
[Problems to be solved by the invention]
A main object of the present invention is to provide a method and an apparatus for accurately detecting the position of a moving object in a certain area without installing a large number of signs.
Another object of the present invention is to provide a position detection apparatus that can accurately detect a position by absorbing an error caused by unevenness of a floor surface.
[0007]
[Means for Solving the Problems]
In order to achieve the above-mentioned object, in the first aspect of the present invention, there is provided a method for detecting the position of an object existing in a certain area , wherein a laser pointer robot is installed at a reference position in the area, Two laser beams are sequentially emitted from a single laser light source of the laser pointer robot toward two known points in the area coordinate system to the target object, and these two laser beams are pointed inside the object. The center of gravity of the first laser spot and the center of gravity of the second laser spot on the point receiver are measured by the in-object coordinate system of the object, and thereby the position of the target object in the area coordinate system Provided is a method for detecting the position of an object for detecting.
[0008]
[Action]
According to the method of the present invention, the following effects can be obtained.
1 There is no need to install many markers. There is only one standard, and there is little installation effort. In addition, there is no distance measurement means and the equipment can be simplified. 2 Installation of the reference is only required in one place, so less effort is required. 3 The reference point corresponding to the sign indicates the position by actively irradiating the laser beam. The device can be simplified without having to select 4 The label need not be enlarged 5 If the CCD camera is arranged at a distance from the screen, the laser spot detection range can be increased (100 × 100 mm in the embodiment). As a result, the laser spot can be detected even if an error occurs between the approximate coordinate data and the actual coordinate data.
[0009]
Furthermore, the present invention provides an object position detection apparatus as a second aspect thereof. This apparatus includes a laser pointer robot having a single laser light source capable of irradiating a plurality of laser beams horizontally downward or horizontally upward within a certain area, and a point receiver that can be mounted on a target object for detecting a position. The point receiver includes a horizontal screen for receiving a spot of laser light, a CCD camera for photographing a laser spot on the horizontal screen, and a laser in an in-object coordinate system of a target object from the image of the CCD camera. An image processing mechanism for measuring the position of the spot; and a control mechanism for calculating a position of the target object in the area coordinate system based on a value measured by the image processing mechanism, and a laser light source of the laser pointer robot By measuring the position where a plurality of laser beams irradiated from the screen irradiate the screen, Detecting the position of an object.
[0010]
The problem when actually using such a device is that the position of the moving body in the Z-axis direction caused by the unevenness of the floor surface, that is, the level of the floor surface of the laser pointer robot and point receiver changes. This is a measurement error problem. Therefore, in the present invention, the point receiver can be further provided with a height measurement mechanism for receiving a horizontal laser irradiation from the laser pointer robot, measuring the height, and correcting the irradiation position on the horizontal screen. The height measuring mechanism preferably includes a light receiving plate and a CCD camera.
[0011]
The method and apparatus according to the present invention comprises an object to be measured and a laser pointer robot. The object to be measured is a wireless modem, a computer, an inclinometer, a screen installed horizontally on the object to be measured that receives laser light from a laser pointer robot, a point receiver consisting of a CCD camera that detects reflected light from the screen, Measuring device.
The laser pointer robot (LPR) includes a wireless modem, a computer, a laser pointer, a mechanism for rotating the laser pointer in the horizontal and vertical directions, a mechanism for measuring an actual laser light projection angle, and the like.
The laser pointer robot moves the laser light source horizontally (α: the angle formed by the laser optical axis with the x axis on the horizontal plane (XY plane) including the laser light source) and vertical (β: the angle formed by the laser optical axis with the horizontal plane. ) Direction, and an arbitrary position in the two-dimensional plane can be indicated by the laser spot.
The two units are each controlled by a computer, and the two computers can communicate wirelessly.
[0012]
The process for detecting the position of the measuring object using this system is shown below. (1) The laser pointer robot is installed at the reference position. (2) The measuring object is placed in the area. (3) The position of the measuring object. (4) The laser pointer robot is irradiated with laser light in the horizontal direction. The object to be measured receives the laser beam by a height measuring device and measures the height of the laser beam. (5) The height of the object to be measured is calculated from the height of the laser beam. Is corrected, the correct height of the measurement target object is calculated, and the data is transmitted to the laser pointer robot. (6) The laser pointer robot measures from the known approximate coordinate data of the measurement target object and the correct height. Laser beam irradiation angles α1, β1 are calculated with respect to the approximate coordinate position where the floor height of the target object has been corrected.
(7) The laser pointer robot irradiates laser light toward the calculated angles α1 and β1. (8) The measurement target object receives the laser light on the screen and transmits the received light to the laser pointer robot. The position of the first light receiving point on the screen is recorded in the computer. (9) The laser pointer robot calculates irradiation angles α2 and β2 with respect to a nearby position that is a specified value away from the approximate position, and irradiates the laser beam at that angle. (10) The measurement target object detects the second light receiving point on the screen and transmits the light reception to the laser pointer robot. The position of the second light receiving point on the screen is recorded in the computer. (11) The measuring object detects the exact position of itself from the recorded data of the first light receiving point and the second light receiving point.
[0014]
More specifically, in order to detect the position of the laser spot, a screen having a large area is mounted horizontally on the object to be measured, and a CCD camera is mounted so that the laser spot received within the screen can be imaged. Is used to measure the center of gravity of the spot.
DESCRIPTION OF EXEMPLARY EMBODIMENTS Hereinafter, preferred embodiments of the invention will be described with reference to the accompanying drawings.
[0015]
DETAILED DESCRIPTION OF THE INVENTION
First, the basic principle of the self-position measuring method according to the present invention will be described.
As shown in FIG. 1, according to the present invention, a measurement target object 10 is equipped with a laser pointer robot (LPR) 12 that indicates a target position by laser light and a point receiver (PRV) 14 that receives the laser light and calculates its own position. It consists of. The measurement target object 10 moves in a certain area S, and the laser pointer robot 12 is installed at a certain position S1 in principle.
[0016]
FIG. 2 shows a state in which the laser pointer robot 12 indicates the projection position T by irradiating the floor surface with laser light. Here, the xy plane of the laser pointer robot is parallel to the XY plane of the floor surface, and the x-axis and y-axis are parallel to the corresponding X-axis and Y-axis, respectively. The rotation center of the laser beam irradiation unit of the laser pointer robot is at a height H from the floor surface. When the laser light irradiation unit is directed in the direction of the horizontal angle α and the elevation angle β, the position can be indicated by irradiating the laser spot to the projection position T (x, y) on the floor surface. These relational expressions are expressed by the following expressions.
x = r · cos α
y = r · sin α
r = h / tan β
[0017]
A point receiver (PRV) is a device that has a screen of a certain size and measures the coordinates of laser light (referred to as a laser point) irradiated on the screen. Here, in order to explain the principle simply, it is assumed that the floor surface to which the laser beam is irradiated and the screen of the point receiver are on the same plane. As shown in FIG. 3, in the coordinate system (XY coordinate system) of the floor of the area, the spot A (x _A , y _A ) irradiated on the floor by the laser pointer robot is a screen (UV coordinate system) on the object to be measured. ) Is measured as spot A (u _A , v _A ). The robot position R (x _R , y _R ) and posture θ _R can be obtained from the two points A and B by the following procedure.
[0018]
First, the orientation θ _R is obtained from the following equation based on the relationship between the straight lines passing through the spot and the angles θ _AB and φ _AB formed by the two coordinate systems. Negative values are absolute values.
θ _R = θ _AB −φ _AB
Here, θ _AB and φ _AB are given by the following equations, respectively.
[Expression 1]

[0019]
Next, the position R (x _R , y _R ) is obtained from the following equation.
_{_{_{x R = x A -r A cos}}} (θ R + φ A)
y _R = y _A −r _A sin (θ _R + φ _A )
Here, φ _A is the direction of the spot A as seen from the robot, and r _A is the distance between the robot center and the spot A, and is given by the following equations.
[Expression 2]

[0020]
【Example】
Generally, a semiconductor position detecting element such as PSD (Position Sensitive Device) is used to detect laser light, but since the size of the PSD is small (up to about 20 × 20 mm), control for applying laser light to the element is performed. Becomes complicated.
In the present invention, in order to detect the position of the laser spot, the laser spot received in the screen is imaged with a CCD camera, and the center of gravity position of the spot is measured using an image processing apparatus.
If the CCD camera is arranged at a distance from the screen as in the present invention, the laser spot detection range can be increased (100 × 100 mm in the embodiment ) . As a result, even when an error occurs during movement in odometry information (travel distance data corresponding to an automobile odometer), a laser spot can be detected.
[0021]
A laser pointer robot (LPR) has a function of projecting a laser beam in a work area by rotating the laser beam in a horizontal direction (rotation angle α) and a vertical direction (rotation angle β), and a control device therefor Consists of.
FIG. 4 shows the appearance of the light projecting unit of the laser pointer robot 12. As the laser light source 26, a semiconductor laser having an element output of 5 mW and a wavelength of 670 nm is used, and a spot diameter of 5 mm is set using a collimator lens at a distance of 5 m. The laser light source 26 is attached to the vertical rotation axis. Each axis of the light projecting unit is driven by a reduction mechanism (reduction ratio 1/300) using

DC servo motors

28 and 29 with reduction gears and a steel belt. The positioning resolution is 1.07 "(0.0003 °) in terms of axis. For the measurement of the laser beam projection angle, encoders 32 and 33 (scale number: 18000) directly attached to each axis are used, and the waveform is measured. The measurement resolution is 1.8 ″ (0.0005 °) due to the shaping circuit (interpolation circuit) and the counter circuit. The base 36 of the light projecting unit is a three-point support mechanism (not shown) for horizontal adjustment.
The control device 24 communicates with a mobile robot and other systems through a wireless modem, provides information (α, β) of the direction in which the laser is projected, and positions the laser beam in the designated direction in response to the command. It has a function to do.
[0022]
As shown in FIG. 5, the moving body 10 is equipped with a point receiver 14 for receiving a laser point irradiated by the laser pointer robot 12 and calculating its own position. The self-position measurement method of this system is a method in which a moving body moves only to odometry information (travel distance data) to a target position indicated by a laser pointer robot, and calculates an accurate self-position after receiving a laser point. . Therefore, when a sensor having a small light receiving area such as PSD is used, the moving body is required to have high movement accuracy, and it is not practical in view of autonomous movement performance and floor condition of only odometry. Therefore, a screen for receiving laser points is prepared on the moving body, and a point receiver system for measuring the image of the reflected light with a CCD camera is constructed.
[0023]
As shown in FIG. 5, the laser point detection unit includes a screen 40 (reflection plate) and a CCD camera 42. The long axis of the point of the laser light incident obliquely on the screen 40 becomes longer as the distance from the laser pointer robot 12 becomes longer. Here, the light receiving range of the point receiver is set to 10 m from the laser pointer robot, and the camera field of view necessary for that is designed. At this time, the focal length of the camera lens was 16 mm, the effective pixels were a 512 × 480 square lattice array, the detection range on the screen was about 100 mm square, and the measurement resolution of the camera was 0.22 mm / pixel. In the image processing apparatus, binarization, smoothing, noise removal, and area filter preprocessing are performed, and the barycentric position and area of the points are measured.
[0024]
A problem in actual use of this system is a change in the position of the moving body in the Z-axis direction caused by unevenness of the floor surface, that is, an altitude difference d between the laser pointer robot (LPR) and the point receiver (PRV). (See FIG. 6). In order to measure and correct this, a height measuring device (mechanism) 50 is provided on the moving body 10 as shown in FIG. The height measuring device 50 receives the laser beam irradiated horizontally from the laser pointer robot 12 by the light receiving plate 52, detects it by the CCD camera 54, and measures the position of the laser point. Since the position of the distance h _LPR from the floor surface is obtained in advance in the coordinate system of the height measuring device, d is obtained by the following equation from the altitude difference Δd in the device.
d = (h _LPR −h _PRV ) + Δd
The measurement resolution of the measurement device 50 is 0.153 mm / pixel.
[0025]
As described above, in order to obtain the self-position, the coordinates (X, Y) (LPR coordinate system) of the projection position T irradiated on the point receiver surface and the coordinates of T on the point receiver surface viewed from the robot. (U, V) (moving object = PRV coordinate system) is required. Here, when the moving body 10 tilts due to the influence of unevenness on the floor surface, the point receiver 14 also tilts, so that the projection position T indicated by the laser pointer robot 12 cannot be measured correctly. Therefore, in order to correct errors due to tilt, the tilt angle is measured with an inclinometer attached to the moving body in the pitching direction (around the V-axis) and the rolling direction (around the U-axis), and the measurement coordinates (U, V) are corrected. To do.
[0026]
The procedure of self-position detection by this system and the operation of each device are as follows.
(1) The current position coordinates and the movement target position coordinates of the moving body are transmitted from the laser pointer robot to the moving body using a wireless modem. (2) The moving body moves to the target position based on the odometry information, and a movement completion message is sent to the laser pointer robot. (3) The laser pointer robot illuminates the moving body with the α axis horizontal to measure the height. (4) The moving body measures the position of the laser point with the height measuring device. To do. Next, the height measurement value is corrected based on the measured tilt angle of the robot, and the result is transmitted to the laser pointer robot.
(5) The laser pointer robot calculates α and β angles based on the corrected height measurement information, and irradiates the moving target position with laser light. Thereafter, an irradiation completion message is transmitted to the moving body (6) The moving body measures the position of the laser point irradiated by the point receiver. The completion of the measurement at the first point is transmitted to the laser pointer robot. (7) The laser pointer robot irradiates the second point with the laser beam at a position obtained by adding 10 mm to the X and Y coordinates of the movement target position. Thereafter, an irradiation completion message is transmitted to the moving body (8) The moving body measures the second point by the point receiver. The self-position is calculated from the measurement results of the first and second points. The self-position measurement result is transmitted to the laser pointer robot as current position coordinate information.
[0028]
If the moving body cannot move to the target position for some reason and the point receiver cannot receive the laser point, the mobile body judges and enters the search mode. At the same time, the wireless pointer instructs the laser pointer robot to enter the search mode. In the search mode, the laser pointer robot scans the laser beam, and the moving body causes the point receiver to continuously detect points. When the point receiver captures the point, the shift of the position of the moving body is calculated from the coordinates indicated by the laser pointer robot and the point coordinates measured by the point receiver, and the target position is returned. Thereafter, control is performed from (3).
[0029]
FIG. 8 is a schematic connection diagram of the control device 24 including the computer

control communication systems

60 and 70 mounted on the moving body 10 and the laser pointer robot 12 respectively. These systems consist of well-known wireless modems, RS232C circuits, computers, A / D converters, inclinometers, image processing devices, CCD cameras, motor controllers, encoders, DC servo motors, counter boards, waveform shaping circuits, etc. .
[0030]
【The invention's effect】
As described above in detail, according to the present invention, it is not necessary to install a large number of markers, the installation of the reference may be performed at one place, and the apparatus can be simplified because there is no distance measuring means. Since the reference point corresponding to the sign indicates the position by actively irradiating the laser beam, it is not necessary to select the sign from the moving object, and it is not necessary to enlarge the sign. If the CCD camera is placed at a distance from the screen, the laser spot detection range can be increased, so that even if an error occurs between the approximate coordinate data and the actual coordinate data, the laser spot can be detected. The technical effects obtained are quite remarkable.
[Brief description of the drawings]
FIG. 1 is a schematic perspective view of a measuring apparatus according to the present invention.
FIG. 2 is a schematic diagram showing the measurement principle of the irradiation angle and distance of laser light.
FIG. 3 is a schematic diagram illustrating a measurement principle in two coordinate systems.
FIG. 4 is a front view of a laser pointer robot.
FIG. 5 is a partially broken side view of the point receiver.
FIG. 6 is a diagram illustrating the principle of height measurement.
FIG. 7 is a schematic perspective view of a height measuring device.
FIG. 8 is a schematic diagram illustrating a data transmission system between two devices.
[Explanation of symbols]
S area 10 measurement object 12 laser pointer robot 14 point receiver 24 control device 26

laser light source

28, 29 DC servo motor 40

screen

42, 54 CCD camera 50 height measuring device 52

light receiving plate

60, 70 communication system

Claims

A method for detecting the position of an object existing in a certain area,
Install a laser pointer robot at the reference position in the area.
From the single laser light source of the laser pointer robot, two laser beams are sequentially irradiated to two known points in the area coordinate system on the target object,
The two laser beams are received by the point receiver inside the object,
Measure the center of gravity position of the first laser spot and the center of gravity of the second laser spot on the point receiver , respectively, in the in-object coordinate system of the object ,
An object position detection method characterized by detecting the position of the target object in the area coordinate system.

A laser pointer robot having a single laser light source capable of irradiating a plurality of laser beams horizontally downward or horizontally upward in a certain area;
With a point receiver that can be mounted on the target object to detect the position,
The point receiver includes a horizontal screen for receiving laser beam spot irradiation, a CCD camera for photographing a laser spot on the horizontal screen, and a position of the laser spot in the in-object coordinate system of the target object from the image of the CCD camera. And an image processing mechanism for measuring the position of the target object in the area coordinate system based on the value measured by the image processing mechanism,
An object position detecting apparatus for detecting a position of a target object by measuring positions at which a plurality of laser beams irradiated from a laser light source of the laser pointer robot irradiate the screen.

The point receiver further includes a height measuring mechanism for receiving a horizontal laser irradiation from the laser pointer robot, measuring a height, and correcting a position to be irradiated on the horizontal screen. 3. A position detecting device according to claim 2, comprising a plate and a CCD camera.