JP2015221490A5 - Robot apparatus control method, robot apparatus, and article manufacturing method - Google Patents

Robot apparatus control method, robot apparatus, and article manufacturing method Download PDF

Info

Publication number
JP2015221490A5
JP2015221490A5 JP2015088702A JP2015088702A JP2015221490A5 JP 2015221490 A5 JP2015221490 A5 JP 2015221490A5 JP 2015088702 A JP2015088702 A JP 2015088702A JP 2015088702 A JP2015088702 A JP 2015088702A JP 2015221490 A5 JP2015221490 A5 JP 2015221490A5
Authority
JP
Japan
Prior art keywords
workpiece
teaching point
point
robot apparatus
amount
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
Application number
JP2015088702A
Other languages
Japanese (ja)
Other versions
JP6516546B2 (en
JP2015221490A (en
Filing date
Publication date
Application filed filed Critical
Priority to JP2015088702A priority Critical patent/JP6516546B2/en
Priority claimed from JP2015088702A external-priority patent/JP6516546B2/en
Publication of JP2015221490A publication Critical patent/JP2015221490A/en
Publication of JP2015221490A5 publication Critical patent/JP2015221490A5/en
Application granted granted Critical
Publication of JP6516546B2 publication Critical patent/JP6516546B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Description

本発明は、複数の関節を有する多関節アームと前記多関節アームに支持されるエンドエフェクタとを有するロボット本体と、前記エンドエフェクタに連結され、第1のワーク及び第2のワークの間に相対的に作用する力の変化量と前記第1のワーク及び前記第2のワークの相対位置姿勢の変位量との少なくとも一方を検出する検出部と、前記ロボット本体を制御する制御部と、を備えるロボット装置の制御方法において、前記制御部が、前記エンドエフェクタにより保持した前記第1のワークを、第1の教示点から、接触点を経て、第2の教示点までの軌道で移動させる移動工程と、前記制御部が、前記移動工程において前記第1のワークが前記接触点から前記第2の教示点までの前記軌道上に位置するときに、前記第1のワーク及び前記第2のワークの間に相対的に作用する力の変化量と、前記第1のワーク及び前記第2のワークの相対位置姿勢の変位量と、の少なくとも一方を前記検出部により検出する第1の検出工程と、前記制御部が、前記第1の検出工程で検出した前記力の変化量あるいは前記相対位置姿勢の変位量に基づき、前記軌道の補正量を演算する第1の演算工程と、前記制御部が、前記第1の演算工程で演算した前記補正量に基づき、前記第1の教示点と前記第2の教示点との各位置及び姿勢を補正する第1の補正工程と、を備えることを特徴とする。 The present invention relates to a robot main body having a multi-joint arm having a plurality of joints and an end effector supported by the multi-joint arm; A detecting unit that detects at least one of a change amount of a force acting on the first workpiece and a displacement amount of a relative position and posture of the first workpiece and the second workpiece, and a control unit that controls the robot body. a method of controlling a robot apparatus, the control section, the first workpiece held by the end effector, the first taught point, through the contact points, Before moving in orbit up to the second teaching point a moving step, the control section, when said at moving step a first workpiece is positioned on the track from the contact point to the second teaching point, the first workpiece and the second Of the variation of the force relative acting between the workpiece, prior to SL and the amount of displacement of the relative position and orientation of the first workpiece and the second workpiece, the first detecting at least one by the detection unit A detection step; and a first calculation step in which the control unit calculates a correction amount of the trajectory based on the change amount of the force detected in the first detection step or the displacement amount of the relative position and posture, A control unit including a first correction step of correcting each position and orientation of the first teaching point and the second teaching point based on the correction amount calculated in the first calculation step; It is characterized by that.

また、本発明は、複数の関節を有する多関節アームと前記多関節アームに支持されるエンドエフェクタとを有するロボット本体と、前記エンドエフェクタに連結され、第1のワーク及び第2のワークの間に相対的に作用する力の変化量と前記第1のワーク及び前記第2のワークの相対位置姿勢の変位量との少なくとも一方を検出する検出部と、前記ロボット本体を制御する制御部と、を備えるロボット装置において、前記制御部は、前記エンドエフェクタにより保持した前記第1のワークを、第1の教示点から、接触点を経て、第2の教示点まで所定の軌道で移動させ、前記第1のワークが前記接触点から前記第2の教示点までの前記軌道上に位置するときに、前記第1のワーク及び前記第2のワークの間に相対的に作用する力の変化量と、前記第1のワーク及び前記第2のワークの相対位置姿勢の変位量と、の少なくとも一方を前記検出部により検出し、検出した前記力の変化量あるいは前記相対位置姿勢の変位量に基づき、前記軌道の補正量を演算し、演算した前記補正量に基づき、前記第1の教示点と前記第2の教示点との各位置及び姿勢を補正することを特徴とする。 The present invention also provides a robot main body having a multi-joint arm having a plurality of joints and an end effector supported by the multi-joint arm, and connected to the end effector, between the first work and the second work. A detection unit that detects at least one of a change amount of a force acting relatively to the displacement amount of a relative position and posture of the first workpiece and the second workpiece, a control unit that controls the robot body, a robot apparatus comprising, said control unit, said first workpiece held by the end effector, the first taught point, through the contact point is moved in a predetermined orbit to the second teaching point, When the first workpiece is located on the trajectory from the contact point to the second teaching point, the amount of change in the force acting relatively between the first workpiece and the second workpiece and, Serial and displacement of the first work and the relative position and orientation of the second workpiece, the detected at least one by the detection unit, based on the displacement amount of the detected said force variation or the relative position and orientation, the A trajectory correction amount is calculated, and each position and orientation of the first teaching point and the second teaching point are corrected based on the calculated correction amount.

Claims (18)

複数の関節を有する多関節アームと前記多関節アームに支持されるエンドエフェクタとを有するロボット本体と、前記エンドエフェクタに連結され、第1のワーク及び第2のワークの間に相対的に作用する力の変化量と前記第1のワーク及び前記第2のワークの相対位置姿勢の変位量との少なくとも一方を検出する検出部と、前記ロボット本体を制御する制御部と、を備えるロボット装置の制御方法において、
前記制御部が、前記エンドエフェクタにより保持した前記第1のワークを、第1の教示点から、接触点を経て、第2の教示点までの軌道で移動させる移動工程と、
前記制御部が、前記移動工程において前記第1のワークが前記接触点から前記第2の教示点までの前記軌道上に位置するときに、前記第1のワーク及び前記第2のワークの間に相対的に作用する力の変化量と、前記第1のワーク及び前記第2のワークの相対位置姿勢の変位量と、の少なくとも一方を前記検出部により検出する第1の検出工程と、
前記制御部が、前記第1の検出工程で検出した前記力の変化量あるいは前記相対位置姿勢の変位量に基づき、前記軌道の補正量を演算する第1の演算工程と、
前記制御部が、前記第1の演算工程で演算した前記補正量に基づき、前記第1の教示点と前記第2の教示点との各位置及び姿勢を補正する第1の補正工程と、を備える、
ことを特徴とするロボット装置の制御方法。
A robot body having a multi-joint arm having a plurality of joints and an end effector supported by the multi-joint arm, and is connected to the end effector and acts relatively between the first work and the second work. Control of a robot apparatus comprising: a detection unit that detects at least one of a force change amount and a displacement amount of a relative position and orientation of the first workpiece and the second workpiece; and a control unit that controls the robot body. In the method
Wherein the control unit, the first workpiece held by the end effector, the first taught point, through the contact point, the moving step Before moving in orbit up to the second teaching point,
When the control unit is positioned on the trajectory from the contact point to the second teaching point in the moving step, the control unit is located between the first workpiece and the second workpiece. and variation of the force relative effect, a first detection step of the displacement amount before SL relative position and orientation of the first workpiece and the second workpiece, the at least one detected by the detecting unit,
A first calculation step in which the control unit calculates a correction amount of the trajectory based on a change amount of the force detected in the first detection step or a displacement amount of the relative position and posture;
A first correction step in which the control unit corrects each position and posture of the first teaching point and the second teaching point based on the correction amount calculated in the first calculation step; Prepare
A method for controlling a robot apparatus, comprising:
前記軌道は、前記第1のワーク及び前記第2のワークが接触状態にある場合と、非接触状態にある場合とで、一直線状である、
ことを特徴とする請求項1記載のロボット装置の制御方法。
Said track includes a case where the first workpiece and the second workpiece is in a state come in contact, in the case in a non-contact state, a straight line,
The method for controlling a robot apparatus according to claim 1.
前記軌道は、非接触状態にある前記第1のワークの位置姿勢である第1の教示点と、接触状態にある前記第1のワークの位置姿勢である第2の教示点と、に基づいて演算され、
前記第1の演算工程では、前記制御部が、前記第1の検出工程で検出した前記力の変化量あるいは前記相対位置姿勢の変位量に基づき、前記軌道の補正量として、前記第1の教示点及び前記第2の教示点の各位置姿勢の補正量を演算し、
前記第1の補正工程では、前記制御部が、前記第1の演算工程で演算した前記第1の教示点及び前記第2の教示点の各位置姿勢の補正量に基づき、前記第1の教示点及び前記第2の教示点の各位置及び姿勢を補正する、
ことを特徴とする請求項1又は2に記載のロボット装置の制御方法。
The trajectory is based on the first teaching point is the position and orientation of the first workpiece in a non-contact state, and the second teaching point is the position and orientation of the first workpiece in contact touch state, Calculated,
In the first calculation step, the controller teaches the first teaching as the correction amount of the trajectory based on the change amount of the force detected in the first detection step or the displacement amount of the relative position and posture. A correction amount for each position and orientation of the point and the second teaching point;
In the first correction step, the control unit controls the first teaching based on the correction amounts of the position and orientation of the first teaching point and the second teaching point calculated in the first calculation step. We correct the points and the position and orientation of the second teaching point,
The robot apparatus control method according to claim 1, wherein the robot apparatus has a control method.
前記軌道は、非接触状態にある前記第1のワークの位置姿勢である第1の教示点と、接触状態にある前記第1のワークの位置姿勢である第2の教示点と、前記接触状態にある前記第1のワークの位置姿勢であり、前記軌道で前記第1の教示点及び前記第2の教示点の間に位置する第3の教示点と、に基づいて演算され、
前記第1の演算工程では、前記制御部が、前記第1の検出工程で検出した前記力の変化量あるいは前記相対位置姿勢の変位量に基づき、前記軌道の補正量として、前記第1の教示点及び前記第2の教示点の各位置姿勢の補正量を演算し、
前記第1の補正工程では、前記制御部が、前記第1の演算工程で演算した前記第1の教示点及び前記第2の教示点の各位置姿勢の補正量に基づき、前記第1の教示点及び前記第2の教示点の各位置及び姿勢を補正する、
ことを特徴とする請求項1記載のロボット装置の制御方法。
It said track includes a first teaching point is the position and orientation of the first workpiece in a non-contact state, and the second teaching point is the position and orientation of the first workpiece in contact touch state, the contact the position and orientation of the first workpiece in the state, a third teaching point located between said first taught point and the second teaching point in the orbit, is calculated based on the,
In the first calculation step, the controller teaches the first teaching as the correction amount of the trajectory based on the change amount of the force detected in the first detection step or the displacement amount of the relative position and posture. A correction amount for each position and orientation of the point and the second teaching point;
In the first correction step, the control unit controls the first teaching based on the correction amounts of the position and orientation of the first teaching point and the second teaching point calculated in the first calculation step. We correct the points and the position and orientation of the second teaching point,
The method for controlling a robot apparatus according to claim 1.
前記第2の教示点における軌道と、前記第3の教示点における軌道とは、一直線状の軌道である、
ことを特徴とする請求項4記載のロボット装置の制御方法。
The trajectory at the second teaching point and the trajectory at the third teaching point are linear trajectories.
The method of controlling a robot apparatus according to claim 4.
前記第2の教示点における軌道と、前記第3の教示点における軌道とは、同方向の直線状の軌道であり、かつ、各軌道の間では前記第1のワーク及び前記第2のワークは非接触である、
ことを特徴とする請求項4記載のロボット装置の制御方法。
The trajectory at the second teaching point and the trajectory at the third teaching point are linear trajectories in the same direction, and the first workpiece and the second workpiece are between the trajectories. Non-contact,
The method of controlling a robot apparatus according to claim 4.
前記第2の教示点における軌道と、前記第3の教示点における軌道とは、相対的に傾斜した直線状の軌道である、
ことを特徴とする請求項4記載のロボット装置の制御方法。
The trajectory at the second teaching point and the trajectory at the third teaching point are relatively inclined linear trajectories,
The method of controlling a robot apparatus according to claim 4.
前記第3の教示点における軌道は直線状の軌道であり、前記第2の教示点における軌道は前記直線と同方向の軸を中心とする回転方向の軌道である、
ことを特徴とする請求項4記載のロボット装置の制御方法。
The trajectory at the third teaching point is a linear trajectory, and the trajectory at the second teaching point is a trajectory in a rotational direction centered on an axis in the same direction as the straight line.
The method of controlling a robot apparatus according to claim 4.
前記第1の検出工程では、前記変化量は、前記第1のワーク及び前記第2のワークの間に前記直線の方向に相対的に作用する力の変化量であるか、または前記変位量は、前記第1のワーク及び前記第2のワークの前記直線の方向の相対位置の変位量である、
ことを特徴とする請求項5乃至8のいずれか1項に記載のロボット装置の制御方法。
In the first detection step, the change amount is a change amount of a force acting relatively in the direction of the straight line between the first workpiece and the second workpiece, or the displacement amount is , The displacement amount of the relative position of the first workpiece and the second workpiece in the direction of the straight line,
The robot apparatus control method according to claim 5, wherein the robot apparatus has a control method.
前記第1の検出工程では、前記制御部が、前記移動工程において前記第1のワークが前記接触点から前記第2の教示点までの前記軌道上に位置するときに、前記第1のワーク及び前記第2のワークの間に相対的に作用する力の変化量と、前記第1のワーク及び前記第2のワークの相対位置の変位量と、の少なくとも一方を前記検出部により検出し、
前記第1の演算工程では、前記制御部が、前記第1の検出工程で検出した前記力の変化量あるいは前記相対位置の変位量に基づき、前記軌道の補正量として、前記第1の教示点及び前記第2の教示点の各位置の補正量を演算し、
前記第1の補正工程では、前記制御部が、前記第1の演算工程で演算した前記補正量に基づき、前記第1の教示点及び前記第2の教示点の各位置を補正し
前記制御部が、前記第1の補正工程での補正後に、前記移動工程において前記第1のワークが前記接触点から前記第2の教示点までの前記軌道上に位置するときに、前記第1のワーク及び前記第2のワークの間に相対的に作用する力の変化量と、前記第1のワーク及び前記第2のワークの相対姿勢の変位量と、の少なくとも一方を前記検出部により検出する第2の検出工程と、
前記制御部が、前記第2の検出工程で検出した前記力の変化量あるいは前記相対姿勢の変位量に基づき、前記軌道の補正量として、前記第1の教示点及び前記第2の教示点の各姿勢の補正量を演算する第2の演算工程と、
前記制御部が、前記第2の演算工程で演算した前記補正量に基づき、前記第1の教示点及び前記第2の教示点の各姿勢を補正する第2の補正工程と、を備える、
ことを特徴とする請求項3乃至9のいずれか1項に記載のロボット装置の制御方法。
In the first detection step, when the control unit is positioned on the trajectory from the contact point to the second teaching point in the movement step, the control unit and the first workpiece and and variation of the force relative acting between said second workpiece, detects a front Symbol displacement of the relative position of the first workpiece and the second workpiece, the at least one by the detection unit,
In the first operation step, the control section, based on the displacement amount of the first detection amount of change in the force detected by the step or the relative position location, as the correction amount of the track, the first teaching A correction amount for each position of the point and the second teaching point is calculated,
In the first correction process, the control section, based on the correction amount calculated by said first calculating step, correct for each position of the first taught point and the second teaching point,
When the first work is positioned on the trajectory from the contact point to the second teaching point in the moving step after the correction in the first correction step, the control unit performs the first step . of the work and force variation which relatively acts between the second workpiece, the pre-Symbol the detecting unit and the displacement amount of at least one of the relative orientation of the first workpiece and the second workpiece A second detection step to detect;
Wherein the control unit is based on the displacement amount of the second variation of the force detected by the detection process or the phase Taisugata bias, as the correction amount of the track, said first taught point and said second teaching A second calculation step of calculating a correction amount of each posture of the point;
Wherein the control unit, based on the correction amount calculated by the second calculating step, and a second correction step you correct each attitude of the first taught point and the second teaching point,
The robot apparatus control method according to claim 3, wherein the robot apparatus has a control method.
前記第1の検出工程では、前記制御部が、前記移動工程において前記第1のワークが前記接触点から前記第2の教示点までの前記軌道上に位置するときに、前記第1のワーク及び前記第2のワークの間に相対的に作用する力の変化量と、前記第1のワーク及び前記第2のワークの相対姿勢の変位量と、の少なくとも一方を前記検出部により検出し、
前記第1の演算工程では、前記制御部が、前記第1の検出工程で検出した前記力の変化量あるいは前記相対姿勢の変位量に基づき、前記軌道の補正量として、前記第1の教示点及び前記第2の教示点の各姿勢の補正量を演算し、
前記第1の補正工程では、前記制御部が、前記第1の演算工程で演算した前記補正量に基づき、前記第1の教示点及び前記第2の教示点の各姿勢を補正し
前記制御部が、前記第1の補正工程での補正後に、前記移動工程において前記第1のワークが前記接触点から前記第2の教示点までの前記軌道上に位置するときに、前記第1のワーク及び前記第2のワークの間に相対的に作用する力の変化量と、前記第1のワーク及び前記第2のワークの相対位置の変位量と、の少なくとも一方を前記検出部により検出する第2の検出工程と、
前記制御部が、前記第2の検出工程で検出した前記力の変化量あるいは前記相対位置の変位量に基づき、前記軌道の補正量として、前記第1の教示点及び前記第2の教示点の各位置の補正量を演算する第2の演算工程と、
前記制御部が、前記第2の演算工程で演算した前記補正量に基づき、前記第1の教示点及び前記第2の教示点の各位置を補正する第2の補正工程と、を備える、
ことを特徴とする請求項3乃至9のいずれか1項に記載のロボット装置の制御方法。
In the first detection step, when the control unit is positioned on the trajectory from the contact point to the second teaching point in the movement step, the control unit and the first workpiece and and variation of the force relative acting between said second workpiece is detected by the front Symbol the detecting unit and the displacement amount of at least one of the relative orientation of the first workpiece and the second workpiece,
In the first operation step, the control section, based on the displacement amount of the first variation of the force detected by the detection process or the phase Taisugata bias, as the correction amount of the track, the first Calculating a correction amount for each posture of the teaching point and the second teaching point;
In the first correction process, the control section, based on the correction amount calculated by said first calculating step, correct for the orientation of the first taught point and the second teaching point,
When the first work is positioned on the trajectory from the contact point to the second teaching point in the moving step after the correction in the first correction step, the control unit performs the first step . and the work and the variation of the force relative acting between said second workpiece, and before Symbol displacement of the relative position of the first workpiece and the second workpiece, by the detecting unit at least one of A second detection step to detect;
Wherein the control unit is based on the displacement amount of the second detection amount of change in the force detected by the step or the relative position location, as the correction amount of the track, the first teaching point and the second teaching point A second calculation step of calculating a correction amount at each position of
Wherein the control unit, based on the correction amount calculated by the second calculating step, and a second correction step you correct the respective positions of the first taught point and the second teaching point,
The robot apparatus control method according to claim 3, wherein the robot apparatus has a control method.
請求項1乃至11のいずれか1項に記載のロボット装置の制御方法の各工程をコンピュータに実行させるためのロボット制御プログラム。   The robot control program for making a computer perform each process of the control method of the robot apparatus of any one of Claims 1 thru | or 11. 請求項12に記載のロボット制御プログラムが記録されたコンピュータが読み取り可能な記録媒体。   A computer-readable recording medium on which the robot control program according to claim 12 is recorded. 複数の関節を有する多関節アームと前記多関節アームに支持されるエンドエフェクタとを有するロボット本体と、前記エンドエフェクタに連結され、第1のワーク及び第2のワークの間に相対的に作用する力の変化量と前記第1のワーク及び前記第2のワークの相対位置姿勢の変位量との少なくとも一方を検出する検出部と、前記ロボット本体を制御する制御部と、を備えるロボット装置において、
前記制御部は、前記エンドエフェクタにより保持した前記第1のワークを、第1の教示点から、接触点を経て、第2の教示点まで所定の軌道で移動させ、前記第1のワークが前記接触点から前記第2の教示点までの前記軌道上に位置するときに、前記第1のワーク及び前記第2のワークの間に相対的に作用する力の変化量と、前記第1のワーク及び前記第2のワークの相対位置姿勢の変位量と、の少なくとも一方を前記検出部により検出し、検出した前記力の変化量あるいは前記相対位置姿勢の変位量に基づき、前記軌道の補正量を演算し、演算した前記補正量に基づき、前記第1の教示点と前記第2の教示点との各位置及び姿勢を補正する、
ことを特徴とするロボット装置。
A robot body having a multi-joint arm having a plurality of joints and an end effector supported by the multi-joint arm, and is connected to the end effector and acts relatively between the first work and the second work. In a robot apparatus comprising: a detection unit that detects at least one of a force change amount and a displacement amount of a relative position and orientation of the first workpiece and the second workpiece; and a control unit that controls the robot body.
Wherein, the first workpiece held by the end effector, the first taught point, via a contact point, to a second teaching point is moved in a predetermined orbit, said first workpiece when located on the track from the contact point to the second teaching point, the change amount of the force relative acting between said first workpiece and said second workpiece, prior Symbol first And at least one of the displacement of the relative position and orientation of the second workpiece and the second workpiece is detected by the detection unit, and the trajectory is corrected based on the detected change amount of the force or the displacement amount of the relative position and orientation An amount is calculated, and each position and orientation of the first teaching point and the second teaching point are corrected based on the calculated correction amount.
A robot apparatus characterized by that.
請求項1乃至11のいずれか1項に記載のロボット装置の制御方法により制御されるロボット装置、又は請求項14に記載のロボット装置を用いて物品を製造する、  A robot apparatus controlled by the method for controlling a robot apparatus according to any one of claims 1 to 11, or an article is manufactured using the robot apparatus according to claim 14.
ことを特徴とする物品の製造方法。  A method for manufacturing an article.
複数の関節を有する多関節アームと前記多関節アームに支持されるエンドエフェクタとを有するロボット本体と、前記エンドエフェクタに連結され、ワークとの間に相対的に作用する力の変化量と前記ワークとの相対位置姿勢の変位量との少なくとも一方を検出する検出部と、前記ロボット本体を制御する制御部と、を備えるロボット装置の制御方法において、  A robot body having a multi-joint arm having a plurality of joints and an end effector supported by the multi-joint arm, a change amount of a force connected to the end effector and acting relatively between the work and the work In a control method of a robot apparatus, comprising: a detection unit that detects at least one of a displacement amount of a relative position and posture; and a control unit that controls the robot body.
前記制御部が、前記エンドエフェクタを、第1の教示点から、接触点を経て、第2の教示点までの軌道で移動させる移動工程と、  A moving step in which the control unit moves the end effector from a first teaching point through a contact point to a second teaching point;
前記制御部が、前記移動工程において前記エンドエフェクタが前記接触点から前記第2の教示点までの前記軌道上に位置するときに、前記エンドエフェクタ及び前記ワークの間に相対的に作用する力の変化量と、前記エンドエフェクタ及び前記ワークの相対位置姿勢の変位量と、の少なくとも一方を前記検出部により検出する第1の検出工程と、  When the end effector is positioned on the track from the contact point to the second teaching point in the moving step, the control unit is configured to generate a force acting relatively between the end effector and the workpiece. A first detection step in which at least one of a change amount and a displacement amount of a relative position and orientation of the end effector and the workpiece is detected by the detection unit;
前記制御部が、前記第1の検出工程で検出した前記力の変化量あるいは前記相対位置姿勢の変位量に基づき、前記軌道の補正量を演算する第1の演算工程と、  A first calculation step in which the control unit calculates a correction amount of the trajectory based on a change amount of the force detected in the first detection step or a displacement amount of the relative position and posture;
前記制御部が、前記第1の演算工程で演算した前記補正量に基づき、前記第1の教示点と前記第2の教示点との各位置及び姿勢を補正する第1の補正工程と、を備える、  A first correction step in which the control unit corrects each position and posture of the first teaching point and the second teaching point based on the correction amount calculated in the first calculation step; Prepare
ことを特徴とするロボット装置の制御方法。  A method for controlling a robot apparatus, comprising:
複数の関節を有する多関節アームと前記多関節アームに支持されるエンドエフェクタとを有するロボット本体と、前記エンドエフェクタに連結され、ワークとの間に相対的に作用する力の変化量と前記ワークとの相対位置姿勢の変位量との少なくとも一方を検出する検出部と、前記ロボット本体を制御する制御部と、を備えるロボット装置において、  A robot body having a multi-joint arm having a plurality of joints and an end effector supported by the multi-joint arm, a change amount of a force connected to the end effector and acting relatively between the work and the work In a robot apparatus comprising: a detection unit that detects at least one of a displacement amount of the relative position and posture; and a control unit that controls the robot body.
前記制御部は、前記エンドエフェクタを、第1の教示点から、接触点を経て、第2の教示点までの軌道で移動させ、前記エンドエフェクタが前記接触点から前記第2の教示点までの前記軌道上に位置するときに、前記エンドエフェクタ及び前記ワークの間に相対的に作用する力の変化量と、前記エンドエフェクタ及び前記ワークの相対位置姿勢の変位量と、の少なくとも一方を前記検出部により検出し、検出した前記力の変化量あるいは前記相対位置姿勢の変位量に基づき、前記軌道の補正量を演算し、演算した前記補正量に基づき、前記第1の教示点と前記第2の教示点との各位置及び姿勢を補正する、  The control unit moves the end effector from a first teaching point through a contact point to a second teaching point, and the end effector moves from the contact point to the second teaching point. At least one of a change amount of a force acting relatively between the end effector and the workpiece and a displacement amount of a relative position and posture of the end effector and the workpiece when positioned on the track is detected. And calculating the correction amount of the trajectory based on the detected change amount of the force or the displacement amount of the relative position and posture. Based on the calculated correction amount, the first teaching point and the second Correct each position and posture with the teaching point of
ことを特徴とするロボット装置。  A robot apparatus characterized by that.
請求項16に記載のロボット装置の制御方法により制御されるロボット装置、又は請求項17に記載のロボット装置を用いて物品を製造する、  An article is manufactured using the robot apparatus controlled by the control method of the robot apparatus according to claim 16, or the robot apparatus according to claim 17.
ことを特徴とする物品の製造方法。  A method for manufacturing an article.
JP2015088702A 2014-04-28 2015-04-23 Control method of robot device, robot device, and method of manufacturing article Active JP6516546B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2015088702A JP6516546B2 (en) 2014-04-28 2015-04-23 Control method of robot device, robot device, and method of manufacturing article

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2014092364 2014-04-28
JP2014092364 2014-04-28
JP2015088702A JP6516546B2 (en) 2014-04-28 2015-04-23 Control method of robot device, robot device, and method of manufacturing article

Publications (3)

Publication Number Publication Date
JP2015221490A JP2015221490A (en) 2015-12-10
JP2015221490A5 true JP2015221490A5 (en) 2018-07-05
JP6516546B2 JP6516546B2 (en) 2019-05-22

Family

ID=54784823

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2015088702A Active JP6516546B2 (en) 2014-04-28 2015-04-23 Control method of robot device, robot device, and method of manufacturing article

Country Status (1)

Country Link
JP (1) JP6516546B2 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6836571B2 (en) * 2018-11-14 2021-03-03 ファナック株式会社 Robot device
JP7351667B2 (en) * 2019-08-01 2023-09-27 ファナック株式会社 Robot control system, control method, computer program, and control device that performs multi-point mating

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08187687A (en) * 1995-01-10 1996-07-23 Toshiba Corp Control device for robot and hand device for robot
JPH09136279A (en) * 1995-11-15 1997-05-27 Fanuc Ltd Phase-adjusting fitting method using force control robot
JPH09258814A (en) * 1996-03-22 1997-10-03 Kayaba Ind Co Ltd Device and method for controlling position of assembling robot
JP3818986B2 (en) * 2003-07-08 2006-09-06 ファナック株式会社 Mating device
JP4598849B2 (en) * 2008-09-03 2010-12-15 ファナック株式会社 Fitting device for correcting clogged fitting
JP5451219B2 (en) * 2009-07-06 2014-03-26 キヤノン株式会社 Parts assembly method
JP5545534B2 (en) * 2010-04-19 2014-07-09 株式会社安川電機 Robot teaching reproduction device, teaching reproducing method, and teaching data creation method
JP2013127670A (en) * 2011-12-16 2013-06-27 Canon Inc Control device and drive unit

Similar Documents

Publication Publication Date Title
CN108214454B (en) Robot system, robot control device, and robot control method
JP2015155126A5 (en) Robot system and method for controlling robot system
US9724801B2 (en) Deburring device including visual sensor and force sensor
JP2021504140A5 (en)
WO2016193686A4 (en) Characterising robot environments
US10279485B2 (en) Robot system and method of detecting deformation of end effector
JP2016052695A5 (en)
JP5733882B2 (en) Robot and its cooperative work control method
US20150045953A1 (en) Robot system, robot control apparatus, method for controlling robot
JP2011115877A (en) Double arm robot
JP2016168651A5 (en)
EP2957375B1 (en) Seam welding system and method for producing a to-be-welded object
JP2015030078A5 (en) Robot device, robot control method, robot control program, and part manufacturing method using robot device
JP2015085458A (en) Robot control device, robot system and robot
JP2016198828A5 (en)
JP2010142910A5 (en)
JP2016168650A5 (en)
CA2897718C (en) Seam-welding method and system
WO2016147592A1 (en) Robot, method for controlling robot, workpiece attachment method, and workpiece feed method
JP2015221490A5 (en) Robot apparatus control method, robot apparatus, and article manufacturing method
JP2015145048A (en) robot
JP6410174B2 (en) Mobile robot
US20210039256A1 (en) Robot control method
US20170043481A1 (en) Robot controller inhibiting shaking of tool tip in robot equipped with travel axis
JP2017013209A5 (en)