JP3307288B2 - Mobile robot - Google Patents

Mobile robot

Info

Publication number
JP3307288B2
JP3307288B2 JP22818097A JP22818097A JP3307288B2 JP 3307288 B2 JP3307288 B2 JP 3307288B2 JP 22818097 A JP22818097 A JP 22818097A JP 22818097 A JP22818097 A JP 22818097A JP 3307288 B2 JP3307288 B2 JP 3307288B2
Authority
JP
Japan
Prior art keywords
arm
obstacle
sensor
robot
detection
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
JP22818097A
Other languages
Japanese (ja)
Other versions
JPH1158271A (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.)
Denso Corp
Original Assignee
Denso 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 Denso Corp filed Critical Denso Corp
Priority to JP22818097A priority Critical patent/JP3307288B2/en
Publication of JPH1158271A publication Critical patent/JPH1158271A/en
Application granted granted Critical
Publication of JP3307288B2 publication Critical patent/JP3307288B2/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)
  • Manipulator (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 robot having an unmanned transport vehicle that moves between a plurality of facilities and a robot arm for performing various operations.

【0002】[0002]

【発明が解決しようとする課題】無人搬送台車にロボッ
トアームを搭載した移動ロボットは、近年、例えば自動
車用の部品の組立ライン等に採用されてきている。この
種の移動ロボットにおいては、例えば実開平6−332
10号公報に示されるように、近傍に、人あるいは他の
移動ロボット等が近付いているときに、その動作を停止
させるような安全機能を設けることが考えられている。
In recent years, mobile robots having a robot arm mounted on an unmanned carrier have been used in, for example, an assembly line for parts for automobiles. In this type of mobile robot, for example, Japanese Utility Model Laid-Open No. 6-332
As disclosed in Japanese Patent Application Laid-Open No. 10, a safety function that stops the operation of a person or another mobile robot when approaching is considered.

【0003】具体的には、図11に部分的に示すよう
に、この種の組立ラインにおいては、走行路1に沿って
複数の設備2,3,4(3つのみ図示)が設けられ、複
数台の移動ロボット5,6(2台のみ図示)がその走行
路1上を矢印a方向に移動(自走)するようになってい
る。各移動ロボット5,6は、例えば設備2においてワ
ークを受取り、そのワークの検査を行いながら次の設備
3へ移動し、設備3において検査が終了したワークの組
付け作業を行い、さらに隣の設備4で別のワークを受取
るといった作業を行うのである。
[0003] More specifically, as shown partially in FIG. 11, in this type of assembly line, a plurality of facilities 2, 3, 4 (only three are shown) are provided along a traveling path 1. A plurality of mobile robots 5 and 6 (only two robots are shown) move (self-run) on the traveling path 1 in the direction of arrow a. Each of the mobile robots 5 and 6 receives, for example, a workpiece in the facility 2, moves to the next facility 3 while inspecting the workpiece, performs an assembling work of the workpiece that has been inspected in the facility 3, and further performs a next facility. The work of receiving another work at 4 is performed.

【0004】ここで、各移動ロボット5,6は、無人搬
送台車7上にロボットアーム8を備えてなると共に、前
記無人搬送台車7の前後左右に、障害物を検知するため
の光電センサ9(前部の光電センサ9のみ図示)を備え
ている。この場合、各光電センサ9は、搬送路1と平行
(水平)に指向して取付けられる。そして、光電センサ
9の検知範囲A内に作業者等の障害物を検出すると、無
人搬送台車7及びロボットアーム8の動作を停止させる
ことにより、安全機能が実現されるようになっている。
[0004] Each of the mobile robots 5 and 6 includes a robot arm 8 on an unmanned transport vehicle 7 and photoelectric sensors 9 (for detecting obstacles) at front, rear, left and right sides of the unmanned transport vehicle 7. Only the front photoelectric sensor 9 is shown). In this case, each photoelectric sensor 9 is mounted so as to be directed parallel (horizontally) to the transport path 1. When an obstacle such as a worker is detected in the detection range A of the photoelectric sensor 9, the safety function is realized by stopping the operations of the automatic guided vehicle 7 and the robot arm 8.

【0005】従来のものでは、図11に示したように、
例えば前の移動ロボット5が設備4に停止している状態
では、後の移動ロボット6は、設備2と設備3との間で
停止され、前の移動ロボット5が次の設備へ向けて移動
した後に、後の移動ロボット6が設備3へ移動すること
になる。ところが、後の移動ロボット6が設備2と設備
3との間で停止している待ち時間中には、そのロボット
アーム8の作業を安全に行い得るにもかかわらず、ロボ
ットアーム8の作業が停止されることになり、作業が停
滞してしまい稼働率が低下する問題点があった。
In the prior art, as shown in FIG.
For example, in a state where the preceding mobile robot 5 is stopped at the facility 4, the later mobile robot 6 is stopped between the facility 2 and the facility 3, and the preceding mobile robot 5 moves toward the next facility. Later, the later mobile robot 6 will move to the equipment 3. However, during the waiting time during which the mobile robot 6 is stopped between the equipment 2 and the equipment 3, the work of the robot arm 8 is stopped although the work of the robot arm 8 can be performed safely. As a result, there is a problem that the work is stagnated and the operation rate is reduced.

【0006】また、図12に示すように、いわば二車線
を有する走行路1を、矢印b,cで示すように、移動ロ
ボット5,6が対面して移動するような場合があるが、
例えば一方の移動ロボット5が、設備2部分で停止しそ
のロボットアーム8により作業を行っている際に、他方
の移動ロボット6が、設備3へ移動してくることが考え
られる。
As shown in FIG. 12, there are cases where the mobile robots 5 and 6 face each other on a traveling path 1 having two lanes as shown by arrows b and c.
For example, it is conceivable that one of the mobile robots 5 moves to the equipment 3 while one of the mobile robots 5 stops at the equipment 2 and is working with the robot arm 8.

【0007】このとき、走行路1の幅が比較的狭いと、
無人搬送台車7の側方の障害物を検知するための光電セ
ンサ9の検知範囲A内に、両移動ロボット5,6が互い
に侵入し合ってしまうことになる。このため、先に設備
2部分で停止していた移動ロボット5のロボットアーム
8の作業が途中で停止され、これと共に、他方の移動ロ
ボット6に関してもロボットアーム8の作業が停止され
ることになり、双方が停止したまま動けなくなるといっ
た不具合も生ずる。
At this time, if the width of the traveling path 1 is relatively narrow,
Both mobile robots 5 and 6 will enter each other within the detection range A of the photoelectric sensor 9 for detecting an obstacle on the side of the automatic guided vehicle 7. For this reason, the operation of the robot arm 8 of the mobile robot 5 which has been stopped previously at the facility 2 is stopped halfway, and at the same time, the operation of the robot arm 8 of the other mobile robot 6 is also stopped. However, there is also a problem that the user cannot move while both are stopped.

【0008】本発明は上記事情に鑑みてなされたもの
で、その目的は、障害物に対する安全機能を実現しなが
らも、ロボットアームによる作業を効率良く行うことが
できる移動ロボットを提供するにある。
[0008] The present invention has been made in view of the above circumstances, and an object of the present invention is to provide a mobile robot that can efficiently perform work by a robot arm while realizing a safety function for obstacles.

【0009】[0009]

【課題を解決するための手段】本発明の移動ロボット
は、無人搬送台車の進行方向の障害物を検知する台車用
障害物検知センサと、ロボットアームの動作領域の周囲
部の障害物を検知するアーム用障害物検知センサとを別
途に設け、それら各障害物検知センサの検知信号に基づ
いて、無人搬送台車及びロボットアームに関して夫々独
立して安全確保動作を実行させる構成とすると共に、
人搬送台車が設備近傍の所定の位置にあるときに、アー
ム用障害物検知センサの検出範囲を小さくする或いは検
出動作を停止するセンサ制御手段を設けたところに特徴
を有する(請求項1の発明)。
SUMMARY OF THE INVENTION A mobile robot according to the present invention detects an obstacle in a traveling direction of an unmanned transport vehicle and an obstacle detection sensor for a vehicle, and detects an obstacle around an operation area of a robot arm. It provided the obstacle detecting sensor arm separately, on the basis of their detection signals of the obstacle detection sensor, with each independently a configuration for executing the secure operation with respect to the unmanned conveyance carriage and robot arm, no
When the human transport trolley is at a predetermined position near the equipment,
The detection range of the obstacle detection sensor for
It is characterized in that a sensor control means for stopping the output operation is provided (the invention of claim 1).

【0010】これによれば、台車用障害物検知センサ及
びアーム用障害物検知センサの検知信号に基づいて安全
確保動作が実行されることにより、無人搬送台車及びロ
ボットアームの接触事故等を未然に防止することがで
き、安全に作業を行うことができる。そして、台車用障
害物検知センサの障害物の検知範囲と、アーム用障害物
検知センサの障害物の検知範囲とを別々に設定すること
ができ、例えば台車用障害物検知センサの検知範囲に障
害物が存在しても、アーム用障害物検知センサが障害物
を検知していないときには、ロボットアームの作業を継
続して行うことができる。このとき、アーム用障害物検
知センサを、上方を指向するように傾けて取付けたこと
により、検知範囲が水平方向に設定されるものと異な
り、実質的なロボットアームの動作領域に検知範囲を設
定することができ、例えばロボットアームが誤動作した
場合等にロボットアーム自身がアーム用障害物検知セン
サの検知範囲に侵入することによって自らの動作が停止
されるといういわば安全スクリーンの機能を果たすこと
になり、ロボットアームの動作に伴う安全性を確保する
ことができ、しかも、ロボットアームの動作領域の下方
においては、水平方向の検知範囲をさほど拡げずに済ま
せることができ、例えば他の無人搬送台車等とのすれ違
い等に支障を来すことがなくなる。
According to this, the safety assurance operation is performed based on the detection signals of the trolley obstacle detection sensor and the arm obstacle detection sensor, so that accidents such as contact between the automatic guided vehicle and the robot arm can be prevented. Can be prevented and work can be performed safely. Then, the detection range of the obstacle of the trolley obstacle detection sensor and the detection range of the obstacle of the arm obstacle detection sensor can be separately set. Even if there is an object, when the obstacle detection sensor for the arm does not detect an obstacle, the operation of the robot arm can be continued. At this time, the arm obstacle detection
The intellectual sensor has been installed at an angle so that it points upward.
Is different from the setting of the detection range in the horizontal direction.
Detection area in the actual robot arm operation area.
For example, the robot arm malfunctioned
In such cases, the robot arm itself detects the obstacle
Operation stops when it enters the detection range
Function as a safety screen
And ensure the safety associated with the operation of the robot arm
And below the operating area of the robot arm
In this case, the horizontal detection range does not need to be greatly expanded.
For example, passing by other unmanned transport vehicles, etc.
It will not cause any trouble.

【0011】そして、アーム用障害物検知センサを上方
を指向するように傾けて取付けたことに伴い、例えば無
人搬送台車が設備前に停止してロボットアームを設備ま
で延ばして作業を行うような場合、アーム用障害物検知
センサが設備を検知してしまったり、ロボットアーム自
身がアーム用障害物検知センサの検知範囲に侵入する虞
が生ずるが、センサ制御手段により、無人搬送台車が設
備近傍の所定の位置にあるときに、アーム用障害物検知
センサの検出範囲が小さくされる、或いは検出動作が停
止されるので、例えば、設備部分にてロボットアームが
作業を行っている際に、自身がアーム用障害物検知セン
サの検知範囲に侵入することによって自らの動作が停止
れるといった不都合を未然に防止することができるよ
うになる。この結果、本発明の請求項1の移動ロボット
によれば、障害物に対する安全機能を実現しながらも、
ロボットアームによる作業を効率良く行うことができ
る。
Then, the obstacle detecting sensor for the arm is moved upward.
With the tilted mounting so that
The human carrier stops in front of the equipment and the robot arm is
Arm for obstacle detection
Sensors may detect equipment, or the robot arm may
The body may enter the detection range of the obstacle detection sensor for the arm.
However, an unmanned carrier is installed by the sensor control means.
Obstacle detection for the arm when it is at a predetermined position near the
The detection range of the sensor is reduced or the detection operation stops.
Because sealed by, for example, when the robot arm in the equipment parts are working, such himself its operation is stopped <br/> by entering the detection range of the obstacle detecting sensor arm Inconvenience can be prevented beforehand. As a result, according to the mobile robot of the first aspect of the present invention, while realizing the safety function for obstacles,
Work by the robot arm can be performed efficiently.

【0012】この場合、前記台車用障害物検知センサの
進行方向の障害物検知距離を、アーム用障害物検知セン
サの同方向の障害物検知距離よりも長く設定すると効果
的である(請求項2の発明)。これにより、例えば無人
搬送台車の進行方向前方に他の無人搬送台車等の障害物
が存在する場合でも、その障害物がアーム用障害物検知
センサの検出範囲に入る前に無人搬送台車を停止させる
ことができ、この結果、ロボットアームの安全確保動作
を実行させるに至らずに、その作業を継続させることが
できる。
In this case, it is effective to set the obstacle detection distance in the traveling direction of the truck obstacle detection sensor longer than the obstacle detection distance of the arm obstacle detection sensor in the same direction. Invention). Thus, for example, even when there is an obstacle such as another unmanned carrier in the forward direction of the unmanned carrier, the unmanned carrier is stopped before the obstacle enters the detection range of the arm obstacle detection sensor. As a result, the operation can be continued without executing the operation for ensuring the safety of the robot arm.

【0013】さらには、前記センサ制御手段を、無人搬
送台車が所定のコースに位置しているときに、前記台車
用障害物検知センサの検知範囲を小さくする或いは検知
動作を停止するように構成することもできる(請求項3
の発明)。これによれば、台車用障害物検知センサの感
度が、無人搬送台車の位置に応じて変更されるので、例
えば、無人搬送台車がカーブを曲がる際に本来安全な位
置にある設備等が台車用障害物検知センサの検知範囲に
入って停止されるといった不都合を未然に防止すること
ができるようになる。
Further, the sensor control means may be unmanned
When the carriage is located on a predetermined course, the carriage
The detection range of the obstacle detection sensor for use or detect
The operation may be stopped.
Invention). According to this, the sense of the trolley obstacle detection sensor is
The degree is changed according to the position of the automatic guided vehicle.
For example, when an unmanned transport vehicle turns a curve,
Equipment etc. are within the detection range of the trolley obstacle detection sensor.
Prevent inconvenience such as entering and stopping
Will be able to

【0014】また、アーム用障害物検知センサの検知範
囲を、ロボットアームの位置や速度によって変更する検
知範囲変更手段を設けるようにしても良い(請求項4の
発明)。これによれば、ロボットアームが作業を行って
いる際に、自身がアーム用障害物検知センサの検知範囲
に侵入することによって自らの動作が停止される不具合
を未然に防止することができる。
Further, a detection range changing means for changing the detection range of the arm obstacle detection sensor according to the position and speed of the robot arm may be provided. According to this, it is possible to prevent a problem in which the operation of the robot arm is stopped by the robot arm entering the detection range of the arm obstacle detection sensor while the robot arm is working.

【0015】ところで、例えば設備部分にてロボットア
ームが作業を行っている際に、アーム用障害物検知セン
サの感度を下げたり検知範囲を変更したりすると、設備
部分に作業者等が侵入しても、アーム用障害物検知セン
サにより障害物として検知できなくなる場合が生ずる。
そこで、設備側に設けられ設備の近傍に障害物が侵入し
たことを検知する設備側障害物検知手段を設け、その検
知信号を障害物信号受信手段により受信するように構成
すると共に、その受信信号に基づいて安全動作実行手段
により安全確保動作を実行させるように構成すれば(請
求項5の発明)、安全性をより一層高めることができる
ようになる。
By the way, if, for example, the sensitivity of the obstacle detection sensor for the arm is reduced or the detection range is changed while the robot arm is working in the equipment portion, an operator or the like enters the equipment portion. Also, there is a case where the obstacle detection sensor for the arm cannot detect the obstacle as an obstacle.
Therefore, equipment-side obstacle detection means provided on the equipment side and detecting that an obstacle has entered the vicinity of the equipment is provided, and the detection signal is received by the obstacle signal reception means, and the reception signal is provided. If the safety operation executing means is configured to execute the safety ensuring operation based on the above (invention of claim 5), the safety can be further improved.

