JP2014028407A - ロボットの制御装置、制御方法、およびロボット - Google Patents
ロボットの制御装置、制御方法、およびロボット Download PDFInfo
- Publication number
- JP2014028407A JP2014028407A JP2012169285A JP2012169285A JP2014028407A JP 2014028407 A JP2014028407 A JP 2014028407A JP 2012169285 A JP2012169285 A JP 2012169285A JP 2012169285 A JP2012169285 A JP 2012169285A JP 2014028407 A JP2014028407 A JP 2014028407A
- Authority
- JP
- Japan
- Prior art keywords
- arm
- speed
- robot
- drive
- vibration
- 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
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
- 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
- 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/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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- 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
-
- 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/39—Robotics, robotics to robotics hand
- G05B2219/39195—Control, avoid oscillation, vibration due to low rigidity
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40549—Acceleration of end effector
Abstract
【解決手段】ロボットの制御装置、制御方法は、連結された複数のリンクを含み構成されたアーム20と、アーム20を構成するリンクを駆動する駆動部40とを有するロボットのアームの振動を抑制するロボットの制御方法であって、振動を抑制する対象の位置としての制振位置が移動するアーム実速度を検出し、検出されたアーム実速度と、駆動部40の駆動量を基に算出された、制振位置が駆動されるアーム駆動速度と、を比較して得られるアームひずみ速度を算出し、算出されたアームひずみ速度に基づいて駆動部を補正制御することを特徴とする。
【選択図】図2
Description
が継続している。それらを具現する多関節ロボットは、高速化、省電力化を実現するため
の軽量化と、高精度化を実現する高剛性化とが相反する要素であるため、制御技術として
それらの両立が図られてきた。例えば、特許文献1では、ロボットの動作が停止するとき
に発生するロボット先端の振動を抑制する方法が提案されている。具体的には、ロボット
の先端に加速度センサーを備え、検出したねじれ角速度とねじれ角度とに基づいて、ねじ
れが解消するような補償量を、各リンクを駆動するモーターの制御入力に加算することに
より制振する方法である。これにより、停止時の位置精度の向上や、振動が治まるまでの
待機時間の短縮が図られた。
生している振動を抑制することができないという課題があった。具体的には、加速度検出
のタイミングが、ロボットの動作が停止するときを前提としたものであるため、例えば、
ロボットアームが移動中に発生している振動や動作ひずみを解消することができず、ロボ
ットに塗装や溶接など、移動させながらの作業を行なわせた場合には、振動によるそれら
の作業の精度低下を抑制することができないという課題があった。
適用例または形態として実現することが可能である。
成されたアームと、前記アームを備えるロボット本体と、複数の前記リンクをそれぞれ駆
動する複数の駆動部とを有するロボット、の前記アームの振動を抑制するロボットの制御
装置であって、前記アームの振動を抑制する対象の位置としての制振位置に取り付けられ
、前記制振位置の加速度および角速度の少なくとも一方を検出する慣性センサーと、前記
制振位置と前記ロボット本体との間にある前記リンクを駆動する前記駆動部の駆動量を検
出する角度センサーと、前記慣性センサーが検出する前記制振位置の加速度および角速度
の少なくとも一方から前記制振位置のアーム実速度を算出する第1演算部と、前記角度セ
ンサーが検出する前記駆動部の駆動量から駆動速度を算出し、前記駆動量および前記駆動
速度に基づき前記制振位置のアーム駆動速度を算出する第2演算部と、前記アーム実速度
と前記アーム駆動速度とに基づき、前記制振位置の前記アーム実速度と前記アーム駆動速
度の差に対応するアームひずみ速度を算出する第3演算部と、前記アームひずみ速度に基
づき、前記ロボット本体と前記制振位置との間にある前記リンクを駆動する前記駆動部毎
の補正速度を算出する第4演算部と、前記駆動量と、前記駆動速度と、前記補正速度と、
に基づき、前記ロボット本体と前記制振位置との間にある前記リンクを駆動する前記駆動
部を制御する制御部と、を備えることを特徴とする。
の情報と、角度センサーから得られるアーム駆動速度の情報とに基づいて制振位置のアー
ムひずみ速度が算出される。また、算出されたアームひずみ速度に基づいて、ロボット本
体と制振位置との間にあるリンクを駆動する駆動部毎の補正速度が算出される。この駆動
部毎の補正速度に基づいてそれぞれの駆動部を制御することで、制振位置に発生する振動
を抑制することができる。
理想的なロボットの場合には、実際のアームの速度が、略このアーム駆動速度を示すこと
になる。これに対し、慣性センサーから得られるアーム実速度は、慣性センサーが取り付
けられた制振位置の実際の動きによって検出される速度である。つまり、理想的な剛性を
有さないアームの撓みなどにより、実際の動作に伴って発生する振動などの速度成分を含
んだ速度である。従って、アーム実速度とアーム駆動速度との差異を評価することによっ
て、撓みや振動による速度成分を抽出することができる。抽出したこの速度成分を、それ
ぞれのリンクを駆動する駆動部に補正速度として分配し、撓みや振動を抑制するトルクを
発生させることで、振動の抑制をはかることが可能となる。
止時の振動ばかりでなく、駆動時(動作中)におけるアームの振動も抑制することができ
る。その結果、駆動時のアーム位置精度をより高く制御することができる。また、停止時
の振動に対しても、アームの停止動作を待たずに抑制することができるため、停止後に振
動が治まるまでの待機時間を短縮することが出来る。
以上のように、本適用例に係るロボットの制御装置によれば、多関節ロボットなどにお
いて、より高精度化、高速化などをはかることができる。
出した前記アームひずみ速度の波形に含まれる所定の周波数以下の低周波成分を除去する
フィルターを更に備えることが好ましい。
ことにより、アーム実速度とアーム駆動速度との差異評価による振動成分の抽出をより適
確に行なえるようになる。具体的には、アームひずみ速度の低周波成分を除去することに
より、ロボットアームの本来の動作を抑制するような補正が誤って行なわれることや、慣
性センサーのオフセット誤差などの影響を軽減できるようになる。
成されたアームと、前記リンクを駆動する駆動部とを有するロボット、の前記アームの振
動を抑制するロボットの制御方法であって、前記アームの振動を抑制する対象の位置とし
ての制振位置が移動する速度であるアーム実速度を検出するステップと、検出された前記
アーム実速度と、前記駆動部の駆動量を基に算出された、前記制振位置が駆動される速度
であるアーム駆動速度と、を比較して得られる前記アーム実速度と前記アーム駆動速度の
差に対応するアームひずみ速度を算出するステップと、算出された前記アームひずみ速度
に基づいて前記駆動部を補正制御するステップと、を含むことを特徴とする。
して得られるアームひずみ速度を算出するステップと、算出されたアームひずみ速度に基
づいて駆動部を補正制御するステップとを含むことにより、ロボットの動作中における振
動を抑制することができる。その結果、駆動時(動作中)のアーム位置精度をより高く制
御することができる。また、停止時の振動に対しても、アームの停止動作を待たずに抑制
することができるため、停止後に振動が治まるまでの待機時間を短縮することが出来る。
つまり、本適用例に係るロボットの制御方法によれば、多関節ロボットなどにおいて、よ
り高精度化、高速化などをはかることができる。
成されたアームと、前記アームを備えるロボット本体と、複数の前記リンクをそれぞれ駆
動する複数の駆動部とを有するロボット、の前記アームの振動を抑制するロボットの制御
方法であって、前記アームの振動を抑制する対象の位置としての制振位置に取り付けられ
た慣性センサーによって前記制振位置の加速度および角速度の少なくとも一方を検出する
慣性量検出ステップと、前記制振位置と前記ロボット本体との間にある前記リンクを駆動
する前記駆動部の駆動量を角度センサーによって検出する駆動量検出ステップと、前記慣
性センサーが検出する前記制振位置の加速度および角速度の少なくとも一方から前記制振
位置のアーム実速度を算出するアーム実速度算出ステップと、前記角度センサーが検出す
る前記駆動部の駆動量から駆動速度を算出し、前記駆動量および前記駆動速度に基づき前
記制振位置のアーム駆動速度を算出するアーム駆動速度算出ステップと、前記アーム実速
度と前記アーム駆動速度とに基づき前記制振位置のアームひずみ速度を算出するアームひ
ずみ速度算出ステップと、前記アームひずみ速度に基づき、前記ロボット本体と前記制振
位置との間にある前記リンクを駆動する前記駆動部毎の補正速度を算出するひずみ補正速
度算出ステップと、前記駆動量と、前記駆動速度と、前記補正速度と、に基づき、前記ロ
ボット本体と前記制振位置との間にある前記リンクを駆動する前記駆動部を制御する駆動
部制御ステップと、を含むことを特徴とする。
の情報と、角度センサーから得られるアーム駆動速度の情報とに基づいて制振位置のアー
ムひずみ速度が算出される。また、算出されたアームひずみ速度に基づいて、ロボット本
体と制振位置との間にあるリンクを駆動する駆動部毎の補正速度が算出される。この駆動
部毎の補正速度に基づいてそれぞれの駆動部を制御することで、制振位置に発生する振動
を抑制することができる。
理想的なロボットの場合には、実際のアームの速度が、略このアーム駆動速度を示すこと
になる。これに対し、慣性センサーから得られるアーム実速度は、慣性センサーが取り付
けられた制振位置の実際の動きによって検出される速度である。つまり、理想的な剛性を
有さないアームの撓みなどにより、実際の動作に伴って発生する振動などの速度成分を含
んだ速度である。従って、アーム実速度とアーム駆動速度との差異を評価することによっ
て、振動による速度成分を抽出することができる。抽出したこの振動の速度成分を、それ
ぞれのリンクを駆動する駆動部に補正速度として分配し、振動を抑制するトルクを発生さ
せることで、振動の抑制をはかることが可能となる。
止時の振動ばかりでなく、駆動時(動作中)におけるアームの振動も抑制することができ
る。その結果、駆動時のアーム位置精度をより高く制御することができる。また、停止時
の振動に対しても、アームの停止動作を待たずに抑制することができるため、停止後に振
動が治まるまでの待機時間を短縮することが出来る。
以上のように、本適用例に係るロボットの制御方法によれば、多関節ロボットなどにお
いて、より高精度化、高速化などをはかることができる。
出ステップには、算出した前記アームひずみ速度の波形に含まれる所定の周波数以下の低
周波成分を除去する低周波成分除去ステップを更に含むことが好ましい。
を更に含むことにより、アーム実速度とアーム駆動速度との差異評価による振動成分の抽
出をより適確に行なえるようになる。具体的には、アームひずみ速度の低周波成分を除去
することにより、ロボットアームの本来の動作を抑制するような補正が誤って行なわれる
ことや、慣性センサーのオフセット誤差などの影響を軽減できるようになる。
ステップは、前記制振位置と前記ロボット本体との間にある前記リンクを駆動する前記駆
動部のうち、予め選択した駆動部を対象に行なうことが好ましい。
要が無い駆動部がわかっている場合や、意図して制御を行わない駆動部がある場合などに
、その駆動部を制御の対象から外しておくことで、各ステップの処理がより簡略化され、
処理スピードをあげるなど、より効率的に処理を行なうことができる。
において、前記ロボット本体と前記制振位置との間にある前記リンクを駆動する前記駆動
部毎の補正速度の算出は、予め設定した前記駆動部毎の重み付けを伴って行なうことが好
ましい。
定した駆動部毎の重み付けで配分することにより、ロボットの仕様や特性、またはロボッ
トに行なわせる作業負荷(例えば、ロボットハンドが保持する物の重さなど)に合わせて
、より効果的な振動の抑制制御を行なうことができる。具体的には、例えば、ロボット本
体に近い部分の駆動部の制振トルクをより大きく設定することで、振動の抑制をより効果
的に行なうことができたり、ロボットの一連の動作の中で、ロボットハンドが保持する物
が変わり、重さが変化する場合などにおいて、振動の抑制をより効果的に行なうことがで
きたりする。
制御装置を備えることを特徴とする。
ボットの動作中に発生している振動をより効果的に抑制することができるようになる。そ
の結果、より高精度化、高速化などがはかられたロボットを提供することができる。例え
ば、アームを移動させながら高精度の作業を行なわせる場合などにおいて、振動によるそ
れらの作業の精度低下を抑制することができる。
明の一実施形態であって、本発明を限定するものではない。なお、以下の各図においては
、説明を分かりやすくするため、実際とは異なる尺度で記載している場合がある。
まず、実施形態1に係るロボットの制御装置および制御方法について説明する。
図1は、実施形態1に係るロボットの制御装置を搭載するロボット200のリンクモデ
ルを示す概略図である。なお、図1において、ロボットの制御装置は図示を省略している
。
ロボット200は、6軸の多関節ロボットであり、連結された6つのリンク10(10
a〜10f)を含み構成されたアーム20と、アーム20を備えるロボット本体30と、
リンク10をそれぞれ駆動する6つの駆動部40(40a〜40f)などから構成されて
いる。
以下、“アーム”は、“複数のリンクが連結された構造体”として説明する。また、そ
れぞれのリンクを連結する関節としての連結部は、それぞれのリンクを駆動する機能を持
つ駆動部として説明する。
され、アーム20の一方の端部を構成するリンク10fの先端部は、ハンド部としてハン
ドツールや溶接ガン、スプレーガンなど(図示省略)が備えられる。
アーム20の他方の端部は、駆動部40aを介してロボット本体30に連結されている
。
駆動部40a,40d,40fは、連結するリンク10a,10d,10fの軸を回転
駆動させるモーターを備えている。
駆動部40b,40c,40eは、連結するリンク10b,10c,10eの連結角度
が変わるようにリンクを回動させるモーターを備えている。
支持される片持ち構造であるため、アーム20には、構造体としてのアーム20の剛性や
動作スピード、ハンド部の重量負荷などに応じた撓みや、撓みによる振動が発生する。ア
ーム20の動作位置精度の向上や、動作のスピードアップなどを図る場合に、予めこの撓
み量や振動を考慮したプログラミングにより、位置精度を向上させ、また高速な動作の位
置制御を行なうこともできるが、その場合のプログラミングの負荷が大きく、あるいは動
作解析など大きな困難が伴う。そのため、動作中に発生する撓みや振動を検知しながら、
それらを抑制する制御を行なうことがより簡便であり好ましい。
本実施形態に係るロボットの制御装置は、この制御機能を有している。以下にその機能
について説明する。
図である。
制振装置100は、動作中の、あるいは停止時のロボット200において、アーム20
に発生する撓みや振動(以下“撓みや振動”を、撓みも含めて“振動”という)を抑制す
るロボットの制御装置であって、角度センサーとしてのエンコーダー50(50a〜50
f)、慣性センサー60、演算制御部80などから構成される。
エンコーダー50(50a〜50f)は、駆動部40a〜40fが備えるモーターのそ
れぞれの回転角度θ1〜θ6、つまり駆動部40の駆動量を検出する。
慣性センサー60は、6軸センサーであり、取り付け位置の加速度および角速度を検出
する。つまり、慣性センサー60は、図1においてX,Y,Z軸方向の加速度(x”,y
”,z”)、およびX,Y,Z軸まわりの角速度(Rx’,Ry’,Rz’)を検出する
。
制振装置100では、慣性センサー60を、アーム20の振動を抑制する対象の位置と
しての制振位置に取り付ける。ロボット200は、慣性センサー60をリンク10f(つ
まり、アーム20の先端部のリンク)に取り付けた例を示している。
演算制御部80は、第1演算部81〜第4演算部84、制御部85、およびヤコビ行列
演算部87などから構成される。
第1演算部81は、慣性センサー60が検出する制振位置の加速度および角速度から制
振位置のアーム実速度を算出する。
第2演算部82は、エンコーダー50が検出する駆動部40の駆動量から駆動速度を算
出し、駆動速度および制振位置に対応するヤコビ行列Jに基づき制振位置のアーム駆動速
度を算出する。ヤコビ行列Jは、ヤコビ行列演算部87において、エンコーダー50が検
出する駆動量情報などに基づき算出される。
第3演算部83は、第1演算部81が算出したアーム実速度と、第2演算部82が算出
したアーム駆動速度に基づき制振位置のアームひずみ速度を算出する。また、第3演算部
83には、フィルター86を備え、算出したアームひずみ速度の波形に含まれる所定の周
波数以下の低周波成分を除去している。本実施形態では、所定の周波数として、1Hzに
設定し、1Hz以下の低周波成分を除去している。フィルター86は、HPF(High Pas
s Filter)により構成されている。
第4演算部84は、第3演算部83が算出したアームひずみ速度に基づき、逆ヤコビ行
列J-1によってロボット本体30と制振位置との間にあるリンク10を駆動する駆動部4
0毎の補正速度を算出する。逆ヤコビ行列J-1は、ヤコビ行列演算部87において、エン
コーダー50が検出する駆動量情報などに基づき算出される。
制御部85は、第4演算部84が算出した補正速度に基づき、ロボット本体30と制振
位置との間にあるリンク10を駆動する駆動部40を制御する。
すフローチャートである。
図3のフローチャートを参照し、図1に示すロボット200のリンクモデルを対象とし
て演算制御部80、および演算制御部80による制振方法について具体的に説明する。
離など)、慣性センサー60が取り付けられたロボット200における制振位置の情報、
エンコーダー50(50a〜50f)が検出する回転角度θ1〜θ6などに基づいて、制振
位置に対応するヤコビ行列Jを求める(ステップS1)。
次に、ヤコビ行列Jの逆行列を演算して逆ヤコビ行列J-1を求める(ステップS2)。
ヤコビ行列Jおよび逆ヤコビ行列J-1は、以下に示す関係式を満たす。
置の加速度および角速度
(x1”,y1”,z1”、Rx1’,Ry1’,Rz1’)
から制振位置のアーム実速度
(x1’,y1’,z1’、Rx1’,Ry1’,Rz1’)
を算出する(ステップS4)。
次に、第2演算部82において、エンコーダー50が検出(ステップS5)する駆動部
40a〜40fの駆動量(回転角度θ1〜θ6)から駆動速度θ’
(θ’1,θ’2,θ’3,θ’4,θ’5,θ’6)
を算出し(ステップS6)、駆動速度および制振位置に対応するヤコビ行列Jに基づき制
振位置のアーム駆動速度
(x2’,y2’,z2’、Rx2’,Ry2’,Rz2’)
を算出する(ステップS7)。
部82が算出したアーム駆動速度の差異を演算して、制振位置のアームひずみ速度
(x1’−x2’,y1’−y2’,z1’−z2’、Rx1’−Rx2’,Ry1’−R
y2’,Rz1’−Rz2’)
を算出し(ステップS8)、第3演算部83に備えるフィルター86により、算出したア
ームひずみ速度の波形に含まれる所定の周波数以下の低周波成分を除去する(ステップS
9)。具体的には、本実施形態ではHPFによって、1Hz以下を除去する。
、逆ヤコビ行列J-1によってロボット本体30と制振位置との間にあるリンク10を駆動
する駆動部40毎の補正速度θ’r(θ’r1〜θ’r6)を算出する(ステップS10)
。補正速度θ’r(θ’r1〜θ’r6)は、以下に示す関係式を満たす。
’rとに基づき、ロボット本体30と制振位置との間にあるリンク10を駆動する駆動部
40に対してフィードバック制御を行なう(ステップS11)。具体的には、駆動部40
a〜40fの各々に分配された補正速度θ’r(θ’r1〜θ’r6)を打ち消す方向のト
ルクが発生するように、それぞれの駆動部40a〜40fが備えるモーターを制御する。
次に、制御を終了するか否かを判断し(ステップS12)、引き続きロボットの制御を
継続する場合には、ステップS1に戻る。
効果を得ることができる。
慣性センサー60から得られるアーム実速度の情報と、エンコーダー50から得られる
アーム駆動速度の情報とに基づいて制振位置のアームひずみ速度が算出される。また、算
出されたアームひずみ速度に基づいて、ロボット本体30と制振位置との間にあるリンク
10を駆動する駆動部40毎の補正速度が算出される。この駆動部40毎の補正速度に基
づいてそれぞれの駆動部40を制御することで、制振位置に発生する振動を抑制すること
ができる。
複数の駆動部40を制御する指令(例えば、予めプログラミングされた指令)に追従する
ように制御される駆動量から算出される速度であるため、動作に伴いアーム20に発生す
る振動などによる速度成分の非常に少ない速度である。つまり、軽量で剛性が高く、撓み
や撓みによる振動などが無い理想的なロボットの場合には、実際のアーム20の速度が、
略このアーム駆動速度を示すことになる。
これに対し、慣性センサー60から得られるアーム実速度は、慣性センサー60が取り
付けられた制振位置の実際の動きによって検出される速度である。つまり、理想的な剛性
を有さないアーム20の撓みなどにより、実際の動作に伴って発生する振動などの速度成
分を含んだ速度である。従って、アーム実速度とアーム駆動速度との差異を評価すること
によって、振動による速度成分を抽出することができる。抽出したこの振動の速度成分を
、それぞれのリンク10を駆動する駆動部40に補正速度として分配し、振動を抑制する
トルクを発生させることで、振動の抑制をはかることが可能となる。
止時の振動ばかりでなく、駆動時(動作中)におけるアーム20の振動も抑制することが
できる。その結果、駆動時のアーム位置精度をより高く制御することができる。また、停
止時の振動に対しても、アーム20の停止動作を待たずに抑制することができるため、停
止後に振動が治まるまでの待機時間を短縮することが出来る。
ィルター86を更に備えることにより、アーム実速度とアーム駆動速度との差異評価によ
る振動成分の抽出をより適確に行なえるようになる。具体的には、アームひずみ速度の低
周波成分を除去することにより、アーム20の本来の動作を抑制するような補正が誤って
行なわれることや、慣性センサー60のオフセット誤差などの影響を軽減できるようにな
る。
節ロボットなどにおいて、より高精度化、高速化などをはかることができる。
に含まれる所定の周波数以下の低周波成分として1Hz以下の低周波成分を除去している
と説明したが、必ずしも1Hz以下である必要はない。制振位置の制振状況に応じて適宜
決定することが望ましい。また、必ずしもフィルター86を備える必要はない。例えば、
算出したアームひずみ速度に除去すべき低周波成分が無い場合や、無視できる場合などに
おいては、フィルター86を省くことが可能である。
また、ヤコビ行列Jおよび逆ヤコビ行列J-1は、ヤコビ行列演算部87において、エン
コーダー50が検出する駆動量情報などに基づき算出すると説明したが、必ずしもロボッ
ト200の稼動中に演算しながら求める必要はない。例えば、予め制振するタイミングを
定めておき、そのタイミングに合わせたヤコビ行列Jおよび逆ヤコビ行列J-1を予めテー
ブルとして準備しておき、制振するタイミングに合わせて都度対応するヤコビ行列Jや逆
ヤコビ行列J-1を選択する方法であっても良い。この場合には、演算制御部80にヤコビ
行列演算部87を備えておく必要はない。
次に、実施形態2に係るロボットの制御装置および制御方法について説明する。なお、
説明にあたり、上述した実施形態と同一の構成部位については、同一の符号を使用し、重
複する説明は省略する。
図4は、実施形態2に係るロボットの制御装置を搭載するロボット201のリンクモデ
ルを示す概略図である。
ロボット201は、制振装置101(図示省略)を搭載するロボット200と同様の6
軸の多関節ロボットである。
制振装置101は、慣性センサーとして3軸の角速度(Rx’,Ry’,Rz’)を検
出するジャイロセンサー(以下慣性センサー61)を用いている点を除き、制振装置10
0と同じである。また、本実施形態では、慣性センサー61は、リンク10dに取り付け
られている。つまり、実施形態1では、慣性センサー60がリンク10fに取り付けられ
、アーム20の先端部分の振動を抑制させたのに対し、本実施形態では、慣性センサー6
1を4番目のリンク10dに取り付け、アーム20の中程を制振位置としている。また、
実施形態1では、慣性センサー60が6軸の加速度および角速度センサーであったのに対
して、本実施形態では、3軸の角速度(Rx’,Ry’,Rz’)を検出するジャイロセ
ンサーを用いている。実施形態2は、これらの点を除き、実施形態1と同じである。
り付けられている制振位置からロボット本体30側にある駆動部に対して行なう。つまり
、3軸の角速度情報に基づき、自由度が1つ多い駆動部40a〜40dの4つの駆動部に
対して制御を行なう。このように、冗長性のある制御の場合は、重み付き疑似逆行列によ
って制御を配分する。
本実施形態に対応するヤコビ行列J1および重み付き疑似逆行列J1 #を以下に示す。
J1 #-=W-1J1 T(J1 TW-1J1 T)-1
J1 #は、これによって求められる駆動部40a〜40dの各々に分配された補正速度θ
’r(θ’r1〜θ’r4)の重みを付けた自乗和が最小となる行列である。つまり、自由
度分について、振動を抑制するための動きを最小の値としている。
また、Wは4×4の重み付け行列である。つまり、駆動部40a〜40dの各々に分配
する補正速度θ’rの値に重み付けを行なっている。
制振装置101および制振方法は、逆ヤコビ行列J-1に代わり重み付き疑似逆行列J1 #
を使用する点を除き、実施形態1の場合と同様である。
、慣性センサーを取り付ける位置を変えることで、同様に振動の抑制を行なうことができ
る。
また、駆動部40毎の補正速度の大きさを、予め設定した駆動部40毎の重み付けで配
分することにより、ロボット201の仕様や特性、またはロボット201に行なわせる作
業負荷(例えば、ロボットハンドが保持する物の重さなど)に合わせて、より効果的な振
動の抑制制御を行なうことができる。具体的には、例えば、ロボット本体30に近い部分
の駆動部40の制振トルクをより大きく設定することで、振動の抑制をより効果的に行な
うことができたり、ロボット201の一連の動作の中で、ロボットハンドが保持する物が
変わり、重さが変化する場合などにおいて、振動の抑制をより効果的に行なうことができ
たりする。
次に、実施形態3に係るロボットの制御装置および制御方法について説明する。なお、
説明にあたり、上述した実施形態と同一の構成部位については、同一の符号を使用し、重
複する説明は省略する。
図5は、実施形態3に係るロボットの制御装置を搭載するロボット202のリンクモデ
ルを示す概略図である。
ロボット202は、制振装置102(図示省略)を搭載する双腕の多関節ロボットであ
り、7軸双腕を成す2本のアーム21、旋回アーム22、ロボット本体30、制振装置1
02などを含み構成されている。
されている。アーム21の一方の端部を構成するリンク11hの先端部は、ハンド部とし
てハンドツールや溶接ガン、スプレーガンなど(図示省略)が備えられる。
旋回アーム22は、リンク11aと駆動部41aなどから構成され、リンク11aの一
方の端部は、駆動部41aを介してロボット本体30に連結され、他方の端部は、2つの
駆動部41bを介してそれぞれの駆動部41bに連結される2つのアーム21を支持して
いる。つまり、アーム21の他方の端部は、駆動部41bを介して旋回アーム22に連結
されている。
駆動部41a,41b,41d,41f,41hは、連結するリンク11a,11b,
11d,11f,11hの軸を回転駆動させるモーターを備えている。
駆動部41c,41e,41gは、連結するリンク11c,11e,11gの連結角度
が変わるようにリンクを回動させるモーターを備えている。
ンコーダー50a〜50hを備えている。
エンコーダー50(50a〜50h)は、駆動部41a〜41hが備えるモーターのそ
れぞれの回転角度θ1〜θ8を検出する。
また、慣性センサー61が、アーム21のそれぞれのリンク11eに取り付けられてい
る。
1に対して独立して行なう。従って、制振装置102は、2つの制振装置101が並列処
理されるように構成されている。
なお、制振装置102は、このような構成(2つの制振装置101を備えて並列して処
理する構成)ではなく、1つの制振装置101を、それぞれのアーム21に対してタイム
シェアリングする方法であっても良い。つまり、1つの制振装置101による処理を、2
つのアーム21に対して切り替えながら独立して行なう構成としても良い。
また、本実施形態における振動を抑制するための状態フィードバック制御は、それぞれ
のアーム21に共通する旋回アーム22に対しては行なわない。つまり、それぞれのアー
ム21が備える慣性センサー61が検出する3軸の角速度情報に基づき、駆動部41b〜
41eの4つの駆動部に対して制御を行なう。
本実施形態に対応するヤコビ行列J2および重み付き疑似逆行列J3 #を以下に示す。
行列であるので、3×5の行列で与えられる。これに対して、制御を行なう対象の駆動部
は、駆動部41b〜41eの4軸(θ2〜θ5)であるため、重み付き疑似逆行列J3 #は、
4軸(θ2〜θ5)を対象とした3×5のヤコビ行列J3を用いて以下の関係式により求め
られる。
J3 #-=W-1J2 T(J2 TW-1J2 T)-1
J3 #は、これによって求められる駆動部41b〜41eの各々に分配された補正速度θ
’r(θ’r2〜θ’r5)の重みを付けた自乗和が最小となる行列である。つまり、実施
形態2と同様に自由度分について、振動を抑制するための動きを最小の値としている。
合や、意図して制御を行わない駆動部がある場合などに、その駆動部を制御の対象から外
しておくことで、各ステップの処理がより簡略化され、処理スピードをあげるなど、より
効率的に処理を行なうことができる。
次に、上述した実施形態におけるロボットをより具体的に示す実施形態4に係るロボッ
トについて説明する。なお、説明にあたり、上述した実施形態と同一の構成部位について
は、同一の符号を使用し、重複する説明は省略する。
図6は、実施形態4に係るロボット203の概略図である。
ロボット203は、制振装置102を搭載する双腕の多関節ロボットであり、2本のア
ーム23、旋回アーム24、ハンド70、ロボット本体30、制振装置102などを含み
構成されている。
ム23の一方の端部に駆動部43dを介してハンド70が備えられている。ハンド70は
、所定の物体を把持する機能を有している。
旋回アーム24は、リンク13aと駆動部43aなどから構成され、リンク13aの一
方の端部は、駆動部43aを介してロボット本体30に連結され、他方の端部は、2つの
駆動部43bを介してそれぞれの駆動部43bに連結される2つのアーム23を支持して
いる。つまり、アーム23の他方の端部は、駆動部43bを介して旋回アーム24に連結
されている。
3cを回動させるモーターを備えている。
駆動部43a,43dは、それぞれが連結するリンク13a、ハンド70の軸を回転駆
動させるモーターを備えている。
また、それぞれの駆動部43a〜43dは、その駆動量(モーターの回転角度)を検出
するエンコーダー50a〜50dを備えている。
慣性センサー61は、アーム23のそれぞれのリンク13cに取り付けられている。
3を支持し、床などに設置される。またロボット本体30の内部には、制振装置102な
どを含むロボットコントローラー31が備えられている。
ロボットコントローラー31は、制振装置102などの制御を含み、ロボット203全
体の制御を行なう。
ため、上述したロボットの制御方法と同様に、動作中のアーム23に発生する振動を抑制
することができる。その結果、高精度で高速な動作がフレキシブルに可能な多関節ロボッ
トとしての機能をより一層高めたロボットを提供することができる。例えば、ハンド70
にスプレーガンなどを装着して塗装対象物に塗装する場合などにおいて、アーム23に発
生する振動による塗装むらが発生する傾向がある場合などにおいて、その振動を抑制する
ことによって、塗装むらを軽減することなどが可能となる。
40…駆動部、50…エンコーダー、60…慣性センサー、70…ハンド、80…演算制
御部、81〜84…第1〜第4演算部、85…制御部、86…フィルター、87…ヤコビ
行列演算部、100…制振装置、200…ロボット。
Claims (8)
- 連結された複数のリンクを含み構成されたアームと、前記アームを備えるロボット本体
と、複数の前記リンクをそれぞれ駆動する複数の駆動部とを有するロボット、の前記アー
ムの振動を抑制するロボットの制御装置であって、
前記アームの振動を抑制する対象の位置としての制振位置に取り付けられ、前記制振位
置の加速度および角速度の少なくとも一方を検出する慣性センサーと、
前記制振位置と前記ロボット本体との間にある前記リンクを駆動する前記駆動部の駆動
量を検出する角度センサーと、
前記慣性センサーが検出する前記制振位置の加速度および角速度の少なくとも一方から
前記制振位置のアーム実速度を算出する第1演算部と、
前記角度センサーが検出する前記駆動部の駆動量から駆動速度を算出し、前記駆動量お
よび前記駆動速度に基づき前記制振位置のアーム駆動速度を算出する第2演算部と、
前記アーム実速度と前記アーム駆動速度とに基づき、前記制振位置の前記アーム実速度
と前記アーム駆動速度の差に対応するアームひずみ速度を算出する第3演算部と、
前記アームひずみ速度に基づき、前記ロボット本体と前記制振位置との間にある前記リ
ンクを駆動する前記駆動部毎の補正速度を算出する第4演算部と、
前記駆動量と、前記駆動速度と、前記補正速度と、に基づき、前記ロボット本体と前記
制振位置との間にある前記リンクを駆動する前記駆動部を制御する制御部と、を備えるこ
とを特徴とするロボットの制御装置。 - 前記第3演算部には、算出した前記アームひずみ速度の波形に含まれる所定の周波数以
下の低周波成分を除去するフィルターを更に備えることを特徴とする請求項1に記載のロ
ボットの制御装置。 - 連結された複数のリンクを含み構成されたアームと、前記リンクを駆動する駆動部とを
有するロボット、の前記アームの振動を抑制するロボットの制御方法であって、
前記アームの振動を抑制する対象の位置としての制振位置が移動する速度であるアーム
実速度を検出するステップと、
検出された前記アーム実速度と、前記駆動部の駆動量を基に算出された、前記制振位置
が駆動される速度であるアーム駆動速度と、を比較して得られる前記アーム実速度と前記
アーム駆動速度の差に対応するアームひずみ速度を算出するステップと、
算出された前記アームひずみ速度に基づいて前記駆動部を補正制御するステップと、を
含むことを特徴とするロボットの制御方法。 - 連結された複数のリンクを含み構成されたアームと、前記アームを備えるロボット本体
と、複数の前記リンクをそれぞれ駆動する複数の駆動部とを有するロボット、の前記アー
ムの振動を抑制するロボットの制御方法であって、
前記アームの振動を抑制する対象の位置としての制振位置に取り付けられた慣性センサ
ーによって前記制振位置の加速度および角速度の少なくとも一方を検出する慣性量検出ス
テップと、
前記制振位置と前記ロボット本体との間にある前記リンクを駆動する前記駆動部の駆動
量を角度センサーによって検出する駆動量検出ステップと、
前記慣性センサーが検出する前記制振位置の加速度および角速度の少なくとも一方から
前記制振位置のアーム実速度を算出するアーム実速度算出ステップと、
前記角度センサーが検出する前記駆動部の駆動量から駆動速度を算出し、前記駆動量お
よび前記駆動速度に基づき前記制振位置のアーム駆動速度を算出するアーム駆動速度算出
ステップと、
前記アーム実速度と前記アーム駆動速度とに基づき前記制振位置のアームひずみ速度を
算出するアームひずみ速度算出ステップと、
前記アームひずみ速度に基づき、前記ロボット本体と前記制振位置との間にある前記リ
ンクを駆動する前記駆動部毎の補正速度を算出するひずみ補正速度算出ステップと、
前記駆動量と、前記駆動速度と、前記補正速度と、に基づき、前記ロボット本体と前記
制振位置との間にある前記リンクを駆動する前記駆動部を制御する駆動部制御ステップと
、を含むことを特徴とするロボットの制御方法。 - 前記アームひずみ速度算出ステップには、算出した前記アームひずみ速度の波形に含ま
れる所定の周波数以下の低周波成分を除去する低周波成分除去ステップを更に含むことを
特徴とする請求項4に記載のロボットの制御方法。 - 前記ひずみ補正速度算出ステップは、前記制振位置と前記ロボット本体との間にある前
記リンクを駆動する前記駆動部のうち、予め選択した駆動部を対象に行なうことを特徴と
する請求項4または請求項5に記載のロボットの制御方法。 - 前記ひずみ補正速度算出ステップにおいて、前記ロボット本体と前記制振位置との間に
ある前記リンクを駆動する前記駆動部毎の補正速度の算出は、予め設定した前記駆動部毎
の重み付けを伴って行なうことを特徴とする請求項4ないし請求項6のいずれか一項に記
載のロボットの制御方法。 - 請求項1または請求項2に記載のロボットの制御装置を備えることを特徴とするロボッ
ト。
Priority Applications (7)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012169285A JP6083145B2 (ja) | 2012-07-31 | 2012-07-31 | ロボットの制御装置、およびロボット |
TW102126977A TWI577515B (zh) | 2012-07-31 | 2013-07-26 | 機器人之控制裝置、控制方法及機器人 |
CN201310322411.8A CN103568013B (zh) | 2012-07-31 | 2013-07-29 | 机器人的控制装置、控制方法以及机器人 |
US13/953,120 US9095979B2 (en) | 2012-07-31 | 2013-07-29 | Control device and control method for robot and the robot |
EP13178508.1A EP2692488B1 (en) | 2012-07-31 | 2013-07-30 | Control device and control method for robot and the robot |
KR1020130090028A KR20140016839A (ko) | 2012-07-31 | 2013-07-30 | 로봇의 제어 장치, 제어 방법 및 로봇 |
US14/790,778 US20150306765A1 (en) | 2012-07-31 | 2015-07-02 | Control device and control method for robot and the robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012169285A JP6083145B2 (ja) | 2012-07-31 | 2012-07-31 | ロボットの制御装置、およびロボット |
Publications (3)
Publication Number | Publication Date |
---|---|
JP2014028407A true JP2014028407A (ja) | 2014-02-13 |
JP2014028407A5 JP2014028407A5 (ja) | 2015-08-13 |
JP6083145B2 JP6083145B2 (ja) | 2017-02-22 |
Family
ID=48875612
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2012169285A Active JP6083145B2 (ja) | 2012-07-31 | 2012-07-31 | ロボットの制御装置、およびロボット |
Country Status (6)
Country | Link |
---|---|
US (2) | US9095979B2 (ja) |
EP (1) | EP2692488B1 (ja) |
JP (1) | JP6083145B2 (ja) |
KR (1) | KR20140016839A (ja) |
CN (1) | CN103568013B (ja) |
TW (1) | TWI577515B (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015085421A (ja) * | 2013-10-30 | 2015-05-07 | セイコーエプソン株式会社 | ロボット、制御装置、ロボットシステム |
JP2016177513A (ja) * | 2015-03-19 | 2016-10-06 | オークマ株式会社 | タンデム位置制御装置 |
JP2019195892A (ja) * | 2018-05-11 | 2019-11-14 | 川崎重工業株式会社 | 撓み量推定装置、ロボット制御装置、及び撓み量推定方法 |
Families Citing this family (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5652042B2 (ja) | 2010-08-06 | 2015-01-14 | セイコーエプソン株式会社 | ロボット装置、ロボット装置の制御方法およびプログラム |
JP2014034101A (ja) * | 2012-08-10 | 2014-02-24 | Toshiba Corp | ロボット制御装置 |
JP6111562B2 (ja) * | 2012-08-31 | 2017-04-12 | セイコーエプソン株式会社 | ロボット |
JP2015150630A (ja) * | 2014-02-13 | 2015-08-24 | セイコーエプソン株式会社 | ロボット |
CN104669244A (zh) | 2013-12-02 | 2015-06-03 | 精工爱普生株式会社 | 机器人 |
US9718187B2 (en) * | 2014-06-11 | 2017-08-01 | Canon Kabushiki Kaisha | Robot controlling method, robot apparatus, program, recording medium, and method for manufacturing assembly component |
US9873198B2 (en) * | 2014-10-06 | 2018-01-23 | The Johns Hopkins University | Active vibration damping device |
CN104537944B (zh) * | 2014-12-30 | 2017-09-26 | 浙江钱江机器人有限公司 | 一种六轴机器人的六连杆示教装置 |
JP6575200B2 (ja) * | 2015-07-27 | 2019-09-18 | セイコーエプソン株式会社 | ロボット、制御装置およびロボットシステム |
JP6088601B2 (ja) * | 2015-08-10 | 2017-03-01 | ファナック株式会社 | 走行軸付きロボットにおけるツール先端の振れを抑制するロボット制御装置 |
JP6771288B2 (ja) * | 2016-02-17 | 2020-10-21 | 株式会社神戸製鋼所 | 溶接装置及び溶接装置の制御方法 |
CN105953792B (zh) * | 2016-04-27 | 2018-08-31 | 宁夏巨能机器人系统有限公司 | 一种多关节机器人定位精度的检测装置及其检测方法 |
JP2017196704A (ja) * | 2016-04-28 | 2017-11-02 | セイコーエプソン株式会社 | 可動部の振動測定方法、ロボットの振動測定方法および制御装置 |
US10350754B2 (en) * | 2016-09-27 | 2019-07-16 | Denso Wave Incorporated | Control device for robot |
JP6711536B2 (ja) * | 2016-10-28 | 2020-06-17 | アズビル株式会社 | 外力検出方法 |
JP6895242B2 (ja) * | 2016-11-25 | 2021-06-30 | 株式会社東芝 | ロボット制御装置、ロボット制御方法及びピッキング装置 |
CN106863303A (zh) * | 2017-03-04 | 2017-06-20 | 安凯 | 一种焊接机械手及其路径学习方法 |
EP4072040A1 (en) * | 2017-06-01 | 2022-10-12 | Panasonic Intellectual Property Corporation of America | Reception device and reception method |
US11207778B2 (en) * | 2017-06-30 | 2021-12-28 | Siemens Industry Software Ltd. | Method and system for determining joint values of an external axis in robot manufacturing |
JP7007839B2 (ja) * | 2017-08-31 | 2022-01-25 | 川崎重工業株式会社 | 多関節ロボット |
CN109591050A (zh) * | 2017-09-30 | 2019-04-09 | 西门子公司 | 安全跟踪系统、装置、方法、存储介质及安全系统 |
JP6698733B2 (ja) * | 2018-04-06 | 2020-05-27 | ファナック株式会社 | モータエンコーダ及びセンサを用いて学習制御を行うロボットシステム |
CN108638056A (zh) * | 2018-04-13 | 2018-10-12 | 华南理工大学 | 基于柔体动力学模型的机器人关节振动分析与抑制方法 |
US11597083B2 (en) * | 2018-12-17 | 2023-03-07 | Canon Kabushiki Kaisha | Robot apparatus, robot system, control method of robot apparatus, product manufacturing method using robot apparatus, and storage medium |
CA3129060A1 (en) * | 2019-02-22 | 2020-08-27 | Covidien Lp | Input shaper for robotic surgical system |
TWI701122B (zh) * | 2019-07-15 | 2020-08-11 | 由田新技股份有限公司 | 多軸機械手臂系統及其路徑規劃方法 |
CN110549337A (zh) * | 2019-08-30 | 2019-12-10 | 上海有个机器人有限公司 | 一种配送机器人控制系统 |
TWI742990B (zh) | 2021-01-19 | 2021-10-11 | 財團法人工業技術研究院 | 機械手臂系統、其控制方法及其電腦程式產品 |
JP2022157882A (ja) * | 2021-03-31 | 2022-10-14 | セイコーエプソン株式会社 | ロボットの制御方法、ロボットシステムおよびロボット制御プログラム |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63201705A (ja) * | 1987-02-17 | 1988-08-19 | Daihen Corp | マニピユレ−タの防振制御装置 |
JPH01173116A (ja) * | 1987-12-28 | 1989-07-07 | Mitsubishi Heavy Ind Ltd | 柔軟構造物の振動制御装置 |
JPH10100085A (ja) * | 1996-09-30 | 1998-04-21 | Toshiba Corp | ロボットの振動抑制制御装置およびその制御方法 |
US20100185324A1 (en) * | 2006-09-18 | 2010-07-22 | Ferrobotics Compliant Technology Gmbh | Device for controlling a robotic arm |
JP2011136395A (ja) * | 2009-12-28 | 2011-07-14 | Kawasaki Heavy Ind Ltd | ロボットの制振方法およびロボットの制御装置 |
JP2011161562A (ja) * | 2010-02-09 | 2011-08-25 | Yaskawa Electric Corp | 無線伝送装置とそれを用いたロボットの振動抑制制御装置およびロボット制御装置 |
JP2012035361A (ja) * | 2010-08-06 | 2012-02-23 | Seiko Epson Corp | ロボット装置、ロボット装置の制御方法およびプログラム |
Family Cites Families (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07314360A (ja) | 1994-05-31 | 1995-12-05 | Ishikawajima Harima Heavy Ind Co Ltd | カメラ操作ロボット |
JPH106261A (ja) | 1996-06-18 | 1998-01-13 | Sony Corp | ロボット制御装置 |
US6508122B1 (en) | 1999-09-16 | 2003-01-21 | American Gnc Corporation | Microelectromechanical system for measuring angular rate |
US6569109B2 (en) | 2000-02-04 | 2003-05-27 | Olympus Optical Co., Ltd. | Ultrasonic operation apparatus for performing follow-up control of resonance frequency drive of ultrasonic oscillator by digital PLL system using DDS (direct digital synthesizer) |
US6507165B2 (en) * | 2000-02-10 | 2003-01-14 | Fanuc Ltd. | Controller for machine |
CN1344908A (zh) | 2000-09-15 | 2002-04-17 | 林清芳 | 测量角速率的微机电系统 |
JP2002304219A (ja) | 2001-04-04 | 2002-10-18 | Yaskawa Electric Corp | モータ制御装置およびメカ特性測定方法 |
JP2005212054A (ja) | 2004-01-30 | 2005-08-11 | Keio Gijuku | 力検出方法及び装置並びに力検出機能を備えた制御装置 |
JP3883544B2 (ja) * | 2004-02-27 | 2007-02-21 | 株式会社東芝 | ロボット制御装置およびロボットの制御方法 |
CN101890720B (zh) | 2004-07-13 | 2012-01-11 | 松下电器产业株式会社 | 物品保持系统、机器人以及机器人控制方法 |
EP1803536A1 (en) * | 2004-08-25 | 2007-07-04 | Kabushiki Kaisha Yaskawa Denki | Robot evaluation system and evaluation method |
WO2006129612A1 (ja) | 2005-05-31 | 2006-12-07 | Mitsubishi Electric Corporation | 電動機制御装置 |
CN101043198A (zh) * | 2006-03-22 | 2007-09-26 | Juki株式会社 | 电子部件搭载装置 |
JP4267027B2 (ja) * | 2006-12-07 | 2009-05-27 | ファナック株式会社 | ロボット制御装置 |
JP4565034B2 (ja) | 2008-12-16 | 2010-10-20 | ファナック株式会社 | イナーシャ推定を行う制御装置及び制御システム |
JP4957753B2 (ja) | 2009-06-15 | 2012-06-20 | セイコーエプソン株式会社 | ロボット、搬送装置、及び慣性センサーを用いた制御方法 |
DE102009032278B4 (de) * | 2009-07-08 | 2021-03-04 | Kuka Roboter Gmbh | Verfahren und eine Vorrichtung zum Betreiben eines Manipulators |
JP5353581B2 (ja) | 2009-09-10 | 2013-11-27 | セイコーエプソン株式会社 | ロボット |
JP5645423B2 (ja) * | 2010-02-23 | 2014-12-24 | キヤノン株式会社 | 回転駆動装置及びロボットアーム |
US8762091B1 (en) * | 2010-06-08 | 2014-06-24 | Thales Visionix, Inc. | Inertial measurement system |
JP5496365B2 (ja) * | 2010-12-20 | 2014-05-21 | 三菱電機株式会社 | モータ制御装置 |
JP5848873B2 (ja) * | 2011-01-05 | 2016-01-27 | 株式会社ミツトヨ | 制御装置、および測定装置 |
US8886359B2 (en) * | 2011-05-17 | 2014-11-11 | Fanuc Corporation | Robot and spot welding robot with learning control function |
-
2012
- 2012-07-31 JP JP2012169285A patent/JP6083145B2/ja active Active
-
2013
- 2013-07-26 TW TW102126977A patent/TWI577515B/zh active
- 2013-07-29 CN CN201310322411.8A patent/CN103568013B/zh active Active
- 2013-07-29 US US13/953,120 patent/US9095979B2/en active Active
- 2013-07-30 KR KR1020130090028A patent/KR20140016839A/ko not_active Application Discontinuation
- 2013-07-30 EP EP13178508.1A patent/EP2692488B1/en active Active
-
2015
- 2015-07-02 US US14/790,778 patent/US20150306765A1/en not_active Abandoned
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63201705A (ja) * | 1987-02-17 | 1988-08-19 | Daihen Corp | マニピユレ−タの防振制御装置 |
JPH01173116A (ja) * | 1987-12-28 | 1989-07-07 | Mitsubishi Heavy Ind Ltd | 柔軟構造物の振動制御装置 |
JPH10100085A (ja) * | 1996-09-30 | 1998-04-21 | Toshiba Corp | ロボットの振動抑制制御装置およびその制御方法 |
US20100185324A1 (en) * | 2006-09-18 | 2010-07-22 | Ferrobotics Compliant Technology Gmbh | Device for controlling a robotic arm |
JP2011136395A (ja) * | 2009-12-28 | 2011-07-14 | Kawasaki Heavy Ind Ltd | ロボットの制振方法およびロボットの制御装置 |
JP2011161562A (ja) * | 2010-02-09 | 2011-08-25 | Yaskawa Electric Corp | 無線伝送装置とそれを用いたロボットの振動抑制制御装置およびロボット制御装置 |
JP2012035361A (ja) * | 2010-08-06 | 2012-02-23 | Seiko Epson Corp | ロボット装置、ロボット装置の制御方法およびプログラム |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015085421A (ja) * | 2013-10-30 | 2015-05-07 | セイコーエプソン株式会社 | ロボット、制御装置、ロボットシステム |
JP2016177513A (ja) * | 2015-03-19 | 2016-10-06 | オークマ株式会社 | タンデム位置制御装置 |
JP2019195892A (ja) * | 2018-05-11 | 2019-11-14 | 川崎重工業株式会社 | 撓み量推定装置、ロボット制御装置、及び撓み量推定方法 |
WO2019216416A1 (ja) * | 2018-05-11 | 2019-11-14 | 川崎重工業株式会社 | 撓み量推定装置、ロボット制御装置、及び撓み量推定方法 |
JP7141847B2 (ja) | 2018-05-11 | 2022-09-26 | 川崎重工業株式会社 | 撓み量推定装置、ロボット制御装置、及び撓み量推定方法 |
Also Published As
Publication number | Publication date |
---|---|
JP6083145B2 (ja) | 2017-02-22 |
CN103568013A (zh) | 2014-02-12 |
US20150306765A1 (en) | 2015-10-29 |
TWI577515B (zh) | 2017-04-11 |
US20140039678A1 (en) | 2014-02-06 |
CN103568013B (zh) | 2016-05-04 |
EP2692488B1 (en) | 2018-10-17 |
KR20140016839A (ko) | 2014-02-10 |
EP2692488A3 (en) | 2017-04-12 |
US9095979B2 (en) | 2015-08-04 |
TW201410418A (zh) | 2014-03-16 |
EP2692488A2 (en) | 2014-02-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6083145B2 (ja) | ロボットの制御装置、およびロボット | |
JP5417161B2 (ja) | ロボットの制振方法およびロボットの制御装置 | |
JP5327722B2 (ja) | ロボットの負荷推定装置及び負荷推定方法 | |
CN103213134B (zh) | 机械手的控制方法和机械手 | |
JP6314426B2 (ja) | ロボット制御装置およびロボット制御方法 | |
JP6392825B2 (ja) | 学習制御機能を備えたロボット制御装置 | |
JP5916583B2 (ja) | 多関節ロボットのウィービング制御装置 | |
KR102312368B1 (ko) | 여자유도 로봇 제어 시스템, 방법, 및 상기 방법을 실행시키기 위한 컴퓨터 판독 가능한 프로그램을 기록한 기록 매체 | |
JP5932578B2 (ja) | 振動抑制方法、振動抑制装置および振動抑制機能を備えた産業用機械装置 | |
JP2015202534A (ja) | 力に応じて動かすロボットのロボット制御装置およびロボットシステム | |
JP2016105686A (ja) | モータ駆動装置の制御装置、複軸モータ駆動装置の制御装置、及びモータ駆動装置の制御方法 | |
JP2017209762A (ja) | ロボット装置、ロボット制御方法、プログラム、記録媒体及び物品の製造方法 | |
JP2019005821A (ja) | ロボットシステム及びロボットシステムの制御方法 | |
JP2011148078A (ja) | 振動抑制方法 | |
JP2014076498A (ja) | 多関節ロボット及び半導体ウェハ搬送装置 | |
JP2016221653A (ja) | ロボット制御装置およびロボットシステム | |
WO2013183190A1 (ja) | ロボットシステム、ロボット制御装置、及びロボットシステムの制御方法 | |
WO2019012942A1 (ja) | ロボット制御装置 | |
Yang et al. | Dynamic compensation control of flexible macro–micro manipulator systems | |
JP6896824B2 (ja) | ロボット装置、ロボットシステム、ロボット装置の制御方法、ロボット装置を用いた物品の製造方法、情報処理装置、情報処理方法、制御プログラム及び記録媒体 | |
JP2017087375A (ja) | ロボットシステム及びロボット制御方法 | |
JPH04343690A (ja) | 多関節マニピュレータの関節摩擦補償方法 | |
JP6036476B2 (ja) | ロボット | |
WO2024045091A1 (zh) | 执行机构的运动规划方法、装置、系统及存储介质 | |
JP6252272B2 (ja) | 垂直多関節型ロボットの位置誤差抑制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20150108 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20150626 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20150626 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20160516 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20160524 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20160609 |
|
RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20160613 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20160708 |
|
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: 20161227 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20170109 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6083145 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |