WO2013180222A1 - 多関節ロボットの軌跡制御装置および制御方法 - Google Patents
多関節ロボットの軌跡制御装置および制御方法 Download PDFInfo
- Publication number
- WO2013180222A1 WO2013180222A1 PCT/JP2013/065054 JP2013065054W WO2013180222A1 WO 2013180222 A1 WO2013180222 A1 WO 2013180222A1 JP 2013065054 W JP2013065054 W JP 2013065054W WO 2013180222 A1 WO2013180222 A1 WO 2013180222A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- calculation unit
- dynamic characteristic
- joint angle
- command value
- characteristic
- Prior art date
Links
Images
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/163—Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
-
- 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
-
- 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/02—Seam welding; Backing means; Inserts
- B23K9/0216—Seam profiling, e.g. weaving, multilayer
-
- 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/095—Monitoring or automatic control of welding parameters
-
- 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
- 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/16—Arc welding or cutting making use of shielding gas
- B23K9/173—Arc welding or cutting making use of shielding gas and of a consumable electrode
-
- 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/06—Programme-controlled manipulators characterised by multi-articulated arms
-
- 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/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- 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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- 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/4093—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 part programming, e.g. entry of geometrical information as taken from a technical drawing, combining this with machining and material information to obtain control information, named part programme, for the NC machine
-
- 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/41124—Nonlinear compensation
-
- 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/41166—Adaptive filter frequency as function of oscillation, rigidity, inertia load
-
- 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/41426—Feedforward of torque
-
- 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/42—Servomotor, servo controller kind till VSS
- G05B2219/42065—Feedforward combined with pid feedback
-
- 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
-
- 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/49—Nc machine tool, till multiple
- G05B2219/49384—Control of oscillatory movement like filling a weld, weaving
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
- Y10S—TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10S901/00—Robots
- Y10S901/02—Arm motion controller
Definitions
- the first dynamic characteristic calculation unit (dynamic characteristic 1) shown in FIG. 4 or the like is used so that the target value does not include a component that excites the natural vibration. Those components are suppressed by the filter processing.
- the interference torque between the axes acts as a nonlinear term c including a gravity term.
- a nonlinear term c including a gravity term.
- Dynamic control is required. Therefore, the influence of this nonlinear term c is enormous.
- the trajectory control apparatus can compensate for the influence of the interference torque of each axis and enable operations such as weaving with high trajectory accuracy in an articulated robot.
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Robotics (AREA)
- Plasma & Fusion (AREA)
- Geometry (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
Description
また、特許文献2では、速度フィードフォワードにフィルタ処理することで、ロボットの固有振動を励起することなくフィードフォワードゲインをアップする手法が開示されている。しかしながら、この技術によるフィードフォワードゲインのアップは微々たるものであり、根本的な解決には至っていない。また、各軸間の制御特性の違いや姿勢による制御特性変化については、この手法は対応していない。さらに、目標位置の微分値とフィルタ後の速度フィードフォワードの値とでは位相が異なることから、所望の制御特性を実現することが困難になっている。
(1)ロボットの固有振動数が低い状態で、各軸間を非干渉化する非線形補償制御を有効に作用させることができないため、各軸干渉トルクの影響を補償できないことが、精度劣化につながっている。
(2)サーボ制御部の位相遅れがある状態において、各軸間を非干渉化する非線形補償制御を有効に作用せせることができないため、各軸干渉トルクの影響を補償できないことが、精度劣化につながっている。
(4)ロボット姿勢によってサーボ制御特性が変化することが、軌跡精度の劣化につながっている。
(5)溶接ロボットのウィービング動作では、ウィービング周期での位相遅れおよびゲイン特性を各軸そろえることが非常に重要である。しかしながら、各軸間の干渉や姿勢によるサーボ特性変化や軸毎での特性の差異によって、位相・ゲイン特性を高周波ウィービング動作でそろえることが非常に困難である。
即ち、本発明に係る多関節ロボットの軌跡制御装置は、多関節ロボットに取り付けられたモータによりツールに所望の動作を行わせるように複数の関節軸を駆動させる多関節ロボットの動作を制御する。この軌跡制御装置は、所望のツール動作を実現するための各関節軸の関節角度指令値θcを算出して出力する関節角度指令値計算部と、前記関節角度指令値θc通りに動作した際に発生する各関節軸間で相互に作用する干渉トルクを、動力学モデルに基づいて関節角度指令値θcから算出して、干渉トルク補償指令値ccを出力する干渉トルク補償指令値計算部と、ロボットの固有振動周波数よりも低いカットオフ周波数を有する高周波遮断特性を備え、前記関節角度指令値θcをフィルタリング処理して、処理後の関節角度目標値θdを出力する第1の動特性演算部と、前記関節角度目標値θdが前記モータに対する目標値として入力される関節角度制御部と、前記第1の動特性演算部よりも低いまたは同等のカットオフ周波数を有する高周波遮断特性を備え、前記干渉トルク補償指令値計算部への入力および前記干渉トルク補償指令値計算部からの出力の少なくともいずれかをフィルタリング処理して、処理後の干渉トルク補償値cdを出力する第2の動特性演算部と、前記関節角度制御部から出力されるモータトルク指令値に、前記干渉トルク補償値cdが加算された値が目標値として入力されるモータ電流制御部と、を含んで構成されていることを特徴とする。
軌跡制御装置は、さらに好ましくは、前記多関節ロボットの姿勢に応じて、前記第1の動特性演算部の特性を変更するように構成することができる。
[全体構成]
まず、本実施の形態に係る軌跡制御装置が適用される垂直多関節ロボット(以下、単に多関節ロボットと記載する場合がある)の概要について説明する。
図1は、溶接トーチを傾動動作(ウィービング動作)させるロボットの一例であって、本実施の形態に係る軌跡制御装置が適用される多関節ロボット1の概要を示す図である。この多関節ロボット1は、垂直多関節型であってJ1~J6の6個の関節を備え、J6の軸の先端に設けられた溶接トーチから送りだされる溶接ワイヤによりアーク溶接を行う。この多関節ロボット1は、予め定められた溶接開始点と溶接終了点との間を溶接作業区間として設定し、溶接開始点と溶接終了点とを結ぶ溶接線方向に移動しつつ、溶接ワイヤを予め定められた振幅および周波数で傾動する動作(ウィービング動作)を行うようにセットされている。
制御装置(サーボ制御部)は、多関節ロボット1に設けられた溶接トーチを、予め教示したプログラムに従って、上述した溶接線に倣ってウィービング動作で移動するように制御する。教示プログラムは、制御装置に接続された教示ペンダントを使用して作成される場合や、上位コンピュータを利用したオフライン教示システムを使用して作成される場合がある。いずれの場合であっても、教示プログラムは、実際の動作の前に予め作成される。上位コンピュータでは、溶接パスが生成されたり、それに基づくウィービング動作指令が生成されたりする。
図2は、図1の多関節ロボット1を制御する軌跡制御装置10の制御ブロック図を示す。上述したように、この軌跡制御装置10は、上位CPUで実現される部分とサーボ制御部で実現される部分とを含んで構成されている。
図2に示すように、この軌跡制御装置10は、多関節ロボット1に取り付けられたツール(ここでは溶接トーチ)に所望の動作(ここではウィービング動作)を行わせるように、複数の関節軸を駆動する。
干渉トルク補償指令値計算部200は、関節角度指令値計算部100から出力された関節角度指令値θc通りに動作した際に発生する各関節軸間で相互に作用する干渉トルクを、動力学モデルに基づいて関節角度指令値θcから算出する。そして、干渉トルク補償指令値計算部200は、干渉トルク補償指令値ccを出力する。
第2の動特性演算部400は、干渉トルク補償指令値計算部200への入力および干渉トルク補償指令値計算部200からの出力の少なくともいずれかをフィルタリング処理して、処理後の干渉トルク補償値cdを出力する。なお、図2において、第2の動特性演算部400は、干渉トルク補償指令値計算部200からの出力をフィルタリング処理している。この第2の動特性演算部400は、第1の動特性演算部300よりも低いまたは同等のカットオフ周波数を有する高周波遮断特性(ローパスフィルタ)を備える。
モータ電流制御部520には、関節角度制御部510から出力されるモータトルク指令値に、第2の動特性演算部400から出力された干渉トルク補償値cdが加算された値が、目標値として入力される。
非線形項である干渉トルク補償指令値計算部200の前および/または後(ここでは後のみ)に、第2の動特性演算部400が配置されている。この第2の動特性演算部400により、第1の動特性演算部300の高周波遮断特性以上の高周波帯域を遮断する特性が与えられている。ここで、第2の動特性演算部400のカットオフ周波数は、第1の動特性演算部300のカットオフ周波数よりも低いか同等である。
以上のような構成を備えた軌跡制御装置10を用いて多関節ロボット1を制御した場合の制御特性(ウィービング軌跡)について説明する。
図3は、第2の動特性演算部400の高周波遮断特性として、第1の動特性演算部300と同等の高周波遮断特性を与えた場合のウィービング軌跡を示す。
図4は、最も一般的な多関節ロボットの制御ブロック図を示す。図4に示すように、この制御ブロックは、位置制御部(Gp)と速度制御部(Gv)と電流制御部とから構成される。位置制御部は、関節角度をフィードバック制御し、角度偏差を比例制御(P制御)し、速度指令として速度制御部に指令する。速度制御部は、関節角速度をフィードバック制御し、与えられた速度指令との偏差を比例積分制御(PI制御)し、電流制御指令として電流制御部に指令する。
電流制御部は、与えられた電流制御指令に基づきモータ電流を制御する。
ただし、多関節ロボットでは、各軸間で干渉トルクが、重力項などを含めて、非線形項cとして作用する。特に溶接ロボットのウィービング動作では、上下にぶれることなく(上下方向の動きを発生させることなく)所望方向に所望の振幅で溶接トーチを揺動させることが必要であるために、非常に高精度な動的制御が必要とされる。そのため、この非線形項cの影響は甚大である。
一般に、このような従来技術に係る制御では、フィードバック制御部(サーボ制御フィードバック特性)における位相特性やゲイン特性が各軸毎に異なり、また、ロボットの姿勢によって慣性行列が変化するため、同一軸でも姿勢によって制御フィードバック特性が変化する。このため、フィードフォワード制御などの位相を合わせることが困難であった。このため、上記のようなフィードフォワード制御はまったく実用化されておらず、各軸間の干渉の影響を抑制することは困難となっていた。
このような従来技術に係る制御による結果(ウィービング軌跡)を示す図5および図7と比較すると、本実施の形態に係る軌跡制御装置10による結果(ウィービング軌跡)では、図3に示すように、上下動成分は発生しているものの格段に上下動成分が抑制されている。なお、図3は、第2の動特性演算部400における高周波遮断特性を、第1の動特性演算部300における高周波遮断特性と同等とした場合の結果である。
以下、本発明の第2の実施の形態に係る軌跡制御装置について説明する。なお、本実施の形態に係る軌跡制御装置は、上述した第1の実施の形態に係る軌跡制御装置10と、第1の動特性演算部300の与え方において異なる。それ以外は、第1の実施の形態と同じであるので、上述した説明と重複する部分についてはここでは繰り返さない。
このようにして、第1の動特性演算部300および第2の動特性演算部400を与えた場合のウィービング軌跡を図8に示す。図8に示すように、本実施の形態に係る軌跡制御装置によるウィービング軌跡では、第1の実施の形態におけるウィービング軌跡(図3)よりも、さらに上下方向の振動が抑制されていることがわかる。
次に、第2の実施の形態の変形例に係る軌跡制御装置について説明する。
以上のようにして、本変形例に係る軌跡制御装置は、多関節ロボットにおいて、モータ電流制御部520の電流制御特性を考慮して、各軸の干渉トルクの影響を補償して、さらに高い軌跡精度でウィービング等の動作を可能とすることができる。
以下、本発明の第3の実施の形態に係る軌跡制御装置について説明する。なお、本実施の形態に係る軌跡制御装置は、上述した第1の実施の形態に係る軌跡制御装置10と、第1の動特性演算部300の与え方において異なる。それ以外は、第1の実施の形態と同じであるので、上述した説明と重複する部分についてはここでは繰り返さない。
なお、この場合、各軸間の干渉がない状態での関節角度目標値θcから実際の関節角度θまでのフィードバック制御動特性を、位置フィードバックゲインおよび速度フィードバックゲインの少なくともいずれかを含むパラメータに基づいて算出するように構成されている。
以下、本発明の第4の実施の形態に係る軌跡制御装置について説明する。なお、本実施の形態に係る軌跡制御装置は、上述した第1の実施の形態に係る軌跡制御装置10と、第1の動特性演算部300の与え方において異なる。それ以外は、第1の実施の形態と同じであるので、上述した説明と重複する部分についてはここでは繰り返さない。
上述した第2および第3の実施の形態においては、各軸毎に所望の動特性が与えられていたが、実際のウィービング動作では各軸の動特性を揃える必要がある。このためには、全軸で同じ(共通の)所望の動特性を与えればよい。上述した第2および第3の実施の形態(図8および図10)では、既に全軸で同じ所望の動特性が与えられている。
以下、本発明の第5の実施の形態に係る軌跡制御装置について説明する。なお、本実施の形態に係る軌跡制御装置は、上述した第1の実施の形態に係る軌跡制御装置10が備えなかった速度フィードフォワード制御および/または加速度フィードフォワード制御が加えられている点で異なる。それ以外は、第1の実施の形態と同じであるので、上述した説明と重複する部分についてはここでは繰り返さない。
実際には、式(1)に示すJ(θ)は、多関節ロボット1の姿勢によって変化するため、サーボ制御特性が変化する。したがって、J(θ)の変化に応じて、以下の式(7)により「動特性1」が与えられれば、多関節ロボット1の姿勢の変化に対応したフィードフォワード制御が可能となる。
図12は、第5の実施の形態に係る軌跡制御装置30のブロック図を示す。この軌跡制御装置30は、速度フィードフォワード制御および加速度フィードフォワード制御を備える。
この図12に示す軌跡制御装置30では、式(1)は、以下の式(8)で与えられる。
なお、ここで、GdaおよびGdvは、加速度フィードフォワードおよび速度フィードフォワードゲインであり、0~1の値をとる。また、JdはJ(θ)の予測値である。
以上のようにして、本実施の形態に係る軌跡制御装置は、多関節ロボットの姿勢に応じて、各軸の干渉トルクの影響を補償して、高い軌跡精度でウィービング等の動作を可能とすることができる。
次に、第5の実施の形態の変形例に係る軌跡制御装置について説明する。
図13に示すように、本変形例では、非線形項である干渉トルク補償指令値計算部200の前後に、第2の動特性演算部4400が配置されている。より詳しくは、干渉トルク補償指令値計算部200の前に動特性(21)4410が配置され、干渉トルク補償指令値計算部200の後に動特性(22)4420および動特性(22)4430が配置される。
以下、本発明の第6の実施の形態に係る軌跡制御装置について説明する。
本実施の形態においては、「動特性2」(または「所望動特性」)によって目標値から実値への動特性が決定されるため、与えられた「動特性2」にしたがって、ウィービング動作時の周期におけるゲイン特性および位相特性を逆算することが可能となる。その特性に応じてウィービング指令を補正することにより、所望のウィービング動作を実現することができるようになる。
上述した第1~第6の実施の形態のように、すなわち以下のように構成した軌跡制御装置は、多関節ロボットにおいて、高い軌跡精度でウィービング等の動作を可能とすることができる。
(1)目標値から固有振動周期を遮断するローパスフィルタ特性を与え、振動成分を目標角度から除去するとともに、非線形補償トルクについてもローパスフィルタ処理する。これにより、目標値と非線形補償トルクの位相を揃え、振動抑制しつつ非干渉化制御を行う。
(3)軸毎のサーボ制御特性の違いを、上記のローパスフィルタにて吸収することにより、軸毎の特性差を揃える。
(5)上述した対応の上、ウィービング周期毎にウィービング振幅補正を行う。
10、20、30、40 軌跡制御装置
100 関節角度指令値計算部
200 干渉トルク補償指令値計算部(非線形FF)
300 第1の動特性演算部(動特性(1))
400、2400、3400、4400 第2の動特性演算部(動特性(2))
500 フィードバック制御部(サーボ制御FB特性)
510 関節角度制御部
520 モータ電流制御部(電流制御)
Claims (7)
- 多関節ロボットに取り付けられたツールに所望の動作を行わせるように複数の関節軸をモータにより駆動する多関節ロボットの軌跡制御装置であって、
前記ツールの所望の動作を実現するための各関節軸の関節角度指令値θcを算出して出力する関節角度指令値計算部と、
前記関節角度指令値θc通りに動作した際に発生する各関節軸間で相互に作用する干渉トルクを、動力学モデルに基づいて関節角度指令値θcから算出して、干渉トルク補償指令値ccを出力する干渉トルク補償指令値計算部と、
前記多関節ロボットの固有振動周波数よりも低いカットオフ周波数を有する高周波遮断特性を備え、前記関節角度指令値θcをフィルタリング処理して、処理後の関節角度目標値θdを出力する第1の動特性演算部と、
前記関節角度目標値θdが前記モータに対する目標値として入力される関節角度制御部と、
前記第1の動特性演算部よりも低いまたは同等のカットオフ周波数を有する高周波遮断特性を備え、前記干渉トルク補償指令値計算部への入力および前記干渉トルク補償指令値計算部からの出力の少なくともいずれかをフィルタリング処理して、処理後の干渉トルク補償値cdを出力する第2の動特性演算部と、
前記関節角度制御部から出力されるモータトルク指令値に、前記干渉トルク補償値cdが加算された値が目標値として入力されるモータ電流制御部と、を含んで構成されていることを特徴とする多関節ロボットの軌跡制御装置。 - 前記関節角度制御部の応答が遅い軸の第1の動特性演算部の位相遅れを、前記関節角度制御部の応答が速い軸の第1の動特性演算部の位相遅れよりも短く与えるように構成されていることを特徴とする、請求項1に記載の多関節ロボットの軌跡制御装置。
- 前記多関節ロボットの姿勢に応じて、前記第1の動特性演算部の特性を変更するように構成されていることを特徴とする、請求項1に記載の多関節ロボットの軌跡制御装置。
- 前記多関節ロボットの姿勢に応じて、前記第1の動特性演算部の特性を変更するように構成されていることを特徴とする、請求項2に記載の多関節ロボットの軌跡制御装置。
- 各軸間の干渉がない状態での関節角度目標値θcから実際の関節角度θまでのフィードバック制御動特性を、位置フィードバックゲインおよび速度フィードバックゲインの少なくともいずれかを含むパラメータに基づいて算出するように構成され、
前記第2の動特性演算部におけるカットオフ周波数を前記第1の動特性演算部におけるカットオフ周波数よりも低くするとともに、前記第2の動特性演算部における特性を前記フィードバック制御動特性で除した特性に対応するように、前記第1の動特性演算部の特性を与えるように構成されていることを特徴とする、請求項1~請求項4のいずれか1項に記載の多関節ロボットの軌跡制御装置。 - 前記モータ電流制御部の電流制御特性を考慮する場合、前記第2の動特性演算部における特性を前記フィードバック制御動特性で除すとともに、前記電流制御特性を乗じた特性に対応するように、前記第1の動特性演算部の特性を与えるように構成されていることを特徴とする、請求項5に記載の多関節ロボットの軌跡制御装置。
- 多関節ロボットに取り付けられたツールに所望の動作を行わせるように複数の関節軸をモータにより駆動する多関節ロボットの軌跡制御方法であって、
前記ツールの所望の動作を実現するための各関節軸の関節角度指令値θcを算出して出力する関節角度指令値計算ステップと、
前記関節角度指令値θc通りに動作した際に発生する各関節軸間で相互に作用する干渉トルクを、動力学モデルに基づいて関節角度指令値θcから算出して、干渉トルク補償指令値ccを出力する干渉トルク補償指令値計算ステップと、
前記多関節ロボットの固有振動周波数よりも低いカットオフ周波数を有する高周波遮断特性を備え、前記関節角度指令値θcをフィルタリング処理して、処理後の関節角度目標値θdを出力する第1の動特性演算ステップと、
前記関節角度目標値θdが前記モータに対する目標値として入力される関節角度制御ステップと、
前記第1の動特性演算ステップよりも低いまたは同等のカットオフ周波数を有する高周波遮断特性を備え、前記干渉トルク補償指令値計算ステップへの入力および前記干渉トルク補償指令値計算ステップからの出力の少なくともいずれかをフィルタリング処理して、処理後の干渉トルク補償値cdを出力する第2の動特性演算ステップと、
前記関節角度制御ステップから出力されるモータトルク指令値に、前記干渉トルク補償値cdが加算された値が目標値として入力されるモータ電流制御ステップと、を含んで構成されていることを特徴とする多関節ロボットの軌跡制御方法。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201380028244.4A CN104334323B (zh) | 2012-05-30 | 2013-05-30 | 多关节机器人的轨迹控制装置以及控制方法 |
EP13797491.1A EP2857152B1 (en) | 2012-05-30 | 2013-05-30 | Trajectory control device for articulated robot, and control method |
US14/403,311 US9254569B2 (en) | 2012-05-30 | 2013-05-30 | Trajectory control device and control method for articulated robot |
KR1020147033244A KR101674282B1 (ko) | 2012-05-30 | 2013-05-30 | 다관절 로봇의 궤적 제어 장치 및 제어 방법 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012123240A JP5409844B2 (ja) | 2012-05-30 | 2012-05-30 | 多関節ロボットの軌跡制御装置および制御方法 |
JP2012-123240 | 2012-05-30 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2013180222A1 true WO2013180222A1 (ja) | 2013-12-05 |
Family
ID=49673409
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2013/065054 WO2013180222A1 (ja) | 2012-05-30 | 2013-05-30 | 多関節ロボットの軌跡制御装置および制御方法 |
Country Status (6)
Country | Link |
---|---|
US (1) | US9254569B2 (ja) |
EP (1) | EP2857152B1 (ja) |
JP (1) | JP5409844B2 (ja) |
KR (1) | KR101674282B1 (ja) |
CN (1) | CN104334323B (ja) |
WO (1) | WO2013180222A1 (ja) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015231663A (ja) * | 2014-06-10 | 2015-12-24 | シーメンス アクチエンゲゼルシヤフトSiemens Aktiengesellschaft | 多数の要素システムを制御調節する装置および方法 |
CN105964820A (zh) * | 2016-05-24 | 2016-09-28 | 衢州学院 | 高速重载冲压机械臂控制*** |
CN112077846A (zh) * | 2020-09-08 | 2020-12-15 | 西华大学 | 非线性机器人抗外源干扰控制器设计方法 |
CN112077847A (zh) * | 2020-09-08 | 2020-12-15 | 西华大学 | 受非匹配干扰机器人的位置跟踪控制方法 |
CN112743541A (zh) * | 2020-12-21 | 2021-05-04 | 南京埃斯顿自动化股份有限公司 | 一种无力/力矩传感器机械臂软浮动控制方法 |
Families Citing this family (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5409844B2 (ja) * | 2012-05-30 | 2014-02-05 | 株式会社神戸製鋼所 | 多関節ロボットの軌跡制御装置および制御方法 |
JP5374613B2 (ja) * | 2012-05-30 | 2013-12-25 | 株式会社神戸製鋼所 | 多関節ロボットの弾性変形補償制御装置および制御方法 |
JP5916583B2 (ja) * | 2012-10-19 | 2016-05-11 | 株式会社神戸製鋼所 | 多関節ロボットのウィービング制御装置 |
JP6381268B2 (ja) * | 2014-04-17 | 2018-08-29 | キヤノン株式会社 | ロボット制御システム及びロボットの制御方法 |
DE102015106227B3 (de) * | 2015-04-22 | 2016-05-19 | Deutsches Zentrum für Luft- und Raumfahrt e.V. | Steuern und/oder Regeln von Motoren eines Roboters |
CN107538494A (zh) * | 2016-06-29 | 2018-01-05 | 沈阳新松机器人自动化股份有限公司 | 一种基于转矩传感器和编码器的机器人控制方法及*** |
CN107662205A (zh) * | 2016-07-29 | 2018-02-06 | 深圳光启合众科技有限公司 | 机器人及其关节运动控制方法和装置 |
JP6870433B2 (ja) * | 2017-03-31 | 2021-05-12 | セイコーエプソン株式会社 | 制御装置、およびロボットシステム |
JP6998514B2 (ja) | 2017-07-11 | 2022-01-18 | パナソニックIpマネジメント株式会社 | ロボット制御装置 |
KR102436844B1 (ko) * | 2018-02-02 | 2022-08-26 | 주식회사 만도 | 모터의 토크 보상 장치 및 방법 |
CN108638056A (zh) * | 2018-04-13 | 2018-10-12 | 华南理工大学 | 基于柔体动力学模型的机器人关节振动分析与抑制方法 |
JP7183601B2 (ja) * | 2018-07-20 | 2022-12-06 | セイコーエプソン株式会社 | ロボットシステムおよびロボットシステムの制御方法 |
CN111958600B (zh) * | 2020-08-19 | 2022-03-18 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人停止过程段的振动抑制方法 |
US11845190B1 (en) * | 2021-06-02 | 2023-12-19 | Google Llc | Injecting noise into robot simulation |
CN114310917B (zh) * | 2022-03-11 | 2022-06-14 | 山东高原油气装备有限公司 | 一种油管搬运机器人关节轨迹误差补偿方法 |
KR102607486B1 (ko) * | 2023-03-24 | 2023-11-29 | 주식회사 아임토리 | 로봇팔의 진동 노이즈 제거 방법 및 장치 |
KR102607487B1 (ko) * | 2023-03-29 | 2023-11-29 | 주식회사 아임토리 | 로봇팔의 노이즈 제거 방법 및 장치 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0340008A (ja) * | 1989-07-06 | 1991-02-20 | Yaskawa Electric Mfg Co Ltd | フィードフォワード補償を用いた位置制御装置 |
JPH06250723A (ja) * | 1993-02-25 | 1994-09-09 | Komatsu Ltd | ロボットの振動低減装置 |
JPH10217173A (ja) | 1997-02-07 | 1998-08-18 | Yaskawa Electric Corp | ロボットの非干渉化制御装置 |
JPH1173211A (ja) * | 1997-08-29 | 1999-03-16 | Canon Inc | 剛物体経路制御装置 |
JPH11134012A (ja) * | 1997-10-24 | 1999-05-21 | Fanuc Ltd | 軌跡誤差補正機能を有するロボット |
Family Cites Families (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4937759A (en) * | 1986-02-18 | 1990-06-26 | Robotics Research Corporation | Industrial robot with controller |
US4975856A (en) * | 1986-02-18 | 1990-12-04 | Robotics Research Corporation | Motion controller for redundant or nonredundant linkages |
US5155423A (en) * | 1986-02-18 | 1992-10-13 | Robotics Research Corporation | Industrial robot with servo |
US4786847A (en) * | 1986-11-20 | 1988-11-22 | Unimation Inc. | Digital control for multiaxis robots |
US4999553A (en) * | 1989-12-28 | 1991-03-12 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Method and apparatus for configuration control of redundant robots |
US5179514A (en) * | 1990-08-08 | 1993-01-12 | The Research Foundation Of State University Of New York | Method and apparatus for trajectory control of robot manipulators or the like |
JPH04279901A (ja) * | 1991-03-07 | 1992-10-06 | Hitachi Ltd | 産業用ロボットの制御装置 |
JP3436320B2 (ja) * | 1994-04-18 | 2003-08-11 | 富士通株式会社 | 非線形システムの出力軌道と動特性の制御方法および装置 |
JPH087625A (ja) | 1994-06-17 | 1996-01-12 | Samutetsuku:Kk | 水槽用装飾装置 |
JP3634238B2 (ja) * | 2000-05-19 | 2005-03-30 | 本田技研工業株式会社 | 脚式移動ロボットの床形状推定装置 |
US7684896B2 (en) * | 2001-06-29 | 2010-03-23 | Honda Motor Co., Ltd. | System and method of estimating joint loads using an approach of closed form dynamics |
US7212886B2 (en) * | 2002-12-12 | 2007-05-01 | Kabushiki Kaisha Yaskawa Denki | Robot control apparatus and method |
CN100592967C (zh) * | 2003-07-29 | 2010-03-03 | 松下电器产业株式会社 | 控制机器人的方法和设备 |
EP1724653B1 (en) * | 2004-02-25 | 2014-05-07 | The Ritsumeikan Trust | Control system of floating mobile body |
US7558647B2 (en) * | 2006-01-13 | 2009-07-07 | Panasonic Corporation | Device and method for controlling robot arm, robot and program based on object-dependent impedance |
WO2007111252A1 (ja) * | 2006-03-24 | 2007-10-04 | Matsushita Electric Industrial Co., Ltd. | マニピュレータの制御方法および制御システム |
US8924021B2 (en) * | 2006-04-27 | 2014-12-30 | Honda Motor Co., Ltd. | Control of robots from human motion descriptors |
KR20090051029A (ko) * | 2006-06-14 | 2009-05-20 | 맥도널드 디트윌러 앤드 어소시에이츠 인코포레이티드 | 직각풀리 구동기구를 갖는 수술조종장치 |
US7986118B2 (en) * | 2007-04-23 | 2011-07-26 | Honda Motor Co., Ltd. | Open-loop torque control on joint position-controlled robots |
JP4836872B2 (ja) * | 2007-05-31 | 2011-12-14 | 株式会社東芝 | 制御装置、制御方法、プログラム及びロボット |
US8444631B2 (en) * | 2007-06-14 | 2013-05-21 | Macdonald Dettwiler & Associates Inc | Surgical manipulator |
JP5854695B2 (ja) * | 2010-09-22 | 2016-02-09 | キヤノン株式会社 | ロボット装置の制御方法及びロボット装置 |
JP5306313B2 (ja) * | 2010-12-20 | 2013-10-02 | 株式会社東芝 | ロボット制御装置 |
JP5778925B2 (ja) * | 2010-12-24 | 2015-09-16 | セミコンダクター・コンポーネンツ・インダストリーズ・リミテッド・ライアビリティ・カンパニー | モータ駆動回路 |
JP5374613B2 (ja) * | 2012-05-30 | 2013-12-25 | 株式会社神戸製鋼所 | 多関節ロボットの弾性変形補償制御装置および制御方法 |
JP5409844B2 (ja) * | 2012-05-30 | 2014-02-05 | 株式会社神戸製鋼所 | 多関節ロボットの軌跡制御装置および制御方法 |
-
2012
- 2012-05-30 JP JP2012123240A patent/JP5409844B2/ja active Active
-
2013
- 2013-05-30 CN CN201380028244.4A patent/CN104334323B/zh active Active
- 2013-05-30 EP EP13797491.1A patent/EP2857152B1/en active Active
- 2013-05-30 KR KR1020147033244A patent/KR101674282B1/ko active IP Right Grant
- 2013-05-30 WO PCT/JP2013/065054 patent/WO2013180222A1/ja active Application Filing
- 2013-05-30 US US14/403,311 patent/US9254569B2/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0340008A (ja) * | 1989-07-06 | 1991-02-20 | Yaskawa Electric Mfg Co Ltd | フィードフォワード補償を用いた位置制御装置 |
JPH087625B2 (ja) | 1989-07-06 | 1996-01-29 | 株式会社安川電機 | フィードフォワード補償を用いた位置制御装置 |
JPH06250723A (ja) * | 1993-02-25 | 1994-09-09 | Komatsu Ltd | ロボットの振動低減装置 |
JPH10217173A (ja) | 1997-02-07 | 1998-08-18 | Yaskawa Electric Corp | ロボットの非干渉化制御装置 |
JPH1173211A (ja) * | 1997-08-29 | 1999-03-16 | Canon Inc | 剛物体経路制御装置 |
JPH11134012A (ja) * | 1997-10-24 | 1999-05-21 | Fanuc Ltd | 軌跡誤差補正機能を有するロボット |
Non-Patent Citations (1)
Title |
---|
See also references of EP2857152A4 |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015231663A (ja) * | 2014-06-10 | 2015-12-24 | シーメンス アクチエンゲゼルシヤフトSiemens Aktiengesellschaft | 多数の要素システムを制御調節する装置および方法 |
CN105964820A (zh) * | 2016-05-24 | 2016-09-28 | 衢州学院 | 高速重载冲压机械臂控制*** |
CN112077846A (zh) * | 2020-09-08 | 2020-12-15 | 西华大学 | 非线性机器人抗外源干扰控制器设计方法 |
CN112077847A (zh) * | 2020-09-08 | 2020-12-15 | 西华大学 | 受非匹配干扰机器人的位置跟踪控制方法 |
CN112077846B (zh) * | 2020-09-08 | 2022-02-18 | 西华大学 | 非线性机器人抗外源干扰控制器设计方法 |
CN112077847B (zh) * | 2020-09-08 | 2022-02-22 | 西华大学 | 受非匹配干扰机器人的位置跟踪控制方法 |
CN112743541A (zh) * | 2020-12-21 | 2021-05-04 | 南京埃斯顿自动化股份有限公司 | 一种无力/力矩传感器机械臂软浮动控制方法 |
CN112743541B (zh) * | 2020-12-21 | 2022-03-04 | 南京埃斯顿自动化股份有限公司 | 一种无力/力矩传感器机械臂软浮动控制方法 |
Also Published As
Publication number | Publication date |
---|---|
EP2857152A1 (en) | 2015-04-08 |
KR20150006016A (ko) | 2015-01-15 |
JP5409844B2 (ja) | 2014-02-05 |
US9254569B2 (en) | 2016-02-09 |
EP2857152B1 (en) | 2017-08-02 |
JP2013248682A (ja) | 2013-12-12 |
CN104334323B (zh) | 2016-05-11 |
EP2857152A4 (en) | 2016-07-13 |
CN104334323A (zh) | 2015-02-04 |
KR101674282B1 (ko) | 2016-11-08 |
US20150112484A1 (en) | 2015-04-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5409844B2 (ja) | 多関節ロボットの軌跡制御装置および制御方法 | |
JP5374613B2 (ja) | 多関節ロボットの弾性変形補償制御装置および制御方法 | |
JP5916583B2 (ja) | 多関節ロボットのウィービング制御装置 | |
JPH02310609A (ja) | マニピユレータの位置と力の協調制御装置 | |
JP5642214B2 (ja) | 多関節ロボットの弾性変形補償制御装置 | |
WO2019049328A1 (ja) | サーボ制御装置 | |
WO2018235812A1 (ja) | ロボットシステム及びロボットシステムの制御方法 | |
JP2016032326A (ja) | モータ制御装置、ロボット装置、モータ制御方法、プログラム及び記録媒体 | |
JP4781000B2 (ja) | サーボ制御装置 | |
JP5868266B2 (ja) | 多関節ロボットの弾性変形補償制御装置および制御方法 | |
JPH06222817A (ja) | ロボットのウィービング制御装置 | |
JPH0760667A (ja) | ロボットのウィービング制御装置 | |
KR100342256B1 (ko) | 로봇제어시스템 및 그 제어방법 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
WWE | Wipo information: entry into national phase |
Ref document number: 201380028244.4 Country of ref document: CN |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 13797491 Country of ref document: EP Kind code of ref document: A1 |
|
WWE | Wipo information: entry into national phase |
Ref document number: 14403311 Country of ref document: US |
|
ENP | Entry into the national phase |
Ref document number: 20147033244 Country of ref document: KR Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
REEP | Request for entry into the european phase |
Ref document number: 2013797491 Country of ref document: EP |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2013797491 Country of ref document: EP |