JP5218540B2 - Assembly robot and its control method - Google Patents
Assembly robot and its control method Download PDFInfo
- Publication number
- JP5218540B2 JP5218540B2 JP2010277250A JP2010277250A JP5218540B2 JP 5218540 B2 JP5218540 B2 JP 5218540B2 JP 2010277250 A JP2010277250 A JP 2010277250A JP 2010277250 A JP2010277250 A JP 2010277250A JP 5218540 B2 JP5218540 B2 JP 5218540B2
- Authority
- JP
- Japan
- Prior art keywords
- condition
- success
- robot
- workpiece
- conditions
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Landscapes
- Manipulator (AREA)
Description
本発明は、単一のワークを複数の動作で対象物に組み付ける組立ロボットとその制御方法に関する。 The present invention relates to an assembly robot for assembling a single workpiece to an object by a plurality of operations and a control method therefor.
ロボットの手先に取り付けた力覚センサ、あるいはロボット関節のトルクから作業にかかる力やモーメントを計測し、これに応じて手先の位置や速度を変化させるのが「力制御」である。
力制御は、例えば精密部品の嵌め合い作業などに用いられる。力制御における調整パラメータは、仮想ばね、仮想ダンパ、仮想マスなどである。
“Force control” is a technique that measures 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 changes the position and speed of the hand according to this.
Force control is used, for example, for fitting work of precision parts. Adjustment parameters in force control are a virtual spring, a virtual damper, a virtual mass, and the like.
ロボットによりワークを対象物に組み付ける際に力制御を用いることは、例えば、特許文献１〜６に開示されている。 For example, Patent Documents 1 to 6 disclose that force control is used when a workpiece is assembled to an object by a robot.
特許文献１は、ロボットが対象物に接触する直前に位置制御モードから力制御モードに切り替え、接触前の位置制御と接触後の力制御を滑らかに接続するものである。
特許文献２は、挿入位置がある閾値を超える前に挿入方向に力がかかったら異常と判断し、閾値を超えて力がかかったら押し当てが正常終了と判断するものである。
特許文献３は、バルブを回す一連の動作を、分割した作業ごと（接近・接触、挿入穴探索、押し付け、など）に選択したパラメータで力制御を行なうものである。
Patent Document 1 switches from a position control mode to a force control mode immediately before a robot contacts an object, and smoothly connects position control before contact and force control after contact.
In Patent Document 2, it is determined that an abnormality occurs if a force is applied in the insertion direction before the insertion position exceeds a certain threshold value, and the pressing is determined to be normally completed if a force is applied exceeding the threshold value.
In Patent Document 3, force control is performed with a parameter selected for each divided operation (approach / contact, insertion hole search, pressing, etc.) in a series of operations for rotating a valve.
特許文献４は、複数の工程で使われる物品の対応を記憶し、各行程において物品と関連付けて自動処理を実行するものである。
特許文献５は、内力管理制御により、強度が弱い部材であっても把持力を最適化して破損や変形を防ぎ、他の部材に組付けするものである。
特許文献６は、ワークをそのワーク座標の原点が目標粗位置まで移動するように各アクチュエータを位置制御した後、作業座標系をもとに組み付け位置にワークをローリング、ピッチング、ヨーイング方向に位置・力制御しながらワークを組み立てるものである。
Patent Document 4 stores correspondence of articles used in a plurality of processes, and executes automatic processing in association with articles in each process.
Patent Document 5 optimizes the gripping force to prevent breakage and deformation even when a member is weak in strength by internal force management control, and is assembled to another member.
In Patent Document 6, after controlling the position of each actuator so that the origin of the workpiece coordinate moves to the target coarse position, the workpiece is positioned in the rolling, pitching and yawing directions based on the work coordinate system. The work is assembled while controlling the force.
ロボットにより、あるワークを、嵌め合いを含む複数の工程で対象物に組み付ける場合、本質的には、ワークと対象物との接触前後だけでなく、嵌め合い工程などの接触中であってもその状況に応じてロボットの動作が切り替わる必要がある。
また、動作切り替えの条件も多種多様考えられる。
さらに、一般的に力制御中のロボットの動作は遅く低速であるが、嵌め合いが失敗している場合に力制御を継続するとワークや対象物に損傷を与えるおそれがある。従って、嵌め合い工程などの成功又は失敗の判定はできるだけ早い段階で行なうことが望ましい。
これらのことを考慮すると、特許文献１〜６には以下のよう問題点があった。
When a workpiece is assembled to an object by multiple processes including fitting, it is essentially not only before and after contact between the workpiece and the object but also during the fitting process. The robot operation needs to be switched according to the situation.
Various conditions for switching operations are also conceivable.
Furthermore, although the operation of the robot during force control is generally slow and slow, if the force control is continued when the fitting has failed, there is a risk of damaging the workpiece or the object. Therefore, it is desirable to determine success or failure of the fitting process etc. as early as possible.
Considering these matters, Patent Documents 1 to 6 have the following problems.
特許文献１は、接触前後の制御方式を限定した上で、これらを滑らかに接続する方法について言及しているのみである。接触後のはめあい中の切り替えについては触れられていない。
特許文献２では、挿入方向の力が設定値を超え、力制御が完了した時点でのみ成否判定が行なわれることになるので、挿入途中で作用力が変わるような形状の部品の場合には対応が困難である。
Patent Document 1 only refers to a method of connecting them smoothly after limiting the control method before and after contact. There is no mention of switching during fitting after contact.
In Patent Document 2, the success / failure determination is performed only when the force in the insertion direction exceeds the set value and the force control is completed. Is difficult.
また、成功可否の判断に用いる距離は、挿入方向（特許文献１、図１のＺ方向）だけを考慮すればよいが、特許文献１では判定に不要な挿入方向に垂直な方向（図１のＸ方向）の変位も含んだ距離が用いられている。微小な閾値で成否の判定を行ないたいとき、この横方向の変位が閾値に対してある程度の大きさを持つと閾値の設定がシビアとなり、誤判定を起こすこともある。 Further, the distance used for the determination of success / failure need only consider the insertion direction (Patent Document 1, Z direction in FIG. 1), but in Patent Document 1, the direction perpendicular to the insertion direction (FIG. 1) is unnecessary. The distance including the displacement in the X direction) is used. When it is desired to make a success / failure determination with a very small threshold value, if the lateral displacement has a certain magnitude with respect to the threshold value, the threshold value setting becomes severe and an erroneous determination may occur.
また、計測力が目標値を超えたときの成否判定の閾値が位置だけでは不十分である。たとえば、はめあい部品の精度などの影響ではめあい途中に力の設定値を超えてしまうと失敗と判定されてしまう。また、大きな力がかかってかじるまで挿入失敗と判定できないため、その後の自動継続は困難で運転停止の原因となる。 Further, it is not sufficient that the threshold value for success / failure determination when the measurement force exceeds the target value is only the position. For example, if the set value of force is exceeded during fitting due to the influence of the accuracy of the fitting parts, it is determined as a failure. In addition, since it cannot be determined that the insertion has failed until a large force is applied, subsequent automatic continuation is difficult and causes a shutdown.
特許文献３は、バルブ操作に限定した手法である。技術的にも、作業に適した力制御のパラメータを切り替えるのみで、異常時については一切言及されていない。
また、従来手法を繰り返すだけでは、力制御開始時の初期化動作によって力覚センサが計測していた値がリセットされるので、力を継続的かつ連続的に計測できない（通常は、力制御開始時の力の計測値を初期値＝０とし、重力や外力の影響をオフセットとみなすため）。
Patent Document 3 is a technique limited to valve operation. Technically, only the force control parameters suitable for the work are switched, and no mention is made of any abnormality.
In addition, simply repeating the conventional method resets the value measured by the force sensor by the initialization operation at the start of force control, so the force cannot be continuously and continuously measured (usually, force control starts (To measure the force of the hour as the initial value = 0 and to consider the influence of gravity and external force as an offset).
特許文献４は、複数の物品を順次組み付ける複数の工程を対象としており、単一のワークを複数の動作で対象物に組み付ける際の、各動作における条件の変化を考慮していない。 Patent Document 4 is intended for a plurality of steps for sequentially assembling a plurality of articles, and does not consider changes in conditions in each operation when a single workpiece is assembled to an object by a plurality of operations.
特許文献５、特許文献６も同様に、単一のワークを複数の動作で対象物に組み付ける際の、各動作における条件の変化を考慮していない。 Similarly, Patent Document 5 and Patent Document 6 do not consider changes in conditions in each operation when a single workpiece is assembled to an object by a plurality of operations.
本発明は、上述した問題点を解決するために創案されたものである。すなわち、本発明の目的は、単一のワークを複数の動作で対象物に組み付ける際に、各動作における条件の変化を考慮して、各動作においてその成功又は失敗を逐次判定することができる組立ロボットとその制御方法を提供することにある。 The present invention has been developed to solve the above-described problems. That is, an object of the present invention is to assemble an assembly capable of sequentially determining success or failure in each operation in consideration of a change in conditions in each operation when a single workpiece is assembled to an object by a plurality of operations. It is to provide a robot and its control method.
本発明によれば、単一のワークを複数の動作で対象物に組み付ける組立ロボットであって、
外力を計測する力センサを有しワークを把持するロボットハンドと、
該ロボットハンドを３次元空間内で位置と姿勢を移動可能なロボットアームと、
前記各動作におけるワークの動作条件を記憶し前記ロボットアームを制御するロボット制御装置とを備え、
該ロボット制御装置により、前記各動作において、ワークの位置と計測された外力を前記動作条件と照合し、
前記動作条件は、前提条件、成功条件及び失敗条件からなり、
前提条件は、直前の動作の成功条件以外の条件を含んでおり、
失敗条件は、成功条件が成立しない以外の条件を含んでおり、
前提条件が成立し、失敗条件が成立するとき、失敗と判断し、
前提条件が成立し、成功条件が成立するとき、成功と判断し、
前提条件が成立しないとき、前記各動作を継続し、
前提条件が成立し、失敗条件及び成功条件が成立しないとき、前記各動作を継続する、ことを特徴とする組立ロボットが提供される。
According to the present invention, an assembly robot for assembling a single workpiece to an object by a plurality of operations,
A robot hand having a force sensor for measuring an external force and holding a workpiece;
A robot arm capable of moving the position and posture of the robot hand in a three-dimensional space;
A robot control device for storing the operation conditions of the workpiece in each operation and controlling the robot arm;
By the robot controller, in each operation, the position of the workpiece and the measured external force are collated with the operation condition,
The operation condition includes a precondition, a success condition, and a failure condition.
Preconditions include conditions other than the success condition of the previous operation,
Failure conditions include conditions other than success conditions are not met,
When the precondition is met and the failure condition is met,
When the preconditions are met and the success conditions are met,
When the precondition is not satisfied, the above operations are continued ,
There is provided an assembly robot characterized in that when the precondition is satisfied and the failure condition and the success condition are not satisfied, the respective operations are continued .
また本発明によれば、単一のワークを複数の動作で対象物に組み付ける組立ロボットの制御方法であって、
外力を計測する力センサを有しワークを把持するロボットハンドと、
該ロボットハンドを３次元空間内で位置と姿勢を移動可能なロボットアームと、を備え、
（Ａ）前記各動作におけるワークの動作条件を記憶し、
（Ｂ）前記ロボットアームを制御して前記各動作を順次実行し、
（Ｃ）前記各動作において、ワークの位置と計測された外力を前記動作条件と照合し、
前記動作条件は、前提条件、成功条件及び失敗条件からなり、
前提条件は、直前の動作の成功条件以外の条件を含んでおり、
失敗条件は、成功条件が成立しない以外の条件を含んでおり、
前提条件が成立し、失敗条件が成立するとき、失敗と判断し、
前提条件が成立し、成功条件が成立するとき、成功と判断し、
前提条件が成立しないとき、前記各動作を継続し、
前提条件が成立し、失敗条件及び成功条件が成立しないとき、前記各動作を継続する、ことを特徴とする組立ロボットの制御方法が提供される。
Further, according to the present invention, there is provided a control method for an assembly robot for assembling a single workpiece to an object by a plurality of operations,
A robot hand having a force sensor for measuring an external force and holding a workpiece;
A robot arm capable of moving the position and posture of the robot hand in a three-dimensional space;
(A) memorize | store the operation | movement condition of the workpiece | work in each said operation | movement,
(B) The robot arm is controlled to sequentially execute the operations.
(C) In each operation, the position of the workpiece and the measured external force are collated with the operation condition,
The operation condition includes a precondition, a success condition, and a failure condition.
Preconditions include conditions other than the success condition of the previous operation,
Failure conditions include conditions other than success conditions are not met,
When the precondition is met and the failure condition is met,
When the preconditions are met and the success conditions are met,
When the precondition is not satisfied, the above operations are continued ,
There is provided a control method for an assembly robot, characterized in that when the precondition is satisfied and the failure condition and the success condition are not satisfied, the respective operations are continued .
上記本発明の装置及び方法によれば、各動作におけるワークの動作条件を記憶し、各動作において、ワークの位置と計測された外力を動作条件と照合し、前記各動作の成功又は失敗を判断するので、単一のワークを複数の動作で対象物に組み付ける際に、各動作における条件の変化を考慮して、各動作においてその成功又は失敗を逐次判定することができる。 According to the apparatus and method of the present invention, the operation condition of the workpiece in each operation is stored, and in each operation, the position of the workpiece and the measured external force are collated with the operation condition to determine success or failure of each operation. Therefore, when assembling a single workpiece to an object with a plurality of operations, it is possible to sequentially determine success or failure in each operation in consideration of changes in conditions in each operation.
従って、力制御の最中に、状況に応じて適切な成否判定が行なえる。また，動作途中でも失敗判定が行なえるので、一連の動作における早い段階での失敗検出とその後の対応動作（再試行動作、システム停止など）が可能となる。
Therefore, an appropriate success / failure determination can be made according to the situation during the force control. In addition, failure determination can be performed even during operation, so that failure detection at an early stage in a series of operations and subsequent response operations (retry operation, system stop, etc.) are possible.
以下、本発明の好ましい実施形態を添付図面に基づいて詳細に説明する。なお、各図において共通する部分には同一の符号を付し、重複した説明を省略する。 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 embodiment diagram of an assembly robot according to the present invention.
In this figure, an assembly robot 10 is an automatic device for assembling a single workpiece 1 to an object 2 by a plurality of operations, and includes a robot hand 12, a robot arm 16, and a robot control device 20.
ワーク１は、後述する第１実施形態では、円筒形部材であり、その上端をロボットハンド１２が把持するようになっている。 In the first embodiment to be described later, the work 1 is a cylindrical member, and the robot hand 12 grips the upper end thereof.
ロボットハンド１２は、外力を計測する力センサ１４を有し、ワーク１を把持する。 The robot hand 12 has a force sensor 14 that measures an external force, and grips the workpiece 1.
力センサ１４は、ワーク１に作用する外力を検出するセンサである。
この例において、力センサ１４は直交３軸方向の力（Ｆｘ，Ｆｙ，Ｆｚ）と各軸まわりのトルク（Ｔｘ，Ｔｙ，Ｔｚ）を計測可能な６軸センサであり、３次元的に移動可能なロボットアーム１６に取り付けられ、これに作用する６自由度の外力（３方向の力Ｆｘ，Ｆｙ，Ｆｚと、３軸まわりのトルクＴｘ，Ｔｙ，Ｔｚ）を検出するようになっている。
なお、本発明はこれに限定されず、ワーク１に作用する外力が検出できる限りで、その他の力センサであってもよい。
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 robot hand 12 is attached to the hand, and the position and posture of the robot arm 16 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.
ロボット制御装置２０は、記憶装置２１に各動作におけるワーク１の動作条件を記憶し、ロボットアーム１６を制御する。
ロボット制御装置２０は、例えば数値制御装置であり、指令信号によりロボットアーム１６を６自由度（３次元位置と３軸まわりの回転）に制御するようになっている。
The robot control device 20 stores the operation conditions of the workpiece 1 in each operation in the storage device 21 and controls the robot arm 16.
The robot control device 20 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.
記憶装置２１に記憶された各動作におけるワーク１の動作条件は、前提条件、成功条件及び失敗条件からなる。
また、記憶装置２１は、各動作にそれぞれ対応する動作条件と制御方法を記憶する。
制御方法は、位置制御、速度制御、又は力制御であり、力制御は、インピーダンス制御又はダンピング制御であるが、本発明はこれに限定されず、その他の力制御方法であってもよい。
The operation condition of the work 1 in each operation stored in the storage device 21 includes a precondition, a success condition, and a failure condition.
The storage device 21 stores operation conditions and control methods corresponding to the respective operations.
The control method is position control, speed control, or force control, and the force control is impedance control or damping control, but the present invention is not limited to this, and other force control methods may be used.
記憶装置２１は、さらに各動作における軌道データテーブルを記憶する。軌道データテーブルは、ロボットハンド１２のＴＣＰの目標位置（Ｘ，Ｙ，Ｚ）と、押付け方向ベクトルからなる。 The storage device 21 further stores a trajectory data table for each operation. The trajectory data table includes TCP target positions (X, Y, Z) of the robot hand 12 and pressing direction vectors.
図２は、本発明による組み付け動作の実施形態図である。
この図において、ワーク１は円筒形部材である。また、対象物２はワーク１が嵌合する円筒形孔２ａを有し、作業台４（図１参照）に移動しないように固定されている。
円筒形孔２ａの内径は、ワーク１の直径よりわずかに大きく、ワーク１の下端が円筒形孔２ａの底面に達するまで、同心を維持したまま挿入できるようになっている。
円筒形孔２ａの内径とワーク１の直径の差は、例えば、０．０１ｍｍである。
FIG. 2 is a diagram showing an embodiment of the assembling operation according to the present invention.
In this figure, the work 1 is a cylindrical member. The object 2 has a cylindrical hole 2a into which the workpiece 1 is fitted, and is fixed so as not to move to the work table 4 (see FIG. 1).
The inner diameter of the cylindrical hole 2a is slightly larger than the diameter of the workpiece 1, and can be inserted while maintaining concentricity until the lower end of the workpiece 1 reaches the bottom surface of the cylindrical hole 2a.
The difference between the inner diameter of the cylindrical hole 2a and the diameter of the workpiece 1 is, for example, 0.01 mm.
この組み付け動作例は、単一のワーク１を３つの動作（１）〜（３）で対象物２の円筒形孔２ａに組み付けるものである。
動作（１）は、図で（Ａ）から（Ｂ）までであり、ワーク１の下端を円筒形孔２ａの上部に挿入するはめあいまでの近接動作である。
動作（２）は、図で（Ｂ）から（Ｃ）までであり、はめあい開始直後の動作である。この動作では、位置と姿勢のずれを修正する必要がある。
動作（３）は、図で（Ｃ）から（Ｄ）までであり、はめあい・挿入動作である。この動作（３）では、位置のずれを修正しつつワーク１を挿入する必要がある。
In this assembly operation example, a single workpiece 1 is assembled into the cylindrical hole 2a of the object 2 by three operations (1) to (3).
The operation (1) is from (A) to (B) in the figure, and is a proximity operation up to the fitting in which the lower end of the work 1 is inserted 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 from (C) to (D) in the figure and is a fitting / inserting operation. In this operation (3), it is necessary to insert the workpiece 1 while correcting the positional deviation.
表１は、上記動作（１）〜（３）におけるワークの動作条件と失敗時又は成功時の動作を示すものである。
この表において、条件コード［１］〜［３］は、動作（１）〜（３）にそれぞれ対応し、条件コード［４］は、動作（１）〜（３）のすべてに対応する。
Table 1 shows the operation conditions of the workpiece and the operation at the time of failure or success in the above operations (1) to (3).
In this table, condition codes [1] to [3] correspond to operations (1) to (3), respectively, and condition code [4] corresponds to all of operations (1) to (3).
表１において、動作条件は、条件コード［１］〜［３］に対してそれぞれ前提条件、成功条件及び失敗条件からなる。なお、条件コード［４］に対しては、失敗条件のみである。 In Table 1, the operation conditions include preconditions, success conditions, and failure conditions for the condition codes [1] to [3], respectively. For condition code [4], there are only failure conditions.
表２は、上述した動作（１）〜（３）におけるワークの動作条件、失敗時又は成功時の動作、及び動作パラメータを示すものである。
この表において、条件コード［１］〜［３］は、動作（１）〜（３）にそれぞれ対応し、条件コード［４］は、動作（１）〜（３）のすべてに対応する。
Table 2 shows the operation conditions of the workpiece, the operation at the time of failure or success, and the operation parameters in the above operations (1) to (3).
In this table, condition codes [1] to [3] correspond to operations (1) to (3), respectively, and condition code [4] corresponds to all of operations (1) to (3).
表２において、動作条件は、条件コード［１］〜［３］に対してそれぞれ前提条件、成功条件及び失敗条件からなる。なお、条件コード［４］に対しては、前提条件と失敗条件のみである。
またこの表において、動作パラメータとは、ワークの移動方向、移動速度、目標力、又は粘性係数を含む制御方法である。
制御方法は、位置制御、速度制御、又は力制御である。また、力制御は、インピーダンス制御又はダンピング制御である。
In Table 2, the operation condition includes a precondition, a success condition, and a failure condition for the condition codes [1] to [3], respectively. For condition code [4], there are only preconditions and failure conditions.
In this table, the operation parameter is a control method including the moving direction, moving speed, target force, or viscosity coefficient of the workpiece.
The control method is position control, speed control, or force control. The force control is impedance control or damping control.
なお、表１と表２は動作パラメータの有無で相違するが、その他の項目は実質的に同一である。また各表における位置、速度、力の数値は例示であり、これらに限定されない。 Tables 1 and 2 differ depending on the presence or absence of operating parameters, but the other items are substantially the same. The numerical values of the position, speed, and force in each table are examples, and are not limited to these.
図３は、本発明による制御方法のフローチャートである。
本発明による制御方法は、上述した組立ロボット１０を用い、以下の（Ａ）〜（Ｃ）を実行する。
FIG. 3 is a flowchart of the control method according to the present invention.
The control method according to the present invention uses the assembly robot 10 described above and executes the following (A) to (C).
（Ａ）上述した各動作（１）〜（３）におけるワーク１の動作条件、失敗時又は成功時の動作、及び動作パラメータを記憶装置２１に記憶する。
（Ｂ）ロボット制御装置２０により、ロボットアーム１６を制御して各動作（１）〜（３）を順次実行する。各動作（１）〜（３）において、条件コード［１］〜［３］に対応して動作パラメータを切り替える。
（Ｃ）各動作（１）〜（３）において、ワーク１の位置と力センサ１４で計測された外力を記憶した動作条件と照合し、各動作（１）〜（３）の成功又は失敗を判断する。
(A) The operation conditions of the work 1, the operation at the time of failure or success, and the operation parameters in each of the operations (1) to (3) described above are stored in the storage device 21.
(B) The robot control device 20 controls the robot arm 16 to sequentially execute the operations (1) to (3). In each of the operations (1) to (3), the operation parameters are switched corresponding to the condition codes [1] to [3].
(C) In each operation (1) to (3), the position of the workpiece 1 and the external force measured by the force sensor 14 are collated with the operation conditions stored, and the success or failure of each operation (1) to (3) is confirmed. to decide.
すなわち、図３において力制御を開始し（Ｓ１）、表１又は表２の判定条件を記憶装置２１から読み込み（Ｓ２）、リアルタイム制御ループ（Ｓ３〜Ｓ１１）を開始する。 That is, in FIG. 3, force control is started (S1), the determination conditions in Table 1 or Table 2 are read from the storage device 21 (S2), and a real-time control loop (S3 to S11) is started.
リアルタイム制御ループ（Ｓ３〜Ｓ１１）において力制御を実施し（Ｓ４）、前提条件［１］の成立を判断し（Ｓ５）、不成立（Ｎｏ）の場合に、順次次の前提条件の成立を判断する。ここで前提条件［ｋ］（ｋ＝１，２、・・・）は条件コード［１］〜［ｋ］に対応する。 In the real-time control loop (S3 to S11), force control is performed (S4), the satisfaction of the precondition [1] is determined (S5), and if the precondition is not satisfied (No), the subsequent precondition is sequentially determined. . Here, the precondition [k] (k = 1, 2,...) Corresponds to the condition codes [1] to [k].
各前提条件［ｋ］（ｋ＝１，２、・・・）が成立（Ｙｅｓ）の場合に、失敗条件［ｋ］の成立を判断し（Ｓ６、Ｓ９）、成立（Ｙｅｓ）の場合に、失敗時動作を実施し（Ｓ１２）、異常終了コードを出力し（Ｓ１３）、力制御を終了する（Ｓ１４）。ここで失敗条件［ｋ］（ｋ＝１，２、・・・）は条件コード［１］〜［ｋ］に対応する。 When each precondition [k] (k = 1, 2,...) Is satisfied (Yes), it is determined whether the failure condition [k] is satisfied (S6, S9), and when it is satisfied (Yes), The operation at the time of failure is performed (S12), an abnormal end code is output (S13), and the force control is ended (S14). Here, the failure condition [k] (k = 1, 2,...) Corresponds to the condition codes [1] to [k].
各失敗条件［ｋ］（ｋ＝１，２、・・・）が不成立（Ｎｏ）の場合に、成功条件［ｋ］の成立を判断し（Ｓ７、Ｓ１０）、成立（Ｙｅｓ）の場合に、成功時動作を実施し（Ｓ１５）、終了でない（Ｓ１６でＮｏ）場合、動作を継続し、リアルタイム制御ループ（Ｓ３〜Ｓ１１）を再度実行する。
各成功条件［ｋ］（ｋ＝１，２、・・・）が不成立（Ｎｏ）の場合、動作を継続し、リアルタイム制御ループ（Ｓ３〜Ｓ１１）を再度実行する。ここで成功条件［ｋ］（ｋ＝１，２、・・・）は条件コード［１］〜［ｋ］に対応する。
When each failure condition [k] (k = 1, 2,...) Is not established (No), it is determined that the success condition [k] is established (S7, S10), and when it is established (Yes), If the operation is successful (S15) and not finished (No in S16), the operation is continued and the real-time control loop (S3 to S11) is executed again.
When each success condition [k] (k = 1, 2,...) Is not established (No), the operation is continued and the real-time control loop (S3 to S11) is executed again. Here, the success condition [k] (k = 1, 2,...) Corresponds to the condition codes [1] to [k].
Ｓ１６で終了（Ｙｅｓ）の場合、正常終了コードを出力し（Ｓ１７）、力制御を終了する（Ｓ１４）。 In the case of termination (Yes) in S16, a normal termination code is output (S17), and the force control is terminated (S14).
なお、失敗条件［ｋ］の成立の判断（Ｓ６、Ｓ９）と成功条件［ｋ］の成立の判断（Ｓ７、Ｓ１０）は、順序が逆であってもよい。 Note that the order of establishment of the failure condition [k] (S6, S9) and the judgment of establishment of the success condition [k] (S7, S10) may be reversed.
上述したように、本発明では、条件コード［１］〜［ｋ］において、
（Ｃ１）前提条件が成立し、失敗条件が成立するとき、失敗と判断し、
（Ｃ２）前提条件が成立し、成功条件が成立するとき、成功と判断し、
（Ｃ３）前提条件が成立しないとき、前記各動作を継続する。
As described above, in the present invention, in the condition codes [1] to [k],
(C1) When the precondition is satisfied and the failure condition is satisfied, it is determined as failure,
(C2) When the precondition is satisfied and the success condition is satisfied, it is determined to be successful,
(C3) When the precondition is not satisfied, the respective operations are continued.
また、各動作（１）〜（３）にそれぞれ対応する動作パラメータ［１］〜［ｋ］（ｋ＝１，２、・・・）を記憶し、各動作に対応する制御方法に順次切り替える。 Further, the operation parameters [1] to [k] (k = 1, 2,...) Respectively corresponding to the operations (1) to (3) are stored, and sequentially switched to the control method corresponding to each operation.
上述したように本発明では、各動作（１）〜（３）において、ワーク１の位置と計測された外力を動作条件と照合し、各動作の成功又は失敗を判断する。
すなわち、成功条件又は失敗条件が満足するか否かを組立などの各動作中に逐次（リアルタイムで）判断し、成功又は失敗の判定が行なわれた時点で成功又は失敗時の動作を行なう。
As described above, in the present invention, in each of the operations (1) to (3), the position of the workpiece 1 and the measured external force are collated with the operation conditions, and the success or failure of each operation is determined.
That is, whether or not the success condition or the failure condition is satisfied is sequentially determined (in real time) during each operation such as assembly, and the operation at the time of success or failure is performed when the determination of success or failure is made.
また上述したように、好ましくは成功・失敗の条件だけでなく、制御方法を含む動作パラメータも条件コードごとに複数準備し、切り替える。
従って、図３のフローチャートでは、成功時動作で動作パラメータの変更がなされることになる。
As described above, preferably, not only the success / failure conditions but also a plurality of operation parameters including the control method are prepared and switched for each condition code.
Therefore, in the flowchart of FIG. 3, the operation parameter is changed by the operation at the time of success.
上述したように本発明の装置及び方法によれば、各動作におけるワーク１の動作条件を記憶し、各動作において、ワーク１の位置と計測された外力を動作条件と照合し、各動作の成功又は失敗を判断するので、単一のワーク１を複数の動作で対象物に組み付ける際に、各動作における条件の変化を考慮して、各動作においてその成功又は失敗を逐次判定することができる。 As described above, according to the apparatus and method of the present invention, the operation conditions of the workpiece 1 in each operation are stored, and in each operation, the position of the workpiece 1 and the measured external force are collated with the operation conditions, and each operation succeeds. Alternatively, since the failure is determined, when assembling the single workpiece 1 to the object by a plurality of operations, it is possible to sequentially determine the success or failure in each operation in consideration of a change in conditions in each operation.
従って、力制御の最中に、状況に応じて適切な成否判定が行なえる。また，動作途中でも失敗判定が行なえるので、一連の動作における早い段階での失敗検出とその後の対応動作（再試行動作、システム停止など）が可能となる。 Therefore, an appropriate success / failure determination can be made according to the situation during the force control. In addition, failure determination can be performed even during operation, so that failure detection at an early stage in a series of operations and subsequent response operations (retry operation, system stop, etc.) are possible.
なお、本発明は上述した実施形態に限定されず、特許請求の範囲の記載によって示され、さらに特許請求の範囲の記載と均等の意味および範囲内でのすべての変更を含むものである。 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 cylindrical hole,
2 object, 2a cylindrical hole, 4 workbench,
10 assembly robots, 12 robot hands,
14 force sensor, 16 robot arm,
20 robot control devices, 21 storage devices
Claims (4)
外力を計測する力センサを有しワークを把持するロボットハンドと、
該ロボットハンドを３次元空間内で位置と姿勢を移動可能なロボットアームと、
前記各動作におけるワークの動作条件を記憶し前記ロボットアームを制御するロボット制御装置とを備え、
該ロボット制御装置により、前記各動作において、ワークの位置と計測された外力を前記動作条件と照合し、
前記動作条件は、前提条件、成功条件及び失敗条件からなり、
前提条件は、直前の動作の成功条件以外の条件を含んでおり、
失敗条件は、成功条件が成立しない以外の条件を含んでおり、
前提条件が成立し、失敗条件が成立するとき、失敗と判断し、
前提条件が成立し、成功条件が成立するとき、成功と判断し、
前提条件が成立しないとき、前記各動作を継続し、
前提条件が成立し、失敗条件及び成功条件が成立しないとき、前記各動作を継続する、ことを特徴とする組立ロボット。 An assembly robot that assembles a single workpiece onto an object with multiple actions,
A robot hand having a force sensor for measuring an external force and holding a workpiece;
A robot arm capable of moving the position and posture of the robot hand in a three-dimensional space;
A robot control device for storing the operation conditions of the workpiece in each operation and controlling the robot arm;
By the robot controller, in each operation, the position of the workpiece and the measured external force are collated with the operation condition,
The operation condition includes a precondition, a success condition, and a failure condition.
Preconditions include conditions other than the success condition of the previous operation,
Failure conditions include conditions other than success conditions are not met,
When the precondition is met and the failure condition is met,
When the preconditions are met and the success conditions are met,
When the precondition is not satisfied, the above operations are continued ,
An assembly robot characterized by continuing each operation when a precondition is satisfied and a failure condition and a success condition are not satisfied .
外力を計測する力センサを有しワークを把持するロボットハンドと、
該ロボットハンドを３次元空間内で位置と姿勢を移動可能なロボットアームと、を備え、
（Ａ）前記各動作におけるワークの動作条件を記憶し、
（Ｂ）前記ロボットアームを制御して前記各動作を順次実行し、
（Ｃ）前記各動作において、ワークの位置と計測された外力を前記動作条件と照合し、
前記動作条件は、前提条件、成功条件及び失敗条件からなり、
前提条件は、直前の動作の成功条件以外の条件を含んでおり、
失敗条件は、成功条件が成立しない以外の条件を含んでおり、
前提条件が成立し、失敗条件が成立するとき、失敗と判断し、
前提条件が成立し、成功条件が成立するとき、成功と判断し、
前提条件が成立しないとき、前記各動作を継続し、
前提条件が成立し、失敗条件及び成功条件が成立しないとき、前記各動作を継続する、ことを特徴とする組立ロボットの制御方法。 A method for controlling an assembly robot that assembles a single workpiece onto an object by a plurality of operations,
A robot hand having a force sensor for measuring an external force and holding a workpiece;
A robot arm capable of moving the position and posture of the robot hand in a three-dimensional space;
(A) memorize | store the operation | movement condition of the workpiece | work in each said operation | movement,
(B) The robot arm is controlled to sequentially execute the operations.
(C) In each operation, the position of the workpiece and the measured external force are collated with the operation condition,
The operation condition includes a precondition, a success condition, and a failure condition.
Preconditions include conditions other than the success condition of the previous operation,
Failure conditions include conditions other than success conditions are not met,
When the precondition is met and the failure condition is met,
When the preconditions are met and the success conditions are met,
When the precondition is not satisfied, the above operations are continued ,
An assembly robot control method, characterized in that when the precondition is satisfied and the failure condition and the success condition are not satisfied, the respective operations are continued .
各動作に対応する制御方法に順次切り替える、ことを特徴とする請求項２に記載の制御方法。 Storing a control method corresponding to each of the operations;
The control method according to claim 2, wherein the control method is sequentially switched to a control method corresponding to each operation.
前記力制御は、インピーダンス制御又はダンピング制御である、ことを特徴とする請求項３に記載の制御方法。
The control method is position control, speed control, or force control,
The control method according to claim 3, wherein the force control is impedance control or damping control.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2010277250A JP5218540B2 (en) | 2010-12-13 | 2010-12-13 | Assembly robot and its control method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2010277250A JP5218540B2 (en) | 2010-12-13 | 2010-12-13 | Assembly robot and its control method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2012125852A JP2012125852A (en) | 2012-07-05 |
| JP5218540B2 true JP5218540B2 (en) | 2013-06-26 |
Family
ID=46643501
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2010277250A Active JP5218540B2 (en) | 2010-12-13 | 2010-12-13 | Assembly robot and its control method |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5218540B2 (en) |
Families Citing this family (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2015157340A (en) * | 2014-02-25 | 2015-09-03 | セイコーエプソン株式会社 | Robot, control device, robot system, and control method |
| JP6840154B2 (en) * | 2016-08-29 | 2021-03-10 | 株式会社ソニー・インタラクティブエンタテインメント | Manufacturing method of assembly equipment and electronic equipment |
| JP7020812B2 (en) | 2017-07-19 | 2022-02-16 | キヤノン株式会社 | Robot device, control method of robot device, assembly method of articles using robot device, control program and recording medium |
| JP2021154392A (en) | 2018-05-22 | 2021-10-07 | ソニーグループ株式会社 | Robot control apparatus and robot control method |
| JP7000359B2 (en) * | 2019-01-16 | 2022-01-19 | ファナック株式会社 | Judgment device |
| WO2022087859A1 (en) * | 2020-10-28 | 2022-05-05 | Shanghai Flexiv Robotics Technology Co., Ltd. | Method for assembling an opreating member and an adapting member by a robot, robot, and controller |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH01310880A (en) * | 1988-06-06 | 1989-12-14 | Toshiba Corp | Controller for industrial robot |
| JP3147276B2 (en) * | 1994-10-14 | 2001-03-19 | キヤノン株式会社 | Component insertion device and component insertion method |
| JPH09136279A (en) * | 1995-11-15 | 1997-05-27 | Fanuc Ltd | Phase-adjusting fitting method using force control robot |
| JP3601279B2 (en) * | 1997-12-22 | 2004-12-15 | 松下電工株式会社 | Parts assembly equipment |
-
2010
- 2010-12-13 JP JP2010277250A patent/JP5218540B2/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| JP2012125852A (en) | 2012-07-05 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5218540B2 (en) | Assembly robot and its control method | |
| EP3656514B1 (en) | Work robot and method for controlling work robot | |
| JP5846479B2 (en) | Robot and its control method | |
| JP4202365B2 (en) | Force control device | |
| JP6351293B2 (en) | Robot system and article manufacturing method | |
| JP5505138B2 (en) | Robot apparatus and gripping method using robot apparatus | |
| US9227321B2 (en) | Method and device for controlling a manipulator | |
| JP5382359B2 (en) | Robot system | |
| CN104827473A (en) | Method for programming industrial robot and associated industrial robot | |
| JP2009255191A (en) | Robot manipulator | |
| JP2015000455A (en) | Robot device and control method for robot device | |
| JP2024015086A (en) | Robot system, control method, article manufacturing method, control program, and recording medium | |
| JP5024689B2 (en) | Assembly robot and its control method | |
| US11999049B2 (en) | Tactile feedback of an end effector of a robot manipulator over different orientation ranges | |
| US11141855B2 (en) | Robot system, method of controlling robot arm, recording medium, and method of manufacturing an article | |
| US11541541B2 (en) | Gripping system | |
| JP6988757B2 (en) | End effector and end effector device | |
| JP2018020430A (en) | Robot device, robot control method, article manufacturing method, program, and recording medium | |
| JPH06143171A (en) | Robot | |
| JP6516546B2 (en) | Control method of robot device, robot device, and method of manufacturing article | |
| JPS6149075B2 (en) | ||
| JP2019010700A (en) | Robot, robot system, and control method thereof | |
| US20240001547A1 (en) | Cooperative robot having improved arm structure and method for controlling same | |
| JP2019155523A (en) | Robot control device, robot control method, assembly method for article using robot control device, program, and recording medium | |
| WO2023218636A1 (en) | Robot control device and machining system |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20120613 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120810 |
|
| A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20121024 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20121228 |
|
| A911 | Transfer of reconsideration by examiner before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20130117 |
|
| 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: 20130205 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20130218 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20160315 Year of fee payment: 3 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 5218540 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20160315 Year of fee payment: 3 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |