JP2008213056A - Robot system - Google Patents
Robot system Download PDFInfo
- Publication number
- JP2008213056A JP2008213056A JP2007051198A JP2007051198A JP2008213056A JP 2008213056 A JP2008213056 A JP 2008213056A JP 2007051198 A JP2007051198 A JP 2007051198A JP 2007051198 A JP2007051198 A JP 2007051198A JP 2008213056 A JP2008213056 A JP 2008213056A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- monitoring unit
- monitoring
- joint
- current position
- 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.)
- Granted
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
Description
本発明は、ロボットの動作範囲を多重監視し、確実に制限するロボット制御装置に関する。 The present invention relates to a robot control apparatus that multiplexly monitors and reliably limits the operation range of a robot.
ロボットの可動範囲の制限を少なくして動作範囲を大きくすることは、ロボットを適用した設備への柔軟性が高くなるため、その可動範囲を広く大きくする努力が各ロボット製造メーカで行なわれ、実施されている。しかし、ロボットの可動範囲を拡大化すると、作業者の操作の誤りや外来の電気ノイズ等のために誤動作すると、ロボットの周辺の作業者への干渉や接触等で作業者に障害を与えるような危険な状態となることが考えられる。また、ロボットの周辺機器への干渉や衝突などでロボット本体又は周辺機器の破損を招くことも考えられる。
そのため、特に作業者を危険に曝さないために、ロボットの稼動中では、ロボットの可動範囲を含む領域を安全防護柵で囲い、作業者の故意又は過失でロボットの可動範囲に入らないような立ち入り制限を行なっている。また、ロボットの動作手順の教示中ではロボットの動作速度の制限や、操作しているときだけロボットが動作することができるイネーブル装置が備わる教示装置を備え、作業者が危険に曝される機会の削減が各規格で要請され、また実施されている。
Increasing the range of motion by reducing the limit of the robot's movable range increases the flexibility of the equipment to which the robot is applied, so efforts to increase the range of motion are made and implemented by each robot manufacturer. Has been. However, if the range of movement of the robot is expanded, malfunctioning due to operator error or external electrical noise, etc., may interfere with the operator due to interference or contact with the workers around the robot. It can be dangerous. Further, it is conceivable that the robot body or peripheral device is damaged due to interference or collision of the robot with the peripheral device.
Therefore, in order not to endanger the worker in particular, during the operation of the robot, the area including the movable range of the robot is surrounded by a safety protection fence, so that the operator cannot enter the movable range of the robot by intention or negligence. There are restrictions. In addition, during teaching of robot operation procedures, there is a teaching device equipped with an enabling device that allows the robot to operate only when it is operating, limiting the operation speed of the robot. Reductions are required and implemented in each standard.
図６は、一般的なロボットの動作する領域を説明する図である。図において、ロボットの可動部分によって掃引することができる、製造業者によって定められた領域に、エンドエフェクタ１１０及びワークによって掃引することができる領域を加えたものが最大領域１１２である。また、最大領域の一部で、ロボットシステムにどんな故障・誤動作が生じても越えることがない限界を設定するリミット装置（機構的な動作制限装置など）によって制限されたものが制限領域１１１である。また、最大領域１１２を含む安全防護装置１１４（安全防護柵など）によって、囲まれた領域を安全防護領域１１３という。（最大領域１１２、制限領域１１１及び安全防護領域１１３の各用語定義はＪＩＳ Ｂ８４３３−１９９３より抜粋。）
安全防護領域１１３を安全防護装置１１４（安全防護柵）などで囲い、ロボット１０１が稼動中には作業者がロボットの近傍に接近できなくすることと、教示中では作業者がロボットに接近するため、イネーブル装置が作動している時だけロボットの動作が許可され、かつ、誤動作など作業者の意図しないロボットの動作が生じても、作業者がイネーブル装置を非作動ととしてロボットの動作を停止する又は危険回避行動をとることのできる安全運転速度以下で動作するようになっている。
FIG. 6 is a diagram for explaining a region where a general robot operates. In the figure, the maximum area 112 is obtained by adding an area that can be swept by the end effector 110 and the workpiece to an area defined by the manufacturer that can be swept by the movable part of the robot. In addition, a limited area 111 is a part of the maximum area that is limited by a limit device (such as a mechanical operation limiting device) that sets a limit that does not exceed any failure or malfunction of the robot system. . An area surrounded by a safety protection device 114 (such as a safety protection fence) including the maximum area 112 is referred to as a safety protection area 113. (Term definitions for maximum area 112, restricted area 111, and safeguard area 113 are excerpted from JIS B 8433-1993.)
The safe protection area 113 is surrounded by a safety protection device 114 (safety protection fence) or the like so that the worker cannot access the vicinity of the robot while the robot 101 is in operation, and the worker approaches the robot during teaching. The robot operation is permitted only when the enabling device is operating, and even if a robot operation that is not intended by the operator such as a malfunction occurs, the operator stops the operation of the robot by disabling the enabling device. Or, it is designed to operate at a safe driving speed or less capable of taking a danger avoidance action.
ロボットは、予め教示設定したプログラム（作業プログラム）に従ってロボットを動かすための軌道計算を行い、この計算に基づき動作予測位置（先読み位置）を算出し、ロボットが駆動制御されるものである。このような、ロボットの軌道計算及び動作の構成では、軌道計算及び動作予測位置計算の間違い（制御プログラムのバグ）や、作業プログラムが格納されるメモリの不良及び計算が行なわれるＣＰＵ等の演算装置の不良（製造不良）また、電気機器及び電気素子の偶発故障では、作業者に対する安全のために、例えば電源投入時又は定期的に自己診断を行ない、異常が検出されると即時ロボットの動作を停止するようにしている。また、ＣＰＵ等の半導体素子の不良（設計不良：エラッタ）並びにＣＰＵの制御プログラム作成時に利用されるコンパイラなどの制御プログラム開発環境の不良（開発用プログラムのバグ）に対しては、開発時に各種試験を実施し、可能の限りの間違いを排除しているが全ての場合についての試験（カバレッジ率１００％）は不可能である。よって、間違いや異常を検出する診断のタイミングによっては、ロボットがこれらを原因として異常な動作をする可能性を否定することは出来ない。
また、作業者により教示設定される作業プログラムの間違いによるロボットの動作では、これを間違いとして検出又は回避することは困難である。
The robot performs trajectory calculation for moving the robot in accordance with a program (work program) set in advance, calculates a motion predicted position (prefetch position) based on this calculation, and drives the robot. In such a configuration of the trajectory calculation and operation of the robot, an arithmetic unit such as a CPU that performs an error in the trajectory calculation and the predicted motion position calculation (bug of the control program), a defect in the memory storing the work program, and a calculation is performed. In case of accidental failure of electrical equipment and electrical elements, for safety to workers, self-diagnosis is performed, for example, when power is turned on or periodically. I try to stop. In addition, various tests are conducted during development for defects in semiconductor elements such as CPUs (design defects: errata) and defects in control program development environments such as compilers used when creating CPU control programs (bugs in development programs). However, it is impossible to test (coverage rate 100%) in all cases. Therefore, depending on the timing of diagnosis for detecting an error or abnormality, it is impossible to deny the possibility that the robot performs an abnormal operation due to these.
Also, it is difficult to detect or avoid this as an error in the operation of the robot due to an error in the work program taught and set by the operator.
以下に、ロボットの可動範囲を作業に必要とする領域（稼動範囲又は最大動作範囲）に制限しつつ、作業者の保護について説明する。
ロボットの稼動範囲を制限するものとして、複数の光電センサを利用して、検出信号に基づいてロボットの可動範囲を部分的に制限を行なう制御装置を備え、ロボットの設置スペースに合わせて可動範囲を任意に変更することができるロボットの可動範囲制限装置が提案されている（例えば、特許文献１）。
しかし、この提案では光電センサを使用しているため、設備設置時には動作領域を分割するために光軸調整が必要となり、使用中に光学系のズレが起こらないような確実な設置が必要とされ、また定期的に光学系の確認が必要となると共に、粉塵及びオイルミストの多い製品の生産工場雰囲気では、発行部及び受光部のレンズ等の集光器が汚れるための、定期的な清掃等の保守が必要となる。このように、光を利用する検出器はクリーンルームなどの特殊な環境以外には適していない。
Hereinafter, the protection of the operator will be described while limiting the movable range of the robot to an area (operation range or maximum operation range) required for work.
To limit the robot operating range, it is equipped with a control device that partially limits the movable range of the robot based on detection signals using multiple photoelectric sensors. The movable range is set according to the installation space of the robot. A robot movable range limiting device that can be arbitrarily changed has been proposed (for example, Patent Document 1).
However, since this proposal uses a photoelectric sensor, it is necessary to adjust the optical axis in order to divide the operating area when installing the equipment, and it is necessary to install it securely so that the optical system does not shift during use. In addition, it is necessary to periodically check the optical system, and in the atmosphere of the production factory where the product contains a lot of dust and oil mist, the condensers such as the lens of the issuing unit and the light receiving unit are contaminated, so that regular cleaning, etc. Maintenance is required. As described above, a detector using light is not suitable except for a special environment such as a clean room.
光学系検出器ような定期的な保守点検の負荷を軽減するものとして、ロボットの可動範囲を制限する仮想安全柵を制御装置のメモリーに定義し、ツールを含むロボットの動作予測位置が該仮想安全柵を越えると判定されるとロボットアームの移動を停止制御するロボット動作規制装置が提案されている（例えば、特許文献２）。
また、特許文献２の動作予測位置の代りにロボットの各軸毎の位置を検出し、該検出した位置データが動作可能範囲にあるかを判定し、動作範囲より外れていると判定されるとロボットの動作を停止させるか警報を発するロボットの暴走防止装置の提案もある（例えば、特許文献３）。
As a means to reduce the burden of periodic maintenance inspections such as optical system detectors, a virtual safety fence that limits the movable range of the robot is defined in the memory of the control device, and the predicted motion position of the robot including the tool is the virtual safety fence. There has been proposed a robot operation restriction device that stops the movement of a robot arm when it is determined that the fence is passed (for example, Patent Document 2).
If the position of each axis of the robot is detected instead of the motion predicted position of Patent Document 2, it is determined whether the detected position data is within the operable range, and if it is determined that the position is out of the motion range. There is also a proposal of a robot runaway prevention device that stops the operation of the robot or issues an alarm (for example, Patent Document 3).
ロボットの制御を行なうＣＰＵの他にロボットの状態を常に監視するＣＰＵを設け、特許文献２又は特許文献３で行なう動作可能範囲の監視を、この監視用ＣＰＵで行ない、ロボット制御ＣＰＵ及び監視用ＣＰＵの相互間で必要最低限の通信を行ない、異常が検出されるとロボットを停止させることが行なわれている（例えば、特許文献４）。このような構成では、ロボット制御ＣＰＵと監視用ＣＰＵの双方でロボット及び他方のＣＰＵの監視をすることができるので、ロボットの状態を、単一の部品故障などの発生があってもロボットを停止する安全方向にすることができるようになっている。 In addition to the CPU that controls the robot, a CPU that constantly monitors the state of the robot is provided, and the operable range monitored in Patent Document 2 or Patent Document 3 is monitored by this monitoring CPU. The robot control CPU and the monitoring CPU The minimum necessary communication is performed between the robots, and the robot is stopped when an abnormality is detected (for example, Patent Document 4). In such a configuration, both the robot control CPU and the monitoring CPU can monitor the robot and the other CPU, so that the robot is stopped even if a single component failure occurs. You can be in a safe direction.
従来のロボット制御装置は、特許文献１乃至３の構成で、動作制限をより確かなものとする努力がなされている。しかし、ロボットの一般的設計要求事項として、「すべての構成要素（電気、電子、機械、空気圧及び油圧）の中でいずれか１個の部品が予測可能な範囲で故障しても、安全機能を影響を受けず、また、影響を受けた場合でもロボットシステムは安全な状態に保たれるように、ロボットシステムを設計、製作及び据付けすること」（日本工業規格Ｂ８４３−１９９３より抜粋）が要請されている。この要請に応えるために、構成要素の偶発故障及び不良（製造不良、動作不良、エラッタ等）並びに制御プログラム開発環境に潜む不良及び間違いを可能な限り排除しなければならない問題に対し、複数個所で監視を行なうことでこれらの問題を解決している。 In the conventional robot control apparatus, efforts are made to make the operation restriction more reliable with the configurations of Patent Documents 1 to 3. However, as a general design requirement for robots, the safety function should be maintained even if any one of all components (electrical, electronic, mechanical, pneumatic and hydraulic) fails within a predictable range. It is requested that “the robot system should be designed, manufactured and installed so that the robot system is not affected and can be kept safe even if affected” (extracted from Japanese Industrial Standard B843-1993). ing. In order to meet this requirement, there are several points where there are accidents and failures of components (manufacturing failures, operation failures, errata, etc.) and problems that must be eliminated as much as possible in the control program development environment. Monitoring these issues solves these problems.
図７は、設置されたロボットの動作領域を説明する図である。ロボット１０１は、ペンダント１０３から作業者によって稼動前に作業プログラムが作られ、ロボット制御装置１０２に記憶されている。作業プログラムは、ロボット１０１の手首部に装着された作業ツール１０４でワーク１０５に対して所定の作業を行なうようになっている。このようにワーク１０５形状が小型であれば、ロボット１０１がワーク１０５に対する作業のときにロボット１０１の動作領域１０６は、ロボット１０１の最大領域内に納まり、動作領域１０６を安全防護柵で囲うことで、ロボット１０１の稼動中に作業者がロボット１０１の動作領域１０６内に立ち入ることを制限して作業者の安全を確保している。しかし、外来の電気的ノイズやロボット又はロボット制御装置の部品の故障によって動作領域１０６を越えて動作してしまうことが考えられる。 FIG. 7 is a diagram illustrating an operation area of the installed robot. In the robot 101, a work program is created by the operator from the pendant 103 before being operated, and is stored in the robot control device 102. The work program is configured to perform a predetermined work on the work 105 with the work tool 104 attached to the wrist of the robot 101. If the shape of the workpiece 105 is small in this way, when the robot 101 is working on the workpiece 105, the operation area 106 of the robot 101 is within the maximum area of the robot 101, and the operation area 106 is surrounded by a safeguard fence. In addition, the worker's safety is ensured by restricting the worker from entering the operation area 106 of the robot 101 while the robot 101 is in operation. However, it is conceivable that the robot moves beyond the operation area 106 due to external electrical noise or a failure of a robot or a part of the robot controller.
ロボットを導入する顧客及びロボットの供給者としては、ロボットを安心して使用することができるように、ロボットの安全性の証明手段として、第三者機関による認証を取得するものもある。この認証は取得には長期間を要し、また、例えば制御プログラムの改正やハードウェアの改良の度にも認証の更新に係る手続が面倒で、機能の確認等のための時間も要するので、早急な改版、改良が困難である問題がある。
本発明はこのような問題点に鑑みてなされたものであり、構成要素の偶発故障及び不良（製造不良、動作不良、エラッタ等）並びに制御プログラム開発環境に潜む不良及び間違いを可能な限り排除するとともに第三者機関による認証を更新に係る手間と時間を削減することができるロボット制御装置を提供することを目的とする。
As a customer who introduces a robot and a supplier of the robot, there are some who obtain authentication by a third-party organization as a means for proving safety of the robot so that the robot can be used with confidence. This certification takes a long time to acquire, and for example, the procedure for updating the certification is troublesome every time the control program is revised or the hardware is improved. There is a problem that rapid revision and improvement are difficult.
The present invention has been made in view of such problems, and eliminates as much as possible accidents and failures of components (manufacturing failures, operation failures, errata, etc.) and failures and mistakes hidden in the control program development environment. Another object of the present invention is to provide a robot controller capable of reducing the labor and time required for renewing authentication by a third party organization.
上記問題を解決するため、本発明は、次のように構成したのである。
請求項１に記載の発明は、回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットの制御点が、予め設定された前記ロボットの動作領域からの逸脱を検出すると前記ロボットの動作を禁止する手段を備えたロボット制御装置を備えるロボットシステムにおいて、 前記エンコーダからの位置信号が接続され、前記ロボットの動作領域に基づいて予め設定された動作領域データと前記ロボットの各軸の位置を検出するエンコーダからの位置データに基づいて算出する前記ロボットの制御点の現在位置とを比較し、前記現在位置が前記ロボットの動作領域の逸脱を検出すると、前記ロボットの動作を禁止する位置監視部を備えたことを特徴とするものである。
また、請求項２に記載の発明は、前記ロボットの動作の禁止は、前記ロボットの駆動電源を遮断することを特徴とするものである。
In order to solve the above problem, the present invention is configured as follows.
According to the first aspect of the present invention, when a control point of a robot driven by a plurality of motor shafts having an encoder for detecting a rotational position detects a deviation from a preset operation area of the robot, the operation of the robot is performed. In a robot system including a robot control device including a means for prohibiting the movement, a position signal from the encoder is connected, and the motion area data set in advance based on the motion area of the robot and the position of each axis of the robot. A position monitoring unit that compares the current position of the control point of the robot calculated based on position data from the encoder to be detected, and prohibits the operation of the robot when the current position detects a deviation of the robot operation area It is characterized by comprising.
The invention described in claim 2 is characterized in that the prohibition of the operation of the robot cuts off the drive power supply of the robot.
また、請求項３に記載の発明は、回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットの制御点が、予め設定された前記ロボットの動作領域からの逸脱を検出すると前記ロボットの動作を禁止する手段を備えたロボット制御装置を備えるロボットシステムにおいて、前記ロボット制御装置は、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの制御点の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの制御点の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするものである。 According to a third aspect of the present invention, when a control point of a robot driven by a plurality of motor shafts having an encoder for detecting a rotational position detects a deviation from a preset operation area of the robot, the robot In the robot system including the robot control device including the means for prohibiting the operation of the robot, the robot control device is configured to detect a current position of the control point of the robot based on position data of an encoder that detects a position of each axis of the robot. Based on the output of the first motion area monitoring means when the current position detects a deviation from the motion area of the robot. A first monitoring unit having a first shut-off means for shutting off the driving power of the robot, and an encoder for detecting the position of each axis of the robot Second operation area monitoring means for obtaining a current position of the control point of the robot based on the position data of the robot, and detecting the deviation of the movement area of the robot from the current position; and the current position is the operation area of the robot Each of the motors includes a second monitoring unit including a second monitoring unit including a second blocking unit configured to block the driving power of the robot based on the output of the second operation area monitoring unit when a deviation is detected. The shaft driving power is supplied from a power source through a line in which the first blocking means and the second blocking means are connected in series.
また、請求項４に記載の発明は、回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットであって、前記ロボットは、設置された基部と、前記基部に回動自在に設けられモータで駆動する第１関節と、第１関節に取り付けられた第１アームと、前記第１アームの端部に回動自在に設けられモータで駆動する第２関節と、前記第２関節に垂直に取り付けられた第２アームと、前記第２アームの端部に回動自在に設けられモータで駆動する第３関節と、前記第３関節に取り付けられた第３アームと、前記第３アームの端部に取り付けられた２つ以上の関節からなり、前記ロボットを制御するロボット制御装置を備えるロボットシステムにおいて、前記ロボット制御装置は、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第３関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第３関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするものである。 According to a fourth aspect of the present invention, there is provided a robot driven by a plurality of motor shafts having an encoder for detecting a rotational position, wherein the robot is provided on an installed base and is rotatably provided on the base. A first joint driven by a motor, a first arm attached to the first joint, a second joint rotatably provided at an end of the first arm, and driven by a motor, and A second arm attached vertically, a third joint rotatably provided at an end of the second arm and driven by a motor; a third arm attached to the third joint; and the third arm In a robot system comprising two or more joints attached to the end of the robot and including a robot control device that controls the robot, the robot control device is an encoder that detects the position of each axis of the robot. First movement area monitoring means for obtaining a current position of the third joint of the robot based on the position data, and detecting the deviation of the movement area of the robot from the current position; and A first monitoring unit comprising a first shut-off means for shutting off the driving power of the robot based on the output of the first motion region monitoring means when a deviation is detected; and an encoder for detecting the position of each axis of the robot Based on the position data, a current position of the third joint of the robot is obtained, second movement area monitoring means for detecting a deviation of the movement area of the robot from the current position, and the current position is the movement area of the robot. A second monitoring unit comprising: a second monitoring unit including a second blocking unit configured to block the driving power of the robot based on an output of the second operation area monitoring unit when a deviation is detected; Serial driving power to each motor shaft is characterized in that the supplied via a series-connected line and said first breaking means and second breaking means from the power source.
また、請求項５に記載の発明は、回転位置を検出するエンコーダを有する複数のモータ軸で駆動されるロボットであって、前記ロボットは、設置された基部と、前記基部に回動自在に設けられモータで駆動する第１関節と、第１関節に取り付けられた第１アームと、前記第１アームの端部に回動自在に設けられモータで駆動する第２関節と、前記第２関節に垂直に取り付けられた第２アームと、前記第２アームの端部に回動自在に設けられモータで駆動する第３関節と、前記第３関節に取り付けられた第３アームと、前記第３アームの端部に取り付けられた２つ以上の関節からなり、前記ロボットを制御するロボット制御装置を備えるロボットシステムにおいて、前記ロボット制御装置は、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第４関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第４関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするものである。 According to a fifth aspect of the present invention, there is provided a robot driven by a plurality of motor shafts having an encoder for detecting a rotational position, wherein the robot is provided on an installed base and is rotatable on the base. A first joint driven by a motor, a first arm attached to the first joint, a second joint rotatably provided at an end of the first arm, and driven by a motor, and A second arm attached vertically, a third joint rotatably provided at an end of the second arm and driven by a motor; a third arm attached to the third joint; and the third arm In a robot system comprising two or more joints attached to the end of the robot and including a robot control device that controls the robot, the robot control device is an encoder that detects the position of each axis of the robot. First movement area monitoring means for obtaining a current position of the fourth joint of the robot based on position data, and detecting the deviation of the movement area of the robot based on the current position; and A first monitoring unit comprising a first shut-off means for shutting off the driving power of the robot based on the output of the first motion region monitoring means when a deviation is detected; and an encoder for detecting the position of each axis of the robot Based on the position data, a current position of the fourth joint of the robot is obtained, second movement area monitoring means for detecting a deviation of the movement area of the robot from the current position, and the current position is the movement area of the robot. A second monitoring unit comprising: a second monitoring unit including a second blocking unit configured to block the driving power of the robot based on an output of the second operation area monitoring unit when a deviation is detected; Serial driving power to each motor shaft is characterized in that the supplied via a series-connected line and said first breaking means and second breaking means from the power source.
また、請求項６に記載の発明は、前記第１監視部が駆動する前記第１遮断手段又は前記第２監視部が駆動する第２遮断手段は電磁接触器であることを特徴とするものである。
また、請求項７に記載の発明は、前記第１監視部又は前記第２監視部が駆動する前記電磁接触器は、少なくとも２つの常開主接点と少なくとも１つの常閉補助接点とを備え、前記電磁接触を駆動して前記常開主接点を閉路するときは、該常閉補助接点が閉路していることが検出された後であることを特徴とするものである。
また、請求項８に記載の発明は、前記第１監視手段又は前記第２監視手段はＣＰＵを備え、前記ＣＰＵは、エンコーダ選択信号を出力し、前記ロボットの複数の前記エンコーダからの位置信号を選択して該当する前記位置データを取得し、前記エンコーダ選択信号を切換え、前記ロボットに備わる複数のエンコーダの位置データを取得し、前記ロボットの制御点の現在位置を求めることを特徴とするものである。
The invention according to claim 6 is characterized in that the first blocking means driven by the first monitoring unit or the second blocking means driven by the second monitoring unit is an electromagnetic contactor. is there.
In the invention according to claim 7, the electromagnetic contactor driven by the first monitoring unit or the second monitoring unit includes at least two normally open main contacts and at least one normally closed auxiliary contact. When the electromagnetic contact is driven to close the normally open main contact, it is after it is detected that the normally closed auxiliary contact is closed.
According to an eighth aspect of the present invention, the first monitoring unit or the second monitoring unit includes a CPU, the CPU outputs an encoder selection signal, and outputs position signals from the plurality of encoders of the robot. Select and acquire the corresponding position data, switch the encoder selection signal, acquire position data of a plurality of encoders provided in the robot, and obtain the current position of the control point of the robot is there.
また、請求項９に記載の発明は、前記第１監視手段及び前記第２監視手段は各々ＣＰＵを備え、前記第１監視装置に備わるＣＰＵと前記第２監視装置に備わるＣＰＵとは、異なるアーキテクチャのＣＰＵであることを特徴とするものである。
また、請求項１０に記載の発明は、前記ロボット制御装置は表示手段を備え、前記第１監視手段及び前記第２監視手段は、各々の状態を前記ロボット制御装置に出力し、前記ロボット制御装置は前記第１監視手段又は前記第２監視手段の状態を前記表示手段に表示することを特徴とするものである。
また、請求項１１に記載の発明は、前記第１監視手段は、第１動作領域監視手段を無効化又は第１遮断手段を接続状態とする無効入力を備え、前記第２監視手段第２動作領域監視手段を無効化又は第２遮断手段を接続状態とする無効入力を備えることを特徴とするものである。
According to a ninth aspect of the present invention, the first monitoring unit and the second monitoring unit each include a CPU, and the CPU provided in the first monitoring device and the CPU provided in the second monitoring device are different in architecture. It is characterized by being a CPU.
Further, in the invention according to claim 10, the robot control device includes a display unit, and the first monitoring unit and the second monitoring unit output each state to the robot control unit, and the robot control unit Is characterized in that the state of the first monitoring means or the second monitoring means is displayed on the display means.
Further, in the invention described in claim 11, the first monitoring means includes an invalid input for invalidating the first operation area monitoring means or connecting the first shut-off means, and the second operation of the second monitoring means. It comprises an invalid input for invalidating the region monitoring means or connecting the second blocking means.
請求項１乃至６に記載の発明によると、ロボットの制御とは独立した２つの監視部でロボットの制御点の監視を行ない、ロボットが動作領域を逸脱すると電磁接触器を開路して駆動部への電源供給を遮断するので、ロボットの制御上の問題でロボットが誤動作や暴走などで動作範囲を逸脱することを確実に検出し、その時には駆動電源を遮断し停止することができる。特に請求項４及び５に記載の発明では、垂直多関節ロボットにおいて、ロボットの姿勢により、最も動作領域が広い場合として第３関節又は第４関節となることがある。このような場合に、最も動作領域の広い部位が動作領域から逸脱すれば、ロボットの動作を禁止する。
また、請求項７に記載の発明によると、駆動部への電源供給をおこなう電磁接触器の接点が溶着していれば、動作範囲を逸脱していなくても電磁接触器接点の閉路をおこなわないので、接点溶着を検出することができる。
また、請求項８に記載の発明によると、ロボットの位置を検出する複数のエンコーダに対し、位置信号を順じスキャンして位置データを取得するようになっているので、位置信号を位置データへの変換する回路又は素子の数を削減でき、位置監視部の形状の縮小化ができ、またコストダウンもできる。
また、請求項９に記載の発明によると、２つの監視部に備わるＣＰＵのアーキテクチャが異なるので、ＣＰＵに固有のエラッタや制御プログラム開発装置の誤りが両監視部に入り込む事がなくなるので、位置監視の確実性が向上する。
また、請求項１０に記載の発明によると、監視部で検出した状態をロボット制御装置に接続されたペンダントに備わる表示手段に表示することができるので、ロボットが動作領域を逸脱した時の原因究明を支援することができ、原因解決までの時間の短縮に貢献することができる。
また、請求項１１に記載の発明によると、何らかの原因でロボットが動作領域を逸脱しても、無効入力へ入信している間は駆動電源を投入することができるので、ロボット制御部及び駆動部でロボットを正規の位置（動作領域内）に戻すことができる。
According to the first to sixth aspects of the present invention, the control points of the robot are monitored by the two monitoring units independent of the control of the robot, and when the robot deviates from the operation area, the electromagnetic contactor is opened to the drive unit. Therefore, it is possible to reliably detect that the robot deviates from the operation range due to malfunction or runaway due to a problem in the control of the robot, and at that time, the drive power can be shut off and stopped. In particular, in the fourth and fifth aspects of the invention, in the vertical articulated robot, depending on the posture of the robot, there may be the third joint or the fourth joint when the motion region is the widest. In such a case, if the part having the widest motion region deviates from the motion region, the robot operation is prohibited.
According to the seventh aspect of the present invention, if the contact of the electromagnetic contactor that supplies power to the drive unit is welded, the contact of the electromagnetic contactor is not closed even if the operating range is not deviated. Therefore, contact welding can be detected.
According to the eighth aspect of the invention, since the position data is obtained by scanning the position signals sequentially for the plurality of encoders that detect the position of the robot, the position signals are converted into the position data. The number of circuits or elements to be converted can be reduced, the shape of the position monitoring unit can be reduced, and the cost can be reduced.
According to the ninth aspect of the present invention, since the CPU architectures of the two monitoring units are different, errata specific to the CPU and errors in the control program development device do not enter both monitoring units. The certainty is improved.
According to the invention described in claim 10, since the state detected by the monitoring unit can be displayed on the display means provided in the pendant connected to the robot control device, the cause investigation when the robot departs from the operation area is possible. Can contribute to shortening the time to resolve the cause.
According to the eleventh aspect of the present invention, even if the robot deviates from the operation area for some reason, the drive power can be turned on while receiving the invalid input. With this, the robot can be returned to the normal position (in the operation area).
以下、本発明の実施の形態について図を参照して説明する。 Hereinafter, embodiments of the present invention will be described with reference to the drawings.
図１は、本発明を適用したロボットシステムのブロック図である。図において、１はロボットであり、複数のモータ１０とエンコーダ１１の組みで、複数の関節を駆動しアームを動作させ、作業ツール１０４を目的の位置に動作させる（図では１組のみを記載している）。３はペンダントであり、教示のときには作業者が操作することでロボット１を目的の位置に動作させ位置の登録を行ない、ワーク１０５に対する作業プログラムを登録又は編集を行なう。また、ロボットの機構情報の入力や動作範囲１０６の設定を行なう。また、ペンダント３は図示しない表示器を備え、作業プログラムのリスト表示、機構情報である機構部データの表示、動作領域データの表示、異常表示その他のロボットの設置時に必要なデータの表示やロボットの状態表示を行なう。２はロボット制御装置であり、ロボット動作の制御を行なう制御部２０、制御部２０によって求められたモータ１０の動作司令に基づきモータ１０を駆動する駆動部２１、作業プログラム、機構部データ、動作領域データその他のロボット制御に必要な諸データまたはプログラムが格納される記憶部２２を主な要素として構成されている。本発明では、位置監視部２３が備わっている。 FIG. 1 is a block diagram of a robot system to which the present invention is applied. In the figure, reference numeral 1 denotes a robot, which is a combination of a plurality of motors 10 and encoders 11, drives a plurality of joints to operate an arm, and moves a work tool 104 to a target position (only one set is shown in the figure). ing). Reference numeral 3 denotes a pendant. When teaching, the operator operates the robot 1 to a target position to register the position and register or edit a work program for the work 105. Also, the robot mechanism information is input and the operation range 106 is set. Further, the pendant 3 is provided with a display (not shown), displaying a list of work programs, displaying mechanism data as mechanism information, displaying operation area data, displaying an abnormality, displaying other data necessary for installing the robot, Displays the status. Reference numeral 2 denotes a robot control device, which is a control unit 20 that controls the robot operation, a drive unit 21 that drives the motor 10 based on the operation command of the motor 10 obtained by the control unit 20, a work program, mechanism unit data, and an operation area. A storage unit 22 that stores data and other data or programs necessary for robot control is configured as a main element. In the present invention, a position monitoring unit 23 is provided.
ロボット１０を動作するための駆動電源は、商用の電源２５から、制御部２０で開閉制御される電磁接触器２４−１及び位置監視部２３で開閉制御される電磁接触器２４−２、２４−３の各接点が直列接続され、駆動部２１へ接続されている。すなわち、制御部２０及び位置監視部２３の双方がロボット１０の動作を許可するときに電磁接触器２４−１、２４−２、２４−３の接点が閉じ、駆動部２３へ電源２５が供給され、ロボット１０の動作が許可されないときには、いずれかの電磁接触器２４−１、２４−２、２４−３の接点が開路して駆動部２３への電源供給が遮断されるようになっている。尚、電源２５と駆動部２３との間には電磁接触器２４−１、２４−２、２４−３の接点以外に、例えば非常停止の接点やその他のロボットの動作を禁止する要因となる接点が挿入されるが、本図では省略している。 The driving power source for operating the robot 10 is an electromagnetic contactor 24-1 that is controlled to be opened and closed by the control unit 20 and an electromagnetic contactor 24-2 that is controlled to be opened and closed by the position monitoring unit 23 from a commercial power source 25. 3 contacts are connected in series and connected to the drive unit 21. That is, when both the control unit 20 and the position monitoring unit 23 permit the operation of the robot 10, the contacts of the electromagnetic contactors 24-1, 24-2 and 24-3 are closed, and the power supply 25 is supplied to the drive unit 23. When the operation of the robot 10 is not permitted, the contacts of any one of the magnetic contactors 24-1, 24-2, and 24-3 are opened, and the power supply to the drive unit 23 is cut off. In addition to the contacts of the electromagnetic contactors 24-1, 24-2 and 24-3, between the power supply 25 and the drive unit 23, for example, an emergency stop contact or other contact that becomes a factor for prohibiting the operation of the robot. Is inserted in the figure.
制御部２０と位置監視部２３とはシリアル通信等の情報伝達路で接続されているが、機構部データ、動作領域データを位置監視部２３への設定と位置監視部２３の状態及び異常情報を制御部２０へ伝えることで、設備導入時及び異常時の復旧を速やかに行なうための情報伝達を目的としていて、ロボット１０の通常の稼動時（作業プログラムの再生時）にはロボットの動作制御に関する情報伝達の必要性はないようになっている。 The control unit 20 and the position monitoring unit 23 are connected by an information transmission path such as serial communication. However, the mechanism unit data and the operation area data are set in the position monitoring unit 23, and the state and abnormality information of the position monitoring unit 23 are displayed. The information is transmitted to the control unit 20 for the purpose of information transmission for prompt recovery at the time of installation of the equipment and when there is an abnormality, and it relates to the operation control of the robot during normal operation of the robot 10 (when reproducing the work program). There is no need to communicate information.
図２は位置監視部２３のブロック図である。図において、３１は第１監視部、４１は第２監視部である。第１監視部３１と第２監視部４１とは同様の構成であるため第１監視部について説明する。尚、第１監視部３１と第２監視部４１とは異なるアーキテクチャのＣＰＵを採用することで、ＣＰＵのエラッタや制御プログラム開発装置の不具合（コンパイラのバグ等）を、双方の監視部の同一個所に入り込む機会をなくし、相互に独立して監視を行なうようにしている。また、第１監視部３１と第２監視部４１の各々は電磁接触器２４−２と２４−３の操作コイルを駆動するようになっている。 FIG. 2 is a block diagram of the position monitoring unit 23. In the figure, 31 is a first monitoring unit and 41 is a second monitoring unit. Since the 1st monitoring part 31 and the 2nd monitoring part 41 are the same structures, a 1st monitoring part is demonstrated. The first monitoring unit 31 and the second monitoring unit 41 employ CPUs having different architectures, so that CPU errata and control program development device failures (compiler bugs, etc.) can be detected at the same location in both monitoring units. It eliminates the opportunity to get in and monitors each other independently. Moreover, each of the 1st monitoring part 31 and the 2nd monitoring part 41 drives the operation coil of the electromagnetic contactors 24-2 and 24-3.
ロボット１０の各関節はモータ１０に備わるエンコーダ１１からの複数軸の位置信号は、駆動部２１に入力されサーボ制御されると共に、位置制御部２３へ並列接続されていて、第１監視部及び第２監視部にさらに並列分岐して入力される。
第１監視部３１に入力された複数のエンコーダ１１からの位置信号は、レシーバ３２を介してＣＰＵ３３に読み込まれる。ＣＰＵ３３は記憶部３４に記憶されているロボット１の機構部データ３７に基づいて、エンコーダ１１〜入力されるロボット１の各関節の位置データからロボット１の座標系の位置データへ順変換３５を行なう。この順変換でロボット１の制御点の座標系での位置データが求められる。
尚、制御点とは、作業ツールが取り付けられるエンドエフェクタの代表点（図５参照）又は取り付けられた作業ツーツの代表点（例えば、アーク溶接ではエンドエフェクタに取り付けられた溶接トーチのワイヤ先端（作業点））をいう。
尚、本図のレシーバ３２は、エンコーダからの位置信号を受け、位置データとしてカウンタ又はレジスタ等への一時格納を行なうインターフェース回路又は素子であるが、位置信号を受けるインターフェース回路又は素子とし、各軸の位置データをＣＰＵ３３で取得する構成であってもよい。
Each joint of the robot 10 receives a plurality of axis position signals from the encoder 11 provided in the motor 10 and is servo-controlled by being input to the drive unit 21 and connected in parallel to the position control unit 23. 2 are further branched and input to the monitoring unit.
Position signals from the plurality of encoders 11 input to the first monitoring unit 31 are read into the
The control point is a representative point of the end effector to which the work tool is attached (see FIG. 5) or a representative point of the attached work tool (for example, in arc welding, the wire tip of the welding torch attached to the end effector (work Point)).
The receiver 32 in this figure is an interface circuit or element that receives a position signal from the encoder and temporarily stores it as position data in a counter or a register. The position data may be acquired by the
求められた座標系の位置データは、記憶部３４に記憶されている動作領域データ３８と比較され、位置データが動作領域データの内部であるなら電磁接触器２４−２の操作コイルを駆動して接点を閉路し、動作領域データの外部であるなら接点を開路する。
図３は、電磁接触器２４−２の駆動回路図である。電磁接触器は、操作コイル２４−５へ電流の通流と遮断を行なうことで、２つの常開主接点２４−６の開路／閉路と１つの常閉補助接点２４−７の閉路／開路が連動して動作する。第１監視部３１のＣＰＵ３３は、位置データが動作領域データの外部であると判断すると、出力インターフェース４０−１を介して操作コイル２４−５への通電を遮断し、主接点２４−６を開路する。主接点２４−６が開路している状態から、位置データが動作領域データの内部であると判断すると、出力インターフェース４０−１を介して操作コイル２４−５への通電を行ない、主接点２４−６の閉路と補助接点２４−７の開路を行うが、操作コイル２４−５への通電の前に補助接点２４−７の状態を入力インターフェース４０−２を介して読み込み、閉路していることを確認する。この補助接点２４−７の状態確認は、主接点２４−６に接点溶着が発生していないことの確認に相当する。
The obtained position data of the coordinate system is compared with the operation area data 38 stored in the storage unit 34. If the position data is inside the operation area data, the operation coil of the electromagnetic contactor 24-2 is driven. Close the contact and open the contact if it is outside the operating area data.
FIG. 3 is a drive circuit diagram of the electromagnetic contactor 24-2. The magnetic contactor conducts and interrupts the current to the operation coil 24-5, so that the two normally open main contacts 24-6 are opened / closed and the one normally closed auxiliary contact 24-7 is closed / open. Operates in conjunction. When the
ロボットが稼動中に、何らかの原因でロボットが動作領域１０６から逸脱してしまったときのために、第１監視部は無効入力３９を備えている。この無効入力がアクティブになると、第１監視部は動作領域の監視を無効とし主接点２４−６を閉路とする又は監視を行っていても電磁接触器２４−２の主接点２４−６を閉路するようになっている。すなわち、ロボットが動作領域１０６から逸脱した位置から動作領域１０６の内部の位置に、ペンダントの操作で動作させるときに、この無効入力３９をアクティブとすると、動作領域１０６を逸脱していてもロボットの駆動電源を投入することができるようになっている。この無効入力３９は、例えばモーメンタリ型のスイッチで入力される。無効入力は制御部２０からの情報伝達路で状態を伝えられていてもかまわない。
The first monitoring unit has an
第２監視部４１は、第１監視部３１と構成は同じであるため詳細な説明は省略する。
尚、動作領域データは、例えばロボット座標系の上で直方体を形成する。すなわち、Ｘ、Ｙ及びＺの各軸に対し各々最大値と最小値を予め情報伝達路を介して設定しておく。現在位置がＸ、Ｙ及びＺの各軸で最大値と最小値の間であれば動作領域の内部であると判定し、最大値と最小値の間から出ればロボットの動作領域を逸脱と判定する。
Since the second monitoring unit 41 has the same configuration as the first monitoring unit 31, detailed description thereof is omitted.
Note that the motion area data forms a rectangular parallelepiped on the robot coordinate system, for example. That is, a maximum value and a minimum value are set in advance for each of the X, Y, and Z axes via the information transmission path. If the current position is between the maximum and minimum values for each of the X, Y, and Z axes, it is determined that it is inside the motion area, and if it is between the maximum and minimum values, the robot motion area is determined to be a departure. To do.
このようにロボット制御装置２の位置制御部２３は制御部２０及び駆動部２１から独立してロボットの位置を監視し、予め設定された動作領域１０６から逸脱すると、電磁接触器２４−２、２４−３の接点を開路して駆動部２１への電源を遮断することでロボット１の動作を禁止する。そして、この時の状態データを制御部２０に送り、制御部ではペンダント３に備わる図示しない表示器に状態データを適宜表示、又は図示しない出力部からロボット制御装置２の外部に出力することで、異常となった原因究明や保守作業に供する。 As described above, the position control unit 23 of the robot control device 2 monitors the position of the robot independently from the control unit 20 and the drive unit 21. When the position deviates from the preset operation region 106, the electromagnetic contactors 24-2 and 24- The operation of the robot 1 is prohibited by opening the contact point -3 and shutting off the power supply to the drive unit 21. Then, the state data at this time is sent to the control unit 20, and the control unit appropriately displays the state data on a display (not shown) provided in the pendant 3, or outputs it from the output unit (not shown) to the outside of the robot controller 2. It is used for investigation of the cause of abnormality and maintenance work.
ロボット制御装置２では、制御部２０でロボット１の制御点の動作軌道を制御周期毎に求め、ロボット１を該動作軌道に沿って動作制御を行なっているが、求めた動作軌道が動作領域１０６の範囲内であることの確認が行なわれているため、例えば、記憶部２２の誤動作や故障で記憶されている作業プログラムの一部データに障害があるときには、この段階でロボット１の動作前に動作領域１０６の逸脱を検出することができ、電磁接触器２４−１の接点を開路する等でロボット１を動作禁止とすることができる。 In the robot control apparatus 2, the control unit 20 obtains the operation trajectory of the control point of the robot 1 for each control period, and performs the motion control of the robot 1 along the operation trajectory. Therefore, for example, when there is a failure in some data of the work program stored due to malfunction or failure of the storage unit 22, before the operation of the robot 1 at this stage, The deviation of the operation area 106 can be detected, and the robot 1 can be prohibited from operating by opening the contact of the electromagnetic contactor 24-1.
このような構成であるため、特許文献２乃至４とは大きく異なり、制御部２０並びに位置監視部２３の第１監視部３１及び第２監視部４１で、ロボットの動作領域を３重に監視し確実に制限することができる。そして、位置監視部２３は制御部２０から独立しているのでロボットの動作制御に影響されずに位置監視を行うことができるので、確実なロボットの動作領域逸脱監視を行うことができる。そのため、特に、小型のワークへの作業等でロボットの動作領域が狭いときに、動作領域に見合う安全防護柵の設置を行なうことができ、また、例えば安全防護柵に代えてロープなどで動作領域を明示することも可能である。 Due to such a configuration, unlike the Patent Documents 2 to 4, the control unit 20 and the first monitoring unit 31 and the second monitoring unit 41 of the position monitoring unit 23 monitor the robot operation area in triplicate. It can be surely limited. Since the position monitoring unit 23 is independent of the control unit 20, the position monitoring can be performed without being affected by the robot operation control, so that the robot operation area deviation can be reliably monitored. Therefore, it is possible to install a safety protection fence suitable for the operation area, especially when the operation area of the robot is narrow due to work on small workpieces, etc. Can also be specified.
位置監視部２３は制御部２０及び駆動部２１とは独立して位置監視を行なうため、第三者機関による認証を取得後に、制御部２０又は駆動部２１の改良事項があっても、位置監視部２３に影響しないので、認証の更新が不要となる。 Since the position monitoring unit 23 performs position monitoring independently of the control unit 20 and the drive unit 21, even if there is an improvement matter of the control unit 20 or the drive unit 21 after obtaining authentication by a third party organization, the position monitoring unit 23 Since it does not affect the unit 23, it is not necessary to update authentication.
図４は第２実施例の第１監視部の構成を示す図である。図において、５１は第１監視部であって、図２の第１監視部３１に代わるものである。複数のエンコーダ１１からの位置信号は、第１監視部５１に導かれ、セレクタ５２に入力される。ＣＰＵ３３はセレクタにエンコーダ選択信号５３を出力して、複数のエンコーダ１１からの位置信号から１軸を選択してレシーバ３２に出力される。レシーバ３２は、選択されたエンコーダ１１の位置信号を入力して、該当する軸の位置データとし、ＣＰＵはこの位置データを取得し、次の軸のエンコーダ１１からの位置データを得るためにエンコーダ選択信号５３を歩進する。
この様にして、ロボット１の全軸の位置データを取得の後、ロボット１の座標系の位置データへ順変換３５を行なう。この順変換でロボット１の制御点の座標系での位置データが求められ、求められた座標系の位置データは、記憶部３４に記憶されている動作領域データ３８と比較され、位置データが動作領域データの内部であるなら電磁接触器２４−２の操作コイルを駆動して接点を閉路し、動作領域データの外部であるなら接点を開路する。
FIG. 4 is a diagram showing the configuration of the first monitoring unit of the second embodiment. In the figure, 51 is a first monitoring unit, which replaces the first monitoring unit 31 of FIG. Position signals from the plurality of encoders 11 are guided to the first monitoring unit 51 and input to the selector 52. The
In this way, after acquiring the position data of all axes of the robot 1, forward conversion 35 is performed to the position data of the coordinate system of the robot 1. By this forward conversion, position data in the coordinate system of the control point of the robot 1 is obtained, and the obtained position data of the coordinate system is compared with the operation area data 38 stored in the storage unit 34, and the position data is operated. If it is inside the area data, the operation coil of the electromagnetic contactor 24-2 is driven to close the contact, and if outside the operation area data, the contact is opened.
第２監視部も同様であるので、図示及び説明は省いている。尚、第２監視部の構成は第２実施例の構成に限定するものではなく、第１実施例の構成であってもかまわない。
尚、第２実施例の構成では、レシーバ３２では単軸単位で位置を得るために、このエンコーダ信号はエンコーダ１１からシリアル通信で送られるものである。
また、各々の軸についての位置データの取得タイミングが異なるが、位置データの取得が例えば１００マイクロ秒の違いは、ロボットの最大速度を２メートル／秒と仮定してもロボットの制御点で０．２ミリメートル程度の差異であるので、実質上問題とはならない。
Since the second monitoring unit is the same, illustration and description are omitted. The configuration of the second monitoring unit is not limited to the configuration of the second embodiment, and the configuration of the first embodiment may be used.
In the configuration of the second embodiment, this encoder signal is sent from the encoder 11 by serial communication so that the receiver 32 obtains the position in units of a single axis.
Further, although the position data acquisition timing for each axis is different, the difference in the acquisition of position data is, for example, 100 microseconds, even if the maximum speed of the robot is assumed to be 2 meters / second, it is 0. Since the difference is about 2 millimeters, it is not a problem in practice.
このように、各々の軸の位置データを順じ取得するような構成をしているので、ロボットの制御点位置計算では実質上問題とならない範囲で、レシーバの数を削減することができるので、監視部形状の小型化の効果を奏し、更にはコストダウンの効果も期待することができる。 In this way, since the configuration is such that the position data of each axis is acquired in order, the number of receivers can be reduced within a range that does not substantially pose a problem in the control point position calculation of the robot. It is possible to expect the effect of downsizing the monitoring unit shape and further to reduce the cost.
図５は第３実施例の垂直多関節型のロボット２００の構成図である。図において、
ロボットアームは、水平面内で回転（旋回）する第１関節２０１と、この第１関節に接続された第１アーム２０２と、第１アーム２０２の端部に第２関節２０３が取り付けられている。
第２関節２０３に接続された第２アーム２０４と、第２アーム２０４の端部に第３関節２０５が取り付けられている。第３アーム２０６の端部には第４関節２０７を介して手首部２０８が取り付けられている。
このとき、水平面をＸＹ平面とし、上空方向を＋Ｚ方向とすると、第３アーム２０５は、ロボットの姿勢、動作によっては、この第３アーム２０５の端部が、もっとも動作領域が広い場合がある。
つまり、第３関節２０５または第４関節２０７の現在位置と動作領域を比較する必要がある。
第３関節２０５または第４関節２０７の現在位置は、順変換から求めることは可能であるので、詳述はしない。また、制御点２０９の位置から第４関節２０７または第３関節２０５までの逆変換によって求めることも可能である。
FIG. 5 is a configuration diagram of a vertical articulated
The robot arm includes a first joint 201 that rotates (turns) in a horizontal plane, a first arm 202 connected to the first joint, and a second joint 203 attached to an end of the first arm 202.
A second arm 204 connected to the second joint 203 and a third joint 205 are attached to the end of the second arm 204. A wrist 208 is attached to the end of the third arm 206 via a fourth joint 207.
At this time, if the horizontal plane is the XY plane and the sky direction is the + Z direction, the third arm 205 may have the widest motion region at the end of the third arm 205 depending on the posture and operation of the robot.
That is, it is necessary to compare the current position of the third joint 205 or the fourth joint 207 with the motion region.
The current position of the third joint 205 or the fourth joint 207 can be obtained from forward conversion and will not be described in detail. It is also possible to obtain by inverse transformation from the position of the control point 209 to the fourth joint 207 or the third joint 205.
ロボットの制御とは独立して行なうようになっているので、ロボットの動作範囲の監視に関する第三者認定機関の認定が受けやすく、更にはロボットの動作制御に関する改善や改良を実施しても、取得済みの認定範囲に干渉しないので認定更新が不要となる。
本発明は、使用者を危険に曝さない有効なものであり、モータ等の駆動源で動作を行なう例えば数値制御機械等の自動機械に適用することができる。
Since it is designed to be performed independently of the robot control, it is easy to receive certification from a third-party accredited organization for monitoring the robot motion range, and even if improvements and improvements related to robot motion control are implemented, Renewal of certification is not required because it does not interfere with the scope of certification already acquired.
The present invention is effective without exposing the user to danger, and can be applied to an automatic machine such as a numerical control machine that operates with a drive source such as a motor.
１、１０１、２００ ロボット
２、１０２ ロボット制御装置
３、１０３ ペンダント
１０ モータ
１１ エンコーダ
２０ 制御部
２１ 駆動部
２２ 記憶部
２３ 位置監視部
２４ 電磁接触器
３１、５１ 第１監視部
３２ レシーバ
３３ ＣＰＵ
３４ 記憶部
３５ 順変換
３６ 比較
３７ 機構部データ
３８ 動作領域データ
４１ 第２監視部
５２ セレクタ
５３ エンコーダ選択信号
１０４ 作業ツール
１０５ ワーク
１０６ 動作領域
１１１ 制限領域
１１２ 最大領域
１１３ 安全防護領域
１１４ 安全防護装置
1, 101, 200 Robot 2, 102 Robot control device 3, 103 Pendant 10 Motor 11 Encoder 20 Control unit 21 Drive unit 22 Storage unit 23 Position monitoring unit 24 Electromagnetic contactor 31, 51 First monitoring unit 32
34 Storage section 35 Forward conversion 36 Comparison 37 Mechanism section data 38 Operation area data 41 Second monitoring section 52 Selector 53 Encoder selection signal 104 Work tool 105 Work 106 Operation area 111 Restriction area 112 Maximum area 113 Safety protection area 114 Safety protection device
Claims (11)
前記エンコーダからの位置信号が接続され、前記ロボットの動作領域に基づいて予め設定された動作領域データと前記ロボットの各軸の位置を検出するエンコーダからの位置データに基づいて算出する前記ロボットの制御点の現在位置とを比較し、
前記現在位置が前記ロボットの動作領域の逸脱を検出すると、前記ロボットの動作を禁止する位置監視部を備えたことを特徴とするロボットシステム。 Robot control provided with means for prohibiting the operation of the robot when a control point of the robot driven by a plurality of motor shafts having an encoder for detecting a rotational position detects a deviation from a preset operation area of the robot In a robot system provided with a device,
Control of the robot, which is calculated based on position data from an encoder that detects position of each axis of the robot and position data from the encoder connected to a position signal from the encoder and that is set in advance based on the motion area of the robot Compare the current position of the point,
A robot system comprising: a position monitoring unit for prohibiting the operation of the robot when the current position detects a deviation of the operation area of the robot.
前記ロボット制御装置は、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの制御点の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの制御点の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、
前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするロボットシステム。 Robot control provided with means for prohibiting the operation of the robot when a control point of the robot driven by a plurality of motor shafts having an encoder for detecting a rotational position detects a deviation from a preset operation area of the robot In a robot system provided with a device,
The robot controller is
First operation area monitoring means for obtaining a current position of a control point of the robot based on position data of an encoder for detecting a position of each axis of the robot, and detecting the deviation of the operation area of the robot based on the current position; A first monitoring unit comprising: a first shut-off unit that shuts off a driving power source of the robot based on an output of the first motion region monitoring unit when the current position detects a deviation from the motion region of the robot;
Second operation area monitoring means for obtaining a current position of the control point of the robot based on position data of an encoder for detecting a position of each axis of the robot, and detecting the deviation of the robot operation area from the current position; A second monitoring unit comprising: a second shut-off unit that shuts off the driving power of the robot based on the output of the second motion region monitoring unit when the current position detects a deviation from the robot motion region; With a position supervision department,
The driving power for each motor shaft is supplied from a power source through a line in which the first shut-off means and the second shut-off means are connected in series.
前記ロボット制御装置は、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第３関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第３関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、
前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするロボットシステム。 A robot driven by a plurality of motor shafts having an encoder for detecting a rotational position, wherein the robot has a base installed therein, a first joint rotatably provided on the base and driven by a motor; A first arm attached to one joint; a second joint rotatably provided at an end of the first arm and driven by a motor; a second arm attached perpendicularly to the second joint; A third joint rotatably provided at the end of the second arm and driven by a motor; a third arm attached to the third joint; and two or more attached to the end of the third arm In a robot system comprising a joint and including a robot control device for controlling the robot,
The robot controller is
First operation area monitoring means for obtaining a current position of the third joint of the robot based on position data of an encoder for detecting the position of each axis of the robot, and detecting the deviation of the robot operation area from the current position And a first monitoring unit comprising: a first shut-off unit that shuts off the driving power of the robot based on the output of the first motion region monitoring unit when the current position detects a deviation from the motion region of the robot;
Second operation area monitoring means for obtaining a current position of the third joint of the robot based on position data of an encoder for detecting the position of each axis of the robot, and detecting the deviation of the robot operation area from the current position And a second monitoring unit comprising: a second shut-off unit that shuts off the driving power of the robot based on an output of the second motion region monitoring unit when the current position detects a deviation from the robot operating region; A position supervision department having
The driving power for each motor shaft is supplied from a power source through a line in which the first shut-off means and the second shut-off means are connected in series.
前記ロボット制御装置は、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第４関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第１動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第１動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第１遮断手段とを備えた第１監視部と、
前記ロボットの各軸の位置を検出するエンコーダの位置データに基づいて、前記ロボットの第４関節の現在位置を求め、該現在位置が前記ロボットの動作領域の逸脱を検出する第２動作領域監視手段と、前記現在位置が前記ロボットの動作領域を逸脱を検出すると前記第２動作領域監視手段の出力に基づいて前記ロボットの駆動電源を遮断する第２遮断手段とを備えた第２監視部と、を有する位置監部を備え、
前記各モータ軸の駆動電源は、電源から前記第１遮断手段と第２遮断手段とを直列接続されたラインを介して供給されることを特徴とするロボットシステム。 A robot driven by a plurality of motor shafts having an encoder for detecting a rotational position, wherein the robot has a base installed therein, a first joint rotatably provided on the base and driven by a motor; A first arm attached to one joint; a second joint rotatably provided at an end of the first arm and driven by a motor; a second arm attached perpendicularly to the second joint; A third joint rotatably provided at the end of the second arm and driven by a motor; a third arm attached to the third joint; and two or more attached to the end of the third arm In a robot system comprising a joint and including a robot control device for controlling the robot,
The robot controller is
First operation area monitoring means for obtaining a current position of the fourth joint of the robot based on position data of an encoder that detects the position of each axis of the robot, and detecting the deviation of the robot operation area from the current position. And a first monitoring unit comprising: a first shut-off unit that shuts off the driving power of the robot based on the output of the first motion region monitoring unit when the current position detects a deviation from the motion region of the robot;
Second operation area monitoring means for obtaining a current position of the fourth joint of the robot based on position data of an encoder for detecting the position of each axis of the robot, and detecting the deviation of the robot operation area from the current position. And a second monitoring unit comprising: a second shut-off unit that shuts off the driving power of the robot based on an output of the second motion region monitoring unit when the current position detects a deviation from the robot operating region; A position supervision department having
The driving power for each motor shaft is supplied from a power source through a line in which the first shut-off means and the second shut-off means are connected in series.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2007051198A JP5271499B2 (en) | 2007-03-01 | 2007-03-01 | Robot system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2007051198A JP5271499B2 (en) | 2007-03-01 | 2007-03-01 | Robot system |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2008213056A true JP2008213056A (en) | 2008-09-18 |
| JP5271499B2 JP5271499B2 (en) | 2013-08-21 |
Family
ID=39833719
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2007051198A Expired - Fee Related JP5271499B2 (en) | 2007-03-01 | 2007-03-01 | Robot system |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5271499B2 (en) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2010224765A (en) * | 2009-03-23 | 2010-10-07 | Fujitsu Ltd | Program, device and method for analyzing approach prohibited space |
| JP2017177283A (en) * | 2016-03-30 | 2017-10-05 | セイコーエプソン株式会社 | Robot control device, robot, and simulation device |
| JP2019514709A (en) * | 2016-04-24 | 2019-06-06 | フランカ エミカ ゲーエムベーハーＦＲＡＮＫＡ ＥＭＩＫＡ ＧｍｂＨ | Robot control system and method |
| CN111251291A (en) * | 2018-11-30 | 2020-06-09 | 发那科株式会社 | Monitoring system of robot and robot system |
| US11420330B2 (en) | 2016-03-25 | 2022-08-23 | Seiko Epson Corporation | Robot control device, robot, and simulation device |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108136602A (en) | 2015-10-07 | 2018-06-08 | 大库输送机株式会社 | The method of controlling operation of the motion control device of movable device, motion control system and movable device |
| JP6630739B2 (en) * | 2015-11-12 | 2020-01-15 | オークラ輸送機株式会社 | Detection device abnormality determination system and detection device abnormality determination method |
| JP6641922B2 (en) * | 2015-11-24 | 2020-02-05 | 株式会社デンソーウェーブ | Robot controller |
| CN106730799B (en) * | 2017-01-23 | 2017-11-21 | 张添火 | A kind of target practice device |
Citations (23)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS5116558A (en) * | 1974-07-31 | 1976-02-09 | Tokyo Shibaura Electric Co | Kogyoyorobotsutono dosahaniseigensochi |
| JPS6044293A (en) * | 1983-08-18 | 1985-03-09 | 株式会社日立製作所 | Control system of industrial robot |
| JPS6130112U (en) * | 1984-07-27 | 1986-02-22 | 株式会社日立製作所 | Industrial robot control method |
| JPS61173876A (en) * | 1985-01-25 | 1986-08-05 | 株式会社日立製作所 | Control system of industrial robot |
| JPH03104588A (en) * | 1989-09-20 | 1991-05-01 | Mitsubishi Electric Corp | Control device of robot |
| JPH04340106A (en) * | 1991-05-16 | 1992-11-26 | Nachi Fujikoshi Corp | Robot motion regulating system |
| JPH0724762A (en) * | 1993-06-30 | 1995-01-27 | Toyoda Mach Works Ltd | Robot controller |
| JPH0796481A (en) * | 1993-08-03 | 1995-04-11 | Nippondenso Co Ltd | Method for setting robot operating range and its control device |
| JPH11113274A (en) * | 1997-10-03 | 1999-04-23 | Mitsubishi Electric Corp | Emergency stop device of motor |
| JPH11154006A (en) * | 1997-11-19 | 1999-06-08 | Fanuc Ltd | Numerical controller with malfunction preventing function |
| JP2001071192A (en) * | 1999-07-02 | 2001-03-21 | Natl Inst Of Industrial Safety Ministry Of Labour | Blanking system |
| JP2001525263A (en) * | 1997-12-06 | 2001-12-11 | エラン・シャルトエレメンテ・ゲーエムベーハー・ウント・コンパニー・カーゲー | Monitoring and control apparatus and method for monitoring technical equipment requiring high safety, especially manipulators |
| JP2002535153A (en) * | 1999-01-19 | 2002-10-22 | アーべーべー・アクチボラゲット | Device for controlling the operation of the drive |
| JP2003173201A (en) * | 2001-12-05 | 2003-06-20 | Natl Inst Of Industrial Safety Independent Administrative Institution | Hold/stop monitoring system for industrial machine |
| JP2004148488A (en) * | 2002-10-08 | 2004-05-27 | Fanuc Ltd | Robot control device |
| JP2004237416A (en) * | 2003-02-07 | 2004-08-26 | Fanuc Ltd | Emergency stop circuit |
| JP2004322244A (en) * | 2003-04-23 | 2004-11-18 | Toyota Motor Corp | Robot operation regulating method, its device and robot having this device |
| JP2005004557A (en) * | 2003-06-12 | 2005-01-06 | Keyence Corp | Input unit for safe relay system, safe relay system, and method for controlling safe relay |
| JP2005059146A (en) * | 2003-08-13 | 2005-03-10 | Yaskawa Electric Corp | Interference check method for industrial robot |
| JP2005103690A (en) * | 2003-09-30 | 2005-04-21 | Yaskawa Electric Corp | Industrial control controller |
| JP2005165755A (en) * | 2003-12-03 | 2005-06-23 | Fanuc Ltd | Emergency stop circuit |
| JP2005161486A (en) * | 2003-12-04 | 2005-06-23 | Yaskawa Electric Corp | Robot system |
| JP2005196441A (en) * | 2004-01-07 | 2005-07-21 | Yaskawa Electric Corp | Driving shaft operation system |
-
2007
- 2007-03-01 JP JP2007051198A patent/JP5271499B2/en not_active Expired - Fee Related
Patent Citations (24)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS5116558A (en) * | 1974-07-31 | 1976-02-09 | Tokyo Shibaura Electric Co | Kogyoyorobotsutono dosahaniseigensochi |
| JPS5344747B2 (en) * | 1974-07-31 | 1978-12-01 | ||
| JPS6044293A (en) * | 1983-08-18 | 1985-03-09 | 株式会社日立製作所 | Control system of industrial robot |
| JPS6130112U (en) * | 1984-07-27 | 1986-02-22 | 株式会社日立製作所 | Industrial robot control method |
| JPS61173876A (en) * | 1985-01-25 | 1986-08-05 | 株式会社日立製作所 | Control system of industrial robot |
| JPH03104588A (en) * | 1989-09-20 | 1991-05-01 | Mitsubishi Electric Corp | Control device of robot |
| JPH04340106A (en) * | 1991-05-16 | 1992-11-26 | Nachi Fujikoshi Corp | Robot motion regulating system |
| JPH0724762A (en) * | 1993-06-30 | 1995-01-27 | Toyoda Mach Works Ltd | Robot controller |
| JPH0796481A (en) * | 1993-08-03 | 1995-04-11 | Nippondenso Co Ltd | Method for setting robot operating range and its control device |
| JPH11113274A (en) * | 1997-10-03 | 1999-04-23 | Mitsubishi Electric Corp | Emergency stop device of motor |
| JPH11154006A (en) * | 1997-11-19 | 1999-06-08 | Fanuc Ltd | Numerical controller with malfunction preventing function |
| JP2001525263A (en) * | 1997-12-06 | 2001-12-11 | エラン・シャルトエレメンテ・ゲーエムベーハー・ウント・コンパニー・カーゲー | Monitoring and control apparatus and method for monitoring technical equipment requiring high safety, especially manipulators |
| JP2002535153A (en) * | 1999-01-19 | 2002-10-22 | アーべーべー・アクチボラゲット | Device for controlling the operation of the drive |
| JP2001071192A (en) * | 1999-07-02 | 2001-03-21 | Natl Inst Of Industrial Safety Ministry Of Labour | Blanking system |
| JP2003173201A (en) * | 2001-12-05 | 2003-06-20 | Natl Inst Of Industrial Safety Independent Administrative Institution | Hold/stop monitoring system for industrial machine |
| JP2004148488A (en) * | 2002-10-08 | 2004-05-27 | Fanuc Ltd | Robot control device |
| JP2004237416A (en) * | 2003-02-07 | 2004-08-26 | Fanuc Ltd | Emergency stop circuit |
| JP2004322244A (en) * | 2003-04-23 | 2004-11-18 | Toyota Motor Corp | Robot operation regulating method, its device and robot having this device |
| JP2005004557A (en) * | 2003-06-12 | 2005-01-06 | Keyence Corp | Input unit for safe relay system, safe relay system, and method for controlling safe relay |
| JP2005059146A (en) * | 2003-08-13 | 2005-03-10 | Yaskawa Electric Corp | Interference check method for industrial robot |
| JP2005103690A (en) * | 2003-09-30 | 2005-04-21 | Yaskawa Electric Corp | Industrial control controller |
| JP2005165755A (en) * | 2003-12-03 | 2005-06-23 | Fanuc Ltd | Emergency stop circuit |
| JP2005161486A (en) * | 2003-12-04 | 2005-06-23 | Yaskawa Electric Corp | Robot system |
| JP2005196441A (en) * | 2004-01-07 | 2005-07-21 | Yaskawa Electric Corp | Driving shaft operation system |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2010224765A (en) * | 2009-03-23 | 2010-10-07 | Fujitsu Ltd | Program, device and method for analyzing approach prohibited space |
| US11420330B2 (en) | 2016-03-25 | 2022-08-23 | Seiko Epson Corporation | Robot control device, robot, and simulation device |
| JP2017177283A (en) * | 2016-03-30 | 2017-10-05 | セイコーエプソン株式会社 | Robot control device, robot, and simulation device |
| JP2019514709A (en) * | 2016-04-24 | 2019-06-06 | フランカ エミカ ゲーエムベーハーＦＲＡＮＫＡ ＥＭＩＫＡ ＧｍｂＨ | Robot control system and method |
| US11059175B2 (en) | 2016-04-24 | 2021-07-13 | Franka Emika Gmbh | System and method for controlling a robot |
| CN111251291A (en) * | 2018-11-30 | 2020-06-09 | 发那科株式会社 | Monitoring system of robot and robot system |
Also Published As
| Publication number | Publication date |
|---|---|
| JP5271499B2 (en) | 2013-08-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5271499B2 (en) | Robot system | |
| JP5062925B2 (en) | Monitoring and control equipment for technical equipment | |
| US10599137B2 (en) | Safety control system and method of operation of a safety control system | |
| US7468594B2 (en) | Protection device | |
| US10514667B2 (en) | Machine tool and machine learning device | |
| US9266240B2 (en) | Robot | |
| EP2202593A1 (en) | Servo system and safety control device | |
| KR0126279B1 (en) | Safety operating system for manipulator | |
| JP2012510098A (en) | Safety controller for controlling automated equipment and control method thereof | |
| KR19980086661A (en) | Method and apparatus for monitoring a factory with several functional units | |
| JP6287677B2 (en) | Multi-axis photoelectric sensor | |
| US20170341240A1 (en) | Controller of transfer device | |
| CN106557067B (en) | Numerical control device and control method | |
| US20110239914A1 (en) | Combustion controlling device | |
| JP4258718B2 (en) | Robot controller | |
| US10596669B2 (en) | Machining system | |
| KR101661150B1 (en) | The Flexible Nozzle Safety System for Wind Tunnel And Controlling Method Thereof | |
| US20220193848A1 (en) | Machine tool and machine tool self-diagnosis method | |
| JP4289219B2 (en) | Human intervention robot controller | |
| WO1987003110A1 (en) | Apparatus for controlling robot having alarm display function | |
| JPS6250906A (en) | Control device for industrial robot | |
| WO2024004042A1 (en) | Robot control device | |
| JP2006116635A (en) | Control device of robot | |
| US20240042596A1 (en) | Method for operating a modular robot, modular robot, collision avoidance system, and computer program product | |
| JP4353048B2 (en) | Safety control equipment |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20090915 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20110323 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110325 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110425 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20120106 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120113 |
|
| A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20120606 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120803 |
|
| A911 | Transfer to examiner for re-examination before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20120813 |
|
| A912 | Re-examination (zenchi) completed and case transferred to appeal board |
Free format text: JAPANESE INTERMEDIATE CODE: A912 Effective date: 20121130 |
|
| RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20130131 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130329 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20130513 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 5271499 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| LAPS | Cancellation because of no payment of annual fees |