JP3244641B2 - Mobile body guidance equipment - Google Patents

Mobile body guidance equipment

Info

Publication number
JP3244641B2
JP3244641B2 JP05969997A JP5969997A JP3244641B2 JP 3244641 B2 JP3244641 B2 JP 3244641B2 JP 05969997 A JP05969997 A JP 05969997A JP 5969997 A JP5969997 A JP 5969997A JP 3244641 B2 JP3244641 B2 JP 3244641B2
Authority
JP
Japan
Prior art keywords
course
forklift
light receiving
light
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.)
Expired - Fee Related
Application number
JP05969997A
Other languages
Japanese (ja)
Other versions
JPH10254544A (en
Inventor
俊弘 津村
久俊 楢崎
和志 平岡
洋敏 下田
好博 井漕
和也 川口
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.)
Hitachi Zosen Corp
Original Assignee
Hitachi Zosen Corp
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 Hitachi Zosen Corp filed Critical Hitachi Zosen Corp
Priority to JP05969997A priority Critical patent/JP3244641B2/en
Publication of JPH10254544A publication Critical patent/JPH10254544A/en
Application granted granted Critical
Publication of JP3244641B2 publication Critical patent/JP3244641B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は、予め設定されたル
ートに沿って自走し、また目標物または地点に対して自
走を可能とする移動体の誘導設備に関するものである。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a mobile object guidance system which can run on a predetermined route and can run on a target or a point.

【0002】[0002]

【従来の技術】従来、移動体の誘導設備としては下記の
方式が知られている。 a.電磁誘導方式 自走搬送台車(移動体)の走行経路に沿って電線を敷設
し、交流電流を流して磁界を発生させ、自走搬送台車に
この電線から発生する磁界を検出するセンサを設け、検
出した磁界に沿って走行する。
2. Description of the Related Art Heretofore, the following systems have been known as guidance systems for mobile bodies. a. Electromagnetic induction method An electric wire is laid along the traveling path of the self-propelled transport vehicle (moving body), an alternating current flows to generate a magnetic field, and the self-propelled transport vehicle is provided with a sensor for detecting a magnetic field generated from the electric wire, It travels along the detected magnetic field.

【0003】b.磁気誘導方式 自走搬送台車(移動体)の走行経路に沿って床面に磁気
テープを敷設して、磁気を発生させ、自走搬送台車にこ
の磁気テープから発生する磁気を検出するセンサを設
け、検出した磁気に沿って走行する。
B. Magnetic guidance system A magnetic tape is laid on the floor along the traveling path of the self-propelled transport vehicle (moving body) to generate magnetism, and the self-propelled transport vehicle has a sensor that detects the magnetism generated from this magnetic tape. , And travels along the detected magnetism.

【0004】c.色線誘導方式 自走搬送台車(移動体)の走行経路に沿って床面に床面
の色と異なった色のテープを敷設し、自走搬送台車に床
面の色と異なる色を検出することによりテープを検出
し、この検出した色テープに沿って走行する。
C. Color line guidance system A tape of a color different from the floor surface is laid on the floor along the traveling path of the self-propelled transport vehicle (moving body), and a color different from the floor surface is detected on the self-propelled transport vehicle. Thus, the tape is detected, and the vehicle runs along the detected color tape.

【0005】d.GPSによる誘導方式 自走搬送台車(移動体)にGPSを設置し、自分の位置
を認識し、走行経路とのずれを修正しながら走行する。
D. GPS-based guidance system A GPS is installed on a self-propelled transport vehicle (moving body) to recognize its own position and travel while correcting the deviation from the traveling route.

【0006】e.自律誘導方式 走行距離を車輪の回転より求め、進行方向を左右の車輪
の回転速度の差より求め、進行方向と走行距離を積算す
ることによって自分の位置を算出し、走行経路とのずれ
を修正しながら走行する。
E. Autonomous Guidance Method Obtains the traveling distance from the rotation of the wheels, calculates the traveling direction from the difference between the rotational speeds of the left and right wheels, calculates the own position by integrating the traveling direction and the traveling distance, and corrects the deviation from the traveling route While traveling.

【0007】f.レーザー誘導方式 道路上に走行経路に沿ってレーザー光線を照射し、道路
を走行する車両にレーザー光線を受光する装置を設け、
車両は受光するレーザー光線に導かれて走行する。
F. Laser guidance system A device that irradiates a laser beam on the road along the travel route and receives the laser beam on a vehicle traveling on the road is provided.
The vehicle travels by being guided by the received laser beam.

【0008】[0008]

【発明が解決しようとする課題】しかし、上記移動体の
誘導設備において、電磁誘導方式、磁気誘導方式、およ
び色線誘導方式では、走行経路が固定されてしまい、変
更が難しく、特にフレキシブルな経路の変更に対応でき
ず、さらに床面の材質や性状に影響されるという問題が
あった。また、走行経路から離れて任意の位置に停止し
たトラックとの間で荷の移載を行うことができなかっ
た。さらに磁気誘導方式、および色線誘導方式では、移
動体が、磁気テープ、あるいは色テープ上を走行するこ
とがあり、移動体によりこれらテープが損傷を受ける恐
れがあった。
However, in the above-described mobile body guidance equipment, in the electromagnetic induction type, the magnetic induction type, and the color line induction type, the traveling route is fixed, and it is difficult to change the traveling route. However, there has been a problem that it is not possible to cope with the change of the floor surface, and further, it is affected by the material and properties of the floor surface. Further, it has not been possible to transfer a load to and from a truck stopped at an arbitrary position away from the traveling route. Further, in the magnetic induction method and the color line induction method, the moving body sometimes runs on a magnetic tape or a color tape, and there is a risk that these tapes may be damaged by the moving body.

【0009】またGPSによる誘導方式では、衛星の影
に移動体の走行経路が入る場合に使用できないという問
題があった。さらに自律誘導方式では、累積誤差が生じ
るために、何らかの位置補正手段を設けなければならな
いという問題があった。
[0009] Further, there is a problem that the guide method using the GPS cannot be used when the traveling route of the moving object enters the shadow of the satellite. Further, in the autonomous guidance system, there is a problem that some position correction means must be provided because an accumulated error occurs.

【0010】またレーザー誘導方式では、レーザー光線
が誘導する走行経路は固定されており、車両の行先にず
れが生じたときに、簡単に修正することができないとい
う問題があった。
[0010] In the laser guidance system, the traveling path guided by the laser beam is fixed, and there is a problem that when the destination of the vehicle is misaligned, it cannot be easily corrected.

【0011】そこで、本発明は、誘導線、テープを必要
とせず、室内においても正確な誘導ができ、さらにルー
トの変更が可能な移動体の誘導設備を提供することを目
的としたものである。
SUMMARY OF THE INVENTION It is therefore an object of the present invention to provide a guidance apparatus for a moving body which does not require a guide wire or tape, can provide accurate guidance even indoors, and can change a route. .

【0012】[0012]

