JP4423719B2 - ロボットおよびロボットの制御方法 - Google Patents
ロボットおよびロボットの制御方法 Download PDFInfo
- Publication number
- JP4423719B2 JP4423719B2 JP30773999A JP30773999A JP4423719B2 JP 4423719 B2 JP4423719 B2 JP 4423719B2 JP 30773999 A JP30773999 A JP 30773999A JP 30773999 A JP30773999 A JP 30773999A JP 4423719 B2 JP4423719 B2 JP 4423719B2
- Authority
- JP
- Japan
- Prior art keywords
- axis
- robot
- articulated robot
- vertical articulated
- reduction ratio
- 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.)
- Expired - Fee Related
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/1638—Programme controls characterised by the control loop compensation for arm bending/inertia, pay load weight/inertia
-
- 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
- B25J9/102—Gears specially adapted therefor, e.g. reduction gears
-
- 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
- Y10S700/00—Data processing: generic control systems or specific applications
- Y10S700/90—Special robot structural element
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Description
【０００１】
【発明の属する技術分野】
この発明は、減速機を介してモータで駆動されるロボット、特に垂直多関節形ロボットに関する。
【０００２】
【従来の技術】
今日、いわゆる産業用の垂直多関節型ロボットはサーボモータで駆動される電動ロボットが主流である。一般にサーボモータはロボットに要求される回転速度とトルクに比べて高回転低トルクの特性を有してので、ロボットとサーボモータの間に減速機を介在させている。これらの減速機にはサイクロ減速機やハーモニック減速機が選ばれるが、いずれも減速比が固定されていてサーボモータの出力を一定の減速比で減速するものであった。
例外として、特開昭６４−５１２８５号公報に関節機構と減速機の間に減速比を変更する手段を設けた電動ロボットの発明が開示されている。しかし、前記発明の電動ロボットは、作業者がロボットを腕力で操作して教示を行ういわゆるダイレクトティーチングロボットにおいて、ティーチング時の操作力を小さくするために、ティーチング時とプレイバック動作時で減速比を切り替えるものであり、プレイバック動作中の減速比は一定の値に固定されていた。
【０００３】
【発明が解決しようとする課題】
ところがこの従来の垂直多関節型ロボットは、設計上の最大負荷質量をロボットに取り付けた上で、サーボモータに加わる負荷が最大になる姿勢つまり、水平面内の旋回であればアームを外側に振り出して回転慣性が最大になる姿勢、前後軸の揺動であれば、アームを水平に倒して重力によるモーメントが最大になる姿勢を基準にして、この様な最大負荷に見合う減速比を決めていた。
そのため、最大負荷質量に満たない負荷質量で使用する場合や、回転慣性や重力によるモーメントが小さい姿勢で使用する場合は、サーボモータのパワーが余る一方、十分な動作速度が得られないという問題、つまり負荷に応じた減速比を選択すれば得られるはずの速度が得られないという問題があった。
そこで、本発明はサーボモータのパワーをフルに利用することによって、高速度で動作できるロボットを提供することを目的とする。
【０００４】
【課題を解決するための手段】
上記の問題を解決するために、請求項１記載の発明は、固定ベースと、前記固定ベースにサーボモータと減速機によって垂直なＳ軸回りで旋回駆動される旋回ヘッドと、前記旋回ヘッドにサーボモータと減速機によって水平なＬ軸回りで揺動駆動される下部アームと、前記下部アームにサーボモータと減速機によって水平なＵ軸回りで揺動駆動される上部アームと、前記上部アームの先端に取り付けられた負荷質量と、を備え、前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機が再生動作中にその減速比を変更可能な可変減速機で構成された、垂直多関節ロボットの制御方法において、前記垂直多関節ロボットに所望の動作径路を教示し、前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機の減速比を大きいほうの値にセットし、 前記動作径路に従って前記垂直多関節ロボットを再生動作させながら、前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれのサーボモータのトルクを記録し、前記記録したトルクの変化に従って前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機の減速比のスケジュールを決定し、前記スケジュールを組み込んだプログラムで前記再生動作を行うよう制御すること、を特徴とする垂直多関節ロボットの制御方法とするものである。
また、請求項２記載の発明は、請求項１記載の垂直多関節ロボットの制御方法において、前記垂直多関節ロボットに所望の動作径路を教示し、前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機の減速比を大きいほうの値にセットし、前記動作径路に従って前記垂直多関節ロボットを再生動作させながら、前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれのサーボモータのトルクを記録し、前記記録したトルクの変化に従って前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機の減速比のスケジュールを決定する際、コンピュータ上でこれらを行なうことを特徴とする垂直多関節ロボットの制御方法とするものである。
【０００５】
【発明の実施の形態】
以下、図にしたがって本発明の実施例を説明する。
図１は本発明の実施例を示す垂直多関節型ロボットの概念図である。図において１は固定ベースであり、固定ベース１には旋回ヘッド２が旋回軸（Ｓ軸）回りに旋回自在に取付けられている。旋回ヘッド２の上部には下部アーム３が前後軸（Ｌ軸）回りに揺動自在に取付けられ、下部アーム３の上部には上部アーム４が上下軸（Ｕ軸）回りに揺動自在に取付けらている。５は上部アーム４の先端に取付けられた負荷質量である。ここで負荷質量５はロボットの先端に取付けられるエンドエフェクタの質量に相当する。
６は旋回ヘッド２に取り付けられた減速機であり、その出力部は固定ベース１に結合され、入力部にはサーボモータ７が固定されている。旋回ヘッド２はサーボモータ７と減速機６によってＳ軸回りに旋回駆動される。
８は旋回ヘッド２に固定された第１の減速機付サーボモータであり、その出力部は下部アーム３に結合されて、下部アーム３をＬ軸回りに揺動駆動する。
９は下部アーム３に固定された第２の減速機付サーボモータであり、その出力部は上部アーム４に結合されて、上部アーム４をＬ軸回りに揺動駆動する。
減速機６と第１の減速機付サーボモータ７および第２の減速機付サーボモータ８は図示しないロボット制御装置の指令によりロボットの再生（プレイバック）動作中に大小２種の減速比を切り換える機構を備えている。減速比を切り換える機構は、歯車の噛み合わせを変更する機構、２組の遊星歯車を組み合わせた機構、あるいはプーリの噛み合わせを変更する機構など公知の機構を適宜選択すれば良い。
【０００６】
ここで、このロボットの作用を説明する、図２はロボットの３種の姿勢を示す説明図であり、（ａ）は下部アーム３を直立させ、上部アーム４を水平にした姿勢を示し、（ｂ）は下部アーム３を直立の姿勢から角度θだけ前方に倒した姿勢を示し、（ｃ）は下部アーム３と上部アーム４を共に直立させた姿勢を示す。
Ｓ軸から負荷質量５の重心までの距離は、図２（ａ）に示す姿勢においては、Ｘ１であるが、図２（ｂ）のように下部アーム３を倒すと大きくなりＸ１’になる。また、下部アーム３および上部アーム４の重心もＳ軸から遠ざかることになる。したがって、図２（ｂ）に示す姿勢では図２（ａ）に示す姿勢に比べてＳ軸回りの回転慣性が大きくなる。
逆に、図２（ｃ）に示す姿勢においては、Ｓ軸から負荷質量５の重心までの距離は、Ｘ１”で示されるように小さくなり、下部アーム３および上部アーム４の重心もＳ軸に接近するので、Ｓ軸回りは回転慣性が小さくなる。
Ｓ軸回りの回転慣性が大きくなると、サーボモータ７の加減速時の負荷が大きくなり、反対にＳ軸回りの回転慣性が小さくなると、負荷が小さくなる。そこで、下部アーム３および上部アーム４の姿勢に応じて減速機６の減速比をロボット制御装置の指令によって変更する。つまり、下部アーム３および上部アーム４の角度がＳ軸回りの回転慣性が所定の値より大きくなる範囲にある時は、大きな減速比を選び、Ｓ軸回りの回転慣性を小さくなる範囲にある時は小さな減速比を選ぶ。
また、下部アーム３および上部アーム４の自重も考慮してＳ軸回りの回転慣性を計算して、その結果の大小に応じて減速比の大小を選んでも良い。
また、負荷質量５の大小に応じて、減速比の大小を選んでも良い。一般にロボットは大型になるほど、取付け可能なエンドエフェクタの最大質量つまり可搬質量と動作範囲が大きくなる。逆にロボットの最大速度、最大加速度は小さくなる傾向にある。動作範囲を大きく取るためにエンドエフェクタの実際の質量に比べて可搬質量の大きい大型ロボットを選ぶ場合がある。このような場合に、エンドエフェクタの質量に応じて、小さい減速比を選べば大型ロボットを高速で動作できる。
【０００７】
つぎに、下部アーム３を駆動する第１の減速機付サーボモータ８の減速比の変更について説明する。
図２（ａ）に示す姿勢におけるＬ軸の回転中心から負荷質量５の重心までの距離、つまり負荷質量５によって第１の減速機付サーボモータ８に負荷される重力のモーメントの梃子の長さＸ２は、図２（ｂ）に示す姿勢においては長くなりＸ２’になる。また図２（ｃ）に示す姿勢では、前記梃子の長さは０になる。
このように負荷質量５によって第１の減速機付サーボモータ８に負荷される重力のモーメントは下部アーム３および上部アーム４の姿勢が水平であるとき最大になり、下部アーム３および上部アーム４の姿勢が共に直立している時は０になる。
そこで、下部アーム３および上部アーム４の姿勢、すなわち基準姿勢（通常、水平姿勢か直立姿勢のどちらかを基準にすれば良い）に対する角度の大小に応じて、第１の減速機付サーボモータ８の減速比を変更する指令をロボット制御装置が発する。
また、下部アーム３と上部アーム４の姿勢を基に、第１の減速機付モータ８に負荷される重力のモーメントを計算して、その結果の大小に応じて減速比を変更しても良い。
【０００８】
同様にして、上部アーム４を駆動する第２の減速機付サーボモータ９の減速比も変更される。
図２（ａ）に示す姿勢においては、負荷質量５によって第２の減速機付モータ８に負荷される重力のモーメントの梃子の長さもＸ２で表されるが、図２（ｃ）に示す姿勢では、前記梃子の長さは０になる。
このように負荷質量５によって第２の減速機付モータ９に負荷される重力のモーメントは上部アーム４の姿勢が水平であるとき最大になり、直立している時は０になる。
そこで、上部アーム４の姿勢、すなわち基準姿勢（通常、水平姿勢か直立姿勢のどちらかを基準にすれば良い）に対する角度の大小に応じて第２の減速機付モータ９の減速比を変更する指令をロボット制御装置が発する。
また、ロボットの動作の始点と終点で、モータに負荷される重力のモーメントが変化する場合は、大きい方の負荷に応じて減速比を選べばよい。もちろん、前記始点と終点の間に中間点を定義して、前記中間点で一度ロボットを停止させて、減速比を切り替えても良いが、減速比を切り替えるのに要する時間と加減速による時間のロスを考慮すると必ずしも有利ではないであろう。
【０００９】
前述した減速比の変更方法は垂直多関節ロボットの各アームの姿勢を基準にする方法であり、静的な力の釣り合いを基にするものである。しかしながら、実際のロボットの動作では複数の駆動軸を同時に動作させるので、各軸の相互の干渉によるトルクが発生するので、駆動用モータの負荷は静的な釣り合いだけでは求められない場合がある。
そこで、実際にロボットを動作させて、モータの負荷の変動を求めて、前記モータの負荷の変動に応じて減速機の減速比の変更のスケジュールを決定する方法を説明する。
（１）まず、ロボットに所望の動作経路（例えば、ロボットがＡ→Ｂ→Ｃ→Ｄ→Ｅ→ＦのようにＡからＦまでの各教示点を辿る経路）を教示する。
（２）各軸の減速比を大きい方の値にセットして、ロボットを先に教示した経路に従ってプレイバック動作させ、この時のモータの速度とトルクと電流を記録する。
（３）先に記録したモータのトルクの変化に従って、減速比の切り替えのスケジュールを決定する。例えば、ＡからＦまでの経路でモータのトルクが大→大→小→小→大→小のように変動する時は、減速比を大→大→小→大→大→小の順にＡからＦまでの各教示点で切り替えるスケジュールをプログラムする。
（４）減速比切り替えのスケジュールを組み込んだプログラムでロボットをプレイバック動作させて、モータの速度とトルクと電流を記録する。
（５）モータの速度とトルクと電流が制限を越えていなければ、終了。何れかが制限を越えている時は（３）から（５）のステップを繰り返す。
また、（１）から（５）までのステップを実際のロボットに依らずに、コンピュータ上でのシミュレーション、いわゆるオフラインティーチングソフト上で実行すれば、プレイバック動作中にモータの速度、トルク、電流が定格をオーバーしても、ロボットが暴走したり、モータが焼き付く心配がなく、減速比の切り替えスケジュールが最適な物に収束するまで、（１）から（５）までのステップを繰り返すことができる。
なお、実施例においては減速機を大小２つの減速比を選べる２段可変速減速機としたが、本発明は２段可変速減速機を使用したものに限られるものではなく、３段以上の多段変速機、あるいは無段階変速機を用いるなどの応用ができることはいうまでもない。
【００１０】
【発明の効果】
以上述べたように、本発明によれば、ロボットの姿勢やエンドエフェクタの質量の大小による各駆動軸の負荷に応じて、減速機の減速比を最適に切り換えるので、駆動用モータのパワーをフルに引き出せる。したがって、ロボットを高速で動作できるという効果がある。
【図面の簡単な説明】
【図１】本発明の実施例を示す垂直多関節型ロボットの概念図である。
【図２】本発明の実施例を示す垂直多関節型ロボットの説明図であり、（ａ）は下部アーム３を直立させ、上部アーム４を水平にした姿勢を示し、（ｂ）は下部アーム３を直立の姿勢から角度θだけ前方に倒した姿勢を示し、（ｃ）は下部アーム３と上部アーム４を共に直立させた姿勢を示す。
【符号の説明】
１：固定ベース ２：旋回ヘッド ３：下部アーム ４：上部アーム
５：負荷質量 ６：減速機 ７：サーボモータ
８：第１の減速機付サーボモータ ９：第２の減速機付サーボモータ
【発明の属する技術分野】
この発明は、減速機を介してモータで駆動されるロボット、特に垂直多関節形ロボットに関する。
【０００２】
【従来の技術】
今日、いわゆる産業用の垂直多関節型ロボットはサーボモータで駆動される電動ロボットが主流である。一般にサーボモータはロボットに要求される回転速度とトルクに比べて高回転低トルクの特性を有してので、ロボットとサーボモータの間に減速機を介在させている。これらの減速機にはサイクロ減速機やハーモニック減速機が選ばれるが、いずれも減速比が固定されていてサーボモータの出力を一定の減速比で減速するものであった。
例外として、特開昭６４−５１２８５号公報に関節機構と減速機の間に減速比を変更する手段を設けた電動ロボットの発明が開示されている。しかし、前記発明の電動ロボットは、作業者がロボットを腕力で操作して教示を行ういわゆるダイレクトティーチングロボットにおいて、ティーチング時の操作力を小さくするために、ティーチング時とプレイバック動作時で減速比を切り替えるものであり、プレイバック動作中の減速比は一定の値に固定されていた。
【０００３】
【発明が解決しようとする課題】
ところがこの従来の垂直多関節型ロボットは、設計上の最大負荷質量をロボットに取り付けた上で、サーボモータに加わる負荷が最大になる姿勢つまり、水平面内の旋回であればアームを外側に振り出して回転慣性が最大になる姿勢、前後軸の揺動であれば、アームを水平に倒して重力によるモーメントが最大になる姿勢を基準にして、この様な最大負荷に見合う減速比を決めていた。
そのため、最大負荷質量に満たない負荷質量で使用する場合や、回転慣性や重力によるモーメントが小さい姿勢で使用する場合は、サーボモータのパワーが余る一方、十分な動作速度が得られないという問題、つまり負荷に応じた減速比を選択すれば得られるはずの速度が得られないという問題があった。
そこで、本発明はサーボモータのパワーをフルに利用することによって、高速度で動作できるロボットを提供することを目的とする。
【０００４】
【課題を解決するための手段】
上記の問題を解決するために、請求項１記載の発明は、固定ベースと、前記固定ベースにサーボモータと減速機によって垂直なＳ軸回りで旋回駆動される旋回ヘッドと、前記旋回ヘッドにサーボモータと減速機によって水平なＬ軸回りで揺動駆動される下部アームと、前記下部アームにサーボモータと減速機によって水平なＵ軸回りで揺動駆動される上部アームと、前記上部アームの先端に取り付けられた負荷質量と、を備え、前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機が再生動作中にその減速比を変更可能な可変減速機で構成された、垂直多関節ロボットの制御方法において、前記垂直多関節ロボットに所望の動作径路を教示し、前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機の減速比を大きいほうの値にセットし、 前記動作径路に従って前記垂直多関節ロボットを再生動作させながら、前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれのサーボモータのトルクを記録し、前記記録したトルクの変化に従って前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機の減速比のスケジュールを決定し、前記スケジュールを組み込んだプログラムで前記再生動作を行うよう制御すること、を特徴とする垂直多関節ロボットの制御方法とするものである。
また、請求項２記載の発明は、請求項１記載の垂直多関節ロボットの制御方法において、前記垂直多関節ロボットに所望の動作径路を教示し、前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機の減速比を大きいほうの値にセットし、前記動作径路に従って前記垂直多関節ロボットを再生動作させながら、前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれのサーボモータのトルクを記録し、前記記録したトルクの変化に従って前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機の減速比のスケジュールを決定する際、コンピュータ上でこれらを行なうことを特徴とする垂直多関節ロボットの制御方法とするものである。
【０００５】
【発明の実施の形態】
以下、図にしたがって本発明の実施例を説明する。
図１は本発明の実施例を示す垂直多関節型ロボットの概念図である。図において１は固定ベースであり、固定ベース１には旋回ヘッド２が旋回軸（Ｓ軸）回りに旋回自在に取付けられている。旋回ヘッド２の上部には下部アーム３が前後軸（Ｌ軸）回りに揺動自在に取付けられ、下部アーム３の上部には上部アーム４が上下軸（Ｕ軸）回りに揺動自在に取付けらている。５は上部アーム４の先端に取付けられた負荷質量である。ここで負荷質量５はロボットの先端に取付けられるエンドエフェクタの質量に相当する。
６は旋回ヘッド２に取り付けられた減速機であり、その出力部は固定ベース１に結合され、入力部にはサーボモータ７が固定されている。旋回ヘッド２はサーボモータ７と減速機６によってＳ軸回りに旋回駆動される。
８は旋回ヘッド２に固定された第１の減速機付サーボモータであり、その出力部は下部アーム３に結合されて、下部アーム３をＬ軸回りに揺動駆動する。
９は下部アーム３に固定された第２の減速機付サーボモータであり、その出力部は上部アーム４に結合されて、上部アーム４をＬ軸回りに揺動駆動する。
減速機６と第１の減速機付サーボモータ７および第２の減速機付サーボモータ８は図示しないロボット制御装置の指令によりロボットの再生（プレイバック）動作中に大小２種の減速比を切り換える機構を備えている。減速比を切り換える機構は、歯車の噛み合わせを変更する機構、２組の遊星歯車を組み合わせた機構、あるいはプーリの噛み合わせを変更する機構など公知の機構を適宜選択すれば良い。
【０００６】
ここで、このロボットの作用を説明する、図２はロボットの３種の姿勢を示す説明図であり、（ａ）は下部アーム３を直立させ、上部アーム４を水平にした姿勢を示し、（ｂ）は下部アーム３を直立の姿勢から角度θだけ前方に倒した姿勢を示し、（ｃ）は下部アーム３と上部アーム４を共に直立させた姿勢を示す。
Ｓ軸から負荷質量５の重心までの距離は、図２（ａ）に示す姿勢においては、Ｘ１であるが、図２（ｂ）のように下部アーム３を倒すと大きくなりＸ１’になる。また、下部アーム３および上部アーム４の重心もＳ軸から遠ざかることになる。したがって、図２（ｂ）に示す姿勢では図２（ａ）に示す姿勢に比べてＳ軸回りの回転慣性が大きくなる。
逆に、図２（ｃ）に示す姿勢においては、Ｓ軸から負荷質量５の重心までの距離は、Ｘ１”で示されるように小さくなり、下部アーム３および上部アーム４の重心もＳ軸に接近するので、Ｓ軸回りは回転慣性が小さくなる。
Ｓ軸回りの回転慣性が大きくなると、サーボモータ７の加減速時の負荷が大きくなり、反対にＳ軸回りの回転慣性が小さくなると、負荷が小さくなる。そこで、下部アーム３および上部アーム４の姿勢に応じて減速機６の減速比をロボット制御装置の指令によって変更する。つまり、下部アーム３および上部アーム４の角度がＳ軸回りの回転慣性が所定の値より大きくなる範囲にある時は、大きな減速比を選び、Ｓ軸回りの回転慣性を小さくなる範囲にある時は小さな減速比を選ぶ。
また、下部アーム３および上部アーム４の自重も考慮してＳ軸回りの回転慣性を計算して、その結果の大小に応じて減速比の大小を選んでも良い。
また、負荷質量５の大小に応じて、減速比の大小を選んでも良い。一般にロボットは大型になるほど、取付け可能なエンドエフェクタの最大質量つまり可搬質量と動作範囲が大きくなる。逆にロボットの最大速度、最大加速度は小さくなる傾向にある。動作範囲を大きく取るためにエンドエフェクタの実際の質量に比べて可搬質量の大きい大型ロボットを選ぶ場合がある。このような場合に、エンドエフェクタの質量に応じて、小さい減速比を選べば大型ロボットを高速で動作できる。
【０００７】
つぎに、下部アーム３を駆動する第１の減速機付サーボモータ８の減速比の変更について説明する。
図２（ａ）に示す姿勢におけるＬ軸の回転中心から負荷質量５の重心までの距離、つまり負荷質量５によって第１の減速機付サーボモータ８に負荷される重力のモーメントの梃子の長さＸ２は、図２（ｂ）に示す姿勢においては長くなりＸ２’になる。また図２（ｃ）に示す姿勢では、前記梃子の長さは０になる。
このように負荷質量５によって第１の減速機付サーボモータ８に負荷される重力のモーメントは下部アーム３および上部アーム４の姿勢が水平であるとき最大になり、下部アーム３および上部アーム４の姿勢が共に直立している時は０になる。
そこで、下部アーム３および上部アーム４の姿勢、すなわち基準姿勢（通常、水平姿勢か直立姿勢のどちらかを基準にすれば良い）に対する角度の大小に応じて、第１の減速機付サーボモータ８の減速比を変更する指令をロボット制御装置が発する。
また、下部アーム３と上部アーム４の姿勢を基に、第１の減速機付モータ８に負荷される重力のモーメントを計算して、その結果の大小に応じて減速比を変更しても良い。
【０００８】
同様にして、上部アーム４を駆動する第２の減速機付サーボモータ９の減速比も変更される。
図２（ａ）に示す姿勢においては、負荷質量５によって第２の減速機付モータ８に負荷される重力のモーメントの梃子の長さもＸ２で表されるが、図２（ｃ）に示す姿勢では、前記梃子の長さは０になる。
このように負荷質量５によって第２の減速機付モータ９に負荷される重力のモーメントは上部アーム４の姿勢が水平であるとき最大になり、直立している時は０になる。
そこで、上部アーム４の姿勢、すなわち基準姿勢（通常、水平姿勢か直立姿勢のどちらかを基準にすれば良い）に対する角度の大小に応じて第２の減速機付モータ９の減速比を変更する指令をロボット制御装置が発する。
また、ロボットの動作の始点と終点で、モータに負荷される重力のモーメントが変化する場合は、大きい方の負荷に応じて減速比を選べばよい。もちろん、前記始点と終点の間に中間点を定義して、前記中間点で一度ロボットを停止させて、減速比を切り替えても良いが、減速比を切り替えるのに要する時間と加減速による時間のロスを考慮すると必ずしも有利ではないであろう。
【０００９】
前述した減速比の変更方法は垂直多関節ロボットの各アームの姿勢を基準にする方法であり、静的な力の釣り合いを基にするものである。しかしながら、実際のロボットの動作では複数の駆動軸を同時に動作させるので、各軸の相互の干渉によるトルクが発生するので、駆動用モータの負荷は静的な釣り合いだけでは求められない場合がある。
そこで、実際にロボットを動作させて、モータの負荷の変動を求めて、前記モータの負荷の変動に応じて減速機の減速比の変更のスケジュールを決定する方法を説明する。
（１）まず、ロボットに所望の動作経路（例えば、ロボットがＡ→Ｂ→Ｃ→Ｄ→Ｅ→ＦのようにＡからＦまでの各教示点を辿る経路）を教示する。
（２）各軸の減速比を大きい方の値にセットして、ロボットを先に教示した経路に従ってプレイバック動作させ、この時のモータの速度とトルクと電流を記録する。
（３）先に記録したモータのトルクの変化に従って、減速比の切り替えのスケジュールを決定する。例えば、ＡからＦまでの経路でモータのトルクが大→大→小→小→大→小のように変動する時は、減速比を大→大→小→大→大→小の順にＡからＦまでの各教示点で切り替えるスケジュールをプログラムする。
（４）減速比切り替えのスケジュールを組み込んだプログラムでロボットをプレイバック動作させて、モータの速度とトルクと電流を記録する。
（５）モータの速度とトルクと電流が制限を越えていなければ、終了。何れかが制限を越えている時は（３）から（５）のステップを繰り返す。
また、（１）から（５）までのステップを実際のロボットに依らずに、コンピュータ上でのシミュレーション、いわゆるオフラインティーチングソフト上で実行すれば、プレイバック動作中にモータの速度、トルク、電流が定格をオーバーしても、ロボットが暴走したり、モータが焼き付く心配がなく、減速比の切り替えスケジュールが最適な物に収束するまで、（１）から（５）までのステップを繰り返すことができる。
なお、実施例においては減速機を大小２つの減速比を選べる２段可変速減速機としたが、本発明は２段可変速減速機を使用したものに限られるものではなく、３段以上の多段変速機、あるいは無段階変速機を用いるなどの応用ができることはいうまでもない。
【００１０】
【発明の効果】
以上述べたように、本発明によれば、ロボットの姿勢やエンドエフェクタの質量の大小による各駆動軸の負荷に応じて、減速機の減速比を最適に切り換えるので、駆動用モータのパワーをフルに引き出せる。したがって、ロボットを高速で動作できるという効果がある。
【図面の簡単な説明】
【図１】本発明の実施例を示す垂直多関節型ロボットの概念図である。
【図２】本発明の実施例を示す垂直多関節型ロボットの説明図であり、（ａ）は下部アーム３を直立させ、上部アーム４を水平にした姿勢を示し、（ｂ）は下部アーム３を直立の姿勢から角度θだけ前方に倒した姿勢を示し、（ｃ）は下部アーム３と上部アーム４を共に直立させた姿勢を示す。
【符号の説明】
１：固定ベース ２：旋回ヘッド ３：下部アーム ４：上部アーム
５：負荷質量 ６：減速機 ７：サーボモータ
８：第１の減速機付サーボモータ ９：第２の減速機付サーボモータ
Claims (2)
- 固定ベースと、前記固定ベースにサーボモータと減速機によって垂直なＳ軸回りで旋回駆動される旋回ヘッドと、前記旋回ヘッドにサーボモータと減速機によって水平なＬ軸回りで揺動駆動される下部アームと、前記下部アームにサーボモータと減速機によって水平なＵ軸回りで揺動駆動される上部アームと、前記上部アームの先端に取り付けられた負荷質量と、を備え、前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機が再生動作中にその減速比を変更可能な可変減速機で構成された、垂直多関節ロボットの制御方法において、
前記垂直多関節ロボットに所望の動作径路を教示し、
前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機の減速比を大きいほうの値にセットし、
前記動作径路に従って前記垂直多関節ロボットを再生動作させながら、前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれのサーボモータのトルクを記録し、
前記記録したトルクの変化に従って前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機の減速比のスケジュールを決定し、
前記スケジュールを組み込んだプログラムで前記再生動作を行うよう制御すること、を特徴とする垂直多関節ロボットの制御方法。 - 請求項１記載の垂直多関節ロボットの制御方法において、
前記垂直多関節ロボットに所望の動作径路を教示し、前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機の減速比を大きいほうの値にセットし、前記動作径路に従って前記垂直多関節ロボットを再生動作させながら、前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれのサーボモータのトルクを記録し、前記記録したトルクの変化に従って前記Ｓ軸と前記Ｌ軸と前記Ｕ軸のそれぞれの減速機の減速比のスケジュールを決定する際、コンピュータ上でこれらを行なうことを特徴とする垂直多関節ロボットの制御方法。
Priority Applications (5)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP30773999A JP4423719B2 (ja) | 1999-10-28 | 1999-10-28 | ロボットおよびロボットの制御方法 |
| US10/110,778 US6684128B1 (en) | 1999-10-28 | 2000-10-26 | Robot and method of controlling the robot |
| EP00970142A EP1228842A4 (en) | 1999-10-28 | 2000-10-26 | ROBOT AND CONTROL THEREOF |
| PCT/JP2000/007552 WO2001030544A1 (fr) | 1999-10-28 | 2000-10-26 | Robot et commande de celui-ci |
| AU79605/00A AU7960500A (en) | 1999-10-28 | 2000-10-26 | Robot and method of controlling the robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP30773999A JP4423719B2 (ja) | 1999-10-28 | 1999-10-28 | ロボットおよびロボットの制御方法 |
Publications (3)
| Publication Number | Publication Date |
|---|---|
| JP2001121467A JP2001121467A (ja) | 2001-05-08 |
| JP2001121467A5 JP2001121467A5 (ja) | 2006-07-13 |
| JP4423719B2 true JP4423719B2 (ja) | 2010-03-03 |
Family
ID=17972691
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP30773999A Expired - Fee Related JP4423719B2 (ja) | 1999-10-28 | 1999-10-28 | ロボットおよびロボットの制御方法 |
Country Status (5)
| Country | Link |
|---|---|
| US (1) | US6684128B1 (ja) |
| EP (1) | EP1228842A4 (ja) |
| JP (1) | JP4423719B2 (ja) |
| AU (1) | AU7960500A (ja) |
| WO (1) | WO2001030544A1 (ja) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102975205A (zh) * | 2012-11-08 | 2013-03-20 | 陕西科技大学 | 全自动仿手梳头机 |
| KR101487097B1 (ko) * | 2012-09-28 | 2015-01-28 | 니혼 덴산 산쿄 가부시키가이샤 | 산업용 로보트 |
Families Citing this family (19)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| TWI273009B (en) * | 2003-01-21 | 2007-02-11 | Yaskawa Electric Corp | Speed reducer for industrial robot |
| JP3946753B2 (ja) * | 2005-07-25 | 2007-07-18 | ファナック株式会社 | ロボットプログラム評価・修正方法及びロボットプログラム評価・修正装置 |
| JP4335286B2 (ja) * | 2008-02-08 | 2009-09-30 | ファナック株式会社 | 部品保護機能を備えたロボット制御装置及びロボット制御方法 |
| US9731419B2 (en) * | 2010-08-03 | 2017-08-15 | Praxair S.T. Technology, Inc. | System and method for programming robots |
| CN103328161B (zh) * | 2011-01-31 | 2015-08-19 | 丰田自动车株式会社 | 多关节型臂机器人及其控制方法 |
| WO2013140579A1 (ja) * | 2012-03-22 | 2013-09-26 | 株式会社安川電機 | 作業ロボットおよびロボットシステム |
| JP5835254B2 (ja) * | 2013-03-15 | 2015-12-24 | 株式会社安川電機 | ロボットシステム、及び、ロボットシステムの制御方法 |
| JP6097174B2 (ja) * | 2013-08-05 | 2017-03-15 | 株式会社東芝 | ロボット制御装置 |
| JP6418782B2 (ja) * | 2014-05-16 | 2018-11-07 | キヤノン株式会社 | ロボットシステムの制御方法、プログラム、記録媒体、ロボットシステム、及び診断装置 |
| JP2016140918A (ja) * | 2015-01-29 | 2016-08-08 | 株式会社安川電機 | ロボット |
| JP6809964B2 (ja) * | 2017-03-30 | 2021-01-06 | 株式会社ダイヘン | 制御装置 |
| CN107471208A (zh) * | 2017-08-31 | 2017-12-15 | 广州泰行智能科技有限公司 | 一种六轴机械手 |
| JP6743791B2 (ja) * | 2017-09-20 | 2020-08-19 | 株式会社安川電機 | ロボットシステムおよびワークの製造方法 |
| CN111347418B (zh) * | 2018-12-24 | 2021-10-29 | 深圳市优必选科技有限公司 | 一种电控伺服系统控制的方法、电控伺服系统及机器人 |
| JP7028196B2 (ja) * | 2019-01-15 | 2022-03-02 | オムロン株式会社 | ロボット制御装置、ロボット制御方法、及びロボット制御プログラム |
| JP7257816B2 (ja) * | 2019-02-26 | 2023-04-14 | 住友重機械工業株式会社 | ロボット制御システム |
| JP7175797B2 (ja) * | 2019-02-28 | 2022-11-21 | 株式会社ミツバ | ロボット |
| KR102254041B1 (ko) * | 2019-06-26 | 2021-05-21 | 한국전자기술연구원 | 로봇관절 구동모듈의 부하 신뢰성 평가 장치 및 시스템 |
| CN114766978A (zh) * | 2022-05-09 | 2022-07-22 | 北京云博仰信科技有限公司 | 一种清洁机械臂及其控制方法 |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| AU3583084A (en) * | 1983-12-10 | 1985-06-13 | Aida Engineering Ltd. | Playback grinding robot |
| JPS6283549A (ja) * | 1985-10-07 | 1987-04-17 | Shinpo Kogyo Kk | 摩擦無段変速機 |
| EP0523889B1 (en) * | 1991-07-06 | 1996-12-27 | Daihen Corporation | Apparatus for controlling industrial robot to perform coordinated operation using teaching playback method and method thereof |
| JP3148810B2 (ja) | 1991-11-27 | 2001-03-26 | 本田技研工業株式会社 | 脚式移動ロボットの制御装置 |
| JPH09149958A (ja) * | 1995-11-29 | 1997-06-10 | Miyamae:Kk | ゴルフボール試打機 |
-
1999
- 1999-10-28 JP JP30773999A patent/JP4423719B2/ja not_active Expired - Fee Related
-
2000
- 2000-10-26 AU AU79605/00A patent/AU7960500A/en not_active Abandoned
- 2000-10-26 US US10/110,778 patent/US6684128B1/en not_active Expired - Fee Related
- 2000-10-26 EP EP00970142A patent/EP1228842A4/en not_active Withdrawn
- 2000-10-26 WO PCT/JP2000/007552 patent/WO2001030544A1/ja active Application Filing
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR101487097B1 (ko) * | 2012-09-28 | 2015-01-28 | 니혼 덴산 산쿄 가부시키가이샤 | 산업용 로보트 |
| CN102975205A (zh) * | 2012-11-08 | 2013-03-20 | 陕西科技大学 | 全自动仿手梳头机 |
| CN102975205B (zh) * | 2012-11-08 | 2015-06-17 | 陕西科技大学 | 全自动仿手梳头机 |
Also Published As
| Publication number | Publication date |
|---|---|
| WO2001030544A1 (fr) | 2001-05-03 |
| EP1228842A1 (en) | 2002-08-07 |
| US6684128B1 (en) | 2004-01-27 |
| EP1228842A4 (en) | 2010-01-20 |
| AU7960500A (en) | 2001-05-08 |
| JP2001121467A (ja) | 2001-05-08 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4423719B2 (ja) | ロボットおよびロボットの制御方法 | |
| US4775289A (en) | Statically-balanced direct-drive robot arm | |
| US9242376B2 (en) | Method of generating path of multiaxial robot and control apparatus for the multiaxial robot | |
| JP3578375B2 (ja) | ロボットアーム駆動装置およびロボットハンド | |
| JP2001121467A5 (ja) | ||
| JP7336215B2 (ja) | ロボットシステム、制御方法、物品の製造方法、プログラム、及び記録媒体 | |
| JPWO2002066210A1 (ja) | ロボット制御装置 | |
| JPH07295650A (ja) | 多関節型ロボットの制御方法 | |
| JPH07100309B2 (ja) | 歩行ロボットのための腕に転用可能な脚機構 | |
| JPS62203786A (ja) | 産業用ロボツト | |
| US5708342A (en) | Method of controlling acceleration/deceleration time constants for robot | |
| JP4392251B2 (ja) | 送り駆動系の制御装置 | |
| JPH08161015A (ja) | 多関節型ロボットの駆動制御方法 | |
| JP3777783B2 (ja) | 水平アームを有するロボット | |
| JPH1153021A (ja) | 産業用ロボットの加減速パターン生成方法 | |
| JPH0750412B2 (ja) | ロボツトの制御装置 | |
| JPS61156406A (ja) | 工業用ロボツトの制御方法 | |
| WO1989000305A1 (en) | Method of optimizing operation of articulated industrial robot | |
| JPS59175988A (ja) | 多関節ロボット | |
| JP2566475B2 (ja) | ロボットの回動軸速度制御装置 | |
| JPH1177571A (ja) | ロボットの教示方法、ロボットの加工制御方法及びロボット制御装置 | |
| RU2288091C2 (ru) | Способ управления двухкоординатным пятизвенным манипулятором | |
| JPH10301616A (ja) | ロボットの教示装置 | |
| JPH07295651A (ja) | ロボットの加減速制御装置 | |
| JPH03234490A (ja) | ロボットの制御方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060526 |
|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060526 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090409 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090423 |
|
| A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20090601 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090604 |
|
| A911 | Transfer to examiner for re-examination before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20090908 |
|
| 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: 20091117 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20091130 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121218 Year of fee payment: 3 |
|
| LAPS | Cancellation because of no payment of annual fees |