JP4187372B2 - 移動体の測角方法およびその装置とこの測角装置を使用した移動体の位置検出設備 - Google Patents
移動体の測角方法およびその装置とこの測角装置を使用した移動体の位置検出設備 Download PDFInfo
- Publication number
- JP4187372B2 JP4187372B2 JP34698899A JP34698899A JP4187372B2 JP 4187372 B2 JP4187372 B2 JP 4187372B2 JP 34698899 A JP34698899 A JP 34698899A JP 34698899 A JP34698899 A JP 34698899A JP 4187372 B2 JP4187372 B2 JP 4187372B2
- Authority
- JP
- Japan
- Prior art keywords
- light beam
- light
- mirror
- moving body
- irradiation means
- 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 - Fee Related
Links
- 238000000034 method Methods 0.000 title claims description 24
- 230000010287 polarization Effects 0.000 claims description 46
- 230000001678 irradiating effect Effects 0.000 claims description 19
- 238000005259 measurement Methods 0.000 claims description 10
- 239000004065 semiconductor Substances 0.000 description 25
- 238000001514 detection method Methods 0.000 description 22
- 238000010586 diagram Methods 0.000 description 8
- 230000010355 oscillation Effects 0.000 description 6
- 238000000926 separation method Methods 0.000 description 6
- 238000000691 measurement method Methods 0.000 description 3
- 230000003287 optical effect Effects 0.000 description 2
- 230000000903 blocking effect Effects 0.000 description 1
- 239000000428 dust Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
【発明の属する技術分野】
本発明は、所定エリア内を移動する移動体において、その位置を検出するに際し、平面座標が既知である所定エリア内の複数位置にそれぞれ再帰反射体を設け、前記移動体より回転しながら全周に渡って光線を照射し、前記再帰反射体からの再帰反射光を検出したときの前記光線の回転角度を測定する移動体の測角方法に関するものである。
【0002】
【従来の技術】
従来、移動体の測角方法としては、例えば、特開平11−230746号公報に開示されているように、光線を回転しながら全周に渡って照射する回転ミラーの回転軸に、エンコーダを取付け、このエンコーダのカウント値より回転ミラーの回転角度を計測している。すなわち再帰反射体の角度を計測している。
【0003】
【発明が解決しようとする課題】
しかし、上記エンコーダを使用した測角方法では、
1.エンコーダ自体が高価なこと、
2.回転ミラーとエンコーダをバックラッシュなどの回転誤差無しに結合させる必要があるため、機械部品による光の遮光が避けられないこと、
3.光の遮光を避けるためには、大型の中空エンコーダ(高価で起動トルクが大きい)を使用したり、投光と受光を回転ミラーの上下に分離する必要があること、
4.エンコーダは内部に光学スリットがあり、埃などに弱く、これを改善するためにシールを施すと起動トルクが大きくなること、
などの問題があった。
【0004】
そこで、本発明は、エンコーダを使用しないで、それに伴う機械的制約のない移動体の測角方法およびその装置とこの測角装置を使用した移動体の位置検出設備を提供することを目的としたものである。
【0005】
【課題を解決するための手段】
前述した目的を達成するために、本発明のうち請求項1記載の発明は、所定エリア内に再帰反射体を設け、前記エリア内を移動する移動体に、光線照射手段と、前記光線照射手段から照射された前記光線を上方へ垂直に導くミラー、前記ミラーにより導かれた前記光線を水平方向に反射し前記移動体の外方へ導く反射ミラーおよび前記反射ミラーを回転させるモータを備えた回転照射手段とを設け、前記回転照射手段により前記移動体より回転しながら全周に渡って前記光線を照射し、前記再帰反射体からの再帰反射光を検出したときの前記光線の回転角度を測定する移動体の測角方法であって、
前記再帰反射体に偏光フィルムを貼りつけ、前記光線照射手段より照射する光線を、一方向に偏光された光線から形成し、この光線を前記ミラーにより上方へ垂直に導き、前記ミラーに導かれた光線を前記反射ミラーの回転により偏光方向を変化して、水平に移動体の全周へ照射し、前記再帰反射体からの前記偏光フィルムの偏光面と一致した成分の再帰反射光のピーク強度により、前記回転角度を求めることを特徴とするものである。
【0006】
上記方法によれば、偏光された光線が、偏光フィルムが貼り付けられた再帰反射体へ回転しながら照射され、この照射された光線は、偏光フィルムの偏光面と一致した光線の成分のみが再帰反射体により反射されて戻り、この再帰反射体からの再帰反射光のピーク強度により、回転角度が求められる。
また請求項2に記載の発明は、所定エリア内に再帰反射体を設け、前記エリア内を移動する移動体に、光線照射手段と、前記光線照射手段から照射された前記光線を上方へ垂直に導くミラー、前記ミラーにより導かれた前記光線を水平方向に反射し前記移動体の外方へ導く反射ミラーおよび前記反射ミラーを回転させるモータを備えた回転照射手段とを設け、前記回転照射手段により前記移動体より回転しながら全周に渡って前記光線を照射し、前記再帰反射体からの再帰反射光を検出したときの前記光線の回転角度を測定する移動体の測角方法であって、
前記再帰反射体に偏光フィルムを貼りつけ、前記照射する光線を、偏光面が異なる2本以上の光線から形成し、前記ミラーの上方にハーフミラーを配置し、前記ミラーおよびハーフミラーによりそれぞれ、前記2本以上の光線を上方へ垂直に導き、前記ミラーおよびハーフミラーに導かれた前記2本以上の光線を前記反射ミラーの回転により、偏光方向を変化して、水平に移動体の全周へ照射し、前記再帰反射体からの前記偏光フィルムの偏光面と一致した成分の再帰反射光を前記形成した光線に分離し、前記分離された光線の強度の比により、前記回転角度を求めることを特徴とするものである。
【0007】
上記方法によれば、偏光面が異なる2本以上の光線が、偏光フィルムが貼り付けられた再帰反射体へ回転しながら照射され、この照射された光線は、偏光フィルムの偏光面と一致した光線の成分のみが再帰反射体により反射されて戻り、この再帰反射体からの再帰反射光は前記光線に分離され、分離された光線の強度の比により、回転角度が求められる。
【0008】
また請求項3に記載の発明は、上記請求項2に記載の発明であって、照射する光線を、偏光面が90゜ずれた2本の光線から形成したことを特徴とするものである。
上記方法によれば、偏光面が90゜ずれた第1光線と第2光線は、偏光フィルムが貼り付けられた再帰反射体へ回転しながら照射され、この照射された光線は、偏光フィルムの偏光面と一致した光線の成分のみが再帰反射体により反射されて戻り、この再帰反射体の再帰反射光は前記第1光線と第2光線に分離され、分離された第1光線と第2光線の強度の比により、回転角度が求められる。
【0009】
また請求項4に記載の発明は、上記請求項2に記載の発明であって、照射する光線を、鉛直方向に偏光された第1光線と水平方向に偏光された第2光線から形成したことを特徴とするものである。
この方法によれば、たとえば偏光フィルムの偏光面を垂直とし、第1光線と第2光線が正面(回転角度0゜)より照射されると、第1光線の戻りは100%、第2光線の戻りは0%となり、よって回転角度0゜であることが、再帰反射体の再帰反射光が第1光線と第2光線に分離され、分離された第1光線と第2光線の強度の比により求められる。
【0010】
また請求項5に記載の発明は、上記請求項2〜請求項4のいずれかに記載の発明であって、照射する光線は、それぞれの強度変調の周波数を異なる周波数に設定し、光線を分離可能としたことを特徴とするものである。
上記方法によれば、第1光線と第2光線は強度変調の周波数によって分離され、分離された第1光線と第2光線の強度の比により回転角度が求められ、また外乱との分離も可能となる。
【0011】
また請求項6に記載の発明は、上記請求項2〜請求項4のいずれかに記載の発明であって、照射する光線は、それぞれの波長を異なる波長に設定し、光線を分離可能としたことを特徴とするものである。
上記方法によれば、第1光線と第2光線は波長によって分離され、分離された第1光線と第2光線の強度の比により回転角度が求められ、また外乱との分離も可能となる。
【0012】
また請求項7に記載の発明は、平面座標が既知である所定エリア内の複数位置にそれぞれ再帰反射体を設け、前記エリア内を移動する移動体に、光線照射手段と、前記光線照射手段から照射された前記光線を上方へ垂直に導くミラー、前記ミラーにより導かれた前記光線を水平方向に反射し前記移動体の外方へ導く反射ミラーおよび前記反射ミラーを回転させるモータを備え、前記光線照射手段より照射された光線を回転しながら全周に渡って照射する回転照射手段とを設け、前記再帰反射体からの再帰反射光を検出したときの前記光線の回転角度を測定する移動体の測角装置であって、
前記再帰反射体にそれぞれ、偏光フィルムを貼りつけ、前記光線照射手段を、一方向に偏光された光線を照射する照射手段により構成し、この光線を前記ミラーにより上方へ垂直に導き、前記ミラーに導かれた光線を前記反射ミラーの回転により偏光方向を変化して、水平に移動体の全周へ照射し、前記移動体に、前記再帰反射体からの前記偏光フィルムの偏光面と一致した成分の再帰反射光のピーク強度により、前記回転照射手段の回転角度を計測する演算手段を備えたことを特徴とするものである。
【0013】
上記構成によれば、偏光された光線は、偏光フィルムが貼り付けられた再帰反射体へ回転しながら照射され、この照射された光線は、偏光フィルムの偏光面と一致した光線の成分のみが再帰反射体により反射されて戻り、この再帰反射体の再帰反射光のピーク強度により、回転角度が求められる。
また請求項8に記載の発明は、平面座標が既知である所定エリア内の複数位置にそれぞれ再帰反射体を設け、前記エリア内を移動する移動体に、光線照射手段と、前記光線照射手段から照射された前記光線を上方へ垂直に導くミラー、前記ミラーにより導かれた前記光線を水平方向に反射し前記移動体の外方へ導く反射ミラーおよび前記反射ミラーを回転させるモータを備え、前記光線照射手段より照射された光線を回転しながら全周に渡って照射する回転照射手段とを設け、前記再帰反射体からの再帰反射光を検出したときの前記光線の回転角度を測定する移動体の測角装置であって、
前記再帰反射体にそれぞれ、偏光フィルムを貼りつけ、前記光線照射手段を、偏光された第1光線を照射する第1光線照射手段と、第1光線と偏光面が異なる第2光線を照射する第2光線照射手段とから構成し、前記回転照射手段に、前記ミラーの上方に配置され、前記第2光線照射手段から照射された第2光線を上方へ垂直に導くハーフミラーを備え、前記ミラーおよびハーフミラーに導かれた前記第1光線および第2光線を前記反射ミラーの回転により、偏光方向を変化して、水平に移動体の全周に渡って照射し、前記移動体に、前記再帰反射体からの前記偏光フィルムの偏光面と一致した成分の再帰反射光を前記第1光線と第2光線に分離する分離手段と、前記分離手段により分離された第1光線と第2光線の強度の比により、前記回転照射手段の回転角度を計測する演算手段を備えたことを特徴とするものである。
【0014】
上記構成によれば、偏光面が異なる第1光線と第2光線は、偏光フィルムが貼り付けられた再帰反射体へ回転しながら照射され、この照射された光線は、偏光フィルムの偏光面と一致した光線の成分のみが再帰反射体により反射されて戻り、この再帰反射体の再帰反射光は前記第1光線と第2光線に分離され、分離された第1光線と第2光線の強度の比により、回転角度が求められる。
【0015】
また請求項9に記載の発明は、上記請求項8に記載の発明であって、第1光線照射手段と第2光線照射手段のそれぞれの強度変調の周波数を、異なる周波数に設定し、分離手段を、バンドパスフィルタで構成したことを特徴とするものである。
上記構成によれば、再帰反射光はバンドパスフィルタにより第1光線と第2光線の異なる強度変調の周波数によって第1光線と第2光線に分離され、また外乱との分離も可能となる。
【0016】
また請求項10に記載の発明は、上記請求項8に記載の発明であって、第1光線照射手段と第2光線照射手段のそれぞれの波長を、異なる波長に設定し、分離手段を、プリズムまたは回折格子により構成したことを特徴とするものである。上記構成によれば、再帰反射光はプリズムまたは回折格子により第1光線と第2光線の異なる波長によって光学的に第1光線と第2光線に分離され、また外乱との分離も可能となる。
【0017】
さらに請求項11に記載の発明は、上記請求項7〜請求項10のいずれかに記載の移動体の測角装置を備え、計測した回転角度および再帰反射体の平面座標データにより現在位置の平面座標を計測する測定手段を備えたことを特徴とするものである。
上記構成によれば、測角装置により計測された回転角度および再帰反射体の平面座標データにより現在位置の平面座標が計測される。
【0018】
【発明の実施の形態】
以下、本発明の実施の形態を図面に基づいて説明する。
[実施の形態1]
図1は本発明の実施の形態1における移動体の測角方法を使用する移動体の位置検出設備を設けたエリアの平面図である。
【0019】
図1において、1は移動体(たとえば、フォークリフトや無人搬送車など)2が移動するエリア(たとえば、倉庫や工場や港湾など)であり、このエリア1には平面座標データが既知の複数位置(図1ではエリア1の中心から45゜毎に8箇所)に、所定方向、たとえば鉛直方向の偏光フィルムが貼られた再帰反射体(再帰型の反射体)3が設けられている。再帰反射体3は、たとえばコーナキューブ(コーナレフレクター)や再帰反射シートから形成されている。なお、全ての再帰反射体3における偏光フィルムの偏光の方向は同一としている。
【0020】
また移動体2は、回転しながら全周に渡って水平にレーザ光線を照射し、少なくとも3カ所(A点、B点、C点)の再帰反射体3から再帰した光(再帰反射光)を検出したときの水平回転光線(レーザ光線)の照射回転角度θを検出して記憶し、これら記憶した回転角度θ1,θ2,θ3、および既知の再帰反射体3の平面座標データ(X1,Y1)、(X2,Y2)、(X3,Y3)により、移動体2(水平回転光線照射位置)の平面座標(Xm,Ym)を計測している。この計測方法は公知である(たとえば、「システムと制御」第29巻第8号(1985)p.553 〜560 参照)。
【0021】
本発明は、上記水平回転光線(レーザ光線)の照射回転角度θをエンコーダを使用しないで計測することを要部としている。
上記移動体2の構成を図2を参照しながら説明する。
一方向へ偏光された光線(レーザ光線)を発生する光線発生手段と、この光線を回転しながら全周に渡って水平に照射する水平回転光線照射手段(以下、回転照射手段と略す)と、前記回転照射手段より照射され再帰反射体3から再帰した光(偏光フィルムの偏光面と一致した光線の成分のみが再帰反射体3により反射されて戻る:再帰反射光)を検出する受光手段と、前記受光手段により検出された再帰反射体3の再帰反射光から前記光線を分離する分離手段と、前記分離手段により分離された光線のピーク強度により、前記回転照射手段の回転角度θを計測する演算手段と、前記演算手段により計測された回転角度θを記憶し、3箇所の記憶した回転角度θ1,θ2,θ3、および既知の再帰反射体3の平面座標データ(X1,Y1)、(X2,Y2)、(X3,Y3)により、移動体2(回転照射手段の水平照射位置)の平面座標(Xm,Ym)を計測する位置計測手段により構成されている。
【0022】
上記光線発生手段は、一方向として、たとえば鉛直方向に偏光されたレーザ光線aを包絡線の周波数(強度変調の周波数)f1(図3参照)で照射する半導体レーザ装置11から構成されている。
また上記回転照射手段は、半導体レーザ装置11から水平に照射された第1レーザ光線aを上方へ垂直に導くミラー31と、レーザ光線aと再帰反射体3からの再帰反射光の通路となる垂直な筒状の導管33と、この導管33が中心下方に接続され、リング状の軸受34上に載置された筒体35と、この筒体35内に配置された、導管33から導かれたレーザ光線aを水平方向に反射させ、筒体35の側面に設けた窓部35Aへ導き、また再帰反射体3からの再帰反射光を導管33へ導く反射ミラー36と、前記導管33を中心に嵌合して導管33を回転する第1プーリ37と、DCモータ38と、DCモータ38の回転軸に連結された第2プーリ39と、第2プーリ39の駆動力を第1プーリ37へ伝達するベルト40から構成されている。
【0023】
この構成により、半導体レーザ装置11から水平に照射されたレーザ光線aはミラー31により上方へ導かれる。DCモータ38が駆動されると、DCモータ38の回転力は第2プーリ39、ベルト40、第1プーリ37を介して導管33へ伝達され、導管33が回転し、よって筒体35とともに反射ミラー36が回転し、導管33内に導かれたレーザ光線aは、反射ミラー36の回転により、導管33(筒体35)の中心位置を中心として移動体2の全周に水平に照射される。
【0024】
また上記受光手段は、ミラー31(図2参照)より上方に配置され、反射ミラー36および導管33を介して導かれた再帰反射体3の再帰反射光を水平に導く孔空きミラー41(孔はレーザ光線aが通過する)と、このミラー41により導かれた再帰反射光を集光する凸レンズ42と、この凸レンズ42により集光された再帰反射光が入射する受光センサ(受光素子)43と、この受光センサ43の光電流信号を増幅するアンプ44から構成されている。
【0025】
上記構成により、導管33の回転によって反射ミラー36が回転し、反射ミラー36を介して導かれた再帰反射体3からの再帰反射光は、導管33と孔空きミラー41と凸レンズ42を介して受光センサ43へ入射され、この受光センサ43の光電流信号はアンプ44により増幅され、再帰反射体3の再帰反射光が検出され、受光信号が出力される。
【0026】
上記分離手段は、受光信号からレーザ光線aの信号のみをその変調周波数f1により取り出すフィルタ(バンドパスフィルタ)51とから構成されている。
上記構成により、再帰反射体3からの再帰反射光の受光信号は、レーザ光線aの受光信号と外乱の光線の受光信号に分離され、レーザ光線aの受光信号のみが取り出される。よって外乱の影響が排除される。
【0027】
上記演算手段は、フィルタ51の出力信号をディジタル信号に変換するA/D変換器61と、コンピュータからなり、A/D変換器61より入力したフィルタ51の出力信号、すなわちレーザ光線aの受光信号のピーク強度から、再帰反射体3の再帰反射光を検出したときの回転ミラー36の回転角度、すなわち再帰反射体3の検出角度を演算する回転角度演算部63から構成されている。
【0028】
回転角度演算部63による演算式(1)を下記に示す。この式(1)において、Iはレーザ光線aのピーク受光強度、gはハーフミラー31へ入射後受光までの減衰係数、θは再帰反射体3の検出角度である。
I=g・cosθ
∴θ=acos(I/g) ・・・(1)
上記構成により、レーザ光線の受光信号のピーク強度により、再帰反射体3の再帰反射光を検出したときの回転ミラー36の回転角度θ、すなわち再帰反射体3の検出角度θが計測される。
【0029】
なお、この式(1)を満足する角度θとして180゜異なる2値が得られるが、位置検出設備として使用し、前回の計測角度は得られているので、2値のいずれかは判断することができる。
上記位置計測手段は、コンピュータからなり、回転角度演算部63により演算された回転角度θを記憶し、3箇所の記憶した回転角度θ1,θ2,θ3、および既知の再帰反射体3の平面座標データ(X1,Y1)、(X2,Y2)、(X3,Y3)により、回転ミラー(水平回転光線照射位置)36の平面座標、すなわち移動体2の平面座標(Xm,Ym)を計測する位置計測部71により構成されている。
【0030】
この構成により、移動体2の平面座標(Xm,Ym)が計測される。
上記設備の構成によれば、平面座標が既知のエリア1の複数位置に、偏光フィルムが貼り付けられた再帰反射体3を設け、移動体2より回転しながら全周に渡って水平に、一方向に偏光され、かつ強度変調されたレーザ光線aを照射し、偏光フィルムの偏光面と一致した再帰反射体3からの再帰反射光の受光信号を、変調周波数によりレーザ光線aのみを外乱の受光信号と分離して取り出し、レーザ光線aのピーク強度を求めて、回転ミラー36の回転角度、すなわち再帰反射体3の検出角度θを計測し、3箇所の記憶した回転角度θ1,θ2,θ3、および既知の再帰反射体3の平面座標データ(X1,Y1)、(X2,Y2)、(X3,Y3)により、回転ミラー(水平回転光線照射位置)36、すなわち移動体2の平面座標(Xm,Ym)を計測する。
【0031】
このように、従来のようなエンコーダを使用せずに、回転ミラー36の回転角度θを計測することができ、この回転角度、すなわち再帰反射体3の検出角度θにより移動体2の平面座標(Xm,Ym)を計測することができる。
またエンコーダを不要となることにより、安価に構成でき、また機械的構成が簡素となり、よって受光特性を改善でき、外乱光線を除去でき、またエンコーダの精密なスリットが不要となるので、耐環境性を向上させることができる。
【0032】
なお、実施の形態1では、再帰反射体3としてコーナキューブを使用することが望ましい。
[実施の形態2]
図4は本発明の実施の形態2における移動体の位置検出装置の構成図である。
上記実施の形態1(図2)の移動体の位置検出装置では、光線発生手段を、鉛直方向に偏光されたレーザ光線aを強度変調の周波数f1で照射する半導体レーザ装置11のみで構成しているが、実施の形態2では、偏光面が異なる2本の光線を発生する構成としている。すなわち、鉛直方向に偏光された第1レーザ光線aを包絡線の周波数(強度変調の周波数)f1(図5参照)で照射する第1半導体レーザ装置11と、水平方向に偏光された第2レーザ光線bを包絡線の周波数(強度変調の周波数)f2(図5参照)で照射する第2半導体レーザ装置12から構成している。なお、両半導体レーザ装置11,12の発振周波数とレーザ光線a,bの最大振幅は同一である(これに限られるものではない)。
【0033】
また前記第2半導体レーザ装置12から水平に照射された第2レーザ光線bを垂直に導くために、ミラー31の上方に配置され、第2半導体レーザ装置12から水平に照射された第2レーザ光線bを第1レーザ光線aと同軸で上方へ垂直に導くハーフミラー32を設けている。
また分離手段して、前記第1フィルタ(バンドパスフィルタ)51に加えて、受光信号から第2レーザ光線bの信号のみをその変調周波数f2により取り出す第2フィルタ(バンドパスフィルタ)52を設けている。
【0034】
上記構成により、再帰反射体3からの再帰反射光の受光信号は、第1レーザ光線aの受光信号と第2レーザ光線bの受光信号に分離され、また外乱が分離され、よって外乱の影響が排除される。
また演算手段として、第1フィルタ51の出力信号をディジタル信号に変換する第1A/D変換器61に加えて、第2フィルタ52の出力信号をディジタル信号に変換する第2A/D変換器62を設けており、回転角度演算部63を、第1A/D変換器61より入力した第1フィルタ51の出力信号、すなわち第1レーザ光線aの受光信号のピーク強度と、第2A/D変換器62より入力した第2フィルタ52の出力信号、すなわち第2レーザ光線bの受光信号のピーク強度の比から、再帰反射体3の再帰反射光を検出したときの回転ミラー36の回転角度、すなわち再帰反射体3の検出角度を演算する構成としている。
【0035】
回転角度演算部63による演算式(2)を下記に示す。この式(2)において、I1は第1レーザ光線aのピーク受光強度、I2は第2レーザ光線bのピーク受光強度、gはハーフミラー32へ入射後受光までの減衰係数、θは再帰反射体3の検出角度である。
また第1半導体レーザ装置11とハーフミラー32間と、第2半導体レーザ装置12とハーフミラー32間の光路は異なるので、減衰係数gを式(3)に示す補正定数kをかけることにより補正する。なお、ミラー31の反射率k2、第1半導体レーザ装置11と第2半導体レーザ装置12の発光強度比k1は一定値である。この補正定数kは、実験的に測定して求めることもできる。
【0036】
I1=g・k・cosθ
I2=g・sinθ
∴θ=atan(k・I2/I1) ・・・(2)
k=k1・k2 ・・・(3)
上記構成により、分離手段により分離された第1レーザ光線aと第2レーザ光線bの受光信号のピーク強度の比により、再帰反射体3の再帰反射光を検出したときの回転ミラー36の回転角度θ、すなわち再帰反射体3の検出角度θが計測される。
【0037】
なお、この式(1)を満足する角度θとして180゜異なる2値が得られるが、位置検出設備として使用し、前回の計測角度は得られているので、2値のいずれかは判断することができる。また45゜、135゜、225゜、315゜では、4値が得られるが同様の方法で1値に限定できる。
上記回転角度演算部63により演算された回転角度θは位置計測部71に記憶され、3箇所の記憶した回転角度θ1,θ2,θ3、および既知の再帰反射体3の平面座標データ(X1,Y1)、(X2,Y2)、(X3,Y3)により、回転ミラー(水平回転光線照射位置)36の平面座標、すなわち移動体2の平面座標(Xm,Ym)が計測される。
【0038】
上記設備の構成によれば、平面座標が既知のエリア1の複数位置に、偏光フィルムが貼り付けられた再帰反射体3を設け、移動体2より回転しながら全周に渡って水平に、偏光面が90゜ずれ、かつ強度の変調周波数が異なる第1レーザ光線aおよび第2レーザ光線bを照射し、偏光フィルムの偏光面と一致した再帰反射体3からの再帰反射光の受光信号を、変調周波数により第1レーザ光線aの受光信号と第2レーザ光線bの受光信号に分離し、これら第1レーザ光線aの受光信号と第2レーザ光線bの受光信号の強度の比を求めて、回転ミラー36の回転角度、すなわち再帰反射体3の検出角度θを計測し、3箇所の記憶した回転角度θ1,θ2,θ3、および既知の再帰反射体3の平面座標データ(X1,Y1)、(X2,Y2)、(X3,Y3)により、回転ミラー(水平回転光線照射位置)36、すなわち移動体2の平面座標(Xm,Ym)を計測する。
【0039】
このように、従来のようなエンコーダを使用せずに、回転ミラー36の回転角度θを計測することができ、この回転角度、すなわち再帰反射体3の検出角度θにより移動体2の平面座標(Xm,Ym)を計測することができる。
またエンコーダを不要となることにより、安価に構成でき、また機械的構成が簡素となり、よって受光特性を改善でき、外乱光線を除去でき、またエンコーダの精密なスリットが不要となるので、耐環境性を向上させることができる。
【0040】
また実施の形態1の場合と比較して、レーザ発振強度と使用雰囲気の光の減衰率が同じの場合、広い範囲に使用することができる。
[実施の形態3]
図6は本発明の実施の形態3における移動体の位置検出装置の構成図である。上記実施の形態2(図4)の移動体の位置検出装置では、光線発生手段を、鉛直方向に偏光された第1レーザ光線aを強度変調の周波数f1で照射する第1半導体レーザ装置11と水平方向に偏光された第2レーザ光線bを強度変調の周波数f2で照射する第2半導体レーザ装置12から構成し、第1レーザ光線aと第2レーザ光線bの分離を強度変調の周波数により電気的に行っているが、実施の形態3では、第1半導体レーザ装置と第2半導体レーザ装置の発振周波数を変え、光学的に第1レーザ光線a’と第2レーザ光線b’の分離を行っている。
【0041】
すなわち、光線発生手段を、鉛直方向に偏光された第1レーザ光線a’を第1発振周波数f3(図7参照)で照射する第1半導体レーザ装置21と、水平方向に偏光された第2レーザ光線b’を第2発振周波数f4(図7参照)で照射する第2半導体レーザ装置22から構成している。なお、第1レーザ光線a’と第2レーザ光線b’の振幅は同一としている。
【0042】
また受光手段を、上記孔空きミラー41と、ミラー41により導かれた再帰反射光において、異なる波長の光の方向を変える、すなわち第1レーザ光線a’の再帰反射光と第2レーザ光線b’の再帰反射光に分離するプリズム(回折格子でもよい)45と、このプリズム45により分離された第1レーザ光線a’の再帰反射光と第2レーザ光線b’の再帰反射光を集光する凸レンズ42と、この凸レンズ42により集光された第1レーザ光線a’の再帰反射光が入射する第1受光センサ(受光素子)43Aと、第2レーザ光線b’の再帰反射光が入射する第2受光センサ(受光素子)43Bと、第1受光センサ(受光素子)43Aの光電流信号を増幅する第1アンプ44Aと、第2受光センサ43Bの光電流信号を増幅する第2アンプ44Bから構成している。
【0043】
この受光手段の構成により、再帰反射体3からの再帰反射光はプリズム45によりその波長によって第1レーザ光線a’の再帰反射光と第2レーザ光線b’の再帰反射光に分離され、また外乱が分離され(外乱の影響が排除され)、それぞれ受光センサ43A,43Bへ入射され、これら受光センサ43A,43Bの光電流信号はアンプ44A,44Bにより増幅され、受光信号として出力される。
【0044】
よって、実施の形態2と同様に、第1レーザ光線a’の再帰反射光と第2レーザ光線b’の再帰反射光の受光強度により、回転ミラー36の回転角度θを得ることができる。
このように、実施の形態3においても、従来のようなエンコーダを使用せずに、回転ミラー36の回転角度θを計測することができ、この回転角度、すなわち再帰反射体3の検出角度θにより移動体2の平面座標(Xm,Ym)を計測することができる。
【0045】
またエンコーダを不要となることにより、安価に構成でき、また機械的構成が簡素となり、よって受光特性を改善でき、外乱光線を除去でき、またエンコーダの精密なスリットが不要となるので、耐環境性を向上させることができる。
なお、上記実施の形態2,3においては、第1半導体レーザ装置11または21と、第2半導体レーザ装置12または22により、鉛直方向と水平方向に偏光されたレーザ光線を照射しているが、偏光面はずれていればよく、鉛直方向と水平方向に限定されるものではない。なお、偏光面は90゜ずれていることが好ましい。
【0046】
また上記実施の形態2,3においては、2本の偏光された光線を照射しているが、2本に限定されることはく、さらに偏光面の角度が他の2本とは異なる第3レーザ光線を照射すれば、式(2)で求められた回転角度θの2値あるいは4値の内、第3レーザ光線の受光強度をI3とすると、
I3=g・k’・cosθ
から、たとえばI1とI2,I2とI3で求められたθのうち共通である角度に絞り込むことができる。またI1とI2,I2とI3で求め特定したθの平均を回転角度としてもよい。このように、測角装置、測角方法(つまりセンサのみ)だけでθを特定することができる。なお、k’は上記kの考え方と同じである。
【0047】
また、たとえばI1とI2の偏光面のずれが90゜である場合、I3の偏光面とI1とI2それぞれの偏光面のずれは45゜付近とさせることが望ましい。
このとき、第3半導体レーザ装置により、第1半導体レーザ装置11または21と第2半導体レーザ装置12または22と異なる強度変調周波数あるいは発振周波数により第3レーザ光線を照射し、再帰反射体3からの再帰反射光から第3レーザ光線を分離し、その強度I3を得ることにより実現できる。
【0048】
なお、レーザ光線が4本以上の場合も同様である。
【0049】
【発明の効果】
以上述べたように本発明によれば、従来のようなエンコーダを使用せずに、再帰反射光を検出したときの回転角度を計測することができる。またエンコーダが不要となることにより、安価に構成でき、また機械的構成が簡素となり、よって受光特性を改善でき、外乱光線を除去でき、またエンコーダの精密なスリットが不要となるので、耐環境性を向上させることができる。
【図面の簡単な説明】
【図1】本発明の実施の形態1における移動体の測角方法を使用する移動体の位置検出設備を備えたエリアの平面図である。
【図2】同移動体の位置検出設備の構成図である。
【図3】同移動体の位置検出設備において照射されるレーザ光線の特性図である。
【図4】本発明の実施の形態2における移動体の位置検出設備の構成図である。
【図5】同移動体の位置検出設備において照射されるレーザ光線の特性図である。
【図6】本発明の実施の形態3における移動体の測角方法を使用する移動体の位置検出設備の構成図である。
【図7】同移動体の位置検出設備において照射されるレーザ光線の特性図である。
【符号の説明】
1 エリア
2 移動体
3 再帰反射体
11,12,21,22 半導体レーザ装置
31 ミラー
32 ハーフミラー
33 導管
34 軸受
35 筒体
35A 窓部
36 反射ミラー
37,39 プーリ
38 DCモータ
40 ベルト
41 孔空きミラー
42 凸レンズ
43,43A,43B 受光センサ
44,44A,44B アンプ
45 プリズム
51,52 バンドパスフィルタ
61,62 A/D変換器
63 回転角度演算部
71 位置計測部
a,a’ 第1レーザ光線
b,b’ 第2レーザ光線
Claims (11)
- 所定エリア内に再帰反射体を設け、前記エリア内を移動する移動体に、光線照射手段と、前記光線照射手段から照射された前記光線を上方へ垂直に導くミラー、前記ミラーにより導かれた前記光線を水平方向に反射し前記移動体の外方へ導く反射ミラーおよび前記反射ミラーを回転させるモータを備えた回転照射手段とを設け、
前記回転照射手段により前記移動体より回転しながら全周に渡って前記光線を照射し、前記再帰反射体からの再帰反射光を検出したときの前記光線の回転角度を測定する移動体の測角方法であって、
前記再帰反射体に偏光フィルムを貼りつけ、
前記光線照射手段より照射する光線を、一方向に偏光された光線から形成し、この光線を前記ミラーにより上方へ垂直に導き、前記ミラーに導かれた光線を前記反射ミラーの回転により偏光方向を変化して、水平に移動体の全周へ照射し、
前記再帰反射体からの前記偏光フィルムの偏光面と一致した成分の再帰反射光のピーク強度により、前記回転角度を求めること
を特徴とする移動体の測角方法。 - 所定エリア内に再帰反射体を設け、前記エリア内を移動する移動体に、光線照射手段と、前記光線照射手段から照射された前記光線を上方へ垂直に導くミラー、前記ミラーにより導かれた前記光線を水平方向に反射し前記移動体の外方へ導く反射ミラーおよび前記反射ミラーを回転させるモータを備えた回転照射手段とを設け、
前記回転照射手段により前記移動体より回転しながら全周に渡って前記光線を照射し、前記再帰反射体からの再帰反射光を検出したときの前記光線の回転角度を測定する移動体の測角方法であって、
前記再帰反射体に偏光フィルムを貼りつけ、
前記照射する光線を、偏光面が異なる2本以上の光線から形成し、
前記ミラーの上方にハーフミラーを配置し、
前記ミラーおよびハーフミラーによりそれぞれ、前記2本以上の光線を上方へ垂直に導き、前記ミラーおよびハーフミラーに導かれた前記2本以上の光線を前記反射ミラーの回転により、偏光方向を変化して、水平に移動体の全周へ照射し、
前記再帰反射体からの前記偏光フィルムの偏光面と一致した成分の再帰反射光を前記形成した光線に分離し、
前記分離された光線の強度の比により、前記回転角度を求めること
を特徴とする移動体の測角方法。 - 照射する光線を、偏光面が90゜ずれた2本の光線から形成したこと
を特徴とする請求項2記載の移動体の測角方法。 - 照射する光線を、鉛直方向に偏光された第1光線と水平方向に偏光された第2光線から形成したこと
を特徴とする請求項2に記載の移動体の測角方法。 - 照射する光線は、それぞれの強度変調の周波数を異なる周波数に設定し、光線を分離可能としたこと
を特徴とする請求項2〜請求項4のいずれかに記載の移動体の測角方法。 - 照射する光線は、それぞれの波長を異なる波長に設定し、光線を分離可能としたこと
を特徴とする請求項2〜請求項4のいずれかに記載の移動体の測角方法。 - 平面座標が既知である所定エリア内の複数位置にそれぞれ再帰反射体を設け、前記エリア内を移動する移動体に、光線照射手段と、前記光線照射手段から照射された前記光線を上方へ垂直に導くミラー、前記ミラーにより導かれた前記光線を水平方向に反射し前記移動体の外方へ導く反射ミラーおよび前記反射ミラーを回転させるモータを備え、前記光線照射手段より照射された光線を回転しながら全周に渡って照射する回転照射手段とを設け、
前記再帰反射体からの再帰反射光を検出したときの前記光線の回転角度を測定する移動体の測角装置であって、
前記再帰反射体にそれぞれ、偏光フィルムを貼りつけ、
前記光線照射手段を、一方向に偏光された光線を照射する照射手段により構成し、この光線を前記ミラーにより上方へ垂直に導き、前記ミラーに導かれた光線を前記反射ミラーの回転により偏光方向を変化して、水平に移動体の全周へ照射し、
前記移動体に、
前記再帰反射体からの前記偏光フィルムの偏光面と一致した成分の再帰反射光のピーク強度により、前記回転照射手段の回転角度を計測する演算手段
を備えたこと
を特徴とする移動体の測角装置。 - 平面座標が既知である所定エリア内の複数位置にそれぞれ再帰反射体を設け、前記エリア内を移動する移動体に、光線照射手段と、前記光線照射手段から照射された前記光線を上方へ垂直に導くミラー、前記ミラーにより導かれた前記光線を水平方向に反射し前記移動体の外方へ導く反射ミラーおよび前記反射ミラーを回転させるモータを備え、前記光線照射手段より照射された光線を回転しながら全周に渡って照射する回転照射手段とを設け、
前記再帰反射体からの再帰反射光を検出したときの前記光線の回転角度を測定する移動体の測角装置であって、
前記再帰反射体にそれぞれ、偏光フィルムを貼りつけ、
前記光線照射手段を、
偏光された第1光線を照射する第1光線照射手段と、
第1光線と偏光面が異なる第2光線を照射する第2光線照射手段と
から構成し、
前記回転照射手段に、前記ミラーの上方に配置され、前記第2光線照射手段から照射された第2光線を上方へ垂直に導くハーフミラーを備え、前記ミラーおよびハーフミラーに導かれた前記第1光線および第2光線を前記反射ミラーの回転により、偏光方向を変化して、水平に移動体の全周に渡って照射し、
前記移動体に、
前記再帰反射体からの前記偏光フィルムの偏光面と一致した成分の再帰反射光を前記第1光線と第2光線に分離する分離手段と、
前記分離手段により分離された第1光線と第2光線の強度の比により、前記回転照射手段の回転角度を計測する演算手段
を備えたこと
を特徴とする移動体の測角装置。 - 第1光線照射手段と第2光線照射手段のそれぞれの強度変調の周波数を、異なる周波数に設定し、
分離手段を、バンドパスフィルタで構成したこと
を特徴とする請求項8に記載の移動体の測角装置。 - 第1光線照射手段と第2光線照射手段のそれぞれの波長を、異なる波長に設定し、
分離手段を、プリズムまたは回折格子により構成したこと
を特徴とする請求項8に記載の移動体の測角装置。 - 請求項7〜請求項10のいずれかに記載の移動体の測角装置を備え、
計測した回転角度および再帰反射体の平面座標データにより現在位置の平面座標を計測する測定手段を備えたこと
を特徴とする移動体の位置検出設備。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP34698899A JP4187372B2 (ja) | 1999-12-07 | 1999-12-07 | 移動体の測角方法およびその装置とこの測角装置を使用した移動体の位置検出設備 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP34698899A JP4187372B2 (ja) | 1999-12-07 | 1999-12-07 | 移動体の測角方法およびその装置とこの測角装置を使用した移動体の位置検出設備 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2001165658A JP2001165658A (ja) | 2001-06-22 |
JP4187372B2 true JP4187372B2 (ja) | 2008-11-26 |
Family
ID=18387177
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP34698899A Expired - Fee Related JP4187372B2 (ja) | 1999-12-07 | 1999-12-07 | 移動体の測角方法およびその装置とこの測角装置を使用した移動体の位置検出設備 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4187372B2 (ja) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5850225B2 (ja) * | 2011-09-07 | 2016-02-03 | 株式会社Ihi | マーカ検出方法および装置 |
WO2019230890A1 (ja) * | 2018-05-30 | 2019-12-05 | 富士フイルム株式会社 | 信号検出システム |
-
1999
- 1999-12-07 JP JP34698899A patent/JP4187372B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2001165658A (ja) | 2001-06-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20190123508A1 (en) | Lidar sensor system with small form factor | |
JPH0464567B2 (ja) | ||
CN101031817A (zh) | 测量移动后向反射器的绝对测距仪 | |
JP2002168625A (ja) | 振れ検出装置、振れ検出装置付き回転レーザ装置及び振れ検出補正装置付き位置測定設定システム | |
JP2012127946A (ja) | 光学式位置測定装置 | |
US3877816A (en) | Remote-angle-of-rotation measurement device using light modulation and electro-optical sensors | |
US4486095A (en) | Movement measuring apparatus and landmarks for use therewith | |
JPS6312521B2 (ja) | ||
US4484069A (en) | Apparatus and method for sensing distance | |
JP4187372B2 (ja) | 移動体の測角方法およびその装置とこの測角装置を使用した移動体の位置検出設備 | |
US4171160A (en) | Distance measuring instrument | |
US5073711A (en) | Fiber-optic remote angular position sensor including a polarization track | |
US4998798A (en) | Encoder having long length measuring stroke | |
RU2540451C1 (ru) | Система лазерной локации | |
JP2874795B2 (ja) | オリエンテーションフラット検出装置 | |
JPH01426A (ja) | 大気中を通過するパルス状光ビームの光路を決定する装置 | |
US5170224A (en) | Laser wavelength measuring device | |
JPH0462004B2 (ja) | ||
JPH0462003B2 (ja) | ||
JPS59224516A (ja) | 光学式エンコ−ダ | |
US4458147A (en) | Apparatus for evaluating optical signals | |
JPH0520195B2 (ja) | ||
CN115932313A (zh) | 一种噪声自校正激光多普勒测速***及方法 | |
JPS5850899A (ja) | マイクロホン装置 | |
JPS6165165A (ja) | 回転情報検出計 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20050720 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20070402 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070911 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20071204 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20080107 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20080205 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20080407 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20080513 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20080714 |
|
A911 | Transfer to examiner for re-examination before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20080722 |
|
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: 20080812 |
|
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: 20080909 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110919 Year of fee payment: 3 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313117 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120919 Year of fee payment: 4 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120919 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130919 Year of fee payment: 5 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees | ||
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313111 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
R360 | Written notification for declining of transfer of rights |
Free format text: JAPANESE INTERMEDIATE CODE: R360 |
|
R360 | Written notification for declining of transfer of rights |
Free format text: JAPANESE INTERMEDIATE CODE: R360 |
|
R371 | Transfer withdrawn |
Free format text: JAPANESE INTERMEDIATE CODE: R371 |