特開 2025-15958 多関節ロボット、多関節ロボットの制御方法、ロボットシステム、及び、物品の製造方法

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】公開特許公報(A)

(11)【公開番号】P2025015958

(43)【公開日】2025-01-31

(54)【発明の名称】多関節ロボット、多関節ロボットの制御方法、ロボットシステム、及び、物品の製造方法

(51)【国際特許分類】

   B25J 9/06 20060101AFI20250124BHJP

【ＦＩ】

B25J9/06 A

【審査請求】未請求

【請求項の数】8

【出願形態】ＯＬ

(21)【出願番号】P 2023118901

(22)【出願日】2023-07-21

(71)【出願人】

【識別番号】000116079

【氏名又は名称】ローレルバンクマシン株式会社

(71)【出願人】

【識別番号】500267170

【氏名又は名称】ローレル機械株式会社

(71)【出願人】

【識別番号】500265501

【氏名又は名称】ローレル精機株式会社

(74)【代理人】

【識別番号】110003177

【氏名又は名称】弁理士法人旺知国際特許事務所

(72)【発明者】

【氏名】繁田 知秀

【テーマコード（参考）】

3C707

【Ｆターム（参考）】

3C707BS10

3C707BS14

3C707BS15

3C707CV02

3C707CW02

3C707CY39

3C707HS27

3C707HT20

3C707MS05

3C707MT04

(57)【要約】

【課題】基部の周辺であっても多関節ロボットの作業可能領域を狭めることなく、高精度にロボットの先端部を制御する。
【解決手段】ロボット１０は、リンクＬＫ１及びＬＫ２と、リンクＬＫ１が延在する方向Ｄｅ１とのなす角度が所定の角度より大きい軸Ａｘ３を第１回転軸としてリンクＬＫ２をリンクＬＫ１に対して回転させる関節機構ＪＥｒ３と、方向Ｄｅ１に沿って関節機構ＪＥｒ３をリンクＬＫ１に対して移動させる関節機構ＪＥｐ１と、リンクＬＫ２の延在方向に沿ってリンクＬＫ２を関節機構ＪＥｒ３に対して移動させる関節機構ＪＥｐ２と、ボディ部ＢＤＰの底面ＢＤＰｂｔに垂直な方向Ｄｖ１とのなす角度が所定の角度より大きい軸Ａｘ２を第３回転軸としてリンクＬＫ１を回転させる関節機構ＪＥｒ２とを有する。方向Ｄｅ１からの平面視において、第１回転軸に沿う方向Ｄａｘ３と第３回転軸に沿う方向Ｄａｘ２とは、所定の角度以上の第１角度で交差する。
【選択図】図１

【特許請求の範囲】

【請求項1】

基部と、
先端部と、
第１リンク及び第２リンクを含み、前記基部と前記先端部とを接続する複数のリンクと、
前記第１リンクと前記第２リンクとを接続し、前記第１リンクが延在する第１方向とのなす角度が所定の角度より大きい軸を第１回転軸として前記第２リンクを前記第１リンクに対して回転させる第１駆動機構と、
前記第１方向に沿って、前記第１駆動機構を前記第１リンクに対して相対的に移動させる第１移動機構と、
前記第２リンクが延在する第２方向に沿って、前記第２リンクを前記第１駆動機構に対して相対的に移動させる第２移動機構と、
前記基部の底面に垂直な方向とのなす角度が前記所定の角度以下の軸を第２回転軸として、前記基部の少なくとも一部分を回転させる第２駆動機構と、
前記基部と前記第１リンクとを接続し、前記基部の底面に垂直な方向とのなす角度が前記所定の角度より大きい軸を第３回転軸として前記第１リンクを回転させる第３駆動機構と、
を備え、
前記第１方向からの平面視において、前記第１回転軸に沿う方向と前記第３回転軸に沿う方向は、前記所定の角度以上の第１角度で交差している、
ことを特徴とする多関節ロボット。

【請求項2】

前記第１角度は、実質的に９０度である、
ことを特徴とする請求項１に記載の多関節ロボット。

【請求項3】

前記第２リンクと前記先端部とを接続し、前記先端部を前記第２リンクに対して回転させる第４駆動機構をさらに有し、
前記第４駆動機構は、
前記第２方向とのなす角度が前記所定の角度より大きい軸を第４回転軸として、前記先端部を前記第２リンクに対して回転させ、
前記先端部は、
前記第２リンクに接続される第１部分と、
前記第１部分に接続される第２部分と、
前記第１部分と前記第２部分とを接続し、前記第４回転軸とのなす角度が前記所定の角度より大きい軸を第５回転軸として、前記第２部分を前記第１部分に対して回転させる第５駆動機構と、
前記第５回転軸とのなす角度が前記所定の角度より大きい軸を第６回転軸として、前記先端部のうちエンドエフェクタが取り付けられる部分を回転させる第６駆動機構と、
を含む、
ことを特徴とする請求項２に記載の多関節ロボット。

【請求項4】

前記第２リンクと前記先端部とを接続し、前記先端部を前記第２リンクに対して回転させる第４駆動機構をさらに有し、
前記第４駆動機構は、
前記第２方向とのなす角度が前記所定の角度以下の軸を第４回転軸として、前記先端部を前記第２リンクに対して回転させ、
前記先端部は、
前記第２リンクに接続される第１部分と、
前記第１部分に接続される第２部分と、
前記第１部分と前記第２部分とを接続し、前記第４回転軸とのなす角度が前記所定の角度より大きい軸を第５回転軸として、前記第２部分を前記第１部分に対して回転させる第５駆動機構と、
前記第５回転軸とのなす角度が前記所定の角度より大きい軸を第６回転軸として、前記先端部のうちエンドエフェクタが取り付けられる部分を回転させる第６駆動機構と、
を含む、
ことを特徴とする請求項２に記載の多関節ロボット。

【請求項5】

前記第１駆動機構を駆動する第１モータと、
前記第１移動機構を駆動する第２モータと、
前記第２移動機構を駆動する第３モータと、
前記第２駆動機構を駆動する第４モータと、
前記第３駆動機構を駆動する第５モータと、
をさらに有し、
前記第１移動機構は、
前記第１リンクの内部に配置され、前記第１方向に延在し、前記第２モータの回転に伴い、前記第１方向に沿う軸を回転軸として回転する第１ねじ部と、
前記第１駆動機構に接続され、前記第１ねじ部が挿通され、前記第１ねじ部の回転に伴い、前記第１ねじ部に対して相対的に移動する第１移動部と、
を有し、
前記第２移動機構は、
前記第２リンクの内部に配置され、前記第２方向に延在し、前記第３モータの回転に伴い、前記第２方向に沿う軸を回転軸として回転する第２ねじ部と、
前記第１駆動機構に接続され、前記第２ねじ部が挿通され、前記第２ねじ部の回転に伴い、前記第２ねじ部に対して相対的に移動する第２移動部と、
を有し、
前記第１駆動機構は、前記第１移動部の移動に伴い、前記第１リンクに対して相対的に移動し、
前記第２リンクは、前記第２移動部の移動に伴い、前記第１駆動機構に対して相対的に移動する、
ことを特徴とする請求項２に記載の多関節ロボット。

【請求項6】

請求項５に記載の多関節ロボットの制御方法であって、
前記多関節ロボットの動作を制御する制御装置は、
前記第１モータ、前記第２モータ及び前記第３モータを制御することにより、前記多関節ロボットの前記先端部が所定の平面に沿って移動するように、前記多関節ロボットの動作を制御する、
ことを特徴とする多関節ロボットの制御方法。

【請求項7】

請求項５に記載の多関節ロボットと、
前記先端部に取り付けられたエンドエフェクタと、
前記多関節ロボット及び前記エンドエフェクタの動作を制御する制御装置と、
を備え、
前記制御装置は、
前記第１モータ、前記第２モータ、前記第３モータ、前記第４モータ及び前記第５モータを制御することにより、前記多関節ロボットの動作を制御する、
ことを特徴とするロボットシステム。

【請求項8】

請求項７に記載のロボットシステムにより、部品を組み付ける、又は、部品を取り除く、
ことを特徴とする物品の製造方法。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、多関節ロボット、多関節ロボットの制御方法、ロボットシステム、及び、物品の製造方法に関する。

【背景技術】

【0002】

人と同様の動作を行うロボットとして、多関節ロボットが知られている（例えば、特許文献１参照）。

【先行技術文献】

【特許文献】

【0003】

【特許文献1】特開昭６１－１３６７８２号公報

【発明の概要】

【発明が解決しようとする課題】

【0004】

ところで、従来の多関節ロボットの場合、ロボットのアーム同士が干渉するため、ロボットの先端部が到達できる領域に制限があり、多関節ロボットの作業可能領域を狭めていた。特にロボットの根本側に位置する、アームが取り付けられている基部の周辺は、アーム同士が干渉しやすく作業可能領域外となる領域が多くなる。すなわち、２つのアームを有するロボットの場合、２つのアームのなす角が０°に近づくためアーム同士が干渉してしまう。また、作業可能領域内であった場合でも、先端部の制御は２つのアームを介して行われるため、精度を高めるにも限界があった。このため、基部の周辺であっても多関節ロボットの作業可能領域を狭めることなく、高精度にロボットの先端部を制御することが望まれている。

【課題を解決するための手段】

【0005】

本発明の好適な態様に係る多関節ロボットは、基部と、先端部と、第１リンク及び第２リンクを含み、前記基部と前記先端部とを接続する複数のリンクと、前記第１リンクと前記第２リンクとを接続し、前記第１リンクが延在する第１方向とのなす角度が所定の角度より大きい軸を第１回転軸として前記第２リンクを前記第１リンクに対して回転させる第１駆動機構と、前記第１方向に沿って、前記第１駆動機構を前記第１リンクに対して相対的に移動させる第１移動機構と、前記第２リンクが延在する第２方向に沿って、前記第２リンクを前記第１駆動機構に対して相対的に移動させる第２移動機構と、前記基部の底面に垂直な方向とのなす角度が前記所定の角度以下の軸を第２回転軸として、前記基部の少なくとも一部分を回転させる第２駆動機構と、前記基部と前記第１リンクとを接続し、前記基部の底面に垂直な方向とのなす角度が前記所定の角度より大きい軸を第３回転軸として前記第１リンクを回転させる第３駆動機構と、を備え、前記第１方向からの平面視において、前記第１回転軸に沿う方向と前記第３回転軸に沿う方向は、前記所定の角度以上の第１角度で交差している。

【0006】

本発明の好適な態様に係る多関節ロボットの制御方法は、上述の多関節ロボットにおいて、前記第１駆動機構を駆動する第１モータと、前記第１移動機構を駆動する第２モータと、前記第２移動機構を駆動する第３モータと、前記第２駆動機構を駆動する第４モータと、前記第３駆動機構を駆動する第５モータと、をさらに有し、前記第１移動機構は、前記第１リンクの内部に配置され、前記第１方向に延在し、前記第２モータの回転に伴い、前記第１方向に沿う軸を回転軸として回転する第１ねじ部と、前記第１駆動機構に接続され、前記第１ねじ部が挿通され、前記第１ねじ部の回転に伴い、前記第１ねじ部に対して相対的に移動する第１移動部と、を有し、前記第２移動機構は、前記第２リンクの内部に配置され、前記第２方向に延在し、前記第３モータの回転に伴い、前記第２方向に沿う軸を回転軸として回転する第２ねじ部と、前記第１駆動機構に接続され、前記第２ねじ部が挿通され、前記第２ねじ部の回転に伴い、前記第２ねじ部に対して相対的に移動する第２移動部と、を有し、前記第１駆動機構は、前記第１移動部の移動に伴い、前記第１リンクに対して相対的に移動し、前記第２リンクは、前記第２移動部の移動に伴い、前記第１駆動機構に対して相対的に移動し、前記第１角度は、実質的に９０度である、多関節ロボットの制御方法であって、前記多関節ロボットの動作を制御する制御装置は、前記第１モータ、前記第２モータ及び前記第３モータを制御することにより、前記多関節ロボットの前記先端部が所定の平面に沿って移動するように、前記多関節ロボットの動作を制御する。

【0007】

本発明の好適な態様に係るロボットシステムは、上述の多関節ロボットにおいて、前記第１駆動機構を駆動する第１モータと、前記第１移動機構を駆動する第２モータと、前記第２移動機構を駆動する第３モータと、前記第２駆動機構を駆動する第４モータと、前記第３駆動機構を駆動する第５モータと、をさらに有し、前記第１移動機構は、前記第１リンクの内部に配置され、前記第１方向に延在し、前記第２モータの回転に伴い、前記第１方向に沿う軸を回転軸として回転する第１ねじ部と、前記第１駆動機構に接続され、前記第１ねじ部が挿通され、前記第１ねじ部の回転に伴い、前記第１ねじ部に対して相対的に移動する第１移動部と、を有し、前記第２移動機構は、前記第２リンクの内部に配置され、前記第２方向に延在し、前記第３モータの回転に伴い、前記第２方向に沿う軸を回転軸として回転する第２ねじ部と、前記第１駆動機構に接続され、前記第２ねじ部が挿通され、前記第２ねじ部の回転に伴い、前記第２ねじ部に対して相対的に移動する第２移動部と、を有し、前記第１駆動機構は、前記第１移動部の移動に伴い、前記第１リンクに対して相対的に移動し、前記第２リンクは、前記第２移動部の移動に伴い、前記第１駆動機構に対して相対的に移動し、前記第１角度は、実質的に９０度である、多関節ロボットと、前記先端部に取り付けられたエンドエフェクタと、前記多関節ロボット及び前記エンドエフェクタの動作を制御する制御装置と、を備え、前記制御装置は、前記第１モータ、前記第２モータ、前記第３モータ、前記第４モータ及び前記第５モータを制御することにより、前記多関節ロボットの動作を制御する。

【0008】

本発明の好適な態様に係る物品の製造方法は、上述のロボットシステムにより、部品を組み付ける、又は、部品を取り除く。

【発明の効果】

【0009】

本発明によれば、基部の周辺であっても多関節ロボットの作業可能領域を狭めることなく、高精度にロボットの先端部を制御することができる。

【図面の簡単な説明】

【0010】

【図1】実施形態に係るロボットシステムの概要を説明するための説明図である。

【図2】関節機構の一例を説明するための説明図である。

【図3】ロボットの先端部を接地面に対して水平方向に移動させる動作の一例を説明するための説明図である。

【図4】図３に示したロボットの動作の続きの動作を説明するための説明図である。

【図5】複数の関節機構のうち、直動関節に対応する２つの関節機構のみを駆動することにより実現される動作の一例を説明するための説明図である。

【図6】図１に示したロボットコントローラのハードウェア構成の一例を示す図である。

