JPH02173520A - Running path having light projecting means for measuring position, azimuth and unit advance quantity, and moving body which can measure position, azimuth and unit advance quantity, and measuring method for position, azimuth and unit advance quantity of moving body - Google Patents

Running path having light projecting means for measuring position, azimuth and unit advance quantity, and moving body which can measure position, azimuth and unit advance quantity, and measuring method for position, azimuth and unit advance quantity of moving body

Info

Publication number
JPH02173520A
JPH02173520A JP32772588A JP32772588A JPH02173520A JP H02173520 A JPH02173520 A JP H02173520A JP 32772588 A JP32772588 A JP 32772588A JP 32772588 A JP32772588 A JP 32772588A JP H02173520 A JPH02173520 A JP H02173520A
Authority
JP
Japan
Prior art keywords
light
moving body
light projecting
projecting means
traveling
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.)
Pending
Application number
JP32772588A
Other languages
Japanese (ja)
Inventor
Toshihiro Tsumura
俊弘 津村
Toshio Kondo
近藤 俊雄
Kenichi Nishide
西出 健一
Moritomo Hanawa
守智 塙
Akira Odawara
小田原 晃
Kiyoshi Omizo
大溝 潔
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
KEIHAN KK
Tokyo Koku Keiki KK
Original Assignee
KEIHAN KK
Tokyo Koku Keiki KK
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by KEIHAN KK, Tokyo Koku Keiki KK filed Critical KEIHAN KK
Priority to JP32772588A priority Critical patent/JPH02173520A/en
Publication of JPH02173520A publication Critical patent/JPH02173520A/en
Pending legal-status Critical Current

Links

Landscapes

  • Indicating Or Recording The Presence, Absence, Or Direction Of Movement (AREA)
  • Navigation (AREA)

Abstract

PURPOSE:To exactly detect the unit advance quantity, the azimuth to a running path or the present position to the left and right directions of the running path by providing the running path having a light projecting means installed at a predetermined distance and an angle. CONSTITUTION:Light beams projected from a pair of light projecting means 3, 3' are received by a pair of light receiving means 5 successively in accordance with the advance of a moving body 2. As the moving body 2 advances, a pulse generating means 8 loaded on the moving body 2 stores temporarily measured pulse information in a memory 11. Also, based on a distance of pair of light projecting means 3 installed at a prescribed interval from a constant ROM 10 in which a constant is stored in advance, an angle of the light projecting means 3' for projecting a light beam at a prescribed angle, and the distance between the light receiv ing means 5 loaded on the moving body, an operation 12 is executed by the number of pulses measured by the pulse generating means 8 being proportional to the advanced quantity and a light receiving timing of light beams from each light projecting means 3, 3', and the unit advanced quantity on the running path, or the position and the azimuth to the running path are outputted 13.

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は、移動体(たとえば、自動車、無人車、ロボッ
トなど)が走行路(たとえば、一般道路、高速道路、自
動車教習所、空港、遊園地、倉庫、工場、ゴルフ場など
)を走行する場合において、移動体の進行距離、走行路
に対する移動体の位置あるいは方位を測定するために必
要な投光手段を有する走行路に関する。
[Detailed Description of the Invention] [Industrial Application Field] The present invention is applicable to a mobile object (for example, a car, an unmanned vehicle, a robot, etc.) traveling on a driving path (for example, a general road, an expressway, a driving school, an airport, an amusement park, etc.). The present invention relates to a running path having a light projecting means necessary for measuring the traveling distance of a moving object and the position or direction of the moving object with respect to the running path when the moving object travels through a warehouse, a factory, a golf course, etc.

本発明は、前記投光手段の光ビームを受光して移動体の
進行距離、上記走行路に対する位置あるいは方位を測定
し得る移動体に関する。
The present invention relates to a moving body capable of measuring the traveling distance of the moving body and its position or orientation with respect to the traveling path by receiving the light beam from the light projecting means.

本発明は、前記走行路に設置された投光手段と、移動体
に搭載された受光手段および進行量に比例したパルス発
生手段と、により移動体の単位進行量、走行路に対する
位置、および方位を測定する移動体単位進行量、位置お
よび方位測定方法に関する。
The present invention uses a light projecting means installed on the traveling path, a light receiving means mounted on the moving object, and a pulse generating means proportional to the traveling distance to determine the unit progress of the moving object, the position with respect to the traveling path, and the direction. This invention relates to a method for measuring unit progress, position, and direction of a moving object.

〔従来の技術〕[Conventional technology]

第8図は、従来技術説明図である。以下、第8図にした
がって、従来技術を説明する。
FIG. 8 is an explanatory diagram of the prior art. The prior art will be explained below with reference to FIG.

80は移動体、81ないし83は光ビーム、84は左光
ビーム反射体、85は右光ビーム反射体である。 移動
体80は、第8図に図示されているようにXY座榎軸の
X方向からθずれた方向に進行している。また、移動体
80は、図示されていない投受光装置を搭載しており、
これは左右方向81.82および進行方向に対してαの
角度83に光ビームを投受光でき、さらに、移動体80
に対して垂直方向にスキャニングができるものである。
80 is a moving body, 81 to 83 are light beams, 84 is a left light beam reflector, and 85 is a right light beam reflector. As shown in FIG. 8, the moving body 80 is moving in a direction deviated by θ from the X direction of the XY seat axis. Furthermore, the moving body 80 is equipped with a light emitting and receiving device (not shown),
This can project and receive a light beam in the left and right directions 81, 82 and at an angle 83 of α with respect to the traveling direction, and furthermore, the moving body 80
It is possible to scan in the direction perpendicular to the image.

左右の光ビーム反射体84.85は、前記投受光装置の
光ビームを入射角に対して同方向に反射する光ビーム反
射体であり、走行路に対して常に直角に相対している。
The left and right light beam reflectors 84 and 85 are light beam reflectors that reflect the light beam of the light projecting and receiving device in the same direction with respect to the incident angle, and are always opposed to the running path at right angles.

この光ビーム反射体は、普通、コーナキューブが用いら
れている。
A corner cube is usually used as this light beam reflector.

第8図に図示されているように、X軸に対してθだけ偏
って走行した場合について説明する。
As shown in FIG. 8, a case will be described in which the vehicle travels deviated by θ with respect to the X axis.

今、移動体80から光ビーム83が進行方向に向かって
αの角度で投光されると同時に光ビーム83は、光ビー
ム反射体84により反射されて図示されていない受光装
置に受光される。
Now, a light beam 83 is projected from the moving body 80 toward the traveling direction at an angle α, and at the same time, the light beam 83 is reflected by a light beam reflector 84 and received by a light receiving device (not shown).

この位置から移動体80が図中でLlだけ走行した時、
左の光ビーム81は、光ビーム反射体84によって反射
され、同時に移動体80に搭載された受光装置に受光さ
れる。また、右の光ビーム82は、さらにL2だけ走行
した後に、光ビーム反射体85によって反射され、同時
に受光装置に受光される。
When the moving body 80 travels by Ll in the figure from this position,
The left light beam 81 is reflected by a light beam reflector 84 and simultaneously received by a light receiving device mounted on the moving body 80 . Further, the right light beam 82 travels further by L2, is reflected by the light beam reflector 85, and is simultaneously received by the light receiving device.

そして、上記距離L1およびL2は、移動体80の車輪
の回転を検出する公知のロークリエンコーダあるいは車
速計と、左右の光ビームの投光時間差等によって測定す
ることができ、光ビーム83の角度αおよび光ビーム反
射体84.85の距離Cは一定で、既知の値である。
The distances L1 and L2 can be measured using a known low-return encoder or vehicle speedometer that detects the rotation of the wheels of the moving body 80, and the difference in projection time between the left and right light beams, and the angle of the light beam 83. α and the distance C between the light beam reflectors 84 and 85 are constant and known values.

したがって、この既知の値と移動体の移動距離L1、L
2とがわかれば、移動体80のX、Y座標軸での位置(
X、Y)と進行方位θとが移動体のコンピュータによっ
て計算できる。
Therefore, this known value and the moving distance L1, L of the moving body
2, the position of the moving body 80 on the X and Y coordinate axes (
X, Y) and the traveling direction θ can be calculated by the computer of the mobile object.

なお、上記計算の詳細は、特開昭61−217787号
公報および「第1O回ビークル・オートメーション・シ
ンポジウム」 昭和62年1月27.28日、日本自動
制御協会「レーザとコーナキューブを用いた専用道路に
おける移動体の位置・方位補正方法」 大阪府立大学工
学部津村俊弘 外4名著 に記載されている。
The details of the above calculation can be found in Japanese Patent Application Laid-Open No. 61-217787 and the ``1st Vehicle Automation Symposium''. ``Method for correcting the position and orientation of moving objects on roads'' by Toshihiro Tsumura, Faculty of Engineering, Osaka Prefecture University, and four other authors.

上記計算によって、自立航法等による移動体の累積位置
誤差を補正することができる。
Through the above calculation, it is possible to correct the cumulative position error of the moving object due to self-contained navigation or the like.

また、他の従来例として特公昭62−57928号公報
に記載されたものがある。
Further, another conventional example is described in Japanese Patent Publication No. 62-57928.

すなわち、走行路の左右両側には信号源を配置しておき
、移動体の左右には前記信号源からの信号を検知する検
知手段が設けられている。また、移動体には、前記一方
の検知手段が前記信号の一方を検知してから、他方の検
知手段が前記信号の他方を検知するまでの移動体の移動
距離を計測する計測手段が設けられている。
That is, signal sources are arranged on both the left and right sides of the travel path, and detection means for detecting signals from the signal sources are provided on the left and right sides of the moving object. Further, the moving body is provided with a measuring means for measuring the distance traveled by the moving body from when the one detection means detects one of the signals until the other detection means detects the other of the signals. ing.

このように、信号源の位置、左右の検知手段の距離、お
よび移動体の移動距離がわかれば、移動体の進行方向の
偏倚角を計算により求めることができる。
In this way, if the position of the signal source, the distance between the left and right detection means, and the moving distance of the moving object are known, the deflection angle in the moving direction of the moving object can be calculated.

〔発明が解決しようとする課題〕[Problem to be solved by the invention]

しかし、上記一方の従来例では、移動体に投光手段と受
光手段とが一体になって搭載されているため、移動体に
受光手段を、また走行路に投光手段を設けた場合と比較
して、走行路に設けた投光手段の数より移動体数が多い
と、移動体1台当りの価格が高価になるという問題があ
る。
However, in one of the conventional examples mentioned above, the light projecting means and the light receiving means are mounted integrally on the moving body, so compared to the case where the light receiving means is provided on the moving body and the light projecting means is provided on the traveling path. Therefore, if the number of moving objects is greater than the number of light projection means provided on the travel path, there is a problem that the price per moving object becomes expensive.

上記一方の従来例では、投光手段と受光手段とを一体に
して搭載した移動体は、投光手段の光ビームが投光され
た後、正確に受光手段に受光させるためには工作精度を
上げる必要があるだけでなく、組立ても複雑となる。し
たがって、投光手段あるいは受光手段を一体にして移動
体に搭載した場合と、別々に製造して、走行路あるいは
移動体に設置した場合とを比較すると、一体に製造する
場合の方が高価なものとなるという問題がある。
In one of the above-mentioned conventional examples, a moving object equipped with a light projecting means and a light receiving means has to be manufactured with precision in order to ensure that the light beam is accurately received by the light receiving means after the light beam from the light projecting means is projected. Not only does it have to be raised, but it is also complicated to assemble. Therefore, when comparing the case where the light emitting means or the light receiving means are integrated and mounted on a moving object, and the case where they are manufactured separately and installed on the running path or moving object, it is more expensive to manufacture them in one piece. There is the problem of becoming a thing.

上記一方の従来例では、距離測定手段は、設計時に予め
計算してエンコーダの1パルス当りの移動体の進行距離
が決められている。このために移動体の位置あるいは方
位を測定する時の状況により、エンコーダの1パルス当
りの移動体の進行距離に誤差が発生する。すなわち、路
面状態あるいは車輪の変形、車輪、ギア、あるいはベル
ト等の機械的な摩耗による変形、および大または荷物の
重量あるいはその配分等の各種条件により車輪に取り付
けられたエンコーダの1パルス当りの進行量が変化し、
移動体の位置あるいは方位を算出する際の誤差となると
いう問題があった。
In one of the above conventional examples, the distance measuring means is calculated in advance at the time of design to determine the distance traveled by the moving object per one pulse of the encoder. Therefore, depending on the situation when measuring the position or orientation of the moving object, an error occurs in the distance traveled by the moving object per one pulse of the encoder. In other words, the progress per pulse of the encoder attached to the wheel is determined by various conditions such as road surface conditions, deformation of wheels, deformation due to mechanical wear of wheels, gears, or belts, and the weight of cargo or its distribution. The amount changes,
There is a problem in that this results in an error when calculating the position or direction of the moving object.

上記他方の従来例では、移動体の現在方位を測定するこ
とができるだけで、位置、あるいは高精度の進行距離を
測定することはできない。
In the other conventional example, it is only possible to measure the current direction of the moving body, but it is not possible to measure the position or the traveling distance with high precision.

本発明は、以上のような問題を解決するために、移動体
の単位進行量、位置あるいは方位を測定するための投光
手段を有する走行路を提供することを目的とする。
SUMMARY OF THE INVENTION In order to solve the above-mentioned problems, it is an object of the present invention to provide a running path having a light projection means for measuring the unit progress, position, or direction of a moving body.

本発明は、投光手段の光ビームを受光して単位進行量、
位置あるいは方位を得ることができる移動体を提供する
ことを目的とする。
The present invention receives a light beam from a light projecting means, and calculates a unit traveling amount.
The purpose of the present invention is to provide a moving body that can obtain the position or orientation.

本発明は、移動体の走行路に対する位置および方位を測
定することができる移動体位置および方位測定方法を提
供することを目的とする。
SUMMARY OF THE INVENTION An object of the present invention is to provide a method for measuring the position and orientation of a moving body, which can measure the position and orientation of a mobile body with respect to a travel path.

本発明は、移動体の進行量に比例したパルス発生手段か
ら発生する1パルス当りの進行距離を測定することがで
きる移動体の単位進行量測定方法を提供することを目的
とする。
SUMMARY OF THE INVENTION An object of the present invention is to provide a method for measuring the unit progress of a moving object, which can measure the distance traveled per pulse generated from a pulse generating means that is proportional to the amount of progress of the moving object.

〔課題を解決するための手段〕[Means to solve the problem]

第1図において、本発明の詳細な説明する。第1図は本
発明の詳細な説明するブロック構成図である。
Referring to FIG. 1, the present invention will be explained in detail. FIG. 1 is a block diagram illustrating the present invention in detail.

第1図において、1は高速道路、一般道路、自動車教習
所内の道路、空港、倉庫、工場、遊園地あるいはゴルフ
場等の走行路、2は自動車、無人車、あるいはロボット
等の移動体、3は走行路1のいずれか一側に一定間隔で
配置され、走行路1に対して直角に投光する一対の投光
手段、3°は前記投光手段3と走行路1の他側に対向し
、直角方向と該直角方向に対する一定角度方向αとに投
光する一対の投光手段、5は移動体2の左右先端に搭載
された一対の受光手段、8は移動体2の左右後部に搭載
された一対の進行量に比例したパルス発生手段で、ロー
タリーエンコーダあるいは速度計のごとく移動体2の走
行によりパルスを発生する。10は一対の投光手段3間
の距離、一対の投光手段3′の角度、および移動体2に
搭載された一対の進行量に比例したパルス発生手段8間
の距離が格納された定数格納ROMで、走行路lおよび
移動体2によって特定される定数が予め格納されている
In Figure 1, 1 is a driving route such as an expressway, general road, road within a driving school, airport, warehouse, factory, amusement park or golf course, 2 is a moving object such as a car, an unmanned vehicle, or a robot, and 3 is a moving vehicle such as a car, an unmanned vehicle, or a robot. are a pair of light projecting means that are arranged at regular intervals on either side of the running path 1 and project light at right angles to the running path 1; a pair of light projecting means for projecting light in a perpendicular direction and a direction α at a constant angle with respect to the perpendicular direction; 5 a pair of light receiving means mounted on the left and right ends of the moving body 2; 8 a pair of light receiving means mounted on the left and right rear of the moving body 2; A pair of mounted pulse generating means proportional to the amount of travel generates pulses as the moving object 2 travels, like a rotary encoder or a speedometer. Reference numeral 10 denotes constant storage in which the distance between the pair of light projecting means 3, the angle of the pair of light projecting means 3', and the distance between the pair of pulse generating means 8 mounted on the moving body 2 and proportional to the amount of travel of the pair are stored. Constants specified by the traveling route l and the moving object 2 are stored in advance in the ROM.

11はパルス数格納メモリで、一対の進行量に比例した
パルス発生手段8により測定した移動体2ごとにより異
なるパルス情報を格納する。12は演算手段で、走行路
1の投光手段3および3゜から投光された光ビームを一
対の受光手段5で受光した際に、定数格納ROM10と
パルス数格納メモリ11のパルス情報とにより移動体の
単位進行量、走行路1に対する位置あるいは方位を演算
する。13は出力手段で、演算手段12において演算し
た値を視覚的に認識できるように表示する。
Reference numeral 11 denotes a pulse number storage memory which stores different pulse information for each moving body 2 measured by the pulse generating means 8 proportional to the amount of travel of the pair. Reference numeral 12 denotes a calculating means, which calculates a value based on the pulse information in the constant storage ROM 10 and the pulse number storage memory 11 when the light beams projected from the light projecting means 3 and 3° on the traveling path 1 are received by the pair of light receiving means 5. The unit progress of the moving object, the position or direction with respect to the traveling path 1 are calculated. 13 is an output means that displays the value calculated by the calculation means 12 so that it can be visually recognized.

〔作  用〕[For production]

第1図にしたがって本発明の詳細な説明する。 The present invention will be explained in detail with reference to FIG.

一対の投光手段3および3′から投光される光ビームは
、移動体2の進行に応じて順次移動体2の一対の受光手
段5により受光される。移動体2が進行するにしたがい
移動体2に搭載されている一対の進行量に比例したパル
ス発生手段8は、測定したパルス情報を−Hメモリ11
に格納する。
The light beams projected from the pair of light projecting means 3 and 3' are sequentially received by the pair of light receiving means 5 of the moving body 2 as the moving body 2 advances. As the moving object 2 advances, a pair of pulse generating means 8 mounted on the moving object 2 proportional to the amount of progress outputs the measured pulse information to the -H memory 11.
Store in.

一方、予め定数として格納している定数ROM10から
一定間隔で設置された一対の投光手段3の距離、一定角
度で投光する投光手段3°の角度および移動体に搭載さ
れた受光手段5間の距離に基づいて、前記進行量に比例
したパルス発生手段で測定したパルス数と各投光手段か
らの光ビームの受光タイミングとにより、演算手段12
が演算を行ない、走行路上での単位進行量、あるいは走
行路に対する位置および方位を出力手段13で得ること
ができる。
On the other hand, from the constant ROM 10 stored in advance as a constant, the distance between a pair of light projecting means 3 installed at a constant interval, the light projecting means projecting light at a constant angle at an angle of 3 degrees, and the light receiving means 5 mounted on the moving object. Based on the distance between them, the number of pulses measured by the pulse generating means proportional to the amount of travel and the reception timing of the light beam from each light projecting means, the calculation means 12
performs the calculation, and the output means 13 can obtain the unit progress on the road or the position and orientation with respect to the road.

本発明によれば、一対の進行量に比例したパルス発生手
段8から出る1パルス当りの移動体2の進行量が正確に
得られる。
According to the present invention, it is possible to accurately obtain the amount of movement of the movable body 2 per pulse output from the pulse generating means 8 which is proportional to the amount of movement of the pair.

本発明によれば、移動体2の走行路に対する単位進行量
、位置および方位が高精度に検出されるので、この値に
基づいて移動体2を制御するための情報を利用すること
ができる。
According to the present invention, since the unit progress, position, and direction of the moving body 2 with respect to the travel path are detected with high precision, information for controlling the moving body 2 based on these values can be used.

〔実 施 例〕〔Example〕

本発明の実施例を第2図ないし第7図にしたがって説明
する。
Embodiments of the present invention will be described with reference to FIGS. 2 to 7.

第2図は本発明の一実施例における単位進行量および方
位演算説明図、第3図は本発明の一実施例における位置
演算説明図、第4図は本発明の一実施例に使用する投光
手段概略図、第5図は本発明の一実施例に使用する受光
手段説明図、第6図および第7図は本発明における他の
実施例説明図である。
FIG. 2 is an explanatory diagram of unit progress and direction calculation in an embodiment of the present invention, FIG. 3 is an explanatory diagram of position calculation in an embodiment of the present invention, and FIG. 4 is a diagram of a projection used in an embodiment of the present invention. FIG. 5 is a schematic diagram of a light receiving means used in one embodiment of the present invention, and FIGS. 6 and 7 are diagrams illustrating other embodiments of the present invention.

第2図および第3図において、1は走行路で、たとえば
一般道路、高速道路、教習所内道路、空港、倉庫内、工
場内、遊園地あるいはゴルフ場内の走行路、2は移動体
で、たとえば自動車、無人車、ロボット、3は投光手段
で、走行路1に対して進行方向の前方のものにF1後方
のものにR1右配置にR1左配置にLの記号を付しであ
る。投光手段3FRと3RRとは走行路lに対して直角
方向に光ビームを投光するとともに一定の距離、dLを
有して走行路の一側に配置されている。
In FIGS. 2 and 3, 1 is a driving route, such as a general road, an expressway, a driving school road, an airport, a warehouse, a factory, an amusement park, or a golf course, and 2 is a moving object, for example, Cars, unmanned vehicles, robots, 3 are light projecting means, and the symbol L is attached to the one in front of the traveling path 1, the one behind F1, the one placed on the right side of R1, and the one placed on the left side of R1. The light projecting means 3FR and 3RR project light beams in a direction perpendicular to the running path 1, and are arranged on one side of the running path with a certain distance dL between them.

また、投光手段3FLは、走行路1に対して直角方向に
光ビームを投光するとともに投光手段3FRと走行路1
の他側に対抗して配置され、投光手段3FLと3RLと
は一定の角度α(0°くαく90°)を有して配置され
ている。4は各投光手段3から投光される光ビームで、
Blから34の記号が付されている。5Lおよび5Rは
左右の受光手段で、移動体2の前部に搭載されている。
Further, the light projecting means 3FL projects a light beam in a direction perpendicular to the running path 1, and the light projecting means 3FR and the running path 1
The light projecting means 3FL and 3RL are arranged opposite to each other on the other side, and are arranged at a constant angle α (0° × α × 90°). 4 is a light beam projected from each light projecting means 3;
34 symbols are attached from Bl. 5L and 5R are left and right light receiving means, which are mounted on the front part of the moving body 2.

7は移動体2の進行方向、8Lおよび8Rは移動体2の
後部に搭載された左右の進行量に比例したパルス発生手
段で、たとえば速度計あるいは移動体2の後輪の回転に
比例したパルスを発生するエンコーダ、dlは移動体2
の受光手段5Rで投光手段3FRが投光する光ビーム4
B3を受光してから、受光手段5して投光手段3FLが
投光する光ビーム4B1を受光するまでに移動体2が進
行した距離、d2は移動体2の受光手段5Rで投光手段
3RRが投光する光ビーム4B4を受光してから、同じ
く受光手段5Rで、走行路1に沿ってdLだけ隔てた投
光手段3FRが、投光する光ビーム4B3を受光するま
でに、移動体2が進行した距離、d3は移動体2が受光
手段5して投光手段3RLが投光する光ビーム4B2を
受光した位置から、投光手段3FRが投光する光ビーム
4B3を受光手段5Rで受光するまでの距離、Tは受光
手段5Rと5Lとの距離、ψmは投光手段三FLと3P
Rを結ぶ線に直角な方向Xと移動体2の進行方向7との
なす角度、Xmは走行路1に対する移動体2の位置、A
ないしDは移動体2の進行位置を示す。
Reference numeral 7 denotes the traveling direction of the moving body 2, and 8L and 8R denote pulse generating means mounted at the rear of the moving body 2 and proportional to the amount of left and right movement, such as a speedometer or pulses proportional to the rotation of the rear wheels of the moving body 2. The encoder that generates dl is the moving body 2
The light beam 4 projected by the light projecting means 3FR by the light receiving means 5R of
d2 is the distance traveled by the moving body 2 from receiving light beam B3 to receiving the light beam 4B1 projected by the light receiving means 5 and the light projecting means 3FL, d2 is the distance traveled by the light receiving means 5 of the moving body 2 and the light projecting means 3RR The mobile object 2 d3 is the distance traveled by the moving body 2 from the position where the light receiving means 5 receives the light beam 4B2 projected by the light projecting means 3RL, and the light receiving means 5R receives the light beam 4B3 projected by the light projecting means 3FR. T is the distance between the light receiving means 5R and 5L, ψm is the distance between the light emitting means 3FL and 3P
The angle formed by the direction X perpendicular to the line connecting R and the traveling direction 7 of the moving body 2,
to D indicate the advancing position of the moving body 2.

第4図において、41はレザーダイオード、42はレザ
ーダイオード41から発生した光ビームを平行光線にす
るためのコリメートレンズ、43はレザーダイオード4
1が光ビームを発生するための駆動回路、44はポリゴ
ンミラーで、モータ45が前記ミラーを回転し、レザー
ダイオード41で発生した光ビームを面ビーム46とす
る。
In FIG. 4, 41 is a laser diode, 42 is a collimating lens for collimating the light beam generated from the laser diode 41, and 43 is a laser diode 4.
1 is a drive circuit for generating a light beam; 44 is a polygon mirror; a motor 45 rotates the mirror and converts the light beam generated by the laser diode 41 into a plane beam 46;

このような構成にして、投光手段3から発生する光ビー
ムは、ポリゴンミラー44によって鉛直方向にスキャニ
ングして、移動体2に搭載した受光手段5に確実に伝達
される。
With this configuration, the light beam generated from the light projecting means 3 is scanned in the vertical direction by the polygon mirror 44 and is reliably transmitted to the light receiving means 5 mounted on the movable body 2.

また、スキャニングによってできる面ビーム46は、ガ
ルバノメータ、シリンドリカルレンズを使用してビーム
を拡大することもでき、光源をレザーダイオード41の
代りに指向性の高い発光ダイオード(LED)を用いて
も良い。
Further, the surface beam 46 generated by scanning can be expanded using a galvanometer or a cylindrical lens, and a highly directional light emitting diode (LED) may be used instead of the laser diode 41 as the light source.

第5図において、50は集光レンズ、51はフィルタ、
52はフォトダイオード、53は受光回路、54は回路
部品、55は受光ユニット、56はケース、57.58
は開口、59は蓋を示す。
In FIG. 5, 50 is a condenser lens, 51 is a filter,
52 is a photodiode, 53 is a light receiving circuit, 54 is a circuit component, 55 is a light receiving unit, 56 is a case, 57.58
indicates an opening, and 59 indicates a lid.

投光手段3から投光された光ビームは、集光レンズ50
を通して光電変換素子、たとえばフォトダイオード52
上に集光される。光ビームが特定の波長をもつ場合、太
陽光線から区別するためフィルタ51を取り付けると良
い。フォトダイオード52による電流は、受光回路53
によって、受光信号として出力する。
The light beam projected from the light projecting means 3 passes through the condensing lens 50
through a photoelectric conversion element, such as a photodiode 52
The light is focused on the top. If the light beam has a specific wavelength, a filter 51 may be installed to distinguish it from sunlight. The current from the photodiode 52 is transmitted to the light receiving circuit 53.
output as a light reception signal.

次に、第1図ないし第3図を参照しつつ本発明の一実施
例である単位進行量、走行路1に対する方位および位置
の測定方法を説明する。
Next, a method for measuring the unit progress, direction and position with respect to the traveling route 1, which is an embodiment of the present invention, will be explained with reference to FIGS. 1 to 3.

今、第2図図示のごとく、移動体2がX方向とψmだけ
角度をもって進行しているとする。
Now, as shown in FIG. 2, it is assumed that the moving body 2 is moving at an angle of ψm with respect to the X direction.

走行路lの一側に一定間隔dLで設置され、走行路1に
対して直角に投光する一対の投光手段3FR,3RRの
うちの一方の投光手段3RRからの光ビーム4B4を移
動体2に搭載されている受光手段5Rが受光する。この
時の移動体2の位置は、第2図図示Aとする。移動体2
は位置Aからさらに進行すると、一対の進行量に比例し
たパルス発生手段8L、8R,たとえばエンコーダが移
動体2の後輪からパルスを発生する。移動体2が距離d
2だけ進行したB点は、投光手段3FRから投光された
光ビーム4B3を受光装置5Rが受光することにより検
出される。そして、この間の左右エンコーダ8L、8R
のパルス数をメモリ11に格納する。さらに、移動体2
は距離d1だけ進み、第2図図示の0点に達する。走行
路1の他側に対向して設けられた投光手段3FLは、走
行路lに対して直角方向に光ビーム4B1を投光し、こ
の光ビーム4B1を受光手段5して受光する。この間の
左右エンコーダ8L、8Rのパルス数をメモリ11に格
納する。
A light beam 4B4 from one of the light projecting means 3RR of a pair of light projecting means 3FR and 3RR installed at a constant interval dL on one side of the travel path 1 and projecting light at right angles to the travel path 1 is transmitted to a moving object. The light-receiving means 5R mounted on 2 receives the light. The position of the moving body 2 at this time is shown as A in FIG. Mobile object 2
When the moving body 2 further advances from the position A, a pair of pulse generating means 8L and 8R, such as an encoder, which are proportional to the amount of travel, generate pulses from the rear wheels of the moving body 2. The moving body 2 is at a distance d
Point B, which has progressed by 2, is detected by the light receiving device 5R receiving the light beam 4B3 projected from the light projecting means 3FR. And between this, left and right encoders 8L and 8R
The number of pulses is stored in the memory 11. Furthermore, moving body 2
advances by a distance d1 and reaches the 0 point shown in FIG. The light projecting means 3FL provided opposite to the other side of the traveling path 1 projects a light beam 4B1 in a direction perpendicular to the traveling path 1, and the light beam 4B1 is received by the light receiving means 5. The number of pulses of the left and right encoders 8L and 8R during this time is stored in the memory 11.

今、dlに相当する右エンコーダ8Rのパルス数をP 
I R,左エンコーダ8Lのパルス数をPIL、d2に
相当する右および左エンコーダ8R。
Now, the number of pulses of the right encoder 8R corresponding to dl is P
I R, the number of pulses of the left encoder 8L is PIL, and the right and left encoders 8R correspond to d2.

8Lのパルス数をそれぞれP2R,P2Lとすると、d
l、d2に相当する左右エンコーダ8R。
If the number of pulses of 8L is P2R and P2L, respectively, d
Left and right encoders 8R corresponding to l and d2.

8Lの平均パルスP1、P2は、 P1= (PIR+PIL)/2      (1)P
2= (P2R+P2L)/2      (2)であ
る。
The average pulses P1 and P2 of 8L are P1= (PIR+PIL)/2 (1)P
2=(P2R+P2L)/2 (2).

この時、左右受光装置5R,5Lの間隔T1投光手段3
FR,3RRの距離をdLとし、これらの値は既知であ
るから、これらの値とエンコーダノ平均パルス数P1、
P2により幾何学的に移動体2の方位ψmが以下の式で
求められる。
At this time, the distance T1 between the left and right light receiving devices 5R and 5L is the light projecting means 3.
Let the distance between FR and 3RR be dL, and since these values are known, these values and the encoder average pulse number P1,
The orientation ψm of the moving body 2 can be determined geometrically from P2 using the following formula.

第2図において、ψmを用いて移動体2の1パルス進行
距離は、左右エンコーダについて別々に求めることがで
きる。
In FIG. 2, the traveling distance of one pulse of the moving body 2 can be determined separately for the left and right encoders using ψm.

すなわち、dPRは右のエンコーダ8R。That is, dPR is the right encoder 8R.

dPLは左のエンコーダ8Lの1パルスに相当する進行
量である。
dPL is the amount of movement equivalent to one pulse of the left encoder 8L.

さらに、平均1パルス進行量dPは、dPR。Furthermore, the average one-pulse progression amount dP is dPR.

dPLにより以下の式で求められる。It is determined by the following formula using dPL.

aP= (dPR十aPL)/2      (6)次
に、移動体2の走行路1に対する左右方向の現在位置X
mを求める方法について第3図を参照しつつ説明する。
aP= (dPR + aPL)/2 (6) Next, the current position X of the moving body 2 in the left and right direction with respect to the traveling path 1
A method for determining m will be explained with reference to FIG.

移動体2は、D点で投光手段3RLの光ビーム4B2を
受光手段5して受光し、この時点から左右エンコーダ8
L、8Rが発生するパルス数のカウントを開始する。そ
して、移動体2が距離d3だけ進み、投光手段3FRの
光ビーム4B3を受光手段5Rが受光するまでのパルス
数をメモリ11に格納する。これにより演算手段12は
、距離d3に相当する左右エンコーダ8L、8Rのパル
スP3L、P3Rから平均パルス数P3を算出する。
The moving body 2 receives the light beam 4B2 from the light projecting means 3RL by the light receiving means 5 at point D, and from this point on, the left and right encoders 8
Start counting the number of pulses generated by L and 8R. Then, the number of pulses until the moving body 2 advances by a distance d3 and the light receiving means 5R receives the light beam 4B3 from the light projecting means 3FR is stored in the memory 11. Thereby, the calculating means 12 calculates the average number of pulses P3 from the pulses P3L and P3R of the left and right encoders 8L and 8R corresponding to the distance d3.

p3=  (P3L+P3R)/2         
(7)距離d1、d2、d3は、前記平均1パルス進行
1tdPを用いて以下の式で求められる。
p3= (P3L+P3R)/2
(7) The distances d1, d2, and d3 are determined by the following formula using the average one-pulse progression 1tdP.

dl=’dP−Pi             (8)
d2=dP−P2             (9)d
 3 = d P −P 3            
 (10)これらの値と前記算出した方位ψmおよび投
光手段3FLと3FRとのなす角度αにより幾何学的に
移動体2の投光手段3FLと3FRとを結ぶ線上におけ
る投光手段3FLからの距離Xmを以下の式により求め
られる。
dl='dP-Pi (8)
d2=dP-P2 (9)d
3 = dP −P 3
(10) Using these values, the calculated azimuth ψm, and the angle α formed by the light projecting means 3FL and 3FR, the angle from the light projecting means 3FL on the line geometrically connecting the light projecting means 3FL and 3FR of the moving object 2 is calculated. The distance Xm can be calculated using the following formula.

2・CO3ψm       tan  a(dl+d
3) ・sin  ψm              
(11)ここで、左右エンコーダ8L、8Rで平均パル
スを(1)式、(2)式および(7)式で算出している
が、エンコーダはどちらか一方または車速計を1つ用い
ても良い。
2・CO3ψm tan a(dl+d
3) ・sin ψm
(11) Here, the average pulse is calculated using equations (1), (2), and (7) for left and right encoders 8L and 8R, but it is also possible to use either one encoder or one vehicle speedometer. good.

この場合(4)式、(5)式のどちらか一方の式を用い
れば(6)式は不要となる。
In this case, if either equation (4) or equation (5) is used, equation (6) becomes unnecessary.

演算装置12は、前記(1)式ないしく11)式を演算
するためのCPUおよびRAMを有するもので、普通の
マイクロコンピュータから構成され、予め定数格納メモ
リ10に格納されている投光手段3FRと3RRとの距
離dL、投光手段3FLと3RLとのなす角度α、受光
手段5Lと5Rとの距離T、Jよび走行中にパルス数格
納メモリ11に格納されたエンコーダのパルス数に基づ
いて、投光手段3RRを通過してからの移動体2の1パ
ルス当りの進行量dP、投光手段3FRを通過した時の
移動体2の走行路1に対するψm方位、走行路1に対す
る左右方向の位fit X mをそれぞれ演算する。
The arithmetic device 12 has a CPU and a RAM for calculating the above equations (1) to 11), and is constituted by an ordinary microcomputer, and includes a light projecting means 3FR stored in the constant storage memory 10 in advance. and 3RR, the angle α formed by the light emitting means 3FL and 3RL, the distance T and J between the light receiving means 5L and 5R, and the number of encoder pulses stored in the pulse number storage memory 11 while traveling. , the traveling distance dP of the moving body 2 per pulse after passing the light projecting means 3RR, the ψm direction of the moving body 2 with respect to the running path 1 when passing the light projecting means 3FR, and the horizontal direction with respect to the running path 1. The positions fit X m are calculated respectively.

出力手段13は、演算手段12の演算結果を表示するも
ので、CRT、プリンタ、フロッピーディスク、テープ
あるいはCD−ROM等を採用することができる。
The output means 13 is for displaying the calculation results of the calculation means 12, and can be a CRT, a printer, a floppy disk, a tape, a CD-ROM, or the like.

また、前記演算手段12の演算により得られた単位進行
量、走行路1に対する移動体2の方位ψm1あるいは走
行路1の左右方向の位置Xmに基づいて移動体2の位置
を修正することもできる。
Further, the position of the moving body 2 can be corrected based on the unit progress obtained by the calculation of the calculation means 12, the azimuth ψm1 of the moving body 2 with respect to the running route 1, or the position Xm in the left-right direction of the running route 1. .

以上、本発明の実施例を詳述したが、本発明は、前記実
施例に限定されるものではなく、特許請求の範囲に記載
された本発明を逸脱することなく、種々の設計変更を行
なうことが可能である。
Although the embodiments of the present invention have been described in detail above, the present invention is not limited to the embodiments described above, and various design changes can be made without departing from the scope of the invention described in the claims. Is possible.

たとえば、第2図に図示された走行路1における投光手
段3の配置を、第6図図示のごとく、走行路1を境にし
て反対にすることもできる。
For example, the arrangement of the light projecting means 3 on the running path 1 shown in FIG. 2 can be reversed with the running path 1 as a boundary, as shown in FIG.

また、移動体2が最初スタート時に1パルス当りの進行
量を演算していれば、第2図に図示された走行路1にお
ける投光手段3FL、3RLの光ビームのなす角度αを
第7図図示のごと(、投光手段3FR,3RRに対して
も同様に配置することもできる。すなわち、最初のスタ
ート時に1パルス当りの進行量を演算しておけば、次に
は1パルス当りの進行量は、移動体2の重量あるいはバ
ランスに変化がない限り演算する必要がないので、移動
体2の位置と方位とを求めて、移動体2の現在位置と方
位とを修正する場合には、第2図図示の投光手段3RR
は必要でなくなる。
If the moving body 2 calculates the amount of progress per pulse at the time of initial start, the angle α formed by the light beams of the light projecting means 3FL and 3RL on the traveling path 1 shown in FIG. 2 can be calculated as shown in FIG. As shown in the figure (it is also possible to arrange the light emitting means 3FR and 3RR in the same way. In other words, if the amount of progress per pulse is calculated at the first start, then the amount of progress per pulse can be calculated. There is no need to calculate the amount unless there is a change in the weight or balance of the moving body 2, so when determining the position and direction of the moving body 2 and correcting the current position and direction of the moving body 2, Light projecting means 3RR shown in Figure 2
is no longer necessary.

さらに、1パルス当りの進行量が演算されている場合に
は、第7図に図示されている投光手段3FR,3RR,
3FL、3RLの4個のうち3RL1または3RRのど
ちらかがあれば、移動体2の現在位置と方位とを修正す
ることができる。
Furthermore, when the amount of progress per pulse is calculated, the light projecting means 3FR, 3RR, shown in FIG.
If either 3RL1 or 3RR out of the four 3FL and 3RL exists, the current position and orientation of the moving body 2 can be corrected.

本発明の移動体2は、自動車あるいは無人車等の走行路
上を移動するものに限らず、ロボットのような平面基を
移動するものにも適用することができる。
The moving body 2 of the present invention is not limited to those that move on a running road, such as automobiles or unmanned vehicles, but can also be applied to those that move on a flat base, such as robots.

投光手段3FLおよび3RLは、同一のケースに収納す
ることができ、投光手段の設置場所は、地上、室内、あ
るいは柱、天井等いかなる所に取り付けても良い。
The light projecting means 3FL and 3RL can be housed in the same case, and the light projecting means may be installed anywhere, such as on the ground, indoors, on a pillar, or on the ceiling.

投光手段3の光ビームは、変調して周波数あるいはパル
ス幅を変え、またバイナリコードとして投光すると、走
行路の位置を移動体に知らせる位置情報、移動体の位置
、方位等を制御する制御情報、あるいは走行路を移動体
が走行する上に必要な道路情報として移動体で受光する
ことができる。
The light beam of the light projecting means 3 is modulated to change the frequency or pulse width, and when the light beam is projected as a binary code, position information that informs the moving object of the position of the traveling route, and control that controls the position, direction, etc. of the moving object is generated. The light can be received by a moving object as information or road information necessary for the moving object to travel on a travel route.

なお、移動体が高速で投光手段の前を通過し、あるいは
光ビームを妨害する物があっても、本発明のように複数
の投光手段を一組にしておき、複数の光ビームを移動体
の受光手段で受光して、この中から正しい情報を選択で
きるよう演算手段が演算できるようにプログラムしてお
けば良い。
Note that even if a moving object passes in front of the light projecting means at high speed or there is something that obstructs the light beam, multiple light projecting means can be combined into a set as in the present invention, and multiple light beams can be transmitted. The light may be received by the light receiving means of the moving object, and the calculating means may be programmed to perform calculations so that the correct information can be selected from among the received light.

以上、本発明の実施例を幾つか説明したが、いずれの例
も走行路に設けられた一対の投光手段は、走行路に対し
て直角である。しかし、投光手段を走行路に対して必ず
しも直角に設ける必要はなく、一対の投光手段が走行路
に対して角度を持って設けられても、その後の演算処理
によって実施例と同様な結果を得ることができる。
Several embodiments of the present invention have been described above, and in each example, the pair of light projection means provided on the running path is perpendicular to the running path. However, it is not necessary to provide the light projecting means at right angles to the running road. Even if the pair of light projecting means is provided at an angle to the running road, the same results as in the embodiment can be obtained by subsequent calculation processing. can be obtained.

〔発明の効果〕〔Effect of the invention〕

本発明によれば、決められた距離と角度に設置された投
光手段を有する走行路を設け、この走行路上を前記投光
手段の投光を受光する受光手段と単位進行量測定手段と
を有する移動体が走行するので、移動体の重量、走行路
の状態あるいは移動体の経年変化等に変化があっても、
単位進行量、走行路に対する方位あるいは走行路の左右
方向に対する現在位置を正確に知ることができる。
According to the present invention, a traveling path having light projecting means installed at a predetermined distance and angle is provided, and a light receiving means for receiving light emitted from the light projecting means and a unit progress measuring means are installed on this traveling path. Since the moving object with the moving object is moving, even if there are changes in the weight of the moving object, the condition of the traveling path, or the aging of the moving object,
It is possible to accurately know the unit amount of progress, the orientation with respect to the travel route, or the current position with respect to the left and right directions of the travel route.

本発明によれば、移動体が最初のスタート時に、1パル
ス当りの進行量を演算しておけば、その後は走行路に対
する方位あるいは現在位置を検出する投光手段だけを走
行路に設置すれば良いので、投光手段の設置場所が少な
く、また投光手段の製造が安価になる。
According to the present invention, if the moving distance per pulse is calculated when the moving body first starts, then only the light projecting means for detecting the direction or current position with respect to the traveling path is installed on the traveling path. Therefore, the installation space for the light projecting means is small, and the manufacturing cost of the light projecting means is also reduced.

本発明によれば、走行路に設置された投光手段の数より
、この走行路を利用する移動体の数の方が多い場合、た
とえば、高速道路、特定地域の一般道路、自動車教習所
、空港、工場内、倉庫内、遊園地、ゴルフ場等における
移動体には、投受光手段を設ける必要がなく、受光手段
だけですむので、移動体に搭載する機器が安価になる。
According to the present invention, when the number of moving objects using the driving path is greater than the number of light projecting means installed on the driving path, for example, expressways, general roads in a specific area, driving schools, airports, etc. It is not necessary to provide a light emitting/receiving means in a moving body in a factory, a warehouse, an amusement park, a golf course, etc., and only a light receiving means is required, so the equipment mounted on the moving body becomes inexpensive.

本発明によれば、投光手段の光ビームを変調して種々の
情報を持たせることができるので、移動体の制御情報あ
るいは運転情報とすることができる。
According to the present invention, the light beam of the light projecting means can be modulated to carry various information, so that it can be used as control information or driving information of a moving body.

【図面の簡単な説明】[Brief explanation of the drawing]

第1図は本発明の詳細な説明するブロック構成図、第2
図は本発明の一実施例における単位進行量および方位演
算説明図、第3図は本発明の一実施例における位置演算
説明図、第4図は本発明の一実施例に使用する投光手段
概略図、第5図は本発明の一実施例に使用する受光手段
説明図、第6図および第7図は本発明における他の実施
例説明図、第8図は、従来技術説明図である。 図中、 1・・・走行路    2・・・移動体3・・・投光手
段   4・・・光ビーム5・・・受光手段   7・
・・移動体進行方向8・・・進行量に比例したパルス発
生手段10・・・定数格納ROM 11・・・パルス数格納メモリ 12・・・演算手段 13・・・出力手段   14・・・送信手段15およ
び16・・・アンテナ 17・・・受信手段   18・・・制御駆動手段ψm
・ Xm  ・ ・・走行路に対する方位 ・・走行路における左右方向の位置 45モータ / 第 図 53受光回路 ^k   w 弔 b 図 1定行路 本発明における他の実施例説明図 Aジー 未 図 本発明における他の実施汐倣胡図 第 Δ
FIG. 1 is a block configuration diagram explaining the present invention in detail, and FIG.
The figure is an explanatory diagram of unit progress and direction calculation in an embodiment of the present invention, Figure 3 is an explanatory diagram of position calculation in an embodiment of the present invention, and Figure 4 is a light projecting means used in an embodiment of the present invention. Schematic diagram, FIG. 5 is an explanatory diagram of a light receiving means used in one embodiment of the present invention, FIGS. 6 and 7 are explanatory diagrams of other embodiments of the present invention, and FIG. 8 is an explanatory diagram of a prior art. . In the figure, 1... Travel path 2... Moving body 3... Light projecting means 4... Light beam 5... Light receiving means 7.
... Moving direction of movement 8 ... Pulse generation means proportional to the amount of movement 10 ... Constant storage ROM 11 ... Pulse number storage memory 12 ... Calculation means 13 ... Output means 14 ... Transmission Means 15 and 16... Antenna 17... Receiving means 18... Control driving means ψm
・Xm ・・Azimuth with respect to the running path・・Left-right position in the running path 45Motor/ Fig. 53 Light receiving circuit ^k w Condolence b Fig. 1 Regular traveling route Explanatory diagram of other embodiments of the present invention AG Unillustrated present invention Other implementations of the tide imitation Hu map No. Δ

Claims (7)

【特許請求の範囲】[Claims] (1)走行路1のいずれか一側に一定間隔で配置され、
走行路1に対して投光する一対の投光手段3と、 走行路1の他側で前記投光手段3に対向して、一定投光
角度αを有する一対の投光手段3′と、を備えたことを
特徴とする位置、方位、単位進行量を測定するための投
光手段を有する走行路。
(1) Arranged at regular intervals on either side of the running path 1,
a pair of light projecting means 3 that project light onto the traveling path 1; a pair of light projecting means 3' facing the light projecting means 3 on the other side of the traveling path 1 and having a constant projection angle α; A traveling path having a light projecting means for measuring position, direction, and unit progress.
(2)走行路の両側に、走行路に対して投光する一対の
投光手段と、 走行路の片側または両側に前記投光手段に対して一定角
度方向αに投光する投光手段と、を備えたことを特徴と
する位置、方位を測定するための投光手段を有する走行
路。
(2) A pair of light projecting means on both sides of the running path for projecting light onto the running path; and a light projecting means for projecting light in a direction α at a constant angle with respect to the light projecting means on one or both sides of the running path. A traveling path having a light projecting means for measuring position and direction.
(3)光ビームを変調して特定情報として投光すること
を特徴とする請求項1ないし2記載の投光手段を有する
走行路。
(3) A running path having a light projection means according to claim 1 or 2, characterized in that the light beam is modulated and projected as specific information.
(4)請求項1記載の投光手段3および3’の光ビーム
を受光する一対の受光手段5と、一対の進行量に比例し
たパルス発生手段8と、前記投光手段3および3’にお
ける一定間隔、角度αおよび前記一対の受光手段5の間
隔の各定数を格納したROM10と、 前記進行量に比例したパルス発生手段8によって得られ
たパルス数を格納するメモリ11と、前記ROM10に
格納されている定数と前記メモリ11に現在格納されて
いるパルス数とから1パルス当りの単位進行量、方位あ
るいは現在位置を演算する演算手段12と、該演算手段
12の出力を得ることができる出力手段13と、 を搭載したことを特徴とする位置、方位、単位進行量を
測定し得る移動体。
(4) A pair of light receiving means 5 for receiving the light beams of the light projecting means 3 and 3' according to claim 1, a pair of pulse generating means 8 proportional to the amount of travel of the light projecting means 3 and 3'; a ROM 10 that stores constants for a constant interval, an angle α, and an interval between the pair of light receiving means 5; a memory 11 that stores the number of pulses obtained by the pulse generating means 8 proportional to the amount of progress; a calculation means 12 for calculating the unit progress per pulse, direction or current position from the constant and the number of pulses currently stored in the memory 11; and an output from which the output of the calculation means 12 can be obtained. A moving body capable of measuring position, direction, and unit progress, characterized in that it is equipped with means 13 and.
(5)請求項3記載の変調された光ビームからなる特定
情報は、移動体2の受光手段3により受光されて、移動
体2の位置を検出することができる移動体。
(5) A moving object in which the specific information formed by the modulated light beam according to claim 3 is received by the light receiving means 3 of the moving object 2, and the position of the moving object 2 can be detected.
(6)移動体2が請求項1記載の走行路における投光手
段3および3’を通過した際に、移動体2に搭載した受
光手段5が前記投光手段3から投光された光ビームを受
光し、前記進行量に比例したパルス発生手段8から進行
距離に比例したパルスを発生させて、この値をパルス格
納メモリ11に格納し、この値と予め設定されている投
光器間距離および受光器間距離、投光器間角度とから前
記移動体2の左右の投光器間を結ぶ線上での位置および
方位を演算手段12により求めることを特徴とする移動
体位置および方位測定方法。
(6) When the moving body 2 passes through the light projecting means 3 and 3' on the traveling path according to claim 1, the light receiving means 5 mounted on the moving body 2 receives the light beam projected from the light projecting means 3. is received, a pulse proportional to the traveling distance is generated from the pulse generating means 8 proportional to the traveling distance, and this value is stored in the pulse storage memory 11, and this value and the preset distance between the projectors and the light receiving A method for measuring the position and direction of a moving object, characterized in that the position and direction on a line connecting the left and right projectors of the moving object 2 are determined by a calculating means 12 from the distance between the projectors and the angle between the projectors.
(7)移動体2が請求項1記載の走行路における投光手
段3および3’を通過した際に、移動体2に搭載した受
光手段5が前記投光手段3から投光された光ビームを受
光し、前記進行量に比例したパルス発生手段8から進行
距離に比例したパルスを発生させ、その後投光手段3お
よび3’から得られる実際に進行した距離と走行路1に
対する方位とを演算し、この値から前記1パルス当りの
移動体単位進行量を演算手段12により求めることを特
徴とする1パルス当りの移動体単位進行量測定方法。
(7) When the moving body 2 passes through the light projecting means 3 and 3' on the traveling path according to claim 1, the light receiving means 5 mounted on the moving body 2 receives the light beam projected from the light projecting means 3. receives the light, generates a pulse proportional to the traveling distance from the pulse generating means 8 proportional to the traveling amount, and then calculates the actual traveling distance obtained from the light projecting means 3 and 3' and the direction with respect to the traveling route 1. The method for measuring the unit progress of a moving body per pulse is characterized in that the unit progress of the moving body per pulse is determined from this value by the calculating means 12.
JP32772588A 1988-12-27 1988-12-27 Running path having light projecting means for measuring position, azimuth and unit advance quantity, and moving body which can measure position, azimuth and unit advance quantity, and measuring method for position, azimuth and unit advance quantity of moving body Pending JPH02173520A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP32772588A JPH02173520A (en) 1988-12-27 1988-12-27 Running path having light projecting means for measuring position, azimuth and unit advance quantity, and moving body which can measure position, azimuth and unit advance quantity, and measuring method for position, azimuth and unit advance quantity of moving body

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP32772588A JPH02173520A (en) 1988-12-27 1988-12-27 Running path having light projecting means for measuring position, azimuth and unit advance quantity, and moving body which can measure position, azimuth and unit advance quantity, and measuring method for position, azimuth and unit advance quantity of moving body

Publications (1)

Publication Number Publication Date
JPH02173520A true JPH02173520A (en) 1990-07-05

Family

ID=18202292

Family Applications (1)

Application Number Title Priority Date Filing Date
JP32772588A Pending JPH02173520A (en) 1988-12-27 1988-12-27 Running path having light projecting means for measuring position, azimuth and unit advance quantity, and moving body which can measure position, azimuth and unit advance quantity, and measuring method for position, azimuth and unit advance quantity of moving body

Country Status (1)

Country Link
JP (1) JPH02173520A (en)

Similar Documents

Publication Publication Date Title
EP0238615B1 (en) Method of navigating an automated guided vehicle
US4729660A (en) Position measuring apparatus of moving vehicle
US20110040482A1 (en) Lidars
WO2000071972A1 (en) Measuring angles of wheels using transition points of reflected laser lines
JPH0216484A (en) On-vehicle radar equipment
US6181993B1 (en) Four sensor system for wheel alignment
JPH0933642A (en) Vehicle circumference detecting device
JP4172882B2 (en) Method and equipment for detecting position of moving object
JPH02173520A (en) Running path having light projecting means for measuring position, azimuth and unit advance quantity, and moving body which can measure position, azimuth and unit advance quantity, and measuring method for position, azimuth and unit advance quantity of moving body
JPH08129064A (en) Apparatus for measuring distance between vehicles
Sutiarso et al. Trajectory control and its application to approach a target: Part II. Target approach experiments
JP2950974B2 (en) Moving object position detection device
JP2008232638A (en) System and method for position detection, optical beacon used for the same, and vehicle-mounted apparatus
JP2784481B2 (en) 2D position and direction measurement device for moving objects
JP2572641B2 (en) Light beam reflector, light emitting / receiving device thereof, moving object position detecting method and moving object traveling control method
JPH07128420A (en) Moving object position detecting device and moving object distance detecting device using the device
JP2739262B2 (en) Moving object position measurement device
JP2617392B2 (en) Direction, Position and Attitude Measurement of Moving Object Using Double Corner Cube and Double Corner Cube
JP2784480B2 (en) 2D position and direction measurement device for moving objects
JP2542257B2 (en) Position and heading measurement system for mobile
Sakai A data recording system of the path of a test vehicle by laser beam and some applications to steering handling test
JPS62187271A (en) Position measuring method for vehicle
JPH0363084B2 (en)
JPH0716165Y2 (en) Vehicle position / speed detector
SU1627447A1 (en) Method for installation of ship sections in building a ship on building slip