JPS59104503A - 移動体の位置検出方法 - Google Patents
移動体の位置検出方法Info
- Publication number
- JPS59104503A JPS59104503A JP21414782A JP21414782A JPS59104503A JP S59104503 A JPS59104503 A JP S59104503A JP 21414782 A JP21414782 A JP 21414782A JP 21414782 A JP21414782 A JP 21414782A JP S59104503 A JPS59104503 A JP S59104503A
- Authority
- JP
- Japan
- Prior art keywords
- laser light
- light source
- moving object
- corner cube
- laser
- 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.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/42—Simultaneous measurement of distance and other co-ordinates
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
本発明は車輌、船舶、航空機といった移動体の位置を検
出する方法に関し、特にレーザー光線を利用した移動体
の位置検出方法に関する。
出する方法に関し、特にレーザー光線を利用した移動体
の位置検出方法に関する。
従来に於ける移動体の位置検出方法としては電波を利用
したものが何種類か実用化されているが、これら電波を
利用した方法はいずれも装置が大損りKなり、どのよう
な場所でも容易に実地することが出来ないという欠点が
あった。
したものが何種類か実用化されているが、これら電波を
利用した方法はいずれも装置が大損りKなり、どのよう
な場所でも容易に実地することが出来ないという欠点が
あった。
丈た、レーザーを利用した位置測定装置も実用化されて
いるが、これら測定装置はほぼ静止している定点の位置
を測定するものであって、移動体の瞬時の位置を次々と
測定するさいうものではなかつ庭。
いるが、これら測定装置はほぼ静止している定点の位置
を測定するものであって、移動体の瞬時の位置を次々と
測定するさいうものではなかつ庭。
そこで、移動体上に順次異なる方位に向けてレーザー光
線を発射するレーザー光源を搭載し、所定位置に設けら
れた3個のコーナーキューブプリズムで反射されて戻っ
て(る反射光の受光角を測定し、三角測量の原理に基い
て、前記移動体の位置を測定するシステムが考えられて
い゛る。
線を発射するレーザー光源を搭載し、所定位置に設けら
れた3個のコーナーキューブプリズムで反射されて戻っ
て(る反射光の受光角を測定し、三角測量の原理に基い
て、前記移動体の位置を測定するシステムが考えられて
い゛る。
このシステムでは、ひとつのレーザー光源と簡単な構造
の3個のコーナーキューブプリズムとで移動体の位置が
簡単に測定可能ではあるが、移動体上にレーザー光源を
設けているために、確実かつ精度良い位置測定が極めて
困難である。
の3個のコーナーキューブプリズムとで移動体の位置が
簡単に測定可能ではあるが、移動体上にレーザー光源を
設けているために、確実かつ精度良い位置測定が極めて
困難である。
即ち、3個のコーナーキューブプリズムからの反射光の
受光角を測定している間に測定点としての移動体が移動
してしまうために精度良い位置測定が行なえないという
不都合が有るとともに、移動体の傾斜や振切に起因して
、レーザー光線をコーナーキューブプリズムに当てるこ
とができないことがあって、確実な位置測定を行なえな
い々いう不都合があった。
受光角を測定している間に測定点としての移動体が移動
してしまうために精度良い位置測定が行なえないという
不都合が有るとともに、移動体の傾斜や振切に起因して
、レーザー光線をコーナーキューブプリズムに当てるこ
とができないことがあって、確実な位置測定を行なえな
い々いう不都合があった。
本発明(は、上記実情に鑑みてなされたものであって、
その目的は、上記移動体の位置検出を確実かつ正確に行
なうことが可能な移動体の位置検出方法を提供すること
にある。
その目的は、上記移動体の位置検出を確実かつ正確に行
なうことが可能な移動体の位置検出方法を提供すること
にある。
上記目的を達成すべく、本発明による移動体の位置検出
方法は、前記レーザー光源から発射されるレーザー光線
の水平方向のスキャン速度を1回目は低速回転で、2回
目は高速回転で行なうシーケンスを繰返し行なうととも
に、前記1回目の低速回転時はレーザー光線の上下方向
のスキャン角を大きく、2回目の高速回転時は@肥土下
方向のスキャン角を小さく行なう、ことを特徴とする。
方法は、前記レーザー光源から発射されるレーザー光線
の水平方向のスキャン速度を1回目は低速回転で、2回
目は高速回転で行なうシーケンスを繰返し行なうととも
に、前記1回目の低速回転時はレーザー光線の上下方向
のスキャン角を大きく、2回目の高速回転時は@肥土下
方向のスキャン角を小さく行なう、ことを特徴とする。
上記特徴構成数に、下記の如き優れた効果が発揮される
に至った。
に至った。
即ち、異なる方向に順次レーザー光線を発射する海に、
1回目は大きく上下方向にレーザー光線をスキャンしな
がら、かつ、低速で水平方向にスキャンすることによっ
て、コーナーキューブプリズムで確実にレーザー光が反
射されるようにして、各コーナーキューブプリズムの存
在する上下方向方位の範囲を予め検出し、メモリしてお
き、2回目は前記メモリされている上下方向方位の範囲
に基いて、レーザー光線の上下方向スキャン角を小さく
して、かつ、水平方向には高速でスキャンするので、い
ずれの場谷にも全体として速い周速に拘らずコーナーキ
ューブプリズムの受光時間を比較内炎(保てることとな
って、コーナーキューブプリズムからの反射光を確実に
受光でき、しかも、2回目の時間ずれの少ない3つの水
平方向受光角度情報より正確な移動体位置が検出できる
に至ったのである。
1回目は大きく上下方向にレーザー光線をスキャンしな
がら、かつ、低速で水平方向にスキャンすることによっ
て、コーナーキューブプリズムで確実にレーザー光が反
射されるようにして、各コーナーキューブプリズムの存
在する上下方向方位の範囲を予め検出し、メモリしてお
き、2回目は前記メモリされている上下方向方位の範囲
に基いて、レーザー光線の上下方向スキャン角を小さく
して、かつ、水平方向には高速でスキャンするので、い
ずれの場谷にも全体として速い周速に拘らずコーナーキ
ューブプリズムの受光時間を比較内炎(保てることとな
って、コーナーキューブプリズムからの反射光を確実に
受光でき、しかも、2回目の時間ずれの少ない3つの水
平方向受光角度情報より正確な移動体位置が検出できる
に至ったのである。
つまv1上記2回目の水平方向のレーザー光線のスキャ
ンは高速で行なうものであるから、この間に移動体が移
動する距離の影響をその位置測定精度に対して十分無視
しえる程度に小さくできたのでらる。
ンは高速で行なうものであるから、この間に移動体が移
動する距離の影響をその位置測定精度に対して十分無視
しえる程度に小さくできたのでらる。
以下、図面に基いて本発明の詳細な説明する。
第1図は移一体の一例である芝刈機(Vlを示し、前車
輸[2! 、 (2jと後車輪fa; 、 (3)を備
えた車体Tl+の中間部にディスク型の刈り刃を内装し
た芝刈装置(4)が上下動自社に懸架され、車体+11
の上部に後記構成になるレーザー光源囚が設けられてい
る。
輸[2! 、 (2jと後車輪fa; 、 (3)を備
えた車体Tl+の中間部にディスク型の刈り刃を内装し
た芝刈装置(4)が上下動自社に懸架され、車体+11
の上部に後記構成になるレーザー光源囚が設けられてい
る。
@記し−ザー光源tAlは、第2図に示すように、レー
ザー発光器(5)から発射されるレーザー光線をオプテ
ィカルスキャナー(61によって上下方向に所定角度(
θ)の範囲に亘ってスキャン可能に構成するとともに、
D、Cモータ(7)によって水平面内で回転可能な回転
台(8)にj! 置されている。
ザー発光器(5)から発射されるレーザー光線をオプテ
ィカルスキャナー(61によって上下方向に所定角度(
θ)の範囲に亘ってスキャン可能に構成するとともに、
D、Cモータ(7)によって水平面内で回転可能な回転
台(8)にj! 置されている。
又、このレーザー発光器(5)には、レーザー光線が発
射される方向に受光面を向はコーナーキューブプリズム
(B、C,D)からの反射光を受光する受光器(9)を
設けてあり、レーザー発光器(5)と一体内に、@記オ
プティカルスキャナー(61及びモータ(7)によって
その光軸の同きを変更可能に構成しである。 そして、
レーザー光線が発射される方位を示す方位角(θ)を検
出すべく前記モータ(7)にはロータリーエンコーダ(
101カ装着されている。
射される方向に受光面を向はコーナーキューブプリズム
(B、C,D)からの反射光を受光する受光器(9)を
設けてあり、レーザー発光器(5)と一体内に、@記オ
プティカルスキャナー(61及びモータ(7)によって
その光軸の同きを変更可能に構成しである。 そして、
レーザー光線が発射される方位を示す方位角(θ)を検
出すべく前記モータ(7)にはロータリーエンコーダ(
101カ装着されている。
そして、レーザー光源囚全体に、下端に重重illを固
着した支持フレームflZに固定してあり、この支持フ
レーム+121 Uゴム等の弾性体で構成されたダンパ
一部材(13を介して、車体fl)に取り付けられてい
て、もって、車体(1)の振切やゆれがレーザー光源L
AIK伝わらないようにして、このレーザー光源Aが常
に水平を保つように構成しである。
着した支持フレームflZに固定してあり、この支持フ
レーム+121 Uゴム等の弾性体で構成されたダンパ
一部材(13を介して、車体fl)に取り付けられてい
て、もって、車体(1)の振切やゆれがレーザー光源L
AIK伝わらないようにして、このレーザー光源Aが常
に水平を保つように構成しである。
前記オプティカルスキャナー(6)は、第3図に示すよ
うに、駆動巻線(14)に電流を流さない状態で、固定
子05)に設けである永久磁石市、 tl、Glの磁力
の中心に位置している回転子0りの軸芯fPl上に光学
ミラー(181を固着してあり、前記駆U巻線1141
に流す電流(I)の強さに対応して発生する回転力と@
記回転千0′71に取り付けである制御バネ0印とのね
じりトルクの等しい位置で前記回転子(171丁なわち
光学ミラーODが静止すべく構成しである。
うに、駆動巻線(14)に電流を流さない状態で、固定
子05)に設けである永久磁石市、 tl、Glの磁力
の中心に位置している回転子0りの軸芯fPl上に光学
ミラー(181を固着してあり、前記駆U巻線1141
に流す電流(I)の強さに対応して発生する回転力と@
記回転千0′71に取り付けである制御バネ0印とのね
じりトルクの等しい位置で前記回転子(171丁なわち
光学ミラーODが静止すべく構成しである。
そして、前記回転子面の軸芯(Pi上に設けた光学ミラ
ーf18)によって前記レーザー発光器(5)から発射
されたレーザー光線を所定方向に反射させるとともに、
その反射方向を#r′J記駆勅巻線14iの入力電流(
I)によって任意の方向に制御するのである。
ーf18)によって前記レーザー発光器(5)から発射
されたレーザー光線を所定方向に反射させるとともに、
その反射方向を#r′J記駆勅巻線14iの入力電流(
I)によって任意の方向に制御するのである。
以下、上記構成になるレーザー光源囚によって芝刈機(
■の位置を測定するシステムについて説明する。
■の位置を測定するシステムについて説明する。
第4図に示すように、地上施設としてのコーナーキュー
ブプリズムfB+ 、 (C1、(D)が3定点に設置
され、前記芝刈機(■上に設けたレーザー光源(3)よ
f)前述したようにオプティカルスキャナー(61によ
って、上下方向へ所定角度(θ)でスキャンしながら水
平面内をスキャンされるレーザー光線を発射する。 レ
ーザー光線がコーナーキューブプリズム(Bl 、 (
C1、(Dlに当たるとその進入経路を逆進し、このレ
ーザー光線が発射された光源臥)に戻り受光器(9)に
よって受光される。 そして、この受光器(9)が夫々
レーザー光線を受光した時点の受光器(9)の向き(4
) 、 (/$ 、 (匈を一前記ロータリーエンコー
ダ(10)によって検出し、この検出方位(q) 、
G!p 、 (4)に基いて芝刈機(■の位置tPlを
三角測量の原理に基いて算出するのである。
ブプリズムfB+ 、 (C1、(D)が3定点に設置
され、前記芝刈機(■上に設けたレーザー光源(3)よ
f)前述したようにオプティカルスキャナー(61によ
って、上下方向へ所定角度(θ)でスキャンしながら水
平面内をスキャンされるレーザー光線を発射する。 レ
ーザー光線がコーナーキューブプリズム(Bl 、 (
C1、(Dlに当たるとその進入経路を逆進し、このレ
ーザー光線が発射された光源臥)に戻り受光器(9)に
よって受光される。 そして、この受光器(9)が夫々
レーザー光線を受光した時点の受光器(9)の向き(4
) 、 (/$ 、 (匈を一前記ロータリーエンコー
ダ(10)によって検出し、この検出方位(q) 、
G!p 、 (4)に基いて芝刈機(■の位置tPlを
三角測量の原理に基いて算出するのである。
一方、前述したよう例、前記レーザー光源(2)の1回
目の水平面内のスキャン時に受光器(9)がコーナーキ
ューブプリズムfBl 、 tel 、 E)からの反
射光を受光した時点のオブrイカルスキャナー(6)の
駆動電流(Q 、 (す、 (I3)をサンプリングす
ることによって、上下方向のレーザー光源L〜とコーナ
ーキューブプリズムfBl 、 (C1、(D) 、ニ
ーの位置関係(上下方向のスキャン角)を測定してお(
。
目の水平面内のスキャン時に受光器(9)がコーナーキ
ューブプリズムfBl 、 tel 、 E)からの反
射光を受光した時点のオブrイカルスキャナー(6)の
駆動電流(Q 、 (す、 (I3)をサンプリングす
ることによって、上下方向のレーザー光源L〜とコーナ
ーキューブプリズムfBl 、 (C1、(D) 、ニ
ーの位置関係(上下方向のスキャン角)を測定してお(
。
そして、2回目の水平面内のスキャン時には、前記ロー
タリーエンコーダ(10)の検出方位(θp 、 <a
) 。
タリーエンコーダ(10)の検出方位(θp 、 <a
) 。
(9の近悼では前記サンプリングした駆動電流(11)
(]2) 、 (%)にわずかな偏差を加えた電流でオ
プティカルスキャナー(6)を駆動して、レーザー光線
がコーナーキューブプリズム(B! l (C1l +
D)に確実に当たるようにするのである。
(]2) 、 (%)にわずかな偏差を加えた電流でオ
プティカルスキャナー(6)を駆動して、レーザー光線
がコーナーキューブプリズム(B! l (C1l +
D)に確実に当たるようにするのである。
図面は本発明に係る移動体の位置検出方法の実施例を示
し、第1図は芝刈作業車の全体側面図、第2図はレーザ
ー光源の構成を示す概略図、第3図はオプティカルスキ
ャナーの構成を示す概略図、そして、第4図は移動体位
置検出の説明図である。 (■・・・修朝体、(3) ・レーザー光源、fBI
、 (C1。 (Dl・・・・コーナーキューブプリズム、轡、 (&
Q 、 (1・ ・方位角、(θ) ・・スキャン角。
し、第1図は芝刈作業車の全体側面図、第2図はレーザ
ー光源の構成を示す概略図、第3図はオプティカルスキ
ャナーの構成を示す概略図、そして、第4図は移動体位
置検出の説明図である。 (■・・・修朝体、(3) ・レーザー光源、fBI
、 (C1。 (Dl・・・・コーナーキューブプリズム、轡、 (&
Q 、 (1・ ・方位角、(θ) ・・スキャン角。
Claims (1)
- 移動体(■に設けられたレーザー光源囚から順次異なる
方位に向けてレーザー光線を発射し、所定位置に設けら
れた少なくとも3個のコーナーキューブプリズム(Bl
、 (C1、(D)で反射されて戻ってくるレーザー
光線をこの光源囚に設けである受光器(9)で受光し、
その時のレーザー光源Wの向きを測定することによりレ
ーザー光源(んと前g己コーナーキューブプリズム(B
! 、 (C1、(D)とのなす各方位角(&、)、(
の、(fl)から移動体(Vlの位置を測定する移動体
の位置検出システムであって、前記レーザー光源囚から
発射されるレーザー光線の水平方向のスキャン速度を1
回目は低速回転で、2回目は高速回転で行なうシーケン
スを繰返し行なうとともに、前記1回目の低速回転時は
レーザー光線の上下方向のスキャン角(θ)を大きく、
2回目の高速回転時は前記上下方向のスキャン角(θ)
を小さく行なうことを特徴とする移動体の位置検出方法
。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP21414782A JPS59104503A (ja) | 1982-12-07 | 1982-12-07 | 移動体の位置検出方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP21414782A JPS59104503A (ja) | 1982-12-07 | 1982-12-07 | 移動体の位置検出方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPS59104503A true JPS59104503A (ja) | 1984-06-16 |
JPS6341489B2 JPS6341489B2 (ja) | 1988-08-17 |
Family
ID=16651001
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP21414782A Granted JPS59104503A (ja) | 1982-12-07 | 1982-12-07 | 移動体の位置検出方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS59104503A (ja) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61117409A (ja) * | 1984-11-14 | 1986-06-04 | Komatsu Zoki Kk | 建設機械の現在地検出方法 |
JPS62254007A (ja) * | 1986-04-04 | 1987-11-05 | Toshihiro Tsumura | 移動体の位置検出装置 |
JPS62254008A (ja) * | 1986-04-04 | 1987-11-05 | Toshihiro Tsumura | 移動体の位置検出装置 |
WO1989003049A1 (en) * | 1987-09-30 | 1989-04-06 | Kabushiki Kaisha Komatsu Seisakusho | Position meter using laser beam |
JPH03142609A (ja) * | 1989-10-30 | 1991-06-18 | Ishikawajima Shibaura Kikai Kk | 自動走行作業車の自己位置検出装置 |
FR2676544A1 (fr) * | 1991-04-11 | 1992-11-20 | Honda Motor Co Ltd | Systeme pour detecter la position d'un corps mobile. |
WO2016057140A1 (en) | 2014-10-10 | 2016-04-14 | Irobot Corporation | Autonomous robot localization |
-
1982
- 1982-12-07 JP JP21414782A patent/JPS59104503A/ja active Granted
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61117409A (ja) * | 1984-11-14 | 1986-06-04 | Komatsu Zoki Kk | 建設機械の現在地検出方法 |
JPH0511762B2 (ja) * | 1986-04-04 | 1993-02-16 | Toshihiro Tsumura | |
JPS62254007A (ja) * | 1986-04-04 | 1987-11-05 | Toshihiro Tsumura | 移動体の位置検出装置 |
JPS62254008A (ja) * | 1986-04-04 | 1987-11-05 | Toshihiro Tsumura | 移動体の位置検出装置 |
WO1989003049A1 (en) * | 1987-09-30 | 1989-04-06 | Kabushiki Kaisha Komatsu Seisakusho | Position meter using laser beam |
JPH03142609A (ja) * | 1989-10-30 | 1991-06-18 | Ishikawajima Shibaura Kikai Kk | 自動走行作業車の自己位置検出装置 |
FR2676544A1 (fr) * | 1991-04-11 | 1992-11-20 | Honda Motor Co Ltd | Systeme pour detecter la position d'un corps mobile. |
WO2016057140A1 (en) | 2014-10-10 | 2016-04-14 | Irobot Corporation | Autonomous robot localization |
CN106659118A (zh) * | 2014-10-10 | 2017-05-10 | 美国iRobot公司 | 自主机器人定位 |
EP3203826A4 (en) * | 2014-10-10 | 2018-06-06 | iRobot Corporation | Autonomous robot localization |
US10067232B2 (en) | 2014-10-10 | 2018-09-04 | Irobot Corporation | Autonomous robot localization |
CN106659118B (zh) * | 2014-10-10 | 2020-11-13 | 美国iRobot公司 | 自主机器人定位 |
CN112540380A (zh) * | 2014-10-10 | 2021-03-23 | 美国iRobot公司 | 自主机器人定位 |
Also Published As
Publication number | Publication date |
---|---|
JPS6341489B2 (ja) | 1988-08-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US5110202A (en) | Spatial positioning and measurement system | |
US7394527B2 (en) | Measuring device and measuring method for determining distance and/or position | |
EP0358368B1 (en) | Laser based measurement system | |
AU2002322525B2 (en) | System and method of measuring flow velocity in three axes | |
JP3039801B2 (ja) | 位置計測装置 | |
US4830489A (en) | Three dimensional laser beam survey system | |
US9671094B2 (en) | Laser scanning apparatus and method of use | |
US6133998A (en) | Method and device for target seeking for geodetic devices | |
DK169003B1 (da) | Fremgangsmåde til navigering af et førerløst køretøj | |
US7321420B2 (en) | Survey system | |
CN109313026B (zh) | 用于比较入射到激光接收机上的接收射束和旋转的激光束的方法 | |
US4926050A (en) | Scanning laser based system and method for measurement of distance to a target | |
JPH09250927A (ja) | 測量システム | |
AU761836B2 (en) | Surveying apparatus comprising a height measuring device | |
JP2019519788A (ja) | レーザー受信機に入射する受信ビームと回転レーザービームを比較するための方法 | |
JPS59104503A (ja) | 移動体の位置検出方法 | |
JPH07154909A (ja) | 架空電線の線下物体距離測定装置 | |
RU2137149C1 (ru) | Устройство для обнаружения целей | |
US20220146644A1 (en) | Monostatic scanning lidar using a multi-faceted polygon mirror as one of dual redirecting elements | |
JPS60205270A (ja) | 自動追跡装置 | |
JPS58201080A (ja) | 移動体の位置検出方法 | |
JPH02216393A (ja) | 航空機ドッキングガイダンス装置 | |
JPH0260124B2 (ja) | ||
JPS5912370A (ja) | 移動体の位置検出方法 | |
JP2949219B2 (ja) | 光学観測による対象物の姿勢推定方法 |