【図7】第１変形例に係る先端部の一例を説明するための説明図である。

【図8】旋回の一例を説明するための説明図である。

【発明を実施するための形態】

【0011】

以下、本発明を実施するための形態について図面を参照して説明する。なお、各図において、各部の寸法及び縮尺は、実際のものと適宜に異ならせてある。また、以下に述べる実施の形態は、本発明の好適な具体例であるから、技術的に好ましい種々の限定が付されているが、本発明の範囲は、以下の説明において特に本発明を限定する旨の記載がない限り、これらの形態に限られるものではない。

【0012】

［１．実施形態］
先ず、図１を参照しながら、実施形態に係るロボットシステム１の概要の一例について説明する。

【0013】

図１は、実施形態に係るロボットシステム１の概要を説明するための説明図である。

【0014】

ロボットシステム１は、例えば、ロボット１０と、ロボット１０に着脱可能に取り付けられるエンドエフェクタ２０と、ロボット１０及びエンドエフェクタ２０の動作を制御するロボットコントローラ３０とを有する。ロボット１０は、「多関節ロボット」の一例であり、ロボットコントローラ３０は、「制御装置」の一例である。

【0015】

ロボット１０及びロボットコントローラ３０は、例えば、有線を用いた接続により、互いに通信可能に接続されている。なお、ロボット１０とロボットコントローラ３０との接続は、無線を用いた接続であってもよいし、有線及び無線の両方を用いた接続であってもよい。また、ロボットコントローラ３０は、ロボット１０に取り付けられたエンドエフェクタ２０と通信可能である。ロボットコントローラ３０としては、他の装置と通信可能な任意の情報処理装置を採用することができる。なお、ロボットコントローラ３０の構成は、後述する図６において説明される。

【0016】

ロボット１０は、例えば、農場、工場及び倉庫等での作業に用いられる多関節ロボットである。具体的には、ロボット１０は、回転関節に対応する６つの関節機構ＪＥｒ（ＪＥｒ１、ＪＥｒ２、ＪＥｒ３、ＪＥｒ４、ＪＥｒ５及びＪＥｒ６）を有する６軸多関節ロボットに、直動関節に対応する２つの関節機構ＪＥｐ（ＪＥｐ１及びＪＥｐ２）を追加した８軸多関節ロボットである。例えば、ロボット１０は、６つの関節機構ＪＥｒと、２つの関節機構ＪＥｐと、ボディ部ＢＤＰと、２つのリンクＬＫ（ＬＫ１及びＬＫ２）と、先端部ＴＰ１とを有する。なお、図１に示す例では、関節機構ＪＥｒ１は、ボディ部ＢＤＰに含まれ、関節機構ＪＥｒ５及びＪＥｒ６は、先端部ＴＰ１に含まれる。また、関節機構ＪＥｐ１は、リンクＬＫ１に設けられ、関節機構ＪＥｐ２は、リンクＬＫ２に設けられる。以下では、関節機構ＪＥｒ及びＪＥｐは、特に区別せずに、関節機構ＪＥとも称される。例えば、ロボット１０は、複数の関節機構ＪＥを駆動する複数のモータＭＯ（図２参照）をさらに有する。図１では、図を見やすくするために、複数の関節機構ＪＥを駆動する複数のモータＭＯ、複数のモータＭＯの各々に設けられる減速機及びエンコーダ等の記載を省略している。

【0017】

ボディ部ＢＤＰは、「基部」の一例である。また、リンクＬＫ１は、「第１リンク」の一例であり、リンクＬＫ２は、「第２リンク」の一例である。従って、リンクＬＫ１及びＬＫ２は、「複数のリンク」に該当する。例えば、リンクＬＫ１及びＬＫ２は、ボディ部ＢＤＰと先端部ＴＰ１とを接続する。

【0018】

ここで、例えば、部材の接続は、２つの部材が直接的に接続される場合と、２つの部材が間接的に接続される場合との両方を含む。２つの部材が直接的に接続されるとは、２つの部材が互いに接触する状態、及び、２つの部材が互いに接触する状態と同視できる状態を含む。２つの部材が互いに接触する状態と同視できる状態とは、例えば、２つの部材の一方が他方に接着剤等により固定される状態である。また、２つの部材が間接的に接続されるとは、２つの部材の間に他の部材が配置されることを意味する。

【0019】

関節機構ＪＥｒ１は、「第２駆動機構」の一例であり、関節機構ＪＥｒ２は、「第３駆動機構」の一例である。関節機構ＪＥｒ３は、「第１駆動機構」の一例であり、関節機構ＪＥｒ４は、「第４駆動機構」の一例である。また、関節機構ＪＥｒ５は、「第５駆動機構」の一例であり、関節機構ＪＥｒ６は、「第６駆動機構」の一例である。また、関節機構ＪＥｐ１は、「第１移動機構」の一例であり、関節機構ＪＥｐ２は、「第２移動機構」の一例である。

【0020】

ボディ部ＢＤＰは、例えば、床等の所定の場所に固定される土台部ＢＤＰｂａと、関節機構ＪＥｒ２に接続される関節機構ＪＥｒ１とを含む。関節機構ＪＥｒ１は、ボディ部ＢＤＰの底面ＢＤＰｂｔに垂直な軸Ａｘ１を回転軸として、ボディ部ＢＤＰの一部分を回転させる。例えば、関節機構ＪＥｒ１は、関節機構ＪＥｒ１のうち、関節機構ＪＥｒ２と接続される部分を含む外壁を、軸Ａｘ１を回転軸として土台部ＢＤＰｂａに対して回転させる。すなわち、関節機構ＪＥｒ１は、軸Ａｘ１を回転軸として、関節機構ＪＥｒ２をボディ部ＢＤＰに対して回転させる。なお、軸Ａｘ１は、「第２回転軸」の一例である。

【0021】

ここで、「垂直」は、厳密な垂直だけではなく、実質的な垂直（例えば、誤差範囲内の垂直）も含む。同様に、後述する「平行」は、厳密な平行だけではなく、実質的な平行（例えば、誤差範囲内の平行）も含む。図１の回転方向Ｄｒ１は、ボディ部ＢＤＰの一部分が軸Ａｘ１を回転軸として回転する場合のボディ部ＢＤＰの一部分の回転方向を示す。

【0022】

関節機構ＪＥｒ２は、ボディ部ＢＤＰとリンクＬＫ１とを接続し、ボディ部ＢＤＰの底面ＢＤＰｂｔに平行な軸Ａｘ２を回転軸としてリンクＬＫ１をボディ部ＢＤＰに対して回転させる。図１の回転方向Ｄｒ２は、リンクＬＫ１が軸Ａｘ２を回転軸として回転する場合のリンクＬＫ１の回転方向を示す。また、方向Ｄａｘ２は、関節機構ＪＥｒ２の回転軸である軸Ａｘ２に沿う方向のうち、関節機構ＪＥｒ２からリンクＬＫ１に向かう方向である。なお、軸Ａｘ２は、「第３回転軸」の一例である。

【0023】

リンクＬＫ１は、例えば、中空であり、長尺に形成される。また、リンクＬＫ１は、リンクＬＫ１が延在する方向Ｄｅ１に延在する開口Ｈｌｋ１を有する。なお、方向Ｄｅ１は、「第１方向」の一例である。

【0024】

開口Ｈｌｋ１は、例えば、リンクＬＫ１のうち、リンクＬＫ２に対向する部分を含む面に形成される。リンクＬＫ１の内部には、関節機構ＪＥｒ３の一部及び関節機構ＪＥｐ１が設けられる。例えば、関節機構ＪＥｒ３の一部は、リンクＬＫ１の内部に位置し、関節機構ＪＥｒ３の他の部分は、開口Ｈｌｋ１からリンクＬＫ１の外部に出ている。なお、関節機構ＪＥｒ３のうち、リンクＬＫ１の外部に出ている部分、又は、リンクＬＫ１の外部に出ている部分の一部は、後述するリンクＬＫ２の開口Ｈｌｋ２を通り、リンクＬＫ２の内部に位置する。

【0025】

なお、リンクＬＫ１は、関節機構ＪＥｒ１により、軸Ａｘ１を回転軸としてボディ部ＢＤＰに対して回転し、関節機構ＪＥｒ２により、軸Ａｘ２を回転軸としてボディ部ＢＤＰに対して回転する。

【0026】

関節機構ＪＥｒ３は、リンクＬＫ１とリンクＬＫ２とを接続し、リンクＬＫ１が延在する方向Ｄｅ１に垂直な軸Ａｘ３を回転軸としてリンクＬＫ２をリンクＬＫ１に対して回転させる。図１の回転方向Ｄｒ３は、リンクＬＫ２が軸Ａｘ３を回転軸として回転する場合のリンクＬＫ２の回転方向を示す。また、方向Ｄａｘ３は、関節機構ＪＥｒ３の回転軸である軸Ａｘ３に沿う方向のうち、リンクＬＫ１からリンクＬＫ２に向かう方向である。なお、軸Ａｘ３は、「第１回転軸」の一例である。

【0027】

本実施形態では、軸Ａｘ３は、方向Ｄｅ１及びＤａｘ２に垂直な軸である。この場合、方向Ｄｅ１からの平面視において、軸Ａｘ３に沿う直線と軸Ａｘ２に沿う直線は、９０度で交差する。すなわち、方向Ｄｅ１からの平面視において、軸Ａｘ３に沿う方向Ｄａｘ３と軸Ａｘ２に沿う方向Ｄａｘ２は、９０度で交差している。なお、平面視とは、例えば、特定の方向から対象物をみることである。また、「９０度で交差」は、厳密に９０度で交差することだけではなく、実質的に９０度（例えば、９０度と見なせる誤差範囲内の角度）で交差することも含む。９０度は、「第１角度」の一例である。

【0028】

このように、本実施形態では、方向Ｄｅ１からの平面視において、軸Ａｘ３に沿う方向Ｄａｘ３と軸Ａｘ２に沿う方向Ｄａｘ２とが９０度で交差しているため、リンクＬＫ２の旋回面は、リンクＬＫ１の旋回面に対して垂直となる。なお、リンクＬＫ２の旋回面は、リンクＬＫ２が軸Ａｘ３を回転軸として回転する場合のリンクＬＫ２の所定位置の軌跡を含む面である。同様に、リンクＬＫ１の旋回面は、リンクＬＫ１が軸Ａｘ２を回転軸として回転する場合のリンクＬＫ１の所定位置の軌跡を含む面である。

【0029】

関節機構ＪＥｐ１は、方向Ｄｅ１に沿って、関節機構ＪＥｒ３をリンクＬＫ１に対して相対的に移動させる。関節機構ＪＥｒ３が方向Ｄｅ１に沿って移動することにより、リンクＬＫ２は、方向Ｄｅ１に沿って、リンクＬＫ１に対して相対的に移動する。なお、図１に示す例では、関節機構ＪＥｐ１が関節機構ＪＥｒ３を方向Ｄｅ１に沿って移動させる場合、リンクＬＫ１の開口Ｈｌｋ１の部分が、関節機構ＪＥｒ３の移動可能な移動領域ＡＲｍｖ１に該当する。

【0030】

リンクＬＫ２は、例えば、中空であり、長尺に形成される。また、リンクＬＫ２は、リンクＬＫ２が延在する方向Ｄｅ２に延在する開口Ｈｌｋ２を有する。なお、方向Ｄｅ２は、「第２方向」の一例である。

【0031】

開口Ｈｌｋ２は、例えば、リンクＬＫ２のうち、リンクＬＫ１に対向する部分を含む面に形成される。リンクＬＫ２の内部には、関節機構ＪＥｒ３の一部及び関節機構ＪＥｐ２が設けられる。例えば、関節機構ＪＥｒ３の一部は、リンクＬＫ２の内部に位置し、関節機構ＪＥｒ３の他の部分は、開口Ｈｌｋ２からリンクＬＫ２の外部に出ている。

【0032】

関節機構ＪＥｐ２は、リンクＬＫ２が延在する方向Ｄｅ２に沿って、リンクＬＫ２を関節機構ＪＥｒ３に対して相対的に移動させる。これにより、リンクＬＫ２は、方向Ｄｅ２に沿って、関節機構ＪＥｒ３に対して相対的に移動する。すなわち、リンクＬＫ２は、方向Ｄｅ２に沿って、リンクＬＫ１に対して相対的に移動する。

【0033】

このように、リンクＬＫ２は、関節機構ＪＥｐ１により、方向Ｄｅ１に沿って、リンクＬＫ１に対して相対的に移動し、関節機構ＪＥｐ２により、方向Ｄｅ２に沿って、リンクＬＫ１に対して相対的に移動する。

【0034】

ここで、リンクＬＫ２が関節機構ＪＥｒ３に対して相対的に移動することは、関節機構ＪＥｒ３がリンクＬＫ２に対して相対的に移動することとも換言できる。従って、関節機構ＪＥｐ２は、方向Ｄｅ２に沿って関節機構ＪＥｒ３をリンクＬＫ２に対して相対的に移動させる関節機構ＪＥとも捉えられる。図１に示す例では、関節機構ＪＥｐ２が関節機構ＪＥｒ３を方向Ｄｅ２に沿って相対的に移動させる場合、リンクＬＫ２の開口Ｈｌｋ２の部分が、関節機構ＪＥｒ３の移動可能な移動領域ＡＲｍｖ２に該当する。

【0035】

関節機構ＪＥｒ４は、リンクＬＫ２と先端部ＴＰ１とを接続し、方向Ｄｅ２に垂直な軸Ａｘ４を回転軸として、先端部ＴＰ１をリンクＬＫ２に対して回転させる。図１の回転方向Ｄｒ４は、先端部ＴＰ１が軸Ａｘ４を回転軸として回転する場合の先端部ＴＰ１の回転方向を示す。なお、軸Ａｘ４は、「第４回転軸」の一例である。

【0036】

先端部ＴＰ１には、例えば、物品を把持するエンドエフェクタ２０が取り付けられる。例えば、先端部ＴＰ１の端面ＴＰ１ｓｆにエンドエフェクタ２０が取り付けられる。先端部ＴＰ１は、リンクＬＫ２に接続される第１部分ＴＰ１１と、第１部分ＴＰ１１に接続される第２部分ＴＰ１２と、関節機構ＪＥｒ５と、関節機構ＪＥｒ６とを含む。第１部分ＴＰ１１は、例えば、関節機構ＪＥｒ４を介してリンクＬＫ２に接続される。従って、第１部分ＴＰ１１は、軸Ａｘ４を回転軸としてリンクＬＫ２に対して回転する。

【0037】

関節機構ＪＥｒ５は、第１部分ＴＰ１１と第２部分ＴＰ１２とを接続し、軸Ａｘ４に垂直な軸Ａｘ５を回転軸として、第２部分ＴＰ１２を第１部分ＴＰ１１に対して回転させる。図１の回転方向Ｄｒ５は、第２部分ＴＰ１２が軸Ａｘ５を回転軸として回転する場合の第２部分ＴＰ１２の回転方向を示す。なお、軸Ａｘ５は、「第５回転軸」の一例である。

【0038】

関節機構ＪＥｒ６は、軸Ａｘ５に垂直な軸Ａｘ６を回転軸として、先端部ＴＰ１の少なくとも一部分を回転させる。図１に示す例では、関節機構ＪＥｒ６は、軸Ａｘ６を回転軸として、先端部ＴＰ１の端面ＴＰ１ｓｆを回転させる。すなわち、関節機構ＪＥｒ６は、軸Ａｘ６を回転軸として、先端部ＴＰ１のうち、エンドエフェクタ２０が取り付けられる部分（端面ＴＰ１ｓｆ）を回転させる。図１の回転方向Ｄｒ６は、端面ＴＰ１ｓｆが軸Ａｘ６を回転軸として回転する場合の端面ＴＰ１ｓｆの回転方向を示す。なお、軸Ａｘ６は、「第６回転軸」の一例である。

【0039】

図１に示す例では、関節機構ＪＥｒ６の表面が端面ＴＰ１ｓｆに該当する。なお、関節機構ＪＥｒ６が第２部分ＴＰ１２に含まれる構成等では、第２部分ＴＰ１２の端面が端面ＴＰ１ｓｆであってもよい。

【0040】

また、エンドエフェクタ２０により行われる作業は、物品の把持に限定されない。エンドエフェクタ２０としては、ロボット１０の作業目的に応じて適切な部品（例えば、ロボットハンド及びロボットフィンガー等）を適用することができる。すなわち、各種作業に適したエンドエフェクタ２０が先端部ＴＰ１に取り付けられる。

【0041】

また、図１に示すロボット１０の状態（姿勢）は、本実施形態におけるロボット１０の特徴を表す状態の１つである。例えば、図１に示す姿勢では、リンクＬＫ１は、関節機構ＪＥｒ２により、ボディ部ＢＤＰの底面ＢＤＰｂｔに対して水平な状態、すなわち、ロボット１０の接地面に対して水平な状態になるまで倒されている。また、関節機構ＪＥｒ３は、移動領域ＡＲｍｖ１において、移動領域ＡＲｍｖ１の両端部を除く中間領域ＡＲｍｄ１（図２参照）よりもリンクＬＫ１の端部ＬＫ１ｅｄ２に近い位置に位置している。なお、端部ＬＫ１ｅｄ２は、リンクＬＫ１の２つの端部ＬＫ１ｅｄ（ＬＫ１ｅｄ１及びＬＫ１ｅｄ２）のうち、ボディ部ＢＤＰから遠い端部ＬＫ１ｅｄである。また、関節機構ＪＥｒ３は、移動領域ＡＲｍｖ２において、移動領域ＡＲｍｖ２の両端部を除く中間領域ＡＲｍｄ２（図２参照）よりもリンクＬＫ２の端部ＬＫ２ｅｄ１に近い位置に位置している。なお、端部ＬＫ２ｅｄ１は、リンクＬＫ２の２つの端部ＬＫ１ｅｄ（ＬＫ２ｅｄ１及びＬＫ２ｅｄ２）のうち、先端部ＴＰ１から遠い端部ＬＫ２ｅｄである。

【0042】

本実施形態では、図１に示す姿勢から、関節機構ＪＥｒ３がリンクＬＫ２をリンクＬＫ１に対して回転（旋回）させることにより、先端部ＴＰ１を接地面に対して水平方向に回転させることができる。また、本実施形態では、図１に示す姿勢から、関節機構ＪＥｐ１が関節機構ＪＥｒ３を方向Ｄｅ１に沿って移動させることにより、先端部ＴＰ１を方向Ｄｅ１に沿って移動させることができる。また、本実施形態では、図１に示す姿勢から、関節機構ＪＥｐ２が関節機構ＪＥｒ３を方向Ｄｅ２に沿って移動させることにより、先端部ＴＰ１を方向Ｄｅ２に沿って移動させることができる。すなわち、本実施形態では、図１に示す姿勢から、先端部ＴＰ１を接地面に対して水平方向に移動させることができる。なお、先端部ＴＰ１を接地面に対して水平方向に移動させる動作の具体例については、後述する図３及び図４において説明される。

【0043】

ここで、本実施形態では、特定の方向とのなす角度が所定の角度より大きい軸を回転軸とした回転を、特定の方向とのなす角度が所定の角度以下の軸を回転軸とした回転と区別して、「旋回」と称する場合がある。所定の角度は、例えば、４５°であってもよい。なお、所定の角度は、４５°に限定されない。

【0044】

例えば、軸Ａｘ１及びＡｘ２の各々を回転軸とする回転では、ボディ部ＢＤＰの底面ＢＤＰｂｔに垂直な方向Ｄｖ１が特定の方向に該当する。この場合、軸Ａｘ１は、ボディ部ＢＤＰの底面ＢＤＰｂｔに垂直な方向Ｄｖ１とのなす角度が所定の角度以下の軸に該当し、軸Ａｘ２は、方向Ｄｖ１とのなす角度が所定の角度より大きい軸に該当する。従って、軸Ａｘ２を回転軸とするリンクＬＫ１の回転は、旋回に該当する。なお、本実施形態では、ボディ部ＢＤＰが底面ＢＤＰｂｔに垂直な方向Ｄｖ１に沿って延在しているため、ボディ部ＢＤＰが延在する方向Ｄｅｂを特定の方向としてもよい。

【0045】

また、軸Ａｘ３を回転軸とする回転では、リンクＬＫ１が延在する方向Ｄｅ１が特定の方向に該当し、軸Ａｘ４を回転軸とする回転では、リンクＬＫ２が延在する方向Ｄｅ２が特定の方向に該当する。この場合、軸Ａｘ３は、リンクＬＫ１が延在する方向Ｄｅ１とのなす角度が所定の角度より大きい軸に該当し、軸Ａｘ４は、リンクＬＫ２が延在する方向Ｄｅ２とのなす角度が所定の角度より大きい軸に該当する。従って、軸Ａｘ３を回転軸とするリンクＬＫ２の回転、及び、軸Ａｘ４を回転軸とする第１部分ＴＰ１１の回転は、旋回に該当する。

【0046】

また、軸Ａｘ５を回転軸とする回転では、方向Ｄｅ１１が特定の方向に該当し、軸Ａｘ６を回転軸とする回転では、方向Ｄｅ１２が特定の方向に該当する。方向Ｄｅ１１は、第１部分ＴＰ１１の端部のうち、関節機構ＪＥｒ５が接続される所定の端部の反対側の端部から所定の端部に向かう方向である。なお、方向Ｄｅ１１は、第１部分ＴＰ１１が延在する方向と捉えられてもよい。また、方向Ｄｅ１２は、第２部分ＴＰ１２の端部のうち、関節機構ＪＥｒ６が接続される所定の端部（端面ＴＰ１ｓｆを含む端部）の反対側の端部から所定の端部に向かう方向である。なお、方向Ｄｅ１２は、第２部分ＴＰ１２が延在する方向と捉えられてもよい。

【0047】

方向Ｄｅ１１が特定の方向である場合、軸Ａｘ５は、方向Ｄｅ１１とのなす角度が所定の角度以下の軸に該当する。また、方向Ｄｅ１２が特定の方向である場合、軸Ａｘ６は、方向Ｄｅ１２とのなす角度が所定の角度以下の軸に該当する。なお、本実施形態では、方向Ｄｅ１１が軸Ａｘ４に垂直な方向であり、方向Ｄｅ１２が軸Ａｘ５に垂直な方向である場合を想定する。この場合、方向Ｄｅ１１とのなす角度が所定の角度以下の軸Ａｘ５は、軸Ａｘ４とのなす角度が所定の角度より大きい軸に該当し、方向Ｄｅ１２とのなす角度が所定の角度以下の軸Ａｘ６は、軸Ａｘ５とのなす角度が所定の角度より大きい軸に該当する。

【0048】

このように、本実施形態では、ロボット１０の複数の部分（ボディ部ＢＤＰ、リンクＬＫ１、リンクＬＫ２及び先端部ＴＰ１等）の各々が軸Ａｘ１、Ａｘ２、Ａｘ３、Ａｘ４、Ａｘ５及びＡｘ６の各々を回転軸として回転可能である。これにより、本実施形態では、ロボット１０は、人と同様の動作を実行できる。

【0049】

例えば、関節機構ＪＥｒ２と関節機構ＪＥｒ３との間のリンクＬＫ１が上腕に相当し、関節機構ＪＥｒ３と関節機構ＪＥｒ４との間のリンクＬＫ２が前腕に相当する。そして、ロボット１０は、関節機構ＪＥｒ１により、人の腰のねじりを模した動作を行うことができ、関節機構ＪＥｒ２により、肩の旋回を模した動作を行うことができる。また、ロボット１０は、関節機構ＪＥｒ３により、肘の旋回を模した動作を行うことができ、関節機構ＪＥｒ４により、手首の旋回を模した動作を行うことができる。また、ロボット１０は、関節機構ＪＥｒ５により、手首のねじりを模した動作を行うことができ、関節機構ＪＥｒ６により、指先のねじりを模した動作を行うことができる。

【0050】

さらに、本実施形態では、リンクＬＫ１内に設けられた関節機構ＪＥｐ１により、リンクＬＫ１が延在する方向Ｄｅ１に沿って、リンクＬＫ２をリンクＬＫ１に対して相対的に移動させることができる。また、本実施形態では、リンクＬＫ２内に設けられた関節機構ＪＥｐ２により、リンクＬＫ２が延在する方向Ｄｅ２に沿って、リンクＬＫ２をリンクＬＫ１に対して相対的に移動させることができる。これにより、本実施形態では、先端部ＴＰ１（より詳細には、端面ＴＰ１ｓｆ）が到達可能な領域を広くすることができる。この結果、本実施形態では、ロボット１０に取り付けられるエンドエフェクタ２０が到達可能な領域を広くすることができる。

【0051】

また、本実施形態では、関節機構ＪＥｐ１及びＪＥｐ２により、ロボット１０の先端部ＴＰ１をボディ部ＢＤＰの周辺に容易に移動させることができる。例えば、ロボットコントローラ３０は、軸Ａｘ３がリンクＬＫ１の端部ＬＫ１ｅｄ２よりも端部ＬＫ１ｅｄ１の近くに位置し、かつ、リンクＬＫ２の端部ＬＫ２ｅｄ１よりも端部ＬＫ２ｅｄ２の近くに位置するように、関節機構ＪＥｐ１及びＪＥｐ２を制御する。この場合、リンクＬＫ１の実質的なリンク長（アーム長）である端部ＬＫ１ｅｄ１から軸Ａｘ３の長さは、リンクＬＫ１の長さの半分以下になる。また、リンクＬＫ２の実質的なリンク長（アーム長）である軸Ａｘ３から端部ＬＫ２ｅｄ２の長さは、リンクＬＫ２の長さの半分以下になる。従って、リンクＬＫ１とリンクＬＫ２とが干渉する領域は非常に少なく、先端部ＴＰ１を、ボディ部ＢＤＰの周辺に容易に移動させることができ、ロボット１０のボディ部ＢＤＰの周辺の作業を容易に行うことが可能となる。

【0052】

また、関節機構ＪＥｒ２及びＪＥｒ３を駆動することにより、ボディ部ＢＤＰの周辺における先端部ＴＰ１の制御を行う場合、制御精度は、リンクＬＫ１及びリンクＬＫ２の実質的なリンク長に左右される。リンクＬＫ１及びリンクＬＫ２の実質的なリンク長が短ければ短いほど高精度な制御が可能である。本実施形態では、リンクＬＫ１及びリンクＬＫ２の実質的なリンク長を短くすることにより、基部の周辺であっても多関節ロボットの作業可能領域を狭めることなく、高精度にロボットの先端部を制御することができる。

【0053】

なお、ロボットシステム１の構成は、図１に示す例に限定されない。例えば、ロボットコントローラ３０は、ロボット１０に内蔵されてもよい。また、図１では、ロボット１０が床等の所定の場所に固定される場合を想定したが、ロボット１０は、所定の場所に固定されずに、ロボット１０自体が移動可能であってもよい。また、ボディ部ＢＤＰの土台部ＢＤＰｂａは、床等の所定の場所に関節機構ＪＥｒ１を介して固定されてもよい。この場合、ボディ部ＢＤＰは、関節機構ＪＥｒ１を含まずに定義されてもよい。土台部ＢＤＰｂａが所定の場所に関節機構ＪＥｒ１を介して固定される構成では、関節機構ＪＥｒ１は、軸Ａｘ１を回転軸として、土台部ＢＤＰｂａを回転させてもよい。また、土台部ＢＤＰｂａが所定の場所に関節機構ＪＥｒ１を介して固定される構成では、土台部ＢＤＰｂａが関節機構ＪＥｒ２と接続されてもよい。また、方向Ｄｅ１からの平面視において、軸Ａｘ３に沿う方向Ｄａｘ３と軸Ａｘ２に沿う方向Ｄａｘ２とが交差する角度は、９０度に限定されない。例えば、方向Ｄｅ１からの平面視において、軸Ａｘ３に沿う方向Ｄａｘ３と軸Ａｘ２に沿う方向Ｄａｘ２とは、所定の角度以上の第１角度で交差してもよい。

【0054】

次に、図２を参照しながら、関節機構ＪＥｐ１及びＪＥｐ２の一例について説明する。

【0055】

図２は、関節機構ＪＥの一例を説明するための説明図である。図２では、関節機構ＪＥｐ１及びＪＥｐ２と関節機構ＪＥｒ３とを中心に説明する。本実施形態では、関節機構ＪＥｒ３を駆動するモータＭＯｒ３が関節機構ＪＥｒ３と一体的に移動する場合を想定する。例えば、モータＭＯｒ３は、関節機構ＪＥｒ３に固定されてもよい。モータＭＯｒ３は、「第１モータ」の一例である。先ず、関節機構ＪＥｐ１について説明する。

【0056】

関節機構ＪＥｐ１、及び、関節機構ＪＥｐ１を駆動するモータＭＯｐ１は、リンクＬＫ１の内部に配置される。例えば、モータＭＯｐ１は、リンクＬＫ１の２つの端部ＬＫ１ｅｄ（ＬＫ１ｅｄ１及びＬＫ１ｅｄ２）のうち、ボディ部ＢＤＰに近い端部ＬＫ１ｅｄ１において、リンクＬＫ１の内部に取り付けられている。モータＭＯｐ１は、「第２モータ」の一例である。

【0057】

関節機構ＪＥｐ１は、例えば、方向Ｄｅ１に沿って延在するねじ部ＪＥｐ１１と、ナットＪＥｐ１２と、接続部ＪＥｐ１３と、レールＪＥｐ１４とを含む。ねじ部ＪＥｐ１１は、「第１ねじ部」の一例であり、ナットＪＥｐ１２は、「第１移動部」の一例である。

【0058】

ねじ部ＪＥｐ１１の一端は、モータＭＯｐ１に取り付けられる。例えば、ねじ部ＪＥｐ１１は、ねじ部ＪＥｐ１１の中心軸（方向Ｄｅ１に沿う中心軸）がモータＭＯｐ１の回転軸と一致するようにモータＭＯｐ１に取り付けられ、ナットＪＥｐ１２に挿通される。そして、ねじ部ＪＥｐ１１は、モータＭＯｐ１の回転に伴い、方向Ｄｅ１に沿う中心軸を回転軸として回転する。

【0059】

接続部ＪＥｐ１３は、例えば、方向Ｄｅ１に沿って移動可能にレールＪＥｐ１４に接続されるスライダー部ＪＥｐ１３ａと、ナットＪＥｐ１２及びモータＭＯｒ３を支持する支持部ＪＥｐ１３ｂとを含む。例えば、ナットＪＥｐ１２は、ねじ部ＪＥｐ１１と一緒に回転しないように、支持部ＪＥｐ１３ｂに固定されている。また、モータＭＯｒ３は、モータＭＯｒ３自体が回転しないように、支持部ＪＥｐ１３ｂに固定されている。

【0060】

なお、スライダー部ＪＥｐ１３ａと支持部ＪＥｐ１３ｂとは、厳密に区別されなくてもよい。例えば、スライダー部ＪＥｐ１３ａにモータＭＯｒ３が固定されてもよい。また、ナットＪＥｐ１２は、支持部ＪＥｐ１３ｂを介さずにモータＭＯｒ３に固定されてもよい。すなわち、ナットＪＥｐ１２は、関節機構ＪＥｒ３に対するナットＪＥｐ１２の相対的な位置が変化しないように、接続部ＪＥｐ１３等に接続されていればよい。このように、ナットＪＥｐ１２は、接続部ＪＥｐ１３等を介して関節機構ＪＥｒ３に接続される。

【0061】

レールＪＥｐ１４は、方向Ｄｅ１に沿って延在し、互いに平行に配置された２つの棒状部材ＪＥｐ１４ａ及びＪＥｐ１４ｂを含む。棒状部材ＪＥｐ１４ａ及びＪＥｐ１４ｂとスライダー部ＪＥｐ１３ａとの各々の形状は、棒状部材ＪＥｐ１４ａ及びＪＥｐ１４ｂがスライダー部ＪＥｐ１３ａを支持できれば、特に限定されない。レールＪＥｐ１４は、例えば、軸Ａｘ３に沿う方向Ｄａｘ３において、開口Ｈｌｋ１とねじ部ＪＥｐ１１との間に配置され、リンクＬＫ１の内部に取り付けられている。なお、レールＪＥｐ１４は、関節機構ＪＥｒ３の一部が開口Ｈｌｋ１から出ている状態で、関節機構ＪＥｒ３が方向Ｄｅ１に沿って移動可能であれば、軸Ａｘ３に沿う方向Ｄａｘ３において、開口Ｈｌｋ１とねじ部ＪＥｐ１１との間に配置されなくてもよい。

【0062】

ナットＪＥｐ１２は、ねじ部ＪＥｐ１１と一緒に回転しないように接続部ＪＥｐ１３に固定されているため、ねじ部ＪＥｐ１１の回転に伴い、方向Ｄｅ１に沿って、ねじ部ＪＥｐ１１に対して相対的に移動する。ナットＪＥｐ１２は、上述したように、関節機構ＪＥｒ３に対する相対的な位置が変化しないように、接続部ＪＥｐ１３等に固定されている。すなわち、関節機構ＪＥｒ３は、ナットＪＥｐ１２と一緒に、方向Ｄｅ１に沿って移動する。例えば、関節機構ＪＥｒ３は、ナットＪＥｐ１２の移動に伴い、リンクＬＫ１に対して相対的に移動する。このように、関節機構ＪＥｐ１は、関節機構ＪＥｒ３を移動可能に支持する。関節機構ＪＥｒ３の移動領域ＡＲｍｖ１（移動範囲）は、リンクＬＫ１の端部ＬＫ１ｅｄ２よりも端部ＬＫ１ｅｄ１に近い領域から、端部ＬＫ１ｅｄ１よりも端部ＬＫ１ｅｄ２に近い領域まで移動可能であることが好ましい。これにより、リンクＬＫ１の実質的な長さ（制御上の長さ）を、リンクＬＫ１の半分以下の長さから半分以上の長さとすることが可能となる。リンクＬＫ１の実質的な長さは、例えば、端部ＬＫ１ｅｄ１（例えば、リンクＬＫ１と軸Ａｘ２との交点）から関節機構ＪＥｒ３（より正確には、軸Ａｘ３）までの方向Ｄｅ１に沿う長さである。

【0063】

ここで、ナットＪＥｐ１２の移動方向、すなわち、関節機構ＪＥｒ３の移動方向は、モータＭＯｐ１の回転方向を切り替えることにより、方向Ｄｅ１と方向Ｄｅ１の反対方向との間で切り替わる。例えば、モータＭＯｐ１の回転が第１の回転方向の回転である場合、ナットＪＥｐ１２は、方向Ｄｅ１に移動し、モータＭＯｐ１の回転が第１の回転方向の回転に対して逆回転となる第２の回転方向の回転である場合、ナットＪＥｐ１２は、方向Ｄｅ１の反対方向に移動する。次に、関節機構ＪＥｐ２について説明する。

【0064】

関節機構ＪＥｐ２、及び、関節機構ＪＥｐ２を駆動するモータＭＯｐ２は、リンクＬＫ２の内部に配置される。例えば、モータＭＯｐ２は、リンクＬＫ２の２つの端部ＬＫ２ｅｄ（ＬＫ２ｅｄ１及びＬＫ２ｅｄ２）のうち、先端部ＴＰ１から遠い端部ＬＫ２ｅｄ１において、リンクＬＫ２の内部に取り付けられている。モータＭＯｐ２は、「第３モータ」の一例である。なお、端部ＬＫ２ｅｄ２は、リンクＬＫ２の２つの端部ＬＫ２ｅｄのうち、先端部ＴＰ１に近い端部ＬＫ２ｅｄである。

【0065】

関節機構ＪＥｐ２は、例えば、方向Ｄｅ２に沿って延在するねじ部ＪＥｐ２１と、ナットＪＥｐ２２と、接続部ＪＥｐ２３と、レールＪＥｐ２４とを含む。ねじ部ＪＥｐ２１は、「第２ねじ部」の一例であり、ナットＪＥｐ２２は、「第２移動部」の一例である。

【0066】

ねじ部ＪＥｐ２１の一端は、モータＭＯｐ２に取り付けられる。例えば、ねじ部ＪＥｐ２１は、ねじ部ＪＥｐ２１の中心軸（方向Ｄｅ２に沿う中心軸）がモータＭＯｐ２の回転軸と一致するようにモータＭＯｐ２に取り付けられ、ナットＪＥｐ２２に挿通される。そして、ねじ部ＪＥｐ２１は、モータＭＯｐ２の回転に伴い、方向Ｄｅ２に沿う中心軸を回転軸として回転する。

【0067】

接続部ＪＥｐ２３は、例えば、レールＪＥｐ２４に対して方向Ｄｅ２に沿って相対的に移動可能に接続されるスライダー部ＪＥｐ２３ａと、ナットＪＥｐ２２及び関節機構ＪＥｒ３を支持する支持部ＪＥｐ２３ｂとを含む。例えば、ナットＪＥｐ２２は、ねじ部ＪＥｐ２１と一緒に回転しないように、支持部ＪＥｐ２３ｂに固定されている。また、支持部ＪＥｐ２３ｂは、モータＭＯｒ３の回転に伴い、軸Ａｘ３を回転軸として回転するように、関節機構ＪＥｒ３に接続されている。すなわち、関節機構ＪＥｒ３は、モータＭＯｒ３の回転に伴い、軸Ａｘ３を回転軸として支持部ＪＥｐ２３ｂを回転させる。

【0068】

なお、スライダー部ＪＥｐ２３ａと支持部ＪＥｐ２３ｂとは、厳密に区別されなくてもよい。例えば、スライダー部ＪＥｐ２３ａに関節機構ＪＥｒ３が接続されてもよい。また、ナットＪＥｐ２２は、スライダー部ＪＥｐ２３ａに固定されてもよい。すなわち、ナットＪＥｐ２２は、関節機構ＪＥｒ３に対する相対的な位置が変化しないように、接続部ＪＥｐ２３等に接続されていればよい。このように、ナットＪＥｐ２２は、接続部ＪＥｐ２３等を介して関節機構ＪＥｒ３に接続される。

【0069】

レールＪＥｐ２４は、方向Ｄｅ２に沿って延在し、互いに平行に配置された２つの棒状部材ＪＥｐ２４ａ及びＪＥｐ２４ｂを含む。棒状部材ＪＥｐ２４ａ及びＪＥｐ２４ｂとスライダー部ＪＥｐ２３ａとの各々の形状は、棒状部材ＪＥｐ２４ａ及びＪＥｐ２４ｂがスライダー部ＪＥｐ２３ａを支持できれば、特に限定されない。レールＪＥｐ２４は、例えば、軸Ａｘ３に沿う方向Ｄａｘ３において、開口Ｈｌｋ２とねじ部ＪＥｐ２１との間に配置され、リンクＬＫ２の内部に取り付けられている。なお、レールＪＥｐ２４は、関節機構ＪＥｒ３の一部が開口Ｈｌｋ２から出ている状態で、関節機構ＪＥｒ３が方向Ｄｅ２に沿って移動可能であれば、軸Ａｘ３に沿う方向Ｄａｘ３において、開口Ｈｌｋ２とねじ部ＪＥｐ２１との間に配置されなくてもよい。

【0070】

ナットＪＥｐ２２は、ねじ部ＪＥｐ２１と一緒に回転しないように接続部ＪＥｐ２３に固定されているため、ねじ部ＪＥｐ２１の回転に伴い、方向Ｄｅ２に沿って、ねじ部ＪＥｐ２１に対して相対的に移動する。ナットＪＥｐ２２は、上述したように、関節機構ＪＥｒ３に対する相対的な位置が変化しないように、接続部ＪＥｐ２３等に固定されている。また、関節機構ＪＥｒ３は、ねじ部ＪＥｐ１１が回転していない場合、すなわち、モータＭＯｐ１が回転していない場合、関節機構ＪＥｐ１により、リンクＬＫ１に対する関節機構ＪＥｒ３の相対的な位置が変化しないように支持される。このため、リンクＬＫ２は、ナットＪＥｐ２２がねじ部ＪＥｐ２１に対して相対的に移動することにより、方向Ｄｅ２に沿って、関節機構ＪＥｒ３に対して相対的に移動する。このように、関節機構ＪＥｐ２は、リンクＬＫ２を移動可能に支持する。関節機構ＪＥｒ３の移動領域ＡＲｍｖ２（移動範囲）は、リンクＬＫ２の端部ＬＫ２ｅｄ２よりも端部ＬＫ２ｅｄ１に近い領域から、端部ＬＫ２ｅｄ１よりも端部ＬＫ２ｅｄ２に近い領域まで移動可能であることが好ましい。これにより、リンクＬＫ２の実質的な長さ（制御上の長さ）を、リンクＬＫ２の半分以下の長さから半分以上の長さとすることが可能となる。リンクＬＫ２の実質的な長さは、例えば、関節機構ＪＥｒ３（より正確には、軸Ａｘ３）から端部ＬＫ２ｅｄ２（例えば、リンクＬＫ２と軸Ａｘ４との交点）までの方向Ｄｅ２に沿う長さである。

【0071】

なお、関節機構ＪＥｒ３は、ねじ部ＪＥｐ２１が回転していない場合、すなわち、モータＭＯｐ２が回転していない場合、関節機構ＪＥｐ２により、リンクＬＫ２に対する相対的な位置が変化しないように支持される。関節機構ＪＥｒ３は、リンクＬＫ１との相対的な位置にかかわらず、リンクＬＫ１に対してリンクＬＫ２を旋回可能である。また、関節機構ＪＥｒ３は、リンクＬＫ２との相対的な位置にかかわらず、リンクＬＫ１に対してリンクＬＫ２を旋回可能である。

【0072】

ここで、ねじ部ＪＥｐ２１に対するナットＪＥｐ２２の移動方向、すなわち、リンクＬＫ２の移動方向は、モータＭＯｐ２の回転方向を切り替えることにより、方向Ｄｅ２と方向Ｄｅ２の反対方向との間で切り替わる。例えば、モータＭＯｐ２の回転が第１の回転方向の回転である場合、リンクＬＫ２は、方向Ｄｅ２の反対方向に移動し、モータＭＯｐ２の回転が第１の回転方向の回転に対して逆回転となる第２の回転方向の回転である場合、リンクＬＫ２は、方向Ｄｅ２に移動する。

【0073】

なお、関節機構ＪＥｐの構成は、図２に示す例に限定されない。例えば、関節機構ＪＥｐ１の要素として、ねじ部ＪＥｐ１１とナットＪＥｐ１２との間に複数のボールが存在するボールねじが採用されてもよい。同様に、関節機構ＪＥｐ２の要素として、ねじ部ＪＥｐ２１とナットＪＥｐ２２との間に複数のボールが存在するボールねじが採用されてもよい。

【0074】

また、例えば、モータＭＯｒ３の一部がリンクＬＫ１の内部に位置し、モータＭＯｒ３の他の部分が開口Ｈｌｋ１からリンクＬＫ１の外部に位置し、関節機構ＪＥｒ３の全体がリンクＬＫ２の内部に位置してもよい。また、例えば、関節機構ＪＥｒ３は、モータＭＯｒ３を収納する収納部を有してもよい。すなわち、モータＭＯｒ３は、関節機構ＪＥｒ３内に設けられてもよい。あるいは、モータＭＯｒ３は、関節機構ＪＥｒ３の一要素として捉えられてもよい。同様に、モータＭＯｐ１は、関節機構ＪＥｐ１の一要素として捉えられてもよいし、モータＭＯｐ２は、関節機構ＪＥｐ２の一要素として捉えられてもよい。

【0075】

次に、関節機構ＪＥｒ１、ＪＥｒ２、ＪＥｒ４、ＪＥｒ５及びＪＥｒ６について、簡単に説明する。

【0076】

関節機構ＪＥｒ１は、例えば、回転部ＪＥｒ１１と、回転部ＪＥｒ１１を収納する筐体ＪＥｒ１２とを有する。回転部ＪＥｒ１１は、関節機構ＪＥｒ１を駆動するモータＭＯｒ１の回転に伴い、軸Ａｘ１を回転軸として回転する。例えば、回転部ＪＥｒ１１は、軸Ａｘ１を回転軸として土台部ＢＤＰｂａに対して回転可能に、モータＭＯｒ１に取り付けられている。また、筐体ＪＥｒ１２は、回転部ＪＥｒ１１と一緒に、軸Ａｘ１を回転軸として土台部ＢＤＰｂａに対して回転する。例えば、筐体ＪＥｒ１２は、軸Ａｘ１を回転軸として土台部ＢＤＰｂａに対して回転可能に、土台部ＢＤＰｂａに接続される。さらに、筐体ＪＥｒ１２は、関節機構ＪＥｒ２に接続される。これにより、関節機構ＪＥｒ２は、回転部ＪＥｒ１１の回転に伴い、軸Ａｘ１を回転軸として土台部ＢＤＰｂａに対して回転する。モータＭＯｒ１は、「第４モータ」の一例である。

【0077】

なお、モータＭＯｒ１は、関節機構ＪＥｒ１の一要素として捉えられてもよい。また、筐体ＪＥｒ１２が土台部ＢＤＰｂａに固定され、関節機構ＪＥｒ２が、軸Ａｘ１を回転軸として筐体ＪＥｒ１２に対して回転可能に、回転部ＪＥｒ１１に取り付けられてもよい。この場合、筐体ＪＥｒ１２は、土台部ＢＤＰｂａの一要素として捉えられてもよい。

【0078】

関節機構ＪＥｒ２は、例えば、回転部ＪＥｒ２１と、関節機構ＪＥｒ２を駆動するモータＭＯｒ２を収納する筐体ＪＥｒ２２とを有する。回転部ＪＥｒ２１は、モータＭＯｒ２の回転に伴い、軸Ａｘ２を回転軸として回転する。例えば、回転部ＪＥｒ２１は、軸Ａｘ２を回転軸として筐体ＪＥｒ２２に対して回転可能に、モータＭＯｒ２に取り付けられている。さらに、回転部ＪＥｒ２１は、リンクＬＫ１に接続される。また、リンクＬＫ１は、筐体ＪＥｒ２２に対して回転可能に筐体ＪＥｒ２２に接続される。これにより、リンクＬＫ１は、回転部ＪＥｒ２１の回転に伴い、軸Ａｘ２を回転軸として筐体ＪＥｒ２２に対して回転する。また、筐体ＪＥｒ２２の内部には、モータＭＯｒ２が取り付けられている。モータＭＯｒ２は、「第５モータ」の一例である。

【0079】

なお、モータＭＯｒ２は、関節機構ＪＥｒ２の一要素として捉えられてもよい。また、図２に示す例では、回転部ＪＥｒ２１はリンクＬＫ１の外部に位置しているが、回転部ＪＥｒ２１の一部がリンクＬＫ１の内部に位置し、回転部ＪＥｒ２１の他の部分が筐体ＪＥｒ２２の内部に位置してもよい。あるいは、回転部ＪＥｒ２１の全体がリンクＬＫ１の内部又は筐体ＪＥｒ２２の内部に位置してもよい。

【0080】

関節機構ＪＥｒ４は、例えば、回転部ＪＥｒ４１と、回転部ＪＥｒ４１を収納する筐体ＪＥｒ４２とを有する。回転部ＪＥｒ４１は、関節機構ＪＥｒ４を駆動するモータＭＯｒ４の回転に伴い、軸Ａｘ４を回転軸として回転する。例えば、回転部ＪＥｒ４１は、軸Ａｘ４を回転軸としてリンクＬＫ２に対して回転可能に、モータＭＯｒ４に取り付けられている。なお、モータＭＯｒ４は、リンクＬＫ２の内部に取り付けられている。

【0081】

また、筐体ＪＥｒ４２は、回転部ＪＥｒ４１と一緒に、軸Ａｘ４を回転軸としてリンクＬＫ２に対して回転する。例えば、筐体ＪＥｒ４２は、軸Ａｘ４を回転軸としてリンクＬＫ２に対して回転可能に、リンクＬＫ２に接続される。さらに、筐体ＪＥｒ４２は、第１部分ＴＰ１１に接続される。これにより、第１部分ＴＰ１１は、回転部ＪＥｒ４１の回転に伴い、筐体ＪＥｒ４２と一緒に、軸Ａｘ４を回転軸として回転する。

【0082】

なお、モータＭＯｒ４は、関節機構ＪＥｒ４の一要素として捉えられてもよい。また、図２に示す例では、回転部ＪＥｒ４１の全体が筐体ＪＥｒ４２の内部に位置しているが、回転部ＪＥｒ４１の全体がリンクＬＫ２の内部に位置してもよい。あるいは、回転部ＪＥｒ４１の一部が筐体ＪＥｒ４２の内部に位置し、回転部ＪＥｒ４１の他の部分がリンクＬＫ２の内部に位置してもよい。

【0083】

関節機構ＪＥｒ５は、例えば、回転部ＪＥｒ５１と、回転部ＪＥｒ５１の一部を収納する筐体ＪＥｒ５２とを有する。回転部ＪＥｒ５１は、関節機構ＪＥｒ５を駆動するモータＭＯｒ５の回転に伴い、軸Ａｘ５を回転軸として回転する。例えば、回転部ＪＥｒ５１は、軸Ａｘ５を回転軸として第１部分ＴＰ１１に対して回転可能に、モータＭＯｒ５に取り付けられている。なお、モータＭＯｒ５は、関節機構ＪＥｒ４の筐体ＪＥｒ４２の内部に取り付けられている。

【0084】

また、筐体ＪＥｒ５２は、回転部ＪＥｒ５１と一緒に、軸Ａｘ５を回転軸として第１部分ＴＰ１１に対して回転する。例えば、筐体ＪＥｒ５２は、軸Ａｘ５を回転軸として第１部分ＴＰ１１に対して回転可能に、第１部分ＴＰ１１に接続される。さらに、筐体ＪＥｒ５２は、第２部分ＴＰ１２に接続される。これにより、第２部分ＴＰ１２は、回転部ＪＥｒ５１の回転に伴い、筐体ＪＥｒ５２と一緒に、軸Ａｘ５を回転軸として回転する。

【0085】

なお、モータＭＯｒ５は、関節機構ＪＥｒ５の一要素として捉えられてもよい。また、図２に示す例では、回転部ＪＥｒ５１の一部が筐体ＪＥｒ５２の内部に位置し、回転部ＪＥｒ５１の他の部分が第１部分ＴＰ１１の内部に位置しているが、回転部ＪＥｒ５１の全体が筐体ＪＥｒ５２の内部又は第１部分ＴＰ１１の内部に位置してもよい。

【0086】

関節機構ＪＥｒ６は、例えば、回転部ＪＥｒ６１と、回転部ＪＥｒ６１の一部を収納する筐体ＪＥｒ６２とを有する。回転部ＪＥｒ６１は、関節機構ＪＥｒ６を駆動するモータＭＯｒ６の回転に伴い、軸Ａｘ６を回転軸として回転する。例えば、回転部ＪＥｒ６１は、軸Ａｘ６を回転軸として第２部分ＴＰ１２に対して回転可能に、モータＭＯｒ６に取り付けられている。また、筐体ＪＥｒ６２は、回転部ＪＥｒ６１と一緒に、軸Ａｘ６を回転軸として第２部分ＴＰ１２に対して回転する。例えば、筐体ＪＥｒ６２は、軸Ａｘ６を回転軸として第２部分ＴＰ１２に対して回転可能に、第２部分ＴＰ１２に接続される。また、筐体ＪＥｒ６２は、端面ＴＰ１ｓｆを含む。例えば、端面ＴＰ１ｓｆは、回転部ＪＥｒ６１の回転に伴い、軸Ａｘ６を回転軸として第２部分ＴＰ１２に対して回転する。

【0087】

なお、モータＭＯｒ６は、関節機構ＪＥｒ６の一要素として捉えられてもよい。また、筐体ＪＥｒ６２が第２部分ＴＰ１２に固定され、エンドエフェクタ２０が、筐体ＪＥｒ６２に対して回転可能に、回転部ＪＥｒ６１の表面に取り付けられてもよい。この場合、回転部ＪＥｒ６１の表面が端面ＴＰ１ｓｆに該当する。また、筐体ＪＥｒ６２が第２部分ＴＰ１２に固定される場合、筐体ＪＥｒ６２は、第２部分ＴＰ１２の一要素として捉えられてもよい。

【0088】

また、複数の関節機構ＪＥｒは、図２に示す例に限定されない。例えば、複数の関節機構ＪＥｒの各々は、既知の多関節ロボットの各関節に対応する機構と同様の構成であってもよい。

【0089】

また、図２では、関節機構ＪＥｒ３が、移動領域ＡＲｍｖ１の両端部を除く中間領域ＡＲｍｄ１に位置し、かつ、移動領域ＡＲｍｖ２の両端部を除く中間領域ＡＲｍｄ２に位置する例が示されているが、関節機構ＪＥｒ３の位置は、特に限定されない。例えば、図２に示す姿勢において、関節機構ＪＥｒ３の位置は、リンクＬＫ１の端部ＬＫ１ｅｄ２よりも端部ＬＫ１ｅｄ１に近く、かつ、リンクＬＫ２の端部ＬＫ１ｅｄ２よりも端部ＬＫ１ｅｄ１に近い位置でもよい。あるいは、図２に示す姿勢において、関節機構ＪＥｒ３の位置は、リンクＬＫ１の端部ＬＫ１ｅｄ１よりも端部ＬＫ１ｅｄ２に近く、かつ、リンクＬＫ２の端部ＬＫ１ｅｄ１よりも端部ＬＫ１ｅｄ２に近い位置でもよい。

【0090】

次に、図３及び図４を参照しながら、先端部ＴＰ１を接地面に対して水平方向に移動させる動作の一例について説明する。

【0091】

図３は、ロボット１０の先端部ＴＰ１を接地面に対して水平方向に移動させる動作の一例を説明するための説明図である。図４は、図３に示したロボット１０の動作の続きの動作を説明するための説明図である。

【0092】

なお、以下では、説明の便宜上、互いに直交するＸ軸、Ｙ軸及びＺ軸を有する３軸の直交座標系を導入する。また、以下では、Ｘ軸の矢印の指す方向は＋Ｘ方向と称され、＋Ｘ方向の反対方向は－Ｘ方向と称される。Ｙ軸の矢印の指す方向は＋Ｙ方向と称され、＋Ｙ方向の反対方向は－Ｙ方向と称される。Ｚ軸の矢印の指す方向は＋Ｚ方向と称され、＋Ｚ方向の反対方向は－Ｚ方向と称される。また、以下では、＋Ｙ方向及び－Ｙ方向を特に区別することなく、Ｙ方向と称し、＋Ｘ方向及び－Ｘ方向を、特に区別することなく、Ｘ方向と称する場合がある。＋Ｚ方向及び－Ｚ方向を、特に区別することなく、Ｚ方向と称する場合がある。

【0093】

本実施形態では、ＸＹ平面が、ボディ部ＢＤＰの底面ＢＤＰｂｔに対して平行、すなわち、ロボット１０の接地面に対して平行である場合を想定する。また、図３及び図４に示す例では、方向Ｄｅ１は、Ｙ方向に平行であり、方向Ｄａｘ２は、Ｘ方向に平行であり、方向Ｄａｘ３は、Ｚ方向に平行である。

【0094】

図の上面図は、＋Ｚ方向から見たロボット１０の状態を模式的に示し、図のＸＺ側面図は、－Ｙ方向から見たロボット１０の状態を模式的に示し、図のＹＺ側面図は、－Ｘ方向から見たロボット１０の状態を模式的に示している。

【0095】

図３（ａ）に示す第１姿勢では、リンクＬＫ１は、関節機構ＪＥｒ２により、ボディ部ＢＤＰの底面ＢＤＰｂｔに対して水平な状態、すなわち、ロボット１０の接地面に対して水平な状態になるまで倒されている。また、リンクＬＫ２は、＋Ｚ方向からの平面視において、関節機構ＪＥｒ３により、リンクＬＫ２の延在方向（方向Ｄｅ２）がリンクＬＫ１の延在方向（方向Ｄｅ１）に垂直となる状態に、維持されている。また、関節機構ＪＥｒ３は、リンクＬＫ１の端部ＬＫ１ｅｄ２よりも端部ＬＫ１ｅｄ１に近い位置に位置し、かつ、リンクＬＫ２の端部ＬＫ２ｅｄ１及びＬＫ２ｅｄ２間の中間付近（例えば、図２に示した中間領域ＡＲｍｄ２）に位置している。

【0096】

そして、図３（ｂ）に示すように、例えば、ロボットコントローラ３０は、関節機構ＪＥｐ２を制御することにより、リンクＬＫ２を関節機構ＪＥｒ３に対して－Ｘ方向に移動させる。すなわち、ロボットコントローラ３０は、関節機構ＪＥｐ２を制御することにより、先端部ＴＰ１の端面ＴＰ１ｓｆを接地面に対して水平方向に維持した状態で、先端部ＴＰ１を－Ｘ方向に移動させる。これにより、ロボット１０の姿勢は、図３（ａ）に示す第１姿勢から図３（ｂ）に示す第２姿勢に変化する。

【0097】

次に、図４（ｃ）に示すように、例えば、ロボットコントローラ３０は、関節機構ＪＥｐ１を制御することにより、関節機構ＪＥｒ３をリンクＬＫ１の延在方向（方向Ｄｅ１）に沿って－Ｙ方向に移動させる。すなわち、ロボットコントローラ３０は、関節機構ＪＥｐ１を制御することにより、先端部ＴＰ１の端面ＴＰ１ｓｆを接地面に対して水平方向に維持した状態で、先端部ＴＰ１を－Ｙ方向に移動させる。これにより、ロボット１０の姿勢は、図３（ｂ）に示した第２姿勢から図４（ｃ）に示す第３姿勢に変化する。

【0098】

そして、図４（ｄ）に示すように、例えば、ロボットコントローラ３０は、関節機構ＪＥｐ２を制御することにより、リンクＬＫ２を関節機構ＪＥｒ３に対して＋Ｘ方向に移動させる。すなわち、ロボットコントローラ３０は、関節機構ＪＥｐ２を制御することにより、先端部ＴＰ１の端面ＴＰ１ｓｆを接地面に対して水平方向に維持した状態で、先端部ＴＰ１を＋Ｘ方向に移動させる。これにより、ロボット１０の姿勢は、図４（ｃ）に示す第３姿勢から図４（ｄ）に示す第４姿勢に変化する。

【0099】

このように、本実施形態では、ロボット１０の姿勢を、第１姿勢、第２姿勢、第３姿勢及び第４姿勢の順に変化させることにより、先端部ＴＰ１を、接地面に対して水平な面を有する長方形の３辺をたどるように、移動させることができる。

【0100】

ここで、例えば、従来の６軸多関節ロボットでは、先端部ＴＰ１を、接地面に対して水平な面を有する長方形の３辺をたどるように、移動させる場合、４つ又は５つの関節機構ＪＥｒを正確に制御する必要がある。従って、従来の６軸多関節ロボットでは、先端部ＴＰ１を長方形の各辺に沿って移動させる場合、駆動させる関節機構ＪＥｒが多くなるため、動作が複雑になる。このため、従来の６軸多関節ロボットでは、動作速度又は動作精度の低下等の問題が生じる。また、従来の６軸多関節ロボットでは、先端部ＴＰ１を長方形の各辺に沿って移動させるために駆動される複数の関節機構ＪＥｒの各々のトルクが制限される場合がある。この場合、先端部ＴＰ１を高速に移動させること、又は、可搬重量を大きくすることが困難になる。

【0101】

これに対し、本実施形態では、上述したように、複数の関節機構ＪＥのうち、直動関節に対応する関節機構ＪＥｐ１及びＪＥｐ２のみを駆動することにより、先端部ＴＰ１を長方形の各辺に沿って移動させることができる。これにより、本実施形態では、動作速度又は動作精度の低下を抑制することができる。すなわち、本実施形態では、ロボット１０の先端部ＴＰ１を長方形の各辺に沿って高精度及び高速に移動させることができる。例えば、本実施形態では、長方形の各辺に沿って溶接する作業、又は、長方形の各辺に沿って接着剤を塗布する作業等を、ロボット１０に高精度及び高速に実行させることができる。

【0102】

また、本実施形態では、回転関節に対応する関節機構ＪＥｒを駆動することなく、先端部ＴＰ１を所定の平面上で移動させることができるため、回転関節のトルクの制限等の影響を受けない。このため、本実施形態では、先端部ＴＰ１を所定の平面上で移動させる場合に、先端部ＴＰ１を高速に移動させること、及び、可搬重量を大きくすることができる。

【0103】

なお、本実施形態では、長方形の各辺に沿って先端部ＴＰ１が移動する動作に限らず、接地面に対して水平な面（ＸＹ平面）上を先端部ＴＰ１が移動する動作であれば、複数の関節機構ＪＥのうちの関節機構ＪＥｐ１及びＪＥｐ２のみの駆動により実現することができる。例えば、本実施形態では、ロボット１０の先端部ＴＰ１に筆記具を保持させることにより、ロボット１０に図形を描画させることも可能である。従来の６軸多関節ロボットでは、先端部ＴＰ１を接地面に対して水平な面上で移動させる場合においても、先端部ＴＰ１を長方形の各辺に沿って移動させる場合と同様の課題がある。本実施形態では、先端部ＴＰ１を接地面に対して水平な面上で移動させる場合においても、複数の関節機構ＪＥのうち、直動関節に対応する関節機構ＪＥｐ１及びＪＥｐ２のみを駆動することにより、先端部ＴＰ１を高精度及び高速に移動させることができる。また、本実施形態では、先端部ＴＰ１を接地面に対して水平な面上で移動させる場合においても、可搬重量を大きくすることができる。

【0104】

また、本実施形態では、例えば、リンクＬＫ２がリンクＬＫ１に対して回転（旋回）するように関節機構ＪＥｒ３を駆動することにより、先端部ＴＰ１を接地面に対して水平方向に回転させることができる。この場合においても、先端部ＴＰ１を高精度及び高速に移動させること、及び、可搬重量を大きくすることができる。

【0105】

また、本実施形態では、接地面に対して水平な面（ＸＹ平面）上を先端部ＴＰ１が移動する動作に限らず、複数の関節機構ＪＥのうちの関節機構ＪＥｐ１及びＪＥｐ２のみの駆動により実現される動作においても、上述した効果と同様の効果を得ることができる。例えば、本実施形態では、図５（ｂ）に示すように、先端部ＴＰ１が接地面に対して垂直な面（ＸＺ平面、ＹＺ平面）上を移動する動作を、複数の関節機構ＪＥのうちの関節機構ＪＥｐ１及びＪＥｐ２のみの駆動により実現することができる。あるいは、本実施形態では、図５（ｃ）に示すように、先端部ＴＰ１が接地面に対して傾斜している平面上を移動する動作を、複数の関節機構ＪＥのうちの関節機構ＪＥｐ１及びＪＥｐ２のみの駆動により実現することができる。

【0106】

図５は、複数の関節機構ＪＥのうち、直動関節に対応する２つの関節機構ＪＥｐ１及びＪＥｐ２のみを駆動することにより実現される動作の一例を説明するための説明図である。なお、図５では、－Ｘ方向から見たロボット１０の状態（姿勢）が模式的に示されている。

【0107】

図５（ａ）は、接地面に対して水平な面ＳＦ１（ＸＹ平面）上を先端部ＴＰ１が移動する場合のロボット１０の状態（姿勢）を模式的に示している。なお、図５（ａ）に示すロボット１０の姿勢は、エンドエフェクタ２０として筆記具がロボット１０の先端部ＴＰ１に取り付けられていることを除いて、図３（ａ）に示した第１姿勢と同様である。例えば、本実施形態では、ロボット１０の姿勢を図５（ａ）に示す姿勢にすることにより、接地面に対して水平な面ＳＦ１（例えば、床面）に図形等を描画する作業をロボット１０に容易に実行させることができる。

【0108】

図５（ｂ）は、接地面に対して垂直な面ＳＦ２（ＸＺ平面）上を先端部ＴＰ１が移動する場合のロボット１０の状態（姿勢）を模式的に示している。ロボット１０の姿勢は、例えば、図５（ａ）に示した姿勢から、リンクＬＫ１が接地面に対して垂直になるように、関節機構ＪＥｒ２を駆動することにより、図５（ｂ）に示す姿勢に遷移する。例えば、本実施形態では、ロボット１０の姿勢を図５（ｂ）に示す姿勢にすることにより、接地面に対して垂直な面ＳＦ２（例えば、壁面）に図形等を描画する作業をロボット１０に容易に実行させることができる。

【0109】

図５（ｃ）は、接地面に対して傾斜している平面ＳＦ３上を先端部ＴＰ１が移動する場合のロボット１０の状態（姿勢）を模式的に示している。平面ＳＦ３は、例えば、図５（ａ）に示した面ＳＦ１及び図５（ｂ）に示した面ＳＦ２に対して傾斜している。ロボット１０の姿勢は、例えば、図５（ａ）に示した姿勢から、リンクＬＫ１の延在方向（方向Ｄｅ１）が平面ＳＦ３と平行になるように、関節機構ＪＥｒ２を駆動することにより、図５（ｃ）に示す姿勢に遷移する。例えば、本実施形態では、ロボット１０の姿勢を図５（ｃ）に示す姿勢にすることにより、接地面に対して傾斜している平面ＳＦ３に図形等を描画する作業をロボット１０に容易に実行させることができる。

【0110】

接地面に対して水平な面ＳＦ１、接地面に対して垂直な面ＳＦ２、及び、接地面に対して傾斜している平面ＳＦ３は、「所定の平面」の一例である。また、図５に示す例においても、リンクＬＫ２がリンクＬＫ１に対して回転（旋回）するように関節機構ＪＥｒ３を駆動することにより、面ＳＦ１等の所定の平面上で先端部ＴＰ１を回転させることができる。この場合においても、先端部ＴＰ１を高精度及び高速に移動させること、及び、可搬重量を大きくすることができる。

【0111】

次に、図６を参照しながら、ロボットコントローラ３０のハードウェア構成について説明する。

【0112】

図６は、図１に示したロボットコントローラ３０のハードウェア構成の一例を示す図である。

【0113】

ロボットコントローラ３０は、ロボットコントローラ３０の各部を制御する処理装置３２と、各種情報を記憶するメモリ３３と、通信装置３４と、作業者等による操作を受け付ける操作装置３５と、表示装置３６と、ドライバ回路３７とを有する。

【0114】

メモリ３３は、例えば、処理装置３２の作業領域として機能するＲＡＭ（Ｒａｎｄｏｍ Ａｃｃｅｓｓ Ｍｅｍｏｒｙ）等の揮発性メモリと、制御プログラムＰＧｒ等の各種情報を記憶するＥＥＰＲＯＭ（Ｅｌｅｃｔｒｉｃａｌｌｙ Ｅｒａｓａｂｌｅ Ｐｒｏｇｒａｍｍａｂｌｅ Ｒｅａｄ－Ｏｎｌｙ Ｍｅｍｏｒｙ）等の不揮発性メモリとの、一方又は両方を含む。なお、メモリ３３は、ロボットコントローラ３０に着脱可能であってもよい。具体的には、メモリ３３は、ロボットコントローラ３０に着脱されるメモリカード等の記憶媒体であってもよい。また、メモリ３３は、例えば、ロボットコントローラ３０とネットワーク等を介して通信可能に接続された記憶装置（例えば、オンラインストレージ）であってもよい。

【0115】

図６に示すメモリ３３は、制御プログラムＰＧｒを記憶している。本実施形態では、制御プログラムＰＧｒは、例えば、ロボットコントローラ３０がロボット１０の動作を制御するためのアプリケーションプログラムを含む。但し、制御プログラムＰＧｒは、例えば、処理装置３２がロボットコントローラ３０の各部を制御するためのオペレーティングロボットシステムプログラムを含んでもよい。

【0116】

処理装置３２は、ロボットコントローラ３０の全体を制御するプロセッサであり、例えば、１又は複数のＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）を含んで構成される。処理装置３２は、例えば、メモリ３３に記憶された制御プログラムＰＧｒを実行し、制御プログラムＰＧｒに従って動作することで、ロボット１０の動作を制御する。なお、制御プログラムＰＧｒは、ネットワーク等を介して他の装置から送信されてもよい。

【0117】

また、例えば、処理装置３２が複数のＣＰＵを含んで構成される場合、処理装置３２の機能の一部又は全部は、これら複数のＣＰＵが制御プログラムＰＧｒ等のプログラムに従って協働して動作することで実現されてもよい。また、処理装置３２は、１又は複数のＣＰＵに加え、又は、１又は複数のＣＰＵのうち一部又は全部に代えて、ＧＰＵ（Ｇｒａｐｈｉｃｓ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）、ＤＳＰ（Ｄｉｇｉｔａｌ Ｓｉｇｎａｌ Ｐｒｏｃｅｓｓｏｒ）、又は、ＦＰＧＡ（Ｆｉｅｌｄ Ｐｒｏｇｒａｍｍａｂｌｅ Ｇａｔｅ Ａｒｒａｙ）等のハードウェアを含んで構成されるものであってもよい。この場合、処理装置３２の機能の一部又は全部は、ＤＳＰ等のハードウェアにより実現されてもよい。

【0118】

通信装置３４は、ロボットコントローラ３０の外部に存在する外部装置と通信を行うためのハードウェアである。例えば、通信装置３４は、近距離無線通信によって外部装置と通信する機能を有する。なお、通信装置３４は、移動体通信網又はネットワークを介して外部装置と通信する機能をさらに有してもよい。

【0119】

操作装置３５は、外部からの入力を受け付ける入力デバイス（例えば、キーボード、マウス、スイッチ、ボタン及びセンサ等）である。例えば、操作装置３５は、作業者の操作を受け付け、操作に応じた操作情報を処理装置３２に出力する。なお、例えば、表示装置３６の表示面に対する接触を検出するタッチパネルが、操作装置３５として採用されてもよい。

【0120】

表示装置３６は、外部への出力を実施するディスプレイ等の出力デバイスである。表示装置３６は、例えば、処理装置３２による制御のもとで、画像を表示する。なお、操作装置３５及び表示装置３６は、一体となった構成（例えば、タッチパネル）であってもよい。

【0121】

ドライバ回路３７は、処理装置３２による制御のもとで、ロボット１０を駆動するための信号をロボット１０に出力するハードウェアである。例えば、ドライバ回路３７は、処理装置３２による制御のもとで、モータＭＯｒ１、ＭＯｒ２、ＭＯｒ３、ＭＯｒ４、ＭＯｒ５、ＭＯｒ６、ＭＯｐ１及びＭＯｐ２等を駆動する信号をロボット１０に出力する。なお、モータＭＯｒ１、ＭＯｒ２、ＭＯｒ３、ＭＯｒ４、ＭＯｒ５及びＭＯｒ６は、関節機構ＪＥｒ１、ＪＥｒ２、ＪＥｒ３、ＪＥｒ４、ＪＥｒ５及びＪＥｒ６をそれぞれ駆動するモータである。また、モータＭＯｐ１及びＭＯｐ２は、関節機構ＪＥｐ１及びＪＥｐ２をそれぞれ駆動するモータである。

【0122】

このように、ロボットコントローラ３０は、モータＭＯｒ１、ＭＯｒ２、ＭＯｒ３、ＭＯｒ４、ＭＯｒ５、ＭＯｒ６、ＭＯｐ１及びＭＯｐ２を制御することにより、ロボット１０の動作を制御する。例えば、ロボットコントローラ３０は、モータＭＯｒ３、ＭＯｐ１及びＭＯｐ２を制御することにより、ロボット１０の先端部ＴＰ１が所定の平面に沿って動作するように、ロボット１０の動作を制御する。

【0123】

以上、本実施形態では、ロボット１０は、ボディ部ＢＤＰと、先端部ＴＰ１と、リンクＬＫ１及びリンクＬＫ２を含み、ボディ部ＢＤＰと先端部ＴＰ１とを接続する複数のリンクＬＫと、リンクＬＫ１とリンクＬＫ２とを接続し、リンクＬＫ１が延在する方向Ｄｅ１とのなす角度が所定の角度より大きい軸Ａｘ３を第１回転軸としてリンクＬＫ２をリンクＬＫ１に対して回転させる関節機構ＪＥｒ３と、方向Ｄｅ１に沿って、関節機構ＪＥｒ３をリンクＬＫ１に対して相対的に移動させる関節機構ＪＥｐ１と、リンクＬＫ２が延在する方向Ｄｅ２に沿って、リンクＬＫ２を関節機構ＪＥｒ３に対して相対的に移動させる関節機構ＪＥｐ２と、ボディ部ＢＤＰの底面ＢＤＰｂｔに垂直な方向Ｄｖ１とのなす角度が所定の角度以下の軸Ａｘ１を第２回転軸として、ボディ部ＢＤＰの少なくとも一部分を回転させる関節機構ＪＥｒ１と、ボディ部ＢＤＰとリンクＬＫ１とを接続し、ボディ部ＢＤＰの底面ＢＤＰｂｔに垂直な方向Ｄｖ１とのなす角度が所定の角度より大きい軸Ａｘ２を第３回転軸としてリンクＬＫ１を回転させる関節機構ＪＥｒ２と、を有する。方向Ｄｅ１からの平面視において、第１回転軸（軸Ａｘ３）に沿う方向Ｄａｘ３と第３回転軸（軸Ａｘ２）に沿う方向Ｄａｘ２は、所定の角度以上の第１角度で交差している。

【0124】

このように、本実施形態では、関節機構ＪＥｐ１が、方向Ｄｅ１に沿って、関節機構ＪＥｒ３をリンクＬＫ１に対して相対的に移動させ、関節機構ＪＥｐ２が、方向Ｄｅ２に沿って、リンクＬＫ２を関節機構ＪＥｒ３に対して相対的に移動させる。これにより、本実施形態では、簡易な制御によってロボット１０の先端部ＴＰ１をボディ部ＢＤＰの周辺に移動させることができる。また、本実施形態では、リンクＬＫ１及びリンクＬＫ２の実質的なリンク長を短くすることにより、基部の周辺であっても多関節ロボットの作業可能領域を狭めることなく、高精度にロボットの先端部を制御することができる。

【0125】

また、本実施形態では、方向Ｄｅ１からの平面視において、第１回転軸（軸Ａｘ３）に沿う方向Ｄａｘ３と第３回転軸（軸Ａｘ２）に沿う方向Ｄａｘ２とは、第１角度で交差している。このため、本実施形態では、リンクＬＫ２の旋回面とリンクＬＫ１の旋回面とのなす角は、第１角度となる。これにより、本実施形態では、リンクＬＫ１の旋回面とのなす角が第１角度の平面上を先端部ＴＰ１が移動する動作を、複数の関節機構ＪＥのうちの直動関節に対応する関節機構ＪＥｐ１及びＪＥｐ２のみの駆動により、実現することができる。この結果、本実施形態では、リンクＬＫ１の旋回面とのなす角が第１角度の平面上で先端部ＴＰ１を高精度及び高速に移動させることができる。さらに、本実施形態では、複数の関節機構ＪＥのうちの関節機構ＪＥｐ１及びＪＥｐ２のみの駆動により、リンクＬＫ１の旋回面とのなす角が第１角度の平面上で先端部ＴＰ１を移動させることができるため、先端部ＴＰ１の可搬重量を大きくすることができる。

【0126】

また、本実施形態では、第１角度は、実質的に９０度である。このため、本実施形態では、ロボット１０の接地面に対して水平な面ＳＦ１、接地面に対して垂直な面ＳＦ２、又は、接地面に対して傾斜している平面ＳＦ３上で先端部ＴＰ１を高精度及び高速に移動させることができる。また、本実施形態では、複数の関節機構ＪＥのうちの関節機構ＪＥｐ１及びＪＥｐ２のみの駆動により、上述の面ＳＦ１、面ＳＦ２、又は、平面ＳＦ３上で先端部ＴＰ１を移動させることができるため、先端部ＴＰ１の可搬重量を大きくすることができる。

【0127】

また、本実施形態では、ロボット１０は、リンクＬＫ２と先端部ＴＰ１とを接続し、先端部ＴＰ１をリンクＬＫ２に対して回転させる関節機構ＪＥｒ４をさらに有する。関節機構ＪＥｒ４は、方向Ｄｅ２とのなす角度が所定の角度より大きい軸Ａｘ４を第４回転軸として、先端部ＴＰ１をリンクＬＫ２に対して回転させる。先端部ＴＰ１は、リンクＬＫ２に接続される第１部分ＴＰ１１と、第１部分ＴＰ１１に接続される第２部分ＴＰ１２と、第１部分ＴＰ１１と第２部分ＴＰ１２とを接続し、第４回転軸（軸Ａｘ４）とのなす角度が所定の角度より大きい軸Ａｘ５を第５回転軸として、第２部分ＴＰ１２を第１部分ＴＰ１１に対して回転させる関節機構ＪＥｒ５と、第５回転軸（軸Ａｘ５）とのなす角度が所定の角度より大きい軸Ａｘ６を第６回転軸として、先端部ＴＰ１のうちエンドエフェクタ２０が取り付けられる部分を回転させる関節機構ＪＥｒ６と、を含む。このように、ロボット１０は、関節機構ＪＥｐ１及びＪＥｐ２を６軸多関節ロボットに追加することによって実現されてもよい。例えば、本実施形態では、先端部ＴＰ１が関節機構ＪＥｒ５及びＪＥｒ６を含むため、関節機構ＪＥｒ４、ＪＥｒ５及びＪＥｒ６等によって、ボディ部ＢＤＰの周辺、又は、所定の平面において、様々な作業をロボット１０に実行させることができる。

【0128】

また、本実施形態では、ロボット１０は、関節機構ＪＥｒ３を駆動するモータＭＯｒ３と、関節機構ＪＥｐ１を駆動するモータＭＯｐ１と、関節機構ＪＥｐ２を駆動するモータＭＯｐ２と、関節機構ＪＥｒ１を駆動するモータＭＯｒ１と、関節機構ＪＥｒ２を駆動するモータＭＯｒ２と、をさらに有する。関節機構ＪＥｐ１は、リンクＬＫ１の内部に配置され、方向Ｄｅ１に延在し、モータＭＯｐ１の回転に伴い、方向Ｄｅ１に沿う軸を回転軸として回転するねじ部ＪＥｐ１１と、関節機構ＪＥｒ３に接続され、ねじ部ＪＥｐ１１が挿通され、ねじ部ＪＥｐ１１の回転に伴い、ねじ部ＪＥｐ１１に対して相対的に移動するナットＪＥｐ１２と、を有する。関節機構ＪＥｐ２は、リンクＬＫ２の内部に配置され、方向Ｄｅ２に延在し、モータＭＯｐ２の回転に伴い、方向Ｄｅ２に沿う軸を回転軸として回転するねじ部ＪＥｐ２１と、関節機構ＪＥｒ３に接続され、ねじ部ＪＥｐ２１が挿通され、ねじ部ＪＥｐ２１の回転に伴い、ねじ部ＪＥｐ２１に対して相対的に移動するナットＪＥｐ２２と、を有する。関節機構ＪＥｒ３は、ナットＪＥｐ１２の移動に伴い、リンクＬＫ１に対して相対的に移動し、リンクＬＫ２は、ナットＪＥｐ２２の移動に伴い、関節機構ＪＥｒ３に対して相対的に移動する。このように、本実施形態では、関節機構ＪＥｐ１及びＪＥｐ２を簡易な構成で実現することができる。

【0129】

また、本実施形態では、ロボット１０の動作を制御するロボットコントローラ３０は、モータＭＯｒ３、ＭＯｐ１及びＭＯｐ２を制御することにより、ロボット１０の先端部ＴＰ１が所定の平面に沿って移動するように、ロボット１０の動作を制御する。このように、本実施形態では、ロボットコントローラ３０により、ロボット１０の先端部ＴＰ１が所定の平面に沿って移動するように、ロボット１０の動作を容易に制御することができる。

【0130】

また、本実施形態では、ロボットシステム１は、ロボット１０と、先端部ＴＰ１に取り付けられたエンドエフェクタ２０と、ロボット１０及びエンドエフェクタ２０の動作を制御するロボットコントローラ３０と、を有する。ロボットコントローラ３０は、モータＭＯｒ３、ＭＯｐ１、ＭＯｐ２、ＭＯｒ１及びＭＯｒ２を制御することにより、ロボット１０の動作を制御する。このように、本実施形態では、簡易な制御によって先端部ＴＰ１を所定の平面に沿って移動させること、及び、簡易な制御によって先端部ＴＰ１をボディ部ＢＤＰの周辺に移動させることができるロボット１０が、ロボットシステム１に用いられる。このため、本実施形態では、所定の平面上で行われる作業を効率よく行うことができる。あるいは、本実施形態では、ボディ部ＢＤＰの周辺の狭い場所においても、複雑な作業及び単純な作業を効率よく行うことができる。例えば、部品を組み付ける、又は、部品を取り除くことを含む物品の製造方法にロボットシステム１が用いられてもよい。この場合、部品を組み付ける、又は、部品を取り除く作業を効率よく実行することができる。

【0131】

［２．変形例］
本発明は、以上に例示した実施形態に限定されない。具体的な変形の態様を以下に例示する。以下の例示から任意に選択された２以上の態様を併合してもよい。

【0132】

［第１変形例］
上述した実施形態では、関節機構ＪＥｒ４が、リンクＬＫ２が延在する方向Ｄｅ２に垂直な軸Ａｘ４を回転軸として、先端部ＴＰ１をリンクＬＫ２に対して回転させる場合を例示したが、本発明はこのような態様に限定されるものではない。例えば、関節機構ＪＥｒ４は、リンクＬＫ２が延在する方向Ｄｅ２とのなす角度が所定の角度以下の軸を回転軸として、先端部ＴＰ１をリンクＬＫ２に対して回転させてもよい。

【0133】

図７は、第１変形例に係る先端部ＴＰ１Ａの一例を説明するための説明図である。図１から図６において説明した要素と同様の要素については、同様の符号を付し、詳細な説明を省略する。

【0134】

例えば、本変形例に係るロボット１０は、図１に示したリンクＬＫ２、関節機構ＪＥｒ４及び先端部ＴＰ１の代わりにリンクＬＫ２Ａ、関節機構ＪＥｒ４Ａ及び先端部ＴＰ１Ａを有することを除いて、図１に示したロボット１０と同様である。リンクＬＫ２Ａは、関節機構ＪＥｒ４の代わりに関節機構ＪＥｒ４Ａが接続されることを除いて、リンクＬＫ２と同様である。なお、リンクＬＫ２Ａは、「第２リンク」の他の例であり、関節機構ＪＥｒ４Ａは、「第４駆動機構」の他の例である。

【0135】

関節機構ＪＥｒ４Ａは、リンクＬＫ２Ａと先端部ＴＰ１Ａとを接続し、方向Ｄｅ２に平行な軸Ａｘ４Ａを回転軸として、先端部ＴＰ１ＡをリンクＬＫ２Ａに対して回転させる。図７の回転方向Ｄｒ４は、軸Ａｘ４Ａを回転軸として回転する場合の先端部ＴＰ１Ａの回転方向を示す。なお、軸Ａｘ４Ａは、「第４回転軸」の他の例であり、リンクＬＫ２Ａが延在する方向Ｄｅ２とのなす角度が所定の角度以下の軸に該当する。

【0136】

先端部ＴＰ１Ａにおいても、図１に示した先端部ＴＰ１と同様に、エンドエフェクタ２０が端面ＴＰ１ｓｆに取り付けられる。先端部ＴＰ１Ａは、リンクＬＫ２Ａに接続される第１部分ＴＰ１１Ａと、第１部分ＴＰ１１Ａに接続される第２部分ＴＰ１２Ａと、関節機構ＪＥｒ５Ａと、関節機構ＪＥｒ６とを含む。第１部分ＴＰ１１Ａは、例えば、関節機構ＪＥｒ４Ａを介してリンクＬＫ２Ａに接続される。従って、第１部分ＴＰ１１Ａは、軸Ａｘ４Ａを回転軸としてリンクＬＫ２Ａに対して回転する。

【0137】

関節機構ＪＥｒ５Ａは、第１部分ＴＰ１１Ａと第２部分ＴＰ１２Ａとを接続し、軸Ａｘ４Ａに垂直な軸Ａｘ５を回転軸として、第２部分ＴＰ１２Ａを第１部分ＴＰ１１Ａに対して回転させる。図１の回転方向Ｄｒ５は、軸Ａｘ５を回転軸として回転する場合の第２部分ＴＰ１２Ａの回転方向を示す。なお、関節機構ＪＥｒ５Ａは、「第５駆動機構」の他の例である。

【0138】

関節機構ＪＥｒ６は、図１に示した関節機構ＪＥｒ６と同様である。例えば、関節機構ＪＥｒ６は、軸Ａｘ５に垂直な軸Ａｘ６を回転軸として、先端部ＴＰ１Ａの少なくとも一部分（例えば、端面ＴＰ１ｓｆ）を回転させる。図７に示す例では、図１に示した関節機構ＪＥｒ６と同様に、関節機構ＪＥｒ６の表面が端面ＴＰ１ｓｆに該当する。なお、関節機構ＪＥｒ６が第２部分ＴＰ１２Ａに含まれる構成等では、第２部分ＴＰ１２Ａの端面が端面ＴＰ１ｓｆであってもよい。

【0139】

以上、本変形例では、関節機構ＪＥｒ４Ａは、方向Ｄｅ２とのなす角度が所定の角度以下の軸Ａｘ４Ａを第４回転軸として、先端部ＴＰ１ＡをリンクＬＫ２Ａに対して回転させる。先端部ＴＰ１Ａは、リンクＬＫ２Ａに接続される第１部分ＴＰ１１Ａと、第１部分ＴＰ１１Ａに接続される第２部分ＴＰ１２Ａと、第１部分ＴＰ１１Ａと第２部分ＴＰ１２Ａとを接続し、第４回転軸（軸Ａｘ４Ａ）とのなす角度が所定の角度より大きい軸Ａｘ５を第５回転軸として、第２部分ＴＰ１２Ａを第１部分ＴＰ１１Ａに対して回転させる関節機構ＪＥｒ５Ａと、第５回転軸（軸Ａｘ５）とのなす角度が所定の角度より大きい軸Ａｘ６を第６回転軸として、先端部ＴＰ１Ａのうちエンドエフェクタ２０が取り付けられる部分を回転させる関節機構ＪＥｒ６と、を含む。

【0140】

本変形例においても、上述した実施形態と同様の効果を得ることができる。例えば、本変形例においても、先端部ＴＰ１Ａが関節機構ＪＥｒ５Ａ及びＪＥｒ６を含むため、関節機構ＪＥｒ４Ａ、ＪＥｒ５Ａ及びＪＥｒ６等によって、ボディ部ＢＤＰの周辺、又は、所定の平面において、様々な作業をロボット１０に実行させることができる。

【0141】

［第２変形例］
上述した実施形態及び変形例では、関節機構ＪＥｒ３を駆動するモータＭＯｒ３が関節機構ＪＥｒ３と一体的に移動する場合を例示したが、本発明はこのような態様に限定されるものではない。例えば、モータＭＯｒ３は、リンクＬＫ１に対する関節機構ＪＥｒ３の相対的な位置が変化しても関節機構ＪＥｒ３を駆動可能に、リンクＬＫ１の所定の場所に固定されてもよい。本変形例においても、上述した実施形態及び変形例と同様の効果を得ることができる。

【0142】

［第３変形例］
上述した実施形態及び変形例では、６軸多関節ロボットに２つの関節機構ＪＥｐ１及びＪＥｐ２を追加した構成をロボット１０として例示したが、本発明はこのような態様に限定されるものではない。例えば、ロボット１０は、７軸以上の多関節ロボットに２つの関節機構ＪＥｐ１及びＪＥｐ２を追加した構成であってもよい。具体的には、ボディ部ＢＤＰと関節機構ＪＥｒ２との間に、リンクＬＫ１及びＬＫ２とは異なる１以上のリンクＬＫが配置されてもよい。あるいは、関節機構ＪＥｒ４と先端部ＴＰ１との間に、リンクＬＫ１及びＬＫ２とは異なる１以上のリンクＬＫが配置されてもよい。すなわち、ロボット１０は、ボディ部ＢＤＰと先端部ＴＰ１とを接続する３以上のリンクＬＫを有してもよい。この場合、ロボット１０が有する３以上のリンクＬＫは、リンクＬＫ１及びＬＫ２を含む複数のリンクＬＫに該当する。

【0143】

以上、本変形例においても、上述した実施形態及び変形例と同様の効果を得ることができる。

【0144】

［３．応用例］
上述した実施形態及び変形例において説明したロボット１０を含むロボットシステム１は、部品を組み付ける、又は、部品を取り除くことを含む物品の製造方法に用いられてもよい。

【0145】

［４．その他］
上述した実施形態において簡単に説明した「旋回」と他の回転との区別について、いくつかの例を挙げて説明する。

【0146】

図８は、旋回の一例を説明するための説明図である。図８では、長手方向を把握可能な２つのリンクＬＫｉ及びＬＫｊの接続を例にして、旋回と他の回転との区別について説明する。図８の延在方向Ｄｅｉは、リンクＬＫｉが延在する方向を示し、延在方向Ｄｅｊは、リンクＬＫｊが延在する方向を示す。また、図８の関節機構ＪＥｒｉは、リンクＬＫｉとリンクＬＫｊとを接続し、軸Ａｘｉを回転軸として、リンクＬＫｊをリンクＬＫｉに対して回転させる。

【0147】

図８に示す例では、リンクＬＫｉの延在方向Ｄｅｉ（特定の方向）と軸Ａｘｉとのなす角度θが所定の角度より大きい場合、当該軸Ａｘｉを回転軸とした回転は、「旋回」に該当する。すなわち、リンクＬＫｉの延在方向Ｄｅｉと軸Ａｘｉとのなす角度θが所定の角度以下の場合、当該軸Ａｘｉを回転軸とした回転は、旋回以外の回転（旋回と区別される他の回転）に該当する。図８に示す「回転」は、旋回以外の回転を示す。また、所定の角度は特に限定されないが、図８では、所定の角度が４５°である場合を想定する。延在方向Ｄｅｉと軸Ａｘｉとのなす角度θは、延在方向Ｄｅｉに対する軸Ａｘｉの角度として把握される複数の角度（例えば、互いに交差する２つの直線では４つの角度、又は、平行な２つの直線では０°及び１８０°）のうち、０°以上９０°以下の角度である。

【0148】

第１パターンでは、リンクＬＫｉの延在方向Ｄｅｉと軸Ａｘｉとのなす角度θは、９０°であり、所定の角度（４５°）よりも大きい。従って、第１パターンでは、軸Ａｘｉを回転軸としたリンクＬＫｊの回転は、旋回である。また、第１パターンでは、リンクＬＫｊの延在方向Ｄｅｊは、軸Ａｘｉに垂直である。なお、第１パターンでは、リンクＬＫｊが軸Ａｘｉを回転軸として回転（旋回）した場合、リンクＬＫｉの延在方向Ｄｅｉに対するリンクＬＫｊの延在方向Ｄｅｊの角度は、変化する。

【0149】

第２パターンでは、リンクＬＫｉの延在方向Ｄｅｉと軸Ａｘｉとのなす角度θは、０°であり、所定の角度（４５°）以下である。従って、第２パターンでは、軸Ａｘｉを回転軸としたリンクＬＫｊの回転は、旋回以外の回転である。また、第２パターンでは、リンクＬＫｊの延在方向Ｄｅｊは、リンクＬＫｉの延在方向Ｄｅｉ及び軸Ａｘｉに平行である。すなわち、リンクＬＫｉの延在方向Ｄｅｉに対するリンクＬＫｊの延在方向Ｄｅｊの角度は、０°である。なお、第２パターンでは、リンクＬＫｊが軸Ａｘｉを回転軸として回転しても、リンクＬＫｉの延在方向Ｄｅｉに対するリンクＬＫｊの延在方向Ｄｅｊの角度は、０°に維持され、常に一定である。

【0150】

第３パターンでは、リンクＬＫｉの延在方向Ｄｅｉと軸Ａｘｉとのなす角度θは、０°であり、所定の角度（４５°）以下である。従って、第３パターンでは、軸Ａｘｉを回転軸としたリンクＬＫｊの回転は、旋回以外の回転である。また、第３パターンでは、リンクＬＫｊの延在方向Ｄｅｊは、リンクＬＫｉの延在方向Ｄｅｉ及び軸Ａｘｉに垂直である。すなわち、リンクＬＫｉの延在方向Ｄｅｉに対するリンクＬＫｊの延在方向Ｄｅｊの角度は、９０°である。なお、第３パターンでは、リンクＬＫｊが軸Ａｘｉを回転軸として回転しても、リンクＬＫｉの延在方向Ｄｅｉに対するリンクＬＫｊの延在方向Ｄｅｊの角度は、９０°に維持され、常に一定である。

【0151】

第４パターンでは、リンクＬＫｉの延在方向Ｄｅｉと軸Ａｘｉとのなす角度θは、１０°であり、所定の角度（４５°）以下である。従って、第４パターンでは、軸Ａｘｉを回転軸としたリンクＬＫｊの回転は、旋回以外の回転である。また、第４パターンでは、リンクＬＫｊの延在方向Ｄｅｊは、軸Ａｘｉに平行であり、リンクＬＫｉの延在方向Ｄｅｉに対するリンクＬＫｊの延在方向Ｄｅｊの角度は、１０°である。なお、第４パターンでは、リンクＬＫｊが軸Ａｘｉを回転軸として回転しても、リンクＬＫｉの延在方向Ｄｅｉに対するリンクＬＫｊの延在方向Ｄｅｊの角度は、１０°に維持され、常に一定である。

【0152】

第５パターンでは、リンクＬＫｉの延在方向Ｄｅｉと軸Ａｘｉとのなす角度θは、７０°であり、所定の角度（４５°）よりも大きい。従って、第５パターンでは、軸Ａｘｉを回転軸としたリンクＬＫｊの回転は、旋回である。また、第５パターンでは、リンクＬＫｊの延在方向Ｄｅｊは、軸Ａｘｉに垂直である。なお、第５パターンでは、リンクＬＫｊが軸Ａｘｉを回転軸として回転（旋回）した場合、リンクＬＫｉの延在方向Ｄｅｉに対するリンクＬＫｊの延在方向Ｄｅｊの角度は、変化する。

【0153】

第６パターンでは、リンクＬＫｉの延在方向Ｄｅｉと軸Ａｘｉとのなす角度θは、１０°であり、所定の角度（４５°）以下である。従って、第６パターンでは、軸Ａｘｉを回転軸としたリンクＬＫｊの回転は、旋回以外の回転である。また、第６パターンでは、リンクＬＫｊの延在方向Ｄｅｊは、軸Ａｘｉに垂直である。なお、第６パターンでは、リンクＬＫｊが軸Ａｘｉを回転軸として回転した場合、リンクＬＫｉの延在方向Ｄｅｉに対するリンクＬＫｊの延在方向Ｄｅｊの角度は、変化する。

【0154】

第７パターンでは、リンクＬＫｉの延在方向Ｄｅｉと軸Ａｘｉとのなす角度θは、７０°であり、所定の角度（４５°）よりも大きい。従って、第７パターンでは、軸Ａｘｉを回転軸としたリンクＬＫｊの回転は、旋回である。また、第７パターンでは、リンクＬＫｊの延在方向Ｄｅｊは、軸Ａｘｉに平行であり、リンクＬＫｉの延在方向Ｄｅｉに対するリンクＬＫｊの延在方向Ｄｅｊの角度は、７０°である。なお、第７パターンでは、リンクＬＫｊが軸Ａｘｉを回転軸として回転しても、リンクＬＫｉの延在方向Ｄｅｉに対するリンクＬＫｊの延在方向Ｄｅｊの角度は、７０°に維持され、常に一定である。

【0155】

このように、上述した実施形態及び変形例では、リンクＬＫｉに対するリンクＬＫｊの回転のうち、リンクＬＫｉの延在方向Ｄｅｉとのなす角度が所定の角度より大きい軸Ａｘｉを回転軸とした回転が、旋回とも称される。但し、「旋回」の定義は、上述の例に限定されない。例えば、リンクＬＫｉの延在方向Ｄｅｉとのなす角度が所定の角度より大きい軸Ａｘｉを回転軸とした回転を旋回とする上述の定義を第１定義とした場合、第１定義の代わりに、下記の第２定義又は第３定義が採用されてもよい。

【0156】

第２定義では、リンクＬＫｉに対するリンクＬＫｊの回転により、リンクＬＫｉの延在方向Ｄｅｉに対するリンクＬＫｊの延在方向Ｄｅｊの角度が変化する場合、当該回転が旋回に該当する。従って、第２定義では、リンクＬＫｉの延在方向Ｄｅｉに対するリンクＬＫｊの延在方向Ｄｅｊの角度が、回転しても常に一定の場合、当該回転は、旋回以外の回転に該当する。例えば、第２定義では、図８に示した第１パターン、第５パターン及び第６パターンは、旋回に該当し、第２パターン、第３パターン、第４パターン及び第７パターンは、旋回以外の回転に該当する。

【0157】

第３定義では、回転するリンクＬＫｊの延在方向ＤｅｊとリンクＬＫｊの回転軸（軸Ａｘｉ）とのなす角度が所定の角度より大きい場合、当該回転が旋回に該当する。従って、第３定義では、リンクＬＫｊの延在方向ＤｅｊとリンクＬＫｊの回転軸（軸Ａｘｉ）とのなす角度が所定の角度以下の場合、当該回転は、旋回以外の回転に該当する。例えば、第３定義では、図８に示した第１パターン、第３パターン、第５パターン及び第６パターンは、旋回に該当し、第２パターン、第４パターン及び第７パターンは、旋回以外の回転に該当する。

【0158】

また、上述の第１定義、第２定義及び第３定義とは別に、互いに隣接する２つの関節機構ＪＥｒのそれぞれの回転軸の関係に着目して、２つの関節機構ＪＥｒによる２つの回転の相対関係を定義してもよい。具体的には、２つの回転軸のなす角度が所定の角度以下である場合（典型的には、平行の場合）、２つの回転を同種の回転とし、２つの回転軸のなす角度が所定の角度よりも大きい場合（典型的には、直交する場合）、２つの回転を異種の回転としてもよい。なお、同種の回転とは、２つの回転とも旋回、又は、２つの回転とも旋回以外の回転であり、異種の回転とは、２つの回転の一方が旋回で他方が旋回以外の回転である。２つの回転の相対関係の定義が用いられる場合、相対関係の起点となる回転は、例えば、上述の第１定義、第２定義及び第３定義のいずれかに基づいて決められてもよい。図８に示した第１パターンは、第１定義、第２定義及び第３定義のいずれにおいても、旋回に該当し、第２パターンは、第１定義、第２定義及び第３定義のいずれにおいても、旋回以外の回転に該当する。従って、第１パターン又は第２パターンを、相対関係の起点となる回転とすることが好ましい。

【0159】

また、上述の第１定義、第２定義及び第３定義の２以上の定義を組み合わせた定義が用いられてもよい。この場合、例えば、組み合わせる２以上の定義の全てで旋回に該当する回転のみを旋回としてもよいし、組み合わせる２以上の定義の少なくとも１つで旋回に該当する回転を旋回としてもよい。

【符号の説明】

【0160】

１…ロボットシステム、１０…ロボット、２０…エンドエフェクタ、３０…ロボットコントローラ、３２…処理装置、３３…メモリ、３４…通信装置、３５…操作装置、３６…表示装置、３７…ドライバ回路、Ａｘ１、Ａｘ２、Ａｘ３、Ａｘ４、Ａｘ４Ａ、Ａｘ５、Ａｘ６、Ａｘｉ…軸、ＢＤＰ…ボディ部、ＢＤＰｂｔ…底面、ＢＤＰｂａ…土台部、ＪＥｒ１、ＪＥｒ２、ＪＥｒ３、ＪＥｒ４、ＪＥｒ４Ａ、ＪＥｒ５、ＪＥｒ６、ＪＥｒｉ、ＪＥｐ１、ＪＥｐ２…関節機構、ＪＥｐ１１、ＪＥｐ２１…ねじ部、ＪＥｐ１２、ＪＥｐ２２…ナット、ＪＥｐ１３、ＪＥｐ２３…接続部、ＪＥｐ１３ａ、ＪＥｐ２３ａ…スライダー部、ＪＥｐ１３ｂ、ＪＥｐ２３ｂ…支持部、ＪＥｐ１４、ＪＥｐ２４…レール、ＪＥｐ１４ａ、ＪＥｐ１４ｂ、ＪＥｐ２４ａ、ＪＥｐ２４ｂ…棒状部材、ＪＥｒ１１、ＪＥｒ２１、ＪＥｒ４１、ＪＥｒ５１、ＪＥｒ６１…回転部、ＪＥｒ１２、ＪＥｒ２２、ＪＥｒ４２、ＪＥｒ５２、ＪＥｒ６２…筐体、ＬＫ１、ＬＫ２、ＬＫ２Ａ、ＬＫｉ、ＬＫｊ…リンク、ＭＯｒ１、ＭＯｒ２、ＭＯｒ３、ＭＯｒ４、ＭＯｒ５、ＭＯｒ６、ＭＯｐ１、ＭＯｐ２…モータ。

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】