JP6648491B2 - 制御装置、ロボットおよびロボットシステム - Google Patents

制御装置、ロボットおよびロボットシステム Download PDF

Info

Publication number
JP6648491B2
JP6648491B2 JP2015215773A JP2015215773A JP6648491B2 JP 6648491 B2 JP6648491 B2 JP 6648491B2 JP 2015215773 A JP2015215773 A JP 2015215773A JP 2015215773 A JP2015215773 A JP 2015215773A JP 6648491 B2 JP6648491 B2 JP 6648491B2
Authority
JP
Japan
Prior art keywords
arm
posture
robot
rotation axis
flag
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.)
Active
Application number
JP2015215773A
Other languages
English (en)
Other versions
JP2017087304A (ja
JP2017087304A5 (ja
Inventor
俊介 年光
俊介 年光
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Seiko Epson Corp
Original Assignee
Seiko Epson Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Seiko Epson Corp filed Critical Seiko Epson Corp
Priority to JP2015215773A priority Critical patent/JP6648491B2/ja
Publication of JP2017087304A publication Critical patent/JP2017087304A/ja
Publication of JP2017087304A5 publication Critical patent/JP2017087304A5/ja
Application granted granted Critical
Publication of JP6648491B2 publication Critical patent/JP6648491B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Description

本発明は、制御装置、ロボットおよびロボットシステムに関するものである。
従来、マニピュレーター(ロボットアーム)を備えたロボットが知られている。マニピュレーターは複数のアーム(アーム部材)が関節部を介して連結され、最も先端側(最も下流側)のアームには、エンドエフェクターとして、例えば、ハンドが装着される。関節部はモーターにより駆動され、その関節部の駆動により、アームが回動する。そして、ロボットは、例えば、ハンドで対象物を把持し、その対象物を所定の場所へ移動させ、組立等の所定の作業を行う。
特許文献1には、ロボットを制御する制御方法として、ロボットのハンドが2点間を移動する場合、各アームの回動角度(移動量)の合計の角度が最小となるようにする制御方法が開示されている。この特許文献1に記載の制御方法によれば、タクトタイムを短縮することが可能である。
特許第2823243号公報
しかしながら、前記特許文献1に記載の制御方法では、ハンドに接続されているケーブル等の配線の仕方によっては、各アームの回動角度の合計の角度が最小となるようにロボットが動作すると、ケーブルを断線させてしまう虞がある。
本発明は、上述の課題の少なくとも一部を解決するためになされたものであり、以下の形態または適用例として実現することが可能である。
本発明の制御装置は、回動可能な複数のアームを有するマニピュレーターを備えたロボットを制御する制御装置であって、
前記マニピュレーターの先端または前記マニピュレーターに設けられたエンドエフェクターの先端を、第1位置から前記第1位置と異なる第2位置へ移動させる場合、前記複数のアームのうち、回動角度を制限する前記アームの選択が可能であり、前記選択に基づいて、前記マニピュレーターを動作させることを特徴とする。
これにより、所定のアームの回動角度を制限することで、マニピュレーターの先端またはエンドエフェクターの先端が第2位置に移動(位置)した状態で、ロボットは、その構造や用途等に応じた適切な姿勢をとることができる。例えば、マニピュレーターに設けられた図示しないケーブルの配線の仕方等に応じて、回動角度を制限するアームを選択することにより、ケーブルの断線等を防止することができる。
本発明の制御装置では、前記複数のアームは、第n(nは1以上の整数)回動軸周りに回動可能な第nアームと、
前記第nアームに、前記第n回動軸の軸方向と異なる軸方向である第(n+1)回動軸周りに回動可能に設けられた第(n+1)アームと、を有し、
前記第(n+1)回動軸の軸方向から見て、前記第nアームと前記第(n+1)アームとが重なる第1状態になることが可能であることが好ましい。
これにより、第n+1アームの先端を第n回動軸周りに180°異なる位置に移動させる場合にロボットが干渉しないようにするための空間を小さくすることができる。
本発明の制御装置では、前記第1状態を経る前記第(n+1)アームの動作における前記第(n+1)アームの加速度の制限値は、前記第1状態を経ない前記第(n+1)アームの動作における前記第(n+1)アームの加速度の制限値よりも大きいことが好ましい。
これにより、タクトタイムを短縮することができる。
本発明の制御装置では、前記第nアームの長さは、前記第(n+1)アームの長さよりも長いことが好ましい。
これにより、容易に前記第1状態になることができる。
本発明の制御装置では、前記第nアーム(nは1である)は基台に設けられていることが好ましい。
これにより、ロボットを設置する場合に、基台を設置することで、その設置作業を容易に行うことができる。
本発明の制御装置では、前記複数のアームは、前記第(n+1)アームに、第(n+2)回動軸周りに回動可能に設けられた第(n+2)アームと、
前記第(n+2)アームに、第(n+3)回動軸周りに回動可能に設けられた第(n+3)アームと、
前記第(n+3)アームに、第(n+4)回動軸周りに回動可能に設けられた第(n+4)アームと、を有し、
回動角度を制限する前記アームとして、前記第(n+3)アームまたは前記第(n+4)アームを選択可能であることが好ましい。
これにより、例えば、マニピュレーターに設けられた図示しないケーブルの配線の仕方に応じて、回動角度を制限するアームとして、第(n+3)アームまたは第(n+4)アームを選択することにより、ケーブルの断線等を防止することができる。
本発明の制御装置では、前記第nアームの回動角度が90°以下であることが好ましい。
これにより、ロボットの周囲に障害物が有る場合でも、容易に、その障害物を回避して動作することができ、また、タクトタイムを短縮することができる。
本発明の制御装置では、前記複数のアームは、前記第(n+1)アームに、第(n+2)回動軸周りに回動可能に設けられた第(n+2)アームを有し、
前記第(n+1)回動軸よりも前記第(n+2)回動軸が基台側にある姿勢と、前記第(n+2)回動軸よりも前記第(n+1)回動軸が基台側にある姿勢と、を選択可能であることが好ましい。
これにより、多彩な動作が可能になる。
本発明の制御装置では、前記複数のアームのうち、少なくとも1つの前記アームの回動角度の制限値を設定可能であることが好ましい。
これにより、使用者にとって予期しないロボットの動作を防止することができる。
本発明の制御装置では、同一軸上にある複数の回動軸のうち、少なくとも1つの前記回動軸周りに回動する前記アームの角度を設定可能であることが好ましい。
これにより、使用者の意図するロボットの姿勢を実現することができる。
本発明の制御装置では、前記回動角度の制限は、前記回動角度を最小にすることであることが好ましい。
これにより、所定のアームの回動角度を最小にすることで、マニピュレーターの先端またはエンドエフェクターの先端が第2位置に移動(位置)した状態で、ロボットは、その構造や用途等に応じた適切な姿勢をとることができる。例えば、マニピュレーターに設けられた図示しないケーブルの配線の仕方等に応じて、回動角度を最小にするアームを選択することにより、ケーブルの断線等を防止することができる。
本発明のロボットは、本発明の制御装置により制御されることを特徴とする。
これにより、所定のアームの回動角度を制限することで、マニピュレーターの先端またはエンドエフェクターの先端が第2位置に移動(位置)した状態で、ロボットは、その構造や用途等に応じた適切な姿勢をとることができる。例えば、マニピュレーターに設けられた図示しないケーブルの配線の仕方等に応じて、回動角度を制限するアームを選択することにより、ケーブルの断線等を防止することができる。
本発明のロボットシステムは、本発明の制御装置と、
前記制御装置により制御される前記ロボットと、を備えることを特徴とする。
これにより、所定のアームの回動角度を制限することで、マニピュレーターの先端またはエンドエフェクターの先端が第2位置に移動(位置)した状態で、ロボットは、その構造や用途等に応じた適切な姿勢をとることができる。例えば、マニピュレーターに設けられた図示しないケーブルの配線の仕方等に応じて、回動角度を制限するアームを選択することにより、ケーブルの断線等を防止することができる。
本発明のロボットシステムの第1実施形態を示す斜視図である。 図1に示すロボットシステムの概略図である。 図1に示すロボットシステムの側面図である。 図1に示すロボットシステムの正面図である。 図1に示すロボットシステムの正面図である。 図1に示すロボットシステムの作業の際の動作を説明するための図である。 図1に示すロボットシステムのブロック図である。 図1に示すロボットシステムのロボットのパターンCの動作の一例を説明するための図である。 図1に示すロボットシステムのロボットのパターンCの動作の一例を説明するための図である。 図1に示すロボットシステムのロボットのパターンCの動作の一例を説明するための図である。 本発明のロボットシステムの第4実施形態におけるロボットの姿勢を示す図である。 本発明のロボットシステムの第4実施形態におけるロボットの姿勢を示す図である。 本発明のロボットシステムの第4実施形態におけるロボットの姿勢を示す図である。
以下、本発明の制御装置、ロボットおよびロボットシステムを添付図面に示す好適な実施形態に基づいて詳細に説明する。
<第1実施形態>
図1は、本発明のロボットシステムの第1実施形態を示す斜視図である。図2は、図1に示すロボットシステムの概略図である。図3は、図1に示すロボットシステムの側面図である。図4は、図1に示すロボットシステムの正面図である。図5は、図1に示すロボットシステムの正面図である。図6は、図1に示すロボットシステムの作業の際の動作を説明するための図である。図7は、図1に示すロボットシステムのブロック図である。図8〜図10は、それぞれ、図1に示すロボットシステムのロボットのパターンCの動作の一例を説明するための図である。
なお、以下では、説明の都合上、図1、図3〜図6、図8〜図10中の上側を「上」または「上方」、下側を「下」または「下方」と言う。また、図1〜図6、図8〜図10中の基台側を「基端」または「上流」、その反対側(ハンド側)を「先端」または「下流」と言う。また、図1、図3〜図6、図8〜図10中の上下方向が鉛直方向である。また、図8〜図13には、ハンドを取り外した状態が図示されている。
図1〜図3および図7に示すように、ロボットシステム(産業用ロボットシステム)100は、ロボット(産業用ロボット)1と、ロボット1の作動(駆動)を制御する制御装置(ロボット制御装置)20とを備えている。このロボットシステム100は、例えば、腕時計のような精密機器等を製造する製造工程等で用いることができる。また、ロボットシステム100は、例えば、当該精密機器やこれを構成する部品の給材、除材、搬送および組立等の各作業を行うことができる。
制御装置20は、例えば、CPU(Central Processing Unit)(図示せず)および記憶部201等が内蔵されたパーソナルコンピューター(PC)等で構成することができる。ロボット1を制御するプログラムは、記憶部201に予め記憶されている。なお、制御装置20は、ロボット1(ロボット本体10)に内蔵されていてもよく、また、ロボット1とは、別体であってもよいが、本実施形態では、ロボット本体10の後述する基台11に配置されている。
ロボット1は、ロボット本体10と、第1駆動源401、第2駆動源402、第3駆動源403、第4駆動源404、第5駆動源405および第6駆動源406(6つの駆動源)とを備えている。ロボット本体10は、基台(支持部)11と、マニピュレーター6とを備えている。マニピュレーター6は、第1アーム(第1アーム部材)(腕部)12、第2アーム(第2アーム部材)(腕部)13、第3アーム(第3アーム部材)(腕部)14、第4アーム(第4アーム部材)(腕部)15、第5アーム(第5アーム部材)(腕部)16および第6アーム(第6アーム部材)(腕部)17(6つのアーム)とを備えている。なお、第5アーム16および第6アーム17によりリストが構成され、第6アーム17の先端には、例えば、ハンド91等のエンドエフェクターを着脱可能に取り付けることができるようになっている。
ロボット1は、基台11と、第1アーム12と、第2アーム13と、第3アーム14と、第4アーム15と、第5アーム16と、第6アーム17とが基端側から先端側に向ってこの順に連結された垂直多関節(6軸)ロボットである。なお、以下では、第1アーム12、第2アーム13、第3アーム14、第4アーム15、第5アーム16および第6アーム17をそれぞれ「アーム」とも言う。また、第1駆動源401、第2駆動源402、第3駆動源403、第4駆動源404、第5駆動源405および第6駆動源406をそれぞれ「駆動源」とも言う。
図3に示すように、基台11は、設置スペースの所定部分に固定(支持)される部分(取り付けられる部材)である。この固定方法としては、特に限定されず、例えば、複数本のボルトによる固定方法等を採用することができる。
本実施形態では、基台11は、設置スペースの天井(天井部)53の天井面531に固定されている。この天井面531は、水平面と平行な平面である。なお、基台11の先端部に設けられた板状のフランジ111が天井面531に取り付けられているが、基台11の天井面531への取り付け箇所は、これに限定されない。
また、このロボット1では、基台11とマニピュレーター6との接続部分、すなわち、後述する軸受部62の中心線(中心)621(図4参照)は、天井面531よりも鉛直方向上側に位置している。なお、軸受部62の中心線621は、これに限らず、例えば、天井面531よりも鉛直方向下側に位置していてもよく、また、天井面531と鉛直方向の同じ位置に位置していてもよい。
また、ロボット1は、基台11が天井面531に設置されているので、第1アーム12と第2アーム13との接続部分、すなわち、第2アーム13を回動可能に支持する図示しない軸受部の中心線(中心)は、軸受部62の中心線621よりも鉛直方向下側に位置している。
なお、基台11には、後述する関節171が含まれていてもよく、また、含まれていなくてもよい(図2参照)。
また、第1アーム12、第2アーム13、第3アーム14、第4アーム15、第5アーム16および第6アーム17は、それぞれ、基台11に対し独立して変位可能に支持されている。
図1〜図3に示すように、第1アーム12は、屈曲した形状をなしている。第1アーム12は、図3の状態で説明すると、基台11に接続され、基台11から後述する第1回動軸O1の軸方向(鉛直方向)であって図3中下側に延出した第1部分121と、第1部分121の図3中の下端から第2回動軸O2の軸方向(水平方向)であって図3中左側に延出した第2部分122と、第2部分122の第1部分121とは反対の端部に設けられ、第1回動軸O1の軸方向(鉛直方向)であって図3中下側に延出した第3部分123と、第3部分123の第2部分122とは反対の端部から第2回動軸O2の軸方向(水平方向)であって図3中右側に延出した第4部分124とを有している。なお、これら第1部分121、第2部分122、第3部分123および第4部分124は、一体で形成されている。また、第2部分122と第3部分123とは、第1回動軸O1および第2回動軸O2の双方と直交する方向から見て(図3の紙面手前から見て)、ほぼ直交(交差)している。
第2アーム13は、長手形状をなし、第1アーム12の先端部、すなわち、第4部分124の第3部分123とは反対の端部に接続されている。
第3アーム14は、長手形状をなし、第2アーム13の先端部、すなわち、第2アーム13の第1アーム12が接続されている端部とは反対の端部に接続されている。
第4アーム15は、第3アーム14の先端部、すなわち、第3アーム14の第2アーム13が接続されている端部とは反対の端部に接続されている。第4アーム15は、互いに対向する1対の支持部151、152を有している。支持部151、152は、第4アーム15の第5アーム16との接続に用いられる。
第5アーム16は、支持部151、152の間に位置し、支持部151、152に接続されることで第4アーム15と連結している。なお、第4アーム15は、この構造に限らず、例えば、支持部が1つ(片持ち)であってもよい。
第6アーム17は、平板状をなし、第5アーム16の基端部に接続されている。また、第6アーム17には、その先端部(第5アーム16と反対側の端部)に、エンドエフェクターとして、例えば、腕時計等のような精密機器、部品等を把持するハンド91が着脱可能に装着される。このハンド91の駆動は、制御装置20により制御される。なお、ハンド91としては、特に限定されず、例えば、複数本の指部(フィンガー)を有する構成のものが挙げられる。そして、このロボット1は、ハンド91で精密機器、部品等を把持したまま、アーム12〜17等の動作を制御することにより、当該精密機器、部品を搬送すること等の各作業を行うことができる。
図1〜図3に示すように、基台11と第1アーム12とは、関節(ジョイント)171を介して連結されている。関節171は、互いに連結された第1アーム12を基台11に対し回動可能に支持する機構を有している。これにより、第1アーム12は、基台11に対し、鉛直方向と平行な第1回動軸O1を中心に(第1回動軸O1周りに)回動可能となっている。第1回動軸O1は、基台11が取り付けられた天井53の天井面531の法線と一致している。また、第1回動軸O1は、ロボット1の最も上流側にある回動軸である。この第1回動軸O1周りの回動は、第1駆動部(駆動部)である第1モーター401Mおよび減速機(図示せず)を有する第1駆動源401の駆動によりなされる。第1駆動源401は第1モーター401Mとケーブル(図示せず)によって駆動され、この第1モーター401Mの駆動は、制御装置20により制御される。なお、前記減速機が省略されていてもよい。
また、この第1アーム12については、第1アーム12を制動するブレーキ(制動装置)は設けられていない。これにより、ロボット1の小型化、軽量化、構造の簡素化を図ることができる。
また、第1アーム12の回動角度は、90°以下に設定されていることが好ましい。これにより、後述するように、ロボット1の周囲に障害物が有る場合でも、容易に、その障害物を回避して動作することができ、また、タクトタイムを短縮することができる。
なお、以下では、第1モーター401Mと、後述する第2モーター402M、第3モーター403M、第4モーター404M、第5モーター405Mおよび第6モーター406Mとをそれぞれ「モーター」とも言う。
また、第1アーム12と第2アーム13とは、関節(ジョイント)172を介して連結されている。関節172は、互いに連結された第1アーム12と第2アーム13のうちの一方を他方に対し回動可能に支持する機構を有している。これにより、第2アーム13は、第1アーム12に対し、水平方向と平行な第2回動軸O2を中心に(第2回動軸O2周りに)回動可能となっている。第2回動軸O2は、第1回動軸O1と直交している。この第2回動軸O2周りの回動は、第2駆動部(駆動部)である第2モーター402Mおよび減速機(図示せず)を有する第2駆動源402の駆動によりなされる。第2駆動源402は第2モーター402Mとケーブル(図示せず)によって駆動され、この第2モーター402Mの駆動は、制御装置20により制御される。なお、前記減速機が省略されていてもよい。
また、第2アーム13を制動するブレーキ(制動装置)として、第2モーター402Mの軸部の近傍にブレーキ(図示せず)が設けられている。このブレーキにより、第2モーター402Mの軸部が回動することを阻止し、第2アーム13の姿勢を保持することができる。
なお、第2回動軸O2は、第1回動軸O1に直交する軸と平行であってもよく、また、第2回動軸O2は、第1回動軸O1と直交していなくても、軸方向が互いに異なっていればよい。
また、第2アーム13と第3アーム14とは、関節(ジョイント)173を介して連結されている。関節173は、互いに連結された第2アーム13と第3アーム14のうちの一方を他方に対し回動可能に支持する機構を有している。これにより、第3アーム14は、第2アーム13に対して、水平方向と平行な第3回動軸O3を中心に(第3回動軸O3周りに)回動可能となっている。第3回動軸O3は、第2回動軸O2と平行である。この第3回動軸O3周りの回動は、第3駆動部(駆動部)である第3モーター403Mおよび減速機(図示せず)を有する第3駆動源403の駆動によりなされる。第3駆動源403は、第3モーター403Mとケーブル(図示せず)によって駆動され、この第3モーター403Mの駆動は、制御装置20により制御される。なお、前記減速機が省略されていてもよい。
また、第3アーム14を制動するブレーキ(制動装置)として、第3モーター403Mの軸部の近傍にブレーキ(図示せず)が設けられている。このブレーキにより、第3モーター403Mの軸部が回動することを阻止し、第3アーム14の姿勢を保持することができる。
また、第3アーム14と第4アーム15とは、関節(ジョイント)174を介して連結されている。関節174は、互いに連結された第3アーム14と第4アーム15のうちの一方を他方に対し回動可能に支持する機構を有している。これにより、第4アーム15は、第3アーム14(基台11)に対し、第3アーム14の中心軸方向と平行な第4回動軸O4を中心に(第4回動軸O4周りに)回動可能となっている。第4回動軸O4は、第3回動軸O3と直交している。この第4回動軸O4周りの回動は、第4駆動部(駆動部)である第4モーター404Mおよび減速機(図示せず)を有する第4駆動源404の駆動によりなされる。第4駆動源404は、第4モーター404Mとケーブル(図示せず)によって駆動され、この第4モーター404Mの駆動は、制御装置20により制御される。なお、前記減速機が省略されていてもよい。
また、第4アーム15を制動するブレーキ(制動装置)として、第4モーター404Mの軸部の近傍にブレーキ(図示せず)が設けられている。このブレーキにより、第4モーター404Mの軸部が回動することを阻止し、第4アーム15の姿勢を保持することができる。
なお、第4回動軸O4は、第3回動軸O3に直交する軸と平行であってもよく、また、第4回動軸O4は、第3回動軸O3と直交していなくても、軸方向が互いに異なっていればよい。
また、第4アーム15と第5アーム16とは、関節(ジョイント)175を介して連結されている。関節175は、互いに連結された第4アーム15と第5アーム16の一方を他方に対し回動可能に支持する機構を有している。これにより、第5アーム16は、第4アーム15に対し、第4アーム15の中心軸方向と直交する第5回動軸O5を中心に(第5回動軸O5周りに)回動可能となっている。第5回動軸O5は、第4回動軸O4と直交している。この第5回動軸O5周りの回動は、第5駆動源405の駆動によりなされる。第5駆動源405は、第5駆動部(駆動部)である第5モーター405Mと、減速機(図示せず)と、第5モーター405Mの軸部に連結された第1プーリー(図示せず)と、第1プーリーに離間して配置され、減速機の軸部に連結された第2プーリー(図示せず)と、第1プーリーと第2プーリーとに掛け渡されたベルト(図示せず)とを有している。第5駆動源405は、第5モーター405Mとケーブル(図示せず)によって駆動され、この第5モーター405Mの駆動は、制御装置20により制御される。なお、前記減速機が省略されていてもよい。
また、第5アーム16を制動するブレーキ(制動装置)として、第5モーター405Mの軸部の近傍にブレーキ(図示せず)が設けられている。このブレーキにより、第5モーター405Mの軸部が回動することを阻止し、第5アーム16の姿勢を保持することができる。
なお、第5回動軸O5は、第4回動軸O4に直交する軸と平行であってもよく、また、第5回動軸O5は、第4回動軸O4と直交していなくても、軸方向が互いに異なっていればよい。
また、第5アーム16と第6アーム17とは、関節(ジョイント)176を介して連結されている。関節176は、互いに連結された第5アーム16と第6アーム17の一方を他方に対し回動可能に支持する機構を有している。これにより、第6アーム17は、第5アーム16に対し、第6回動軸O6を中心に(第6回動軸O6周りに)回動可能となっている。第6回動軸O6は、第5回動軸O5と直交している。この第6回動軸O6周りの回動は、第6駆動部(駆動部)である第6モーター406Mおよび減速機(図示せず)を有する第6駆動源406の駆動によりなされる。第6駆動源406は、第6モーターとケーブル(図示せず)によって駆動され、この第6モーター406Mの駆動は、制御装置20により制御される。なお、前記減速機が省略されていてもよい。
また、第6アーム17を制動するブレーキ(制動装置)として、第6モーター406Mの軸部の近傍にブレーキ(図示せず)が設けられている。このブレーキにより、第6モーター406Mの軸部が回動することを阻止し、第6アーム17の姿勢を保持することができる。
なお、第6回動軸O6は、第5回動軸O5に直交する軸と平行であってもよく、また、第6回動軸O6は、第5回動軸O5と直交していなくても、軸方向が互いに異なっていればよい。
前記モーター401M〜406Mとしては、特に限定されず、例えば、ACサーボモーター、DCサーボモーター等のサーボモーター等が挙げられる。
また、前記各ブレーキとしては、特に限定されず、例えば、電磁ブレーキ等が挙げられる。
なお、第1アーム12についても、他のアームと同様に、第1アーム12を制動するブレーキ(制動装置)として、例えば、モーター401Mの軸部の近傍に、電磁ブレーキ等のブレーキ(図示せず)を設けてもよい。また、逆に、第2アーム13〜第6アーム17については、それぞれ、ブレーキを省略してもよい。
また、駆動源401〜406のモーター401M〜406Mまたは各減速機には、それぞれ、第1アーム12の位置を検出する第1位置検出部として第1エンコーダー、第2アーム13の位置を検出する第2位置検出部として第2エンコーダー、第3アーム14の位置を検出する第3位置検出部として第3エンコーダー、第4アーム15の位置を検出する第4位置検出部として第4エンコーダー、第5アーム16の位置を検出する第5位置検出部として第5エンコーダー、第6アーム17の位置を検出する第6位置検出部として第6エンコーダーが設けられている(いずれのエンコーダーも図示せず)。各エンコーダーにより、それぞれ、駆動源401〜406のモーター401M〜406Mまたは各減速機の回転軸の回転角度を検出する。
以上、ロボット1の構成について簡単に説明した。
次に、第1アーム12〜第6アーム17の関係について説明するが、表現等を変え、種々の視点から説明する。また、第3アーム14〜第6アーム17については、これらを真っ直ぐに伸ばした状態、すなわち、最も長くした状態、換言すれば、第4回動軸O4と第6回動軸O6とが一致しているか、または平行である状態で考えることとする。
まず、図4に示すように、第1アーム12の長さL1は、第2アーム13の長さL2よりも長く設定されている。
ここで、第1アーム12の長さL1とは、第2回動軸O2の軸方向から見て、第2回動軸O2と、第1アーム12を回動可能に支持する軸受部62の図4中の左右方向に延びる中心線621との間の距離である。
また、第2アーム13の長さL2とは、第2回動軸O2の軸方向から見て、第2回動軸O2と、第3回動軸O3との間の距離である。
また、図5に示すように、第2回動軸O2の軸方向から見て、第1アーム12と第2アーム13とのなす角度θを0°にすることが可能なように構成されている。すなわち、第2回動軸O2の軸方向から見て、第1アーム12と第2アーム13とが重なることが可能、すなわち、第1アーム12と第2アーム13とが重なる第1状態となることが可能なように構成されている。
そして、第2アーム13は、角度θが0°の場合、すなわち、第2回動軸O2の軸方向から見て、第1アーム12と第2アーム13とが重なった場合、基台11が設けられた天井53の天井面531および第1アーム12の第2部分122と干渉しないように構成されている。なお、基台11の基端面が天井面531に取り付けられている場合も同様に、第2アーム13は、天井面531および第1アーム12の第2部分122と干渉しないように構成されている。
ここで、前記第1アーム12と第2アーム13とのなす角度θとは、第2回動軸O2の軸方向から見て、第2回動軸O2と第3回動軸O3とを通る直線(第2回動軸O2の軸方向から見た場合の第2アーム13の中心軸)61と、第1回動軸O1とのなす角度である。
また、第1アーム12を回動させず、第2アーム13を回動させることにより、第2回動軸O2の軸方向から見て角度θが0°となる状態(第1アーム12と第2アーム13とが重なった状態)を経て、第2アーム13の先端を、第1回動軸O1周りに180°異なる位置に移動させることが可能である(図6参照)。すなわち、第1アーム12を回動させず、第2アーム13を回動させることにより、マニピュレーター6の先端(第6アーム17の先端)を図6の左側に示す左側位置から、角度θが0°となる状態を経て、第1回動軸O1周りに180°異なる図6の右側に示す右側位置に移動させることが可能である(図6参照)。なお、第3アーム14〜第6アーム17は、それぞれ、必要に応じて回動させる。
また、第2アーム13の先端を第1回動軸O1周りに180°異なる位置に移動させる際(マニピュレーター6の先端を前記左側位置から前記右側位置に移動させる際)は、第1回動軸O1の軸方向から見て、第2アーム13の先端およびマニピュレーター6の先端は、直線上を移動する。
また、第3アーム14〜第6アーム17の合計の長さ(最大の長さ)L3は、第2アーム13の長さL2よりも長く設定されている。
これにより、第2回動軸O2の軸方向から見て、第2アーム13と第3アーム14とを重ねたとき、第2アーム13から第6アーム17の先端を突出させることができる。これによって、ハンド91が、第1アーム12および第2アーム13と干渉することを防止することができる。
ここで、第3アーム14〜第6アーム17の合計の長さ(最大の長さ)L3とは、第2回動軸O2の軸方向から見て、第3回動軸O3と、第6アーム17の先端との間の距離である(図4参照)。この場合、第3アーム14〜第6アーム17は、図4に示すように、第4回動軸O4と第6回動軸O6とが一致しているか、または平行である状態である。
また、図5に示すように、第2回動軸O2の軸方向から見て、第2アーム13と、第3アーム14とが重なることが可能なように構成されている。
すなわち、第2回動軸O2の軸方向から見て、第1アーム12と、第2アーム13と、第3アーム14とが同時に重なることが可能なように構成されている。
このロボット1では、上記のような関係を満たすことにより、第1アーム12を回動させず、第2アーム13、第3アーム14を回動させることにより、第2回動軸O2の軸方向から見て第1アーム12と第2アーム13とのなす角度θが0°となる状態(第1アーム12と第2アーム13とが重なった状態)を経て、ハンド91(第6アーム17の先端)を第1回動軸O1周りに180°異なる位置に移動させることができる。そして、この動作を用いて、効率良く、ロボット1を駆動することができ、また、ロボット1が干渉しないようにするために設ける空間を小さくすることができ、また、最後に述べるような種々の利点を有する。
このロボットシステム100では、ロボット1の動作パターン(動作モード)について、8つのパターン(モード)A、B、C、D、E、F、GおよびHのうちから任意のパターンを設定可能に構成されている。このパターンの設定(選択)は、使用者が、例えば、コマンド等で、ロボット1の各動作毎、具体的には、マニピュレーター6の先端またはハンド91の先端を所定の第1位置から前記第1位置とは異なる第2位置へ移動させる動作毎にそれぞれ行うことができるようになっている。この8つのパターンA〜Hのうち、パターンA、C、EおよびGを「第1の動作モード」とし、パターンB、D、FおよびHを「第2の動作モード」とする。
なお、このロボットシステム100において、第1位置から第2位置へ移動させる対象は、マニピュレーター6の先端とハンド91の先端とのいずれでもよいが、以下では、代表的に、マニピュレーター6の先端を図8に示す第1位置から図10に示す第2位置へ移動させる動作を例に挙げ説明する。
まずは、パターンA〜Hの説明で登場する参照姿勢、腕姿勢、肘姿勢、手首姿勢およびフラグF等について説明する。また、ここでは、上下方向を特定し易いように、ロボット1の第1回動軸O1の軸方向が鉛直方向であり、基台11が天井53に固定された状態で説明を行う。
参照姿勢は、ロボット1の基準の姿勢として、使用者が任意に設定できる姿勢であるが、使用者が設定していない状態では、マニピュレーター6の先端が第1位置に位置する動作開始時の姿勢に設定される。なお、使用者が参照姿勢として設定する姿勢の具体例としては、例えば、第1アーム12〜第6アーム17について、それぞれ、第1モーター401M〜第6モーター406M等に設けられているエンコーダーが原点を示すときの姿勢等が挙げられる。
また、腕姿勢としては、「右腕姿勢」と、「左腕姿勢」とがある。第2回動軸O2の軸方向で、かつ、ロボット1の背面側から見て(ロボット1自身から見て)、第5回動軸O5が第1回動軸O1よりも右側に位置する場合は、右腕姿勢であり(図4参照)、左側に位置する場合は、左腕姿勢である(図10参照)。すなわち、図4に示すように、第2回動軸O2の軸方向で、かつ、ロボット1の正面側から見て、第5回動軸O5が第1回動軸O1よりも左側に位置する場合は、右腕姿勢であり、図10に示すように、右側に位置する場合は、左腕姿勢である。なお、第5回動軸O5が第1回動軸O1上に位置する場合は、右腕姿勢と左腕姿勢とのいずれか一方に含める。
また、肘姿勢としては、「上肘姿勢」と、「下肘姿勢」とがある。図4に示すように、第2回動軸O2の軸方向から見て、第3回動軸O3が第2回動軸O2よりも上側(基台11側)に位置する場合は、上肘姿勢であり、図示しないが、下側(基台11と反対側)に位置する場合は、下肘姿勢である。なお、第3回動軸O3と第2回動軸O2の上下方向の位置が同じ場合は、上肘姿勢と下肘姿勢とのいずれか一方に含める。
また、手首姿勢としては、「上手首姿勢(Flip)」と、「下手首姿勢(NoFlip)」とがある。第5回動軸O5の軸方向から見て、第4回動軸O4に対して第6回動軸O6が所定方向に傾斜している場合は、上手首姿勢であり、前記と逆方向に傾斜している場合は、下手首姿勢である。なお、第4回動軸O4と第6回動軸O6とが一致または平行である場合は、上手首姿勢と下手首姿勢とのいずれか一方に含める。
また、第1アーム12〜第6アーム17についてのフラグFとしては、それぞれ、フラグが「1(立っている)」であることを示す「F1」と、フラグが「0(立っていない)」であることを示す「F0」とがある。基準角度からのアームの回転角度の絶対値が180°以下の場合は、F0であり、180°を超える場合は、F1である。前記基準角度としては、例えば、第1アーム12〜第6アーム17について、それぞれ、第1モーター401M〜第6モーター406M等に設けられているエンコーダーが原点を示すときの角度等が挙げられる。
次に、パターンA〜Hについて説明するが、下記の説明の「(2)姿勢変更の基準」における姿勢は、マニピュレーター6の先端が第2位置に移動した動作終了時の姿勢である。また、パターンA〜Hのうち、パターンCのみは、代表して、図を付けて説明する。
(パターンA)
(1)用途
タクトタイムを短縮(軌道も適正化)し、第5アーム16の第5回動軸O5回りの回動角度(回動量)を小さくする場合に使用する。
したがって、パターンAを選択することにより、回動角度を最小にする(制限する)アームとして、第5アーム16が選択される。
(2)姿勢変更の基準
(a)腕姿勢
マニピュレーター6(ハンド91)の先端を第1回動軸O1周りに角度aだけ異なる位置に移動させる動作において、前記角度aが90°以下の場合は、腕姿勢は参照姿勢と同じである。
前記角度aが90°よりも大きい場合は、腕姿勢は参照姿勢と異なる。
(b)肘姿勢
必ず上肘姿勢とする。
(c)手首姿勢、第4アーム15のフラグF
「上手首姿勢、第4アーム15のフラグFがF0」、「上手首姿勢、第4アーム15のフラグFがF1」、「下手首姿勢、第4アーム15のフラグFがF0」、「下手首姿勢、第4アーム15のフラグFがF1」の4つの組み合わせをそれぞれ比較し、これらのうちから第5アーム16の回動角度が最小となる組み合わせを選択する。
(d)第1アーム12のフラグF
第1アーム12のフラグFを変更することで第1アーム12の回動角度が90°以下になる場合は、第1アーム12のフラグFを変更する。また、腕姿勢は参照姿勢と同じである。
第1アーム12のフラグFを変更することで第1アーム12の回動角度が90°よりも大きい角度になる場合は、第1アーム12のフラグFは変更しない。また、腕姿勢は、参照姿勢と異なる。
(e)第6アーム17のフラグF
第6アーム17のフラグFとして、F0とF1とのうち、第6アーム17の回動角度が小さい方を選択する。
(パターンB)
(1)用途
タクトタイムを短縮(軌道も適正化)し、第4アーム15の第4回動軸O4回りの回動角度を小さくする場合に使用する。
したがって、パターンBを選択することにより、回動角度を最小にする(制限する)アームとして、第4アーム15が選択される。
(2)姿勢変更の基準
(a)腕姿勢
マニピュレーター6(ハンド91)の先端を第1回動軸O1周りに角度aだけ異なる位置に移動させる動作において、前記角度aが90°以下の場合は、腕姿勢は参照姿勢と同じである。
前記角度aが90°よりも大きい場合は、腕姿勢は参照姿勢と異なる。
(b)肘姿勢
必ず上肘姿勢とする。
(c)手首姿勢、第4アーム15のフラグF
「上手首姿勢、第4アーム15のフラグFがF0」、「上手首姿勢、第4アーム15のフラグFがF1」、「下手首姿勢、第4アーム15のフラグFがF0」、「下手首姿勢、第4アーム15のフラグFがF1」の4つの組み合わせをそれぞれ比較し、これらのうちから第4アーム15の回動角度が最小となる組み合わせを選択する。
(d)第1アーム12のフラグF
第1アーム12のフラグFを変更することで第1アーム12の回動角度が90°以下になる場合は、第1アーム12のフラグFを変更する。また、腕姿勢は参照姿勢と同じである。
第1アーム12のフラグFを変更することで第1アーム12の回動角度が90°よりも大きい角度になる場合は、第1アーム12のフラグFは変更しない。また、腕姿勢は、参照姿勢と異なる。
(e)第6アーム17のフラグF
第6アーム17のフラグFとして、F0とF1とのうち、第6アーム17の回動角度が小さい方を選択する。
(パターンC)
(1)用途
マニピュレーター6(ハンド91)の先端の回転半径を小さくし、すなわち、第1アーム12の回動角度を小さくし、また、第5アーム16の第5回動軸O5回りの回動角度を小さくする場合に使用する。
したがって、パターンCを選択することにより、回動角度を最小にする(制限する)アームとして、第5アーム16が選択される。
(2)姿勢変更の基準
(a)腕姿勢
参照姿勢と異なる腕姿勢にする。
(b)肘姿勢
必ず上肘姿勢とする
(c)手首姿勢、第4アーム15のフラグF
「上手首姿勢、第4アーム15のフラグFがF0」、「上手首姿勢、第4アーム15のフラグFがF1」、「下手首姿勢、第4アーム15のフラグFがF0」、「下手首姿勢、第4アーム15のフラグFがF1」の4つの組み合わせをそれぞれ比較し、これらのうちから第5アーム16の回動角度が最小となる組み合わせを選択する。
(d)第1アーム12のフラグF
参照姿勢と異なる腕姿勢で第1アーム12のフラグFを変更することで、前記フラグFを変更しない場合に比べて、第1アーム12の回動角度が小さくなる場合は、第1アーム12のフラグFを変更する。なお、前記第1アーム12の回動角度が小さくならない場合は、第1アーム12のフラグFは変更しない。
(e)第6アーム17のフラグF
第6アーム17のフラグFとして、F0とF1とのうち、第6アーム17の回動角度が小さい方を選択する。
動作モードをパターンCに設定して、マニピュレーター6の先端を図8に示す第1位置から図10に示す第2位置へ移動する動作を行う場合は、動作の途中の状態を表す図9に示すように、第4アーム15の回動角度を大きくし、第5アーム16は、回動させないか、または、第5アーム16の回動角度を小さくする。
(パターンD)
(1)用途
マニピュレーター6(ハンド91)の先端の回転半径を小さくし、すなわち、第1アーム12の回動角度を小さくし、また、第4アーム15の第4回動軸O4回りの回動角度を小さくする場合に使用する。
したがって、パターンDを選択することにより、回動角度を最小にする(制限する)アームとして、第4アーム15が選択される。
(2)姿勢変更の基準
(a)腕姿勢
参照姿勢と異なる腕姿勢にする。
(b)肘姿勢
必ず上肘姿勢とする
(c)手首姿勢、第4アーム15のフラグF
「上手首姿勢、第4アーム15のフラグFがF0」、「上手首姿勢、第4アーム15のフラグFがF1」、「下手首姿勢、第4アーム15のフラグFがF0」、「下手首姿勢、第4アーム15のフラグFがF1」の4つの組み合わせをそれぞれ比較し、これらのうちから第4アーム15の回動角度が最小となる組み合わせを選択する。
(d)第1アーム12のフラグF
参照姿勢と異なる腕姿勢で第1アーム12のフラグFを変更することで、前記フラグFを変更しない場合に比べて、第1アーム12の回動角度が小さくなる場合は、第1アーム12のフラグFを変更する。なお、前記第1アーム12の回動角度が小さくならない場合は、第1アーム12のフラグFは変更しない。
(e)第6アーム17のフラグF
第6アーム17のフラグFとして、F0とF1とのうち、第6アーム17の回動角度が小さい方を選択する。
動作モードをパターンDに設定して、マニピュレーター6の先端を図8に示す第1位置から図10に示す第2位置へ移動する動作を行う場合は、図示しないが、第5アーム16の回動角度を大きくし、第4アーム15は、回動させないか、または、第4アーム15の回動角度を小さくする。
(パターンE)
(1)用途
参考姿勢から腕姿勢を変更せず、第5アーム16の第5回動軸O5回りの回動角度を小さくする場合に使用する。
したがって、パターンEを選択することにより、回動角度を最小にする(制限する)アームとして、第5アーム16が選択される。
(2)姿勢変更の基準
(a)腕姿勢
参照姿勢と同じ腕姿勢にする。
(b)肘姿勢
必ず上肘姿勢とする。
(c)手首姿勢、第4アーム15のフラグF
「上手首姿勢、第4アーム15のフラグFがF0」、「上手首姿勢、第4アーム15のフラグFがF1」、「下手首姿勢、第4アーム15のフラグFがF0」、「下手首姿勢、第4アーム15のフラグFがF1」の4つの組み合わせをそれぞれ比較し、これらのうちから第5アーム16の回動角度が最小となる組み合わせを選択する。
(d)第1アーム12のフラグF
参照姿勢と同じ腕姿勢で第1アーム12のフラグFを変更することで、前記フラグFを変更しない場合に比べて、第1アーム12の回動角度が小さくなる場合は、第1アーム12のフラグFを変更する。なお、前記第1アーム12の回動角度が小さくならない場合は、第1アーム12のフラグFは変更しない。
(e)第6アーム17のフラグF
第6アーム17のフラグFとして、F0とF1とのうち、第6アーム17の回動角度が小さい方を選択する。
(パターンF)
(1)用途
参考姿勢から腕姿勢を変更せず、第4アーム15の第4回動軸O4回りの回動角度を小さくする場合に使用する。
したがって、パターンFを選択することにより、回動角度を最小にする(制限する)アームとして、第4アーム15が選択される。
(2)姿勢変更の基準
(a)腕姿勢
参照姿勢と同じ腕姿勢にする。
(b)肘姿勢
必ず上肘姿勢とする。
(c)手首姿勢、第4アーム15のフラグF
「上手首姿勢、第4アーム15のフラグFがF0」、「上手首姿勢、第4アーム15のフラグFがF1」、「下手首姿勢、第4アーム15のフラグFがF0」、「下手首姿勢、第4アーム15のフラグFがF1」の4つの組み合わせをそれぞれ比較し、これらのうちから第4アーム15の回動角度が最小となる組み合わせを選択する。
(d)第1アーム12のフラグF
参照姿勢と同じ腕姿勢で第1アーム12のフラグFを変更することで、前記フラグFを変更しない場合に比べて、第1アーム12の回動角度が小さくなる場合は、第1アーム12のフラグFを変更する。なお、前記第1アーム12の回動角度が小さくならない場合は、第1アーム12のフラグFは変更しない。
(e)第6アーム17のフラグF
第6アーム17のフラグFとして、F0とF1とのうち、第6アーム17の回動角度が小さい方を選択する。
(パターンG)
(1)用途
下肘姿勢を使用し、第5アーム16の第5回動軸O5回りの回動角度を小さくする場合に使用する。
したがって、パターンGを選択することにより、回動角度を最小にする(制限する)アームとして、第5アーム16が選択される。
(2)姿勢変更の基準
(a)腕姿勢
下肘姿勢がとれる腕姿勢にする。なお、下肘姿勢がとれる腕姿勢は、必ず、右腕姿勢と、左腕姿勢とのいずれか一方である。
(b)肘姿勢
必ず下肘姿勢とする。
(c)手首姿勢、第4アーム15のフラグF
「上手首姿勢、第4アーム15のフラグFがF0」、「上手首姿勢、第4アーム15のフラグFがF1」、「下手首姿勢、第4アーム15のフラグFがF0」、「下手首姿勢、第4アーム15のフラグFがF1」の4つの組み合わせをそれぞれ比較し、これらのうちから第5アーム16の回動角度が最小となる組み合わせを選択する。
(d)第1アーム12のフラグF
前記(a)腕姿勢で決定した腕姿勢で第1アーム12のフラグFを変更することで、前記フラグFを変更しない場合に比べて、第1アーム12の回動角度が小さくなる場合は、第1アーム12のフラグFを変更する。なお、前記第1アーム12の回動角度が小さくならない場合は、第1アーム12のフラグFは変更しない。
(e)第6アーム17のフラグF
第6アーム17のフラグFとして、F0とF1とのうち、第6アーム17の回動角度が小さい方を選択する。
(パターンH)
(1)用途
下肘姿勢を使用し、第4アーム15の第4回動軸O4回りの回動角度を小さくする場合に使用する。
したがって、パターンHを選択することにより、回動角度を最小にする(制限する)アームとして、第5アーム16が選択される。
(2)姿勢変更の基準
(a)腕姿勢
下肘姿勢がとれる腕姿勢にする。なお、下肘姿勢がとれる腕姿勢は、必ず、右腕姿勢と、左腕姿勢とのいずれか一方である。
(b)肘姿勢
必ず下肘姿勢とする。
(c)手首姿勢、第4アーム15のフラグF
「上手首姿勢、第4アーム15のフラグFがF0」、「上手首姿勢、第4アーム15のフラグFがF1」、「下手首姿勢、第4アーム15のフラグFがF0」、「下手首姿勢、第4アーム15のフラグFがF1」の4つの組み合わせをそれぞれ比較し、これらのうちから第4アーム15の回動角度が最小となる組み合わせを選択する。
(d)第1アーム12のフラグF
前記(a)腕姿勢で決定した腕姿勢で第1アーム12のフラグFを変更することで、前記フラグFを変更しない場合に比べて、第1アーム12の回動角度が小さくなる場合は、第1アーム12のフラグFを変更する。なお、前記第1アーム12の回動角度が小さくならない場合は、第1アーム12のフラグFは変更しない。
(e)第6アーム17のフラグF
第6アーム17のフラグFとして、F0とF1とのうち、第6アーム17の回動角度が小さい方を選択する。
以上説明したように、ロボットシステム100によれば、ロボット1の動作において、マニピュレーター6(ハンド91)の先端を第1位置から第2位置へ移動させる場合、マニピュレーター6の先端が第2位置に移動(位置)した状態で、ロボット1は、複数の姿勢をとることが可能であるが、そのロボット1の姿勢を選択することが可能である。このロボット1の姿勢の選択は、パターンA〜Hのうちから所定のパターンを選択することで行うことができる。
これにより、ロボット1の構造や用途等に応じて、前記第2位置へ移動した状態でのロボット1の姿勢を選択することができ、種々の効果を得ることができる。
具体例としては、例えば、マニピュレーター6に設けられた図示しないケーブルの配線の仕方として、第4アーム15の回動角度が小さい場合に、ケーブルの断線等が防止され、有利となる配線、第5アーム16の回動角度が小さい場合に、ケーブルの断線等が防止され、有利となる配線等がある。このため、前記第5アーム16の回動角度が小さい場合に有利である場合は、第1の動作モード、すなわち、パターンA、C、EおよびGのうちのいずれか1つを選択する。また、前記第4アーム15の回動角度が小さい場合に有利である場合は、第2の動作モード、すなわち、パターンB、D、FおよびHのうちのいずれか1つを選択する。これにより、ケーブルの断線等を防止することができる。
また、パターンAまたはBを選択することにより、タクトタイムを短縮することができ、作業効率を向上させることができる。
また、パターンCまたはDを選択することにより、マニピュレーター6の先端の回転半径を小さく、すなわち、第1アーム12の回動角度を小さくすることができる。これにより、ロボット1の周囲に障害物が有る場合でも、容易に、その障害物を回避して動作することができる。
また、パターンEまたはFを選択することにより、参考姿勢から腕姿勢を変更しないように、ロボット1を動作させることができる。
また、パターンGまたはHを選択することにより、下肘姿勢を使用するように、ロボット1を動作させることができる。
また、前述したように、ロボットシステム100では、第1アーム12を回動させず、第2アーム13、第3アーム14等を回動させることにより、第2回動軸O2の軸方向から見て第1アーム12と第2アーム13とのなす角度θが0°となる状態(第1アーム12と第2アーム13とが重なった状態)を経て、マニピュレーター6の先端を第1回動軸O1周りに180°異なる位置に移動させることができる。
これにより、ロボット1が干渉しないようにするための空間を小さくすることができる。
すなわち、まずは、天井53を低くすることができ、これにより、ロボット1の重心の位置が低くなり、ロボット1の振動の影響を小さくすることができる。すなわち、ロボット1の動作による反力により発生する振動を抑制することができる。
また、ロボット1の幅方向(生産ラインの方向)の稼働領域を小さくすることができ、これにより、ロボット1を生産ラインに沿って、単位長さ当たりに多く配置することができ、生産ラインを短縮することができる。
また、マニピュレーター6の先端を移動させる場合、ロボット1の動きを少なくすることができる。例えば、第1アーム12を回動させないか、または、第1アーム12の回動角度を小さくすることができ、これにより、タクトタイムを短縮することができ、作業効率を向上させることができる。
また、マニピュレーター6の先端を第1回動軸O1周りに180°異なる位置に移動させる動作(以下、「ショートカットモーション」とも言う)を、従来のロボットのように単純に第1アーム12を第1回動軸O1周りに回動させて実行しようとすると、ロボット1がその近傍の壁(図示せず)や周辺装置(図示せず)に干渉する虞があるので、その干渉を回避するための退避点をロボット1に教示する必要がある。例えば、第1アーム12のみを第1回動軸O1周りに90°回転させるとロボット1が壁に干渉する場合は、他のアームも回動させることで、壁に干渉しないように退避点を教示する必要がある。同様に、ロボット1が周辺装置にも干渉する場合は、周辺装置に干渉しないようにさらに退避点をロボット1に教示する必要がある。このように従来のロボットでは、多数の退避点を教示することが必要であり、特に、ロボット1の周辺の空間が小さい場合は、膨大な数の退避点が必要になり、教示に多くの手間および長い時間を要する。
これに対し、ロボットシステム100では、前記ショートカットモーションを実行する場合、干渉する虞がある領域や部分が非常に少なくなるため、教示する退避点の数を低減することができ、教示に要する手間および時間を低減することができる。すなわち、ロボットシステム100では、教示する退避点の数は、例えば、従来のロボットの1/3程度になり、飛躍的に教示が容易になる。
また、第3アーム14および第4アーム15の図3中の右側の二点鎖線で囲まれた領域(部分)101は、ロボット1がロボット1自身および他の部材と干渉しないか、または干渉し難い領域(部分)である。このため、前記領域101に、所定の部材を搭載した場合、その部材は、ロボット1および周辺装置等に干渉し難い。このため、ロボットシステム100では、領域101に、所定の部材を搭載することが可能である。特に、領域101のうち、第3アーム14の図3中の右側の領域に前記所定の部材を搭載する場合は、その部材が図示しない作業台上に配置された周辺装置(図示せず)と干渉する確率はさらに低くなるので、より効果的である。
前記領域101に搭載可能なものとしては、例えば、ハンド、ハンドアイカメラ等のセンサーの駆動を制御する制御装置、吸着機構の電磁弁等が挙げられる。
具体例としては、例えば、ハンドに吸着機構を設ける場合、領域101に電磁弁等を設置すると、ロボット1が駆動する際に前記電磁弁が邪魔にならない。このように、領域101は、利便性が高い。
なお、回動角度を最小にする(制限する)アームの選択について、例えば、ティーチングペンダントを用いて前記アームを選択可能に構成されていてもよく、また、パーソナルコンピューターを用いて前記アームを選択可能に構成されていてもよい。
また、本実施形態では、回動角度を最小にする(制限する)アームとして、第4アーム15または第5アーム16を選択可能に構成されているが、前記選択可能なアームは、これに限らず、例えば、第1アーム12〜第6アーム17のうちのいずれでもよい。
<第2実施形態>
以下、第2実施形態について説明するが、前述した第1実施形態との相違点を中心に説明し、同様の事項はその説明を省略する。
第2実施形態のロボットシステム100では、第1アーム12〜第6アーム17について、それぞれ、参照姿勢からの回動角度の制限値(上限値)を設定可能に構成されている。
参照姿勢が、マニピュレーター6の先端が第1位置に位置する動作開始時の姿勢である場合は、制限される回動角度は、動作開始時の姿勢からの回動角度である。
また、参照姿勢が、使用者が設定した所定の姿勢である場合は、制限される回動角度は、前記所定の姿勢からの回動角度である。
制御装置20は、マニピュレーター6の先端を第1位置から第2位置へ移動させる動作において、その動作を行う前に、第1アーム12が制限値を超えるか否かを判断し、第6アーム17が制限値を超える場合、前記動作を行わない。第1アーム12〜第5アーム16についても同様である。
以上のような第2実施形態によっても、前述した第1実施形態と同様の効果を発揮することができる。
また、このロボットシステム100では、使用者にとって予期しないロボット1の動作を防止することができる。
<第3実施形態>
以下、第3実施形態について説明するが、前述した第1実施形態との相違点を中心に説明し、同様の事項はその説明を省略する。
第3実施形態のロボットシステム100では、第2回動軸O2の軸方向から見て、第1アーム12と第2アーム13とが重なる第1状態を経る第2アーム13の動作における第2アーム13の加速度の制限値(上限値)は、前記第1状態を経ない第2アーム13の動作における第2アーム13の加速度の制限値よりも大きく設定される。
その理由は、第1状態を経るロボット1の動作では、マニピュレーター6の第2回動軸O2の周りの慣性モーメントは、第1状態の前と、第1状態のときと、第1状態の後とで、大、小、大と変化するので、第1状態を経ない動作を行う場合に比べて、同一のトルクで、加速度を大きくすることができるためである。また、第1状態を経るロボット1の動作では、第2アーム13の動作と第3アーム14の動作とが逆相になる、すなわち、第2アーム13の回動方向と第3アーム14の回動方向とが逆になるので、さらに加速度を大きくすることができる。
なお、減速度の絶対値は、第1状態を経る場合は、第1状態を経ない場合よりも大きくしてもよく、また、第1状態を経ない場合と同じにしてもよい。
同様に、第2回動軸O2の軸方向から見て、第2アーム13と第3アーム14とが重なる状態を経る第3アーム14の動作における第3アーム14の加速度の制限値は、前記状態を経ない第3アーム14の動作における第3アーム14の加速度の制限値よりも大きく設定される。この場合も、減速度の絶対値は、第1状態を経る場合は、第1状態を経ない場合よりも大きくしてもよく、また、第1状態を経ない場合と同じにしてもよい。
以上のような第3実施形態によっても、前述した第1実施形態と同様の効果を発揮することができる。
また、このロボットシステム100では、タクトタイムを短縮することができ、作業効率を向上させることができる。
<第4実施形態>
図11、図12および図13は、それぞれ、本発明のロボットシステムの第4実施形態におけるロボットの姿勢を示す図である。
以下、第4実施形態について説明するが、前述した第1実施形態との相違点を中心に説明し、同様の事項はその説明を省略する。
図11に示すように、第4実施形態のロボットシステム100では、同一軸上にある複数の回動軸のうち、少なくとも1つの回動軸周りに回動するアームの角度を設定可能に構成されている。
すなわち、まずは、図5に示すように、第1回動軸O1と、第4回動軸O4と、第6回動軸O6とが、同一軸上に位置するロボット1の姿勢では、第1回動軸O1周りに回動する第1アーム12と、第4回動軸O4周りに回動する第4アーム15と、第6回動軸O6周りに回動する第6アーム17とのうち、最も基台11側に位置する第1アーム12の角度が設定可能になっている。この場合、または、最も基台11側に位置する第1アーム12および基台11側から2番目に位置する第4アーム15の角度が設定可能になっている。これにより、第6アーム17の角度が決定され、使用者の意図するロボット1の姿勢を実現することができる。
また、図11に示すように、第1回動軸O1と、第4回動軸O4とが、同一軸上に位置するロボット1の姿勢では、第1回動軸O1周りに回動する第1アーム12と、第4回動軸O4周りに回動する第4アーム15とのうち、最も基台11側に位置する第1アーム12の角度が設定可能になっている。これにより、第4アーム15の角度が決定され、使用者の意図するロボット1の姿勢を実現することができる。
また、図12に示すように、第1回動軸O1と、第6回動軸O6とが、同一軸上に位置するロボット1の姿勢では、第1回動軸O1周りに回動する第1アーム12と、第6回動軸O6周りに回動する第6アーム17とのうち、最も基台11側に位置する第1アーム12の角度が設定可能になっている。これにより、第6アーム17の角度が決定され、使用者の意図するロボット1の姿勢を実現することができる。
また、図13に示すように、第4回動軸O4と、第6回動軸O6とが、同一軸上に位置するロボット1の姿勢では、第4回動軸O4周りに回動する第4アーム15と、第6回動軸O6周りに回動する第6アーム17とのうち、最も基台11側に位置する第4アーム15の角度が設定可能になっている。これにより、第6アーム17の角度が決定され、使用者の意図するロボット1の姿勢を実現することができる。
以上のような第4実施形態によっても、前述した第1実施形態と同様の効果を発揮することができる。
また、このロボットシステム100では、使用者の意図するロボット1の姿勢を実現することができる。
以上、本発明の制御装置、ロボットおよびロボットシステムを、図示の実施形態に基づいて説明したが、本発明はこれに限定されるものではなく、各部の構成は、同様の機能を有する任意の構成のものに置換することができる。また、他の任意の構成物が付加されていてもよい。
また、本発明は、前記各実施形態のうちの、任意の2以上の構成(特徴)を組み合わせたものであってもよい。
また、前記実施形態では、特許請求の範囲に規定したnが1の場合について説明したが、本発明では、これに限定されず、nは、1以上の整数である。すなわち、本発明では、nが1以上の任意の整数において、前記nが1の場合と同様に構成されていればよい。
また、前記実施形態では、マニピュレーター(ロボットアーム)の回動軸の数は、6つであるが、本発明では、これに限定されず、マニピュレーターの回動軸の数は、例えば、3つ、4つ、5つまたは7つ以上でもよい。すなわち、前記実施形態では、アーム(リンク)の数は、6つであるが、本発明では、これに限定されず、アームの数は、例えば、3つ、4つ、5つ、または、7つ以上でもよい。例えば、前記実施形態のロボットにおいて、第2アームと第3アームとの間にアームを追加することにより、アームの数が7つのロボットを実現することができる。
また、前記実施形態では、マニピュレーターの数は、1つであるが、本発明では、これに限定されず、マニピュレーターの数は、例えば、2つ以上でもよい。すなわち、ロボット(ロボット本体)は、例えば、双腕ロボット等の複数腕ロボットであってもよい。
また、前記実施形態では、エンドエフェクターとして、ハンドを例に挙げたが、本発明では、これに限定されず、エンドエフェクターとしては、その他、例えば、ドリル、溶接機、レーザー照射機等が挙げられる。
また、前記実施形態では、ロボットの基台の固定箇所は、天井であるが、本発明では、これに限定されず、この他、例えば、設置スペースにおける床、壁、作業台、地上等が挙げられる。また、ロボットは、セル内に設置されていてもよい。この場合、基台の固定箇所は、特に限定されず、例えば、セルの天井部、壁部、作業台、床等が挙げられる。
また、前記実施形態では、ロボット(基台)が固定される面は、水平面と平行な平面(面)であるが、本発明では、これに限定されず、例えば、水平面や鉛直面に対して傾斜した平面(面)でもよく、また、鉛直面と平行な平面(面)であってもよい。すなわち、第1回動軸は、鉛直方向や水平方向に対して傾斜していてもよく、また、水平方向と平行であってもよい。
また、前記実施形態では、第2回動軸(第(n+1)回動軸)の軸方向から見て、第1アーム(第nアーム)と第2アーム(第(n+1)アーム)とが重なることが可能であるが、本発明では、これに限定されず、第2回動軸の軸方向から見て、第1アームと第2アームとが重なることが不可能であってもよい。
また、本発明では、ロボットは、他の形式のロボットであってもよい。具体例としては、例えば、脚部を有する脚式歩行(走行)ロボット等が挙げられる。
1…ロボット、10…ロボット本体、100…ロボットシステム、11…基台、111…フランジ、12、13、14、15、16、17…アーム、121…第1部分、122…第2部分、123…第3部分、124…第4部分、151、152…支持部、171、172、173、174、175、176…関節、401、402、403、404、405、406…駆動源、401M、402M、403M、404M、405M、406M…モーター、20…制御装置、201…記憶部、53…天井、531…天井面、6…マニピュレーター、61…直線、62…軸受部、621…中心線、91…ハンド、101…領域、O1、O2、O3、O4、O5、O6…回動軸、θ…角度、L1、L2、L3…長さ

Claims (8)

  1. 回動軸周りに回動する第アームと、前記第アームに設けられ、前記第回動軸の軸方向と異なる軸方向である第回動軸周りに回動する第アームと、前記第2アームに設けられ、第3回動軸周りに回動する第3アームと、前記第3アームに設けられ、第4回動軸周りに回動する第4アームと、前記第4アームに設けられ、第5回動軸周りに回動する第5アームと、を有するマニピュレーターを備えたロボットであって、
    前記マニピュレーターの先端または前記マニピュレーターに設けられたエンドエフェクターの先端を、第1位置から前記第1位置と異なる第2位置へ移動させる場合、前記第アームまたは前記第アームの回動角度を制限して、前記マニピュレーターを動作し、
    前記第4アームの回動角度の制限は、前記第4アームの回動角度を最小にすることであり、
    前記第5アームの回動角度の制限は、前記第5アームの回動角度を最小にすることであることを特徴とするロボット。
  2. 前記第回動軸の軸方向から見て、前記第アームと前記第アームとが重なる第状態になることが可能である請求項1に記載のロボット。
  3. 前記第1状態を経る前記第アームの動作における前記第アームの加速度の制限値は、前記第1状態を経ない前記第アームの動作における前記第アームの加速度の制限値よりも大きい請求項2に記載のロボット。
  4. 前記第アームの長さは、前記第アームの長さよりも長い請求項2または3に記載のロボット。
  5. 前記第アームは基台に設けられている請求項2ないし4のいずれか1項に記載のロボット。
  6. 前記第アームの回動角度が90°以下である請求項1ないしのいずれか1項に記載のロボット。
  7. 請求項1ないしのいずれか1項に記載のロボットの動作を制御することを特徴とする制御装置。
  8. 請求項1ないしのいずれか1項に記載のロボットと、
    前記ロボットの動作を制御する制御装置と、を備えることを特徴とするロボットシステム。
JP2015215773A 2015-11-02 2015-11-02 制御装置、ロボットおよびロボットシステム Active JP6648491B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2015215773A JP6648491B2 (ja) 2015-11-02 2015-11-02 制御装置、ロボットおよびロボットシステム

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2015215773A JP6648491B2 (ja) 2015-11-02 2015-11-02 制御装置、ロボットおよびロボットシステム

Publications (3)

Publication Number Publication Date
JP2017087304A JP2017087304A (ja) 2017-05-25
JP2017087304A5 JP2017087304A5 (ja) 2018-12-13
JP6648491B2 true JP6648491B2 (ja) 2020-02-14

Family

ID=58769891

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2015215773A Active JP6648491B2 (ja) 2015-11-02 2015-11-02 制御装置、ロボットおよびロボットシステム

Country Status (1)

Country Link
JP (1) JP6648491B2 (ja)

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS61152380A (ja) * 1984-12-26 1986-07-11 株式会社日立製作所 ロボツト
JP2713702B2 (ja) * 1995-12-25 1998-02-16 川崎重工業株式会社 ロボットの制御方法および装置

Also Published As

Publication number Publication date
JP2017087304A (ja) 2017-05-25

Similar Documents

Publication Publication Date Title
US10189164B2 (en) Robot, control device, and robot system
JP6766339B2 (ja) ロボットおよびロボットシステム
JP6582491B2 (ja) ロボット
CN108858278B (zh) 机器人
CN106002931B (zh) 机器人系统
TWI675728B (zh) 機器人及機器人系統
JP6686644B2 (ja) ロボットおよびロボットシステム
US20130310973A1 (en) Method of controlling seven-axis articulated robot, control program, and robot control device
JP2016190297A (ja) ロボットシステム
US10252413B2 (en) Robot and robot system
JP2016190294A (ja) ロボットシステム
JP7144754B2 (ja) 多関節ロボットおよび多関節ロボットシステム
JP2017131969A (ja) ロボット
JP6300693B2 (ja) ロボット
JP2016203344A (ja) ロボット
JP5703870B2 (ja) ロボットの制御装置
JP6648491B2 (ja) 制御装置、ロボットおよびロボットシステム
JP2017104939A (ja) 制御装置、ロボットおよびロボットシステム
US20180001486A1 (en) Robot, robot control device, and robot system
JP5545263B2 (ja) ロボットシステム及び被作業物の製造方法
JP2017185625A (ja) ロボット
JP6638327B2 (ja) ロボット
JP2017185624A (ja) ロボット及びロボットシステム
JP6300706B2 (ja) ロボットシステム
JP2017080859A (ja) ロボットおよびロボットシステム

Legal Events

Date Code Title Description
A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20181101

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20181101

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20191004

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20191015

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20191120

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: 20191217

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20191230

R150 Certificate of patent or registration of utility model

Ref document number: 6648491

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150