JPH0246961B2 - - Google Patents
Info
- Publication number
- JPH0246961B2 JPH0246961B2 JP57195142A JP19514282A JPH0246961B2 JP H0246961 B2 JPH0246961 B2 JP H0246961B2 JP 57195142 A JP57195142 A JP 57195142A JP 19514282 A JP19514282 A JP 19514282A JP H0246961 B2 JPH0246961 B2 JP H0246961B2
- Authority
- JP
- Japan
- Prior art keywords
- light
- light beam
- moving body
- rotation angle
- beam scanning
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Lifetime
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
- G05D1/0236—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons in combination with a laser
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
【発明の詳細な説明】
この発明は、移動体の自動操舵装置に関し、特
にたとえば自動車や工場内の無人移動搬送装置や
飛行機等のように平面や空間を移動する移動体に
自動操舵を行なう装置に関する。DETAILED DESCRIPTION OF THE INVENTION The present invention relates to an automatic steering device for a moving body, and particularly to a device for automatically steering a moving body that moves on a plane or space, such as a car, an unmanned mobile transport device in a factory, an airplane, etc. Regarding.
従来、自動車や工場内の無人移動搬送装置など
の移動体を自動操舵する方法として、たとえば移
動体が走行する路面上に軌道レールを敷設し、そ
の軌道レール上を走行させる方法があつた。この
ような方法は非常に大掛かりな施設を要し、高価
になるという欠点があつた。また、飛行機のよう
に空中を移動するものを自動操舵する方法とし
て、たとえば電波により誘導する方法などがあつ
た。しかし、このような方法では、誘導電波が電
波障害を受けたとき操舵不能となる欠点があつ
た。 BACKGROUND ART Conventionally, as a method for automatically steering a moving object such as an automobile or an unmanned transport device in a factory, there has been a method of, for example, laying a track rail on the road surface on which the moving object runs and having the moving object run on the track rail. This method has the drawback of requiring very large-scale facilities and being expensive. There is also a method for automatically steering an object moving in the air, such as an airplane, by using radio waves to guide the object. However, this method has the disadvantage that steering becomes impossible when the guided radio waves receive interference.
上述のような欠点を解消するために次のような
ことが考えられる。すなわち、入射光方向に光を
反射する複数の光反射手段を移動体の移動領域に
予め定められた軌跡に沿つて配列する。一方、移
動体からは所定の広がりを有する光ビームを発生
し、光反射手段が設けられた方向に回動走査させ
る。そして、光反射手段によつて反射された光ビ
ームを移動体で受光し、そのときの光ビームの回
動角度を検出する。この検出した回動角度は移動
体の進行方向と予め定められた軌跡とのずれに相
関する。したがつて、この検出した回動角度に基
づいて移動体の操舵方向を制御する。 In order to eliminate the above-mentioned drawbacks, the following can be considered. That is, a plurality of light reflecting means that reflect light in the direction of incident light are arranged along a predetermined locus in the movement area of the moving body. On the other hand, a light beam having a predetermined spread is generated from the moving body, and the light beam is rotated and scanned in the direction in which the light reflecting means is provided. Then, the light beam reflected by the light reflecting means is received by the moving body, and the rotation angle of the light beam at that time is detected. This detected rotation angle correlates with the deviation between the moving direction of the moving body and a predetermined trajectory. Therefore, the steering direction of the mobile body is controlled based on the detected rotation angle.
上述のような自動操舵装置は、従来の操舵シス
テムに比べて簡単かつ安価であり、また電波障害
により操舵不能となることもない。そして、光反
射手段は何ら電気的な装置や機械的な動作機構を
含んでいないため、ほとんど保守点検の必要がな
い。さらに、光反射手段は、同時に複数の移動体
で共用することができるなどの数多くの利点を有
する。 The automatic steering device as described above is simpler and cheaper than conventional steering systems, and does not become unable to steer due to radio wave interference. Furthermore, since the light reflecting means does not include any electrical device or mechanical operating mechanism, there is almost no need for maintenance and inspection. Furthermore, the light reflecting means has many advantages such as being able to be shared by multiple moving objects at the same time.
ところで、上述のような光ビームを用いた自動
操舵装置では、光反射手段から反射された光ビー
ムに基づいて角度情報のみを得るようにしている
が、光ビームからさらに他の情報を得ることがで
きれば一層有用でかつ用途の広い自動操舵装置が
得られるであろう。 Incidentally, in the above-mentioned automatic steering system using a light beam, only angle information is obtained based on the light beam reflected from the light reflecting means, but it is also possible to obtain other information from the light beam. This would hopefully result in a more useful and versatile autopilot system.
それゆえに、この発明の主たる目的は、上述の
ように光ビームを用いて自動操舵を行なう装置に
おいて、光反射手段から反射された光ビームから
各種情報が得られるような移動体の自動操舵装置
を提供することである。 Therefore, the main object of the present invention is to provide an automatic steering system for a moving object that can obtain various information from the optical beam reflected from the light reflecting means, in an apparatus that performs automatic steering using a light beam as described above. It is to provide.
この発明は、要約すれば、入射光方向に光を反
射する複数の光反射手段を移動体が移動すべきよ
うに予め定められた軌跡に沿つて配列し、また各
光反射手段には反射光を変調する変調手段を取付
ける。一方、移動体からは所定の広がりを有する
ビームを光反射手段方向に回動走査し、光反射手
段によつて反射される光ビームを受光し、そのと
きの光ビームの回動角度を検出する。そして、そ
の検出した回動角度に基づいて移動体の操舵方向
を制御する。また、受光した光ビームを復調して
その復調データを取込み、データの判別を行な
う。 In summary, this invention arranges a plurality of light reflecting means that reflect light in the direction of incident light along a predetermined locus so that a moving body should move, and each light reflecting means has a plurality of light reflecting means that reflect light in the direction of incident light. Install a modulation means to modulate the On the other hand, a beam having a predetermined spread is rotated and scanned from the moving body in the direction of the light reflection means, the light beam reflected by the light reflection means is received, and the rotation angle of the light beam at that time is detected. . Then, the steering direction of the moving body is controlled based on the detected rotation angle. It also demodulates the received light beam, captures the demodulated data, and discriminates the data.
この発明の上述の目的およびその他の目的と特
徴は、図面を参照して行なう以下の詳細な説明か
ら一層明らかとなろう。 The above objects and other objects and features of the present invention will become more apparent from the following detailed description with reference to the drawings.
第1図および第2図はこの発明の一実施例の原
理を説明するための図であり、特に、第1図は移
動体Vを側面から見た図であり、第2図は移動体
Vを正面から見た図である。図において、移動体
Vが走行する路面の上部の天井あるいは壁などに
光反射手段の一例のコーナキユーブCCが配列さ
れる。このコーナキユーブCCは移動体Vを移動
させるべき予め定められた軌跡に沿つて配列され
る。なお、コーナキユーブCCは直線上に配列さ
れてもよいし、第3図に示すように曲線の軌跡上
に配列されてもよい。ここで、コーナキユーブ
CCは、たとえば四面体のプリズムを複数個組合
わせることによつて構成される。そして、コーナ
キユーブCCは、入射した光の方向にその入射光
を反射するという光学的性質を有する。 1 and 2 are diagrams for explaining the principle of an embodiment of the present invention. In particular, FIG. 1 is a side view of the moving body V, and FIG. 2 is a diagram showing the moving body V. It is a figure seen from the front. In the figure, corner cubes CC, which are an example of light reflecting means, are arranged on the ceiling or wall above the road surface on which the moving body V runs. The corner cubes CC are arranged along a predetermined trajectory along which the moving body V is to be moved. Note that the corner cubes CC may be arranged on a straight line, or may be arranged on a curved locus as shown in FIG. Here, corner cube
The CC is constructed by, for example, combining a plurality of tetrahedral prisms. The corner cube CC has an optical property of reflecting the incident light in the direction of the incident light.
さらに、各コーナキユーブCCには、光変調手
段PMが設けられる。光変調手段としては、一番
簡単なものは、光を機械的に断続する方式のもの
である。たとえば、複数のスリツトが形成された
円板をコーナキユーブCCの前で回転させればよ
い。ほかに、ガルバノメータ方式、電気光学変調
としてのPockels効果、Kerr効果、磁気光学変調
としてのFaraday効果、あるいは音響光学変調効
果を利用するのもよい。 Furthermore, each corner cube CC is provided with a light modulation means PM. The simplest light modulation means is one that mechanically interrupts light. For example, a disk with a plurality of slits formed therein may be rotated in front of the corner cube CC. In addition, it is also good to use the galvanometer method, the Pockels effect as electro-optic modulation, the Kerr effect, the Faraday effect as magneto-optic modulation, or the acousto-optic modulation effect.
変調情報としては、種々のものが考えられる。
たとえば、各コーナキユーブCCの配列順に予め
番号を割当てておき、その番号を変調情報として
もよい。また、或る基準位置からの各コーナキユ
ーブCCの位置を表わす情報を変調情報としても
よい。 Various types of modulation information can be considered.
For example, a number may be assigned in advance to the arrangement order of each corner cube CC, and the number may be used as the modulation information. Furthermore, information representing the position of each corner cube CC from a certain reference position may be used as modulation information.
一方、移動体Vの上面には、ビームスキヤナ
BSが設けられる。そして、このビームスキヤナ
BSからは広がり角度φの光ビームPBが出射され
る。第2図に示すように、光ビームPBはビーム
スキヤナBSによつてたとえばθ1の角度範囲で回
動走査される。なお、光ビームPBの広がり角φ
は、光ビームPBの1回の回動走査で少なくとも
2つのコーナキユーブCCa,CCbに光が当たるよ
うな値に選ばれる。 On the other hand, a beam scanner is mounted on the top surface of the moving body V.
BS will be provided. And this beam scanner
A light beam PB with a spread angle φ is emitted from the BS. As shown in FIG. 2, the light beam PB is rotated and scanned by a beam scanner BS, for example, in an angular range of θ1. In addition, the spread angle φ of the light beam PB
is selected to a value such that at least two corner cubes CCa and CCb are illuminated by one rotational scan of the light beam PB.
ここで、ビームスキヤナBSは刻々の光ビーム
PBの回動走査角度を検出するためのたとえばロ
ータリエンコーダなどを有する。このロータリエ
ンコーダの基準角度はたとえばビームスキヤナ
BSの真上に選ばれる。さらに、ビームスキヤナ
BSには、コーナキユーブCCからの反射光を検出
するための受光手段が設けられる。たとえば、ビ
ームスキヤナBSから出射された光がコーナキユ
ーブCCaに当たると、コーナキユーブCCaは入射
光方向すなわちビームスキヤナBS方向に光ビー
ムPBを反射する。応じて、ビームスキヤナBSに
設けられた受光手段がコーナキユーブCCaからの
反射光を受光する。このときのロータリエンコー
ダの出力角度を読取れば、ロータリエンコーダの
基準角度に対するコーナキユーブCCaの開き角θa
を求めることができる。同様に、ロータリエンコ
ーダの基準角度に対するコーナキユーブCCbの開
き角θbが求められる。 Here, the beam scanner BS scans the light beam every moment.
It has, for example, a rotary encoder for detecting the rotational scanning angle of the PB. The reference angle of this rotary encoder is, for example, a beam scanner.
Selected right above BS. In addition, beam scanner
The BS is provided with light receiving means for detecting reflected light from the corner cube CC. For example, when light emitted from the beam scanner BS hits the corner cube CCa, the corner cube CCa reflects the light beam PB in the direction of the incident light, that is, in the direction of the beam scanner BS. Accordingly, the light receiving means provided in the beam scanner BS receives the reflected light from the corner cube CCa. If you read the output angle of the rotary encoder at this time, you can find the opening angle θa of the corner cube CCa with respect to the reference angle of the rotary encoder.
can be found. Similarly, the opening angle θb of the corner cube CCb with respect to the reference angle of the rotary encoder is determined.
上述のようにして求められた開き角θaおよび
θbが0でない場合は、移動体Vの進行方向がコ
ーナキユーブCCaとCCbとを結ぶ線分(予め定め
られた軌跡)に対してずれているときである。も
し、移動体Vの進行方向がコーナキユーブCCaと
CCbとを結ぶ線分と一致した関係にあれば、開き
角θaおよびθbはいずれも0となる。そこで、上
述のようにして求めた開き角θaおよびθbをいず
れも0にするように、移動体Vの操舵方向を制御
すれば、移動体VをコーナキユーブCCが配列さ
れた軌跡に沿つて走行させることができる。 If the opening angles θa and θb obtained as described above are not 0, it means that the moving direction of the moving body V is deviated from the line segment (predetermined trajectory) connecting the corner cubes CCa and CCb. be. If the moving direction of the moving object V is the corner cube CCa,
If there is a relationship that matches the line segment connecting CCb, both opening angles θa and θb will be 0. Therefore, if the steering direction of the moving body V is controlled so that the opening angles θa and θb obtained as described above are both 0, the moving body V can be made to travel along the trajectory in which the corner cubes CC are arranged. be able to.
第4図はこの発明の一実施例に用いられるビー
ムスキヤナBSの外観図である。図において、円
筒1には、スリツト2が形成され、このスリツト
2から光ビームPBが出射される。また、スリツ
ト2の両側部には、前述のコーナキユーブCCか
らの反射光を受光するための受光部3および4が
設けられる。これら受光部3および4としては、
各種光電変換素子が用いられる。円筒1には、ロ
ータリエンコーダEC1およびモータM1が連結
される。モータM1の回転は円筒1に伝達され、
この円筒1を回動させる。すなわち、モータM1
は円筒1を回動させることによつて光ビームPB
を回動走査させる。また、ロータリエンコーダ
EC1はモータM1かつしたがつて光ビームPBの
回動角度を検出する。 FIG. 4 is an external view of a beam scanner BS used in an embodiment of the present invention. In the figure, a slit 2 is formed in a cylinder 1, and a light beam PB is emitted from this slit 2. Further, on both sides of the slit 2, light receiving sections 3 and 4 are provided for receiving the reflected light from the corner cube CC mentioned above. These light receiving sections 3 and 4 are as follows:
Various photoelectric conversion elements are used. A rotary encoder EC1 and a motor M1 are connected to the cylinder 1. The rotation of motor M1 is transmitted to cylinder 1,
This cylinder 1 is rotated. That is, motor M1
is the light beam PB by rotating the cylinder 1.
Rotate and scan. Also, rotary encoder
EC1 detects the rotation angle of motor M1 and therefore of light beam PB.
上述の円筒1およびモータM1は保持部材5に
よつて保持される。特に、円筒1は保持部材5に
よつて回動自在に保持され、モータM1は固定的
に保持される。この保持部材5には、ロータリエ
ンコーダEC2およびモータM2が連結される。
モータM2は保持部材5を回動させるが、これに
よつて円筒1、ロータリエンコーダEC1および
モータM1はモータM1による回動面とは直交す
る面上で回動される。また、ロータリエンコーダ
EC2はモータM2の回動角度を検出する。 The cylinder 1 and motor M1 described above are held by a holding member 5. In particular, the cylinder 1 is rotatably held by the holding member 5, and the motor M1 is held fixedly. A rotary encoder EC2 and a motor M2 are connected to this holding member 5.
The motor M2 rotates the holding member 5, which causes the cylinder 1, rotary encoder EC1, and motor M1 to rotate on a plane perpendicular to the plane of rotation by the motor M1. Also, rotary encoder
EC2 detects the rotation angle of motor M2.
第5図は第4図における線X−Xに沿う断面図
である。図において、円筒1の内周壁には、半導
体レーザ11が設けられる。この半導体レーザ1
1から出射したレーザ光はレンズ13によつて拡
散され、さらにレンズ14によつて平行光とされ
る。この平行光はスリツト2近傍に設けられたレ
ンズ15によつて拡散される。このレンズ15は
第4図に示すように、スリツト2の長手方向にの
み光を拡散させる。したがつて、レンズ15はそ
の横断面形状が長方形であり、その縦断面にのみ
凹曲面を有する。このようにして、スリツト2の
長手方向に広がりを有する光ビームPBがスリツ
ト2から外部へ出射される。なお、受光部3およ
び4は、コーナキユーブCCから反射された光を
受光すためのものであるが、これらに代えてビー
ムスプリツタ16と、このビームスプリツタ16
によつて反射されるコーナキユーブCCからの光
を受光する受光部17とを設けるようにしてもよ
い。 FIG. 5 is a sectional view taken along line XX in FIG. 4. In the figure, a semiconductor laser 11 is provided on the inner peripheral wall of a cylinder 1. This semiconductor laser 1
The laser beam emitted from the laser beam 1 is diffused by a lens 13, and further converted into parallel light by a lens 14. This parallel light is diffused by a lens 15 provided near the slit 2. This lens 15 diffuses light only in the longitudinal direction of the slit 2, as shown in FIG. Therefore, the lens 15 has a rectangular cross-sectional shape and has a concave curved surface only in its vertical cross-section. In this way, the light beam PB that spreads in the longitudinal direction of the slit 2 is emitted from the slit 2 to the outside. Note that the light receiving sections 3 and 4 are for receiving the light reflected from the corner cube CC, but instead of these, a beam splitter 16 and a beam splitter 16 are provided.
A light receiving section 17 may be provided to receive light from the corner cube CC reflected by the corner cube CC.
上述のような構成において、ロータリエンコー
ダEC1の基準角度は移動体Vの真上に選ばれる。
ロータリエンコーダEC2の基準角度は移動体V
の直進方向に選ばれる。また、モータM1はモー
タM2に比べて充分速く回動される。 In the above configuration, the reference angle of the rotary encoder EC1 is selected to be directly above the moving body V.
The reference angle of rotary encoder EC2 is the moving object V.
is selected in the straight direction. Furthermore, the motor M1 is rotated sufficiently faster than the motor M2.
第6図はこの発明の一実施例の好ましいブロツ
ク図である。図において、ORゲート60には、
受光部3および4からの受光出力が与えられる。
このORゲート60の出力は、ANDゲート61お
よび62のそれぞれの一方入力に与えられる。
ANDゲート61の他方入力には、ロータリエン
コーダEC1からの角度出力が与えられる。した
がつて、ANDゲート61からは第2図で説明し
たθaあるいはθbが出力される。このANDゲート
61の出力(以下θαと称す)はCPU63に与え
られる。一方、ANDゲート62の他方入力には、
ロータリエンコーダEC2からの角度出力が与え
られる。したがつて、ANDゲート62からは、
受光部3あるいは4から受光出力があつたときに
おけるロータリエンコーダEC2の回動角度が出
力される。このANDゲート62の出力(θβと称
す)はCPU63に与えられる。 FIG. 6 is a preferred block diagram of one embodiment of the present invention. In the figure, the OR gate 60 includes
Light receiving outputs from light receiving sections 3 and 4 are given.
The output of this OR gate 60 is given to one input of each of AND gates 61 and 62.
The other input of the AND gate 61 is given the angle output from the rotary encoder EC1. Therefore, θa or θb explained in FIG. 2 is output from the AND gate 61. The output of this AND gate 61 (hereinafter referred to as θα) is given to the CPU 63. On the other hand, the other input of the AND gate 62 has
The angle output from rotary encoder EC2 is given. Therefore, from AND gate 62,
The rotation angle of the rotary encoder EC2 when the light receiving output is received from the light receiving section 3 or 4 is output. The output of this AND gate 62 (referred to as θβ) is given to the CPU 63.
また、受光部3および4からの受光出力は復調
回路70に与えられる。復調回路70は、受光出
力を復調し、その復調したデータをCPU63に
与える。 Further, the light receiving outputs from the light receiving sections 3 and 4 are given to a demodulation circuit 70. The demodulation circuit 70 demodulates the received light output and provides the demodulated data to the CPU 63.
さらに、CPU63には、モータM1を駆動す
るためのM1駆動回路64からモータM1の回転
方向切換信号が与えられられる。この回転方向切
換信号は、たとえばモータM1を正転させるとき
はハイレベルであり、逆転させるときはローレベ
ルであるような信号である。同様に、CPU63
には、モータM2を駆動させるためのM2駆動回
路65からモータM2の回転方向切換信号が与え
られる。 Further, the CPU 63 is given a rotation direction switching signal for the motor M1 from an M1 drive circuit 64 for driving the motor M1. This rotational direction switching signal is, for example, a signal that is at a high level when rotating the motor M1 in the forward direction, and is at a low level when rotating the motor M1 in the reverse direction. Similarly, CPU63
A rotation direction switching signal for the motor M2 is given from an M2 drive circuit 65 for driving the motor M2.
さらに、CPU63には、タイマ66、操舵用
モータ67、ROM68およびRAM69が接続
される。後述するように、この実施例では、移動
体Vの操舵制御を2つのフアクタに基づいて交互
に行なうようにしているが、タイマ66はそのう
ちの1つのフアクタに基づく操舵制御における操
舵時間を規制するために用いられる。操舵用モー
タ67は移動体Vの操舵方向を制御するためのモ
ータである。ROM68には、たとえば第9図な
いし第12図に示すようなCPU63の動作プロ
グラムが格納される。RAM69は、各種処理デ
ータを記憶するが、特にこの実施例に興味ある記
憶領域として、カウンタ69aと、θxレジスタ
69bと、θyレジスタ69cと、θFレジスタ69
dとを含む。 Furthermore, a timer 66, a steering motor 67, a ROM 68, and a RAM 69 are connected to the CPU 63. As will be described later, in this embodiment, the steering control of the moving body V is performed alternately based on two factors, and the timer 66 regulates the steering time in the steering control based on one of the factors. used for The steering motor 67 is a motor for controlling the steering direction of the moving body V. The ROM 68 stores operating programs for the CPU 63 as shown in FIGS. 9 to 12, for example. The RAM 69 stores various processing data, but the storage areas that are particularly interesting in this embodiment include a counter 69a, a θx register 69b, a θy register 69c, and a θF register 69.
d.
第7図および第8図はこの発明の一実施例の操
舵制御態様を説明するための図解図である。ま
た、第9図ないし第12図はCPU63の動作を
説明するためのフローチヤートであり、特に第9
図は自動操舵制御のためのメインフローを示し、
第10図および第11図は第9図におけるサブル
ーチンを示す。また、第12図は復調データの判
別動作を示す。 FIG. 7 and FIG. 8 are illustrative diagrams for explaining the steering control mode of an embodiment of the present invention. 9 to 12 are flowcharts for explaining the operation of the CPU 63, and in particular, FIG.
The figure shows the main flow for automatic steering control,
10 and 11 show the subroutine in FIG. 9. Further, FIG. 12 shows an operation for determining demodulated data.
以下、第1図ないし第12図を参照してこの発
明の一実施例の動作について説明する。 The operation of one embodiment of the present invention will be described below with reference to FIGS. 1 to 12.
まず、第9図のステツプ(図示ではSと略す)
1において、θxが検出される。θxは、第7図に
示されるように、コーナキユーブCCaCCbとを結
ぶ線分に対して移動体Vの直進方向がなす角度で
ある。ステツプ1におけるサブルーチンの詳細は
第10図に示される。 First, the steps in Figure 9 (abbreviated as S in the illustration)
1, θx is detected. As shown in FIG. 7, θx is the angle that the straight direction of the moving body V makes with the line segment connecting the corner cube CCaCCb. Details of the subroutine in step 1 are shown in FIG.
第10図において、ステツプ101では、ANDゲ
ート61から出力θαがあつたか否かが判断され
る。もし、出力θαがあれば、ステツプ102におい
て、ANDゲート62からの出力θβが読取られ、
RAM69に記憶される。次に、ステツプ103に
おいて、カウンタ69aが+1される。そして、
ステツプ104に進む。このステツプ104では、M1
駆動回路64からの回転方向切換信号に基づい
て、モータM1の回転方向が切換わつたか否かが
判断される。このステツプ104において、モータ
M1の回転方向の切換えが判断されなければ、再
びステツプ101以下の動作が繰返される。すなわ
ち、ステツプ101ないし104では、モータM1によ
る光ビームPBの1走査の間にコーナキユーブCC
から何回反射光を受光したかを検出している。一
方、ステツプ104において、モータM1の回転方
向の切換えが判断されると、ステツプ105に進む。
このステツプ105では、カウンタ69aの計数値
が1であるか否かが判断される。今、移動体Vの
直進方向がコーナキユーブCCaとCCbとを結ぶ線
分に対して平行でない場合を想定する。この場
合、コーナキユーブCCaからの反射光を受光する
タイミングとコーナキユーブCCbからの反射光を
受光するタイミングとがずれるため、モータM1
が光ビームPBを1回走査する間に得られる受光
出力は2個である。これに対し、移動体Vの直進
方向がコーナキユーブCCaとCCbとを結ぶ線分と
平行である場合は、コーナキユーブCCaからの反
射光を受光するタイミングとコーナキユーブCCb
からの反射光を受光するタイミングとはほぼ同じ
になる。したがつて、この場合モータM1が光ビ
ームPBを1回走査する間に得られる受光出力は
1個である。すなわち、ステツプ105では、カウ
ンタ69aの計数値が1であるか否かを判断する
ことによつて、移動体Vの直進方向がコーナキユ
ーブCCaとCCbとを結ぶ線分と平行であるか否か
を検出している。ステツプ105においてカウンタ
69aの計数値が1でないことが判断されると、
ステツプ106においてカウンタ69aがクリアさ
れる。その後、再びステツプ101以下の動作が繰
返される。これらステツプ101ないし106の動作の
繰返しによつて、カウンタ69aの計数値が1に
なると、ステツプ107においてθβがθxレジスタ6
9bに記憶される。なお、ここでθxレジスタ6
9bに記憶されるθβは光ビームPBの広がり方向
がコーナキユーブCCaとCCbとを結ぶ線分と平行
になつたときのロータリエンコーダEC2の角度
出力である。 In FIG. 10, in step 101, it is determined whether or not the output θα is received from the AND gate 61. If there is an output θα, then in step 102 the output θβ from the AND gate 62 is read;
It is stored in RAM69. Next, in step 103, the counter 69a is incremented by one. and,
Proceed to step 104. In this step 104, M1
Based on the rotation direction switching signal from the drive circuit 64, it is determined whether the rotation direction of the motor M1 has been switched. If it is not determined in step 104 that the rotational direction of the motor M1 should be changed, the operations from step 101 onward are repeated again. That is, in steps 101 to 104, during one scan of the light beam PB by the motor M1, the corner cube CC is
It detects how many times the reflected light is received. On the other hand, if it is determined in step 104 that the direction of rotation of the motor M1 should be changed, the process proceeds to step 105.
In step 105, it is determined whether the count value of the counter 69a is 1 or not. Now, assume that the straight direction of the moving body V is not parallel to the line segment connecting the corner cubes CCa and CCb. In this case, since the timing of receiving the reflected light from the corner cube CCa and the timing of receiving the reflected light from the corner cube CCb are different, the motor M1
The number of received light outputs obtained during one scan of the light beam PB is two. On the other hand, if the straight direction of the moving body V is parallel to the line segment connecting the corner cubes CCa and CCb, the timing of receiving the reflected light from the corner cube CCa and the corner cube CCb
The timing is almost the same as the timing at which the reflected light is received. Therefore, in this case, the number of received light outputs obtained while the motor M1 scans the light beam PB once is one. That is, in step 105, by determining whether the count value of the counter 69a is 1, it is determined whether the straight direction of the moving body V is parallel to the line segment connecting the corner cubes CCa and CCb. Detected. When it is determined in step 105 that the count value of the counter 69a is not 1,
In step 106, counter 69a is cleared. Thereafter, the operations starting from step 101 are repeated again. By repeating the operations in steps 101 to 106, when the count value of the counter 69a becomes 1, in step 107, θβ is changed to θx register 69a.
9b. Note that here, θx register 6
θβ stored in 9b is the angular output of the rotary encoder EC2 when the spreading direction of the light beam PB becomes parallel to the line segment connecting the corner cubes CCa and CCb.
再び第9図を参照して、ステツプ1の動作の
後、ステツプ2においてθxが0か否かが判断さ
れる。もし、θxが0でなければ、ステツプ3に
進む。このステツプ3では、θxに基づいて操舵
用モータ67による移動体Vの操舵が行なわれ
る。なお、このステツプ3における操舵では、た
とえばθxの正負に応じて操舵用モータ67を正
転あるいは逆転させる。また、θxの大きさに応
じて操舵用モータ67の回動角度を制御する。次
に、ステツプ4において、θxレジスタ69bが
クリアされる。その後、ステツプ1以下の動作が
繰返される。 Referring again to FIG. 9, after the operation in step 1, it is determined in step 2 whether θx is 0 or not. If θx is not 0, proceed to step 3. In step 3, the moving body V is steered by the steering motor 67 based on θx. In the steering in step 3, the steering motor 67 is rotated forward or reverse depending on, for example, whether θx is positive or negative. Further, the rotation angle of the steering motor 67 is controlled according to the magnitude of θx. Next, in step 4, the θx register 69b is cleared. Thereafter, the operations from step 1 onwards are repeated.
ステツプ3における操舵によつて、移動体Vの
直進方向がコーナキユーブCCaとCCbとを結ぶ線
分と平行になると、θxは0となる。そのことが
ステツプ2において判断され、ステツプ5におい
てタイマ66がスタートされる。次に、ステツプ
6において、θyが検出される。このθyはロータ
リエンコーダEC1の基準角度に対するコーナキ
ユーブCCa(あるいはCCb)からの反射光の開き
角である。なお、ステツプ6の動作に進む場合
は、ステツプ1ないし5の動作において既に移動
体Vの直進方向がコーナキユーブCCaとCCbとを
結ぶ線分と平行にされているため、コーナキユー
ブCCaの反射光の開き角とコーナキユーブCCbか
らの反射光の開き角とは等しくなつている。ここ
で、ステツプ6のサブルーチンの詳細は第11図
に示される。 As a result of the steering in step 3, when the straight direction of the moving body V becomes parallel to the line segment connecting the corner cubes CCa and CCb, θx becomes 0. This is determined in step 2 and timer 66 is started in step 5. Next, in step 6, θy is detected. This θy is the opening angle of the reflected light from the corner cube CCa (or CCb) with respect to the reference angle of the rotary encoder EC1. In addition, when proceeding to the operation of step 6, since the straight direction of the moving body V has already been made parallel to the line segment connecting the corner cubes CCa and CCb in the operations of steps 1 to 5, the difference in the reflected light of the corner cube CCa is The angle and the opening angle of the reflected light from the corner cube CCb are equal. Here, details of the subroutine of step 6 are shown in FIG.
次に、第11図を参照して、ステツプ111では
θαが読取られる。そして、ステツプ112に進む。
このステツプ112では、θαからθFレジスタ69d
に予め設定された角度θFが減算される。続いて、
ステツプ113において、ステツプ112における減算
結果がθyレジスタ69cに記憶される。 Next, referring to FIG. 11, in step 111, θα is read. Then, proceed to step 112.
In this step 112, from θα to θF register 69d
A preset angle θ F is subtracted from . continue,
At step 113, the result of the subtraction at step 112 is stored in the θy register 69c.
再び第9図を参照して、ステツプ7では、θy
レジスタ69cに記憶された角度θyに基づいて
操舵用モータ67が制御される。すなわち、ステ
ツプ7では、θyが0になる方向に操舵用モータ
67が制御される。したがつて、θFが0に設定さ
れているときは、移動体Vは各コーナキユーブ
CCを結ぶ線分の真下を走るように制御される。
これに対し、θFが正あるいは負のいずれかの値に
設定されているときは、移動体Vは各コーナキユ
ーブCCを結ぶ線分の右下あるいは左下を走るよ
うに制御される。次に、ステツプ8において、タ
イマ66がタイムアツプしたか否かが判断され
る。もし、タイマ66がタイムアツプしていなけ
れば、ステツプ7の動作が繰返される。ステツプ
7の動作が何回か行なわれた後ステツプ8におい
てタイマ66のタイムアツプが判断されると、ス
テツプ9においてθyレジスタ69cに記憶され
た角度θyがクリアされる。これらステツプ5な
いし9の操舵制御において、移動体Vは予め定め
られた軌跡にさらに近付けられる。 Referring again to FIG. 9, in step 7, θy
The steering motor 67 is controlled based on the angle θy stored in the register 69c. That is, in step 7, the steering motor 67 is controlled in the direction in which θy becomes zero. Therefore, when θ F is set to 0, the moving body V
It is controlled to run directly under the line segment connecting the CCs.
On the other hand, when θ F is set to either a positive or negative value, the moving body V is controlled to run on the lower right or lower left of the line segment connecting each corner cube CC. Next, in step 8, it is determined whether the timer 66 has timed up. If the timer 66 has not timed up, the operation of step 7 is repeated. After the operation in step 7 has been performed several times, it is determined in step 8 that the timer 66 has timed up, and in step 9 the angle θy stored in the θy register 69c is cleared. In the steering control of steps 5 to 9, the moving body V is brought closer to a predetermined trajectory.
上述のごとくこの実施例では、まず移動体Vが
予め定められた軌跡に平行になるように制御さ
れ、さらに次の段階で移動体Vが予め定められた
軌跡に近付くように制御される。このような交互
の制御を行なうと、移動体Vの走行軌跡は第3図
の1点鎖線Tで示すようにジグザグを描きながら
予め定められた軌跡に近付きその後予め定められ
た軌跡を追従する。 As described above, in this embodiment, the moving body V is first controlled so as to be parallel to a predetermined trajectory, and then in the next step, the moving body V is controlled so as to approach the predetermined trajectory. When such alternating control is performed, the travel trajectory of the moving body V approaches a predetermined trajectory while drawing a zigzag as shown by the dashed line T in FIG. 3, and then follows the predetermined trajectory.
次に、第12図を参照して復調データの判別動
作について説明する。なお、この第12図の動作
は、たとえば割込動作として処理される。すなわ
ち、復調回路70から復調出力があるとこの第1
2図の動作が行なわれる。 Next, the operation for determining demodulated data will be explained with reference to FIG. Note that the operation shown in FIG. 12 is processed as, for example, an interrupt operation. That is, when there is a demodulated output from the demodulating circuit 70, this first
The operation shown in FIG. 2 is performed.
まず、ステツプ201において、復調回路70か
ら復調データが取込まれる。そして、ステツプ
202において、取込んだ復調データに基づいてコ
ーナキユーブ(反射光を受光したもの)の番号が
判別される。すなわち、この実施例では、予め各
コーナキユーブCCに配列順に番号が割当てられ、
各コーナキユーブCCに取付けられた変調手段
PMはその番号を表わす情報を変調情報として反
射光を変調する。続いて、ステツプ203では、移
動体VがコーナキユーブCCの番号順に走行して
いるか否かが判断される。もし、移動体Vがコー
ナキユーブCCの番号順に走行してしなければ、
移動体Vが予め定められた軌跡に沿つて走行して
いないとみなし、ステツプ204において図示しな
い表示記やブザーから警報が発生される。一方、
移動体VがコーナキユーブCCの番号順に走行し
ている場合は、再びステツプ201以下の動作が繰
返される。 First, in step 201, demodulated data is taken in from the demodulation circuit 70. And step
At 202, the number of the corner cube (the one that received the reflected light) is determined based on the captured demodulated data. That is, in this embodiment, a number is assigned to each corner cube CC in advance in order of arrangement,
Modulation means installed in each corner cube CC
The PM modulates the reflected light using information representing the number as modulation information. Subsequently, in step 203, it is determined whether the moving objects V are traveling in numerical order of the corner cubes CC. If the moving object V does not travel in the numerical order of the corner cube CC,
It is assumed that the moving body V is not traveling along a predetermined trajectory, and in step 204 a warning is generated from a display or a buzzer (not shown). on the other hand,
If the moving objects V are traveling in the numerical order of the corner cubes CC, the operations from step 201 onwards are repeated again.
なお、第12図に示した処理動作は、この発明
の一例にすぎず、反射光の変調情報に応じて種々
の処理および制御が行なえることを指摘してお
く。たとえば、変調情報として各光反射手段の位
置情報を含めれば、その情報に基づいて移動体V
が軌跡のどのあたりを走行しているかを知ること
ができる。また、復調回路70から所定のデータ
が得られたときのみロータリエンコーダEC1,
EC2からのデータを読込むようにすれば、光反
射手段以外からの光を受光してもそのときの回動
角度は読込まれず、誤動作を防止することができ
る。 It should be noted that the processing operation shown in FIG. 12 is only one example of the present invention, and that various processing and control can be performed depending on the modulation information of the reflected light. For example, if position information of each light reflecting means is included as modulation information, the moving object
You can see where along the trajectory the vehicle is traveling. Further, only when predetermined data is obtained from the demodulation circuit 70, the rotary encoder EC1,
By reading data from the EC2, even if light is received from a source other than the light reflecting means, the rotation angle at that time will not be read, and malfunctions can be prevented.
第13図はこの発明の他の実施例を示す図解図
である。この実施例では、コーナキユーブCCが
群単位にまとめられ、各群はそれぞれがかなり長
い距離を隔てて設けられる。今、移動多Vが第1
群のコーナキユーブCCの下を通過しているとす
ると、移動体Vは第1群のコーナキユーブCCか
らの反射光に基づいて操舵制御される。ところ
が、移動体Vが第1群のコーナキユーブCCを通
過してしまうと、第1群のコーナキユーブCCか
らの反射光が得られなくなつてしまう。そこで、
この実施例では、ビームスキヤナBS′を移動体V
の走行方向に傾けることによつて第2群のコーナ
キユーブCCに光ビームPBを投射して操舵制御を
行なうようにしている。 FIG. 13 is an illustrative view showing another embodiment of the invention. In this embodiment, the corner cubes CC are grouped into groups, and each group is separated by a fairly long distance. Now, mobile V is the first
Assuming that the moving body V is passing under the corner cube CC of the first group, the moving body V is steered based on the reflected light from the corner cube CC of the first group. However, when the moving object V passes through the first group of corner cubes CC, it becomes impossible to obtain reflected light from the first group of corner cubes CC. Therefore,
In this embodiment, the beam scanner BS' is connected to a moving body V
By tilting the vehicle in the direction of travel, a light beam PB is projected onto the corner cube CC of the second group to perform steering control.
第14図および第15図は第13図に示すビー
ムスキヤナBS′の外観図であり、特に第14図は
移動体Vの側面から見た図であり、第15図は移
動体Vの正面から見た図である。図において、こ
のビームスキヤナBS′は第4図と同様に半導体レ
ーザや光学系が収納された円筒1と、この円筒1
を直接回動させるためのモータM1と、モータM
1の回動角度を検出するためのロータリエンコー
ダEC1とを含む。円筒1およびモータM1は保
持部材50によつて保持される。この保持部材5
0の底辺中央部はモータM3およびロータリエン
コーダEC3に連結される。モータM3は保持部
材50を回動させて、第13図に示すように光ビ
ームPBを傾ける。ロータリエンコーダEC3はモ
ータM3の回動角度を検出する。モータM3およ
びロータリエンコーダEC3は保持部材51によ
つて保持される。この保持部材51の底面にはロ
ータリエンコーダEC2とモータM2とが連結さ
れる。モータM2は第4図に示すモータM2と同
様に、移動体Vの移動面と平行な面上で保持部材
51を回動させる。ロータリエンコーダEC2は
モータM2の回動角度を検出する。 14 and 15 are external views of the beam scanner BS' shown in FIG. 13, in particular, FIG. 14 is a view seen from the side of the moving body V, and FIG. This is a diagram. In the figure, this beam scanner BS' consists of a cylinder 1 that houses a semiconductor laser and an optical system, and a cylinder 1 that houses a semiconductor laser and an optical system, as in FIG.
Motor M1 for directly rotating the motor
and a rotary encoder EC1 for detecting the rotation angle of 1. The cylinder 1 and the motor M1 are held by a holding member 50. This holding member 5
0 is connected to a motor M3 and a rotary encoder EC3. The motor M3 rotates the holding member 50 to tilt the light beam PB as shown in FIG. Rotary encoder EC3 detects the rotation angle of motor M3. Motor M3 and rotary encoder EC3 are held by holding member 51. A rotary encoder EC2 and a motor M2 are connected to the bottom surface of this holding member 51. Similarly to the motor M2 shown in FIG. 4, the motor M2 rotates the holding member 51 on a plane parallel to the plane of movement of the moving body V. Rotary encoder EC2 detects the rotation angle of motor M2.
上述のごとくの構成で、第1群のコーナキユー
ブCCからの反射光が得られなくなれば、モータ
M3を回動させて光ビームPBを第2群のコーナ
キユーブCCに投射させる。その他の動作は、第
4図の実施例とほぼ同様であり、その詳細な説明
を省略する。 With the configuration as described above, if the reflected light from the corner cube CC of the first group is no longer obtained, the motor M3 is rotated to project the light beam PB onto the corner cube CC of the second group. Other operations are almost the same as those in the embodiment shown in FIG. 4, and detailed explanation thereof will be omitted.
上述したこの発明の他の実施例によれば、コー
ナキユーブCCの設置個数を減らすことができ、
設備費の低減を図ることができる。なお、このよ
うな実施例はたとえばトンネル内における自動車
の操舵制御に特に有効となろう。この場合、トン
ネル内の事故発生を表わす情報を反射光の変調情
報に含ませ、移動体Vでその情報を判別したとき
警報発生や走行停止制御を行なうようにすること
もできる。 According to the other embodiments of the invention described above, the number of corner cube CCs installed can be reduced;
Equipment costs can be reduced. Incidentally, such an embodiment would be particularly effective for controlling the steering of an automobile in a tunnel, for example. In this case, it is also possible to include information indicating the occurrence of an accident in the tunnel in the modulation information of the reflected light, and to issue an alarm or perform travel stop control when the moving object V determines this information.
なお、以上の説明では、1台の移動体Vの操舵
制御について示したが、コーナキユーブCCは複
数台の移動体Vによつて同時に共用されることが
可能である。たとえば、複数のレーンがある道路
では、いずれかのレーンの上部に1列だけコーナ
キユーブを配列しておけばよい。その場合、各レ
ーンを走る移動体Vで設定されるθFを各レーンに
見合うように異ならせて設定しておけばよい。 Note that although the above explanation has been about the steering control of one moving body V, the corner cube CC can be shared by a plurality of moving bodies V at the same time. For example, on a road with multiple lanes, it is sufficient to arrange only one row of corner cubes at the top of any lane. In that case, θ F set for the moving object V running in each lane may be set differently to suit each lane.
また、以上の説明では、主として地上を走行す
る移動体について説明したが、この発明は飛行機
など空中を飛行する移動体にも適用することがで
きる。この場合、地上(たとえば滑走路)に光反
射手段を配列し、移動体から地上の光反射手段に
向けて光ビームを回動走査すればよい。なお、こ
の場合、移動体にローリング(移動体の移動方向
を軸とし、その軸に対する移動体の回転)がある
ときは、地上に対するロータリエンコーダの基準
角度がずれるため、移動体の操舵方向演算過程に
おいてローリング角度を考慮に入れて補正を行な
う必要がある。また、移動体のピッチング(移動
体の移動方向を軸とし、その軸と地上面と角度)
によるずれは第13図ないし第15図に示すよう
な実施例を用いれば容易に解消できる。 Further, in the above description, the explanation has mainly been given to a moving object that travels on the ground, but the present invention can also be applied to a moving object that flies in the air, such as an airplane. In this case, light reflecting means may be arranged on the ground (for example, a runway), and a light beam may be rotated and scanned from the moving object toward the light reflecting means on the ground. In this case, if the moving object is rolling (rotation of the moving object with respect to the moving direction of the moving object as an axis), the reference angle of the rotary encoder with respect to the ground will shift, so the steering direction calculation process of the moving object will be It is necessary to take the rolling angle into account when making corrections. Also, the pitching of the moving object (the direction of movement of the moving object is the axis, and the angle between that axis and the ground surface)
This deviation can be easily eliminated by using the embodiments shown in FIGS. 13 to 15.
また、以上の説明では、この発明を移動体の操
舵制御に用いる場合について説明したが、この発
明は移動体が予め定める軌跡からずれたことを警
報あるいは表示するようなコースずれ検知装置に
も利用することができる。 Further, in the above explanation, the case where the present invention is used for steering control of a moving body has been explained, but the present invention can also be applied to a course deviation detection device that warns or displays that a moving body has deviated from a predetermined trajectory. can do.
以上のように、この発明によれば、従来のよう
な軌道レールに代えて予め定められた軌跡に沿つ
て光反射手段を配列するだけでよく、非常に簡単
かつ安価な移動体の自動操舵装置が得られる。ま
た、光反射手段によつて反射された光を変調する
ようにしたので、移動体では光反射手段からの反
射光に基づいて角度情報以外にも種々の情報を得
ることができる。したがつて、自動操舵のために
設けられたシステムを他の処理や制御のために共
用することができ、非常に有用でかつ用途の広い
自動操舵装置を得ることができる。また、この発
明によれば、光ビームを移動体が走行する面と直
交する方向および平行な面上の2方向に回動さ
せ、これら各回動方向に関連して異なる2種類の
回動角度を検出し、それを移動体の誘導のための
パラメータとして用いるようにしたので、これら
2種類のパラメータから誘導コースに対する移動
体の進行方向のずれ角度と移動体に対する光反射
手段の鉛直角を知ることができ、その結果、移動
体と光反射手段との鉛直角を所定角度に保ちなが
ら移動体を誘導することができる。これによつ
て、移動体の誘導コーの真上に障害物がある場合
はそれを避けて光反射手段を配置することがで
き、回りの障害物に左右されることなく移動体の
誘導コースを設定できるという効果もある。 As described above, according to the present invention, it is only necessary to arrange the light reflecting means along a predetermined trajectory instead of the conventional track rail, and it is possible to obtain a very simple and inexpensive automatic steering system for a moving body. is obtained. Furthermore, since the light reflected by the light reflecting means is modulated, the moving body can obtain various information other than angle information based on the reflected light from the light reflecting means. Therefore, the system provided for automatic steering can be shared for other processing and control, and an extremely useful and versatile automatic steering system can be obtained. Further, according to the present invention, the light beam is rotated in two directions, one in a direction perpendicular to the plane on which the moving body travels and the other in a plane parallel to the plane, and two different rotation angles are set in relation to each of these rotation directions. Since this is detected and used as a parameter for guiding the moving object, it is possible to know the deviation angle of the moving direction of the moving object with respect to the guidance course and the vertical angle of the light reflecting means with respect to the moving object from these two types of parameters. As a result, the moving object can be guided while maintaining the vertical angle between the moving object and the light reflecting means at a predetermined angle. As a result, if there is an obstacle directly above the guiding course of the moving object, the light reflecting means can be placed to avoid it, and the guiding course of the moving object can be guided without being affected by surrounding obstacles. It also has the effect of being configurable.
第1図および第2図はこの発明の一実施例の原
理を説明するための図であり、第1図は移動体V
を側面から見た図であり、第2図は移動体Vを正
面から見た図である。第3図はコーナキユーブ
CCの配置例と、移動体Vの走行軌跡を示す図で
ある。第4図はビームスキヤナBSの外観図であ
る。第5図は第4図における線走X−Xに沿う断
面図である。第6図はこの発明の一実施例の好ま
しいブロツク図である。第7図および第8図はこ
の発明の一実施例の操舵制御態様を説明するため
の図解図である。第9図ないし第12図はCPU
63の動作を説明するためのフローチヤートであ
る。第13図はこの発明の他の実施例を示す図解
図である。第14図および第15図は第13図に
示すビームスキヤナBS′の外観図であり、特に第
14図は移動体Vの側面から見た図であり、第1
5図は移動体Vの正面から見た図である。
図において、Vは移動体、BSはビームスキヤ
ナ、CCはコーナキユーブ、PMは変調手段、M
1ないしM3はモータ、EC1ないしEC3はロー
タリエンコーダ、4および3は受光部、11は半
導体レーザ、70は復調回路を示す。
1 and 2 are diagrams for explaining the principle of an embodiment of the present invention, and FIG. 1 shows a moving body V
FIG. 2 is a diagram of the mobile body V viewed from the front. Figure 3 shows the corner cube.
FIG. 3 is a diagram showing an example of the arrangement of CCs and a traveling trajectory of a moving body V. FIG. Figure 4 is an external view of the beam scanner BS. FIG. 5 is a sectional view taken along line X--X in FIG. 4. FIG. 6 is a preferred block diagram of one embodiment of the present invention. FIG. 7 and FIG. 8 are illustrative diagrams for explaining the steering control mode of an embodiment of the present invention. Figures 9 to 12 are CPU
63 is a flowchart for explaining the operation. FIG. 13 is an illustrative view showing another embodiment of the invention. 14 and 15 are external views of the beam scanner BS' shown in FIG.
FIG. 5 is a diagram of the moving body V seen from the front. In the figure, V is a moving object, BS is a beam scanner, CC is a corner cube, PM is a modulation means, and M
1 to M3 are motors, EC1 to EC3 are rotary encoders, 4 and 3 are light receiving sections, 11 is a semiconductor laser, and 70 is a demodulation circuit.
Claims (1)
せるために、移動体の操舵制御を行なう移動体の
自動操舵装置であつて、 前記予め定められた軌跡に沿つて配列され、入
射光方向に光を反射する複数の光反射手段、 前記各光反射手段に関連して設けられ、前記光
反射手段からの反射光を変調する手段、 前記移動体に設けられ、所定の広がりを有する
光ビームを発生する光ビーム発生手段、 前記光ビーム発生手段に関連して設けられ、前
記光ビーム発生手段から発生された光ビームを前
記光反射手段方向に回動走査する光ビーム走査手
段、 前記光ビーム走査手段に関連して設けられ、前
記光反射手段からの反射光を受光するための受光
手段、 前記光ビーム走査手段に関連して設けられ、前
記受光手段の受光出力に応答して前記光ビーム走
査手段のそのときの回動角度を検出する回動角度
検出手段、 前記回動角度検出手段によつて検出された回動
角度に基いて、前記移動体の操舵方向を制御する
操舵方向制御手段、 前記受光手段の受光出力を復調する手段、およ
び 前記復調手段からのデータを取込んで該データ
を判別する手段を備え、 前記光ビーム走査手段は、 前記光ビームを前記移動体が走行する面と直交
する方向に回動走査させる第1の光ビーム走査手
段と、 前記光ビームを前記移動体が走行する面と平行
な面上で回動させる第2の光ビーム走査手段とを
含み、 前記回動角度検出手段は、 前記第1の光ビーム走査手段において予め定め
られた基準回動角度に対する前記光反射手段から
の反射光の開き角を検出する開き角検出手段と、 前記第2の光ビーム走査手段の回動角度が前記
予め定められた軌跡に対して平行になつたときの
該回動角度を検出する平行回動角度検出手段とを
含み、 前記操舵方向制御手段は前記開き角検出手段に
よつて検出された開き角と前記平行回動角度検出
手段によつて検出された平行回動角度とに基づい
て前記移動体の操舵方向を制御する手段を含む、
移動体の自動操舵装置。 2 前記光反射手段は前記移動体の移動領域の上
部に配列される、特許請求の範囲第1項記載の移
動体の自動操舵装置。 3 前記光反射手段は前記移動体の移動領域の下
部に配列される、特許請求の範囲第2項記載の移
動体の自動操舵装置。 4 前記各変調手段は対応の光反射手段を特定す
る情報を変調情報として前記反射光を変調する、
特許請求の範囲第1項ないし第3項のいずれかに
記載の移動体の自動操舵装置。 5 前記光反射手段を特定する情報は前記光反射
手段の位置情報である、特許請求の範囲第4項記
載の移動体の自動操舵装置。 6 前記光反射手段を特定する情報は前記光反射
手段に対して予め割当てられた番号を表わす情報
である、特許請求の範囲第4項記載の移動体の自
動操舵装置。[Scope of Claims] 1. An automatic steering device for a movable body that performs steering control of a movable body in order to move the movable body along a predetermined trajectory, comprising: a plurality of light reflecting means for reflecting light in the direction of incident light; means provided in association with each of the light reflecting means and modulating the reflected light from the light reflecting means; a light beam generating means that generates a light beam having a spread; a light beam scanning device that is provided in association with the light beam generating means and rotates and scans the light beam generated from the light beam generating means in the direction of the light reflecting means; means, provided in association with the light beam scanning means, light receiving means for receiving reflected light from the light reflecting means; provided in relation to the light beam scanning means, responsive to the light receiving output of the light receiving means; a rotation angle detection means for detecting the rotation angle of the light beam scanning means at that time; and controlling a steering direction of the moving body based on the rotation angle detected by the rotation angle detection means. a steering direction control means for controlling the light beam, a means for demodulating the light receiving output of the light receiving means, and a means for taking in data from the demodulating means and determining the data, the light beam scanning means moving the light beam a first light beam scanning device that rotates and scans the light beam in a direction perpendicular to the plane on which the moving body travels; and a second light beam scanning device that rotates the light beam on a plane parallel to the plane on which the moving body travels. The rotation angle detection means includes: an aperture angle detection means for detecting an aperture angle of reflected light from the light reflection means with respect to a predetermined reference rotation angle in the first light beam scanning means; a parallel rotation angle detection means for detecting a rotation angle of the second light beam scanning means when the rotation angle becomes parallel to the predetermined trajectory, the steering direction control means includes means for controlling the steering direction of the movable body based on the opening angle detected by the opening angle detection means and the parallel rotation angle detected by the parallel rotation angle detection means,
Automatic steering device for mobile objects. 2. The automatic steering device for a moving body according to claim 1, wherein the light reflecting means is arranged above a movement area of the moving body. 3. The automatic steering system for a moving body according to claim 2, wherein the light reflecting means is arranged below a movement area of the moving body. 4. Each of the modulation means modulates the reflected light using information specifying the corresponding light reflection means as modulation information,
An automatic steering device for a mobile body according to any one of claims 1 to 3. 5. The automatic steering system for a moving body according to claim 4, wherein the information specifying the light reflecting means is position information of the light reflecting means. 6. The automatic steering system for a moving body according to claim 4, wherein the information specifying the light reflecting means is information representing a number assigned in advance to the light reflecting means.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP57195142A JPS5985507A (en) | 1982-11-06 | 1982-11-06 | Automatic steering device of traveling object |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP57195142A JPS5985507A (en) | 1982-11-06 | 1982-11-06 | Automatic steering device of traveling object |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPS5985507A JPS5985507A (en) | 1984-05-17 |
| JPH0246961B2 true JPH0246961B2 (en) | 1990-10-18 |
Family
ID=16336139
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP57195142A Granted JPS5985507A (en) | 1982-11-06 | 1982-11-06 | Automatic steering device of traveling object |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPS5985507A (en) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5041722A (en) * | 1986-11-14 | 1991-08-20 | Kabushiki Kaisha Komatsu Seisakusho | Method of guiding movement of unmanned vehicle by following a number of luminous points |
| JP2020004123A (en) * | 2018-06-28 | 2020-01-09 | 株式会社Doog | Autonomous mobile device, autonomous mobile method and program |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS56153875U (en) * | 1980-04-18 | 1981-11-17 | ||
| JPS5731006A (en) * | 1980-06-17 | 1982-02-19 | Mitsubishi Electric Corp | Inductive device of unattended carrier car |
-
1982
- 1982-11-06 JP JP57195142A patent/JPS5985507A/en active Granted
Also Published As
| Publication number | Publication date |
|---|---|
| JPS5985507A (en) | 1984-05-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JPH01316808A (en) | Steering controller for self-traveling vehicle | |
| JPS6259804B2 (en) | ||
| US6036209A (en) | System for managing safe mobile run by scanning lane | |
| JP2004094298A (en) | Transport device using self-propelled vehicles | |
| JPH0246961B2 (en) | ||
| JP2662946B2 (en) | Traveling control method for a vehicle running independently | |
| JPH0130437B2 (en) | ||
| JP2509551B2 (en) | Optical beam transmitter / receiver for guiding a moving body | |
| JP3244642B2 (en) | Mobile body guidance equipment | |
| JPS59153211A (en) | Guiding method of unmanned carrier car | |
| JP2833681B2 (en) | Method and apparatus for detecting an obstacle ahead of an unmanned driving vehicle | |
| JPS5962917A (en) | Introduction method of unattended car | |
| JPS60508A (en) | Automatic outdoor steering device of moving body | |
| JP2825239B2 (en) | Automatic guidance control device for moving objects | |
| JPH11230746A (en) | Mobile object position detection equipment | |
| JPH0363084B2 (en) | ||
| JP2696823B2 (en) | Driverless vehicle guidance device | |
| JPS61817A (en) | Guide controller of traveling object on ground | |
| JPH0610615B2 (en) | Multi-directional distance measuring device | |
| JPH0133792B2 (en) | ||
| JPS62120511A (en) | Correcting system for direction of autonomous mobile body | |
| JPH03105207A (en) | Position detecting apparatus for moving object | |
| JPS5886606A (en) | Scanning method for light beam for guiding and controlling ground moving body | |
| JP2518888B2 (en) | Beam light projection device for guiding work vehicles | |
| JPH0218485B2 (en) |