【課題を解決するための手段】前述した目的を達成する
ために、本発明は、自走する移動体の誘導設備であっ
て、第1設定地点と第2設定地点間に亘って光線を照射
する照射部と、この照射部により照射される光線照射面
の角度を調整し、複数の前記移動体の誘導路を形成する
回転部とを有する光線発生手段を設け、前記移動体に、
前記移動体の前後に前記光線が交差する方向に配置さ
れ、前記光線の受光位置を検出する受光位置検出手段
と、前記受光位置検出手段により検出された前後の受光
位置がともに一定位置となるように走行して、設定地点
へ移動し、移動した到達点と移動体が目的とする目標地
点とのずれ量を検出する走行手段とを設け、前記走行手
段により検出された位置ずれ量に応じて前記光線発生手
段の回転部を駆動し、前記光線照射面の移動体の移動軸
に対する回転角度を補正し、前記各誘導路を変更する
御手段を設けたことを特徴とするものである。
In order to achieve the above-mentioned object, the present invention relates to a guidance system for a self-propelled moving body, and irradiates a light beam between a first set point and a second set point. The light generating means having an irradiating unit for performing the irradiation, and a rotating unit that adjusts an angle of a light irradiation surface irradiated by the irradiating unit and forms a plurality of guide paths for the moving body; To
The light receiving position detecting means for detecting the light receiving position of the light beam is disposed in the direction in which the light beams intersect before and after the moving body, and the light receiving position before and after the light receiving position detected by the light receiving position detecting device are both constant. Traveling means for moving to a set point, and a traveling means for detecting a deviation amount between the reached point and the target point where the moving object is moved, and according to the positional deviation amount detected by the traveling means. Control means for driving a rotating part of the light beam generating means, correcting a rotation angle of the light irradiation surface with respect to a moving axis of a moving body, and changing each of the guide paths is provided. Things.

【0013】上記構成により、移動体は、受光位置検出
手段により検出された前後の受光位置がともに一定位置
となるように走行することにより光線に導かれて走行
し、移動した到達点と目標地点とのずれ量を検出する。
この検出された位置ずれ量に応じて光発生手段の回転部
を駆動し、光線照射面の移動体の移動軸に対する回転角
度を補正し、各誘導路を変更する。よって以後、移動体
はずれることなく、目標地点に到達できる。
With the above arrangement, the moving body travels by being guided by the light beam by traveling so that the front and rear light receiving positions detected by the light receiving position detecting means are both constant, and the moving point and the target point are moved. Is detected.
The rotating unit of the light generating means is driven in accordance with the detected positional shift amount, the rotation angle of the light irradiation surface with respect to the moving axis of the moving body is corrected, and each guide path is changed. Therefore, thereafter, the moving body can reach the target point without shifting.

【0014】[0014]

【0015】[0015]

【0016】[0016]

【0017】[0017]

【0018】[0018]

【0019】[0019]

【発明の実施の形態】以下、本発明の実施の形態を図面
に基づいて説明する。図1〜図3は本発明の実施の形態
における移動体の誘導設備を備えた荷搬出エリアの平面
図、側面図、および正面図である。
Embodiments of the present invention will be described below with reference to the drawings. FIG. 1 to FIG. 3 are a plan view, a side view, and a front view of a loading / unloading area provided with a moving object guiding facility according to an embodiment of the present invention.

【0020】図1において、1,2は予め床面FLに設
定された自動フォークリフト(移動体)3の2つのルー
トであるX1コースとX2コースをそれぞれレーザー光
線により走査する第1レーザスキャナ,第2レーザスキ
ャナであり、これらレーザスキャナ1,2は、X1コー
スとX2コースの上方の天井部Uに設置されている。こ
のX1コースとX2コースは、荷置き場Sに沿って平行
なルートである。荷置き場Sには、4個2段の計8個の
荷4を積載したパレット5が段積(実施の形態では2
段)されている。
In FIG. 1, reference numerals 1 and 2 denote a first laser scanner and a second laser scanner for scanning the X1 course and the X2 course, which are two routes of the automatic forklift (moving body) 3 set in advance on the floor FL, with laser beams. These are laser scanners, and these laser scanners 1 and 2 are installed on the ceiling U above the X1 course and the X2 course. The X1 course and the X2 course are parallel routes along the storage space S. A pallet 5 loaded with a total of eight loads 4 (two in four stages) is stacked in the loading place S (in the embodiment, 2 pallets 5 are stacked).
Dan).

【0021】X1コースとX2コースを挟んで、荷置き
場Sに対向して、荷4(パレット5)を搬出するトラッ
ク6の停止位置(枠)7が設定されている。トラック6
は、5つのパレット5を前方から後方へ順に積載可能な
荷台8を有しており、停止枠7に停止したトラック6の
荷台8の5つのパレット5の積載位置Z1 ,Z2 ,Z3
,Z4 ,Z5 と、これら積載位置Z1 ,Z2 ,Z3 ,
Z4 ,Z5 に対向する荷置き場Sのパレット5の5つの
ルート、Y1コース,Y2コース,Y3コース,Y4コ
ース,Y5コースをレーザー光線により走査する第3レ
ーザスキャナ9が、天井部Uに設置されている。
A stop position (frame) 7 of the truck 6 for carrying out the load 4 (pallet 5) is set opposite the load storage space S with the X1 course and the X2 course interposed therebetween. Track 6
Has a loading platform 8 on which five pallets 5 can be loaded in order from the front to the rear. The loading positions Z1, Z2, Z3 of the five pallets 5 on the loading platform 8 of the truck 6 stopped on the stop frame 7.
, Z4, Z5 and their loading positions Z1, Z2, Z3,
A third laser scanner 9 that scans five routes of the pallet 5 of the storage space S facing the Z4 and Z5, Y1, C2, Y3, Y4, and Y5 courses with a laser beam is installed on the ceiling U. I have.

【0022】また、Y1コース,Y5コースの両側に
は、X1コース,X2コースと直角に交差する光線(面
ビーム)を照射するレーザ光線発生装置10が天井部Uに
配置されている。このレーザ光線発生装置10によりフォ
ークリフト3の針路変更位置が照射される。
Further, on both sides of the Y1 course and the Y5 course, a laser beam generator 10 for irradiating a light beam (plane beam) intersecting at right angles to the X1 course and the X2 course is arranged on the ceiling portion U. The laser beam generator 10 irradiates the course change position of the forklift 3.

【0023】第1レーザスキャナ1と第2レーザスキャ
ナ2は、図4(a)に示すように、レーザー光線を下方
に所定角度Θに亘って照射するレーザー光線走査手段か
ら構成されている。
As shown in FIG. 4A, the first laser scanner 1 and the second laser scanner 2 are constituted by laser beam scanning means for irradiating a laser beam downward at a predetermined angle Θ.

【0024】このレーザー光線走査手段は、レーザ光源
11と、レーザ光源11から照射されたレーザー光線を平行
光線とするコリメータレンズ12と、コリメータレンズ12
から出射されたレーザー光線を下方に所定角度Θに亘っ
て走査する回転ミラー13と、回転ミラー13を駆動するモ
ータ(図示せず)から構成されている。
This laser beam scanning means is a laser light source.
11, a collimator lens 12 for collimating the laser beam emitted from the laser light source 11, and a collimator lens 12
And a motor (not shown) for driving the rotating mirror 13 to scan the laser beam emitted downward from the laser beam over a predetermined angle Θ.

【0025】第1レーザスキャナ1と第2レーザスキャ
ナ2はこの構成により、レーザ光源11から照射されたレ
ーザー光線はコリメータレンズ12により平行なレーザー
光線とされ、回転ミラー13により、レーザー光線が下方
に所定角度Θに亘って照射される。
With this configuration, the first laser scanner 1 and the second laser scanner 2 convert the laser beam emitted from the laser light source 11 into a parallel laser beam by the collimator lens 12, and the rotating mirror 13 lowers the laser beam by a predetermined angle Θ. Irradiation.

【0026】第3レーザスキャナ9は、図4(b)に示
すように、レーザー光線を下方に所定角度Θに亘って照
射するレーザー光線走査手段と、このレーザー光線走査
手段を回動し、レーザー光線走査面の角度を調整する回
転部から構成されている。
As shown in FIG. 4B, the third laser scanner 9 irradiates a laser beam downward at a predetermined angle Θ, and rotates the laser beam scanning device to rotate the laser beam scanning surface. It is composed of a rotating unit that adjusts the angle.

【0027】レーザー光線走査手段は、上記レーザ光源
11、コリメータレンズ12、回転ミラー13、および回転ミ
ラー13を駆動するモータ(図示せず)にさらに、コリメ
ータレンズ12,回転ミラー13間に設けられ、回転ミラー
13から入射した反射光を屈折するハーフミラー14と、ハ
ーフミラー14により導かれた反射光を検知するフォトト
ランジスタ15と、これら装置を収納し、またレーザー光
線の走査口を底面に設けた箱体16を加えて構成されてい
る。また箱体16には、前後に回転軸17が設けられてい
る。この回転軸17間を結ぶ線上に回転ミラー13の回転中
心が位置する。
[0027] The laser beam scanning means is a laser beam source.
11, a collimator lens 12, a rotating mirror 13, and a motor (not shown) for driving the rotating mirror 13, further provided between the collimator lens 12 and the rotating mirror 13,
A half mirror 14 that refracts the reflected light incident from 13, a phototransistor 15 that detects the reflected light guided by the half mirror 14, and a box body 16 that houses these devices and also has a laser light scanning port on the bottom surface. Is configured. The box 16 is provided with rotating shafts 17 at the front and rear. The rotation center of the rotating mirror 13 is located on a line connecting the rotating shafts 17.

【0028】上記回転部は、箱体16の一方の回転軸17に
連結されたサーボモータ18から構成され、このサーボモ
ータ18の駆動により、箱体16の角度、すなわちレーザー
光線走査面の垂直な位置からの角度が調整される。
The rotating section is constituted by a servomotor 18 connected to one rotating shaft 17 of the box 16. By driving the servomotor 18, the angle of the box 16, that is, the vertical position of the laser beam scanning surface is set. The angle from is adjusted.

【0029】第3レーザスキャナ9はこの構成により、
レーザ光源11から照射されたレーザー光線はコリメータ
レンズ12により平行なレーザー光線とされ、回転ミラー
13により、レーザー光線が下方に所定角度Θに亘って照
射され、その走査面の角度はサーボモータ18により調整
される。この角度の調整により、上記Y1コース,Y2
コース,Y3コース,Y4コース,Y5コースをレーザ
ー光線により走査することができる。また回転ミラー1
3、ハーフミラー14を介して反射光はフォトトランジス
タ15へ入射され、フォトトランジスタ15により検知され
る。
The third laser scanner 9 has this configuration,
The laser beam emitted from the laser light source 11 is converted into a parallel laser beam by the collimator lens 12, and is rotated by a rotating mirror.
By 13, the laser beam is irradiated downward over a predetermined angle Θ, and the angle of the scanning plane is adjusted by the servomotor 18. By adjusting this angle, the Y1 course, Y2 course
The course, Y3 course, Y4 course, and Y5 course can be scanned by a laser beam. Also rotating mirror 1
3. The reflected light enters the phototransistor 15 via the half mirror 14, and is detected by the phototransistor 15.

【0030】なお、図6に示すように、2台のレーザ光
線発生装置10と、レーザスキャナ1,2,9の上記フォ
トトランジスタ15、レーザ光源11、回転ミラー13の駆動
モータ、およびサーボモータ18は、後述するマイクロコ
ンピュータからなるメイン制御装置19に接続されてい
る。
As shown in FIG. 6, the two laser beam generators 10, the phototransistor 15 of the laser scanners 1, 2 and 9, the laser light source 11, the drive motor of the rotating mirror 13, and the servo motor 18 Is connected to a main controller 19 composed of a microcomputer described later.

【0031】フォークリフト3の構成を図5に示す。フ
ォークリフト3の走行自在なフォークリフト本体21の前
面には、昇降自在なサイドシフト機構22付きのフォーク
23が設けられ、フォークリフト本体21の上面には、前後
2ヵ所に、左右方向(レーザー光線が交差する方向)に
フォトダイオードを並べてレーザー光線を受光するセン
サアレイ24が設けられ、入射した光線を正確に入射した
方向に送り返す機能を有する再帰反射シート(またはコ
ーナーキューブ)25が設けられている。上記サイドシフ
ト機構22には、フォーク23が右端にシフトされたことを
検出する右端リミットスイッチ22A、フォーク23が左端
にシフトされたことを検出する左端リミットスイッチ22
Bが設けられている。
FIG. 5 shows the structure of the forklift 3. A fork with a side shift mechanism 22 that can move up and down is mounted on the front of the forklift body 21 that can move freely.
A sensor array 24 is provided on the upper surface of the forklift main body 21 at two locations in front and rear of the forklift body 21 to receive laser beams by arranging photodiodes in a horizontal direction (a direction in which laser beams intersect). A retroreflective sheet (or corner cube) 25 having a function of feeding back in the set direction is provided. The side shift mechanism 22 includes a right end limit switch 22A for detecting that the fork 23 has been shifted to the right end, and a left end limit switch 22 for detecting that the fork 23 has been shifted to the left end.
B is provided.

【0032】またフォークリフト本体21内に、2つのセ
ンサアレイ24の受光信号より、それぞれの受光位置(レ
ーザー光線の照射位置)を検出する信号処理装置26が設
けられている。これらセンサアレイ24と信号処理装置26
において、たとえば特開平7−198326号公報に開
示されている方法により、前後それぞれの受光位置が検
出される。
In the forklift body 21, there is provided a signal processing device 26 for detecting respective light receiving positions (irradiation positions of laser beams) from the light receiving signals of the two sensor arrays 24. These sensor array 24 and signal processing device 26
In this method, the front and rear light receiving positions are detected by the method disclosed in, for example, Japanese Patent Application Laid-Open No. 7-198326.

【0033】またフォーク23には、フォーク23にかかる
前後左右の圧力を検出する圧力センサ27が設けられ、ま
たフォークリフト本体21の前面には近接センサ28が設け
られ、さらにフォークリフト本体21内に、後輪29を操舵
し、駆動するステアリング走行駆動部30と、前輪31に連
結されてその回転数からフォークリフト本体21の移動量
を検出する移動量検出部32と、上記フォーク23を昇降す
る昇降駆動部33が設けられている。
The fork 23 is provided with a pressure sensor 27 for detecting front, rear, left and right pressure applied to the fork 23, and a proximity sensor 28 is provided on a front surface of the forklift main body 21. A steering traveling drive unit 30 that steers and drives the wheels 29, a movement amount detection unit 32 that is connected to the front wheels 31 and detects the movement amount of the forklift body 21 from the number of revolutions thereof, and a lifting drive unit that moves the fork 23 up and down. 33 are provided.

【0034】この制御装置35には、図6に示すように、
サイドシフト機構22のリミットスイッチ22A,22Bの検
出データ、信号処理装置26の受光位置データ、圧力セン
サ27の前後圧力検出データおよび左右圧力検出データ、
近接センサ28のトラック6の検出データ、移動量検出部
32の移動量データが入力され、サイドシフト機構22へ左
右移動指令データ、ステアリング走行駆動部30へ前進/
後進/停止/反転/切返し/左方向/右方向指令デー
タ、昇降駆動部33へ昇降指令データを出力する。
As shown in FIG. 6, the control device 35
Detection data of the limit switches 22A and 22B of the side shift mechanism 22, light receiving position data of the signal processing device 26, front and rear pressure detection data and left and right pressure detection data of the pressure sensor 27,
Detection data of the track 6 of the proximity sensor 28, the movement amount detection unit
The movement amount data is input to the side shift mechanism 22, and the forward /
Reverse / stop / reversal / turnback / left / right direction command data and up / down command data are output to the up / down drive unit 33.

【0035】上記メイン制御装置19と、フォークリフト
3の制御装置35の動作を、図7〜図9のフローチャート
にしたがって詳細に説明する。なお、フォークリフト3
はX2コースを移動し、Y1コース,Y2コース,Y3
コース,Y4コース,Y5コースの順にパレット5をト
ラック6へ移載するものとする。
The operation of the main control device 19 and the control device 35 of the forklift 3 will be described in detail with reference to the flowcharts of FIGS. In addition, forklift 3
Moves on X2 course, Y1 course, Y2 course, Y3
The pallet 5 is transferred to the truck 6 in the order of course, Y4 course, and Y5 course.

【0036】メイン制御装置19は、まずレーザ光線発生
装置10を駆動してフォークリフト3の針路変更位置を照
射し(ステップ−A1)、第1レーザスキャナ1と第2
レーザスキャナ2のレーザ光源11と回転ミラー駆動モー
タ20を駆動してレーザー光線を照射してX1コースとX
2コースを形成する(ステップ−A2)。次に、第3レ
ーザスキャナ9のレーザ光源11と回転ミラー駆動モータ
20を駆動し(ステップ−A3)、Y1〜Y5のコースの
コースナンバーKに1をセットし(ステップ−A4)、
サーボモータ18へパルス信号を出力してY(K)コース
に相当する角度に箱体16の角度を調整する(ステップ−
A5)。最初は、Y1(K=1)コースが形成される。
The main control unit 19 first drives the laser beam generator 10 to irradiate the course change position of the forklift 3 (step-A1), and the first laser scanner 1 and the second laser scanner
The laser light source 11 of the laser scanner 2 and the rotating mirror drive motor 20 are driven to irradiate a laser beam, and X1 course and X
Two courses are formed (Step-A2). Next, the laser light source 11 of the third laser scanner 9 and the rotating mirror driving motor
20 is driven (step-A3), and the course number K of the courses Y1 to Y5 is set to 1 (step-A4),
A pulse signal is output to the servo motor 18 to adjust the angle of the box 16 to an angle corresponding to the Y (K) course (step-
A5). Initially, a Y1 (K = 1) course is formed.

【0037】フォークリフト3の制御装置35は、Y1〜
Y5のコースのコースナンバーKに1をセットし(ステ
ップ−B1)、第2レーザスキャナ2により照射される
レーザー光線による信号処理装置26の受光位置データ
が、予め定めた一定位置、たとえば中心位置となるよう
にステアリング走行駆動部30へ前進および左方向/右方
向指令データを出力してX2コースを走行し(ステップ
−B2)、X2コースを移動してきたフォークリフト3
は、センサアレイ24により、レーザ光線発生装置10が照
射する光線を検出すると、すなわちY(K)コースへの
針路変更位置を検出すると(ステップ−B3)、ステア
リング走行駆動部30へ右行指令データを出力し(ステッ
プ−B4)、移動量検出部32の移動量データMを記憶す
る(ステップ−B5)。
The control device 35 of the forklift 3 includes Y1
The course number K of the course of Y5 is set to 1 (step-B1), and the light receiving position data of the signal processing device 26 by the laser beam emitted by the second laser scanner 2 becomes a predetermined fixed position, for example, a center position. As described above, the forward and left / right direction command data are output to the steering traveling drive unit 30 to travel the X2 course (step-B2), and the forklift 3 that has moved the X2 course
When the sensor array 24 detects a light beam emitted by the laser beam generator 10, that is, when a course change position to the Y (K) course is detected (step-B 3), the rightward command data is sent to the steering drive unit 30. Is output (step-B4), and the movement amount data M of the movement amount detection unit 32 is stored (step-B5).

【0038】この動作により、フォークリフト3はX2
コースからY(K)コースへ針路を変更して荷置き場S
方向へ移動する。第3レーザスキャナ9により照射され
るレーザー光線による信号処理装置26の受光位置データ
が中心位置となるようにステアリング走行駆動部30へ前
進および左方向/右方向指令データを出力してY(K)
コースを走行し(ステップ−B6)、昇降駆動部33へ2
段目のパレット5の高さに相当する昇降指令データを出
力する(ステップ−B7)。そして、移動量データが
(M+α)になると、すなわち荷置き場Sのパレット5
の掬い位置に到達すると(ステップ−B8)、ステアリ
ング走行駆動部30へ停止指令データを出力し(ステップ
−B9)、昇降駆動部33へ掬い指令データを出力する
(ステップ−B10)。
By this operation, the forklift 3 is moved to X2
Change course from course to Y (K) course, and place to store cargo S
Move in the direction. The forward and left / right direction command data is output to the steering drive 30 so that the light receiving position data of the signal processing device 26 by the laser beam emitted by the third laser scanner 9 becomes the center position, and Y (K) is output.
Run on the course (Step-B6), and
The ascending / descending command data corresponding to the height of the pallet 5 at the level is output (step-B7). Then, when the movement amount data becomes (M + α), that is, the pallet 5
Is reached (step-B8), stop command data is output to the steering traveling drive unit 30 (step-B9), and scoop command data is output to the elevation drive unit 33 (step-B10).

【0039】この動作により、フォークリフト3はY
(K)コースに従って荷置き場Sへ移動し、パレット5
をフォーク23へ積み込む。次に、ステアリング走行駆動
部30へ後進および反転指令データを出力し(ステップ−
B11)、昇降駆動部33へトラック6の積載高さに相当す
る昇降指令データを出力し(ステップ−B12)、サイド
シフト機構22へ右移動指令データ(トラック6の後方向
への移動指令データ)を出力し(ステップ−B13)、右
端リミットスイッチ22Aの検出データを入力すると(ス
テップ−B14)、サイドシフト機構22へ停止指令データ
を出力する(ステップ−B15)。続いて第3レーザスキ
ャナ9により照射されるレーザー光線による信号処理装
置26の受光位置データが中心位置となるようにステアリ
ング走行駆動部30へ前進および左方向/右方向指令デー
タを出力してY(K)コースを走行する(ステップ−B
16)。
By this operation, the forklift 3 is moved to Y
(K) Move to the storage area S according to the course, and
To fork 23. Next, the reverse and reverse command data is output to the steering drive unit 30 (step-
B11), lifting / lowering command data corresponding to the loading height of the truck 6 is output to the lifting / lowering drive unit 33 (step-B12), and rightward movement command data (backward movement command data of the track 6) is sent to the side shift mechanism 22. Is output (step-B13), and when the detection data of the right end limit switch 22A is input (step-B14), stop command data is output to the side shift mechanism 22 (step-B15). Subsequently, forward and left / right direction command data are output to the steering traveling drive unit 30 so that the light receiving position data of the signal processing device 26 by the laser beam emitted by the third laser scanner 9 becomes the center position, and Y (K ) Running on the course (Step-B
16).

【0040】この動作により、フォークリフト3はY
(K)コースに従って反転し、続いてフォーク23をトラ
ック6の後方向位置にシフトさせ、Y(K)コースに従
って荷置き場Sからトラック3へ移動する。
By this operation, the forklift 3 moves to Y
(K) The truck 23 is reversed according to the course, and then the fork 23 is shifted to the rearward position of the truck 6 and moves from the loading place S to the truck 3 according to the Y (K) course.

【0041】次に、後述する切返しの回数N,Jに0を
セットし(ステップ−B17)、圧力センサ27によりフォ
ーク23が前方に接触したことを検出する検出データを入
力しているかを確認し(ステップ−B18)、確認できな
い場合、近接センサ28の検出データを入力しているかを
確認する(ステップ−B19)。近接センサ28の検出デー
タを確認すると、ステアリング走行駆動部30へ停止指令
データを出力し(ステップ−B20)、サイドシフト機構
22へ左移動指令データ(トラック6の前方向への移動指
令データ)を出力し(ステップ−B21)、時間tのカウ
ントを開始する(ステップ−B22)。
Next, 0 is set to the number of times N and J of the switching to be described later (step-B17), and it is confirmed whether the pressure sensor 27 has inputted detection data for detecting that the fork 23 has contacted forward. If it cannot be confirmed (step-B18), it is confirmed whether or not the detection data of the proximity sensor 28 has been input (step-B19). When the detection data of the proximity sensor 28 is confirmed, stop command data is output to the steering traveling drive unit 30 (Step-B20), and the side shift mechanism is output.
The left movement command data (forward movement data of the track 6 in the forward direction) is output to 22 (step-B21), and the counting of the time t is started (step-B22).

【0042】そして、左端リミットスイッチ22Bの検出
データを入力しているかを確認し(ステップ−B23)、
確認できない場合、圧力センサ27の左方検出データを入
力しているかを確認する(ステップ−B24)。この左方
検出データを確認すると、サイドシフト機構22へ停止指
令データを出力し(ステップ−B25)、時間tを停止し
て時間を計測し(ステップ−B26)、この時間をフォー
ク23のシフト量Lに換算し(ステップ−B27)、フォー
ク23の中心位置のシフト量Lc とのずれ量LEを検出し
(ステップ−B28)、このずれ量LE に「N*Ls−J
*Ls」(Lsはサイドシフト機構22によるフォーク23
の全シフト量)を加算して停止ずれ量ERを演算し、メ
イン制御装置19へ出力し(ステップ−B29)、昇降駆動
部33へ卸し指令データを出力する(ステップ−B30)。
Then, it is confirmed whether or not the detection data of the left end limit switch 22B has been inputted (step B23).
If it cannot be confirmed, it is confirmed whether the leftward detection data of the pressure sensor 27 has been inputted (step-B24). When this left detection data is confirmed, stop command data is output to the side shift mechanism 22 (step-B25), the time t is stopped, and the time is measured (step-B26). L (step-B27), a deviation LE from the shift Lc of the center position of the fork 23 is detected (step-B28), and the deviation LE is calculated as "N * Ls-J".
* Ls ”(Ls is the fork 23 by the side shift mechanism 22)
The total shift amount is calculated to calculate the stop deviation amount ER, output it to the main controller 19 (step-B29), and output wholesale command data to the lifting / lowering drive unit 33 (step-B30).

【0043】またステップ−B23において、左端リミッ
トスイッチ22Bの検出データを確認すると、すなわちフ
ォーク23をシフトしてもトラック6に接触しないとき、
サイドシフト機構22へ停止指令データを出力し(ステッ
プ−B31)、時間tをリセットし(ステップ−B32)、
ステアリング走行駆動部30へ左切返し指令データを出力
し(ステップ−B33)、左切返し回数「N=N+1」を
カウントし(ステップ−B34)、ステップ−B18へ戻
る。
In step B23, when the detection data of the left end limit switch 22B is confirmed, that is, when the track 6 is not contacted even if the fork 23 is shifted,
Output stop command data to the side shift mechanism 22 (Step-B31), reset the time t (Step-B32),
The left turn command data is output to the steering drive unit 30 (step-B33), the number of times of left turn "N = N + 1" is counted (step-B34), and the process returns to step-B18.

【0044】またステップ−B18において、圧力センサ
27によりフォーク23が前方に接触したことを検出する検
出データの入力を確認すると、すなわちトラック6へフ
ォーク23の先端が接触すると、ステアリング走行駆動部
30へ停止指令データを出力し(ステップ−B35)、ステ
アリング走行駆動部30へ右切返し指令データを出力し
(ステップ−B36)、右切返し回数「J=J+1」をカ
ウントし(ステップ−B37)、ステップ−B18へ戻る。
In step B18, a pressure sensor
When the input of the detection data for detecting that the fork 23 has contacted forward with the 27 is confirmed, that is, when the tip of the fork 23 contacts the truck 6, the steering drive unit
The stop command data is output to 30 (Step-B35), the right turn command data is output to the steering drive unit 30 (Step-B36), and the number of times of right turn "J = J + 1" is counted (Step-B37). Return to Step-B18.

【0045】この動作により、図10に示すように、フォ
ークリフト3はY1コースに従って反転して荷置き場S
からトラック6へ移動し、さらにトラック6の後方向位
置にシフトさせたパレット5をトラック6の荷台8の上
へ運び、フォーク23をトラック6の前方向位置にシフト
させてパレット5を荷台8へ積み込む。
By this operation, as shown in FIG. 10, the forklift 3 is turned over according to the Y1 course, and
To the truck 6, the pallet 5 further shifted to the rearward position of the truck 6 is carried onto the carrier 8 of the truck 6, and the fork 23 is shifted to the forward position of the truck 6 to move the pallet 5 to the carrier 8. Load.

【0046】また図11に示すように、トラック6が枠7
から大きく前方へずれて停車し、図11(c)に示すよう
に、フォーク23を左へシフトしてもトラック6に接触し
ないとき、左切返しを行い、フォーク23を左へシフトし
てパレット5がトラック6へ接触するまで繰り返して、
パレット5を荷台8へ積み込む。また切返しの回数をカ
ウントし、トラック6の停止ずれ量ER(=LE +N*
Ls−J*Ls)をメイン制御装置19へ出力する。
Also, as shown in FIG.
11C, when the fork 23 shifts to the left and does not come into contact with the truck 6 as shown in FIG. 11C, the left turn is performed and the fork 23 is shifted to the left to shift the pallet 5 to the left. Until it touches track 6,
The pallet 5 is loaded on the carrier 8. Also, the number of times of switching is counted, and the stop deviation amount ER of the track 6 (= LE + N *)
Ls−J * Ls) is output to the main control device 19.

【0047】また図12に示すように、トラック6が枠7
から大きく後方へずれて停車し、図12(b)に示すよう
に、フォーク23の先端がトラック6へ接触すると、右切
返しを行い、フォーク23がトラック6へ接触しなくなる
まで繰り返して、パレット5を荷台8へ積み込む。また
切返しの回数をカウントし、トラック6の停止ずれ量E
Rをメイン制御装置19へ出力する。
Also, as shown in FIG.
When the fork 23 comes into contact with the truck 6 as shown in FIG. 12 (b), it turns to the right, and repeats until the fork 23 stops contacting the truck 6 until the pallet 5 stops. Is loaded on the loading platform 8. Also, the number of times of switching is counted, and the stop deviation amount E of the track 6 is calculated.
R is output to the main control device 19.

【0048】続いて、ステアリング走行駆動部30へ後進
および反転指令データを出力し(ステップ−B38)、第
3レーザスキャナ9により照射されるレーザー光線によ
る信号処理装置26の受光位置データが中心位置となるよ
うにステアリング走行駆動部30へ前進および左方向/右
方向指令データを出力してY(K)コースを走行する
(ステップ−B39)。そして移動量検出部32の移動量デ
ータMを記憶し(ステップ−B40)、移動量データが
(M+β)になると(ステップ−B41)、ステアリング
走行駆動部30へ左行指令データを出力する(ステップ−
B42)。そして、第2レーザスキャナ2により照射され
るレーザー光線による信号処理装置26の受光位置データ
が中心位置となるようにステアリング走行駆動部30へ前
進および左方向/右方向指令データを出力してX2コー
スを走行する(ステップ−B43)。
Subsequently, reverse and reverse command data are output to the steering drive 30 (step-B38), and the light receiving position data of the signal processor 26 by the laser beam irradiated by the third laser scanner 9 becomes the center position. As described above, the forward and left / right direction command data is output to the steering drive unit 30, and the vehicle travels on the Y (K) course (step-B39). Then, the movement amount data M of the movement amount detection unit 32 is stored (step-B40), and when the movement amount data becomes (M + β) (step-B41), the left-hand command data is output to the steering drive unit 30 (step-B41). −
B42). Then, the forward and left / right direction command data is output to the steering traveling drive unit 30 so that the light receiving position data of the signal processing device 26 by the laser beam emitted by the second laser scanner 2 becomes the center position, and the X2 course is performed. The vehicle travels (step-B43).

【0049】次のコースをセットし(K=K+1)(ス
テップ−B44)、K=6になったかを確認する(ステッ
プ−B45)。Kが5以下の場合は、移動量検出部32の移
動量データMを記憶し(ステップ−B46)、移動量デー
タが(M+γ)になると(ステップ−B47)、ステップ
−B4へ戻って次のコースの荷の移載を行う。K=6の
とき(Y6コースは存在しない)、そのままX2コース
を走行する(ステップ−B48)。
The next course is set (K = K + 1) (step-B44), and it is confirmed whether K = 6 (step-B45). If K is 5 or less, the movement amount data M of the movement amount detection unit 32 is stored (step-B46), and when the movement amount data becomes (M + γ) (step-B47), the process returns to step-B4 and returns to the next step. Transfer the load of the course. When K = 6 (the Y6 course does not exist), the vehicle travels on the X2 course (step-B48).

【0050】この動作により、フォークリフト3はY
(K)コースに従ってX2コースへ戻り、X2コースを
移動し、次のY(K)コースの荷の移載を実行し、Y5
コースの荷の移載が終了すると、X2コースにしたがっ
て走行する。
By this operation, the forklift 3 moves to Y
(K) Return to the X2 course according to the course, move the X2 course, execute the transfer of the load of the next Y (K) course, and
When the transfer of the load on the course ends, the vehicle travels according to the X2 course.

【0051】メイン制御装置19は、フォトトランジスタ
15の受光信号の入力により、Y(K)コースへのフォー
クリフト3の乗換えを確認し(ステップ−A6)、フォ
トトランジスタ15より受光信号を入力しなくなると、す
なわちフォークリフト3がY(K)コースからX2コー
スへ戻ると(ステップ−A7)、次のコースをセットし
(K=K+1)(ステップ−A8)、K=6になったか
を確認する(ステップ−A9)。K=6のとき(Y6コ
ースは存在しない)、ステップ−A4へ戻り、Y1コー
スの角度設定から繰り返す。Kが5以下の場合は、トラ
ック6の停止ずれ量ERを入力しているかを確認し(ス
テップ−A10)、確認すると、停止ずれ量ERに相当す
る箱体16の補正角度γE を演算する(ステップ−A1
1)。確認しないと、γE =0をセットする(ステップ
−A12)。そして、次のY(K)コースに相当する角度
に上記補正角度γE を加算した角度を演算し(γS は次
のコースを設定する角度)(ステップ−A13)、ステッ
プ−A5へ戻り、サーボモータ18へパルス信号を出力し
てY(K)コースに相当する角度に上記補正角度γE を
加算した角度に箱体16の角度を調整する。
The main control unit 19 includes a phototransistor
The transfer of the forklift 3 to the Y (K) course is confirmed by the input of the light receiving signal 15 (step-A6). When the light receiving signal is no longer input from the phototransistor 15, that is, the forklift 3 is moved from the Y (K) course. When returning to the X2 course (step-A7), the next course is set (K = K + 1) (step-A8), and it is confirmed whether K = 6 (step-A9). When K = 6 (the Y6 course does not exist), the process returns to step-A4 and repeats from the setting of the angle of the Y1 course. If K is equal to or less than 5, it is confirmed whether or not the stop deviation amount ER of the track 6 has been input (step-A10), and when it is confirmed, the correction angle γE of the box 16 corresponding to the stop deviation amount ER is calculated ( Step-A1
1). If not, γE = 0 is set (step-A12). Then, an angle obtained by adding the correction angle γE to the angle corresponding to the next Y (K) course is calculated (γS is the angle for setting the next course) (step-A13), and the process returns to step-A5 to return to the servo-motor. A pulse signal is output to 18 to adjust the angle of the box 16 to an angle obtained by adding the correction angle γE to an angle corresponding to the Y (K) course.

【0052】この動作により、次のY(K)コースから
トラック6の停止ずれ量ERを補正したコースへ誘導路
が変更される。フォークリフト3において、Y5コース
のパレット5の移載が終了すると、X2コースに従って
移動を続け、第3レーザスキャナ9では、Y1コースに
相当する角度に箱体16の角度が再度調整される。
By this operation, the guide path is changed from the next Y (K) course to a course in which the stop deviation amount ER of the track 6 has been corrected. When the transfer of the pallet 5 in the Y5 course is completed in the forklift 3, the movement of the pallet 5 is continued according to the X2 course, and the third laser scanner 9 again adjusts the angle of the box 16 to an angle corresponding to the Y1 course.

【0053】上記誘導設備の構成により、フォークリフ
ト3は、X1,X2,Y1〜Y5のコースにしたがって
移動するとともに、Y1コースによるトラック6へのパ
レット5の移載の際に、トラック6の停止ずれ量を計測
し、以後このずれ量を考慮したY2〜Y5コースが設定
される。よって、枠7から外れて停止したトラック3へ
の移載経路を修正でき、パレット5の移載を自動化で
き、フォークリフト3による移載を効率よく行うことが
できる。またY1コースによるトラック6へのパレット
5の移載の際に、フォークリフト3の切返しを繰り返す
ことにより、確実にパレット5をトラック6へ積載で
き、自動化を達成することができる。
The forklift 3 moves along the courses of X1, X2, Y1 to Y5 due to the configuration of the above-mentioned guidance equipment, and when the pallet 5 is transferred onto the truck 6 by the Y1 course, the forklift 3 stops moving. The amount is measured, and thereafter Y2 to Y5 courses are set in consideration of the deviation amount. Therefore, the transfer route to the truck 3 stopped off the frame 7 can be corrected, the transfer of the pallet 5 can be automated, and the transfer by the forklift 3 can be performed efficiently. Further, when the pallet 5 is transferred to the truck 6 in the Y1 course, the forklift 3 is repeatedly turned over, so that the pallet 5 can be reliably loaded on the truck 6 and automation can be achieved.

【0054】なお、本実施の形態では、検出したトラッ
ク6の停止位置ずれ量ERを第3レーザスキャナ9で補
正しているが、フォークリフト3側で補正することもで
きる。すなわち、フォークリフト3は前後受光位置を中
心位置となるように走行しているが、前後受光位置を停
止位置ずれ量ERだけずらして以後のY2コース〜Y5
コースを移動すれば、トラック6の停止位置へ正確に移
動することができる。
In the present embodiment, the detected stop position deviation ER of the track 6 is corrected by the third laser scanner 9, but may be corrected on the forklift 3 side. In other words, the forklift 3 is traveling so that the front and rear light receiving positions are at the center position, but the front and rear light receiving positions are shifted by the stop position shift amount ER, and the subsequent Y2 course to Y5
By moving the course, it is possible to move to the stop position of the truck 6 accurately.

【0055】また、本実施の形態では、移動体として自
動フォークリフト2を使用しているが、床面を自走する
台車について適用することができる。また、本実施の形
態では、レーザー光線を使用しているが、レーザー光線
に限らず、通常の照明器具の光を集光して使用すること
もできる。
In the present embodiment, the automatic forklift 2 is used as the moving body, but the present invention can be applied to a bogie that runs on the floor by itself. In this embodiment, a laser beam is used. However, the present invention is not limited to a laser beam, and light from a normal lighting fixture can be collected and used.

【0056】また、本実施の形態では、第1〜第3レー
ザスキャナ1,2,9は、スキャンして光線を所定角度
Θで照射しているが、スキャンすることなく、面ビーム
によりコースを照射するようにしてもよい。また、第1
〜第3レーザスキャナ1,2,9は上方から下方へ向け
て光線を照射しているが、床面FL側から照射すること
も可能であるし、フォークリフト3の正面あるいは背面
から照射するようにすることも可能である。このとき、
センサアレイ24の取り付け位置が変わることはいうまで
もない。
In the present embodiment, the first to third laser scanners 1, 2, and 9 scan and irradiate the light beam at a predetermined angle 、. Irradiation may be performed. Also, the first
Although the third laser scanners 1, 2, and 9 irradiate light rays from above to below, they can also irradiate from the floor surface FL side, or irradiate from the front or back of the forklift 3. It is also possible. At this time,
It goes without saying that the mounting position of the sensor array 24 changes.

【0057】また、本実施の形態では、フォークリフト
3の針路変更位置をレーザ光線発生装置10により照射し
ているが、フォークリフト3の針路変更位置に予め金属
片からなる被検出体が床面FLに配置し、フォークリフ
ト3の底面に、被検出体を検出する近接センサ(金属セ
ンサ)からなる検出器を設け、フォークリフト3の針路
変更位置を検出するようにしてもよい。
Further, in the present embodiment, the course change position of the forklift 3 is irradiated by the laser beam generator 10, but the detected object made of a metal piece is placed on the floor FL in advance at the course change position of the forklift 3. Alternatively, a detector including a proximity sensor (metal sensor) for detecting an object to be detected may be provided on the bottom surface of the forklift 3 to detect the course change position of the forklift 3.

【0058】[0058]

【発明の効果】以上述べたように本発明によれば、移動
体は、受光位置検出手段により検出された前後の受光位
置がともに一定位置となるように走行することにより光
線に導かれて走行し、移動した到達点と移動体が目標と
する目標地点とのずれ量を検出し、この検出された位置
ずれ量に応じて光発生手段の回転部を駆動し、光線走査
面の移動体の移動軸に対する回転角度を補正し、各誘導
路を変更することにより、以後、移動体はずれることな
く目標地点に到達できる。
As described above, according to the present invention , the moving body travels by being guided by the light beam by traveling so that the front and rear light receiving positions detected by the light receiving position detecting means are both constant. Then, the amount of displacement between the moved arrival point and the target point targeted by the moving body is detected, and the rotating unit of the light generating means is driven in accordance with the detected amount of displacement, and the moving body on the light beam scanning surface is moved. Correct the rotation angle with respect to the movement axis , and
More altering the road, thereafter, it can reach the target point without departing mobile.

【0059】[0059]

【0060】[0060]

【図面の簡単な説明】[Brief description of the drawings]

【図1】本発明の実施の形態における移動体の誘導設備
を配置した荷搬出エリアの平面図である。
FIG. 1 is a plan view of a loading / unloading area in which a mobile object guiding facility according to an embodiment of the present invention is arranged.

【図2】同誘導設備を配置した荷搬出エリアの側面図で
ある。
FIG. 2 is a side view of an unloading area where the guidance equipment is arranged.

【図3】同誘導設備を配置した荷搬出エリアの正面図で
ある。
FIG. 3 is a front view of a loading / unloading area where the guidance equipment is arranged.

【図4】同誘導設備のレーザスキャナの構成図である。FIG. 4 is a configuration diagram of a laser scanner of the guidance equipment.

【図5】同誘導設備を搭載したフォークリフトの構成図
である。
FIG. 5 is a configuration diagram of a forklift equipped with the guidance equipment.

【図6】同誘導設備の制御構成図である。FIG. 6 is a control configuration diagram of the guidance equipment.

【図7】同誘導設備のメイン制御装置の動作を説明する
フローチャートである。
FIG. 7 is a flowchart illustrating an operation of a main control device of the guidance facility.

【図8】同誘導設備のフォークリフトの制御装置の動作
を説明するフローチャートである。
FIG. 8 is a flowchart illustrating an operation of a control device of a forklift of the guidance equipment.

【図9】同誘導設備のフォークリフトの制御装置の動作
を説明するフローチャートである。
FIG. 9 is a flowchart illustrating an operation of a control device of a forklift of the guidance equipment.

【図10】同誘導設備のトラックへの荷の移載時のフォー
クリフトの動作を説明する説明図である。
FIG. 10 is an explanatory diagram illustrating an operation of the forklift when the load is transferred to a truck by the guidance equipment.

【図11】同誘導設備のトラックへの荷の移載時のフォー
クリフトの動作を説明する説明図である。
FIG. 11 is an explanatory diagram illustrating an operation of the forklift when the load is transferred to a truck by the guidance equipment.

【図12】同誘導設備のトラックへの荷の移載時のフォー
クリフトの動作を説明する説明図である。
FIG. 12 is an explanatory diagram illustrating an operation of the forklift when the load is transferred to a truck by the guidance equipment.

【符号の説明】[Explanation of symbols]

1 第1レーザスキャナ 2 第2レーザスキャナ 3 自動フォークリフト(移動体) 4 荷 5 パレット 6 トラック(目標物) 7 枠 8 荷台 9 第3レーザスキャナ 10 レーザ光線発生装置 11 レーザ光源 12 コリメータレンズ 13 回転ミラー 14 ハーフミラー 15 フォトトランジスタ 16 箱体 18 サーボモータ 19 メイン制御装置 21 フォークリフト本体 22 サイドシフト機構 22A 右端リミットスイッチ 22B 左端リミットスイッチ 23 フォーク 24 センサアレイ(受光位置検出手段) 25 再帰反射シート 26 信号処理装置(受光位置検出手段) 27 圧力センサ 28 近接センサ 30 ステアリング走行駆動部 32 移動量検出部 33 昇降駆動部 35 制御装置 X1,X2,Y1〜Y5 ルート Z1〜Z5 荷移載位置 S 荷置き場 FL 床面 U 天井部 DESCRIPTION OF SYMBOLS 1 1st laser scanner 2 2nd laser scanner 3 automatic forklift (moving body) 4 load 5 pallet 6 truck (target) 7 frame 8 loading platform 9 3rd laser scanner 10 laser beam generator 11 laser light source 12 collimator lens 13 rotating mirror 14 Half mirror 15 Phototransistor 16 Box 18 Servo motor 19 Main controller 21 Forklift body 22 Side shift mechanism 22A Right end limit switch 22B Left end limit switch 23 Fork 24 Sensor array (light receiving position detecting means) 25 Retroreflective sheet 26 Signal processing device (Light receiving position detecting means) 27 Pressure sensor 28 Proximity sensor 30 Steering traveling drive unit 32 Moving amount detection unit 33 Elevating drive unit 35 Control device X1, X2, Y1 to Y5 Route Z1 to Z5 Load transfer position S Load storage FL Floor U ceiling

───────────────────────────────────────────────────── フロントページの続き (72)発明者 津村 俊弘 大阪府大阪市住吉区我孫子3丁目7番21 号 (72)発明者 楢崎 久俊 大阪府大阪市西区京町堀1丁目15番10号 東洋運搬機株式会社内 (72)発明者 平岡 和志 大阪府大阪市此花区西九条5丁目3番28 号 日立造船株式会社内 (72)発明者 下田 洋敏 大阪府大阪市此花区西九条5丁目3番28 号 日立造船株式会社内 (72)発明者 井漕 好博 大阪府大阪市此花区西九条5丁目3番28 号 日立造船株式会社内 (72)発明者 川口 和也 大阪府大阪市此花区西九条5丁目3番28 号 日立造船株式会社内 (56)参考文献 特開 平1−245311(JP,A) 特開 昭63−298412(JP,A) (58)調査した分野(Int.Cl.7,DB名) G05D 1/00 - 1/12 ──────────────────────────────────────────────────続 き Continued on the front page (72) Inventor Toshihiro Tsumura 3-7-21 Abiko, Sumiyoshi-ku, Osaka-shi, Osaka (72) Inventor Hisatoshi Narasaki 1-15-110, Kyomachibori, Nishi-ku, Osaka-shi, Osaka Toyo Hakko Inside (72) Inventor Kazushi Hiraoka 5-28 Nishikujo, Konohana-ku, Osaka-shi, Osaka Inside Hitachi Zosen Corporation (72) Inventor Hirotoshi Shimoda 5-3-28, Nishikujo, Konohana-ku, Osaka-shi, Osaka Within Hitachi Zosen Corporation (72) Inventor Yoshihiro Igoku 5-28 Nishikujo, Konohana-ku, Osaka-shi, Osaka Inside Hitachi Zosen Corporation (72) Inventor Kazuya Kawaguchi 5 Nishikujo, Konohana-ku, Osaka-shi, Osaka No. 3-28, Hitachi Zosen Corporation (56) References JP-A-1-245311 (JP, A) JP-A-63-298412 (JP, A) (58) Fields investigated (Int. Cl. 7 , (DB name) G05D 1/00-1 / 12

Claims (1)

(57)【特許請求の範囲】(57) [Claims] 【請求項1】 自走する移動体の誘導設備であって、 第1設定地点と第2設定地点間に亘って光線を照射する
照射部と、この照射部により照射される光線照射面の角
度を調整し、複数の前記移動体の誘導路を形成する回転
部とを有する光線発生手段を設け、 前記移動体に、 前記移動体の前後に前記光線が交差する方向に配置さ
れ、前記光線の受光位置を検出する受光位置検出手段
と、 前記受光位置検出手段により検出された前後の受光位置
がともに一定位置となるように走行して、設定地点へ移
動し、移動した到達点と移動体が目的とする目標地点と
のずれ量を検出する走行手段とを設け、 前記走行手段により検出された位置ずれ量に応じて前記
光線発生手段の回転部を駆動し、前記光線照射面の移動
体の移動軸に対する回転角度を補正し、前記各誘導路を
変更する制御手段を設けたことを特徴とする移動体の誘
導設備。
1. An apparatus for guiding a self-propelled moving body, comprising: an irradiating unit that irradiates a light beam between a first setting point and a second setting point; and an angle of a light irradiation surface irradiated by the irradiating unit. And a light beam generating means having a rotating portion that forms a plurality of guide paths for the moving object is provided, wherein the moving object is disposed in a direction in which the light beams intersect before and after the moving object, and A light receiving position detecting means for detecting a light receiving position, and traveling before and after the light receiving position detected by the light receiving position detecting means are both constant, moved to the set point, and the moved arrival point and the moving body are moved. And a traveling unit for detecting a deviation amount from a target point to be provided, and a rotating unit of the light beam generation unit is driven in accordance with the positional deviation amount detected by the traveling unit. correcting the rotational angle with respect to the moving axis Each of said guideway
A mobile body guidance facility, characterized by comprising a control means for changing .
JP05969997A 1997-03-14 1997-03-14 Mobile body guidance equipment Expired - Fee Related JP3244641B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP05969997A JP3244641B2 (en) 1997-03-14 1997-03-14 Mobile body guidance equipment

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP05969997A JP3244641B2 (en) 1997-03-14 1997-03-14 Mobile body guidance equipment

Publications (2)

Publication Number Publication Date
JPH10254544A JPH10254544A (en) 1998-09-25
JP3244641B2 true JP3244641B2 (en) 2002-01-07

Family

ID=13120732

Family Applications (1)

Application Number Title Priority Date Filing Date
JP05969997A Expired - Fee Related JP3244641B2 (en) 1997-03-14 1997-03-14 Mobile body guidance equipment

Country Status (1)

Country Link
JP (1) JP3244641B2 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2014006832A (en) * 2012-06-27 2014-01-16 Hitachi Ltd Conveyance system
JP7085576B2 (en) * 2020-02-27 2022-06-16 三菱ロジスネクスト株式会社 Mobile control systems, mobiles, control methods and programs

Also Published As

Publication number Publication date
JPH10254544A (en) 1998-09-25

Similar Documents

Publication Publication Date Title
JP6492024B2 (en) Moving body
US4918607A (en) Vehicle guidance system
JP6507894B2 (en) Travel control method at unloading in unmanned forklift and travel control device at unloading
CN106444766A (en) AGV(automatic guided vehicle) and control method thereof
US20160170412A1 (en) Autonomous mobile device and method for controlling same
US11358706B2 (en) Automated weight balancing for automated guided vehicle
CN107817803A (en) The control system and its control method of a kind of secondary accurate positioning suitable for AGV
WO2021170852A1 (en) Method for controlling an automatic guided vehicle and control system adapted to execute the method
JP3244641B2 (en) Mobile body guidance equipment
JP3262734B2 (en) Cargo handling equipment
JP3212530B2 (en) Mobile body guidance equipment
JP3244642B2 (en) Mobile body guidance equipment
JPH0412841B2 (en)
JP7300413B2 (en) Control device, moving body, movement control system, control method and program
JPS59153211A (en) Guiding method of unmanned carrier car
JP2011243129A (en) Transportation vehicle system
JP2004264099A (en) Apparatus for detecting location of movable body and automated guided vehicle
JPH0794320B2 (en) Automatic cargo handling control method
JP2825239B2 (en) Automatic guidance control device for moving objects
JP2007072572A (en) Article conveyance facility
JP7187516B2 (en) Mobile object, mobile control system, mobile object control method and program
JPS60231218A (en) Unmanned carrier car having positioning device
JPH10254542A (en) Guiding equipment for moving body
JP2004287711A (en) Moving mechanism for moving carriage and movement control method
JP2021182272A (en) Mobile robot

Legal Events

Date Code Title Description
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20010918

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees