JP2020116703A - Teaching device and teaching method - Google Patents
Teaching device and teaching method Download PDFInfo
- Publication number
- JP2020116703A JP2020116703A JP2019011136A JP2019011136A JP2020116703A JP 2020116703 A JP2020116703 A JP 2020116703A JP 2019011136 A JP2019011136 A JP 2019011136A JP 2019011136 A JP2019011136 A JP 2019011136A JP 2020116703 A JP2020116703 A JP 2020116703A
- Authority
- JP
- Japan
- Prior art keywords
- robot arm
- force
- pressing force
- servo
- unit
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
Description
この発明は、ロボットアームに対して力をダイレクト教示するための教示装置及び教示方法に関する。 The present invention relates to a teaching device and a teaching method for directly teaching a force to a robot arm.
従来から、教示装置は、ユーザによるロボットアームに対する位置及び姿勢のダイレクト教示を可能としている(例えば特許文献1,2参照)。一方、従来の教示装置では、ロボットアームに対する力の教示については、ユーザによるティーチングペンダントを用いた数値入力に応じ、力の値及び方向を設定している。 Conventionally, a teaching device enables a user to directly teach a position and a posture with respect to a robot arm (see, for example, Patent Documents 1 and 2). On the other hand, in the conventional teaching device, regarding the teaching of force to the robot arm, the value and direction of the force are set according to the numerical value input by the user using the teaching pendant.
上記のように、従来の教示装置では、ロボットアームに対する力の教示については、ユーザによるティーチングペンダントを用いた数値入力を受付けている。しかしながら、この場合、ユーザは、事前に実験を行って、入力する数値を確認する必要がある。そのため、ロボットアームに対する力の教示は、作業工数という観点では煩わしく、改善が求められている。 As described above, in the conventional teaching device, the user inputs a numerical value using the teaching pendant for teaching the force to the robot arm. However, in this case, the user needs to perform an experiment in advance to confirm the numerical value to be input. Therefore, teaching the force to the robot arm is cumbersome from the viewpoint of work man-hours, and improvement is required.
この発明は、上記のような課題を解決するためになされたもので、ロボットアームに対して力のダイレクト教示が可能な教示装置を提供することを目的としている。 The present invention has been made to solve the above problems, and an object thereof is to provide a teaching device capable of directly teaching a force to a robot arm.
この発明に係る教示装置は、ロボットアームに取付けられ、当該ロボットアームに加えられた押付力によるトルクを検出可能なトルクセンサと、トルクセンサにより検出されたトルクから、ロボットアームに加えられた押付力を算出する力算出部と、ユーザからサーボロック指示を受付けるロック指示受付部と、ロック指示受付部によりサーボロック指示を受付けたタイミングで、ロボットアームをサーボロックするアーム制御部と、ユーザから決定指示を受付ける決定指示受付部と、アーム制御部によりロボットアームがサーボロックされた後に力算出部により算出された押付力のうち、決定指示受付部により決定指示が受付けられたタイミングでの押付力の値及び方向を、ロボットアームに対して教示された力の値及び方向として登録する力登録部とを備えたことを特徴とする。 A teaching device according to the present invention is attached to a robot arm, and a torque sensor capable of detecting torque due to a pressing force applied to the robot arm, and a pressing force applied to the robot arm from the torque detected by the torque sensor. A force calculation unit that calculates a servo lock instruction, a lock instruction reception unit that receives a servo lock instruction from the user, an arm control unit that servo-locks the robot arm at the timing when the lock instruction reception unit receives the servo lock instruction, and a determination instruction from the user Of the pressing force calculated by the force calculation unit after the robot control unit servo-locks the robot arm by the arm control unit, and the value of the pressing force at the timing when the determination command is received by the determination command receiving unit. And a force registration unit that registers the direction and the direction as a value and a direction of the force taught to the robot arm.
この発明によれば、上記のように構成したので、ロボットアームに対して力のダイレクト教示が可能となる。 According to the present invention, since it is configured as described above, it is possible to directly teach the force to the robot arm.
以下、この発明の実施の形態について図面を参照しながら詳細に説明する。
実施の形態1.
図1は実施の形態1に係る教示装置の構成例及び動作例を示す図である。
教示装置は、ユーザがロボットアーム101に対して力のダイレクト教示を実施するための装置である。この教示装置は、力のダイレクト教示に関する機能の他に、位置及び姿勢のダイレクト教示に関する機能も有していてもよいが、位置及び姿勢のダイレクト教示に関する機能については従来と同様であるためその説明を省略する。なお、ユーザがロボットアーム101に対して教示する力としては、例えば、ツール102による物体201に対する押付け、ツール102が把持するワークの物体201上へのプレイス、ツール102による物体201に対する研磨又はネジ締め等の際に加える力が挙げられる。この教示装置は、図1に示すように、トルクセンサ11、力算出部12及び力教示部13を備えている。
Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings.
Embodiment 1.
FIG. 1 is a diagram showing a configuration example and an operation example of the teaching device according to the first embodiment.
The teaching device is a device for a user to directly teach force to the
トルクセンサ11は、ロボットアーム101に取付けられ、ロボットアーム101に加えられた押付力によるトルクを検出可能な検出センサである。トルクセンサ11は、ロボットアーム101の各軸に取付けられている。
The
力算出部12は、トルクセンサ11により検出されたトルクから、ロボットアーム101に加えられた押付力を算出する。この際、力算出部12は、トルクセンサ11毎に、検出値から初期値(ロボットアーム101に力が加えられていない状態での検出値)を差し引き、その差分値及び取付け位置までのアーム長さに基づいて力を算出する。そして、力算出部12は、算出した各力を合成することで、ロボットアーム101に加えられた押付力を算出する。
The
力教示部13は、力算出部12により算出された押付力に基づいて、ロボットアーム101に対して教示された力を登録する。この力教示部13は、図2に示すように、ロック指示受付部14、アーム制御部15、通知部16、決定指示受付部17、力登録部18及び記録部19を有している。
The
なお、力算出部12及び力教示部13は、システムLSI(Large Scale Integration)等の処理回路、又はメモリ等に記憶されたプログラムを実行するCPU(Central Processing Unit)等により実現される。
The
ロック指示受付部14は、ユーザからサーボロック指示を受付ける。サーボロック指示は、ユーザがロボットアーム101をサーボロックする際に教示装置に対して入力する指示である。なお、ユーザは、例えばロボットアーム101が有する操作ボタン(不図示)又はティーチングペンダント(不図示)が有する操作ボタンを用いて、サーボロック指示の入力を行う。
The lock
アーム制御部15は、ロック指示受付部14によりサーボロック指示を受付けたタイミングで、ロボットアーム101をサーボロックする。
The
通知部16は、力算出部12により算出された押付力をリアルタイムに通知する。この通知部16により通知された押付力を示す情報は、表示装置(不図示)に表示される。
なお、通知部16は、教示装置に必須の構成ではなく、教示装置に設けられていなくてもよい。例えば、ユーザが、力のダイレクト教示において、ロボットアーム101に加えられている押付力を確認しながら教示を行う必要が無い場合には、通知部16は不要である。
The
The
決定指示受付部17は、ユーザから決定指示を受付ける。決定指示は、ユーザが、力のダイレクト教示を実施している最中に、ロボットアーム101に対して教示する力を決定する際に教示装置に対して入力する指示である。なお、ユーザは、例えばロボットアーム101が有する操作ボタン又はティーチングペンダントが有する操作ボタンを用いて、決定指示の入力を行う。
The decision
力登録部18は、アーム制御部15によりロボットアーム101がサーボロックされた後に力算出部12により算出された押付力のうち、決定指示受付部17により決定指示が受付けられたタイミングでの押付力の値及び方向を、ロボットアーム101に対して教示された力の値及び方向として記録部19に登録する。
The
なお、記録部19は、HDD(Hard Disk Drive)、DVD(Digital Versatile Disc)又はメモリ等によって構成される。
また図2では、記録部19が教示装置の内部に設けられた場合を示しているが、これに限らず、記録部19は教示装置の外部に設けられていてもよい。
The
Although FIG. 2 shows the case where the
また、教示装置は、力のダイレクト教示を、位置及び姿勢のダイレクト教示とは別に実施するものとする。 Further, the teaching device performs direct force teaching separately from direct position and posture teaching.
次に、図1,2に示す教示装置を用いた力のダイレクト教示の一例について説明する。以下では、図1に示すように、ロボットアーム101が物体201をz軸方向に押付ける際の力を教示する場合を示す。
ここで、ユーザがロボットアーム101に対して位置又は姿勢をダイレクト教示する場合、ロボットアーム101の関節部分の回転角等を教示することになるが、この回転角等はユーザにとって視覚的に捉え易く位置又は姿勢の再現が容易である。これに対し、ユーザがロボットアーム101に対して力をダイレクト教示しようとする場合には、この力はユーザにとって視覚的に捉え難く力の再現が難しい。そこで、実施の形態1に係る教示装置では、ロボットアーム101に加えられた押付力によるトルクを検出可能なトルクセンサ11を用いることで、力のダイレクト教示を実現する。
一方、ロボットアーム101を自由に動かせる状態でユーザがロボットアーム101を物体201に押付けると、この押付力が物体201からの反発力で相殺されてしまうため、トルクセンサ11はトルクを検出できない。そのため、この状態ではロボットアーム101に対する力のダイレクト教示は実施できない。そこで、実施の形態1に係る教示装置では、ロボットアーム101が物体201から離れた状態でサーボロック状態(静止状態)とする。これにより、この状態でユーザがロボットアーム101に押付力を加えると、ロボットアーム101には押付力のみが加えられた状態となり、トルクセンサ11はこの押付力によるトルクを検出可能となる。
Next, an example of direct force teaching using the teaching device shown in FIGS. Hereinafter, as shown in FIG. 1, a case will be described in which the
Here, when the user directly teaches the position or posture to the
On the other hand, when the user presses the
力のダイレクト教示では、ユーザは、まず、ロボットアーム101が有するツール102を物体201から離した位置に移動させる。図1では、ロボットアーム101が物体201の上方に移動されている。
In direct teaching of force, the user first moves the
次いで、ユーザは、サーボロック指示を教示装置に入力する。
次いで、アーム制御部15は、ロボットアーム101をサーボロックする。
Next, the user inputs a servo lock instruction to the teaching device.
Next, the
次いで、ユーザは、ロボットアーム101に対して手でz軸方向に力を加える。この際、トルクセンサ11はロボットアーム101に加えられたz軸方向の押付力によるトルクを算出し、力算出部12はこのトルクから当該押付力を算出する。図1において、符号501に示す矢印はユーザにより加えられた押付力を示している。
Next, the user manually applies a force to the
また、通知部16は力算出部12により算出された押付力をリアルタイムに通知し、表示装置はその押付力を示す情報を表示する。これにより、ユーザは、ロボットアーム101に加えた押付力をモニタしながらロボットアーム101に加える押付力を調整できる。
In addition, the
次いで、ユーザは、ロボットアーム101に加えた押付力が所望値となった場合に、決定指示を教示装置に入力する。
Next, when the pressing force applied to the
次いで、力登録部18は、決定指示が入力されたタイミングでの押付力の値及び方向を、ロボットアーム101に対して教示された力の値及び方向として登録する。
以上の動作により、ユーザは、ロボットアーム101に対して力を教示できる。
Next, the
By the above operation, the user can teach the force to the
なお、ロボットアーム101の位置又は姿勢によっては、ユーザがロボットアーム101に対して押付力を加え難い場合又はトルクセンサ11での感度が弱くなる場合がある。そこで、このような場合には、例えば図3に示すように、ユーザは、ロボットアーム101の位置又は姿勢を、力のダイレクト教示がし易い任意の位置又は姿勢に移動させてから、力のダイレクト教示を実施してもよい。これにより、ユーザは、ロボットアーム101に対して押付力を加え易くなり、また、トルクセンサ11での感度の低下を抑制できる。
Depending on the position or posture of the
以上のように、この実施の形態1によれば、教示装置は、ロボットアーム101に取付けられ、当該ロボットアーム101に加えられた押付力によるトルクを検出可能なトルクセンサ11と、トルクセンサ11により検出されたトルクから、ロボットアーム101に加えられた押付力を算出する力算出部12と、ユーザからサーボロック指示を受付けるロック指示受付部14と、ロック指示受付部14によりサーボロック指示を受付けたタイミングで、ロボットアーム101をサーボロックするアーム制御部15と、ユーザから決定指示を受付ける決定指示受付部17と、アーム制御部15によりロボットアーム101がサーボロックされた後に力算出部12により算出された押付力のうち、決定指示受付部17により決定指示が受付けられたタイミングでの押付力の値及び方向を、ロボットアーム101に対して教示された力の値及び方向として登録する力登録部18とを備えた。これにより、実施の形態1に係る教示装置は、ロボットアーム101に対して力のダイレクト教示が可能となる。
As described above, according to the first embodiment, the teaching device includes the
なお、本願発明はその発明の範囲内において、実施の形態の任意の構成要素の変形、若しくは実施の形態の任意の構成要素の省略が可能である。 It should be noted that, in the present invention, it is possible to modify any of the constituent elements of the embodiment or omit any of the constituent elements of the embodiment within the scope of the invention.
11 トルクセンサ
12 力算出部
13 力教示部
14 ロック指示受付部
15 アーム制御部
16 通知部
17 決定指示受付部
18 力登録部
19 記録部
101 ロボットアーム
102 ツール
201 物体
11
Claims (5)
前記トルクセンサにより検出されたトルクから、前記ロボットアームに加えられた押付力を算出する力算出部と、
ユーザからサーボロック指示を受付けるロック指示受付部と、
前記ロック指示受付部によりサーボロック指示を受付けたタイミングで、前記ロボットアームをサーボロックするアーム制御部と、
ユーザから決定指示を受付ける決定指示受付部と、
前記アーム制御部により前記ロボットアームがサーボロックされた後に前記力算出部により算出された押付力のうち、前記決定指示受付部により決定指示が受付けられたタイミングでの押付力の値及び方向を、前記ロボットアームに対して教示された力の値及び方向として登録する力登録部と
を備えた教示装置。 A torque sensor attached to the robot arm and capable of detecting the torque due to the pressing force applied to the robot arm,
A force calculation unit that calculates the pressing force applied to the robot arm from the torque detected by the torque sensor,
A lock instruction receiving unit that receives a servo lock instruction from a user,
An arm control unit that servo-locks the robot arm at a timing when a servo lock instruction is received by the lock instruction reception unit,
A decision instruction receiving unit that receives a decision instruction from a user,
Of the pressing force calculated by the force calculation unit after the robot arm is servo-locked by the arm control unit, the value and direction of the pressing force at the timing when the determination instruction is received by the determination instruction receiving unit, A teaching device comprising: a force registration unit that registers the value and direction of the force taught to the robot arm.
ことを特徴とする請求項1記載の教示装置。 The teaching device according to claim 1, further comprising a notification unit that notifies the pressing force calculated by the force calculation unit in real time.
ことを特徴とする請求項1又は請求項2記載の教示装置。 The force calculation unit calculates the force based on the difference value obtained by subtracting the initial value from the detected value for each torque sensor and the arm length up to the attachment position, and combines the calculated force for each torque sensor. The teaching device according to claim 1 or 2, wherein a pressing force applied to the robot arm is calculated.
ことを特徴とする請求項1から請求項3のうちの何れか1項記載の教示装置。 The teaching device according to any one of claims 1 to 3, wherein the position or the posture of the robot arm when a pressing force is applied to the robot arm is an arbitrary position or posture. ..
ロック指示受付部が、ユーザからサーボロック指示を受付け、
アーム制御部が、前記ロック指示受付部によりサーボロック指示を受付けたタイミングで、前記ロボットアームをサーボロックし、
決定指示受付部が、ユーザから決定指示を受付け、
力登録部が、前記アーム制御部により前記ロボットアームがサーボロックされた後に前記力算出部により算出された押付力のうち、前記決定指示受付部により決定指示が受付けられたタイミングでの押付力の値及び方向を、前記ロボットアームに対して教示された力の値及び方向として登録する
ことを特徴とする教示方法。 A torque sensor attached to the robot arm and capable of detecting the torque due to the pressing force applied to the robot arm, and a force calculation unit for calculating the pressing force applied to the robot arm from the torque detected by the torque sensor. A teaching method using a teaching device comprising:
The lock instruction receiving unit receives the servo lock instruction from the user,
The arm control unit servo locks the robot arm at the timing when the servo lock instruction is received by the lock instruction receiving unit,
The decision instruction receiving unit receives the decision instruction from the user,
The force registration unit determines the pressing force at the timing when the determination instruction is received by the determination instruction receiving unit, among the pressing forces calculated by the force calculation unit after the robot control unit servo-locks the robot arm. A value and a direction are registered as a value and a direction of the force taught to the robot arm.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019011136A JP7273522B2 (en) | 2019-01-25 | 2019-01-25 | Teaching device and teaching method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019011136A JP7273522B2 (en) | 2019-01-25 | 2019-01-25 | Teaching device and teaching method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2020116703A true JP2020116703A (en) | 2020-08-06 |
JP7273522B2 JP7273522B2 (en) | 2023-05-15 |
Family
ID=71889618
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019011136A Active JP7273522B2 (en) | 2019-01-25 | 2019-01-25 | Teaching device and teaching method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7273522B2 (en) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11231925A (en) * | 1998-02-10 | 1999-08-27 | Yaskawa Electric Corp | Hand of direct teaching robot |
JP2012040637A (en) * | 2010-08-18 | 2012-03-01 | Iai:Kk | Control device, industrial robot, method for reproducing coordinate system, and program |
US20130236050A1 (en) * | 2012-03-06 | 2013-09-12 | Korea Institute Of Machinery & Materials | Method of post-correction of 3d feature point-based direct teaching trajectory |
JP2014128843A (en) * | 2012-12-28 | 2014-07-10 | Toyota Motor Corp | Robot arm teaching system and robot arm teaching method |
JP2015003378A (en) * | 2013-06-24 | 2015-01-08 | ファナック株式会社 | Motor-driven hand provided with force sensor |
JP2016028842A (en) * | 2014-07-17 | 2016-03-03 | 株式会社ロボテック | Actuator system |
JP2016168651A (en) * | 2015-03-13 | 2016-09-23 | キヤノン株式会社 | Robot controlling method, robot apparatus, program, and recording medium |
JP2017001122A (en) * | 2015-06-08 | 2017-01-05 | ファナック株式会社 | Robot and robot control device with force display function |
JP2017177293A (en) * | 2016-03-30 | 2017-10-05 | ファナック株式会社 | Human cooperation-type robot system |
US20180319013A1 (en) * | 2017-05-08 | 2018-11-08 | Seiko Epson Corporation | Controller and control method of robot, and robot system |
-
2019
- 2019-01-25 JP JP2019011136A patent/JP7273522B2/en active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11231925A (en) * | 1998-02-10 | 1999-08-27 | Yaskawa Electric Corp | Hand of direct teaching robot |
JP2012040637A (en) * | 2010-08-18 | 2012-03-01 | Iai:Kk | Control device, industrial robot, method for reproducing coordinate system, and program |
US20130236050A1 (en) * | 2012-03-06 | 2013-09-12 | Korea Institute Of Machinery & Materials | Method of post-correction of 3d feature point-based direct teaching trajectory |
JP2014128843A (en) * | 2012-12-28 | 2014-07-10 | Toyota Motor Corp | Robot arm teaching system and robot arm teaching method |
JP2015003378A (en) * | 2013-06-24 | 2015-01-08 | ファナック株式会社 | Motor-driven hand provided with force sensor |
JP2016028842A (en) * | 2014-07-17 | 2016-03-03 | 株式会社ロボテック | Actuator system |
JP2016168651A (en) * | 2015-03-13 | 2016-09-23 | キヤノン株式会社 | Robot controlling method, robot apparatus, program, and recording medium |
JP2017001122A (en) * | 2015-06-08 | 2017-01-05 | ファナック株式会社 | Robot and robot control device with force display function |
JP2017177293A (en) * | 2016-03-30 | 2017-10-05 | ファナック株式会社 | Human cooperation-type robot system |
US20180319013A1 (en) * | 2017-05-08 | 2018-11-08 | Seiko Epson Corporation | Controller and control method of robot, and robot system |
JP2018187754A (en) * | 2017-05-08 | 2018-11-29 | セイコーエプソン株式会社 | Controller and control method of robot, and robot system |
Also Published As
Publication number | Publication date |
---|---|
JP7273522B2 (en) | 2023-05-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10201901B2 (en) | Robot apparatus, method for controlling robot, program, and recording medium | |
JP2018126857A5 (en) | Control methods, robot systems, article manufacturing methods, programs and recording media | |
JP6331517B2 (en) | Image processing apparatus, system, image processing method, and image processing program | |
US9815198B2 (en) | System and method for determining a work offset | |
JP4612086B2 (en) | Machine tool with workpiece measurement reference point setting function | |
US20060269123A1 (en) | Method and system for three-dimensional measurement | |
JP4643619B2 (en) | Robot controller | |
JP6795540B2 (en) | Devices, methods and programs for estimating load weight and center of gravity position using a robot | |
JP2018130813A (en) | Control device, robot, and robot system | |
CN111721391A (en) | Device, method, and program for estimating weight and center of gravity position of load by robot | |
JP2015071207A (en) | Robot hand and control method thereof | |
KR102658278B1 (en) | Mobile robot and method of aligning robot arm thereof | |
JP2020116703A (en) | Teaching device and teaching method | |
WO2017070872A1 (en) | Method and apparatus for abnormality detection | |
JP6488571B2 (en) | Teaching apparatus and robot system | |
JP2019093152A5 (en) | ||
JP2020116702A (en) | Teaching device and teaching method | |
WO2020262168A1 (en) | Teaching device and teaching method | |
JP7193207B2 (en) | Teaching device and teaching method | |
WO2020262170A1 (en) | Teaching device and teaching method | |
JP2016028227A (en) | Inspection system for inspecting object by utilizing force sensor | |
JP7392154B2 (en) | robot control device | |
JP5516974B2 (en) | Vision sensor mounting apparatus and method | |
JP2008254157A (en) | Installation evaluation device, method, program and storage medium for coupling member | |
JP2020116704A (en) | Teaching device and teaching method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20211223 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20221026 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20221108 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20221226 |
|
RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20221226 |
|
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: 20230404 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230428 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7273522 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |