(57)【要約】      （修正有）【課題】本発明は高応答性を備えながら、安全に動作させることができる産業用ロボットを提供する。【解決手段】基部２に回転自在に支持された中空室３と、前記中空室３に回転支持されたアーム体４を備え、前記アーム体４を駆動する動力手段を前記中空室３に備えたものである。駆動手段が少なくとも２つの電動機から構成され、第１の電動機の出力軸に第２の電動機の出力が入力されたものである。前記複数の電動機には、ブレーキ電源から直接通電され、前記第１の電動機には、サーボ機器からブレーキ指令が入力されるように構成されたものである。【選択図】図１
2010240832.tif 000002
【特許請求の範囲】
【請求項１】
基部に回転自在に支持された中空室と、前記中空室に回転支持されたアーム体を備え、前記アーム体を駆動する動力手段を前記中空室に備えたことを特徴とする産業用ロボット。
【請求項２】
基部に回転自在に支持された中空室と、前記中空室に回転支持されたアーム体を備え、前記アーム体を駆動する動力手段が複数からなり、前記中空室に備えたことを特徴とする産業用ロボット。
【請求項３】
前記駆動手段が少なくとも２つの電動機から構成されたことを特徴とする請求項２記載の産業用ロボット。
【請求項４】
前記駆動手段が少なくとも２つの電動機から構成され、第１の電動機の出力軸に第２の電動機の出力が入力されたことを特徴とする請求項２記載の産業用ロボット。
【請求項５】
前記動力手段が少なくとも２つの電動機から構成され、前記２つの電動機は整列して配置されたことを特徴とする請求項２記載の産業用ロボット。
【請求項６】
前記アーム体を駆動する前記動力手段が少なくとも２つの電動機から構成され、前記中空室に少なくとも２つのアーム体を駆動する前記動力手段が配置されたことを特徴とする請求項２記載の産業用ロボット。
【請求項７】
前記動力手段が少なくとも２つの電動機から構成され、前記２つの電動機のトルクの加算値により前記アーム体を駆動することを特徴とする請求項２記載の産業用ロボット。
【請求項８】
前記駆動手段が少なくとも２つの電動機から構成され、第１の電動機の出力軸に複数の電動機の出力が直列に入力されたことを特徴とする請求項２記載の産業用ロボット。
【請求項９】
少なくとも２つの前記動力手段は、第１の電動機と直列に連結される複数の電動機から構成され、前記第１の電動機に入力される直列に連結される前記複数の電動機のトルクが前記第１の電動機のトルクと均等であることを特徴とする産業用ロボットの制御方法。
【請求項１０】
少なくとも２つの動力手段により１つのアーム体を駆動するように、少なくとも前記２つの動力手段に各々の制御器を備え、前記動力手段の出力が均等になるように制御することを特徴とする産業用ロボットの制御方法。
【請求項１１】
前記制御器によって前記第１の電動機に入力される直列に連結される前記複数の電動機のトルクが前記第１の電動機のトルクと均等になるように演算する第２の制御器を備えたことを特徴とする請求項９記載の産業用ロボットの制御方法。
【請求項１２】
少なくとも２つの前記動力手段は、第１の電動機と直列に連結される複数の電動機から構成され、前記複数の電動機には、ブレーキ電源から直接通電され、前記第１の電動機には、サーボ機器からブレーキ指令が入力されるように構成されたことを特徴とする産業用ロボットの制御方法。
【請求項１３】
前記ブレーキ電源に遅延回路を備え、電源がオフされても出力が降下しながら前記ブレーキ電源がオフされることを特徴とする産業用ロボットの制御方法。
【請求項１４】
通電されている前記複数の電動機は、前記第１の電動機よりも遅れてブレーキが作動することを特徴とする請求項１２記載の産業用ロボットの制御方法。
【請求項１５】
前記第１の電動機のブレーキは、前記サーボ機器からの指令とコンタクタインターロックの状態から指令されることを特徴とする請求項１２記載の産業用ロボットの制御方法。
【請求項１６】
前記複数の電動機のブレーキは、前記ブレーキ用電源から通電されており、前記ブレーキ用電源がオフされない限り、前記ブレーキはオフの状態を保持することを特徴とする請求項１２記載の産業用ロボットの制御方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、その工業ロボットおよびその制御方法に関するものである。
【背景技術】
【０００２】
電動機を用いたロボットは、産業用だけでなくヒューマノイドロボットにも適用されてきている。関節軸は、複数台の電動機で動作させるようになってきている。1つの関節の回転を２つの電動機で動作させるものが提案されている（例えば、特許文献１参照）。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２００４−２８３９４０号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
産業用ロボットが適用される分野においては、生産性向上のために物品を搬送するスループットを向上させることが要求されている。産業用ロボットの各関節軸の動作を速くする必要がある。電動機の応答性を向上させる必要があるが、高速に駆動しようとすると、電動機の出力を大きくするには大型化する。そうすると、電動機のイナーシャが大きくなり、応答性を向上させることができないといった問題が生じる。
【０００５】
また、物品のスループットを向上させるために、製造設備は産業用ロボットのフットプリントを小さくして、製造ラインを短くする傾向にある。
これに対して、従来のロボットでは、1つの軸を2つの電動機で単純に回転させるようにしていることから、2つの電動機の協調動作を必要とし、制御が煩雑になるといった問題が生じていた。
【０００６】
また、非常停止など急激な停止指令が入った場合には、2つの電動機が同時に制止動作するために、産業用ロボットのアームや減速機に急激な反力が生じる。このような動作では、可動部位や構造物に損傷が生じることが考えられ、物品のスループットを向上させる観点を考慮すると、問題となることが予想される。
【０００７】
本発明はこのような問題点に鑑みてなされたものであり、高応答性を備えながら、安全に動作させることができる産業用ロボットを提供することを目的とする。
【課題を解決するための手段】
【０００８】
上記問題を解決するため、本発明は、次のように構成したのである。
請求項１に記載の発明は、基部に回転自在に支持された中空室と、前記中空室に回転支持されたアーム体を備え、前記アーム体を駆動する動力手段を前記中空室に備えたものである。
【０００９】
請求項２に記載の発明は、基部に回転自在に支持された中空室と、前記中空室に回転支持されたアーム体を備え、前記アーム体を駆動する動力手段が複数からなり、前記中空室に備えたものである。
【００１０】
請求項３に記載の発明は、前記駆動手段が少なくとも２つの電動機から構成されたものである。
【００１１】
請求項４に記載の発明は、前記駆動手段が少なくとも２つの電動機から構成され、第１の電動機の出力軸に第２の電動機の出力が入力されたものである。
【００１２】
請求項５に記載の発明は、前記動力手段が少なくとも２つの電動機から構成され、前記２つの電動機は整列して配置されたものである。
請求項６に記載の発明は、前記アーム体を駆動する前記動力手段が少なくとも２つの電動機から構成され、前記中空室に少なくとも２つのアーム体を駆動する前記動力手段が配置されたものである。
【００１３】
請求項７に記載の発明は、前記動力手段が少なくとも２つの電動機から構成され、前記２つの電動機のトルクの加算値により前記アーム体を駆動するものである。
【００１４】
請求項８に記載の発明は、前記駆動手段が少なくとも２つの電動機から構成され、第１の電動機の出力軸に複数の電動機の出力が直列に入力されたものである。
【００１５】
請求項９に記載の発明は、少なくとも２つの前記動力手段は、第１の電動機と直列に連結される複数の電動機から構成され、前記第１の電動機に入力される直列に連結される前記複数の電動機のトルクが前記第１の電動機のトルクと均等であるものである。
【００１６】
請求項１０に記載の発明は、少なくとも２つの動力手段により１つのアーム体を駆動するように、少なくとも前記２つの動力手段に各々の制御器を備え、前記動力手段の出力が均等になるように制御するものである。
【００１７】
請求項１１に記載の発明は、前記制御器によって前記第１の電動機に入力される直列に連結される前記複数の電動機のトルクが前記第１の電動機のトルクと均等になるように演算する第２の制御器ものである。
【００１８】
請求項１２に記載の発明は、少なくとも２つの前記動力手段は、第１の電動機と直列に連結される複数の電動機から構成され、前記複数の電動機には、ブレーキ電源から直接通電され、前記第１の電動機には、サーボ機器からブレーキ指令が入力されるように構成されたものである。
【００１９】
請求項１３に記載の発明は、前記ブレーキ電源に遅延回路を備え、電源がオフされても出力が降下しながら前記ブレーキ電源がオフされるものである。
【００２０】
請求項１４に記載の発明は、通電されている前記複数の電動機は、前記第１の電動機よりも遅れてブレーキが作動するものである。
【００２１】
請求項１５に記載の発明は、前記第１の電動機のブレーキは、前記サーボ機器からの指令とコンタクタインターロックの状態から指令されるものである。
【００２２】
請求項１６に記載の発明は、前記複数の電動機のブレーキは、前記ブレーキ用電源から通電されており、前記ブレーキ用電源がオフされない限り、前記ブレーキはオフの状態を保持するものである。
【発明の効果】
【００２３】
本発明では、第１の電動機の出力軸に直列に電動機の出力を入力するような構成にしたことにより、電動機のイナーシャを大きくすることがないので、高応答性を維持したまま、関節軸を高速に駆動することが可能となる。
【００２４】
また、このような複数の電動機を配置する中空室を設けたことにより、各関節近傍に電動機を配置する必要がないので、ロボット自体を小型化できるためにフットプリントを小さくして製造ラインを短くすることが可能となる。
【００２５】
また、第１の電動機の出力軸に直列に電動機の出力を入力するような構成にして、第１の電動機のトルクと直列に複数台配置された電動機のトルクが均等になるように制御されることにより、複雑な協調制御を必要とせずに容易に複数台の電動機のトルクの和により関節軸を駆動することが可能となる。
【００２６】
また、第１の電動機の出力軸に直列に電動機の出力を入力するような構成にして、第１の電動機よりも遅れて第２以降の電動機にブレーキトルクを緩やかに供給するようにしたことにより、産業用ロボットのアームや減速機に急激な反力が生じることがなくなり、可動部位や構造物に損傷が生じない。このために製造ラインのメンテナンスを行う必要がなくなり、物品のスループットが向上する。
【図面の簡単な説明】
【００２７】
【図１】本発明の産業用ロボットの側断面図
【図２】本発明の産業用ロボットの正面断面図
【図３】（図３）本発明の制御ブロック図
【図４】本発明の制御ブロック図
【図５】本発明のタイムチャート
【発明を実施するための形態】
【００２８】
以下、本発明の実施の形態について図を参照して説明する。
【実施例１】
【００２９】
図１は本発明の産業用ロボットの側断面図である。図２は本発明の産業用ロボットの正面断面図である。
【００３０】
産業用ロボット１は、基部２上に内室３が回転自在に連結され、内室３は第1のアーム体４と回転自在に連結され、第1のアーム体４は第２のアーム体５と回転自在に連結され、第２のアーム体５の先端には手首機構６を備えて構成されている。
【００３１】
基部２には、第１の電動機７が備えられており、出力軸は第１の減速機８に入力されて、第１の減速機８の出力軸は内室３を垂直軸回りに回転する。
【００３２】
内室３には、第２から第４の電動機が配置されている。図１の側断面図に示すように、第２の電動機９１と第３の電動機９２は、内室３に縦方向に並んで配置され、同様に、第４の電動機１１と第５の電動機１２は、内室３に縦方向に並んで配置され、第２の電動機９１と第４の電動機１１および第３の電動機９２と第５の電動機１２は離間して平行に配置されている。離間している空間には、手首機構６までの供給線が配置されている。このように配置することにより、供給線の空間を設けながら省スペースに複数個の電動機を配置することが可能となる。
【００３３】
次に、動力伝達について説明する。第４の電動機１１が回転すると、第４の電動機１１の出力軸に取り付けられた第３のプーリ１７にかけられた第４のベルト１４を介して第７のプーリ２５に入力され、第２の減速機２２の入力軸が中空形状をしており、中空部で軸受２３を介して回転自在に支持されたシャフト１８が回転し、シャフト１８に取り付けられた第５のプーリ１９にかけられた第５のベルト２０を介して第６のプーリ２１を回転させ、第２の減速機２２によって減速された回転が第３の減速機２４の出力軸を介して第２のアーム体５を回転させる。また、第５の電動機１２の出力軸には、第５の電動機１２の回転が、第５の電動機１２の出力軸に取り付けられた第１のプーリ１５にかけられた第３のベルト１３を介して第４の電動機１１の出力軸に取り付けられた第２のプーリ１６を回転させる。このようにして、第３のプーリ１７に作用するトルクは、第４の電動機１１と第５の電動機１２のトルクの和が作用することになる。
【００３４】
また、第２の電動機および第３の電動機の動力伝達系も同様の構成となっており、第２の電動機９１が回転すると、第２のベルト９４を介して第４のプーリ９８に入力され、第２の減速機２２の入力軸が回転し、減速された回転が第２の減速機２２の出力軸を介して第１のアーム体４を回転させる。また、第２の電動機９１の出力軸には、第３の電動機９２の回転が、第１のベルト９３を介して第２の電動機９１の出力軸に取り付けられた第２のプーリ１６を回転させる。このようにして、第４のプーリ９８に作用するトルクは、第２の電動機９１と第３の電動機９２のトルクの和が作用することになる。
本実施例では、１つのモータのもう１つのモータの出力を入力してトルクの和とするような構成で説明したが、１つのモータに２台以上のモータを直列に連結して構成することも可能である。その場合は、たとえば、１つのモータのトルク容量と同等のトルク容量になるように２つ以上の１つのモータのトルク容量より小容量のモータで構成することができる。そうすることで、複数台のモータで構成することで発生トルクのアンバランスを解消することができ、複雑な制御をする必要がなくなる。
【００３５】
次に、制御方法について図３を用いて説明する。本例では、第２の電動機９１および第３の電動機９２を用いて説明する。第１のアーム体４を動作させるために位置指令３０不図示のコントローラから第１の制御器３１および第２の制御器３２に入力される。制御器３１および制御器３２は、位置フィードバック回路、速度フィードバック回路、トルクフィードバック回路から構成されている。第１の制御器３１から第１のトルク指令３３受けた不図示のドライブ回路からの電流が第２の電動機９１に入力され、第１のアーム体を動作させる。また、第２の制御器３２から第２のトルク指令３４は、第１のトルク指令３３と差分にゲインを積算する第３の制御器３５からの値を加算して不図示のドライブ回路に入力されて電流が第３の電動機９２に通電される。
【００３６】
このように、また、第２の制御器３２から第２のトルク指令３４は、第１のトルク指令３３と差分にゲインを積算する第３の制御器３５からの値を用いることで、第２の電動機９１と第３の電動機９２へのトルク指令の差がなくなるようにすることができる。
第３の制御器を有することにより、第２の電動機９１と第３の電動機９２の発生するトルクが均等になり、第３の電動機９２が発生するトルクにより、第２の電動機９１の発生するトルクを減ずることなく、有効に２台のモータで協調した動作が可能となる。１つのモータのトルク容量と同等のトルク容量になるように２つ以上の１つのモータのトルク容量より小容量のモータで構成した場合には、第３の制御器のサーボゲインを変更することにより容易に複数台について対応することが可能となる。
【００３７】
次に、産業用ロボットを停止させる制御方法について第１のアーム体および第2のアーム体を例に説明する。産業用ロボットをサーボオフの状態で停止させると、第１のアーム体および第２のアーム体は、自重により落下する。したがって、電動機にはそれを抑制するためにブレーキが備えられている。ブレーキ回路について図４を用いて説明する。第２から第５の電動機のブレーキの作用について説明する。ブレーキ用電源４１からブレーキリレー回路４２に電源供給され、通常、第３の電動機４６および第５の電動機４７のブレーキには通電されている。つまり、通常状態ではブレーキオフの状態である。また、コントローラからブレーキ指令４８がブレーキリレー回路４２に入力され、ブレーキ用電源４１からの入力がコンタクタインターロック４３の状態に応じて第２の電動機４４および第４の電動機４５に動作指令が出力される。
【００３８】
電源停止がされた場合のタイムチャートを図５に示し、第２から第５の電動機のブレーキへの通電の状態変化について説明する。コントローラへ供給されている電源の通電状態からオフ状態になる状態変化を（Ａ）に示し、電源のオフ状態を検出した状態変化を（Ｂ）に示し、第２の電動機のブレーキおよび第４の電動機のブレーキへの通電状態の変化を（Ｃ）に示し、第３の電動機のブレーキおよび第５の電動機のブレーキへの通電状態の変化を（Ｄ）に示す。電源がオフされてから遅延時間を有しながら、第２の電動機のブレーキおよび第４の電動機のブレーキへの通電がオフされ、さらに遅延して第３の電動機のブレーキおよび第５の電動機のブレーキへの通電がオフされる。第２の電動機のブレーキおよび第４の電動機のブレーキへの通電は（１）の状態変化のように急峻にオフされ、電動機の回転をロックするようにブレーキが作用する。また、第３の電動機のブレーキおよび第５の電動機のブレーキへの通電は（２）の状態変化のように所定時間をかけて徐々に低下してオフされる。第３および第５の電動機の回転を止めるトルクが所定時間をかけて次第に大きくなるように作用する。
【００３９】
本発明で用いられる電動機のブレーキには、通電電流に比例して作用するトルクが発生するタイプが用いられている。
【００４０】
このような状態変化について図４を用いて説明する。サーボ機器の電源がオフされるのでブレーキ指令はオフ状態になり、コンタクタインターロック４３もサーボ機器がオフになるとともにブレーキ用電源４１が遮断され、この状態を検出することにより、第２の電動機４４および第４の電動機４５に動作指令がオフ状態になることで、ブレーキが作動する。また、ブレーキ用電源４１がオフされると、第３の電動機４６および第５の電動機４７のブレーキへの通電がオフされるのでブレーキが作動する。この時、電源停止から遅延して第２の電動機４４および第４の電動機４５に動作指令がオフ状態になり、ブレーキ用電源４１は内部回路にコンデンサなどからなるバックアップ回路を持っていることから、さらに遅延して第３の電動機４６および第５の電動機４７のブレーキの動作指令がオフとなる。このように、第２の電動機および第４の電動機に対して、第３の電動機および第５の電動機を遅延させてブレーキトルクを作用させることで、急峻なアーム体の静止がおこならないようになる。つまり、ブレーキが作用する初期状態では定格負荷の半分程度の負荷でブレーキが作用し、遅延して定格負荷が作用するようになっている。
【００４１】
この遅延時間は、ブレーキ用電源４１内部のコンデンサで構成されるバックアップ回路から求められるが、数１０ms程度であり、アーム体の落下への影響には問題が生じない程度である。
【符号の説明】
【００４２】
１  産業用ロボット
２  基部
３  内室
４  第１のアーム体
５  第２のアーム体
６  手首機構
７  第１の電動機
８  第１の減速機
９１  第２の電動機
９２  第３の電動機
９３  第１のベルト
９４  第２のベルト
９８  第４のプーリ
１１  第４の電動機
１２  第５の電動機
１３  第３のベルト
１４  第４のベルト
１５  第１のプーリ
１６  第２のプーリ
１７  第３のプーリ
１８  シャフト
１９  第５のプーリ
２０  第５のベルト
２１  第６のプーリ
２２  第２の減速機
２３  軸受
２４  第３の減速機
２５  第７のプーリ
３０  位置指令
３１  第１の制御器
３２  第２の制御器
３３  第１のトルク指令
３４  第２のトルク指令
３５  第３の制御器
４１  ブレーキ用電源
４２  ブレーキリレー回路
４３  コンタクタインターロック
４４  第２の電動機ブレーキ
４５  第４の電動機ブレーキ
４６  第３の電動機ブレーキ
４７  第５の電動機ブレーキ
４８  ブレーキ指令
【図１】
2010240832.tif 000003
【図２】
2010240832.tif 000004
【図３】
2010240832.tif 000005
【図４】
2010240832.tif 000006
【図５】
2010240832.tif 000007