JPWO2018061283A1 - ロボットの制御方法及び溶接方法 - Google Patents
ロボットの制御方法及び溶接方法 Download PDFInfo
- Publication number
- JPWO2018061283A1 JPWO2018061283A1 JP2018541884A JP2018541884A JPWO2018061283A1 JP WO2018061283 A1 JPWO2018061283 A1 JP WO2018061283A1 JP 2018541884 A JP2018541884 A JP 2018541884A JP 2018541884 A JP2018541884 A JP 2018541884A JP WO2018061283 A1 JPWO2018061283 A1 JP WO2018061283A1
- Authority
- JP
- Japan
- Prior art keywords
- arm
- robot
- backlash correction
- motor
- correction value
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1641—Programme controls characterised by the control loop compensation for backlash, friction, compliance, elasticity in the joints
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23K—SOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
- B23K9/00—Arc welding or cutting
- B23K9/12—Automatic feeding or moving of electrodes or work for spot or seam welding or cutting
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
-
- 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
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/404—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23K—SOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
- B23K9/00—Arc welding or cutting
- B23K9/06—Arrangements or circuits for starting the arc, e.g. by generating ignition voltage, or for stabilising the arc
- B23K9/067—Starting the arc
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
- B25J11/005—Manipulators for mechanical processing tasks
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41039—Change compensation slowly, gradually, smooth error with filter
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41041—Compensation pulses as function of direction movement
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41059—Play in gear, screw backlash, lost motion
-
- 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/43—Speed, acceleration, deceleration control ADC
- G05B2219/43054—Take up gear backlash during deceleration
-
- 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/45—Nc applications
- G05B2219/45104—Lasrobot, welding robot
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Physics & Mathematics (AREA)
- Plasma & Fusion (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
Description
アームが停止する前に、モータに入力される位置指令に、バックラッシュ補正値を加える加算ステップと、
ロボットアームが停止中に、位置指令に加算されたバックラッシュ補正値を減少させる減算ステップと、
を備える。
アームが停止する前に、モータに入力される位置指令に、バックラッシュ補正値を加える加算ステップと、
ロボットアームが停止中に、位置指令に加算されたバックラッシュ補正値を減少させる減算ステップと、
アームの停止後に、ワイヤとワークとの間でアークを発生させるアーク発生ステップと、アークの発生後に、アームを移動させることによりワイヤを移動させて、ワークの溶接を行う溶接ステップと、
を備える。
図1は、実施の形態に係る、垂直多関節の6軸ロボットの概略構成図である。
Rg = ωM/ωL (1)
なお、減速機3は減速機1次側6と減速機2次側7の間にガタ(隙間)及びバネ成分が存在するので、式(1)が成立するのは、減速機1次側6が減速機2次側7に接触し、ガタ(隙間)が一方に寄せられバネの伸びが一定となった定常状態のみである。
YA = KYA × θL (2−2)
VM = KVM × ωM (2−3)
VA = KVA × ωL (2−4)
YBL = KYM × θBL (2−5)
ここで、記号は以下の値を示している。
θL :アーム先端の回転位置
ωM :モータの回転速度
ωL :アーム先端のモータ速度
θBL:モータのバックラッシュ補正位置
KYM:モータの回転位置θMからアーム先端位置換算のモータ位置YMへの換算係数
KYA:アームの回転位置θLからY軸方向のアーム先端位置YAへの換算係数
KVM:モータの回転速度ωMからアーム先端速度換算のモータ速度VMへの換算係数
KVA:アームの回転速度ωLからY軸方向のアーム先端速度VAの換算係数
KYM:モータのバックラッシュ補正位置からアーム先端位置換算のY軸方向のモータ補正位置YBLへの換算係数
なお、いずれの換算係数もアームの姿勢で変化する。
図6A〜図6Cは、比較例に係る、ロボットメカの動作を示す図である。図6Aは、Y軸方向でのロボットアームの移動を示す図である。図6Bは、アームを駆動するモータのY軸方向の位置の時間経過を示す図である。図6Cは、アーム先端のY軸方向の位置の時間経過を示す図である。
2 モータ
3 減速機
4 ベアリング
6 減速機1次側
7 減速機2次側
9 第2アーム
20 位置制御ブロック
30 速度制御ブロック
40 ブロック
51 エンコーダ
53 減速機
55 バックラッシュ補正値演算ブロック
60 ロボット
61 ロボットメカ
62 ロボット制御装置
63 アーム
64 関節軸
65 操作・教示部
66 メイン制御部
67 サーボ制御部
68 モータ
69 アーム
71 アーム先端
72 アーム
73 モータ
74 溶接トーチ
75 溶接ワイヤ
80 ワーク
AX 第1軸
Claims (8)
- モータを用いてアームを動作させるロボットの制御方法であって、
前記アームが停止する前に、前記モータに入力される位置指令に、バックラッシュ補正値を加える加算ステップと、
前記ロボットアームが停止中に、前記位置指令に加算された前記バックラッシュ補正値を減少させる減算ステップと、
を備える
ロボットの制御方法。 - 前記加算ステップにおいて、前記バックラッシュ補正値は、前記アームの進行方向に加算される
請求項1に記載のロボットの制御方法。 - 前記加算ステップの期間よりも、前記減算ステップの期間の方が長い
請求項1に記載のロボットの制御方法。 - 前記加算ステップと前記減算ステップとの間に、前記バックラッシュ補正値を維持する維持ステップをさらに備える
請求項1に記載のロボットの制御方法。 - モータを用いて、ワイヤが装着されたアームを動作させるとともに、前記ワイヤを用いてワークの溶接を行う溶接方法であって、
前記アームが停止する前に、前記モータに入力される位置指令に、バックラッシュ補正値を加える加算ステップと、
前記ロボットアームが停止中に、前記位置指令に加算された前記バックラッシュ補正値を減少させる減算ステップと、
前記アームの停止後に、前記ワイヤと前記ワークとの間でアークを発生させるアーク発生ステップと、
前記アークの発生後に、前記アームを移動させることにより前記ワイヤを移動させて、前記ワークの溶接を行う溶接ステップと、
を備える
溶接方法。 - 前記加算ステップにおいて、前記バックラッシュ補正値は、前記アームの進行方向に加算される
請求項5に記載の溶接方法。 - 前記加算ステップの期間よりも、前記減算ステップの期間の方が長い
請求項5に記載の溶接方法。 - 前記加算ステップと前記減算ステップとの間に、前記バックラッシュ補正値を維持する維持ステップをさらに備える
請求項5に記載の溶接方法。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016188088 | 2016-09-27 | ||
JP2016188088 | 2016-09-27 | ||
PCT/JP2017/017437 WO2018061283A1 (ja) | 2016-09-27 | 2017-05-09 | ロボットの制御方法及び溶接方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPWO2018061283A1 true JPWO2018061283A1 (ja) | 2019-07-04 |
JP6712724B2 JP6712724B2 (ja) | 2020-06-24 |
Family
ID=61760313
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2018541884A Active JP6712724B2 (ja) | 2016-09-27 | 2017-05-09 | ロボットの制御方法及び溶接方法 |
Country Status (5)
Country | Link |
---|---|
US (1) | US10882183B2 (ja) |
EP (1) | EP3520972B1 (ja) |
JP (1) | JP6712724B2 (ja) |
CN (1) | CN109476024B (ja) |
WO (1) | WO2018061283A1 (ja) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020246171A1 (ja) * | 2019-06-04 | 2020-12-10 | パナソニックIpマネジメント株式会社 | ロボットの制御方法 |
JP7396850B2 (ja) * | 2019-10-18 | 2023-12-12 | ファナック株式会社 | ロボット |
CN114750145A (zh) * | 2021-01-12 | 2022-07-15 | 曰轮法寺 | 机械手系统的控制方法、装置、系统、存储介质及设备 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5804940A (en) * | 1994-04-08 | 1998-09-08 | Siemens Aktiengesellschaft | Device designed to compensate for non-linearity of machine shafts |
JP2000250614A (ja) * | 1998-12-28 | 2000-09-14 | Mitsubishi Electric Corp | バックラッシ補正装置および数値制御システム |
JP2003280742A (ja) * | 2002-03-22 | 2003-10-02 | Fuji Photo Optical Co Ltd | モータ制御装置 |
JP2007058277A (ja) * | 2005-08-22 | 2007-03-08 | Okuma Corp | ロストモーション補正機能を有する位置制御装置 |
WO2013031465A1 (ja) * | 2011-09-01 | 2013-03-07 | 株式会社神戸製鋼所 | 制御方法及び制御装置 |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5868111A (ja) * | 1981-10-20 | 1983-04-22 | Fanuc Ltd | バツクラツシユ補正方式 |
JP2531258B2 (ja) | 1989-03-14 | 1996-09-04 | 日本電気株式会社 | バックラッシュ補正回路 |
JPH0371206A (ja) * | 1989-08-10 | 1991-03-27 | Mitsubishi Electric Corp | Nc工作機械の機械誤差補正装置 |
JPH048451A (ja) * | 1990-04-27 | 1992-01-13 | Fanuc Ltd | サーボモータの制御方式 |
JP2873156B2 (ja) | 1993-12-27 | 1999-03-24 | 株式会社神戸製鋼所 | アーク溶接用ロボット及びその制御方法 |
JPH0876847A (ja) | 1994-08-31 | 1996-03-22 | Nippei Toyama Corp | 駆動装置におけるバックラッシュ補正機構及び補正方法 |
JP3687958B2 (ja) * | 2001-03-30 | 2005-08-24 | 東芝機械株式会社 | 位置制御装置および位置制御方法 |
JP2006039807A (ja) | 2004-07-26 | 2006-02-09 | Fanuc Ltd | 数値制御装置 |
JP2006317310A (ja) * | 2005-05-13 | 2006-11-24 | Mazda Motor Corp | ギア駆動式バランサの検査装置 |
JP5049916B2 (ja) * | 2007-10-31 | 2012-10-17 | 株式会社神戸製鋼所 | アーク溶接ロボットの制御装置、その方法及びそのプログラム |
CN202815509U (zh) * | 2012-09-28 | 2013-03-20 | 北京航天计量测试技术研究所 | 利用误差修正闭环回路消除齿隙误差的精密定位装置 |
JP5628940B2 (ja) * | 2013-01-11 | 2014-11-19 | ファナック株式会社 | バックラッシを補正するモータ制御装置 |
JP5890473B2 (ja) * | 2014-06-13 | 2016-03-22 | ファナック株式会社 | モータを制御するモータ制御装置 |
JP5890488B1 (ja) * | 2014-08-05 | 2016-03-22 | ファナック株式会社 | ツールをワークに押付けて作業を行うロボットの制御装置 |
JP6506232B2 (ja) * | 2016-10-04 | 2019-04-24 | ファナック株式会社 | モータ制御装置、モータ制御方法、及びモータ制御プログラム |
-
2017
- 2017-05-09 CN CN201780045479.2A patent/CN109476024B/zh active Active
- 2017-05-09 JP JP2018541884A patent/JP6712724B2/ja active Active
- 2017-05-09 WO PCT/JP2017/017437 patent/WO2018061283A1/ja unknown
- 2017-05-09 US US16/316,041 patent/US10882183B2/en active Active
- 2017-05-09 EP EP17855242.8A patent/EP3520972B1/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5804940A (en) * | 1994-04-08 | 1998-09-08 | Siemens Aktiengesellschaft | Device designed to compensate for non-linearity of machine shafts |
JP2000250614A (ja) * | 1998-12-28 | 2000-09-14 | Mitsubishi Electric Corp | バックラッシ補正装置および数値制御システム |
JP2003280742A (ja) * | 2002-03-22 | 2003-10-02 | Fuji Photo Optical Co Ltd | モータ制御装置 |
JP2007058277A (ja) * | 2005-08-22 | 2007-03-08 | Okuma Corp | ロストモーション補正機能を有する位置制御装置 |
WO2013031465A1 (ja) * | 2011-09-01 | 2013-03-07 | 株式会社神戸製鋼所 | 制御方法及び制御装置 |
Also Published As
Publication number | Publication date |
---|---|
EP3520972A1 (en) | 2019-08-07 |
EP3520972A4 (en) | 2020-03-04 |
CN109476024B (zh) | 2021-09-28 |
CN109476024A (zh) | 2019-03-15 |
US10882183B2 (en) | 2021-01-05 |
WO2018061283A1 (ja) | 2018-04-05 |
JP6712724B2 (ja) | 2020-06-24 |
EP3520972B1 (en) | 2021-01-06 |
US20200009726A1 (en) | 2020-01-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7842904B2 (en) | Welding system and consumable electrode welding method | |
JP5897644B2 (ja) | ロボットの制御装置 | |
JP6712724B2 (ja) | ロボットの制御方法及び溶接方法 | |
JP2008296310A (ja) | 加工ロボットの制御装置 | |
JP2009072913A (ja) | ロボットの制御方法 | |
JP5875714B2 (ja) | サーボ制御装置およびサーボ制御方法 | |
JP6693939B2 (ja) | ロボットシステム | |
JP2010231575A (ja) | ロボットのオフライン教示装置、ロボットのオフライン教示方法、及びロボットシステム | |
JP2016078149A (ja) | ロボット装置の制御方法及びロボット装置、プログラム及び記録媒体 | |
US20210039256A1 (en) | Robot control method | |
JP2005052913A (ja) | ロボット制御装置 | |
JP6088601B2 (ja) | 走行軸付きロボットにおけるツール先端の振れを抑制するロボット制御装置 | |
JP2008036733A (ja) | 多関節リンク機構の軌跡制御装置 | |
WO2019012942A1 (ja) | ロボット制御装置 | |
JPWO2019044237A1 (ja) | ロボット制御装置 | |
JP5633268B2 (ja) | ロボットの制御装置 | |
JP7194910B2 (ja) | ロボット制御方法及びロボット制御装置 | |
JP4870647B2 (ja) | 回転構造物の位置制御方法 | |
US20220176557A1 (en) | Robot control method and robot control device | |
JP7489591B1 (ja) | ロボットの制御方法及びロボットの制御装置 | |
WO2019215980A1 (ja) | ロボット制御装置 | |
KR20230099273A (ko) | 스카라 로봇의 작업 공간상의 직선 궤적을 생성하는 방법 | |
JP2024071866A (ja) | ロボットの制御方法およびロボットシステム | |
JP2020146807A (ja) | ロボットの制御装置、ロボットの制御方法 | |
WO2014126216A1 (ja) | 多関節ロボットの制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20181219 |
|
RD01 | Notification of change of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7421 Effective date: 20190124 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20190607 |
|
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: 20200414 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20200427 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6712724 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |