JP5311657B2 - Safety control system and safety control method - Google Patents
Safety control system and safety control method Download PDFInfo
- Publication number
- JP5311657B2 JP5311657B2 JP2009146646A JP2009146646A JP5311657B2 JP 5311657 B2 JP5311657 B2 JP 5311657B2 JP 2009146646 A JP2009146646 A JP 2009146646A JP 2009146646 A JP2009146646 A JP 2009146646A JP 5311657 B2 JP5311657 B2 JP 5311657B2
- Authority
- JP
- Japan
- Prior art keywords
- control target
- target area
- mobile robot
- stop switch
- mobile
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 50
- 230000008569 process Effects 0.000 claims description 33
- 230000006854 communication Effects 0.000 claims description 30
- 238000004891 communication Methods 0.000 claims description 27
- 238000001514 detection method Methods 0.000 claims description 24
- 238000012545 processing Methods 0.000 description 23
- 230000005540 biological transmission Effects 0.000 description 16
- 230000004044 response Effects 0.000 description 13
- 238000004092 self-diagnosis Methods 0.000 description 5
- 238000001994 activation Methods 0.000 description 4
- 238000013459 approach Methods 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000012546 transfer Methods 0.000 description 3
- 238000010276 construction Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 241000406668 Loxodonta cyclotis Species 0.000 description 1
- 230000004913 activation Effects 0.000 description 1
- 238000012790 confirmation Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 238000010200 validation analysis Methods 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
本発明は、移動ロボット等の移動体の安全制御に関し、詳細には、移動体を無線で安全に制御するためのシステムの構築に関する。 The present invention relates to safety control of a mobile object such as a mobile robot, and more particularly to the construction of a system for safely controlling a mobile object wirelessly.
ロボット制御システムにおいて、設備内に設置された例えば産業用ロボット等の固定ロボットの場合、作業者の安全を確保するために固定ロボットを緊急停止させる非常停止スイッチは、一般に、設備内の所定の位置に取り付けられている。 In a robot control system, in the case of a fixed robot such as an industrial robot installed in an equipment, an emergency stop switch that makes an emergency stop of the fixed robot in order to ensure the safety of an operator is generally a predetermined position in the equipment. Is attached.
この場合、非常停止スイッチとロボットは、有線を介した接続により、常時一定の対応関係にあり、非常停止スイッチを操作すると、これに対応するロボットが停止するようになっている。 In this case, the emergency stop switch and the robot are always in a fixed correspondence by connection via a wire, and when the emergency stop switch is operated, the corresponding robot is stopped.
その一方、設備内を移動する、例えば無人搬送ロボット等の移動ロボットの場合には、移動ロボットを非常停止スイッチに対して有線で接続するのは実用的でなく、無線で接続する必要が生じる。 On the other hand, in the case of a mobile robot such as an unmanned transfer robot that moves in the facility, it is not practical to connect the mobile robot to the emergency stop switch by wire, and it is necessary to connect it wirelessly.
しかしながら、従来においては、設備内を移動しまた設備内に出入りする移動ロボットを無線で非常停止または停止させることにより、設備内の移動ロボットを無線で安全に制御することができるシステムは構築されていなかった。 However, in the past, a system has been constructed that can safely control the mobile robot in the facility wirelessly by moving the equipment in the facility and stopping or stopping the mobile robot entering and leaving the facility wirelessly. There wasn't.
なお、特開平１０−１２６８６６号公報は、無線操作器の非常停止装置に関するものであるが、離れた場所で運転される建設機械等の機械を無線操作器の非常停止スイッチの操作により無線で非常停止させる点について記載している（段落［００１２］参照）。 Japanese Laid-Open Patent Publication No. 10-126866 relates to an emergency stop device for a radio operating device. However, a machine such as a construction machine that is operated at a remote location can be operated in an emergency by operating an emergency stop switch of the radio operating device. The points to be stopped are described (see paragraph [0012]).
この場合、無線操作器と機械は、常時一定の一対一の対応関係におかれており、無線操作器の非常停止スイッチを操作すると、これに対応した機械が停止するようになっている。このため、上記公報に示すシステムは、一定の設備内に複数の移動ロボットが進入してくるようなケースでは、同じ無線操作器の操作により複数の移動ロボットを無線で非常停止させることができない。 In this case, the wireless operation device and the machine are always in a constant one-to-one correspondence relationship, and when the emergency stop switch of the wireless operation device is operated, the corresponding machine is stopped. For this reason, in the system shown in the above publication, in a case where a plurality of mobile robots enter a certain facility, the plurality of mobile robots cannot be emergency-stopped wirelessly by operating the same wireless controller.
本発明は、このような従来の実情に鑑みてなされたものであり、本発明が解決しようとする課題は、設備内に進入する移動体を無線で安全に制御できる安全制御システムを提供することにある。 The present invention has been made in view of such a conventional situation, and a problem to be solved by the present invention is to provide a safety control system capable of safely controlling a mobile body entering a facility wirelessly. It is in.
請求項１の発明は、制御対象領域内を移動する移動体を安全に制御するための安全制御システムであって、制御対象領域が複数の制御対象領域から構成されるとともに各制御対象領域にそれぞれ対応して設置され、各制御対象領域に進入する任意の移動体をそれぞれ制御対象領域ごとに検知する複数の検知手段と、各制御対象領域にそれぞれ対応して設置され、各制御対象領域内の移動体を無線で操作するための複数の無線操作スイッチと、各検知手段により各制御対象領域に進入する任意の移動体が検知されたとき、当該各制御対象領域に対応する各無線操作スイッチを当該任意の移動体に対して有効にするとともに、当該各無線操作スイッチの操作に基づいて当該任意の移動体を停止させるよう制御する制御部とを備えている。
The invention of
請求項１の発明によれば、各制御対象領域に進入する任意の移動体は各検知手段により検知され、当該各制御対象領域に対応して設置された各無線操作スイッチが、各検知手段により進入を検知された当該任意の移動体に対して有効にされる。そして、この状態から、当該各無線操作スイッチが操作されると、当該任意の移動体が停止する。 According to the first aspect of the present invention, any moving body entering each control target area is detected by each detection means, and each wireless operation switch installed corresponding to each control target area is detected by each detection means. It is made effective for the arbitrary moving body whose entry is detected. Then, from this state, when each wireless operation switch is operated, the arbitrary moving body stops.
この場合には、制御対象領域に複数の移動体が進入する場合でも、各移動体の進入の度に当該各移動体が検知手段により検知されて、無線操作スイッチがこれらの移動体に対して有効にされるので、無線操作スイッチを操作することで、当該無線操作スイッチに対応するすべての移動体が停止させられる。これにより、各制御対象領域に進入する任意の移動体を無線で安全に制御できるようになる。 In this case, even when a plurality of moving bodies enter the control target area, each moving body is detected by the detection means each time each moving body enters, and the wireless operation switch is set against these moving bodies. Since it is validated, all the moving bodies corresponding to the wireless operation switch are stopped by operating the wireless operation switch. As a result, any mobile object that enters each control target area can be safely controlled wirelessly.
請求項２の発明は、制御対象領域内を移動する移動体を安全に制御するための安全制御方法であって、制御対象領域が複数の制御対象領域から構成されており、各制御対象領域に進入する任意の移動体を、各制御対象領域にそれぞれ対応して設置された複数の検知手段により検知する工程と、各制御対象領域にそれぞれ対応して設置されかつ各制御対象領域内の移動体を無線で操作するための複数の無線操作スイッチを、各検知手段で検知された任意の移動体に対して有効にする工程と、当該各無線操作スイッチの操作に基づいて当該任意の移動体を停止させる工程とを備えている。 The invention of claim 2 is a safety control method for safely controlling a moving body that moves in a control target area, wherein the control target area includes a plurality of control target areas, and each control target area includes A step of detecting an arbitrary moving body entering by a plurality of detection means installed corresponding to each control target area, and a moving body installed corresponding to each control target area and in each control target area a plurality of wireless operation switches for operating wirelessly, the steps to enable for any mobile body is detected by the detecting means, the arbitrary moving object based on the operation of each radio operating switch And a step of stopping.
請求項２の発明によれば、各制御対象領域に進入する任意の移動体は各検知手段により検知され、各無線操作スイッチが当該任意の移動体に対して有効にされる。そして、この状態から、各無線操作スイッチが操作されると、当該任意の移動体が停止する。 According to the second aspect of the present invention, any moving body that enters each control target area is detected by each detecting means , and each wireless operation switch is enabled for the arbitrary moving body. From this state, when each wireless operation switch is operated, the arbitrary moving body stops.
この場合には、制御対象領域に複数の移動体が進入する場合でも、各移動体の進入の度に当該各移動体が検知されて、無線操作スイッチがこれらの移動体に対して有効にされるので、無線操作スイッチを操作することで、当該無線操作スイッチに対応するすべての移動体が停止させられる。これにより、各制御対象領域に進入する任意の移動体を無線で安全に制御できるようになる。 In this case, even when a plurality of moving objects enter the control target area, each moving object is detected each time the moving object enters, and the wireless operation switch is enabled for these moving objects. Therefore, by operating the wireless operation switch, all the moving bodies corresponding to the wireless operation switch are stopped. As a result, any mobile object that enters each control target area can be safely controlled wirelessly.
請求項３の発明では、請求項２において、制御対象領域から退出する任意の移動体を検知手段により検知するとともに、当該移動体に対応する無線操作スイッチを無効にする工程をさらに備えている。 According to a third aspect of the present invention, the method according to the second aspect further includes the step of detecting an arbitrary moving body leaving the control target area by the detecting means and disabling the wireless operation switch corresponding to the moving body.
この場合には、制御対象領域から退出する移動体が検知され、当該移動体に対応する無線操作スイッチが無効にされることにより、無線操作スイッチの操作が制御対象領域内の移動体にのみ及び、制御対象領域を退出した移動体には及ばなくなるので、制御対象領域に出入りする移動体を無線で安全に制御できるようになる。 In this case, the moving object that exits the control target area is detected, and the wireless operation switch corresponding to the moving object is disabled, so that the operation of the wireless operation switch only affects the moving object in the control target area. Since it does not reach the moving body that has left the control target area, the mobile body that enters and exits the control target area can be safely controlled wirelessly.
請求項４の発明では、請求項２において、無線操作スイッチがグループＩＤを有しており、無線操作スイッチは、制御対象領域内の任意の移動体に対して当該グループＩＤを用いたブロードキャスト方式の通信により有効にされている。 In the invention of claim 4, in claim 2, the wireless operation has a switch Gagu loop ID, wireless operation switch, the broadcast scheme for any mobile control target area using the group ID It is enabled by communication.
この場合には、無線操作スイッチが各移動体に対して個々に有効化処理を行う必要がなくなって、効率的に処理を行える。 In this case, it is not necessary for the wireless operation switch to individually perform the activation process on each moving body, and the process can be performed efficiently.
請求項５の発明では、請求項２において、無線操作スイッチの操作によりいずれかの制御対象領域内の移動体が停止している際に当該制御対象領域内に進入してくる別の移動体を検知し、当該別の移動体に対して無線操作スイッチを有効にして当該別の移動体を停止させるようにしている。 According to a fifth aspect of the present invention, in the second aspect, when the mobile body in any one of the control target areas is stopped by operating the wireless operation switch, another mobile body that enters the control target area is provided. Then, the wireless operation switch is enabled for the other moving body and the other moving body is stopped.
この場合には、制御対象領域内の移動体が停止または非常停止している際に、別の移動体が制御対象領域内に進入しても、当該別の移動体は制御対象領域内で停止して当該制御対象領域内を移動することがなくなるので、より安全な制御を行なえるようになる。 In this case, even if another moving body enters the control target area when the moving body in the control target area is stopped or emergency stopped, the other mobile body stops in the control target area. As a result, movement within the control target area is eliminated, and safer control can be performed.
以上のように、本発明によれば、制御対象領域内を移動する移動体を安全に制御するための安全制御システムにおいて、制御対象領域が複数の制御対象領域から構成されるとともに各制御対象領域にそれぞれ対応して設置され、各制御対象領域に進入する任意の移動体をそれぞれ制御対象領域ごとに検知する複数の検知手段と、各制御対象領域にそれぞれ対応して設置され、各制御対象領域内の移動体を無線で操作するための複数の無線操作スイッチと、各検知手段により各制御対象領域に進入する任意の移動体が検知されたとき、当該各制御対象領域に対応する各無線操作スイッチを当該移動体に対して有効にするとともに、当該各無線操作スイッチの操作に基づいて当該移動体を停止させるよう制御する制御部と設けたことにより、制御対象領域に複数の移動体が進入する場合でも、各移動体の進入の度に当該各移動体が検知手段により検知されて、無線操作スイッチがこれらの移動体に対して有効にされるので、無線操作スイッチの操作により、当該無線操作スイッチに対応するすべての移動体が停止させられる。これにより、各制御対象領域に進入する任意の移動体を無線で安全に制御できるようになる。 As described above , according to the present invention, in a safety control system for safely controlling a moving body that moves in a control target area, the control target area is composed of a plurality of control target areas and each control target area And a plurality of detection means for detecting, for each control target area, any moving body that enters each control target area, and each control target area is installed corresponding to each control target area. A plurality of wireless operation switches for wirelessly operating a mobile body in the vehicle, and each wireless operation corresponding to each control target area when an arbitrary mobile body entering the control target area is detected by each detection means with a switch to enable for the mobile, by providing a control unit for controlling so as to stop the moving object based on the operation of each radio operating switch, control Even when a plurality of moving bodies enter the elephant area, each moving body is detected by the detection means each time each moving body enters, and the wireless operation switch is enabled for these moving bodies. By operating the wireless operation switch, all the moving bodies corresponding to the wireless operation switch are stopped. As a result, any mobile object that enters each control target area can be safely controlled wirelessly.
以下、本発明の実施例を添付図面に基づいて説明する。
〔第１の実施例〕
図１は、本発明の第１の実施例による安全制御システムを示している。同図に示すように、この安全制御システム１は、無線制御の対象となる一定の空間領域である制御対象領域Ａ、Ｂ、Ｃ、Ｄを備えている。これらの制御対象領域Ａ、Ｂ、Ｃ、Ｄは、例えば、工場内の製造設備等における無人搬送ヤードに設けられている。無人搬送車等の移動ロボット（移動体）１０（１０ａ〜１０ｄ）は、これらの制御対象領域Ａ、Ｂ、Ｃ、Ｄを含む設備内を移動可能になっている。
Embodiments of the present invention will be described below with reference to the accompanying drawings.
[First embodiment]
FIG. 1 shows a safety control system according to a first embodiment of the present invention. As shown in the figure, the
各制御対象領域Ａ、Ｂ、Ｃ、Ｄにそれぞれ対応して停止スイッチ（無線操作スイッチ）２ａ、２ｂ、２ｃ、２ｄが設置されている。停止スイッチ２ａ、２ｂ、２ｃ、２ｄは、各制御対象領域Ａ、Ｂ、Ｃ、Ｄの正面中央を作業者が傍観できる位置に設けられている。これらの停止スイッチ２ａ、２ｂ、２ｃ、２ｄは、制御対象領域Ａ、Ｂ、Ｃ、Ｄ内での作業者の安全を確保するために、無線により移動ロボット１０を操作して、移動ロボット１０の移動を無線で安全に制御するためのものである。各停止スイッチ２ａ、２ｂ、２ｃ、２ｄは、各移動ロボット１０の無線端末１１と通信可能になっている。
Stop switches (wireless operation switches) 2a, 2b, 2c, and 2d are installed corresponding to the control target areas A, B, C, and D, respectively. The
各移動ロボット１０には、ＩＤタグとしてのアクティブＲＦＩＤ（radio frequency identification）タグ３が搭載されている。ＲＦＩＤタグ３には、これが搭載された移動ロボット１０のＩＤ情報等の情報が格納されている。また、各制御対象領域Ａ、Ｂ、Ｃ、Ｄの出入口には、ＲＦＩＤタグ３から発せられた電波を受信するアンテナ（検知手段）４ａ、４ｂ、４ｃ、４ｄ、４ｅと、各アンテナ４ａ、４ｂ、４ｃ、４ｄ、４ｅで受信されたＲＦＩＤタグ３からの電波に含まれる各移動ロボット１０のＩＤ情報等の情報を読み取るためのＲＦＩＤタグリーダ５ａ、５ｂ、５ｃ、５ｄ、５ｅがそれぞれ設けられている。
Each
この構成により、いずれの制御対象領域Ａ、Ｂ、Ｃ、Ｄにどの移動ロボット１０が進入しているかが検知されて、当該移動ロボット１０の個体認識が行われるようになっている。また、このとき、個体認識された移動ロボット１０は、各制御対象領域に対応するメモリ内のロボットリストに登録されるようになっている。
With this configuration, it is detected which
各ＲＦＩＤタグリーダ５ａ、５ｂ、５ｃ、５ｄ、５ｅには、それぞれ無線サーバ６ａ、６ｂ、６ｃ、６ｄ、６ｅが隣接して接続されている。各無線サーバ６ａ、６ｂ、６ｃ、６ｄ、６ｅは、各ＲＦＩＤタグリーダ５ａ、５ｂ、５ｃ、５ｄ、５ｅで読み取られた各移動ロボット１０の情報を、当該各無線サーバ６ａ、６ｂ、６ｃ、６ｄ、６ｅにそれぞれ対応する各停止スイッチ２ａ、２ｂ、２ｃ、２ｄに送信するためのものである。
Each
移動ロボット１０の情報を各無線サーバ６ａ、６ｂ、６ｃ、６ｄ、６ｅから受信した停止スイッチ２ａ、２ｂ、２ｃ、２ｄは、当該移動ロボット１０に対して電気的に接続可能な状態となって有効（アクティブ）となる。有効となった停止スイッチは、無効（ノンアクティブ）状態のままの停止スイッチと区別するために、例えば、当該停止スイッチに内蔵されたランプが点灯する。図１に示す例では、停止スイッチ２ａ、２ｂ、２ｄが有効となってランプが点灯しており、停止スイッチ２ｃは無効のままでランプが消灯している。なお、停止スイッチに内蔵されたランプを点灯させるかわりに、停止スイッチの操作部の色を蛍光発光等により変化させたり、あるいは、蛍光発光等に加えて、停止スイッチに搭載された表示灯を点灯させるようにしてもよい。
The stop switches 2a, 2b, 2c, and 2d that have received the information of the
移動ロボット１０がメモリ内のロボットリストに登録された後、当該移動ロボット１０が制御対象領域から退出した場合には、当該移動ロボット１０はロボットリストから削除されるとともに、当該制御対象領域に対応する停止スイッチ２ａ、２ｂ、２ｃ、２ｄが、退出した移動ロボット１０に対して無効にされるようになっている。
After the
なお、図示していないが、この安全制御システム１には、当該システム全体の制御を行う制御部が設けられている。当該制御部は、制御対象領域Ａ、Ｂ、Ｃ、Ｄに進入した移動ロボット１０の有効化処理のほか、制御対象領域Ａ、Ｂ、Ｃ、Ｄから退出した移動ロボット１０の無効化処理や、上述したメモリ内のロボットリストの更新などを行う。
Although not shown, the
次に、本実施例の作用効果について説明する。
いま、制御対象領域Ａ内に１台の移動ロボット１０ａが進入し、制御対象領域Ｂに２台の移動ロボット１０ｂ、１０ｃが進入し、制御対象領域Ｄに１台の移動ロボット１０ｄが進入しているとする。また、このとき、制御対象領域Ｂ内の一方の移動ロボット１０ｂは制御対象領域Ａに進入しようとしているとする（図１参照）。
Next, the function and effect of this embodiment will be described.
Now, one
制御対象領域Ａにおいては、移動ロボット１０ａがアンテナ４ａの近傍を通過したときに移動ロボット１０ａのＲＦＩＤタグ３から発せられた電波がアンテナ４ａで受信され、ＲＦＩＤタグ３からの電波に含まれた移動ロボット１０ａのＩＤ情報等の情報がＲＦＩＤタグリーダ５ａにより読み取られる。これにより、制御対象領域Ａに移動ロボット１０ａが進入していることが検知されて、当該移動ロボット１０ａの個体認識が行われる。
In the control target area A, when the
ＲＦＩＤタグリーダ５ａで読み取られた移動ロボット１０ａの情報は、無線サーバ６ａを介して停止スイッチ２ａに送信される。これにより、停止スイッチ２ａが当該移動ロボット１０ａに対して通信接続可能な状態となって有効（アクティブ）となる。また、このとき、停止スイッチ２ａが点灯するので、アクティブ状態の停止スイッチ２ａを明示でき、停止スイッチ２ａの視認性および操作性が向上する。
Information on the
この状態から、作業者が停止スイッチ２ａを操作すると、停止スイッチ２ａの停止信号が無線で移動ロボット１０ａの無線端末１１に入力されて、移動ロボット１０ａが停止する。この場合、移動ロボット１０ａの動力源がオフにされる。これにより、制御対象領域Ａ内での作業者の安全が確保される。
When the operator operates the
制御対象領域Ｂにおいては、２台の移動ロボット１０ｂ、１０ｃのＩＤ情報等の情報がすでに読み取られて、制御対象領域Ｂに２台の移動ロボット１０ｂ、１０ｃが進入していることが検知されており、これらの移動ロボット１０ｂ、１０ｃの個体認識がそれぞれ行われる。
In the control target area B, information such as ID information of the two
各移動ロボット１０ｂ、１０ｃの情報は、停止スイッチ２ｂに送信されており、停止スイッチ２ｂが各移動ロボット１０ｂ、１０ｃに対して有効（アクティブ）となっている。また、このとき、停止スイッチ２ｂが点灯するので、停止スイッチ２ｂを明示でき、停止スイッチ２ｂの視認性および操作性が向上する。
Information on each of the
この状態から、作業者が停止スイッチ２ｂを操作すると、停止スイッチ２ｂの停止信号が無線で各移動ロボット１０ｂ、１０ｃの各無線端末１１に入力され、各移動ロボット１０が停止する。これにより、制御対象領域Ｂ内での作業者の安全が確保される。
When the operator operates the
また、この場合には、制御対象領域Ｂ内の一方の移動ロボット１０ｂが制御対象領域Ａに進入しようとしており、移動ロボット１０ｂが制御対象領域Ａ内に進入する際にアンテナ４ｂの近傍を通過することで、移動ロボット１０ｂのＲＦＩＤタグ３から発せられた電波がアンテナ４ｂで受信されて、移動ロボット１０ｂの情報がＲＦＩＤタグリーダ５ｂから無線サーバ６ｂを介して停止スイッチ２ａに送信される。これにより、停止スイッチ２ａが移動ロボット１０ｂに対して有効になる。その一方、移動ロボット１０ｂの情報は、同時に、無線サーバ６ｂを介して停止スイッチ２ｂにも送信されるので、停止スイッチ２ｂは移動ロボット１０ｂに対して無効となる。
In this case, one
したがって、作業者が停止スイッチ２ａを操作すると、制御対象領域Ａ内にすでに進入していた移動ロボット１０ａのみならず、新たに制御対象領域Ａ内に進入した移動ロボット１０ｂについても停止することになる。
Therefore, when the operator operates the
なお、制御対象領域Ａに後から進入した移動ロボット１０ｂは、制御対象領域Ａに対応するロボットリストに追加されるとともに、制御対象領域Ｂから退出した移動ロボット１０ｂは、制御対象領域Ｂに対応するロボットリストから削除される。そして、停止スイッチ２ｂは、制御対象領域Ｂから退出した移動ロボット１０ｂに対して無効にされる。
The
制御対象領域Ｄにおいては、移動ロボット１０ｄが当該制御対象領域Ｄ内に進入した直後の状態であり、このとき、制御対象領域Ｄにおける移動ロボットｄの出入口に配置されたアンテナ４ｅが移動ロボット１０ｄのＲＦＩＤタグ３から発せられた電波を受信する。そして、ＲＦＩＤタグ３からの電波に含まれた移動ロボット１０ｄのＩＤ情報等の情報がＲＦＩＤタグリーダ５ｅにより読み取られて、移動ロボット１０ｄの個体認識が行われる。
In the control target area D, the
ＲＦＩＤタグリーダ５ｅで読み取られた移動ロボット１０ｄのＩＤ情報は、無線サーバ６ｅを介して停止スイッチ２ｄに送信される。これにより、停止スイッチ２ｄが移動ロボット１０ｄに対して有効（アクティブ）となる。また、このとき、停止スイッチ２ｄが点灯するので、アクティブ状態の停止スイッチ２ｄを明示でき、停止スイッチ２ｄの視認性および操作性が向上する。
The ID information of the
この状態から、作業者が停止スイッチ２ｄを操作すると、停止スイッチ２ｄの停止信号が無線で移動ロボット１０ｄの無線端末１１に入力されて、移動ロボット１０ｄが停止する。この場合、移動ロボット１０ｄの動力源がオフにされる。これにより、制御対象領域Ｄ内での作業者の安全が確保される。
When the operator operates the
このようにして、制御対象領域に出入りする移動ロボット１０を無線で安全に制御できるようになる。
In this way, the
なお、図１では、各ＲＦＩＤタグリーダ５ａ、５ｂ、５ｃ、５ｄ、５ｅが、これらにそれぞれ対応する各アンテナ４ａ、４ｂ、４ｃ、４ｄ、４ｅとそれぞれ一体化された例を示しているが、各ＲＦＩＤタグリーダ５ａ、５ｂ、５ｃ、５ｄ、５ｅは、各アンテナ４ａ、４ｂ、４ｃ、４ｄ、４ｅから分離して設けるようにしてもよい。
FIG. 1 shows an example in which the
また、各無線サーバ６ａ、６ｂ、６ｃ、６ｄ、６ｅは、対応する各ＲＦＩＤタグリーダ５ａ、５ｂ、５ｃ、５ｄ、５ｅとそれぞれ一体化されていてもよく、あるいは、各ＲＦＩＤタグリーダ５ａ、５ｂ、５ｃ、５ｄ、５ｅから分離して設けられていてもよい。
In addition, each
〔第２の実施例〕
前記第１の実施例では、制御対象領域Ａ、Ｂ、Ｃ、Ｄに対応して設けられた無線サーバ６ａ、６ｂ、６ｃ、６ｄ、６ｅを用いることにより、停止スイッチ２ａ、２ｂ、２ｃ、２ｄの有効化処理を無線で行う例を示したが、本発明の適用はこれに限定されない。
[Second Embodiment]
In the first embodiment, the stop switches 2a, 2b, 2c, 2d are used by using the
図２は、本発明の第２の実施例による安全制御システムを示している。なお、図２において、図１と同一符号は同一または相当部分を示している。 FIG. 2 shows a safety control system according to a second embodiment of the present invention. In FIG. 2, the same reference numerals as those in FIG. 1 denote the same or corresponding parts.
この第２の実施例では、各ＲＦＩＤタグリーダ５ａ、５ｂ、５ｃ、５ｄ、５ｅがケーブル７を介して停止スイッチ２ａ、２ｂ、２ｃ、２ｄに有線接続されている。
In the second embodiment, the
この場合には、ＲＦＩＤタグリーダ５ａ、５ｂ、５ｃ、５ｄ、５ｅで読み取られた各移動ロボット１０のＩＤ情報等の情報が、ケーブル７を介してそれぞれ対応する各停止スイッチ２ａ、２ｂ、２ｃ、２ｄに送信される点のみが前記第１の実施例と異なっており、その他の点は前記第１の実施例と同様である。
In this case, information such as ID information of each
この第２の実施例によれば、制御対象領域ごとに無線サーバを設ける必要がないので、製造コストを低減できる。 According to the second embodiment, since it is not necessary to provide a wireless server for each control target area, the manufacturing cost can be reduced.
〔第３の実施例〕
図３は、本発明の第３の実施例による安全制御システムを示している。なお、図３において、図１と同一符号は同一または相当部分を示している。
[Third embodiment]
FIG. 3 shows a safety control system according to a third embodiment of the present invention. In FIG. 3, the same reference numerals as those in FIG. 1 denote the same or corresponding parts.
この第３の実施例では、アンテナ４ａ、４ｂ、４ｃ、４ｄ、４ｅおよびＲＦＩＤタグリーダ５ａ、５ｂ、５ｃ、５ｄ、５ｅが省略されており、制御対象領域Ａ、Ｂ、Ｃ、Ｄに対応して無線サーバ６ａ、６ｂ、６ｃ、６ｄ、６ｅのみが設けられている。
In the third embodiment, the
この場合、図３に示すように、制御対象領域Ａにおいては、移動ロボット１０ａの無線端末１１からの電波は、無線サーバ６ｃ、６ｄ、６ｅと比較して、移動ロボット１０ａが接近している無線サーバ６ａ、６ｂの方に届きやすくなっており、このため、電波強度が強く、さらに電波到達時間も短い。
In this case, as shown in FIG. 3, in the control target area A, the radio waves from the
同様に、制御対象領域Ｂにおいては、各移動ロボット１０ｂ、１０ｃの無線端末１１からの電波は、無線サーバ６ａ、６ｄ、６ｅと比較して、移動ロボット１０ｂ、１０ｃが接近している無線サーバ６ｂ、６ｃの方に届きやすくなっており、このため、電波強度が強く、さらに電波到達時間も短い。また、制御対象領域Ｄにおいては、移動ロボット１０ｄの無線端末１１からの電波は、無線サーバ６ａ、６ｂ、６ｃと比較して、移動ロボット１０ｄが接近している無線サーバ６ｄ、６ｅの方に届きやすくなっており、このため、電波強度が強く、さらに電波到達時間も短い。
Similarly, in the control target area B, radio waves from the
そこで、この第３の実施例においては、移動ロボットが、電波強度の強いまたは電波到達時間の短い２つの無線サーバ間の領域に存在することが分かり、任意の無線サーバが移動ロボット１０から得たＩＤ情報等の情報を停止スイッチに送信して、停止スイッチの有効化処理を行うようにしている。
Therefore, in this third embodiment, it can be seen that the mobile robot exists in the area between the two wireless servers with strong radio wave intensity or short radio wave arrival time, and an arbitrary radio server was obtained from the
すなわち、例えば制御対象領域Ａにおいては、無線サーバ６ｂが移動ロボット１０ａから得た情報を停止スイッチ２ａに送信して、停止スイッチ２ａの有効化処理が行われる。
That is, for example, in the control target area A, the
また、この場合、無線サーバ６ａ、６ｂ間における電波強度の差または電波到達時間の差に基づいて、移動ロボット１０の各無線サーバ６ａ、６ｂからの距離が分かり、制御対象領域Ａ内で或る時刻における移動ロボット１０の位置を正確に知ることができる。この点は、他の制御対象領域においても同様である。ただ、この場合には、システムの制御部が、移動ロボットの停止処理のみならず、位置測定のルーチン処理をも行うことになるので、ＣＰＵの負担がやや大きくなる。
Further, in this case, the distance from the
〔第４の実施例〕
前記第１ないし第３の実施例では、停止スイッチが制御対象領域からやや離れた位置に設置された例を示したが、本発明の適用はこれに限定されない。
[Fourth embodiment]
In the first to third embodiments, the example in which the stop switch is installed at a position slightly away from the control target area is shown, but the application of the present invention is not limited to this.
図４は、本発明の第４の実施例による安全制御システムを示している。なお、図４において、図１と同一符号は同一または相当部分を示している。 FIG. 4 shows a safety control system according to a fourth embodiment of the present invention. In FIG. 4, the same reference numerals as those in FIG. 1 denote the same or corresponding parts.
この第４の実施例においては、停止スイッチ２ａが制御対象領域Ａ、Ｂ間の出入口に設置されており、同様に、停止スイッチ２ｂが制御対象領域Ｂ、Ｃ間の出入口に、停止スイッチ２ｃが制御対象領域Ｃ、Ｄ間の出入口に、停止スイッチ２ｄが制御対象領域Ｄ、Ｅ間の出入口にそれぞれ設置されている。なお、各停止スイッチの設置位置は、隣り合う各制御対象領域間の出入口に限らず、各制御対象領域内でもよく、あるいは各制御対象領域の直近近傍に設置するようにしてもよい。
In the fourth embodiment, the
また、この場合には、各アンテナ４ａ、４ｂ、４ｃ、４ｄ、４ｅ、各ＲＦＩＤタグリーダ５ａ、５ｂ、５ｃ、５ｄ、５ｅ、および各無線サーバ６ａ、６ｂ、６ｃ、６ｄ、６ｅが省略されており、移動ロボット１０の無線端末１１は、当該移動ロボット１１が進入している制御対象領域の停止スイッチと直接通信を行うことにより、当該移動ロボット１１の検知および個体認識処理、ならびに当該停止スイッチの有効化処理を行う。
In this case, the
〔第５の実施例〕
前記第１ないし第４の実施例では、移動ロボット１０の各制御対象領域に対する進入および退出の検出をアンテナ、無線サーバまたは停止スイッチにより行った例を示したが、本発明の適用はこれに限定されない。
[Fifth embodiment]
In the first to fourth embodiments, the example in which the detection of entry and exit from each control target area of the
図５は、本発明の第５の実施例による安全制御システムを示している。なお、図５において、図４と同一符号は同一または相当部分を示している。 FIG. 5 shows a safety control system according to a fifth embodiment of the present invention. In FIG. 5, the same reference numerals as those in FIG. 4 denote the same or corresponding parts.
この第５の実施例においては、移動ロボット１０の進入および退出を検知するためのライトカーテン８が各制御対象領域Ａ、Ｂ、Ｃ、Ｄの出入口に設けられている。すなわち、制御対象領域Ａの出入口にはライトカーテン８ａが、制御対象領域Ａ、Ｂ間の出入口にはライトカーテン８ｂが、制御対象領域Ｂ、Ｃ間の出入口にはライトカーテン８ｃが、制御対象領域Ｃ、Ｄ間の出入口にはライトカーテン８ｄが、制御対象領域Ｄ、Ｅ間の出入口にはライトカーテン８ｅが、制御対象領域Ｅの出入口にはライトカーテン８ｆがそれぞれ設けられている。各ライトカーテンは、投光部とこれから出射された光を受ける受光部から構成されている。
In this fifth embodiment, a light curtain 8 for detecting the entry and exit of the
この場合、移動ロボット１０がいずれかのライトカーテンを通過して当該ライトカーテンの光を遮断することにより、移動ロボット１０の進入および退出が検出される。
In this case, when the
いま、制御対象領域Ｂ内の左側の移動ロボット１０ｂが制御対象領域Ｂから退出して制御対象領域Ａに進入しようとしているとする。このとき、前記第１ないし第４の実施例では、アンテナ、無線サーバまたは停止スイッチが定期的に有効化処理を常に行っている必要があるが、この第５の実施例では、移動ロボットの進入および退出の検出をライトカーテンが分担するので、アンテナ、サーバまたは停止スイッチはその瞬間だけ有効化処理を行えばよく、定期的な有効化処理を常に行っている場合と比べて、ＣＰＵの負担を軽減できる。
Now, it is assumed that the
なお、移動ロボットの進入および退出を検出する検出装置としては、上述したライトカーテンの他、光電センサ等のその他の非接触式センサまたは接触式センサを用いるようにしてもよい。 In addition, as a detection apparatus for detecting the entry and exit of the mobile robot, other non-contact sensors such as photoelectric sensors or contact sensors may be used in addition to the light curtain described above.
〔伝送メッセージの例〕
前記第１ないし第５の実施例において、各停止スイッチと各移動ロボットとの間で交信される伝送メッセージの例について図６および図７を用いて説明する。ここでは、一つの停止スイッチが複数の移動ロボットと交信する場合を例にとっている。また、図６は、停止スイッチから各移動ロボットに対して個々に交信するポーリング方式の例を示し、図７は、停止スイッチから複数の移動ロボットに対してグループＩＤを用いて交信を行うブロードキャスト方式の例を示している。なお、各図中、「Estop」は停止スイッチ（または非常停止スイッチ）を示し、「RT」は移動ロボットを示している。
[Example of transmission message]
In the first to fifth embodiments, examples of transmission messages communicated between each stop switch and each mobile robot will be described with reference to FIGS. Here, a case where one stop switch communicates with a plurality of mobile robots is taken as an example. FIG. 6 shows an example of a polling method for communicating with each mobile robot individually from the stop switch, and FIG. 7 shows a broadcast method for communicating with a plurality of mobile robots using the group ID from the stop switch. An example is shown. In each figure, “Estop” indicates a stop switch (or emergency stop switch), and “RT” indicates a mobile robot.
図６に示すポーリング方式の場合、停止スイッチ（Estop）から各移動ロボット（RT1〜RTn）に対して、同図の上側に示すようなデータ送信要求（リクエスト）がなされる。このリクエストには、当該停止スイッチの端末ＩＤ、ロボットの端末ＩＤ、自己診断情報（無線通信状態などを含む）、停止（オン/オフ含む）、およびその他の安全情報が含まれている。なお、図６では、停止スイッチからロボット（RT1）へのリクエストの伝送メッセージのみが記載されているが、他のロボット（RT2〜RTn）へのリクエストについても同様の伝送メッセージが含まれている。 In the case of the polling method shown in FIG. 6, a data transmission request (request) as shown on the upper side of the figure is made from the stop switch (Estop) to each of the mobile robots (RT1 to RTn). This request includes the terminal ID of the stop switch, the terminal ID of the robot, self-diagnosis information (including wireless communication status), stop (including ON / OFF), and other safety information. In FIG. 6, only the transmission message of the request from the stop switch to the robot (RT1) is described, but the same transmission message is also included in the requests to the other robots (RT2 to RTn).
その一方、各移動ロボット（RT1〜RTn）から停止スイッチ（Estop）に対しては、図６の下側に示すようなデータ送信（レスポンス）が行われる。このレスポンスには、当該停止スイッチの端末ＩＤ、ロボットの端末ＩＤ、自己診断情報（無線通信状態などを含む）、およびその他の安全情報が含まれている。なお、図６では、ロボット（RT1）から停止スイッチへのレスポンスの伝送メッセージのみが記載されているが、他のロボット（RT2〜RTn）からのレスポンスについても同様の伝送メッセージが含まれている。 On the other hand, data transmission (response) as shown in the lower side of FIG. 6 is performed from each mobile robot (RT1 to RTn) to the stop switch (Estop). This response includes the terminal ID of the stop switch, the terminal ID of the robot, self-diagnosis information (including wireless communication status, etc.), and other safety information. In FIG. 6, only a response transmission message from the robot (RT1) to the stop switch is shown, but similar transmission messages are also included in responses from other robots (RT2 to RTn).
この場合、一つの停止スイッチが複数の移動ロボットに対して個別に通信を行う必要があるため、通常、時分割による多重伝送が行われる。また、他の停止スイッチと各移動ロボットとの間においても、図６と同様の伝送メッセージを用いた通信が行われている。 In this case, since one stop switch needs to individually communicate with a plurality of mobile robots, multiplex transmission by time division is usually performed. In addition, communication using the same transmission message as in FIG. 6 is performed between the other stop switches and each mobile robot.
このようなポーリング方式の場合には、移動ロボットごとにリクエストおよびレスポンスを１セットとした処理が行われており、各停止スイッチと各移動ロボットは、常に一対一に対応している。そして、停止スイッチからのリクエストに対する移動ロボットからのレスポンスの処理が完了すると、移動ロボットと停止スイッチとの間の通信が正常に行われたことになる。 In the case of such a polling method, processing for making a set of requests and responses for each mobile robot is performed, and each stop switch and each mobile robot always correspond one-to-one. When the response process from the mobile robot to the request from the stop switch is completed, the communication between the mobile robot and the stop switch is normally performed.
図７に示すブロードキャスト方式の場合には、停止スイッチ（Estop）から各移動ロボット（RT1〜RTn）に対して、同図の上側に示すようなデータ送信要求（リクエスト）がなされる。このリクエストには、図７上側の左側に示すように、当該停止スイッチの端末ＩＤ（グループＩＤ）、ロボット（RT1）の端末ＩＤ、ロボット（RT2）の端末ＩＤ、…ロボット（RTn）の端末ＩＤ、自己診断情報（無線通信状態などを含む）、停止（オン/オフ含む）、およびその他の安全情報が含まれている。あるいは、図７上側の右側に示すように、このリクエストには、当該停止スイッチの端末ＩＤ（グループＩＤ）、ロボット（RT1〜RTn）の端末ＩＤ、自己診断情報（無線通信状態などを含む）、停止（オン/オフ含む）、およびその他の安全情報が含まれている。 In the case of the broadcast method shown in FIG. 7, a data transmission request (request) as shown on the upper side of the figure is made from the stop switch (Estop) to each mobile robot (RT1 to RTn). This request includes a terminal ID (group ID) of the stop switch, a terminal ID of the robot (RT1), a terminal ID of the robot (RT2), a terminal ID of the robot (RTn), as shown on the left side of FIG. Self-diagnosis information (including wireless communication status etc.), stop (including on / off), and other safety information are included. Alternatively, as shown on the upper right side of FIG. 7, the request includes a terminal ID (group ID) of the stop switch, a terminal ID of the robot (RT1 to RTn), self-diagnosis information (including wireless communication status, etc.), Stops (including on / off) and other safety information are included.
その一方、各移動ロボット（RT1〜RTn）から停止スイッチ（Estop）に対しては、図７の下側に示すようなデータ送信（レスポンス）が行われる。このレスポンスには、当該停止スイッチの端末ＩＤ、ロボットの端末ＩＤ、自己診断情報（無線通信状態などを含む）、およびその他の安全情報が含まれている。なお、図７では、ロボット（RT1）から停止スイッチへのレスポンスの伝送メッセージのみが記載されているが、他のロボット（RT2〜RTn）からのレスポンスについても同様の伝送メッセージが含まれている。 On the other hand, data transmission (response) as shown in the lower side of FIG. 7 is performed from each mobile robot (RT1 to RTn) to the stop switch (Estop). This response includes the terminal ID of the stop switch, the terminal ID of the robot, self-diagnosis information (including wireless communication status, etc.), and other safety information. In FIG. 7, only the transmission message of the response from the robot (RT1) to the stop switch is described, but the same transmission message is also included in the response from the other robots (RT2 to RTn).
この場合、各停止スイッチがそれぞれグループＩＤを有しており、各停止スイッチは、それぞれの制御対象領域内の複数の移動ロボットに対して当該グループＩＤを用いて一度に通信が行う。したがって、当該制御対象領域内の各移動ロボットは、停止スイッチから同一のグループＩＤを受け取ることで、同一のグループに属することになる。 In this case, each stop switch has a group ID, and each stop switch communicates with a plurality of mobile robots in each control target area at once using the group ID. Accordingly, each mobile robot in the control target area belongs to the same group by receiving the same group ID from the stop switch.
このようなブロードキャスト方式の場合には、ポーリング方式のように移動ロボットごとにリクエストおよびレスポンスを１セットとした処理を行う必要がなく、停止スイッチ（Estop）から各移動ロボット（RT1〜RTn）へのリクエストは一度に行われる。そして、レスポンスの処理が完了した移動ロボットに対しては、停止スイッチとの間の通信が正常に行われたことになる。 In the case of such a broadcast method, there is no need to perform a process in which a request and a response are set for each mobile robot as in the polling method, and from the stop switch (Estop) to each mobile robot (RT1 to RTn). Requests are made at once. Communication with the stop switch is normally performed for the mobile robot for which the response processing has been completed.
〔停止スイッチ側の通信処理スレッドの第１の実施例〕
図８ないし図１０は、停止スイッチ側の通信処理スレッドの第１の実施例を示している。図８は通信処理スレッドのメインのフローチャートを、図９は図８におけるロボット進入検知処理のサブルーチンを、図１０は図８におけるロボット通信処理のサブルーチンをそれぞれ示している。
[First embodiment of communication processing thread on stop switch side]
8 to 10 show a first embodiment of the communication processing thread on the stop switch side. 8 shows a main flowchart of the communication processing thread, FIG. 9 shows a subroutine for the robot approach detection process in FIG. 8, and FIG. 10 shows a subroutine for the robot communication process in FIG.
プログラムがスタートすると、まず、図８のステップＳ１において、制御対象領域（エリア）内への移動ロボットの進入検知処理を行うサブルーチンが実行される。このサブルーチンについて図９を用いて説明する。 When the program is started, first, in step S1 of FIG. 8, a subroutine for performing an entry detection process of the mobile robot into the control target area (area) is executed. This subroutine will be described with reference to FIG.
図９のステップＴ１では、停止スイッチが移動ロボット（RT）の情報を受け取る。制御対象領域に進入しまたは制御対象領域から退出した移動ロボットの情報は、上述した前記第１、第２の実施例では、当該制御対象領域に対応するＲＦＩＤタグリーダ５ａ〜５ｅで読み取られ、前記第３の実施例では無線サーバ６ａ〜６ｅで読み取られ、前記第４、第５の実施例では停止スイッチ２ａ〜２ｄで読み取られる。読み取られた情報は、前記第１、第３の実施例では無線サーバ６ａ〜６ｅにより、前記第２の実施例ではケーブル７を介して、前記第４、第５の実施例では直接、当該制御対象領域の停止スイッチに入力される。
In step T1 of FIG. 9, the stop switch receives information on the mobile robot (RT). In the first and second embodiments described above, the information on the mobile robot that has entered the control target area or has left the control target area is read by the
次に、ステップＴ２では、ステップＴ１で受け取った情報に基づいて、エリア内に存在する移動ロボット（RT）の登録リストの更新を行う。すなわち、エリア内に新たに移動ロボットが進入していれば、当該移動ロボットを登録リストに追加し、また、エリアから移動ロボットが退出していれば、当該移動ロボットを登録リストから削除する。 Next, in step T2, the registration list of mobile robots (RT) existing in the area is updated based on the information received in step T1. That is, if a mobile robot has newly entered the area, the mobile robot is added to the registration list. If the mobile robot has left the area, the mobile robot is deleted from the registration list.
次に、ステップＴ３では、更新された登録リストが更新前の前回の登録リストに対して差があるか否かを判断する。ステップＴ３での判断が「Ｙｅｓ」となれば、プログラムはステップＴ４に移行する。ステップＴ４では、登録リストに新たに追加された移動ロボットと通信接続処理を実行する。通信接続処理が完了すれば、当該移動ロボットに対して停止スイッチが有効となる。次に、ステップＴ５では、登録リストから新たに削除された移動ロボットとの通信接続を解除する。通信接続が解除されれば、当該移動ロボットに対して停止スイッチが無効にされる。ステップＴ５での処理後、プログラムは図８のメインルーチンに戻る。同様に、ステップＴ３での判断が「Ｎｏ」となった場合も、プログラムは図８のメインルーチンに戻る。 Next, in step T3, it is determined whether or not the updated registration list is different from the previous registration list before the update. If the determination in step T3 is “Yes”, the program proceeds to step T4. In step T4, communication connection processing is executed with the mobile robot newly added to the registration list. When the communication connection process is completed, the stop switch is enabled for the mobile robot. Next, in step T5, the communication connection with the mobile robot newly deleted from the registration list is released. If the communication connection is released, the stop switch is disabled for the mobile robot. After the process in step T5, the program returns to the main routine of FIG. Similarly, if the determination in step T3 is “No”, the program returns to the main routine of FIG.
図８において、ステップＳ１におけるロボット進入検知処理のサブルーチンが終了すれば、ステップＳ２に移行する。ステップＳ２では、接続された移動ロボットとの通信処理を行うサブルーチンが実行される。この通信処理のサブルーチンについて図１０を用いて説明する。 In FIG. 8, when the subroutine of the robot approach detection process in step S1 is completed, the process proceeds to step S2. In step S2, a subroutine for performing communication processing with the connected mobile robot is executed. This communication processing subroutine will be described with reference to FIG.
図１０のステップＵ１では、停止スイッチ（SW）が押されたか否かが判断される。停止スイッチが押されたと判断されれば、ステップＵ２に移行する。ステップＵ２では、移動ロボット（RT）の登録リスト（RTリスト）にある全ての移動ロボットに対して停止信号を送信する。ステップＵ２での処理後、プログラムは図８のメインルーチンに戻る。ステップＵ１での判断が「Ｎｏ」となった場合は、ステップＵ３に移行する。ステップＵ３では、移動ロボット（RT）の登録リスト（RTリスト）にある全ての移動ロボットと安全確認信号を交信する。ステップＵ３での処理後、プログラムは図８のルーチンに戻る。図８では、ステップＳ１およびＳ２の処理を繰り返し行う。 In step U1 of FIG. 10, it is determined whether or not the stop switch (SW) has been pressed. If it is determined that the stop switch has been pressed, the process proceeds to step U2. In step U2, a stop signal is transmitted to all mobile robots in the mobile robot (RT) registration list (RT list). After the process in step U2, the program returns to the main routine of FIG. If the determination in step U1 is “No”, the process proceeds to step U3. In step U3, safety confirmation signals are communicated with all mobile robots in the mobile robot (RT) registration list (RT list). After the process in step U3, the program returns to the routine of FIG. In FIG. 8, the processes of steps S1 and S2 are repeated.
〔停止スイッチ側の通信処理スレッドの第２の実施例〕
図１１は、停止スイッチ側の通信処理スレッドの第２の実施例を示している。この第２の実施例は、接続された移動ロボットとの通信処理のサブルーチンを実行するメイン処理において、制御対象領域内に新たに別の移動ロボットが進入してきた場合の割り込み処理に関する。
[Second Embodiment of Communication Processing Thread on Stop Switch Side]
FIG. 11 shows a second embodiment of the communication processing thread on the stop switch side. The second embodiment relates to an interrupt process when another mobile robot enters a control target area in the main process for executing a subroutine for a communication process with a connected mobile robot.
図１１のメイン処理におけるステップＶ１では、接続された移動ロボットとの通信処理のサブルーチンが実行されている。このサブルーチンは、上述した図１０におけるサブルーチンと同様である。このサブルーチンの処理後、進入検知センサから移動ロボットの検知信号が発生すると、プログラムは、図１１中の割り込み処理に移行する。この割り込み処理では、ステップＶ２において、エリア内への移動ロボット進入検知処理のサブルーチンが実行される。このサブルーチンは、上述した図９におけるサブルーチンと同様である。当該サブルーチンの処理後、プログラムはメイン処理に戻る。 In step V1 in the main process of FIG. 11, a subroutine for a communication process with the connected mobile robot is executed. This subroutine is the same as the subroutine in FIG. 10 described above. After the processing of this subroutine, when the detection signal of the mobile robot is generated from the approach detection sensor, the program shifts to the interrupt processing in FIG. In this interruption process, a subroutine for the mobile robot entry detection process into the area is executed in step V2. This subroutine is the same as the subroutine in FIG. 9 described above. After the subroutine processing, the program returns to the main processing.
この場合には、例えば、ステップＶ１でのサブルーチンの実行中に、停止スイッチが押されて、エリア内の全ての移動ロボットが停止している最中に、当該エリア内に別の移動ロボットが新たに進入してきたとき、停止スイッチが当該移動ロボットの情報を受け取って新たに登録リストに登録し、当該移動ロボットに対して停止スイッチを有効にする。このとき、停止スイッチが押されている状態なので、新たに進入した移動ロボットは、当該エリアに進入すると同時に停止することになる。このようにして、エリア内の安全性を向上できる。 In this case, for example, during execution of the subroutine in step V1, another mobile robot is newly added in the area while the stop switch is pressed and all the mobile robots in the area are stopped. When the vehicle enters the mobile station, the stop switch receives the information of the mobile robot and newly registers it in the registration list, and enables the stop switch for the mobile robot. At this time, since the stop switch is being pushed, the newly entered mobile robot stops at the same time as it enters the area. In this way, safety in the area can be improved.
〔移動ロボット側の制御フローの一例〕
図１２は、移動ロボット側の制御フローチャートの一例を示しており、通信エラー発生時の処理に関する。
[Example of control flow on the mobile robot side]
FIG. 12 shows an example of a control flowchart on the mobile robot side, and relates to processing when a communication error occurs.
図１２のステップＷ１では、停止スイッチから受信した受信メッセージが有るか否か判断される。受信メッセージが受信されれば、ステップＷ２に移行する。ステップＷ２では、受信メッセージが正常か否か判断される。受信メッセージが正常であれば、ステップＷ３に移行する。ステップＷ３では、受信メッセージが停止信号か否か判断される。停止信号であれば、ステップＷ４に移行して、停止処理が実行される。この停止処理では、移動ロボットの駆動回路の動力が遮断される。ステップＷ４での処理後、ステップＷ５に移行する。ステップＷ５では、リセット信号の入力によりリセット処理がなされたか否か判断される。リセット処理がされれば、プログラムはステップＷ１に戻る。 In step W1 of FIG. 12, it is determined whether there is a received message received from the stop switch. If a received message is received, the process proceeds to step W2. In step W2, it is determined whether the received message is normal. If the received message is normal, the process proceeds to step W3. In step W3, it is determined whether the received message is a stop signal. If it is a stop signal, it will transfer to step W4 and a stop process will be performed. In this stop process, the power of the drive circuit of the mobile robot is shut off. After the process in step W4, the process proceeds to step W5. In step W5, it is determined whether reset processing has been performed by inputting a reset signal. If reset processing is performed, the program returns to step W1.
その一方、ステップＷ２において、受信メッセージが正常でないと判断されれば、ステップＷ６に移行する。ステップＷ６では、移動ロボットの駆動回路の動力が遮断される。また、ステップＷ３において、受信メッセージが停止信号でないと判断されれば、ステップＷ７に移行する。ステップＷ７では、停止スイッチに対してレスポンス処理（図６、図７参照）を行う。ステップＷ６、Ｗ７での処理後、プログラムはステップＷ１に戻る。 On the other hand, if it is determined in step W2 that the received message is not normal, the process proceeds to step W6. In step W6, the power of the mobile robot drive circuit is shut off. If it is determined in step W3 that the received message is not a stop signal, the process proceeds to step W7. In step W7, response processing (see FIGS. 6 and 7) is performed on the stop switch. After the processes in steps W6 and W7, the program returns to step W1.
この場合には、受信メッセージが正常でない場合のような通信エラー発生時に移動ロボットを停止させることができ、エリア内の安全性を確保できるとともに、通信エラーの解除後には、移動ロボットを自動復帰させることができる。 In this case, the mobile robot can be stopped when a communication error occurs, such as when the received message is not normal, ensuring safety in the area, and automatically resuming the mobile robot after the communication error is cleared. be able to.
〔安全制御システムの変形例〕
図１３は、本発明の変形例による安全制御システムを示している。なお、同図において、前記各実施例と同一符号は同一または相当部分を示している。
[Modification of safety control system]
FIG. 13 shows a safety control system according to a modification of the present invention. In the figure, the same reference numerals as those in the above embodiments denote the same or corresponding parts.
図１３に示すように、制御対象領域Ａ、Ｂ間の出入口には、停止スイッチ２ａの他に非常停止スイッチ２ａ’が設置されており、同様に、制御対象領域Ｂ、Ｃ間の出入口には停止スイッチ２ｂおよび非常停止スイッチ２ｂ’が、制御対象領域Ｃ、Ｄ間の出入口には停止スイッチ２ｃおよび非常停止スイッチ２ｃ’が、制御対象領域Ｄ、Ｅ間の出入口には停止スイッチ２ｄおよび非常停止スイッチ２ｄ’がそれぞれ設置されている。これらの非常停止スイッチ２ａ’、２ｂ’、２ｃ’、２ｄ’は、緊急時にすべての制御対象領域内のすべての移動ロボットを非常停止させるためのものである。これに対して、上述した停止スイッチは、対応する制御対象領域内に存在する移動ロボットに対してのみ有効となる。
As shown in FIG. 13, in addition to the
図１３において、例えば停止スイッチ２ｃは、制御対象領域Ｃ、Ｄに存在する移動ロボットに対して有効となるが、例えば非常停止スイッチ２ｃ’は、すべての制御対象領域Ａ〜Ｅ内のすべての移動ロボットに対して有効となる。したがって、図１３に示す状態から、停止スイッチ２ｃを押してもどの移動ロボットも停止しないが、非常停止スイッチ２ｃ’を押すと、すべての移動ロボットが停止する。同様に、例えば停止スイッチ２ｄを押すと、移動ロボット１０ｄのみが停止するが、非常停止スイッチ２ｄ’を押すと、すべての移動ロボットが停止する。
In FIG. 13, for example, the
なお、各移動ロボット１０は、電源が投入されても、任意の安全無線機器と接続されない限り、動作しない仕様になっている。一旦、安全無線機器と接続して安全が確認された移動ロボット１０は動作が可能になるが、各安全無線機器は互いに通信を行っており、このため、結果的に、安全が確認された移動ロボット１０に対しては、すべての非常停止スイッチが有効となる。
Each
また、いずれの停止スイッチ２ａ、２ｂ、２ｃ、２ｄについても、各制御対象領域に進入した各移動ロボットに対して有効化処理される手順は、上述した各実施例の場合と同様である。 In addition, for any of the stop switches 2a, 2b, 2c, and 2d, the procedure for enabling the mobile robot that has entered each control target area is the same as in the above-described embodiments.
本発明は、移動ロボット等の移動体の安全制御システムに好適であり、とくに、移動体の安全制御を無線で行うシステムに適している。 The present invention is suitable for a safety control system for a mobile object such as a mobile robot, and particularly suitable for a system that performs safety control of a mobile object wirelessly.
１： 安全制御システム
２ａ、２ｂ、２ｃ、２ｄ： 停止スイッチ
２ａ’、２ｂ’、２ｃ’、２ｄ’： 非常停止スイッチ
４ａ、４ｂ、４ｃ、４ｄ、４ｅ： アンテナ（検知手段）
１０： 移動ロボット
Ａ、Ｂ、Ｃ、Ｄ、Ｅ： 制御対象領域
1: Safety control system
2a, 2b, 2c, 2d: Stop
4a, 4b, 4c, 4d, 4e: Antenna (detection means)
10: Mobile robot
A, B, C, D, E: Control target area
Claims (5)
制御対象領域が複数の制御対象領域から構成されるとともに各制御対象領域にそれぞれ対応して設置され、各制御対象領域に進入する任意の移動体をそれぞれ制御対象領域ごとに検知する複数の検知手段と、
各制御対象領域にそれぞれ対応して設置され、各制御対象領域内の移動体を無線で操作するための複数の無線操作スイッチと、
各検知手段により各制御対象領域に進入する任意の移動体が検知されたとき、当該各制御対象領域に対応する各無線操作スイッチを当該任意の移動体に対して有効にするとともに、当該各無線操作スイッチの操作に基づいて当該任意の移動体を停止させるよう制御する制御部と、
を備えた安全制御システム。 A safety control system for safely controlling a moving object that moves in a control target area ,
A plurality of detection means for detecting, for each control target area, an arbitrary moving body that is configured corresponding to each control target area and that is configured to include a plurality of control target areas and that enters each control target area. When,
A plurality of wireless operation switches that are installed corresponding to each control target area, and operate the mobile body in each control target area by radio,
When any moving body entering each control target area is detected by each detection means, each radio operation switch corresponding to each control target area is enabled for the arbitrary moving body , and each radio A control unit that controls to stop the arbitrary moving body based on the operation of the operation switch;
With safety control system.
制御対象領域が複数の制御対象領域から構成されており、各制御対象領域に進入する任意の移動体を、各制御対象領域にそれぞれ対応して設置された複数の検知手段により検知する工程と、
各制御対象領域にそれぞれ対応して設置されかつ各制御対象領域内の移動体を無線で操作するための複数の無線操作スイッチを、各検知手段で検知された任意の移動体に対して有効にする工程と、
当該各無線操作スイッチの操作に基づいて当該任意の移動体を停止させる工程と、
を備えた安全制御方法。 A safety control method for safely controlling a moving object that moves in a control target area ,
The control target area is composed of a plurality of control target areas , and a step of detecting an arbitrary moving body entering each control target area by a plurality of detection means respectively installed corresponding to each control target area ;
A plurality of wireless operation switches that are installed corresponding to each control target area and operate the mobile bodies in each control target area by radio are effective for any mobile body detected by each detection means. And a process of
A step of stopping the arbitrary moving body based on the operation of each wireless operation switch;
Safety control method with.
制御対象領域から退出する任意の移動体を検知手段により検知するとともに、当該任意の移動体に対応する無線操作スイッチを無効にする工程をさらに備えた、
ことを特徴とする安全制御方法。 In claim 2,
The method further includes a step of detecting an arbitrary moving body that exits the control target area by the detecting unit and disabling a wireless operation switch corresponding to the arbitrary moving body.
A safety control method characterized by that.
無線操作スイッチがグループＩＤを有しており、無線操作スイッチは、制御対象領域内の任意の移動体に対して当該グループＩＤを用いたブロードキャスト方式の通信により有効にされている、
ことを特徴とする安全制御方法。 In claim 2,
Has a radio operating switch Gagu loop ID, wireless operation switch is enabled by the communication of a broadcast system using the group ID to any mobile in the control target area,
A safety control method characterized by that.
無線操作スイッチの操作によりいずれかの制御対象領域内の移動体が停止している際に当該制御対象領域内に進入してくる別の移動体を検知し、当該別の移動体に対して無線操作スイッチを有効にして当該別の移動体を停止させるようにした、
ことを特徴とする安全制御方法。 In claim 2,
When a mobile body in one of the control target areas is stopped by operating the wireless operation switch, another mobile body entering the control target area is detected, and the mobile body is wirelessly connected to the other mobile body. The operation switch was enabled to stop the other moving body.
A safety control method characterized by that.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2009146646A JP5311657B2 (en) | 2009-06-19 | 2009-06-19 | Safety control system and safety control method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2009146646A JP5311657B2 (en) | 2009-06-19 | 2009-06-19 | Safety control system and safety control method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2011003078A JP2011003078A (en) | 2011-01-06 |
| JP5311657B2 true JP5311657B2 (en) | 2013-10-09 |
Family
ID=43560974
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2009146646A Active JP5311657B2 (en) | 2009-06-19 | 2009-06-19 | Safety control system and safety control method |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5311657B2 (en) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP5669791B2 (en) * | 2012-08-07 | 2015-02-18 | 本田技研工業株式会社 | Moving object peripheral image display device |
| JP6600593B2 (en) * | 2016-03-28 | 2019-10-30 | 株式会社ダイヘン | Mobile system |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2636403B2 (en) * | 1989-03-08 | 1997-07-30 | 株式会社豊田自動織機製作所 | Operation control device for unmanned vehicles |
| JP2006293588A (en) * | 2005-04-08 | 2006-10-26 | Toyota Industries Corp | Method and system for controlling travel of automatic guided vehicle |
| JP4876443B2 (en) * | 2005-06-14 | 2012-02-15 | トヨタ自動車株式会社 | Robot group control system and robot |
-
2009
- 2009-06-19 JP JP2009146646A patent/JP5311657B2/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| JP2011003078A (en) | 2011-01-06 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US10310513B2 (en) | Conveyance control device and merging point passing method for carrying cart | |
| US8046104B2 (en) | Industrial robot system | |
| US10802505B2 (en) | Driverless transport system | |
| US7208900B2 (en) | Industrial robot system | |
| US8487747B2 (en) | Method and system for controlling the traffic flow through an RFID directional portal | |
| US20090128079A1 (en) | Industrial Robot System | |
| JP2019069509A (en) | Safety system for protecting cooperative work between human, robot and machine | |
| JP6701056B2 (en) | Operation terminal device, manufacturing system, article manufacturing method, operation terminal device control method, operation terminal device control program, and storage medium | |
| FI124526B (en) | Arrangement for access control of mining vehicles | |
| KR20060110766A (en) | Process for controlling industrial robots, and related robots, systems and computer programs | |
| KR101708559B1 (en) | Tension sensing system and method having wireless switching function | |
| KR20100071804A (en) | System and method for auto valet parking | |
| JP5311657B2 (en) | Safety control system and safety control method | |
| CN112585988A (en) | Wireless communication system and wireless communication method | |
| CN113165179B (en) | Method for operating a machine control system and machine control system | |
| CN108076434B (en) | Industrial truck and method for automatically linking a radio remote control to an industrial truck | |
| JP5467749B2 (en) | A signal system having a backup function having a normal system signal and a backup system signal using a mobile block system ATC logic device | |
| CN105274746A (en) | Sewing machine | |
| JP2004265163A (en) | Safety system for automatic production facilities | |
| JPH1031515A (en) | Control method for automated guide vehicle and automated guided device | |
| TWI786320B (en) | Allow communication partner login method | |
| JP2005243316A (en) | Communication system for illumination | |
| JP4465604B2 (en) | Abnormality reporting system | |
| CN103365219A (en) | System and method for monitoring and controlling a target operating device of a process control system | |
| JP2000095109A (en) | Electronic blocking system |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20110928 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20120925 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20121009 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20121210 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20130606 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20130701 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 5311657 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |