JP2013043256A - Assembling robot and method of controlling the same - Google Patents
Assembling robot and method of controlling the same Download PDFInfo
- Publication number
- JP2013043256A JP2013043256A JP2011183482A JP2011183482A JP2013043256A JP 2013043256 A JP2013043256 A JP 2013043256A JP 2011183482 A JP2011183482 A JP 2011183482A JP 2011183482 A JP2011183482 A JP 2011183482A JP 2013043256 A JP2013043256 A JP 2013043256A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- workpiece
- robot arm
- external force
- assembly
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40032—Peg and hole insertion, mating and joining, remote center compliance
Landscapes
- Automatic Assembly (AREA)
- Manipulator (AREA)
Abstract
Description
本発明は、ワークを対象物に組み付ける組立ロボットとその制御方法に関する。 The present invention relates to an assembly robot for assembling a workpiece on an object and a control method thereof.
ロボットの手先に取り付けた力センサ、あるいはロボット関節のトルクから作業にかかる力やモーメントを計測し、これに応じて手先の位置や速度を変化させるのが「力制御」である。
力制御は、例えば精密部品の嵌め合い作業などに用いられる。
“Force control” is to measure the force and moment applied to the work from the force sensor attached to the hand of the robot or the torque of the robot joint, and to change the position and speed of the hand according to this.
Force control is used, for example, for fitting work of precision parts.
ロボットによりワークを対象物に組み付ける際に力制御を用いることは、例えば、特許文献１〜６に開示されている。 For example, Patent Documents 1 to 6 disclose that force control is used when a workpiece is assembled to an object by a robot.
ロボットにより、ワークを嵌め合い動作を含む動作で対象物に組み付ける場合、本質的には、ワークと対象物との接触前後だけでなく、嵌め合い動作中であってもその状況に応じてロボットの動作が切り替わる必要がある。 When a workpiece is assembled to an object by an operation including a fitting operation by a robot, not only before and after the contact between the workpiece and the object, but also depending on the situation of the robot even during the fitting operation. The operation needs to be switched.
例えば特許文献１では、ワークを置き治具に設置するときは、ワークの設置面が置き治具の案内テーパに入り込むまで搬送してから、ツメを少し緩めることで、ツメの中でワークの「遊び」を作り、この状態で、置き治具の位置決めガイド面まで搬送動作することで、搬送装置および置き治具に過剰な力が加わらないようにしている。 For example, in Patent Document 1, when a work is placed on a placing jig, the work is moved until the work installation surface enters the guide taper of the placing jig, and then loosened slightly. “Play” is created, and in this state, the carrying operation is performed up to the positioning guide surface of the placing jig so that an excessive force is not applied to the carrying device and the placing jig.
しかし、特許文献１の手段を用いた場合でも、水平方向には僅かな遊びしかないため、嵌め合い動作中のカジリや位置ズレにより鉛直方向に過大な力が発生し、過負荷によりロボットが緊急停止する場合があった。
このような緊急停止の場合、ワークやハンド等が破壊する可能性があった。
However, even when using the means of Patent Document 1, since there is only a little play in the horizontal direction, excessive force is generated in the vertical direction due to galling or misalignment during the fitting operation, and the robot becomes urgent due to overload. There was a case to stop.
In the case of such an emergency stop, there is a possibility that the workpiece or the hand may be destroyed.
本発明は、上述した問題点を解決するために創案されたものである。すなわち、本発明の目的は、ワークを対象物に複数の動作で組み付ける場合に、各動作において正常動作中に誤作動することなく過負荷を確実に検出し安全に停止させることができる組立ロボットとその制御方法を提供することにある。 The present invention has been developed to solve the above-described problems. That is, an object of the present invention is to provide an assembly robot capable of reliably detecting an overload and stopping it safely without malfunctioning during normal operation in each operation when the workpiece is assembled to an object in a plurality of operations. It is in providing the control method.
本発明によれば、ワークを対象物に複数の動作で組み付ける組立ロボットの制御方法であって、
ワークを把持するハンドと、
ハンドに作用する外力を検出する力センサと、
３次元空間内でハンドの位置と姿勢を移動可能なロボットアームと、
ロボットアームを制御するロボット制御装置とを備え、
（Ａ）各動作における組付け方向の外力の最大値を記憶し、
（Ｂ）ロボットアームを制御して各動作を順次実行し、
（Ｃ）各動作の実行中に、力センサで検出された組付け方向の外力が、各動作における最大値に達したときに、ロボットアームを停止する、ことを特徴とする組立ロボットの制御方法が提供される。
According to the present invention, there is provided a method for controlling an assembly robot for assembling a workpiece on an object by a plurality of operations,
A hand for gripping the workpiece;
A force sensor for detecting an external force acting on the hand;
A robot arm that can move the position and posture of the hand in a three-dimensional space;
A robot control device for controlling the robot arm,
(A) The maximum value of the external force in the assembly direction in each operation is stored,
(B) The robot arm is controlled to execute each operation sequentially.
(C) A control method for an assembly robot, wherein the robot arm is stopped when the external force in the assembly direction detected by the force sensor reaches the maximum value in each operation during the execution of each operation. Is provided.
また本発明によれば、ワークを対象物に複数の動作で組み付ける組立ロボットであって、
ワークを把持するハンドと、
ハンドに作用する外力を検出する力センサと、
３次元空間内でハンドの位置と姿勢を移動可能なロボットアームと、
各動作における組付け方向の外力の最大値を記憶し、ロボットアームを制御して各動作を順次実行するロボット制御装置とを備え、
各動作の実行中に、力センサで検出された組付け方向の外力が、各動作における最大値に達したときに、ロボットアームを停止する、ことを特徴とする組立ロボットが提供される。
According to the present invention, there is an assembly robot for assembling a workpiece on a target object by a plurality of operations,
A hand for gripping the workpiece;
A force sensor for detecting an external force acting on the hand;
A robot arm that can move the position and posture of the hand in a three-dimensional space;
A maximum value of the external force in the direction of assembly in each operation, and a robot controller that controls the robot arm and sequentially executes each operation;
An assembly robot is provided that stops a robot arm when an external force in an assembly direction detected by a force sensor reaches a maximum value in each operation during execution of each operation.
上記本発明の装置及び方法によれば、ロボットの各動作における組付け方向外力の最大値をそれぞれ記憶しており、各動作の実行中に力センサで組付け方向の外力を検出するので、検出された外力が各動作における記憶した最大値に達したときに異常と判定し、自動的にロボットアームを停止することができる。
従ってワークを対象物に複数の動作で組み付ける場合に、各動作において正常動作中に誤作動することなく過負荷を確実に検出し安全に停止させることができる。
According to the apparatus and method of the present invention, the maximum value of the assembly direction external force in each operation of the robot is stored, and the external force in the assembly direction is detected by the force sensor during the execution of each operation. When the applied external force reaches the stored maximum value in each operation, it is determined that there is an abnormality, and the robot arm can be automatically stopped.
Therefore, when the workpiece is assembled to the object by a plurality of operations, overload can be reliably detected and safely stopped without malfunction during normal operation in each operation.
以下、本発明の好ましい実施形態を添付図面に基づいて詳細に説明する。なお、各図において共通する部分には同一の符号を付し、重複した説明を省略する。 Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the accompanying drawings. In addition, the same code | symbol is attached | subjected to the common part in each figure, and the overlapping description is abbreviate | omitted.
図１は、本発明の組立ロボットの全体構成図である。
本発明の組立ロボット１０は、ワーク１を対象物２に複数の動作で組み付けるロボットである。
組立ロボット１０は、この例では、多関節ロボットであるが、本発明はこれに限定されず、その他のロボットであってもよい。
対象物２は、この例で置き治具であり、テーブル３の上面に正確に位置決めされている。
FIG. 1 is an overall configuration diagram of an assembly robot according to the present invention.
The assembly robot 10 of the present invention is a robot that assembles the workpiece 1 to the object 2 by a plurality of operations.
In this example, the assembly robot 10 is an articulated robot, but the present invention is not limited to this and may be another robot.
The object 2 is a placing jig in this example, and is accurately positioned on the upper surface of the table 3.
複数の動作は、例えば、ワーク１の把持、ワーク１の搬送、ワーク１の対象物２への設置（挿入）である。
すなわち、本発明の組立ロボット１０は、図示しない支持台上に置かれたワーク１をハンド１２で把持し、ワーク１を予め定められた搬送経路に沿って数値制御により３次元的に搬送し、テーブル３の上面の対象物２に設置（挿入）するようになっている。
The plurality of operations are, for example, gripping the workpiece 1, transporting the workpiece 1, and installing (inserting) the workpiece 1 into the object 2.
That is, the assembly robot 10 of the present invention grips the work 1 placed on a support base (not shown) with the hand 12, and transports the work 1 three-dimensionally by numerical control along a predetermined transport path, It is installed (inserted) in the object 2 on the upper surface of the table 3.
図１において、本発明の組立ロボット１０は、ワーク１を把持するハンド１２、力センサ１４、ロボットアーム１６及びロボット制御装置１８を備える。 In FIG. 1, the assembly robot 10 of the present invention includes a hand 12 that holds a workpiece 1, a force sensor 14, a robot arm 16, and a robot control device 18.
力センサ１４は、ワーク１に作用する外力を検出するセンサである。
この例において、力センサ１４は直交３軸方向の力（Ｆｘ，Ｆｙ，Ｆｚ）と各軸まわりのトルク（Ｔｘ，Ｔｙ，Ｔｚ）を計測可能な６軸センサであり、３次元的に移動可能なロボットアーム１６に取り付けられ、これに作用する６自由度の外力（３方向の力Ｆｘ，Ｆｙ，Ｆｚと、３軸まわりのトルクＴｘ，Ｔｙ，Ｔｚ）を検出するようになっている。
なお、本発明はこれに限定されず、ワーク１に作用する外力が検出できる限りで、その他の力センサであってもよい。
The force sensor 14 is a sensor that detects an external force acting on the workpiece 1.
In this example, the force sensor 14 is a six-axis sensor capable of measuring a force (Fx, Fy, Fz) in three orthogonal axes and a torque (Tx, Ty, Tz) around each axis, and can be moved three-dimensionally. 6 degrees of freedom external force (forces Fx, Fy, Fz in three directions and torques Tx, Ty, Tz around three axes) acting on the robot arm 16 is detected.
In addition, this invention is not limited to this, As long as the external force which acts on the workpiece | work 1 is detectable, another force sensor may be sufficient.
ロボットアーム１６は、手先にハンド１２を取付け、これを３次元空間内で位置と姿勢を移動可能に構成されている。
ロボットアーム１６は、この例では、多関節ロボットのロボットアームであるが、本発明はこれに限定されず、その他のロボットアームであってもよい。
The robot arm 16 is configured such that the hand 12 is attached to the hand and the position and posture of the hand can be moved in a three-dimensional space.
In this example, the robot arm 16 is a robot arm of an articulated robot, but the present invention is not limited to this and may be another robot arm.
ロボット制御装置１８は、例えば数値制御装置であり、指令信号によりロボットアーム１６を６自由度（３次元位置と３軸まわりの回転）に制御するようになっている。また、ロボット制御装置１８は、ロボットアーム１６を制御してロボット１０の複数の動作を順次実行する。 The robot control device 18 is, for example, a numerical control device, and controls the robot arm 16 to six degrees of freedom (three-dimensional position and rotation about three axes) by a command signal. Further, the robot control device 18 controls the robot arm 16 to sequentially execute a plurality of operations of the robot 10.
さらに、ロボット制御装置１８は、各動作における組付け方向の外力の最大値を記憶し、各動作の実行中に、力センサ１４で検出された組付け方向の外力が、各動作における組付け方向の外力の最大値に達したときに、ロボットアーム１６を停止するようになっている。
組付け方向の外力の最大値は、各動作に応じてそれぞれ予め設定する。
Further, the robot controller 18 stores the maximum value of the external force in the assembly direction in each operation, and the external force in the assembly direction detected by the force sensor 14 during the execution of each operation is the assembly direction in each operation. When the maximum value of the external force is reached, the robot arm 16 is stopped.
The maximum value of the external force in the assembling direction is set in advance according to each operation.
さらに、ロボット制御装置１８は、ロボットアーム１６の停止位置と予め設定した目標位置との差が閾値以内であれば、設置成功と判断し、この差が閾値を超えていれば設置失敗と判断する。閾値は、各動作に応じてそれぞれ予め設定する。 Furthermore, the robot controller 18 determines that the installation is successful if the difference between the stop position of the robot arm 16 and the preset target position is within a threshold value, and determines that the installation has failed if the difference exceeds the threshold value. . The threshold value is preset in accordance with each operation.
図２は、本発明のハンド１２の構成図である。 FIG. 2 is a configuration diagram of the hand 12 of the present invention.
この図において、ワーク１は、本体１ａと鍔部１ｂとからなる。
本体１ａは、鉛直な軸線Ｚ−Ｚを有する。また、鍔部１ｂは、ワーク下端１ｄより上方に設けられ、その鍔部下面１ｃが水平に構成されている。
なおこの例において、本体１ａは円筒形または中空円筒形であり、鍔部１ｂはリング状である。
In this figure, the work 1 is composed of a main body 1a and a flange 1b.
The main body 1a has a vertical axis ZZ. Moreover, the collar part 1b is provided above the workpiece | work lower end 1d, and the collar part lower surface 1c is comprised horizontally.
In this example, the main body 1a has a cylindrical shape or a hollow cylindrical shape, and the flange portion 1b has a ring shape.
図２において、ワーク１が設置される対象物２（置き治具）は、ワーク下端１ｄと嵌合する嵌合部２ａをその上端部に有し、この嵌合部２ａには案内テーパ面２ｂが設けられている。
この例において、対象物２は円筒形であり、嵌合部２ａは円筒面であり、案内テーパ面２ｂは接頭円錐面である。
なお嵌合部２ａがワーク下端１ｄの中空孔と嵌合する場合、嵌合部２ａをピン形状としてもよい。
In FIG. 2, an object 2 (placement jig) on which the workpiece 1 is installed has a fitting portion 2a fitted to the workpiece lower end 1d at its upper end portion, and the fitting tapered portion 2a has a guide taper surface 2b. Is provided.
In this example, the object 2 has a cylindrical shape, the fitting portion 2a has a cylindrical surface, and the guide tapered surface 2b has a prefix conical surface.
In addition, when the fitting part 2a fits with the hollow hole of the workpiece | work lower end 1d, it is good also considering the fitting part 2a as a pin shape.
図２において、ハンド１２は、複数のツメ部材１２ａと開閉アクチュエータ１２ｂを備える。 In FIG. 2, the hand 12 includes a plurality of claw members 12a and an opening / closing actuator 12b.
ハンド１２の本体１１は、上述した力センサ１４の下部に取り付けられ、３次元的に移動可能に構成されている。また、本体１１は、上述したロボット制御装置１８により、ワーク１を対象物２まで搬送して設置する動作において、本体１１を一定の姿勢（水平姿勢）に保持するようになっている。 The main body 11 of the hand 12 is attached to the lower part of the force sensor 14 described above and is configured to be movable three-dimensionally. Further, the main body 11 is configured to hold the main body 11 in a fixed posture (horizontal posture) in the operation of transporting and setting the workpiece 1 to the object 2 by the robot control device 18 described above.
複数（この例では２つ）のツメ部材１２ａは、本体１１に水平方向に移動可能に取り付けられている。すなわち、この例で２つのツメ部材１２ａは、ワーク１の軸線Ｚ−Ｚに対して互いに反対方向に移動して、その水平方向の間隔を開閉でき、閉位置Ｃでワーク１の鍔部１ｂを把持し、開位置Ｏで鍔部１ｂを開放して、その外端より外側に位置するようになっている。
なお、ツメ部材１２ａは、ワーク１の軸線Ｚ−Ｚに対して対称（水平）に移動できる限りで、３つ以上であってもよい。
A plurality (two in this example) of claw members 12a are attached to the main body 11 so as to be movable in the horizontal direction. That is, in this example, the two claw members 12a can move in opposite directions with respect to the axis ZZ of the workpiece 1 to open and close the horizontal interval, and the flange 1b of the workpiece 1 can be opened at the closed position C. The grip 1b is opened at the open position O and positioned outside the outer end.
Note that the number of the claw members 12a may be three or more as long as the claw members 12a can move symmetrically (horizontal) with respect to the axis ZZ of the workpiece 1.
開閉アクチュエータ１２ｂは、複数のツメ部材１２ａを互いに連動して水平反対方向に駆動する。この開閉アクチュエータ１２ｂは、例えば、（１）リンク機構と電動シリンダの組み合わせや（２）サーボモータとラック＆ピニオンの組み合わせを用いることができる。
なお、開閉アクチュエータ１２ｂは、ツメ部材１２ａの開閉位置を数値制御できることが好ましいが、本発明はこれに限定されず、開閉位置を３段階（閉、開、中間）に変化できる機構であればよい。
The opening / closing actuator 12b drives the plurality of claw members 12a in the opposite horizontal direction in conjunction with each other. As the opening / closing actuator 12b, for example, (1) a combination of a link mechanism and an electric cylinder, or (2) a combination of a servo motor and a rack and pinion can be used.
The opening / closing actuator 12b is preferably capable of numerically controlling the opening / closing position of the claw member 12a. However, the present invention is not limited to this, and any mechanism may be used as long as the opening / closing position can be changed in three stages (closed, opened, intermediate). .
図２において、各ツメ部材１２ａは、支持面Ａと把持面Ｂ，Ｃを有する。
支持面Ａは水平であり、鍔部１ｂの水平な鍔部下面１ｃを支持する機能を有する。
把持面Ｂ，Ｃは、鉛直面Ｂとテーパ面Ｃからなり、鍔部１ｂの外面又は上縁部を把持する機能を有する。
この例において、鉛直面Ｂとテーパ面Ｃは、平面視において、Ｖ字状に開いている。すなわち、鉛直面Ｂは、鍔部１ｂの外面と当接する鉛直Ｖ字面であり、テーパ面Ｃは、鍔部１ｂの上縁部と当接するテーパＶ字面である。
In FIG. 2, each claw member 12 a has a support surface A and gripping surfaces B and C.
The support surface A is horizontal and has a function of supporting the horizontal flange lower surface 1c of the flange 1b.
The gripping surfaces B and C are composed of a vertical surface B and a tapered surface C, and have a function of gripping the outer surface or upper edge portion of the flange 1b.
In this example, the vertical surface B and the tapered surface C are open in a V shape in plan view. That is, the vertical surface B is a vertical V-shaped surface that contacts the outer surface of the flange 1b, and the tapered surface C is a tapered V-shaped surface that contacts the upper edge of the flange 1b.
図３は、図１、図２の組立ロボット１０の動作説明図である。
この図において、（Ａ）はワーク把持、（Ｂ）は設置準備、（Ｃ）は設置中、（Ｄ）は設置完了の各動作を示している。
FIG. 3 is an operation explanatory diagram of the assembly robot 10 of FIGS. 1 and 2.
In this figure, (A) shows the workpiece gripping, (B) shows the preparation for installation, (C) shows the operation during installation, and (D) shows the operation for completing the installation.
本発明では、（Ａ）〜（Ｄ）の各動作における組付け方向の外力の最大値を記憶し、各動作の実行中に、力センサ１４で検出された組付け方向の外力が、各動作における組付け方向の外力の最大値に達したときに、ロボットアーム１６を停止するようになっている。「組付け方向」は、この例では鉛直下向きである。 In the present invention, the maximum value of the external force in the assembly direction in each operation of (A) to (D) is stored, and the external force in the assembly direction detected by the force sensor 14 during each operation is The robot arm 16 is stopped when the maximum value of the external force in the assembling direction is reached. The “assembly direction” is vertically downward in this example.
以下、この図を参照して、ワーク１の設置方法を説明する。
なおハンド１０は、上述した力センサ１４の下部に取り付けられ、ロボット制御装置１８により、一定の姿勢を保持する。ここで「一定の姿勢」とは、ワーク１の軸線Ｚ−Ｚに対して、ツメ部材１２ａが対称（水平）に移動する姿勢を意味する。
Hereinafter, with reference to this figure, the installation method of the workpiece | work 1 is demonstrated.
The hand 10 is attached to the lower part of the force sensor 14 described above, and is held in a certain posture by the robot control device 18. Here, the “constant posture” means a posture in which the claw member 12a moves symmetrically (horizontal) with respect to the axis ZZ of the workpiece 1.
ワーク把持動作（Ａ）において、図示しない支持台上に置かれたワーク１の鍔部下面１ｃを複数のツメ部材１２ａの水平な支持面Ａで支持し、かつワークの鍔部１ｂの外面又は上縁部を複数のツメ部材１２ａの把持面（鉛直面Ｂとテーパ面Ｃ）で把持して、ワーク１を３次元的に移動し、ワーク下端１ｄを対象物２の案内テーパ２ｂの近傍まで搬送する。
なお、図示しない支持台からのワークの搬送動作中は、ワーク１の軸線Ｚ−Ｚを鉛直以外に傾けてもよい。
動作（Ａ）における組付け方向（鉛直下向き）の外力の最大値は、ワーク１の把持に支障がない値、例えばワーク重量の２〜３倍の値に設定するのがよい。
In the workpiece gripping operation (A), the collar 1 lower surface 1c of the workpiece 1 placed on a support base (not shown) is supported by the horizontal support surface A of the plurality of claw members 12a, and the outer surface or upper surface of the workpiece collar 1b. The edge is gripped by the gripping surfaces (vertical surface B and tapered surface C) of the plurality of claw members 12a, the workpiece 1 is moved three-dimensionally, and the workpiece lower end 1d is conveyed to the vicinity of the guide taper 2b of the object 2. To do.
Note that the axis ZZ of the workpiece 1 may be tilted to a position other than vertical during a workpiece transfer operation from a support base (not shown).
The maximum value of the external force in the assembly direction (vertically downward) in the operation (A) is preferably set to a value that does not hinder the gripping of the workpiece 1, for example, a value that is two to three times the workpiece weight.
設置準備（Ｂ）において、ワーク１の鍔部下面１ｃを複数のツメ部材１２ａの水平な支持面Ｃで支持したまま、複数のツメ部材１２ａを互いに連動して水平外方に駆動して、鍔部１ｂの外面又は上縁部と複数のツメ部材１２ａの把持面（鉛直面Ｂとテーパ面Ｃ）との間に隙間（遊び）を形成する。
ここで「隙間」（遊び）は、案内テーパ２ｂの内側まで搬送されたワーク下端１ｄが、対象物２の嵌合部２ａに嵌合するために要する水平移動距離よりも大きい必要がある。すなわち、隙間は、例えばこの水平移動距離の最大値である案内テーパ２ｂの最大半径と最小半径の差に設定するのがよい。
また設置準備（Ｂ）における組付け方向の外力の最大値は、ツメ部材１２ａの駆動に支障がない値、例えばワーク重量の２〜３倍の値に設定するのがよい。
In the preparation for installation (B), the plurality of claw members 12a are driven in the horizontal direction in conjunction with each other while the flange lower surface 1c of the work 1 is supported by the horizontal support surfaces C of the plurality of claw members 12a. A gap (play) is formed between the outer surface or upper edge of the portion 1b and the gripping surfaces (vertical surface B and tapered surface C) of the plurality of claw members 12a.
Here, the “gap” (play) needs to be larger than the horizontal movement distance required for the work lower end 1 d conveyed to the inside of the guide taper 2 b to be fitted into the fitting portion 2 a of the object 2. That is, the gap is preferably set to the difference between the maximum radius and the minimum radius of the guide taper 2b, which is the maximum value of the horizontal movement distance, for example.
Further, the maximum value of the external force in the assembly direction in the installation preparation (B) is preferably set to a value that does not hinder the driving of the claw member 12a, for example, a value that is two to three times the workpiece weight.
設置中（Ｃ）において、隙間（遊び）の範囲でワーク１が自由に水平移動できる状態で、ツメ部材１２ａの下端が対象物２に対し目標位置に達するまで、把持機構を鉛直に下降させて、ワーク下端１ｄを対象物２の嵌合部２ａに設置する。
ここで「目標位置」とは、ワーク１を対象物２に正確に組み付けた際に、ツメ部材１２ａの下端が位置する高さをいう。
During installation (C), the gripping mechanism is lowered vertically until the lower end of the claw member 12a reaches the target position with respect to the object 2 in a state where the workpiece 1 can freely move horizontally within the gap (play). The lower end 1d of the workpiece is installed in the fitting portion 2a of the object 2.
Here, the “target position” refers to the height at which the lower end of the claw member 12a is positioned when the workpiece 1 is accurately assembled to the object 2.
設置中（Ｃ）において、ワーク下端１ｄが対象物２の嵌合部２ａより大きく、嵌合部２ａに嵌らない場合には、ワーク下端１ｄが対象物２に対し目標位置に達していても、上記「遊び」によりツメ部材１２ａのなかでワーク１が上方に変位しており、ワーク下端１ｄを対象物２の位置決めガイド面（例えば嵌合底面）まで搬送動作できない状態となる。
従って、この状態を検知するために、設置中（Ｃ）における組付け方向の外力の最大値は、正常な設置動作に支障がない値よりも高く、かつワークやハンド等に悪影響を与えない値に設定する。
During installation (C), when the workpiece lower end 1d is larger than the fitting portion 2a of the object 2 and does not fit into the fitting portion 2a, the workpiece lower end 1d reaches the target position with respect to the object 2. As a result of the “play”, the workpiece 1 is displaced upward in the claw member 12a, and the workpiece lower end 1d cannot be conveyed to the positioning guide surface (for example, the fitting bottom surface) of the object 2.
Therefore, in order to detect this state, the maximum value of the external force in the assembling direction during installation (C) is higher than a value that does not hinder normal installation operation, and does not adversely affect the workpiece, hand, etc. Set to.
本発明では、設置中（Ｃ）の実行中に、力センサ１４で検出された組付け方向の外力が、設置中（Ｃ）における組付け方向の外力の最大値に達したときに、ロボットアーム１６を停止する。
この停止の際に、ロボットアーム１６の停止位置と目標位置との差が閾値以内であれば、設置成功と判断し、この差が閾値を超えていれば設置失敗と判断する。
例えば停止の際に、ツメ部材１２ａの下端が対象物２に対し目標位置に達していれば、設置成功と判定することができる。また逆に、停止の際に、ツメ部材１２ａの下端が対象物２に対し目標位置に達していなければ、設置失敗と判定することができる。
In the present invention, when the external force in the assembly direction detected by the force sensor 14 reaches the maximum value of the external force in the assembly direction during installation (C) during execution of the installation (C), the robot arm 16 is stopped.
At the time of this stop, if the difference between the stop position of the robot arm 16 and the target position is within the threshold value, it is determined that the installation is successful, and if this difference exceeds the threshold value, it is determined that the installation has failed.
For example, when the lower end of the claw member 12a has reached the target position with respect to the object 2 when stopping, it can be determined that the installation has been successful. Conversely, if the lower end of the claw member 12a has not reached the target position with respect to the object 2 when stopping, it can be determined that the installation has failed.
次いで、設置完了（Ｄ）において、複数のツメ部材１２ａを互いに連動して水平外方に駆動して、その間の鍔部１ｂを開放し、ハンド１２をワーク把持動作（Ａ）まで復帰させる。 Next, in the installation completion (D), the plurality of claw members 12a are driven in the horizontal direction in conjunction with each other to release the collar portion 1b therebetween, and the hand 12 is returned to the workpiece gripping operation (A).
上述したように、ワーク１を対象物２に設置するときは、ワーク下端１ｄが対象物２の案内テーパ２ｂに入り込むまで搬送してから、ツメ部材１２ａを少し緩めることで、ツメ部材１２ａのなかでワーク１の「遊び」をつくる。次いで、この状態で、対象物２の位置決めガイド面（例えば嵌合底面）まで搬送動作することで、搬送装置（ロボット１０、力センサ１４等）および対象物２に過剰な力が加わらないように、正確な位置決め動作が可能である。またワーク１を高速搬送するときは、ツメ部材１２ａを閉じてワーク１を確実に把持することができる。 As described above, when the workpiece 1 is installed on the object 2, the claw member 12 a is slightly loosened after the workpiece 1 is conveyed until the workpiece lower end 1 d enters the guide taper 2 b of the object 2. Then, create “play” for Work 1. Next, in this state, the transfer operation is performed up to the positioning guide surface (for example, the fitting bottom surface) of the target object 2 so that excessive force is not applied to the transfer device (the robot 10, the force sensor 14, etc.) and the target object 2. Accurate positioning operation is possible. When the workpiece 1 is conveyed at high speed, the claw member 12a can be closed and the workpiece 1 can be securely gripped.
また、本発明はワークの設置動作に限定されず、上述した動作を逆にたどることで、ワークの持ち上げ動作にも適用することができる。 Further, the present invention is not limited to the workpiece setting operation, and can be applied to the workpiece lifting operation by tracing the above-described operation in reverse.
図４は、本発明による組立ロボットの別の動作説明図である。
この図において、ワーク１は円筒形孔４ａを有する中空円筒形部材である。また、対象物２はワーク１の円筒形孔４ａに嵌合する大径部２ｃを有し、作業台３（図１参照）に移動しないように固定されている。なおこの例で、大径部２ｃの上部に大径部２ｃより小径の小径部２ｄが設けられている。
円筒形孔４ａの内径は、大径部２ｃの直径よりわずかに大きく、ワーク１の下端が対象物２の拡径部２ｃ上面に達するまで、同心を維持したまま挿入できるようになっている。
円筒形孔４ａの内径と大径部２ｃの直径の差は、例えば、０．０１ｍｍである。
FIG. 4 is another operation explanatory diagram of the assembly robot according to the present invention.
In this figure, the workpiece 1 is a hollow cylindrical member having a cylindrical hole 4a. The object 2 has a large-diameter portion 2c that fits into the cylindrical hole 4a of the work 1, and is fixed so as not to move to the work table 3 (see FIG. 1). In this example, a small-diameter portion 2d having a smaller diameter than the large-diameter portion 2c is provided above the large-diameter portion 2c.
The inner diameter of the cylindrical hole 4a is slightly larger than the diameter of the large diameter portion 2c, and the cylindrical hole 4a can be inserted while maintaining concentricity until the lower end of the workpiece 1 reaches the upper surface of the enlarged diameter portion 2c of the object 2.
The difference between the inner diameter of the cylindrical hole 4a and the diameter of the large diameter portion 2c is, for example, 0.01 mm.
さらにこの例において、大径部２ｃには、円周溝５が設けられ、この円周溝５にリング６が嵌められている。リング６は、割目のある環状のリングであり、その弾性力で円筒形孔４ａの内面に半径方向外方に付勢するようになっている。 Further, in this example, the large diameter portion 2 c is provided with a circumferential groove 5, and a ring 6 is fitted in the circumferential groove 5. The ring 6 is an annular ring with a split, and is urged radially outward by the elastic force against the inner surface of the cylindrical hole 4a.
この組立ロボット１０は、単一のワーク１の円筒形孔４ａを３つの動作（１）〜（３）で対象物２の大径部２ｃに組み付ける。
動作（１）は、図で（Ａ）から（Ｂ）までであり、ワーク１の下端を円筒形孔２ａの上部に挿入する嵌め合いまでの近接動作である。
動作（２）は、図で（Ｂ）から（Ｃ）までであり、嵌め合い開始直後の動作である。この動作では、位置と姿勢のずれを修正する必要がある。
動作（３）は、図で（Ｃ）から（Ｄ）までであり、嵌め合い動作と挿入動作である。この動作（３）では、位置のずれを修正しつつワーク１を挿入する必要がある。
The assembly robot 10 assembles the cylindrical hole 4a of a single workpiece 1 to the large-diameter portion 2c of the object 2 by three operations (1) to (3).
The operation (1) is from (A) to (B) in the figure, and is a close-up operation until the fitting of inserting the lower end of the work 1 into the upper portion of the cylindrical hole 2a.
The operation (2) is from (B) to (C) in the figure, and is an operation immediately after the start of fitting. In this operation, it is necessary to correct the deviation between the position and the posture.
The operation (3) is (C) to (D) in the figure, and is a fitting operation and an insertion operation. In this operation (3), it is necessary to insert the workpiece 1 while correcting the positional deviation.
図４の例において、動作（３）における「組付け方向の外力の最大値」は、リング６の存在を考慮して設定する必要がある。
すなわち、リング６が対象物２の円周溝５に嵌められており、かつ対象物２との芯ずれが許容範囲である場合には、動作（３）に必要な挿入方向の力は、予め設定した「組付け方向の外力の最大値」以下であり、力センサ１４で検出された組付け方向の外力が、最大値に達したときに、ロボットアーム１６を停止することで、動作（３）の成功と判定することができる。
In the example of FIG. 4, “the maximum value of the external force in the assembling direction” in the operation (3) needs to be set in consideration of the presence of the ring 6.
That is, when the ring 6 is fitted in the circumferential groove 5 of the object 2 and the misalignment with the object 2 is within an allowable range, the force in the insertion direction necessary for the operation (3) is When the external force in the assembling direction detected by the force sensor 14 reaches the maximum value, the robot arm 16 is stopped to operate (3 ) Success.
また、リング６が対象物２の円周溝５に嵌められているが、対象物２との芯ずれが許容範囲を超えている場合には、動作（３）に必要な挿入方向の力は、予め設定した最大値を超える。従って、この場合には「芯ずれが過大である」と判定することができる。 Further, when the ring 6 is fitted in the circumferential groove 5 of the object 2, when the misalignment with the object 2 exceeds the allowable range, the force in the insertion direction necessary for the operation (3) is , Exceeding the preset maximum value. Therefore, in this case, it can be determined that “the misalignment is excessive”.
上述した本発明の装置及び方法によれば、ロボット１０の各動作における組付け方向の外力の最大値をそれぞれ記憶しており、各動作の実行中に力センサ１４で組付け方向の外力を検出するので、検出された外力が各動作における記憶した最大値に達したときに異常と判定し、自動的にロボットアーム１６を停止することができる。
従ってワーク１を対象物２に複数の動作で組み付ける場合に、各動作において正常動作中に誤作動することなく過負荷を確実に検出し安全に停止させることができる。
According to the apparatus and method of the present invention described above, the maximum value of the external force in the assembly direction in each operation of the robot 10 is stored, and the external force in the assembly direction is detected by the force sensor 14 during the execution of each operation. Therefore, when the detected external force reaches the stored maximum value in each operation, it is determined that there is an abnormality, and the robot arm 16 can be automatically stopped.
Therefore, when the workpiece 1 is assembled to the object 2 by a plurality of operations, overload can be reliably detected and safely stopped without malfunction during normal operation in each operation.
なお、本発明は上述した実施形態に限定されず、特許請求の範囲の記載によって示され、さらに特許請求の範囲の記載と均等の意味および範囲内でのすべての変更を含むものである。 In addition, this invention is not limited to embodiment mentioned above, is shown by description of a claim, and also includes all the changes within the meaning and range equivalent to description of a claim.
１ ワーク、１ａ 本体、１ｂ 鍔部、１ｃ 鍔部下面、１ｄ ワーク下端、
２ 対象物、２ａ 嵌合部、２ｂ 案内テーパ面、
２ｃ 大径部、２ｄ 小径部、
３ テーブル（作業台）、５ 円周溝、６ リング、
１０ 組立ロボット、１１ 本体、
１２ ハンド、１２ａ ツメ部材、１２ｂ 開閉アクチュエータ、
１４ 力センサ、１６ ロボットアーム、１８ ロボット制御装置
1 work 1a body 1b collar 1c collar bottom 1d work bottom
2 object, 2a fitting part, 2b guide taper surface,
2c Large diameter part, 2d Small diameter part,
3 tables (workbench), 5 circumferential grooves, 6 rings,
10 assembly robot, 11 body,
12 hand, 12a claw member, 12b opening and closing actuator,
14 force sensor, 16 robot arm, 18 robot controller
Claims (3)
ワークを把持するハンドと、
ハンドに作用する外力を検出する力センサと、
３次元空間内でハンドの位置と姿勢を移動可能なロボットアームと、
ロボットアームを制御するロボット制御装置とを備え、
（Ａ）各動作における組付け方向の外力の最大値を記憶し、
（Ｂ）ロボットアームを制御して各動作を順次実行し、
（Ｃ）各動作の実行中に、力センサで検出された組付け方向の外力が、各動作における最大値に達したときに、ロボットアームを停止する、ことを特徴とする組立ロボットの制御方法。 An assembly robot control method for assembling a workpiece on a target object by a plurality of operations,
A hand for gripping the workpiece;
A force sensor for detecting an external force acting on the hand;
A robot arm that can move the position and posture of the hand in a three-dimensional space;
A robot control device for controlling the robot arm,
(A) The maximum value of the external force in the assembly direction in each operation is stored,
(B) The robot arm is controlled to execute each operation sequentially.
(C) A control method for an assembly robot, wherein the robot arm is stopped when the external force in the assembly direction detected by the force sensor reaches the maximum value in each operation during the execution of each operation. .
ワークを把持するハンドと、
ハンドに作用する外力を検出する力センサと、
３次元空間内でハンドの位置と姿勢を移動可能なロボットアームと、
各動作における組付け方向の外力の最大値を記憶し、ロボットアームを制御して各動作を順次実行するロボット制御装置とを備え、
各動作の実行中に、力センサで検出された組付け方向の外力が、各動作における最大値に達したときに、ロボットアームを停止する、ことを特徴とする組立ロボット。 An assembly robot that assembles a workpiece onto a target object in multiple actions,
A hand for gripping the workpiece;
A force sensor for detecting an external force acting on the hand;
A robot arm that can move the position and posture of the hand in a three-dimensional space;
A maximum value of the external force in the direction of assembly in each operation, and a robot controller that controls the robot arm and sequentially executes each operation;
An assembly robot characterized by stopping a robot arm when an external force in an assembly direction detected by a force sensor reaches a maximum value in each operation during execution of each operation.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2011183482A JP5892459B2 (en) | 2011-08-25 | 2011-08-25 | Assembly robot and its control method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2011183482A JP5892459B2 (en) | 2011-08-25 | 2011-08-25 | Assembly robot and its control method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2013043256A true JP2013043256A (en) | 2013-03-04 |
| JP5892459B2 JP5892459B2 (en) | 2016-03-23 |
Family
ID=48007570
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2011183482A Active JP5892459B2 (en) | 2011-08-25 | 2011-08-25 | Assembly robot and its control method |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5892459B2 (en) |
Cited By (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105415370A (en) * | 2014-09-16 | 2016-03-23 | 发那科株式会社 | Article Pickup Apparatus For Picking Up Randomly Piled Articles |
| CN106217373A (en) * | 2015-06-02 | 2016-12-14 | 精工爱普生株式会社 | Robot, robot controller, robot control method and robot system |
| KR20180084679A (en) * | 2017-01-17 | 2018-07-25 | 웨버 쉬라바우토마튼 게엠베하 | Method and apparatus for setting a screw |
| KR102257388B1 (en) * | 2020-11-02 | 2021-05-26 | 조용석 | Automatic insertion machine for return bend pipe of heat exchanger |
| CN112912214A (en) * | 2019-03-27 | 2021-06-04 | 黑崎播磨株式会社 | Opening and closing device |
| CN113165059A (en) * | 2019-03-04 | 2021-07-23 | 黑崎播磨株式会社 | Plate holding device, plate detaching device, plate attaching device, and plate attaching/detaching device |
| CN114833542A (en) * | 2022-05-18 | 2022-08-02 | 北京天玛智控科技股份有限公司 | Flexible assembly system and method based on mechanical sensor |
| EP3173193B1 (en) * | 2015-11-26 | 2024-04-24 | Seiko Epson Corporation | Robot, robot system and method of controlling a robot |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6389283A (en) * | 1986-09-30 | 1988-04-20 | 株式会社東芝 | Operation execution state monitor for robot |
| JPH05108108A (en) * | 1991-05-10 | 1993-04-30 | Nok Corp | Compliance control method and controller |
| JPH0724665A (en) * | 1993-07-05 | 1995-01-27 | Yamatake Honeywell Co Ltd | Automatic assembly device |
| JP2011011315A (en) * | 2009-07-06 | 2011-01-20 | Canon Inc | Component assembling method |
| JP2011152599A (en) * | 2010-01-26 | 2011-08-11 | Ihi Corp | Calibration method of robot and apparatus used for the same |
-
2011
- 2011-08-25 JP JP2011183482A patent/JP5892459B2/en active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6389283A (en) * | 1986-09-30 | 1988-04-20 | 株式会社東芝 | Operation execution state monitor for robot |
| JPH05108108A (en) * | 1991-05-10 | 1993-04-30 | Nok Corp | Compliance control method and controller |
| JPH0724665A (en) * | 1993-07-05 | 1995-01-27 | Yamatake Honeywell Co Ltd | Automatic assembly device |
| JP2011011315A (en) * | 2009-07-06 | 2011-01-20 | Canon Inc | Component assembling method |
| JP2011152599A (en) * | 2010-01-26 | 2011-08-11 | Ihi Corp | Calibration method of robot and apparatus used for the same |
Cited By (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105415370A (en) * | 2014-09-16 | 2016-03-23 | 发那科株式会社 | Article Pickup Apparatus For Picking Up Randomly Piled Articles |
| JP2016059983A (en) * | 2014-09-16 | 2016-04-25 | ファナック株式会社 | Article take-out device for taking out article in bulk |
| US9694499B2 (en) | 2014-09-16 | 2017-07-04 | Fanuc Corporation | Article pickup apparatus for picking up randomly piled articles |
| CN106217373A (en) * | 2015-06-02 | 2016-12-14 | 精工爱普生株式会社 | Robot, robot controller, robot control method and robot system |
| JP2016221642A (en) * | 2015-06-02 | 2016-12-28 | セイコーエプソン株式会社 | Robot, robot control device, robot control method and robot system |
| EP3173193B1 (en) * | 2015-11-26 | 2024-04-24 | Seiko Epson Corporation | Robot, robot system and method of controlling a robot |
| KR20180084679A (en) * | 2017-01-17 | 2018-07-25 | 웨버 쉬라바우토마튼 게엠베하 | Method and apparatus for setting a screw |
| KR102259761B1 (en) | 2017-01-17 | 2021-06-02 | 웨버 쉬라바우토마튼 게엠베하 | Method and apparatus for setting a screw |
| EP3936253A4 (en) * | 2019-03-04 | 2022-11-16 | Krosakiharima Corporation | Plate holding device, plate removing device, plate mounting device, and plate attaching/detaching device |
| CN113165059A (en) * | 2019-03-04 | 2021-07-23 | 黑崎播磨株式会社 | Plate holding device, plate detaching device, plate attaching device, and plate attaching/detaching device |
| US20220097129A1 (en) * | 2019-03-04 | 2022-03-31 | Krosakiharima Corporation | Plate holding device, plate detaching apparatus, plate attaching apparatus, and plate attaching-detaching apparatus |
| US11958106B2 (en) * | 2019-03-04 | 2024-04-16 | Krosakiharima Corporation | Plate holding device, plate detaching apparatus, plate attaching apparatus, and plate attaching-detaching apparatus |
| CN112912214A (en) * | 2019-03-27 | 2021-06-04 | 黑崎播磨株式会社 | Opening and closing device |
| EP3950238A4 (en) * | 2019-03-27 | 2022-12-21 | Krosakiharima Corporation | Device for opening/closing |
| KR102257388B1 (en) * | 2020-11-02 | 2021-05-26 | 조용석 | Automatic insertion machine for return bend pipe of heat exchanger |
| CN114833542A (en) * | 2022-05-18 | 2022-08-02 | 北京天玛智控科技股份有限公司 | Flexible assembly system and method based on mechanical sensor |
| CN114833542B (en) * | 2022-05-18 | 2023-07-18 | 北京天玛智控科技股份有限公司 | Flexible assembly system and method based on mechanical sensor |
Also Published As
| Publication number | Publication date |
|---|---|
| JP5892459B2 (en) | 2016-03-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5892459B2 (en) | Assembly robot and its control method | |
| JP5791387B2 (en) | Automatic assembly apparatus and component assembly method using automatic assembly apparatus | |
| CN104625676A (en) | Shaft hole assembly industrial robot system and working method thereof | |
| JP2017102825A (en) | Composite system equipped with machine tool and robot | |
| US9815196B2 (en) | Apparatus and method for recording positions | |
| JP5365989B2 (en) | Conveying robot provided with workpiece setting device, setting method and lifting method | |
| CN111571642A (en) | Coordinate robot to robot part assembly | |
| JP2019202406A (en) | Robot hand, robot hand control method, robot device, program and recording medium | |
| US11376739B2 (en) | Workpiece transport robot | |
| JP5218540B2 (en) | Assembly robot and its control method | |
| JP5024689B2 (en) | Assembly robot and its control method | |
| JP2010058235A (en) | Teaching method and teaching tool for robot system | |
| CN110871449B (en) | Mechanical arm | |
| JP2010253624A (en) | Apparatus and method of installing workpiece | |
| KR20120063841A (en) | Apparatus for auto position fixing positioner using sensor | |
| JP2015142952A (en) | Teaching method for component inserting operation of robot, and operation method of robot using the same | |
| JP2020175492A (en) | Processing device and processing method | |
| JP2011224708A (en) | Machining system and machining method | |
| JP5347705B2 (en) | Robot controller | |
| JP2015221490A (en) | Control method of robot device and robot device | |
| EP4397453A1 (en) | A tool engagement coupling and associated method | |
| JP2015100884A (en) | Robot hand | |
| JP2020059069A (en) | Loader control device and loader control method | |
| CN110961661B (en) | Mechanical arm | |
| JP2015096290A (en) | Robot, robot system, robot control device and method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20140626 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20150320 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20150325 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20150520 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20151026 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20151222 |
|
| 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: 20160201 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 5892459 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20160214 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |