JP2015182143A - ロボットおよびロボットシステム - Google Patents

Abstract

【課題】容易かつ確実に、振動を抑制することができるロボットおよびロボットシステムを提供すること。
【解決手段】ロボットは、基台と、前記基台に、第１回動軸を回動中心として回動可能に設けられた第１アームと、前記第１アームに、前記第１回動軸の軸方向とは異なる軸方向である第２回動軸を回動中心として回動可能に設けられた第２アームと、第１角速度検出器を有する第１部材と、を備え、前記第１部材の少なくとも一部は、前記第２回動軸の軸方向から見て、前記第１アームの前記第２アームと重なっている部分に設けられている。
【選択図】図１

Description

本発明は、ロボットおよびロボットシステムに関するものである。

特許文献１に記載のロボットでは、先端部、すなわち、最も先端側の第６のリンクに、互いに直交するＸ軸、Ｙ軸、Ｚ軸のそれぞれの方向の加速度、Ｘ軸、Ｙ軸、Ｚ軸のそれぞれの回りの加速度を検出する６軸センサーを設置し、その６軸センサーの検出結果に基づいて、各リンクについて、それぞれ、目的の軸回りの角速度の振動成分を求め、振動を抑制する制御を行っている。なお、リンクの角速度の振動成分は、「ねじれ角速度」または「振動角速度」等と呼ばれている。

特開２０１１−１３６３９５号公報

特許文献１に記載のロボットでは、ロボットの動きによって６軸センサーの姿勢が変わるので、その６軸センサーの検出結果から、ヤコビ変換と呼ばれる座標軸変換等を行い、各リンクの角速度の振動成分を求める必要がある。しかも、刻一刻と変化するモーターの回転角度に合わせて計算を行う必要がある。

このため、複雑で膨大な演算処理が必要となるので、性能が高く、高価なＣＰＵ（Central Processing Unit）等を有する制御装置を必要とし、コストが増大するという問題がある。

また、複雑で膨大な演算処理が必要となるので、演算誤差が生じ易く、その演算誤差により、振動を十分に抑制することができないという問題がある。

本発明の目的は、容易かつ確実に、振動を抑制することができるロボットおよびロボットシステムを提供することにある。

本発明は、上述の課題の少なくとも一部を解決するためになされたものであり、以下の形態または適用例として実現することが可能である。

（適用例１）
本発明に係わるロボットは、基台と、
前記基台に、第１回動軸を回動中心として回動可能に設けられた第１アームと、
前記第１アームに、前記第１回動軸の軸方向とは異なる軸方向である第２回動軸を回動中心として回動可能に設けられた第２アームと、
第１角速度検出器を有する第１部材と、を備え、
前記第１部材の少なくとも一部は、前記第２回動軸の軸方向から見て、前記第１アームの前記第２アームと重なっている部分に設けられていることを特徴とする。

これにより、容易かつ確実に、振動を抑制することができる。
また、第１部材を前記の位置に配置することにより、第１角速度検出器は、第１アームの先端側に配置されることとなるので、その第１角速度検出器により、第１アームのうちの振動の大きい部位の角速度を検出することができ、これにより、確実に振動を抑制することができる。

（適用例２）
本発明に係わるロボットでは、前記第１アームは、前記第２アームよりも基台側に位置する第１部分と、前記基台よりも前記第２アーム側に位置する第２部分と、を有し、
前記第１部材は、前記第２部分に設けられていることが好ましい。

これにより、第２アームが回動した場合に第１アームに発生する振動は、第１部分よりも第２部分の方が大きいので、第１角速度検出器により、第１アームのうちの振動の大きい部位の角速度を検出することができ、これによって、確実に振動を抑制することができる。

（適用例３）
本発明に係わるロボットでは、前記第２部分に、減速機が設けられていることが好ましい。

これにより、第２アームが回動した場合に、第２部分に大きい振動が発生するので、第１角速度検出器により、第１アームのうちの振動の大きい部位の角速度を検出することができ、これによって、確実に振動を抑制することができる。

（適用例４）
本発明に係わるロボットでは、前記第２回動軸の軸方向から見て、前記第１部分と前記第２アームとは重なっておらず、
前記第１部材は、前記第２回動軸の軸方向から見て、前記第２部分に、前記第１部分と重ならないように設けられていることが好ましい。

これにより、第１角速度検出器により、第１アームのうちの振動の大きい部位の角速度を検出することができ、これによって、確実に振動を抑制することができる。

（適用例５）
本発明に係わるロボットでは、前記第２アームに、前記第２回動軸と平行な軸である第３回動軸を回動中心として回動可能に設けられた第３アームと、
前記第３アームに設けられ、第２角速度検出器を有する第２部材と、を備えることが好ましい。

これにより、第１角速度検出器により、第１アームの角速度を検出することができる。また、第３回動軸は、第２回動軸と平行であるので、第２角速度検出器により、第２アームの回動分を含めて第３アームの角速度を検出することができる。そして、これらの検出結果に基づいて、振動を抑制することができる。

また、第２角速度検出器により、第２アームの角速度ではなく、第２アームの回動分を含めて第３アームの角速度を検出するので、より確実に振動を抑制することができる。

また、第２アームにも角速度検出器を設置する場合に比べて、角速度検出器の数を削減することができ、コストを低減することができ、また、構成を簡素化することができる。

（適用例６）
本発明に係わるロボットでは、前記第２角速度検出器の角速度の検出軸は、前記第３回動軸と平行であることが好ましい。

これにより、容易かつ確実に第３アームの角速度を検出することができる。
また、ロボットの姿勢が変化、例えば、第２アームが回動しても、また、第３アームが回動しても第２角速度検出器の角速度の検出軸は、一定である。このため、第２角速度検出器により検出された第３アームの角速度に対して、第２角速度検出器の向きによる補正を行う必要がない。

（適用例７）
本発明に係わるロボットでは、前記第１角速度検出器の角速度の検出軸は、前記第１回動軸と平行であることが好ましい。

これにより、容易かつ確実に第１アームの角速度を検出することができる。
また、ロボットの姿勢が変化しても第１角速度検出器の角速度の検出軸の軸方向は、一定である。このため、第１角速度検出器により検出された第１アームの角速度に対して、第１角速度検出器の向きによる補正を行う必要がない。

（適用例８）
本発明に係わるロボットでは、前記第１部材は、前記第１アームの内部に配置されていることが好ましい。

これにより、第１角速度検出器を保護することができ、信頼性および耐久性を向上させることができる。

（適用例９）
本発明に係わるロボットでは、前記第２回動軸は、前記第１回動軸に直交する軸であるかまたは前記第１回動軸に直交する軸と平行な軸であることが好ましい。
これにより、ロボットの制御を容易に行うことができる。

（適用例１０）
本発明に係わるロボットでは、前記第２回動軸は、前記第１回動軸の軸方向から見て、前記第１回動軸からずれた位置に配置されていることが好ましい。
これにより、ロボットの可動範囲を広くすることができる。

（適用例１１）
本発明に係わるロボットでは、前記第３アームに、前記第３回動軸に直交する軸であるかまたは前記第３回動軸に直交する軸と平行な軸である第４回動軸を回動中心として回動可能に設けられた第４アームと、
前記第４アームに対し、前記第４回動軸に直交する軸であるかまたは前記第４回動軸に直交する軸と平行な軸である第５回動軸を回動中心として回動可能に設けられた第５アームと、
前記第５アームに対し、前記第５回動軸に直交する軸であるかまたは前記第５回動軸に直交する軸と平行な軸である第６回動軸を回動中心として回動可能に設けられた第６アームと、を備えることが好ましい。
これにより、より複雑な動きを容易に行うことができる。

（適用例１２）
本発明に係わるロボットシステムは、ロボットと、
前記ロボットの作動を制御するロボット制御装置と、を備え、
前記ロボットは、基台と、
前記基台に、第１回動軸を回動中心として回動可能に設けられた第１アームと、
前記第１アームに、前記第１回動軸の軸方向とは異なる軸方向である第２回動軸を回動中心として回動可能に設けられた第２アームと、
角速度検出器を有する部材と、を備え、
前記部材の少なくとも一部は、前記第２回動軸の軸方向から見て、前記第１アームの前記第２アームと重なっている部分に設けられていることを特徴とする。

これにより、容易かつ確実に、振動を抑制することができる。
また、部材を前記の位置に配置することにより、角速度検出器は、第１アームの先端側に配置されることとなるので、その角速度検出器により、第１アームのうちの振動の大きい部位の角速度を検出することができ、これにより、確実に振動を抑制することができる。

本発明のロボットの実施形態を正面側から見た斜視図である。 図１に示すロボットを背面側から見た斜視図である。 図１に示すロボットの概略図である。 図１に示すロボットを有するロボットシステムの主要部のブロック図である。 図１に示すロボットの正面図である。 図１に示すロボットの第１アームにおける第１角速度センサー付近を示す図である。 図１に示すロボットの第３アームにおける第２角速度センサー付近を示す図である。 図１に示すロボットの第１角速度センサーユニットの断面図である。 図１に示すロボットの第２アームを駆動する駆動源の減速機付近を示す断面図である。 図１に示すロボットの主要部のブロック図である。 図１に示すロボットの主要部のブロック図である。 図１に示すロボットの主要部のブロック図である。 図１に示すロボットの主要部のブロック図である。 図１に示すロボットの主要部のブロック図である。

以下、本発明のロボットおよびロボットシステムを添付図面に示す好適な実施形態に基づいて詳細に説明する。

図１は、本発明のロボットの実施形態を正面側から見た斜視図である。図２は、図１に示すロボットを背面側から見た斜視図である。図３は、図１に示すロボットの概略図である。図４は、図１に示すロボットを有するロボットシステムの主要部のブロック図である。図５は、図１に示すロボットの正面図である。図６は、図１に示すロボットの第１アームにおける第１角速度センサー付近を示す図である。図７は、図１に示すロボットの第３アームにおける第２角速度センサー付近を示す図である。図８は、図１に示すロボットの第１角速度センサーユニットの断面図である。図９は、図１に示すロボットの第２アームを駆動する駆動源の減速機付近を示す断面図である。図１０〜図１４は、それぞれ、図１に示すロボットの主要部のブロック図である。

なお、以下では、説明の都合上、図１〜図３、図５〜図７中の上側を「上」または「上方」、下側を「下」または「下方」と言う。また、図１〜図３、図５〜図７中の基台側を「基端」、その反対側を「先端」と言う。また、図９中の右側を「右」、左側を「左」と言う。また、図８には、第１角速度センサーユニットに対応させて、括弧書きで、第２角速度センサーユニットの各部の符号を記載し、第２角速度センサーユニットの図示は省略する。

図１〜図４に示すロボットシステム（産業用ロボットシステム）１は、例えば腕時計のような精密機器等を製造する製造工程で用いることができ、ロボット（産業用ロボット）１と、ロボット１の作動を制御するロボット制御装置（制御手段）２０（図４参照）とを有している。ロボット１と、ロボット制御装置２０とは、電気的に接続されている。また、ロボット制御装置２０は、例えば、ＣＰＵ（Central Processing Unit）が内蔵されたパーソナルコンピューター（ＰＣ）等で構成することができる。なお、ロボット制御装置２０については、後で詳述する。

ロボット１は、基台１１と、４本のアーム（リンク）１２、１３、１４、１５と、リスト（リンク）１６と、６つの駆動源４０１、４０２、４０３、４０４、４０５、４０６とを備えている。このロボット１は、基台１１と、アーム１２、１３、１４、１５と、リスト１６とが基端側から先端側に向ってこの順に連結された垂直多関節（６軸）ロボット（ロボット本体）である。垂直多関節ロボットでは、基台１１と、アーム１２〜１５と、リスト１６とを総称して「アーム」と言うこともでき、アーム１２を「第１アーム」、アーム１３を「第２アーム」、アーム１４を「第３アーム」、アーム１５を「第４アーム」、リスト１６を「第５アーム、第６アーム」と分けて言うことができる。なお、本実施形態では、リスト１６は、第５アームと、第６アームとを有している。リスト１６にはエンドエフェクタ等を取り付けることができる。

アーム１２〜１５、リスト１６は、それぞれ、基台１１に対し独立して変位可能に支持されている。このアーム１２〜１５、リスト１６の長さは、それぞれ、特に限定されないが、図示の構成では、第１アーム１２、第２アーム１３、第４アーム１５の長さが、第３アーム１４およびリスト１６よりも長く設定されている。

基台１１と第１アーム１２とは、関節（ジョイント）１７１を介して連結されている。そして、第１アーム１２は、基台１１に対し、鉛直方向と平行な第１回動軸Ｏ１を回動中心とし、その第１回動軸Ｏ１回りに回動可能となっている。第１回動軸Ｏ１は、基台１１の設置面である床１０１の上面の法線と一致している。この第１回動軸Ｏ１回りの回動は、モーター４０１Ｍを有する第１駆動源４０１の駆動によりなされる。また、第１駆動源４０１はモーター４０１Ｍとケーブル（図示せず）によって駆動され、このモーター４０１Ｍは電気的に接続されたモータードライバー３０１を介してロボット制御装置２０により制御される（図４参照）。なお、第１駆動源４０１はモーター４０１Ｍとともに設けた減速機（図示せず）によってモーター４０１Ｍからの駆動力を伝達するように構成してもよく、また、減速機が省略されていてもよいが、本実施形態では、第１駆動源４０１は、減速機を有している。

第１アーム１２と第２アーム１３とは、関節（ジョイント）１７２を介して連結されている。そして、第２アーム１３は、第１アーム１２に対し、水平方向と平行な第２回動軸Ｏ２を軸中心として回動可能となっている。第２回動軸Ｏ２は、第１回動軸Ｏ１に直交する軸と平行である。すなわち、第２回動軸Ｏ２は、第１回動軸Ｏ１の軸方向から見て、第１回動軸Ｏ１からずれた位置に配置されている。この第２回動軸Ｏ２回りの回動は、モーター４０２Ｍを有する第２駆動源４０２の駆動によりなされる。また、第２駆動源４０２はモーター４０２Ｍとケーブル（図示せず）によって駆動され、このモーター４０２Ｍは電気的に接続されたモータードライバー３０２を介してロボット制御装置２０により制御される（図４参照）。なお、第２駆動源４０２はモーター４０２Ｍとともに設けた減速機によってモーター４０２Ｍからの駆動力を伝達するように構成してもよく、また、減速機が省略されていてもよいが、本実施形態では、第２駆動源４０２は、減速機４５（図５、図９参照）を有している。また、第２回動軸Ｏ２は、第１回動軸Ｏ１と直交していてもよい。また、第２回動軸Ｏ２の軸方向は、第１回動軸Ｏ１の軸方向と異なっていれば、前記以外であってもよい。すなわち、第２回動軸Ｏ２は、第１回動軸Ｏ１と平行でなく、かつ、一致していなければよい。

第２アーム１３と第３アーム１４とは、関節（ジョイント）１７３を介して連結されている。そして、第３アーム１４は、第２アーム１３に対して水平方向と平行な回動軸Ｏ３を回動中心とし、その第３回動軸Ｏ３回りに回動可能となっている。第３回動軸Ｏ３は、第２回動軸Ｏ２と平行である。この第３回動軸Ｏ３回りの回動は、第３駆動源４０３の駆動によりなされる。また、第３駆動源４０３は、モーター４０３Ｍとケーブル（図示せず）によって駆動され、このモーター４０３Ｍは電気的に接続されたモータードライバー３０３を介してロボット制御装置２０により制御される（図４参照）。なお、第３駆動源４０３はモーター４０３Ｍとともに設けた減速機（図示せず）によってモーター４０３Ｍからの駆動力を伝達するように構成してもよく、また、減速機が省略されていてもよいが、本実施形態では、第３駆動源４０３は、減速機を有している。

第３アーム１４と第４アーム１５とは、関節（ジョイント）１７４を介して連結されている。そして、第４アーム１５は、第３アーム１４（基台１１）に対し、第３アーム１４の中心軸方向と平行な第４回動軸Ｏ４を回動中心とし、その第４回動軸Ｏ４回りに回動可能となっている。第４回動軸Ｏ４は、第３回動軸Ｏ３と直交している。この第４回動軸Ｏ４回りの回動は、第４駆動源４０４の駆動によりなされる。また、第４駆動源４０４は、モーター４０４Ｍとケーブル（図示せず）によって駆動され、このモーター４０４Ｍは電気的に接続されたモータードライバー３０４を介してロボット制御装置２０により制御される（図４参照）。なお、第４駆動源４０４はモーター４０４Ｍとともに設けた減速機（図示せず）によってモーター４０４Ｍからの駆動力を伝達するように構成してもよく、また、減速機が省略されていてもよいが、本実施形態では、第４駆動源４０４は、減速機を有している。第４回動軸Ｏ４は、第３回動軸Ｏ３に直交する軸と平行であってもよい。

第４アーム１５と第５リスト１６とは、関節（ジョイント）１７５を介して連結されている。そして、リスト１６は、第４アーム１５に対して水平方向（ｙ軸方向）と平行な第５回動軸Ｏ５を回動中心とし、その第５回動軸Ｏ５回りに回動可能となっている。第５回動軸Ｏ５は、第４回動軸Ｏ４と直交している。この第５回動軸Ｏ５回りの回動は、第５駆動源４０５の駆動によりなされる。また、第５駆動源４０５は、モーター４０５Ｍとケーブル（図示せず）によって駆動され、このモーター４０５Ｍは電気的に接続されたモータードライバー３０５を介してロボット制御装置２０により制御される（図４参照）。なお、第５駆動源４０５はモーター４０５Ｍとともに設けた減速機（図示せず）によってモーター４０５Ｍからの駆動力を伝達するように構成してもよく、また、減速機が省略されていてもよいが、本実施形態では、第５駆動源４０５は、減速機を有している。また、リスト１６は、関節（ジョイント）１７６を介して、第５回動軸Ｏ５と垂直な第６回動軸Ｏ６を回動中心とし、その第６回動軸Ｏ６回りにも回動可能となっている。回動軸Ｏ６は、回動軸Ｏ５と直交している。この第６回動軸Ｏ６回りの回動は、第６駆動源４０６駆動によりなされる。また、第６駆動源４０６の駆動は、モーター４０６Mとケーブル（図示せず）によって駆動され、このモーター４０６Ｍは電気的に接続されたモータードライバー３０６を介してロボット制御装置２０により制御される（図４参照）。なお、第６駆動源４０６はモーター４０６Ｍとともに設けた減速機（図示せず）によってモーター４０６Ｍからの駆動力を伝達するように構成してもよく、また、減速機が省略されていてもよいが、本実施形態では、第６駆動源４０６は、減速機を有している。また、第５回動軸Ｏ５は、第４回動軸Ｏ４に直交する軸と平行であってもよく、また、第６回動軸Ｏ６は、第５回動軸Ｏ５に直交する軸と平行であってもよい。

また、図６に示すように、第１アーム１２には、第１角速度センサー（第１角速度検出器）３１、すなわち、第１角速度センサー３１を有する第１角速度センサーユニット（第１部材）７１が設置されている。この第１角速度センサー３１により第１アーム１２の角速度、すなわち、第１角速度センサー３１の角速度の検出軸３１１の回りの角速度を検出する。第１部材とは、第１角速度センサー（第１角速度検出器）３１が設けられているものであり、例えば、基板（第１基板）等が挙げられる。

また、図７に示すように、第３アーム１４には、第２角速度センサー（第２角速度検出器）３２、すなわち、第２角速度センサー３２を有する第２角速度センサーユニット（第１部材）７２が設置されている。この第２角速度センサー３２により第３アーム１４の角速度、すなわち、第２角速度センサー３２の角速度の検出軸３２１の回りの角速度を検出する。第２部材とは、第２角速度センサー（第２角速度検出器）３２が設けられているものであり、例えば、基板（第２基板）等が挙げられる。

なお、第１角速度センサー３１、第２角速度センサー３２としては、それぞれ、特に限定されず、例えば、ジャイロセンサー等を用いることができる。

ここで、このロボット１では、第１アーム１２、第２アーム１３および第３アーム１４の振動を抑制することにより、ロボット１全体の振動を抑制する。但し、第１アーム１２、第２アーム１３および第３アーム１４の振動を抑制するために、第１アーム１２、第２アーム１３および第３アーム１４のすべてに角速度センサーを設置するのではなく、前記のように第１アーム１２、第３アーム１４のみに第１角速度センサー３１、第２角速度センサー３２を設置し、その第１角速度センサー３１、第２角速度センサー３２の検出結果に基づいて駆動源４０１、４０２の作動を制御する。これにより、第１アーム１２、第２アーム１３および第３アーム１４のすべてに角速度センサーを設置する場合に比べ、角速度センサーの数を削減することができ、コストを低減することができ、また、回路構成を簡素化することができる。また、第２角速度センサー３２により、第２アーム１３の角速度ではなく、第２アーム１３の回動分を含めて第３アーム１４の角速度を検出するので、より確実に振動を抑制することができる。また、第３アーム１４よりも基端側の第２アーム１３を回動させる第２駆動源４０２の作動を制御することにより、ロボット１の振動を抑制する効果を高めることができる。

駆動源４０１〜４０６には、それぞれのモーターまたは減速機に、第１位置センサー４１１、第２位置センサー４１２、第３位置センサー４１３、第４位置センサー４１４、第５位置センサー４１５、第６位置センサー４１６が設けられている。これらの位置センサーとしては、それぞれ、特に限定されず、例えば、エンコーダー、ロータリーエンコーダー、レゾルバー、ポテンショメーター等を用いることができる。これらの位置センサー４１１〜４１６により、それぞれ、駆動源４０１〜４０６のモーターまたは減速機の軸部の回転角度を検出する。この駆動源４０１〜４０６のモーターとしては、それぞれ、特に限定されず、例えば、ＡＣサーボモーター、ＤＣサーボモーター等のサーボモーターを用いるのが好ましい。また、前記各ケーブルは、それぞれ、ロボット１を挿通していてもよい。

図４に示すように、ロボット１は、ロボット制御装置２０と電気的に接続されている。すなわち、駆動源４０１〜４０６、位置センサー４１１〜４１６、角速度センサー３１、３２は、それぞれ、ロボット制御装置２０と電気的に接続されている。

そして、ロボット制御装置２０は、アーム１２〜１５、リスト１６をそれぞれ独立して作動させることができる、すなわち、モータードライバー３０１〜３０６を介して、駆動源４０１〜４０６をそれぞれ独立して制御することができる。この場合、ロボット制御装置２０は、位置センサー４１１〜４１６、第１角速度センサー３１、第２角速度センサー３２により検出を行い、その検出結果に基づいて、駆動源４０１〜４０６の駆動、例えば、角速度や回転角度等をそれぞれ制御する。この制御プログラムは、ロボット制御装置２０に内蔵された記録媒体に予め記憶されている。

図１、図２に示すように、基台１１は、ロボット１が垂直多関節ロボットの場合、当該垂直多関節ロボットの最も下方に位置し、設置スペースの床１０１に固定される部分である。この固定方法としては、特に限定されず、例えば、図１、図２に示す本実施形態では、複数本のボルト１１１による固定方法を用いている。なお、基台１１の設置スペースでの固定箇所としては、床の他に、設置スペースの壁や天井とすることもできる。

基台１１は、中空の基台本体（ハウジング）１１２を有している。基台本体１１２は、円筒状をなす円筒状部１１３と、当該円筒状部１１３の外周部に一体的に形成された、箱状をなす箱状部１１４とに分けることができる。そして、このような基台本体１１２には、例えば、モーター４０１Ｍやモータードライバー３０１〜３０６が収納されている。

アーム１２〜１５は、それぞれ、中空のアーム本体（筺体）２と、駆動機構３とを有している。なお、以下では、説明の都合上、第１アーム１２が有するアーム本体２、駆動機構３、後述する封止手段４をそれぞれ「アーム本体２ａ」、「駆動機構３ａ」、「封止手段４ａ」と言い、第２アーム１３が有するアーム本体２、駆動機構３、封止手段４をそれぞれ「アーム本体２ｂ」、「駆動機構３ｂ」、「封止手段４ｂ」と言い、第３アーム１４が有するアーム本体２、駆動機構３、封止手段４をそれぞれ「アーム本体２ｃ」、「駆動機構３ｃ」、「封止手段４ｃ」と言い、第４アーム１５が有するアーム本体２、駆動機構３、封止手段４をそれぞれ「アーム本体２ｄ」、「駆動機構３ｄ」、「封止手段４ｄ」と言うことがある。

また、関節１７１〜１７６は、それぞれ、回動支持機構（図示せず）を有している。この回動支持機構は、互いに連結された２本のアームのうちの一方を他方に対し回動可能に支持する機構、互いに連結された基台１１と第１アーム１２のうちの一方を他方に対し回動可能に支持する機構、互いに連結された第４アーム１５と第５リスト１６のうちの一方を他方に対し回動可能に支持する機構である。互いに連結された第４アーム１５とリスト１６とを一例とした場合、回動支持機構は、リスト１６を第４アーム１５に対し回動させることができる。また、各回動支持機構は、それぞれ、対応するモーターの回転速度を所定の減速比で減速して、その駆動力を対応するアーム、リスト１６のリスト本体１６１、支持リング１６２に伝達する減速機（図示せず）を有している。なお、前述したように、本実施形態では、この減速機とモーターとを含めて駆動源とする。

第１アーム１２は、基台１１の上端部（先端部）に水平方向に対し傾斜した姿勢で連結されている。この第１アーム１２では、駆動機構３ａがモーター４０２Ｍを有しており、アーム本体２ａ内に収納している。また、アーム本体２ａ内は、封止手段（蓋体）４ａにより気密封止されている。アーム本体２ａは、先端側の１対の舌片部（第２部分）２４１ａ、２４１ｂと、基端側の根元部（第１部分）２５１とを有している。根元部（第１部分）２５１、舌片部２４１ａ、２４１ｂの位置関係は、固定されている。また、舌片部２４１ａと舌片部２４１ｂとは、離間し、互いに対向している。また、舌片部２４１ａ、２４１ｂは、根元部２５１に対して傾斜しており、これにより、第１アーム１２は、水平方向に対し傾斜する。そして、舌片部２４１ａと舌片部２４１ｂとの間に、第２アーム１３の基端部が配置されている。なお、各封止手段４ａは、各舌片部２４１ａ、２４１ｂの構成要素であり、各舌片部２４１ａ、２４１ｂ内は、各封止手段４ａにより気密封止されている。また、前記アーム本体２ａは、第２アーム１３よりも基台１１側に位置する第１部分と、基台１１よりも第２アーム１３側に位置する第２部分とに大別することができる。

また、根元部２５１は、基台１１と接している。具体的には、根元部２５１は、基台１１の上端部（先端部）に回動可能に連結されている。また、各舌片部２４１ａ、２４１ｂは、第２アーム１３の基端部と接している。具体的には、第２アーム１３の基端部は、各舌片部２４１ａ、２４１ｂに回動可能に連結されている。すなわち、各舌片部２４１ａ、２４１ｂは、第２アーム１３の基端部に回動可能に連結されている。

また、図６に示すように、第２回動軸Ｏ２の軸方向から見て、根元部２５１と第２アーム１３とは重なっていないが、舌片部２４１ａの一部および舌片部２４１ｂの一部と第２アーム１３とは重なっている。

そして、図６に示すように、第１アーム１２の内部には、第１角速度センサーユニット７１が設置されている。本実施形態では、第１角速度センサーユニット７１は、第１アーム１２の舌片部２４１ａの内部に設置されている。これにより、第１アーム１２のうちの振動の大きい部位の角速度を検出することができ、これによって、より確実に振動を抑制することができる。

また、第１角速度センサーユニット７１の少なくとも一部は、第２回動軸Ｏ２の軸方向から見て、第１アーム１２の第２アーム１３と重なっている部位に設置されている。本実施形態では、第２回動軸Ｏ２の軸方向から見て、第１角速度センサーユニット７１の全体が、第１アーム１２の第２アーム１３と重なっている部位に設置され、かつ、第１角速度センサーユニット７１は、全く、根元部２５１と重なっていない。これにより、第１アーム１２のうちの振動の大きい部位の角速度を検出することができ、これによって、より確実に振動を抑制することができる。

この場合、図示の構成のように、第１角速度センサーユニット７１は、第１アーム１２の基台１１よりも第２アーム１３側に位置する第２部分、換言すれば、第１アーム１２の先端部、すなわち、舌片部２４１ａの先端部に配置されていることが好ましい。第１アーム１２に生じる振動は、第１アーム１２の先端部において最大となるので、これにより、第１アーム１２のうちの振動の大きい部位の角速度を検出することができこれによって、より確実に振動を抑制することができる。

また、第１アーム１２の舌片部２４１ｂの内部には、ロボット１の各モーター４０１Ｍ〜４０６Ｍに電力を供給するケーブル８５が収納されており、前述したように、第１角速度センサーユニット７１は、その舌片部２４１ｂと反対側の舌片部２４１ａ内に設置されている。これにより、第１角速度センサー３１がケーブル８５から発せられるノイズの影響を受けることを防止することができ、また、第１角速度センサーユニット７１の後述する回路部７１３、配線、第１角速度センサー３１がケーブル８５によりショートしてしまうことを防止することができる。

ここで、駆動機構３および減速機について、代表的に、第１アーム１２のアーム本体２ａ内に設けられ、第２アーム１３を回動させる駆動機構３および減速機を説明する。

図５および図６に示すように、駆動機構３は、モーター４０２Ｍの軸部に連結された第１プーリー９１と、第１プーリー９１に離間して配置された第２プーリー９２と、第１プーリー９１と第２プーリー９２とに掛け渡されたベルト（タイミングベルト）９３とを有している。そして、第２プーリー９２と第２アーム１３の軸部とが、減速機４５により連結されている。

なお、ロボット１のアーム１２〜１５、リスト１６の振動の主な原因としては、例えば、減速機４５のねじれや撓み、ベルト９３の伸縮、アーム１２〜１５、リスト１６の撓み等が挙げられる。

減速機４５としては、特に限定されず、例えば、複数の歯車で構成されたものや、ハーモニックドライブ（「ハーモニックドライブ」は登録商標）と呼ばれるもの等が挙げられる。

次に、減速機４５について説明する。なお、以下に説明する減速機の構成は、あくまでも１例である。

図９に示すように、第１アーム１２の舌片部２４１ａと舌片部２４１ｂとの間に、第２アーム１３の根元部２５２が配置されている。

そして、舌片部２４１ｂは、軸受１８３により、根元部２５２に回転可能に支持されている。また、プーリー９２の中心部には、回転軸９２１が固定されている。この回転軸９２１は、軸受１８１、１８２により、舌片部２４１ａ、根元部２５２に回転可能に支持されている。

減速機４５は、ユニットタイプの減速機であり、プーリー９２の回転を減速して第２アーム１３の根元部２５２に伝達する機能を有する減速部４５１と、第１アーム１２の舌片部２４１ａと根元部２５２との一方に対して他方を回動可能に支持する機能を有する軸受４５６とを備えている。

軸受４５６は、クロスローラーベアリングで構成されており、外輪４５７と、内輪４５８と、複数のローラー４５９とを有している。

舌片部２４１ａは、前記軸受４５６により、根元部２５２に回転可能に支持されている。すなわち、軸受４５６の内輪４５８は、舌片部２４１ａに固定され、外輪４５７は、根元部２５２に固定されている。

減速部４５１は、ハーモニックドライブ（「ハーモニックドライブ」は登録商標）または波動歯車装置等と呼ばれる減速機で構成されており、外周側に配置された歯車４５２と、内周側に配置された歯車４５５とを有している。

歯車４５２は、内形が円形状で、内周に複数の歯が形成された筒状部４５３と、取付部４５４とを有している。また、歯車４５５は、その外形が楕円形状をなし、その外周に、歯車４５２の歯数よりも少ない歯数の複数の歯が形成されている。そして、歯車４５５が歯車４５２の内周側に配置され、歯車４５２の歯と歯車４５５の歯とが噛合している。
歯車４５５は、プーリー９２の中心部に固定された回転軸９２１に固定されている。

また、歯車４５２は、その取付部４５４において、軸受４５６の外輪４５７に固定されている。

このように、減速機４５は、舌片部２４１ａと、根元部２５２とに跨って設けられている。

なお、前述した図９に示す減速機４５は、ユニットタイプの減速機であるが、これに限定されず、例えば、プーリー９２の回転を減速して第２アーム１３の根元部２５２に伝達する機能を有する装置と、第１アーム１２の舌片部２４１ａと根元部２５２との一方に対して他方を回動可能に支持する機能を有する装置とが別体となったコンポーネントタイプの減速機であってもよい。

図１〜図３に示すように、第２アーム１３は、第１アーム１２の先端部に連結されている。この第２アーム１３では、駆動機構３ｂがモーター４０３Ｍを有しており、アーム本体２ｂ内に収納している。また、アーム本体２ｂ内は、封止手段４ｂにより気密封止されている。アーム本体２ｂは、先端側の１対の舌片部２４２ａ、２４２ｂと、基端側の根元部２５２とを有している。舌片部２４２ａと舌片部２４２ｂとは、離間し、互いに対向している。そして、舌片部２４２ａと舌片部２４２ｂとの間に、第３アーム１４の基端部が配置されている。なお、各封止手段４ｂは、各舌片部２４２ａ、２４２ｂの構成要素であり、各舌片部２４２ａ、２４２ｂ内は、各封止手段４ｂにより気密封止されている。

第３アーム１４は、第２アーム１３の先端部に連結されている。この第３アーム１４では、駆動機構３ｃがモーター４０４Ｍを有しており、アーム本体２ｃ内に収納している。また、アーム本体２ｃ内は、封止手段４ｃにより気密封止されている。なお、アーム本体２ｃは、前記アーム本体２ａの根元部２５１、前記アーム本体２ｂの根元部２５２に相当する部材で構成されている。

また、第３アーム１４における第２角速度センサー３２の設置位置は、特に限定されないが、本実施形態では、図７に示すように、第２角速度センサー３２、すなわち、第２角速度センサーユニット７２は、第３アーム１４のアーム本体２ｃの内部のケーブル８５と反対側の端部に設置されている。これにより、第２角速度センサー３２がケーブル８５から発せられるノイズの影響を受けることを防止することができ、また、第２角速度センサーユニット７２の回路部７２３、配線、第２角速度センサー３２がケーブル８５によりショートしてしまうことを防止することができる。

第４アーム１５は、第３アーム１４の先端部に、その中心軸方向と平行に連結されている。このアーム１５では、駆動機構３ｄがモーター４０５Ｍ、４０６Ｍを有しており、アーム本体２ｄ内に収納している。また、アーム本体２ｄ内は、封止手段４ｄにより気密封止されている。アーム本体２ｄは、先端側の１対の舌片部２４４ａ、２４４ｂと、基端側の根元部２５４とを有している。舌片部２４４ａと舌片部２４４ｂとは、離間し、互いに対向している。そして、舌片部２４４ａと舌片部２４４ｂとの間に、リスト１６の支持リング１６２が配置されている。なお、各封止手段４ｄは、各舌片部２４４ａ、２４４ｂの構成要素であり、各舌片部２４４ａ、２４４ｂ内は、各封止手段４ｄにより気密封止されている。

第４アーム１５の先端部（基台１１と反対側の端部）には、リスト１６が連結されている。このリスト１６には、その先端部（第４アーム１５と反対側の端部）に、機能部（エンドエフェクタ）として、例えば、腕時計等のような精密機器を把持するマニピュレーター（図示せず）が着脱可能に装着される。なお、マニピュレーターとしては、特に限定されず、例えば、複数本の指部（フィンガー）を有する構成のものが挙げられる。そして、このロボット１は、マニピュレーターで精密機器を把持したまま、アーム１２〜１５やリスト１６等の動作を制御することにより、当該精密機器を搬送することができる。

リスト１６は、円筒状をなすリスト本体（第６アーム）１６１と、リスト本体１６１と別体で構成され、当該リスト本体１６１の基端部に設けられ、リング状をなす支持リング（第５アーム）１６２とを有している。

リスト本体１６１の先端面１６３は、平坦な面となっており、マニピュレーターが装着される装着面となる。また、リスト本体１６１は、関節１７６を介して、第４アーム１５の駆動機構３ｄに連結されており、当該駆動機構３ｄのモーター４０６Ｍの駆動により、回動軸Ｏ６回りに回動する。

支持リング１６２は、関節１７５を介して、第４アーム１５の駆動機構３ｄに連結されており、当該駆動機構３ｄのモーター４０５Ｍの駆動により、リスト本体１６１ごと回動軸Ｏ５回りに回動する。

アーム本体２の構成材料としては、特に限定されず、例えば、各種金属材料を用いることができ、これらの中でも、特にアルミニウムまたはアルミニウム合金が好ましい。アーム本体２が金型を用いて成形される鋳物である場合、当該アーム本体２の構成材料にアルミニウムまたはアルミニウム合金を用いることにより、金型成形を容易に行なうことができる。

また、基台１１の基台本体１１２、リスト１６のリスト本体１６１、支持リング１６２の構成材料としては、それぞれ、特に限定されず、例えば、前記アーム本体２の構成材料と同様のもの等が挙げられる。なお、リスト１６のリスト本体１６１の構成材料は、ステンレス鋼を用いるのが好ましい。

また、封止手段４の構成材料としては、特に限定されず、例えば、各種樹脂材料、各種金属材料を用いることができる。なお、封止手段４の構成材料として、樹脂材料を用いることにより、軽量化を図ることができる。

次に、第１角速度センサーユニット７１、第２角速度センサーユニット７２について説明する。

図８に示すように、第１角速度センサーユニット７１は、第１ハウジング７１１と、第１ハウジング７１１内に設けられ、配線を有する回路基板７１２、回路基板７１２上に電気的に接続された第１角速度センサー３１および回路部７１３とを有している。本実施形態では、第１ハウジング７１１は、封止材で構成され、その封止材により、第１角速度センサー３１、回路部７１３および回路基板７１２全体が封止されている。

同様に、第２角速度センサーユニット７２は、第２ハウジング７２１と、第２ハウジング７２１内に設けられ、配線を有する回路基板７２２、回路基板７２２上に電気的に接続された第２角速度センサー３２および回路部７２３とを有している。本実施形態では、第２ハウジング７２１は、封止材で構成され、その封止材により、第２角速度センサー３２、回路部７２３および回路基板７２２全体が封止されている。

このように、第１角速度センサー３１および回路部７１３、第２角速度センサー３２および回路部７２３をパッケージ化することで、構成を簡素化することができる。

なお、第１角速度センサーユニット７１と第２角速度センサーユニット７２とは同様であるので、以下、代表的に、第１角速度センサーユニット７１について説明する。

まず、回路部７１３は、第１角速度センサー３１から出力される信号をＡＤ変換、すなわち、アナログ信号をデジタル信号に変換するＡＤ変換部と、前記変換された信号をロボット制御装置２０に送信する送信部とを有している。
また、第１ハウジング７１１の外形は、立方体である。

また、図６に示すように、第１角速度センサー３１は、角速度の検出軸（以下、単に「検出軸」とも言う）３１１を有しており（図６参照）、その検出軸３１１の回りの角速度を検出するように構成されている。また、第１角速度センサー３１の検出軸３１１は、第１ハウジング７１１の直方体の一番大きな面の法線と一致している。これにより、容易かつ確実に、第１角速度センサー３１の検出軸３１１および第２角速度センサー３２の検出軸３２１の方向を認識することができ、容易に、第１角速度センサー３１および第２角速度センサー３２を適正な姿勢にすることができる。そして、第１角速度センサー３１、すなわち、第１角速度センサーユニット７１は、第１角速度センサー３１の検出軸３１１が第１回動軸Ｏ１と平行になるように設置されている。また、図７に示すように、第２角速度センサー３２、すなわち、第２角速度センサーユニット７２は、第２角速度センサー３２の検出軸３２１が第３回動軸Ｏ３と平行になるように設置されている。

また、図６および図８に示すように、第１ハウジング７１１は、その４つの角部に、第１アーム１２に取り付けられる取付部７１１１を有している。各取付部７１１１には、それぞれ、雄ネジ（固定部材）８１が挿入される孔７１１２が形成されている。

第１角速度センサーユニット７１を第１アーム１２に取り付ける（設置する）際は、４つの雄ネジ８１をそれぞれ第１ハウジング７１１の孔７１１２に挿入し、第１アーム１２のアーム側取付部１２１の４つの雌ネジに螺合する。これにより、各雄ネジ８１により、第１ハウジング７１１の各取付部７１１１がそれぞれアーム側取付部１２１に固定される。すなわち、アーム側取付部１２１に、第１角速度センサーユニット７１が取り付けられる。

また、図７および図８に示すように、第２ハウジング７２１は、その４つの角部に、第３アーム１４に取り付けられる取付部７２１１を有している。各取付部７２１１には、それぞれ、雄ネジ（固定部材）８１が挿入される孔７２１２が形成されている。

また、図７に示すように、第３アーム１４は、アーム本体２ｃと一体的に形成され、第２角速度センサーユニット７２（第２ハウジング７２１）が取り付けられるアーム側取付部１４１を有している。アーム側取付部１４１は、第２ハウジング７２１に対応した形状をなしている。すなわち、アーム側取付部１４１は、板状をなし、平面視での形状は、四角形、本実施形態では、長方形をなしている。また、アーム側取付部１４１の各角部には、それぞれ、雄ネジ８１が螺合する雌ネジが形成されている。

なお、前記アーム本体２ｃと一体的に形成されたアーム側取付部１４１における「一体的」とは、別々に部材を形成し、それらを接合するのではなく、例えば、ダイキャスト等により、アーム本体２ｃとアーム側取付部１４１とを同時に形成する場合を言う。

第２角速度センサーユニット７２を第３アーム１４に取り付ける際は、４つの雄ネジ８１をそれぞれ第２ハウジング７２１の孔７２１２に挿入し、第３アーム１４のアーム側取付部１４１の先端部の雌ネジに螺合する。これにより、各雄ネジ８１により、第２ハウジング７２１の４つの取付部７２１１がそれぞれ第２アーム１４のアーム側取付部１４１に固定される。すなわち、第２アーム１４のアーム側取付部１４１に、第２角速度センサーユニット７２が取り付けられる。この場合、アーム側取付部１４１と第２角速度センサーユニット７２との間には、何も介在しておらず、すなわち、第２角速度センサーユニット７２は、アーム側取付部１４１に直接取り付けられる。これにより、第２角速度センサーユニット７２を確実に第３アーム１４に取り付けることができ、また、第２角速度センサーユニット７２は、確実に、第３アーム１４と一体的に回動することができる。

なお、第２角速度センサーユニット７２がアーム側取付部１４１に直接取り付けられるにおける「直接」とは、第２角速度センサーユニット７２を別の基板等の中間体に取り付けて、その中間体を、アーム側取付部１４１に取り付けでいるのではないことを言う。すなわち、アーム側取付部１４１と第２角速度センサーユニット７２との間に、接着剤等を除き、何も介在していないことを言う。

また、雄ネジ８１は、導電性を有しており、例えば、各種の金属材料で形成されている。雄ネジ８１は、第２ハウジング７２１の孔７２１２に挿入し、アーム側取付部１４１の雌ネジに螺合した際、回路部７２３のアース用の端子に電気的に接続された回路基板７２２の配線に電気的に接続され、また、雄ネジ８１の先端部は、アーム側取付部１４１に電気的に接続される。これにより、回路部７２３のアース用の端子は、配線および雄ネジ８１を介して、第２アーム１４のアーム本体２ｃに電気的に接続され、アースされる。これにより、アースに要する部品点数を削減することができ、構成を簡素化することができる。

次に、図４、図１０〜図１４を参照し、ロボット制御装置２０の構成について説明する。

ロボット制御装置２０は、第１角速度センサー３１から出力される第１信号と、第２角速度センサー３２から出力される第２信号と、位置センサー４１１〜４１６から出力される各信号とをそれぞれ受信する受信部と、この受信部により受信された第１信号および第２信号に基づいて、第１アーム１２の角速度の振動成分および第３アーム１４の角速度の振動成分を求める演算部と、この演算部により求められた第１アーム１２の角速度の振動成分および第３アーム１４の角速度の振動成分に基づいて、ロボット１の作動を制御する制御部とを有している。

具体的には、図４、図１０〜図１４に示すように、ロボット制御装置２０は、前記受信部と、第１駆動源４０１の作動を制御する第１駆動源制御部２０１と、第２駆動源４０２の作動を制御する第２駆動源制御部２０２と、第３駆動源４０３の作動を制御する第３駆動源制御部２０３と、第４駆動源４０４の作動を制御する第４駆動源制御部２０４と、第５駆動源４０５の作動を制御する第５駆動源制御部２０５と、第６駆動源４０６の作動を制御する第６駆動源制御部２０６とを有している。

なお、前記演算部は、第１駆動源制御部２０１の後述する角速度算出部５６１、減算器５７１、第２駆動源制御部２０２の後述する角速度算出部５６２、加減算器６２２、第３駆動源制御部２０３の後述する角速度算出部５６３により構成される。

図１０に示すように、第１駆動源制御部２０１は、減算器５１１と、位置制御部５２１と、減算器５３１と、角速度制御部５４１と、回転角度算出部５５１と、角速度算出部５６１と、減算器５７１と、変換部５８１と、補正値算出部５９１と、加算器６０１とを有している。

図１１に示すように、第２駆動源制御部２０２は、減算器５１２と、位置制御部５２２と、減算器５３２と、角速度制御部５４２と、回転角度算出部５５２と、角速度算出部５６２と、加減算器６２２と、変換部５８２と、補正値算出部５９２と、加算器６０２とを有している。

図１１に示すように、第３駆動源制御部２０３は、減算器５１３と、位置制御部５２３と、減算器５３３と、角速度制御部５４３と、回転角度算出部５５３と、角速度算出部５６３とを有している。

図１２に示すように、第４駆動源制御部２０４は、減算器５１４と、位置制御部５２４と、減算器５３４と、角速度制御部５４４と、回転角度算出部５５４と、角速度算出部５６４とを有している。

図１３に示すように、第５駆動源制御部２０５は、減算器５１５と、位置制御部５２５と、減算器５３５と、角速度制御部５４５と、回転角度算出部５５５と、角速度算出部５６５とを有している。

図１４に示すように、第６駆動源制御部２０６は、減算器５１６と、位置制御部５２６と、減算器５３６と、角速度制御部５４６と、回転角度算出部５５６と、角速度算出部５６６とを有している。

ここで、ロボット制御装置２０は、ロボット１が行う処理の内容に基づいてリスト１６の目標位置を演算し、その目標位置にリスト１６を移動させるための軌道を生成する。そして、ロボット制御装置２０は、その生成した軌道に沿ってリスト１６が移動するように、各駆動源４０１〜４０６の回転角度を所定の制御周期ごとに測定し、この測定結果に基づいて演算した値をそれぞれ各駆動源４０１〜４０６の位置指令Ｐｃとして駆動源制御部２０１〜２０６に出力する（図１０〜図１４参照）。なお、前記および以下では、「値が入力、出力」等と表記しているが、これは、「その値に対応する信号が入力、出力」の意味である。

図１０に示すように、第１駆動源制御部２０１には、第１駆動源４０１の位置指令Ｐｃの他、第１位置センサー４１１、第１角速度センサー３１からそれぞれ検出信号が入力される。第１駆動源制御部２０１は、第１位置センサー４１１の検出信号から算出される第１駆動源の回転角度（位置フィードバック値Ｐｆｂ）が位置指令Ｐｃになり、かつ、後述する角速度フィードバック値ωｆｂが後述する角速度指令ωｃになるように、各検出信号を用いたフィードバック制御によって第１駆動源４０１を駆動する。

すなわち、第１駆動源制御部２０１の減算器５１１には、位置指令Ｐｃが入力され、また、回転角度算出部５５１から後述する位置フィードバック値Ｐｆｂが入力される。回転角度算出部５５１では、第１位置センサー４１１から入力されるパルス数がカウントされるとともに、そのカウント値に応じた第１駆動源４０１の回転角度が位置フィードバック値Ｐｆｂとして減算器５１１に出力される。減算器５１１は、これら位置指令Ｐｃと位置フィードバック値Ｐｆｂとの偏差（第１駆動源４０１の回転角度の目標値から位置フィードバック値Ｐｆｂを減算した値）を位置制御部５２１に出力する。

位置制御部５２１は、減算器５１１から入力された偏差と、予め定められた係数である比例ゲイン等を用いた所定の演算処理を行うことで、その偏差に応じた第１駆動源４０１の角速度の目標値を演算する。位置制御部５２１は、その第１駆動源４０１の角速度の目標値（指令値）を示す信号を角速度指令ωｃとして減算器５３１に出力する。なお、ここでは、本実施形態では、フィードバック制御として、比例制御（Ｐ制御）がなされるが、これに限定されるものではない。

減算器５３１には、角速度指令ωｃが入力され、また、後述する角速度フィードバック値ωｆｂが入力される。減算器５３１は、これら角速度指令ωｃと角速度フィードバック値ωｆｂとの偏差（第１駆動源４０１の角速度の目標値から角速度フィードバック値ωｆｂを減算した値）を角速度制御部５４１に出力する。

角速度制御部５４１は、減算器５３１から入力された偏差と、予め定められた係数である比例ゲイン、積分ゲイン等を用い、積分を含む所定の演算処理を行うことで、その偏差に応じた第１駆動源４０１の駆動信号（駆動電流）を生成し、モータードライバー３０１を介してモーター４０１Ｍに供給する。なお、ここでは、本実施形態では、フィードバック制御として、ＰＩ制御がなされるが、これに限定されるものではない。

このようにして、位置フィードバック値Ｐｆｂが位置指令Ｐｃと可及的に等しくなり、かつ、角速度フィードバック値ωｆｂが角速度指令ωｃと可及的に等しくなるように、フィードバック制御がなされ、第１駆動源４０１の駆動電流が制御される。

次に、第１駆動源制御部２０１における角速度フィードバック値ωｆｂについて説明する。

角速度算出部５６１では、第１位置センサー４１１から入力されるパルス信号の周波数に基づいて、第１駆動源４０１の角速度ωｍ１が算出され、その角速度ωｍ１は、加算器６０１に出力される。

また、角速度算出部５６１では、第１位置センサー４１１から入力されるパルス信号の周波数に基づいて、第１アーム１２の第１回動軸Ｏ１の回りの角速度ωＡ１ｍが算出され、その角速度ωＡ１ｍは、減算器５７１に出力される。なお、角速度ωＡ１ｍは、角速度ωｍ１を、第１駆動源４０１のモーター４０１Ｍと第１アーム１２との間、すなわち、関節１７１における減速比で除算した値である。

また、第１角速度センサー３１により、第１アーム１２の第１回動軸Ｏ１の回りの角速度が検出される。そして、その第１角速度センサー３１の検出信号、すなわち、第１角速度センサー３１により検出された第１アーム１２の第１回動軸Ｏ１の回りの角速度ωＡ１は、減算器５７１に出力される。

減算器５７１には、角速度ωＡ１および角速度ωＡ１ｍが入力され、減算器５７１は、この角速度ωＡ１から角速度ωＡ１ｍを減算した値ωＡ１ｓ（＝ωＡ１−ωＡ１ｍ）を変換部５８１に出力する。この値ωＡ１ｓは、第１アーム１２の第１回動軸Ｏ１の回りの角速度の振動成分（振動角速度）に相当する。以下、ωＡ１ｓを振動角速度と言う。本実施形態では、この振動角速度ωＡ１ｓ（詳細には、振動角速度ωＡ１ｓに基づいて生成した値であるモーター４０１Ｍにおける角速度ωｍ１ｓ）が後述するゲインＫａ倍されて駆動源４０１の入力側に戻るフィードバック制御を行う。具体的には、振動角速度ωＡ１ｓが可及的に０になるように、駆動源４０１に対してフィードバック制御がなされる。これにより、ロボット１の振動を抑制することができる。なお、このフィードバック制御では、駆動源４０１の角速度が制御される。

変換部５８１は、振動角速度ωＡ１ｓを第１駆動源４０１における角速度ωｍ１ｓに変換し、その角速度ωｍ１ｓを補正値算出部５９１に出力する。この変換は、振動角速度ωＡ１ｓに、第１駆動源４０１のモーター４０１Ｍと第１アーム１２との間、すなわち、関節１７１における減速比を乗算することで得ることができる。

補正値算出部５９１は、角速度ωｍ１ｓに予め定められた係数であるゲイン（フィードバックゲイン）Ｋａを乗算し、補正値Ｋａ・ωｍ１ｓを求め、その補正値Ｋａ・ωｍ１ｓを加算器６０１に出力する。

加算器６０１には、角速度ωｍ１が入力され、また、補正値Ｋａ・ωｍ１ｓが入力される。加算器６０１は、角速度ωｍ１と補正値Ｋａ・ωｍ１ｓとの加算値を角速度フィードバック値ωｆｂとして減算器５３１に出力する。なお、以降の動作は、前述した通りである。

図１１に示すように、第２駆動源制御部２０２には、第２駆動源４０２の位置指令Ｐｃの他、第２位置センサー４１２、第２角速度センサー３２からそれぞれ検出信号が入力される。また、第２駆動源制御部２０２には、第３駆動源制御部２０３からアーム１５の第３回動軸Ｏ３の回りの角速度ωＡ３ｍが入力される。第２駆動源制御部２０２は、第２位置センサー４１２の検出信号から算出される第２駆動源４０２の回転角度（位置フィードバック値Ｐｆｂ）が位置指令Ｐｃになり、かつ、後述する角速度フィードバック値ωｆｂが後述する角速度指令ωｃになるように、各検出信号を用いたフィードバック制御によって第２駆動源４０２を駆動する。

すなわち、第２駆動源制御部２０２の減算器５１２には、位置指令Ｐｃが入力され、また、回転角度算出部５５２から後述する位置フィードバック値Ｐｆｂが入力される。回転角度算出部５５２では、第２位置センサー４１２から入力されるパルス数がカウントされるとともに、そのカウント値に応じた第２駆動源４０２の回転角度が位置フィードバック値Ｐｆｂとして減算器５１２に出力される。減算器５１２は、これら位置指令Ｐｃと位置フィードバック値Ｐｆｂとの偏差（第２駆動源４０２の回転角度の目標値から位置フィードバック値Ｐｆｂを減算した値）を位置制御部５２２に出力する。

位置制御部５２２は、減算器５１２から入力された偏差と、予め定められた係数である比例ゲイン等を用いた所定の演算処理を行うことで、その偏差に応じた第２駆動源４０２の角速度の目標値を演算する。位置制御部５２２は、その第２駆動源４０２の角速度の目標値（指令値）を示す信号を角速度指令ωｃとして減算器５３２に出力する。なお、ここでは、本実施形態では、フィードバック制御として、比例制御（Ｐ制御）がなされるが、これに限定されるものではない。

減算器５３２には、角速度指令ωｃが入力され、また、後述する角速度フィードバック値ωｆｂが入力される。減算器５３２は、これら角速度指令ωｃと角速度フィードバック値ωｆｂとの偏差（第２駆動源４０２の角速度の目標値から角速度フィードバック値ωｆｂを減算した値）を角速度制御部５４２に出力する。

角速度制御部５４２は、減算器５３２から入力された偏差と、予め定められた係数である比例ゲイン、積分ゲイン等を用い、積分を含む所定の演算処理を行うことで、その偏差に応じた第２駆動源４０２の駆動信号（駆動電流）を生成し、モータードライバー３０２を介してモーター４０２Ｍに供給する。なお、ここでは、本実施形態では、フィードバック制御として、ＰＩ制御がなされるが、これに限定されるものではない。

このようにして、位置フィードバック値Ｐｆｂが位置指令Ｐｃと可及的に等しくなり、かつ、角速度フィードバック値ωｆｂが角速度指令ωｃと可及的に等しくなるように、フィードバック制御がなされ、第２駆動源４０２の駆動電流が制御される。なお、第２回動軸Ｏ２は、第１回動軸Ｏ１に対して直交しているので、第１アーム１２の動作や振動の影響を受けず、第１駆動源４０１に対して独立して第２駆動源４０２の作動を制御することができる。

次に、第２駆動源制御部２０２における角速度フィードバック値ωｆｂについて説明する。

角速度算出部５６２では、第２位置センサー４１２から入力されるパルス信号の周波数に基づいて、第２駆動源４０２の角速度ωｍ２が算出され、その角速度ωｍ２は、加算器６０２に出力される。

また、角速度算出部５６２では、第２位置センサー４１２から入力されるパルス信号の周波数に基づいて、第２アーム１３の第２回動軸Ｏ２の回りの角速度ωＡ２ｍが算出され、その角速度ωＡ２ｍは、加減算器６２２に出力される。なお、角速度ωＡ２ｍは、角速度ωｍ２を、第２駆動源４０２のモーター４０２Ｍと第２アーム１３との間、すなわち、関節１７２における減速比で除算した値である。

また、第３駆動源制御部２０３の角速度算出部５６３では、第３位置センサー４１３から入力されるパルス信号の周波数に基づいて、第３アーム１４の第３回動軸Ｏ３の回りの角速度ωＡ３ｍが算出され、その角速度ωＡ３ｍは、加減算器６２２に出力される。なお、角速度ωＡ３ｍは、角速度ωｍ３を、第３駆動源４０３のモーター４０３Ｍと第３アーム１４との間、すなわち、関節１７３における減速比で除算した値である。

また、第２角速度センサー３２により、第３アーム１４の第２回動軸Ｏ２の回りの角速度が検出される。そして、その第２角速度センサー３２の検出信号、すなわち、第２角速度センサー３２により検出された第３アーム１４の第２回動軸Ｏ２の回りの角速度ωＡ３は、加減算器６２２に出力される。なお、第２回動軸Ｏ２、第３回動軸Ｏ３は、第１回動軸Ｏ１に対して直交しているので、第１アーム１２の動作や振動の影響を受けずに、容易かつ確実に、第３アーム１４の第２回動軸Ｏ２の回りの角速度を求めることができる。

加減算器６２２には、角速度ωＡ３、角速度ωＡ２ｍおよび角速度ωＡ３ｍが入力され、加減算器６２２は、角速度ωＡ３から角速度ωＡ２ｍおよび角速度ωＡ３ｍを減算した値ωＡ２ｓ（＝ωＡ３−ωＡ２ｍ−ωＡ３ｍ）を変換部５８２に出力する。この値ωＡ２ｓは、第２アーム１３と第３アーム１４の第２回動軸Ｏ２の回りの合計の角速度の振動成分（振動角速度）に相当する。以下、ωＡ２ｓを振動角速度と言う。本実施形態では、この振動角速度ωＡ２ｓ（詳細には、振動角速度ωＡ２ｓに基づいて生成した値であるモーター４０２Ｍにおける角速度ωｍ２ｓ）が後述するゲインＫａ倍されて第２駆動源４０２の入力側に戻るフィードバック制御を行う。具体的には、振動角速度ωＡ２ｓが可及的に０になるように、第２駆動源４０２に対してフィードバック制御がなされる。これにより、ロボット１の振動を抑制することができる。なお、このフィードバック制御では、第２駆動源４０２の角速度が制御される。

変換部５８２は、振動角速度ωＡ２ｓを第２駆動源４０２における角速度ωｍ２ｓに変換し、その角速度ωｍ２ｓを補正値算出部５９２に出力する。この変換は、振動角速度ωＡ２ｓに、第２駆動源４０２のモーター４０２Ｍと第２アーム１３との間、すなわち、関節１７２における減速比を乗算することで得ることができる。

補正値算出部５９２は、角速度ωｍ２ｓに予め定められた係数であるゲイン（フィードバックゲイン）Ｋａを乗算し、補正値Ｋａ・ωｍ２ｓを求め、その補正値Ｋａ・ωｍ２ｓを加算器６０２に出力する。なお、この第２駆動源制御部２０２におけるゲインＫａと、第１駆動源制御部２０１におけるゲインＫａとは、同一でもよく、また、異なっていてもよい。

加算器６０２には、角速度ωｍ２が入力され、また、補正値Ｋａ・ωｍ２ｓが入力される。加算器６０２は、角速度ωｍ２と補正値Ｋａ・ωｍ２ｓとの加算値を角速度フィードバック値ωｆｂとして減算器５３２に出力する。なお、以降の動作は、前述した通りである。

図１１に示すように、第３駆動源制御部２０３には、第３駆動源４０３の位置指令Ｐｃの他、第３位置センサー４１３から検出信号が入力される。第３駆動源制御部２０３は、第３位置センサー４１３の検出信号から算出される第３駆動源４０３の回転角度（位置フィードバック値Ｐｆｂ）が位置指令Ｐｃになり、かつ、後述する角速度フィードバック値ωｆｂが後述する角速度指令ωｃになるように、各検出信号を用いたフィードバック制御によって第３駆動源４０３を駆動する。

すなわち、第３駆動源制御部２０３の減算器５１３には、位置指令Ｐｃが入力され、また、回転角度算出部５５３から後述する位置フィードバック値Ｐｆｂが入力される。回転角度算出部５５３では、第３位置センサー４１３から入力されるパルス数がカウントされるとともに、そのカウント値に応じた第３駆動源４０３の回転角度が位置フィードバック値Ｐｆｂとして減算器５１３に出力される。減算器５１３は、これら位置指令Ｐｃと位置フィードバック値Ｐｆｂとの偏差（第３駆動源４０３の回転角度の目標値から位置フィードバック値Ｐｆｂを減算した値）を位置制御部５２３に出力する。

位置制御部５２３は、減算器５１３から入力された偏差と、予め定められた係数である比例ゲイン等を用いた所定の演算処理を行うことで、その偏差に応じた第３駆動源４０３の角速度の目標値を演算する。位置制御部５２３は、その第３駆動源４０３の角速度の目標値（指令値）を示す信号を角速度指令ωｃとして減算器５３３に出力する。なお、ここでは、本実施形態では、フィードバック制御として、比例制御（Ｐ制御）がなされるが、これに限定されるものではない。

また、角速度算出部５６３では、第３位置センサー４１３から入力されるパルス信号の周波数に基づいて、第３駆動源４０３の角速度が算出され、その角速度が角速度フィードバック値ωｆｂとして減算器５３３に出力される。

減算器５３３には、角速度指令ωｃが入力され、また、角速度フィードバック値ωｆｂが入力される。減算器５３３は、これら角速度指令ωｃと角速度フィードバック値ωｆｂとの偏差（第３駆動源４０３の角速度の目標値から角速度フィードバック値ωｆｂを減算した値）を角速度制御部５４３に出力する。

角速度制御部５４３は、減算器５３３から入力された偏差と、予め定められた係数である比例ゲイン、積分ゲイン等を用い、積分を含む所定の演算処理を行うことで、その偏差に応じた第３駆動源４０３の駆動信号（駆動電流）を生成し、モータードライバー３０３を介してモーター４０３Ｍに供給する。なお、ここでは、本実施形態では、フィードバック制御として、ＰＩ制御がなされるが、これに限定されるものではない。

このようにして、位置フィードバック値Ｐｆｂが位置指令Ｐｃと可及的に等しくなり、かつ、角速度フィードバック値ωｆｂが角速度指令ωｃと可及的に等しくなるように、フィードバック制御がなされ、第３駆動源４０３の駆動電流が制御される。

なお、駆動源制御部２０４〜２０６については、それぞれ、前記第３駆動源制御部２０３と同様であるので、その説明は省略する。

以上説明したように、このロボット１およびロボットシステム１０では、第１角速度センサー３１により、第１アーム１２の角速度を検出することができ、また、第３回動軸Ｏ３は、第２回動軸Ｏ２と平行であるので、第２角速度センサー３２により、第２アーム１３の回動分を含めて第３アーム１４の角速度を検出することができる。そして、これらの検出結果に基づいて、振動を抑制することができる。そして、特に、第１角速度センサーユニット７１を前述した位置に配置することにより、第１角速度センサー３１により、第１アーム１２のうちの振動の大きい部位の角速度を検出することができ、これにより、より確実に振動を抑制することができる。

ここで、第１角速度センサー３１により第１アーム１２のうちの振動の大きい部位の角速度を検出することができる理由を説明すると、まず、第１アーム１２のうち、根元部２５１と、舌片部２４１ａ、２４１ｂとでは、根元部２５１の方が剛性が高く、また、第１アーム１２の基端側よりも先端側の方が大きい振動が生じるので、舌片部２４１ａ、２４１ｂの方が大きい振動が生じる。

また、舌片部２４１ａと、舌片部２４１ｂとでは、舌片部２４１ａに減速機４５が設けられているので、第２アーム１３に駆動力を伝達し、かつ、第２アーム１３を支持している部位は、舌片部２４１ａである。このため、第２アーム１３が駆動した際、舌片部２４１ｂよりも舌片部２４１ａの方が大きい振動が生じる。

なお、第２回動軸Ｏ２の軸方向から見て、第１角速度センサーユニット７１が、全く、第１アーム１２の第２アーム１３と重なっている部位に設けられていない場合、例えば、第１角速度センサーユニット７１が根元部２５１に設置されている場合は、第１アーム１２の第１回動軸Ｏ１の回りの捩じれによる振動を含む角速度は検出できるが、第１アーム１２の撓みによる振動を含む角速度を検出することができない。しかし、このロボット１およびロボットシステム１０では、第１角速度センサーユニット７１が舌片部２４１ａに設置されているので、第１アーム１２の第１回動軸Ｏ１の回りの捩じれによる振動および第１アーム１２の撓みによる振動を含む角速度を検出することができ、これにより、より確実に振動を抑制することができる。

また、ロボット１の姿勢が変化しても、第１角速度センサー３１の検出軸３１１は、一定である。このため、第１角速度センサー３１により検出された第１アーム１２の角速度に対して、第１角速度センサー３１の向きによる補正を行う必要がない。

また、第３回動軸Ｏ３および第２回動軸Ｏ２は、第１回動軸Ｏ１と直交または第１回動軸に直交する軸と平行であるので、ロボット１の姿勢が変化、例えば、第２アーム１３が回動しても、また、第３アーム１４が回動しても、第２角速度センサー３２の検出軸３２１は、一定である。このため、第２角速度センサー３２により検出された第３アーム１４の角速度に対して、第２角速度センサー３２の向きによる補正を行う必要がない。

これにより、複雑で膨大な演算が不要であり、これによって、演算誤差が生じ難く、振動を確実に抑制することができ、また、ロボット１の制御における応答速度を速くすることができる。

また、第２角速度センサー３２により、第２アーム１３の角速度ではなく、第２アーム１３の回動分を含めて第３アーム１４の角速度を検出するので、より確実に振動を抑制することができる。

また、第２アーム１３にも角速度センサーを設置する場合に比べて、角速度センサーの数を削減することができ、コストを低減することができ、また、構成を簡素化することができる。

また、第３アーム１４よりも基端側の第２アーム１３を回動させる第２駆動源４０２の作動を制御することにより、ロボット１の振動を抑制する効果を高めることができる。

以上、本発明のロボットおよびロボットシステムを、図示の実施形態に基づいて説明したが、本発明はこれに限定されるものではなく、各部の構成は、同様の機能を有する任意の構成のものに置換することができる。また、本発明に、他の任意の構成物が付加されていてもよい。

なお、各駆動源のモーターとしては、それぞれ、前記サーボモーターの他、例えば、ステッピングモーター等が挙げられる。また、モーターとしてステッピングモーターを用いる場合は、位置センサーとして、例えば、ステッピングモーターへ入力する駆動パルスの数を計測することで、モーターの回転角度を検出するものを用いてもよい。

また、各位置センサー、各角速度センサーの方式は、それぞれ、特に限定されず、例えば、光学式、磁気式、電磁式、電気式等が挙げられる。

また、前記実施形態では、第２角速度センサーの検出結果に基づいて第２アームを回動させる第２駆動源の作動を制御するようになっているが、これに限らず、例えば、第２角速度センサーの検出結果に基づいて第３アームを回動させる第３駆動源の作動を制御するようになっていてもよい。

また、前記実施形態では、ロボットの回動軸の数は、６つであるが、本発明では、これに限定されず、ロボットの回動軸の数は、２つ、３つ、４つ、５つまたは７つ以上でもよい。

すなわち、前記実施形態では、リストが２本のアームを有しているので、ロボットのアームの本数は、６本であるが、本発明では、これに限定されず、ロボットのアームの本数は、２本、３本、４本、５本または７本以上でもよい。

また、前記実施形態では、ロボットは、複数のアームを回動可能に連結してなるロボットアームを１つ有する単腕ロボットであるが、本発明では、これに限定されず、例えば、複数のアームを回動可能に連結してなるロボットアームを２つ有する双腕ロボット等、前記ロボットアームを複数有するロボットであってもよい。

１……ロボット（産業用ロボット） １０……ロボットシステム １１……基台 １２、１３、１４、１５……アーム（リンク） １６……リスト（リンク） １６１……リスト本体 １６２……支持リング １６３……先端面 １７１、１７２、１７３、１７４、１７５、１７６……関節（ジョイント） ２、２ａ、２ｂ、２ｃ、２ｄ……アーム本体 ３、３ａ、３ｂ、３ｃ、３ｄ……駆動機構 ３１、３２……角速度センサー ３１１、３２１……検出軸 ４、４ａ、４ｂ、４ｃ、４ｄ……封止手段 ２０……ロボット制御装置 ２０１〜２０６……駆動源制御部 ３０１、３０２、３０３、３０４、３０５、３０６……モータードライバー ４０１、４０２、４０３、４０４、４０５、４０６……駆動源 ４０１Ｍ、４０２Ｍ、４０３Ｍ、４０４Ｍ、４０５Ｍ、４０６Ｍ……モーター ４１１、４１２、４１３、４１４、４１５、４１６……位置センサー ５１１、５１２、５１３、５１４、５１５、５１６……減算器 ５２１、５２２、５２３、５２４、５２５、５２６……位置制御部 ５３１、５３２、５３３、５３４、５３５、５３６……減算器 ５４１、５４２、５４３、５４４、５４５、５４６……角速度制御部 ５５１、５５２、５５３、５５４、５５５、５５６……回転角度算出部 ５６１、５６２、５６３、５６４、５６５、５６６……角速度算出部 ５７１……減算器 ５８１、５８２……変換部 ５９１、５９２……補正値算出部 ６０1、６０２……加算器 ６２２……加減算器 ４５……減速機 ４５１……減速部 ４５２……歯車 ４５３……筒状部 ４５４……取付部 ４５５……歯車 ４５６……軸受 ４５７……外輪 ４５８……内輪 ４５９……ローラー ７１、７２……角速度センサーユニット ７１１、７２１……ハウジング ７１１１、７２１１……取付部 ７１２、７２２……回路基板 ７１３、７２３……回路部 ７１１２、７２１２……孔 ８１……雄ネジ ８５……ケーブル ９１、９２……プーリー ９２１……回転軸 ９３……ベルト １０１……床 １１１……ボルト １１２……基台本体 １１３……円筒状部 １１４……箱状部 １２１、１４１ アーム側取付部 １８１、１８２、１８３……軸受 ２４１ａ、２４１ｂ、２４２ａ、２４２ｂ、２４４ａ、２４４ｂ……舌片部 ２５１、２５２、２５４……根元部 Ｏ１、Ｏ２、Ｏ３、Ｏ４、Ｏ５、Ｏ６……回動軸

Claims (12)

1. 基台と、
   前記基台に、第１回動軸を回動中心として回動可能に設けられた第１アームと、
   前記第１アームに、前記第１回動軸の軸方向とは異なる軸方向である第２回動軸を回動中心として回動可能に設けられた第２アームと、
   第１角速度検出器を有する第１部材と、を備え、
   前記第１部材の少なくとも一部は、前記第２回動軸の軸方向から見て、前記第１アームの前記第２アームと重なっている部分に設けられていることを特徴とするロボット。
2. 前記第１アームは、前記第２アームよりも基台側に位置する第１部分と、前記基台よりも前記第２アーム側に位置する第２部分と、を有し、
   前記第１部材は、前記第２部分に設けられている請求項１に記載のロボット。
3. 前記第２部分に、減速機が設けられている請求項２に記載のロボット。
4. 前記第２回動軸の軸方向から見て、前記第１部分と前記第２アームとは重なっておらず、
   前記第１部材は、前記第２回動軸の軸方向から見て、前記第２部分に、前記第１部分と重ならないように設けられている請求項２または３に記載のロボット。
5. 前記第２アームに、前記第２回動軸と平行な軸である第３回動軸を回動中心として回動可能に設けられた第３アームと、
   前記第３アームに設けられ、第２角速度検出器を有する第２部材と、を備える請求項１ないし４のいずれか１項に記載のロボット。
6. 前記第２角速度検出器の角速度の検出軸は、前記第３回動軸と平行である請求項５に記載のロボット。
7. 前記第１角速度検出器の角速度の検出軸は、前記第１回動軸と平行である請求項１ないし６のいずれか１項に記載のロボット。
8. 前記第１部材は、前記第１アームの内部に配置されている請求項１ないし７のいずれか１項に記載のロボット。
9. 前記第２回動軸は、前記第１回動軸に直交する軸であるかまたは前記第１回動軸に直交する軸と平行な軸である請求項１ないし８のいずれか１項に記載のロボット。
10. 前記第２回動軸は、前記第１回動軸の軸方向から見て、前記第１回動軸からずれた位置に配置されている請求項１ないし９のいずれか１項に記載のロボット。
11. 前記第３アームに、前記第３回動軸に直交する軸であるかまたは前記第３回動軸に直交する軸と平行な軸である第４回動軸を回動中心として回動可能に設けられた第４アームと、
    前記第４アームに対し、前記第４回動軸に直交する軸であるかまたは前記第４回動軸に直交する軸と平行な軸である第５回動軸を回動中心として回動可能に設けられた第５アームと、
    前記第５アームに対し、前記第５回動軸に直交する軸であるかまたは前記第５回動軸に直交する軸と平行な軸である第６回動軸を回動中心として回動可能に設けられた第６アームと、を備える請求項１ないし１０のいずれか１項に記載のロボット。
12. ロボットと、
    前記ロボットの作動を制御するロボット制御装置と、を備え、
    前記ロボットは、基台と、
    前記基台に、第１回動軸を回動中心として回動可能に設けられた第１アームと、
    前記第１アームに、前記第１回動軸の軸方向とは異なる軸方向である第２回動軸を回動中心として回動可能に設けられた第２アームと、
    角速度検出器を有する部材と、を備え、
    前記部材の少なくとも一部は、前記第２回動軸の軸方向から見て、前記第１アームの前記第２アームと重なっている部分に設けられていることを特徴とするロボットシステム。

Images