【0016】[0016]

【発明の実施の形態】以下、本発明の一実施例(請求項
1〜3に対応)について、図1ないし図9を参照しなが
ら説明する。図1ないし図3は、本実施例に係る移動ロ
ボット11の構成を概略的に示しており、この移動ロボ
ット11は、無人搬送台車12上にロボットアーム13
を備えて構成されている。
DESCRIPTION OF THE PREFERRED EMBODIMENTS One embodiment of the present invention (corresponding to claims 1 to 3) will be described below with reference to FIGS. 1 to 3 schematically show the configuration of a mobile robot 11 according to the present embodiment. The mobile robot 11 has a robot arm 13 mounted on an unmanned carrier 12.
It is configured with.

【0017】このうち無人搬送台車12(以下「搬送台
車12」と略称する)は、周知のように、全体としてほ
ぼ矩形箱状をなし上面が作業台(載置台)とされた本体
12aの底部に、車輪12b(図2参照)を有して構成
されている。そして、前記車輪12bは、図示はしない
が、バッテリーを電源として駆動モータやステアリング
モータにより駆動されるようになっており、これらによ
り図3に示す走行部14が構成されている。
As is well known, the automatic guided vehicle 12 (hereinafter referred to as the "transported vehicle 12") has a substantially rectangular box shape as a whole, and a bottom portion of a main body 12a having an upper surface serving as a work table (mounting table). And a wheel 12b (see FIG. 2). Although not shown, the wheels 12b are driven by a drive motor or a steering motor using a battery as a power source, and these constitute a traveling unit 14 shown in FIG.

【0018】そして、図3に示すように、この走行部1
4は、走行用コントローラ15により制御されるように
なっている。この場合、搬送台車12は、前進及び後退
方向に移動するようになっている。このとき、後述する
ように、走行路18の床部には、ガイドテープあるいは
ガイドワイヤ等からなる誘導ライン28(図8にのみ図
示)が、走行路22の端部の床部には、同様に誘導ライ
ン29(図9にのみ図示)が、搬送台車12の進行方向
に沿って延びるように設けられている。図示はしない
が、搬送台車12(本体12a)の底部にはそれらの誘
導ライン28,29等を検出する誘導用センサが設けら
れており、以て、搬送台車12(移動ロボット11)
は、それら誘導ライン28,29等に沿って移動するよ
うになっている。
Then, as shown in FIG.
4 is controlled by the traveling controller 15. In this case, the transport carriage 12 moves in the forward and backward directions. At this time, as will be described later, a guide line 28 (shown only in FIG. 8) made of a guide tape, a guide wire, or the like is provided on the floor of the travel path 18, and a guide line 28 is provided on the floor at the end of the travel path 22. A guide line 29 (shown only in FIG. 9) is provided so as to extend along the traveling direction of the transport vehicle 12. Although not shown, a guide sensor for detecting the guide lines 28, 29 and the like is provided at the bottom of the transport trolley 12 (main body 12a), so that the transport trolley 12 (mobile robot 11) is provided.
Move along the guide lines 28, 29 and the like.

【0019】一方、前記ロボットアーム13(以下「ア
ーム13」と略称する)は、例えば多関節形アームから
なり、先端部に、図示しないワークを把持して所定の作
業を行うハンド16を備えて構成されている。また、こ
のアーム13(及びハンド16)は、図3に示すアーム
用コントローラ17により制御されるようになってい
る。これにて、アーム13は、例えばワークの組付け,
加工,検査等の作業を実行するようになっている。
On the other hand, the robot arm 13 (hereinafter abbreviated as "arm 13") is composed of, for example, an articulated arm, and has a hand 16 at its tip for gripping a work (not shown) and performing a predetermined work. It is configured. The arm 13 (and the hand 16) is controlled by an arm controller 17 shown in FIG. Thus, the arm 13 can be attached to the workpiece, for example,
Operations such as processing and inspection are performed.

【0020】尚、本実施例に係る移動ロボット11は、
例えば自動車用部品の組立ラインに用いられ、複数台が
同時に組立ライン内で作業を行うようになっている。こ
の組立ラインは、移動ロボット11が走行する走行路に
沿って複数の設備を備えており、図6及び図7は、その
組立ラインの一部を夫々示している。
Note that the mobile robot 11 according to the present embodiment
For example, it is used in an assembly line for automotive parts, and a plurality of units work simultaneously in the assembly line. This assembly line includes a plurality of facilities along a traveling path on which the mobile robot 11 travels, and FIGS. 6 and 7 each show a part of the assembly line.

【0021】ここで、図6及び図8に示す走行路18の
近傍には、走行路18に沿って図で左側から順に3つの
設備19,20,21が設けられている。複数台の移動
ロボット11は、矢印a方向に移動しながら、例えば設
備19においてワークを受取り、そのワークの検査を行
いながら次の設備20へ移動し、設備20において検査
が終了したワークの組付け作業を行い、さらに隣の設備
21で別のワークを受取るといった作業を行う。
Here, in the vicinity of the traveling path 18 shown in FIGS. 6 and 8, three facilities 19, 20, and 21 are provided along the traveling path 18 in order from the left side in the figure. The plurality of mobile robots 11 receive a work at the equipment 19, for example, while moving in the direction of the arrow a, move to the next equipment 20 while inspecting the work, and assemble the work that has been inspected at the equipment 20. Work is performed, and another work is received at the adjacent facility 21.

【0022】また、図7に示す走行路22は、いわば二
車線を有するものであり、矢印b,cで示すように、移
動ロボット11が対面して移動し、各車線で設備23,
24に夫々停止して所定の作業を行うようになってい
る。さらに、図9に示すように、走行路22の端部にお
いては、移動ロボット11が矢印dで示すようにUター
ン状に移動するようになっている。このとき、走行路2
2の端部の外側には、障害物30が存在するようになっ
ている。
The traveling path 22 shown in FIG. 7 has two lanes, so to speak, as shown by arrows b and c, the mobile robot 11 moves facing each other, and the equipment 23,
At 24, predetermined operations are performed. Further, as shown in FIG. 9, at the end of the traveling path 22, the mobile robot 11 moves in a U-turn shape as shown by an arrow d. At this time, traveling path 2
An obstacle 30 exists outside the end of the second part.

【0023】さて、前記搬送台車12の本体12aの前
部及び後部には、該搬送台車12の進行方向(前進及び
後退方向)の障害物を検知するための台車用障害物検知
センサ25が夫々左右に2個ずつ設けられている。これ
ら台車用障害物検知センサ25(以下「台車用センサ2
5」と略称する)は、非接触形の物体検知センサ例えば
超音波センサからなり、設定された検知範囲A1(前方
のみ図示)内における障害物(人や他の移動ロボット1
1の搬送台車12等)を検知するようになっている。
尚、この台車用センサ25の検知範囲A1は、走行路1
8,22の路面とほぼ平行(水平)に設定されている。
At the front and rear portions of the main body 12a of the carriage 12, an obstacle detection sensor 25 for the carriage for detecting obstacles in the traveling direction (forward and backward directions) of the carriage 12 is provided. Two are provided on each side. These trolley obstacle detection sensors 25 (hereinafter referred to as “trolley sensor 2
5) is a non-contact type object detection sensor, for example, an ultrasonic sensor, and an obstacle (a person or another mobile robot 1) within a set detection range A1 (only the front is shown).
1 transport cart 12 etc.).
Note that the detection range A1 of the bogie sensor 25 is the travel path 1
It is set substantially parallel (horizontal) to the road surfaces 8 and 22.

【0024】そして、搬送台車12の本体12aには、
前記アーム13の周囲部の障害物を検知するためのアー
ム用障害物検知センサ26が設けられている。このアー
ム用障害物検知センサ26(以下「アーム用センサ2
6」と略称する)は、やはり非接触形の例えば超音波セ
ンサからなり、本体12aの前部及び後部の夫々中央部
に位置して各1個、左右の側壁部の夫々前後に位置して
各2個の合計6個が設けられている。
The main body 12a of the carrier 12 has
An arm obstacle detection sensor 26 for detecting an obstacle around the arm 13 is provided. This arm obstacle detection sensor 26 (hereinafter referred to as “arm sensor 2”)
6 "), which is also formed of a non-contact type, for example, an ultrasonic sensor, and is located at the center of each of the front part and the rear part of the main body 12a, one each at the front and rear of the left and right side wall parts. A total of six of each two are provided.

【0025】これらアーム用センサ26は、設定された
検知範囲A2内における障害物(人や他の移動ロボット
11のアーム13等)を検知するのであるが、このと
き、本実施例では、図1に示すように、台車用センサ2
5の進行方向(図1で矢印a方向)の障害物検知距離
が、アーム用センサ26の同方向(前方水平方向)の障
害物検知距離よりも長く設定されるようになっている。
さらに、本実施例では、図2に示すように、これらアー
ム用センサ26は、斜め上方を指向するように角度θだ
け傾けて取付けられており、その検知範囲A2が、アー
ム13の動作領域の高さまでに設定されている。
These arm sensors 26 detect an obstacle (such as a person or the arm 13 of another mobile robot 11) within the set detection range A2. At this time, in this embodiment, FIG. As shown in FIG.
The obstacle detection distance in the traveling direction 5 (the direction of arrow a in FIG. 1) is set longer than the obstacle detection distance of the arm sensor 26 in the same direction (front horizontal direction).
Further, in the present embodiment, as shown in FIG. 2, the arm sensors 26 are attached at an angle θ so as to point obliquely upward, and the detection range A2 is It is set up to the height.

【0026】一方、図3に示すように、搬送台車12の
本体12aには、各機構を制御するための制御装置27
が設けられている。この制御装置27は、マイコン等を
含んでなり、演算処理部27a,入出力ポート部27b
等を備えて構成されている。この制御装置27は、予め
設定された作業プログラムに従って、前記走行用コント
ローラ15及びアーム用コントローラ17に制御信号を
与え、組立作業を実行させるようになっている。そし
て、この制御装置27は、前記台車用センサ25及びア
ーム用センサ26、並びに前記誘導用センサからの信号
が入力されるようになっていると共に、それら台車用セ
ンサ25及びアーム用センサ26のオン,オフを個々に
制御したり、検知範囲A1,A2を調整したりするよう
になっている。
On the other hand, as shown in FIG. 3, a control device 27 for controlling each mechanism is provided in the main body 12a of the transport carriage 12.
Is provided. The control device 27 includes a microcomputer and the like, and includes an arithmetic processing unit 27a, an input / output port unit 27b.
And the like. The control device 27 supplies a control signal to the traveling controller 15 and the arm controller 17 according to a preset work program to execute an assembling work. The control device 27 receives signals from the bogie sensor 25, the arm sensor 26, and the guidance sensor, and turns on the bogie sensor 25 and the arm sensor 26. , And OFF are individually controlled, and the detection ranges A1 and A2 are adjusted.

【0027】このとき、後の作用説明にて述べるよう
に、制御装置27は、そのソフトウエア構成により、前
記台車用センサ25から障害物検知信号が入力される
と、搬送台車12の安全確保動作を実行させるこの場合
停止させるようになっている。そして、前記アーム用セ
ンサ26から障害物検知信号が入力されると、アーム1
3の安全確保動作を実行させるこの場合停止させるよう
になっている。従って、制御装置27が、本発明にいう
搬送台車制御手段及びロボット制御手段として機能する
のである。
At this time, as will be described in the following description of the operation, the control device 27 is operated by the software configuration when the obstacle detection signal is input from the bogie sensor 25 and the safety operation of the transport bogie 12 is performed. In this case, the operation is stopped. When an obstacle detection signal is input from the arm sensor 26, the arm 1
In this case, the operation is stopped in order to execute the safety operation 3. Accordingly, the control device 27 functions as the carrier control means and the robot control means according to the present invention.

【0028】さらに、制御装置27は、予め入力されて
いるコース情報に応じて、搬送台車12が誘導ライン2
8の所定のコースに位置したときに、6個のアーム用セ
ンサ26のうち所定のものの感度を変更するこの場合検
知動作を一時的に停止(オフ)するように構成されてい
る。より具体的には、今、図8に示すように、走行路1
8には誘導ライン28が設けられているのであるが、そ
の誘導ライン28は、その進行方向に沿って分けられた
いくつかのコース1,コース2,コース3…が設定され
ており、そのうち設備19の近傍のコース2(便宜上斜
線を付して示す)に搬送台車12が位置しているときに
は、設備19側(進行方向右側)のアーム用センサ26
がオフされるのである。
Further, the control device 27 controls the transport vehicle 12 to change the guide line 2 in accordance with the previously input course information.
When the vehicle is located on the predetermined course of No. 8, the detection operation of changing the sensitivity of the predetermined one of the six arm sensors 26 is temporarily stopped (turned off) in this case. More specifically, as shown in FIG.
8, a guide line 28 is provided. The guide line 28 is provided with several courses 1, course 2, course 3,... Divided along the traveling direction. When the transport vehicle 12 is located on the course 2 (shown as hatched for convenience) near the device 19, the arm sensor 26 on the facility 19 side (rightward in the traveling direction)
Is turned off.

【0029】また、本実施例では、制御装置27は、予
め入力されているコース情報に応じて、搬送台車12が
誘導ライン29の所定のコースに位置したときに、前記
台車用センサ25の感度を変更するこの場合検知範囲A
1を小さく(短く)するように構成されている。具体的
には、図9に示すように、走行路22の端部のUターン
状の誘導ライン29は、やはり進行方向に沿ってコース
11,コース12,コース13,コース14というよう
に設定がなされており、そのうち障害物30の近傍のコ
ース13に(便宜上斜線を付して示す)に搬送台車12
が位置しているときには、障害物30側(右側)の台車
用センサ25の検知範囲A1が障害物に届かない程度に
小さくされるようになっているのである。従って、制御
装置27が、本発明にいうセンサ制御手段としても機能
するのである。
Further, in this embodiment, the control device 27 determines the sensitivity of the bogie sensor 25 when the transport bogie 12 is positioned on a predetermined course of the guide line 29 in accordance with the previously input course information. In this case, the detection range A
1 is made smaller (shorter). Specifically, as shown in FIG. 9, the U-turn guide line 29 at the end of the traveling path 22 is also set along the traveling direction such as course 11, course 12, course 13, and course 14. The transfer truck 12 is placed on a course 13 near the obstacle 30 (shown by hatching for convenience).
Is located, the detection range A1 of the bogie sensor 25 on the side of the obstacle 30 (right side) is made small enough not to reach the obstacle. Therefore, the control device 27 also functions as the sensor control means according to the present invention.

【0030】次に、上記構成の作用について、図4ない
し図9も参照しながら述べる。移動ロボット11の電源
がオンされ、作業プログラムが起動されると、そのプロ
グラム内の命令によって、台車用センサ25及びアーム
用センサ26がオンされる。図4のフローチャートは、
台車用センサ25の電源がオンされたときの制御装置2
7が実行する制御手順を示し、図5のフローチャート
は、アーム用センサ26の電源がオンされたときの制御
装置27が実行する制御手順を示している。
Next, the operation of the above configuration will be described with reference to FIGS. When the power of the mobile robot 11 is turned on and the work program is started, the bogie sensor 25 and the arm sensor 26 are turned on according to a command in the program. The flowchart of FIG.
Control device 2 when power supply of cart sensor 25 is turned on
7 shows a control procedure executed by the control unit 27. The flowchart of FIG. 5 shows a control procedure executed by the control device 27 when the power of the arm sensor 26 is turned on.

【0031】ここで、図4のフローチャートに示すよう
に、台車用センサ25の電源がオンされているときに
は、搬送台車12が現在どのコースにあるのかが常に監
視され、搬送台車12が所定のコースに入ったかどうか
が判断される(ステップS1)。この場合、所定のコー
スとは、搬送台車12がカーブを曲がる際に本来安全な
位置にある障害物が台車用センサ25の検知範囲に入っ
て停止される部所など、つまり図9に示すコース13の
ような障害物30の近傍などに予め設定されるようにな
っている。
Here, as shown in the flowchart of FIG. 4, when the power supply of the bogie sensor 25 is turned on, the current course of the transport bogie 12 is constantly monitored, and the transport bogie 12 is moved to a predetermined course. It is determined whether the process has entered (step S1). In this case, the predetermined course is, for example, a place where an obstacle at an inherently safe position enters the detection range of the bogie sensor 25 and stops when the transport bogie 12 turns a curve, that is, the course shown in FIG. 13 is set in advance near the obstacle 30 or the like.

【0032】そして、搬送台車12が所定のコース以外
に位置しているときには(ステップS1にてNo)、台
車用センサ25のオン状態が維持され(ステップS
2)、搬送台車12が所定のコースに位置しているとき
には(ステップS1にてYes)、所定の台車用センサ
25の検知範囲A1を小さくする(あるいはオフする)
制御が行われる(ステップS3)。従って、図9に示す
ように、搬送台車12がUターンする際に障害物30に
近付いたときには、障害物30側(右側)の台車用セン
サ25の検知範囲A1が小さくされ、障害物30を検知
することがなくなるのである。
When the transport vehicle 12 is located outside the predetermined course (No in step S1), the ON state of the vehicle sensor 25 is maintained (step S1).
2) When the transport trolley 12 is located on a predetermined course (Yes in step S1), the detection range A1 of the predetermined trolley sensor 25 is reduced (or turned off).
Control is performed (step S3). Therefore, as shown in FIG. 9, when the transport vehicle 12 approaches the obstacle 30 when making a U-turn, the detection range A1 of the vehicle sensor 25 on the obstacle 30 side (right side) is reduced, and the obstacle 30 is There is no detection.

【0033】また、これと共に、台車用センサ25の検
知信号が常に監視されており、台車用センサ25が障害
物を検知しておらず(ステップS4にてNo)、且つ、
アーム用センサ26が障害物を検知していないとき(ス
テップS5にてNo)にのみ、搬送台車12の移動(走
行)が可能となり、搬送台車12がスタートされる(ス
テップS6)。
At the same time, the detection signal of the bogie sensor 25 is constantly monitored, and the bogie sensor 25 does not detect an obstacle (No in step S4), and
Only when the arm sensor 26 does not detect an obstacle (No in step S5), the transport trolley 12 can move (run), and the transport trolley 12 is started (step S6).

【0034】これに対し、台車用センサ25の検知範囲
A1内に、人や他の搬送台車12が存在すると、台車用
センサ25がその障害物を検知し、検知信号を出力する
(ステップS4にてYes)。すると、搬送台車12は
一時停止される(ステップS7)。また、このとき、ア
ーム用センサ26がオンされていて、障害物を検出して
いるときにも(ステップS5にてYes)、搬送台車1
2は一時停止されるようになっている(ステップS
7)。これにて、搬送台車12の進行方向の所定距離内
に障害物が存在するときには、搬送台車12が停止さ
れ、障害物が存在しなくなると、搬送台車12が移動さ
れるのである。
On the other hand, if there is a person or another transport vehicle 12 within the detection range A1 of the vehicle sensor 25, the vehicle sensor 25 detects the obstacle and outputs a detection signal (step S4). Yes). Then, the transport carriage 12 is temporarily stopped (Step S7). At this time, even when the arm sensor 26 is turned on and an obstacle is detected (Yes in step S5), the transport vehicle 1
2 is temporarily stopped (step S
7). Thus, when there is an obstacle within a predetermined distance in the traveling direction of the transport vehicle 12, the transport vehicle 12 is stopped, and when there is no obstacle, the transport vehicle 12 is moved.

【0035】一方、図5のフローチャートに示すよう
に、アーム用センサ26の電源がオンされているときに
は、搬送台車12が現在どのコースにあるのかが常に監
視され、搬送台車12が所定のコースに入ったかどうか
が判断される(ステップS11)。この場合、所定のコ
ースとは、アーム13が作業を行う際に、自身がアーム
用センサ26の検知範囲A2に侵入することによって自
らの動作が停止される虞のある部所など、つまり図8に
示すコース2のような設備19等の近傍などに予め設定
されるようになっている。
On the other hand, as shown in the flowchart of FIG. 5, when the power of the arm sensor 26 is turned on, it is always monitored which course the transport vehicle 12 is currently in, and the transport vehicle 12 is moved to a predetermined course. It is determined whether it has entered (step S11). In this case, the predetermined course is, for example, a place where the operation of the arm 13 is likely to be stopped by entering the detection range A2 of the arm sensor 26 when the arm 13 performs a work, that is, a part shown in FIG. Is set in advance in the vicinity of equipment 19 such as course 2 shown in FIG.

【0036】そして、搬送台車12が所定のコース以外
に位置しているときには(ステップS11にてNo)、
アーム用センサ26のオン状態が維持され(ステップS
12)、搬送台車12が所定のコースに位置していると
きには(ステップS11にてYes)、所定のアーム用
センサ26をオフする(あるいは感度を低下させて検知
範囲A2を小さくする)ことが行われる(ステップS1
3)。従って、図6及び図7に示すように、搬送台車1
2が設備19,20,21,23,24等の近傍で停止
しているときには、その設備19,20,21,23,
24側に位置するアーム用センサ26(搬送台車12の
進行方向に向かって右側の2個のアーム用センサ26)
が休止状態とされ、設備を検知することがなくなるので
ある。
When the transport vehicle 12 is located outside the predetermined course (No in step S11),
The on state of the arm sensor 26 is maintained (step S
12) When the transport trolley 12 is located on a predetermined course (Yes in step S11), the predetermined arm sensor 26 is turned off (or the sensitivity is reduced to reduce the detection range A2). (Step S1
3). Therefore, as shown in FIG. 6 and FIG.
2 is stopped near the equipment 19, 20, 21, 23, 24, etc., the equipment 19, 20, 21, 23, 23
Arm sensor 26 located on the 24 side (the two arm sensors 26 on the right side in the traveling direction of the transport trolley 12)
Is put into a dormant state, and no equipment is detected.

【0037】また、これと共に、6個のアーム用センサ
26(所定のコースでは搬送台車12の進行方向に向か
って前後及び左側の4個)の検知信号が常に監視され、
アーム用センサ26が障害物を検知していないとき(ス
テップS14にてNo)にのみ、アーム13が動作され
(ステップS15)、アーム用センサ26の検知範囲A
2内に障害物を検知すると(ステップS14にてYe
s)、アーム13が一時停止されるのである(ステップ
S16)。
At the same time, the detection signals of the six arm sensors 26 (four in the predetermined course, the front and rear and the left in the traveling direction of the transport vehicle 12) are constantly monitored,
Only when the arm sensor 26 does not detect an obstacle (No in Step S14), the arm 13 is operated (Step S15), and the detection range A of the arm sensor 26 is set.
2 when an obstacle is detected (Ye in step S14).
s) The arm 13 is temporarily stopped (step S16).

【0038】このようにして搬送台車12及びアーム1
3が制御されるので、例えば図6に示すように、前の移
動ロボット11が設備21に停止して作業を行っている
状態で、後の移動ロボット11が設備19から設備20
へ向かって移動しているときには、その途中で、前の移
動ロボット11(搬送台車12)が、台車用センサ25
の検知範囲A1内に侵入するようになる。このため、後
の移動ロボット11の搬送台車12が停止され、接触等
が未然に防止される。
In this manner, the carrier 12 and the arm 1
3 is controlled, for example, as shown in FIG. 6, while the preceding mobile robot 11 is stopped at the facility 21 and performing work, the later mobile robot 11 is moved from the facility 19 to the facility 20.
When the mobile robot 11 is moving toward the vehicle, the preceding mobile robot 11 (transfer vehicle 12)
In the detection range A1. For this reason, the transport vehicle 12 of the mobile robot 11 is stopped, and contact and the like are prevented beforehand.

【0039】そして、このとき、前の移動ロボット11
が、検知範囲A1内に入っていても、アーム用センサ2
6の検知範囲A2内には入らないところで停止されるこ
とになり、後の移動ロボット11においてはアーム13
による作業(検査作業)は継続して実行されるようにな
る。前の移動ロボット11が設備21から移動して台車
用センサ25の検知範囲A1から外れると、後の移動ロ
ボット11の搬送台車12が移動して設備20に至るよ
うになる。この場合、搬送台車12が一時停止している
際にも、アーム13による作業を行うことができるの
で、時間のロスがなく効率的な作業を行うことができる
のである。
At this time, the previous mobile robot 11
Is within the detection range A1, the arm sensor 2
6 is stopped when it does not enter the detection range A2.
(Inspection work) is continuously executed. When the preceding mobile robot 11 moves out of the facility 21 and moves out of the detection range A1 of the trolley sensor 25, the transport trolley 12 of the subsequent mobile robot 11 moves to reach the facility 20. In this case, even when the transport trolley 12 is temporarily stopped, the work by the arm 13 can be performed, so that efficient work can be performed without time loss.

【0040】また、例えば図7に示すように、幅が比較
的狭い走行路22を2台の移動ロボット11が対面移動
するような場合、一方の移動ロボット11が、設備23
部分で停止してアーム13により作業を行っている際
に、他方の移動ロボット11が、設備24へ移動してく
ることが考えられる。ところが、このとき、アーム用セ
ンサ26の検知範囲A2は、斜め上向きに設定されてい
るので、アーム用センサ26の検知範囲A2内に、両移
動ロボット11が互いに侵入しあうことはなく、双方の
移動ロボット11は夫々作業を実行することができるの
である。
As shown in FIG. 7, for example, when two mobile robots 11 move face-to-face on a relatively narrow travel path 22, one of the mobile robots 11
It is conceivable that the other mobile robot 11 moves to the equipment 24 while stopping at a part and performing the work with the arm 13. However, at this time, since the detection range A2 of the arm sensor 26 is set obliquely upward, the two mobile robots 11 do not enter each other within the detection range A2 of the arm sensor 26. Each of the mobile robots 11 can execute a task.

【0041】そして、図9に示すように、移動ロボット
11においては、搬送台車12が所定のコースつまり走
行路22の端部にてUターンするような場合には、障害
物30側の台車用センサ25の検知範囲A1が小さくな
るようになっている。これにより、本来安全な位置にあ
る障害物30等が台車用センサ25の検知範囲A1に入
って搬送台車12が停止されるといった不都合を未然に
防止することができるようになるのである。
As shown in FIG. 9, in the mobile robot 11, when the transport vehicle 12 makes a U-turn at a predetermined course, that is, at the end of the traveling path 22, the vehicle for the vehicle on the obstacle 30 side is used. The detection range A1 of the sensor 25 is reduced. As a result, it is possible to prevent the inconvenience that the obstacle 30 or the like, which is originally at a safe position, enters the detection range A1 of the bogie sensor 25 and the transport bogie 12 is stopped.

【0042】さらに、図6ないし図8に示すように、各
移動ロボット11においては、搬送台車12が所定のコ
ースつまり設備19,20,21,23,24の近傍等
に位置しているときには、その設備側(進行方向に向か
って右側)のアーム用センサ26がオフされるようにな
っている。これにより、アーム13を設備側まで延ばし
て作業を行うことができ、アーム13自身がアーム用セ
ンサ26の検知範囲A2に侵入することによって自らの
動作が停止されるといった不都合を未然に防止すること
ができるようになる。
Further, as shown in FIGS. 6 to 8, in each of the mobile robots 11, when the transport carriage 12 is located at a predetermined course, that is, in the vicinity of the facilities 19, 20, 21, 23, 24, etc. The arm sensor 26 on the equipment side (the right side in the traveling direction) is turned off. Accordingly, the work can be performed by extending the arm 13 to the facility side, and the inconvenience of stopping the operation of the arm 13 itself by entering the detection range A2 of the arm sensor 26 can be prevented. Will be able to

【0043】ここで、もし万一、作業プログラムの間違
い等があると、アーム13が例えば設備とは反対側に動
くなどの誤った動作を行う虞がある。ところが、本実施
例では、アーム用センサ26の検知範囲A2が、アーム
13の周囲の動作領域の高さまで設定されているので、
アーム13の誤った動作によってそのアーム13が検知
範囲A2に侵入したときには、そのアーム13自身によ
って自らの動作が停止されるようになり、いわば安全ス
クリーンとしての機能を果たすようになるのである。
Here, if there is an error in the work program or the like, there is a possibility that the arm 13 may perform an erroneous operation such as moving to the opposite side of the facility. However, in the present embodiment, since the detection range A2 of the arm sensor 26 is set up to the height of the operation area around the arm 13,
When the arm 13 enters the detection range A2 due to an erroneous operation of the arm 13, the operation of the arm 13 is stopped by the arm 13 itself, so that the arm 13 functions as a safety screen.

【0044】このように本実施例によれば、次のような
優れた実用的効果を得ることができる。即ち、台車用セ
ンサ25及びアーム用センサ26の検知信号に基づいて
安全確保動作を行わせることにより、障害物に対する安
全機能を実現することができる。そして、別個に設けら
れた台車用センサ25及びアーム用センサ26に基づい
て、夫々搬送台車12及びアーム13を独立して制御す
るものであるから、台車用センサ25が障害物を検知し
た場合でも、アーム用センサ26の検知がない限りはア
ーム13による作業を継続して実行させることができ、
アーム13による作業を効率良く行うことができる。
As described above, according to this embodiment, the following excellent practical effects can be obtained. That is, by performing the safety ensuring operation based on the detection signals of the bogie sensor 25 and the arm sensor 26, a safety function for an obstacle can be realized. Since the transport trolley 12 and the arm 13 are independently controlled based on the trolley sensor 25 and the arm sensor 26 provided separately, even when the trolley sensor 25 detects an obstacle, As long as there is no detection by the arm sensor 26, the operation by the arm 13 can be continuously executed,
The operation by the arm 13 can be performed efficiently.

【0045】しかも、台車用センサ25の感度(検知範
囲A1)及びアーム用センサ26の感度(オン,オフ)
が、搬送台車12の位置に応じて変更されるので、搬送
台車12がカーブを曲がる際に本来安全な位置にある障
害物30等が台車用センサ25の検知範囲A1に入って
停止されるといったことや、アーム13自身がアーム用
センサ26の検知範囲A2に侵入することによって自ら
の動作が停止されるといった不都合を未然に防止するこ
とができるものである。
Moreover, the sensitivity of the bogie sensor 25 (detection range A1) and the sensitivity of the arm sensor 26 (on, off)
Is changed according to the position of the transport vehicle 12, so that when the transport vehicle 12 turns a curve, the obstacle 30 or the like which is originally at a safe position enters the detection range A1 of the vehicle sensor 25 and stops. That is, the inconvenience of stopping the operation of the arm 13 itself when the arm 13 enters the detection range A2 of the arm sensor 26 can be prevented.

【0046】尚、上記した実施例では、搬送台車12の
位置に応じて、台車用センサ25及びアーム用センサ2
6の双方について、その感度を変更するようにしたが、
少なくともアーム用センサ26の感度を変更する構成と
すれば良い。また、センサの感度変更の形態として、台
車用センサ25をオフしたり、アーム用センサ26の検
知範囲A2を小さくするように構成しても良い。
In the above-described embodiment, the trolley sensor 25 and the arm sensor 2 are set in accordance with the position of the transport trolley 12.
The sensitivity of both 6 was changed,
A configuration for changing at least the sensitivity of the arm sensor 26 ;
Just do it. Further, as a form of changing the sensitivity of the sensor, the bogie sensor 25 may be turned off, or the detection range A2 of the arm sensor 26 may be reduced.

【0047】ところで、上記実施例においては、図8な
どに示すように、例えば設備19部分にてアーム13が
作業を行っている際には、その設備19側のアーム用セ
ンサ26がオフしているので、設備19の近傍に作業者
等が侵入しても、アーム用センサ26により障害物とし
て検知できず、アーム13による作業が継続して行われ
るようになる。
In the above embodiment, as shown in FIG. 8, for example, when the arm 13 is working at the equipment 19, the arm sensor 26 of the equipment 19 is turned off. Therefore, even if a worker or the like enters the vicinity of the facility 19, it cannot be detected as an obstacle by the arm sensor 26, and the work by the arm 13 is continued.

【0048】そこで、図10に示す本発明の他の実施例
(請求項5に対応)のように、設備19の左右の床部
に、設備側障害物検知手段としての例えば圧力スイッチ
式の安全マット31,31を設けて作業者等の侵入を検
知する構成とすることができる。これと共に、詳しく図
示はしないが、その安全マット31による検知信号を光
通信や電波等の手段を用いて送信し、移動ロボット11
側にその検知信号を受信する障害物信号受信手段を設け
る構成とする。そして、移動ロボット11においては、
その検知信号を受信することに基づいて、制御装置(安
全動作実行手段)27により、アーム13の安全確保動
作を実行させるように構成すれば良い。
Therefore, as in another embodiment of the present invention shown in FIG. 10 (corresponding to claim 5), for example, a pressure switch type safety device as an equipment-side obstacle detecting means is provided on the left and right floors of the equipment 19. Mats 31 may be provided to detect intrusion of an operator or the like. At the same time, although not shown in detail, a detection signal from the safety mat 31 is transmitted using a means such as optical communication or radio waves, and the mobile robot 11
On the side, an obstacle signal receiving means for receiving the detection signal is provided. And in the mobile robot 11,
The control device (safety operation execution means) 27 may be configured to execute the operation of ensuring the safety of the arm 13 based on receiving the detection signal.

【0049】これによれば、設備19部分でのアーム1
3による作業時に、設備19側のアーム用センサ26が
オフしている事情があっても、作業者等が設備19の近
傍に近付いたことを検知でき、その検知に基づいて移動
ロボット11における安全確保動作を行わせることがで
き、安全性をより一層高めることができるものである。
尚、設備側障害物検知手段としては、圧力スイッチ式の
安全柵や赤外線等を用いた障害物検知センサ等を採用す
ることも可能である。
According to this, the arm 1 in the equipment 19 part
3, even if the arm sensor 26 on the equipment 19 side is turned off, it is possible to detect that the worker or the like has approached the vicinity of the equipment 19, and the safety of the mobile robot 11 is determined based on the detection. The securing operation can be performed, and the safety can be further improved.
As the equipment-side obstacle detection means, a pressure switch-type safety fence, an obstacle detection sensor using infrared rays, or the like may be employed.

【0050】また、図示及び詳しい説明を省略するが、
アーム用障害物検知センサの検知範囲を、ロボットアー
ムの位置や速度によって変更する検知範囲変更手段を設
けるようにしても良い(請求項4に対応)。これによれ
ば、ロボットアームが作業を行っている際に、自身がア
ーム用障害物検知センサの検知範囲に侵入することによ
って自らの動作が停止される不具合を未然に防止するこ
とができる。
Although illustration and detailed explanation are omitted,
A detection range changing means for changing the detection range of the arm obstacle detection sensor according to the position and speed of the robot arm may be provided (corresponding to claim 4). According to this, it is possible to prevent a problem in which the operation of the robot arm is stopped by the robot arm entering the detection range of the arm obstacle detection sensor while the robot arm is working.

【0051】その他、上記した実施例では、安全確保動
作として搬送台車12,アーム13を停止させるように
したが、安全確保動作としては、搬送台車12を減速さ
せたり、アーム13を所定の退避位置へ移動させたりす
る等の動作も考えられる。また、非接触形の物体検知セ
ンサとしては、超音波センサに限らず、赤外線センサな
どの光を利用したセンサも採用することができる。その
他、障害物が検知されたときには、視覚的あるいは聴覚
的な警報を行うようにしても良い等、本発明は要旨を逸
脱しない範囲内で適宜変更して実施し得るものである。
In addition, in the above-described embodiment, the transport vehicle 12 and the arm 13 are stopped as a safety ensuring operation. However, as the safety ensuring operation, the transport vehicle 12 is decelerated or the arm 13 is moved to a predetermined retreat position. It is also conceivable to perform an operation such as moving to a position. Further, the non-contact type object detection sensor is not limited to an ultrasonic sensor, and a sensor using light, such as an infrared sensor, may be employed. In addition, when an obstacle is detected, a visual or audible alarm may be issued, for example, and the present invention can be appropriately modified and implemented without departing from the gist.

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

【図1】本発明の一実施例を示すもので、移動ロボット
の構成を検知範囲と共に概略的に示す平面図
FIG. 1 shows an embodiment of the present invention and is a plan view schematically showing a configuration of a mobile robot together with a detection range.

【図2】移動ロボットの構成を検知範囲と共に概略的に
示す側面図
FIG. 2 is a side view schematically showing a configuration of a mobile robot together with a detection range.

【図3】電気的構成を概略的に示すブロック図FIG. 3 is a block diagram schematically showing an electrical configuration.

【図4】台車用センサのオン時における制御手順を示す
フローチャート
FIG. 4 is a flowchart showing a control procedure when the bogie sensor is turned on.

【図5】アーム用センサのオン時における制御手順を示
すフローチャート
FIG. 5 is a flowchart showing a control procedure when an arm sensor is turned on.

【図6】組立ラインの一部を概略的に示す平面図FIG. 6 is a plan view schematically showing a part of an assembly line.

【図7】組立ラインの別の一部を概略的に示す平面図FIG. 7 is a plan view schematically showing another part of the assembly line.

【図8】設備の近傍の走行路の誘導ラインの状態を示す
平面図
FIG. 8 is a plan view showing a state of a guide line on a traveling path near the facility.

【図9】走行路の端部における誘導ラインの状態を示す
平面図
FIG. 9 is a plan view showing a state of a guide line at an end of a traveling path.

【図10】本発明の他の実施例を示す図8相当図FIG. 10 is a diagram corresponding to FIG. 8, showing another embodiment of the present invention.

【図11】従来例を示す図6相当図FIG. 11 is a diagram corresponding to FIG. 6 showing a conventional example.

【図12】図7相当図FIG. 12 is a diagram corresponding to FIG. 7;

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

図面中、11は移動ロボット、12は無人搬送台車、1
3はロボットアーム、18,22は走行路、19,2
0,21,23,24は設備、25は台車用障害物検知
センサ、26はアーム用障害物検知センサ、27は制御
装置(搬送台車制御手段,ロボット制御手段,センサ制
御手段)、28,29は誘導ライン、30は障害物、3
1は安全マット(設備側障害物検知手段)、A1,A2
は検知範囲を示す。
In the drawing, 11 is a mobile robot, 12 is an unmanned carrier, 1
3 is a robot arm, 18 and 22 are running paths, 19 and 2
Reference numerals 0, 21, 23, 24 denote equipment, 25 denotes an obstacle detection sensor for a trolley, 26 denotes an obstacle detection sensor for an arm, 27 denotes a control device (transportation trolley control means, robot control means, sensor control means), 28, 29 Is a guidance line, 30 is an obstacle, 3
1 is a safety mat (equipment side obstacle detection means), A1, A2
Indicates a detection range.

───────────────────────────────────────────────────── フロントページの続き (58)調査した分野(Int.Cl.7,DB名) B25J 13/08 B25J 5/00 ──────────────────────────────────────────────────続 き Continued on the front page (58) Field surveyed (Int. Cl. 7 , DB name) B25J 13/08 B25J 5/00

Claims (5)

(57)【特許請求の範囲】(57) [Claims] 【請求項1】 無人搬送台車にロボットアームを搭載し
ており、複数の設備間を移動しながら前記ロボットアー
ムによる作業を行うものにおいて、 前記無人搬送台車に設けられ該無人搬送台車の進行方向
の障害物を検知する非接触形の台車用障害物検知センサ
と、 この台車用障害物検知センサの障害物検知信号に基づい
て前記無人搬送台車の安全確保動作を実行させる搬送台
車制御手段と、 前記無人搬送台車に上方を指向するように傾いて取付け
られ前記ロボットアームの動作領域の周囲部の障害物を
検知する非接触形のアーム用障害物検知センサと、 このアーム用障害物検知センサの検知信号に基づいて前
記ロボットアームの安全確保動作を実行させるロボット
制御手段と、 前記無人搬送台車が前記設備近傍の所定の位置にあると
きに、前記アーム用障害物検知センサの検知範囲を小さ
くする或いは検知動作を停止するセンサ制御手段とを具
備することを特徴とする移動ロボット。
1. An unmanned carrier having a robot arm mounted thereon and performing operations by the robot arm while moving between a plurality of facilities, wherein the robot is provided on the unmanned carrier and has a moving direction. A non-contact type trolley obstacle detection sensor for detecting an obstacle, and a transport trolley control means for executing a safety ensuring operation of the unmanned transport trolley based on an obstacle detection signal of the trolley obstacle detection sensor; A non-contact type arm obstacle detection sensor which is attached to the automatic guided vehicle so as to be directed upward and detects an obstacle around the operation area of the robot arm; Robot control means for executing a safety ensuring operation of the robot arm based on a detection signal of a detection sensor, and when the automatic guided vehicle is at a predetermined position near the equipment
The detection range of the arm obstacle detection sensor
A mobile robot, comprising: a sensor control unit that stops or stops a detection operation .
【請求項2】 前記台車用障害物検知センサの進行方向
の障害物検知距離は、前記アーム用障害物検知センサの
同方向の障害物検知距離よりも長く設定されることを特
徴とする請求項1記載の移動ロボット。
2. An obstacle detection distance in the traveling direction of the truck obstacle detection sensor is set longer than an obstacle detection distance in the same direction of the arm obstacle detection sensor. The mobile robot according to 1.
【請求項3】 前記センサ制御手段は、前記無人搬送台
車が所定のコースに位置しているときに、前記台車用障
害物検知センサの検知範囲を小さくする或いは検知動作
を停止するように構成されていることを特徴とする請求
項1又は2記載の移動ロボット。
3. The unmanned transfer table according to claim 1, wherein the sensor control means includes :
When the car is on the predetermined course,
Decreasing the detection range of the harmful object detection sensor or detecting operation
The mobile robot according to claim 1, wherein the mobile robot is configured to stop .
【請求項4】 前記アーム用障害物検知センサの検知範
囲を、前記ロボットアームの位置や速度によって変更す
る検知範囲変更手段を具備することを特徴とする請求項
1ないし3のいずれかに記載の移動ロボット。
4. The apparatus according to claim 1, further comprising a detection range changing unit that changes a detection range of the arm obstacle detection sensor according to a position and a speed of the robot arm. Mobile robot.
【請求項5】 前記設備側に設けられ該設備の近傍に障
害物が侵入したことを検知する設備側障害物検知手段か
ら送信される信号を受信する障害物信号受信手段と、こ
の障害物信号受信手段の受信信号に基づいて安全確保動
作を実行させる安全動作実行手段とを具備することを特
徴とする請求項1ないし4のいずれかに記載の移動ロボ
ット。
5. An obstacle signal receiving means provided on the equipment side for receiving a signal transmitted from the equipment side obstacle detection means for detecting that an obstacle has entered the vicinity of the equipment, and the obstacle signal The mobile robot according to any one of claims 1 to 4, further comprising a safe operation execution unit that executes a safety ensuring operation based on a reception signal of the reception unit.
JP22818097A 1997-08-25 1997-08-25 Mobile robot Expired - Fee Related JP3307288B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP22818097A JP3307288B2 (en) 1997-08-25 1997-08-25 Mobile robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP22818097A JP3307288B2 (en) 1997-08-25 1997-08-25 Mobile robot

Publications (2)

Publication Number Publication Date
JPH1158271A JPH1158271A (en) 1999-03-02
JP3307288B2 true JP3307288B2 (en) 2002-07-24

Family

ID=16872475

Family Applications (1)

Application Number Title Priority Date Filing Date
JP22818097A Expired - Fee Related JP3307288B2 (en) 1997-08-25 1997-08-25 Mobile robot

Country Status (1)

Country Link
JP (1) JP3307288B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006231421A (en) * 2005-02-22 2006-09-07 Honda Motor Co Ltd Robot controller, robot control method, robot control program, and mobile robot
US11440188B2 (en) 2017-09-07 2022-09-13 Fanuc Corporation Robot system

Families Citing this family (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100310617B1 (en) * 1999-07-12 2001-10-18 배종렬 Method of producing motion planning for troweling robot
JP4564447B2 (en) * 2004-12-14 2010-10-20 本田技研工業株式会社 Autonomous mobile robot
JP5308840B2 (en) * 2009-01-21 2013-10-09 ファナック株式会社 Robot system with power supply adjustment device
DE102010063214A1 (en) * 2010-12-16 2012-06-21 Robert Bosch Gmbh Securing device for a handling device, in particular an industrial robot, and method for operating the securing device
JP5915322B2 (en) * 2012-03-29 2016-05-11 株式会社デンソーウェーブ Robot device
CN104870147B (en) * 2012-08-31 2016-09-14 睿信科机器人有限公司 The system and method for robot security's work
KR101395888B1 (en) 2013-03-21 2014-05-27 엘지전자 주식회사 Robot cleaner and operating method
JP2015084129A (en) * 2013-10-25 2015-04-30 日本精工株式会社 Guidance robot
KR20180062602A (en) * 2016-12-01 2018-06-11 고려대학교 세종산학협력단 Apparatus of industrial robot for preventing collision, preventing collision and teaching method for industrial robot using thereof
JP6935672B2 (en) * 2017-03-03 2021-09-15 富士フイルムビジネスイノベーション株式会社 Mobile device
CN108327815B (en) * 2018-02-08 2020-06-12 广西大学 Unmanned fortune material carrier of mill based on visual control
CN108423089A (en) * 2018-04-12 2018-08-21 南阳师范学院 A kind of intelligence ground creeping vehicle and control method
WO2020075886A1 (en) * 2018-10-12 2020-04-16 최유라 Mobile robot
JP2021010992A (en) * 2019-07-09 2021-02-04 セイコーエプソン株式会社 Mobile robot

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006231421A (en) * 2005-02-22 2006-09-07 Honda Motor Co Ltd Robot controller, robot control method, robot control program, and mobile robot
JP4616664B2 (en) * 2005-02-22 2011-01-19 本田技研工業株式会社 Robot control device, robot control method, robot control program, and mobile robot
US11440188B2 (en) 2017-09-07 2022-09-13 Fanuc Corporation Robot system

Also Published As

Publication number Publication date
JPH1158271A (en) 1999-03-02

Similar Documents

Publication Publication Date Title
JP3307288B2 (en) Mobile robot
JPH02235113A (en) Operation controller for unmanned vehicle
JP6109616B2 (en) Automated guided vehicle
US8825205B2 (en) Method for controlling movement of travelling carriers
JP2603228Y2 (en) Automated guided vehicle safety equipment
JP3419313B2 (en) Production system
JP3446650B2 (en) Mobile robot safety devices
JP2715202B2 (en) Wireless monitoring communication method and apparatus for unmanned self-propelled body
JPH09300252A (en) Travel robot
JPH01222889A (en) Safety device for mobile type robot
JP2001341086A (en) Mobile robot system
JP2000214928A (en) Automated guided vehicle
JP2005352855A (en) Production line system
JP2836314B2 (en) Self-propelled bogie collision prevention control method
JP4974934B2 (en) Control method of automatic guided vehicle
JPH08161047A (en) Safety device of unmanned carriage travel system
JPH0934548A (en) Automatic guiding method for guided wagon
JP2910245B2 (en) Driverless vehicle safety devices
KR20080025463A (en) Automatic transferring device for semiconductor manufacturing apparatus
JPH087447Y2 (en) Automatic guided vehicle collision prevention device
JP3225092B2 (en) Self-propelled machine
JPH048495A (en) Automatic guided vehicle
JP3009408U (en) Automated guided vehicle
JP2825239B2 (en) Automatic guidance control device for moving objects
JPS6288006A (en) Obstacle evading device for unmanned conveyance vehicle

Legal Events

Date Code Title Description
FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20080517

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110517

Year of fee payment: 9

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110517

Year of fee payment: 9

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120517

Year of fee payment: 10

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120517

Year of fee payment: 10

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130517

Year of fee payment: 11

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130517

Year of fee payment: 11

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140517

Year of fee payment: 12

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees