JP2000198091A - 複数腕協調ロボットシステム - Google Patents

複数腕協調ロボットシステム

Info

Publication number
JP2000198091A
JP2000198091A JP11002778A JP277899A JP2000198091A JP 2000198091 A JP2000198091 A JP 2000198091A JP 11002778 A JP11002778 A JP 11002778A JP 277899 A JP277899 A JP 277899A JP 2000198091 A JP2000198091 A JP 2000198091A
Authority
JP
Japan
Prior art keywords
robot
weight
arm
robots
work
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.)
Pending
Application number
JP11002778A
Other languages
English (en)
Inventor
Kunio Miyawaki
国男 宮脇
Noriaki Shinohara
紀昭 篠原
Kazuyuki Sunayama
和之 砂山
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.)
Hitachi Zosen Corp
Original Assignee
Hitachi Zosen 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 Hitachi Zosen Corp filed Critical Hitachi Zosen Corp
Priority to JP11002778A priority Critical patent/JP2000198091A/ja
Publication of JP2000198091A publication Critical patent/JP2000198091A/ja
Pending legal-status Critical Current

Links

Landscapes

  • Manipulator (AREA)

Abstract

(57)【要約】 【課題】 作業対象であるワークの寸法や重量が変化し
ても、ロボットの仕様を変更する必要がない複数腕協調
ロボットシステムを提供する。 【解決手段】 夫々のアーム1aが同調駆動される複数
のロボット1と、これら複数のロボット1の中央部に設
置され、ロボット1のアーム1aの前後左右方向の移動
範囲を移動可能なワーク自重補償装置8を備えた構成で
ある。 【効果】 ワークの重量を自重補償装置で支え、ロボッ
トにはほとんど負荷が作用しないので、より高精度な位
置・姿勢の制御が行えることになる。また、ワークの寸
法や重量が変化しても、自重補償装置の変更だけで良
く、ロボットの仕様を変更する必要がない。

Description

【発明の詳細な説明】
【0001】
【発明の属する技術分野】本発明は、構造部材の搬送や
組立を行うための複数腕協調ロボットシステムに関する
ものである。
【0002】
【従来の技術】従来、双腕ロボットを用いた作業ロボッ
ト等は実用化され、各種工場で採用されているが、構造
部材の搬送用や組立用の複数腕協調ロボットはほとんど
実用化されていない。特にワークの自重を補償する装置
と組合せた複数腕協調ロボットは、ワークをロボット自
体が掴むことで搬送や組立を行う方式のものを除いて、
ほとんど実用化されていなかった。
【0003】
【発明が解決しようとする課題】上記したワークをロボ
ット自体が掴むことで搬送や組立を行う方式の双腕協調
型のロボットでは、作業対象であるワークの寸法や重量
が変化した場合には、ロボットの仕様を変更する必要が
あり、また、ワークによっては対応できない場合もあっ
た。
【0004】本発明は、上記した従来の問題点に鑑みて
なされたものであり、作業対象であるワークの寸法や重
量が変化しても、ロボットの仕様を変更する必要がない
複数腕協調ロボットシステムを提供することを目的とし
ている。
【0005】
【課題を解決するための手段】上記した目的を達成する
ために、本発明の複数腕協調ロボットシステムは、夫々
のアームが同調駆動される複数のロボットの他に、これ
ら複数のロボットのアームが把持するワークの重心(中
心部)の移動範囲内を自由に移動可能なワーク自重補償
装置を備えさせることとしている。そして、このように
することで、ワーク自重補償装置でワークの自重を支え
ることから、ロボットに作用する負荷が大幅に軽減され
ることになる。
【0006】
【発明の実施の形態】本発明の複数腕協調ロボットシス
テムは、夫々のロボットのアームが同調駆動される複数
のロボットと、これら複数のロボットの中央部に設置さ
れ、ロボットのアームが把持するワークの重心(中心
部)の移動範囲内を自由に移動可能なワーク自重補償装
置を備えたものである。
【0007】本発明の複数腕協調ロボットシステムによ
れば、ワークの自重はワーク自重補償装置で支えること
になるので、ロボットにワークの自重が作用することが
ない。従って、ロボットは、より高精度な位置・姿勢の
制御が行えることになる。このロボットの位置・姿勢を
制御する際、ロボットのハンド部の駆動源を、全体の駆
動トルクを小さくするようロボットの根元付近に設けた
場合にはさらなる高精度化が図れる。また、作業対象で
あるワークの寸法や重量が変化しても、ロボットの仕様
を変更する必要がない。
【0008】
【実施例】以下、本発明の複数腕協調ロボットシステム
を図1〜図6に示す一実施例に基づいて説明する。図1
は双腕協調ロボットを備えた本発明の複数腕協調ロボッ
トシステムの全体側面図、図2は図1を平面方向から見
た図、図3は図1の正面図、図4は本発明の複数腕協調
ロボットシステムに使用するロボットの一例を示す側面
図、図5は本発明の複数腕協調ロボットシステムを構成
する双腕協調ロボットのフレーム配置を示す説明図、図
6は本発明の複数腕協調ロボットシステムが採用する逆
ヤコビアン制御装置の概略構成図である。
【0009】図1〜図4において、1は例えば移動台車
2上に所定の間隔を存して取り付けられた2個のロボッ
トであり、例えば以下のような機構によって、平行リン
ク機構で構成されたアーム1aの先端側に設置された掴
み部1bを移動させるようになっている。
【0010】3は移動台車2の床面裏側に設置された水
平回動用のモータであり、このモータ3の出力軸の正逆
回動によって、傘歯車4a,4bを介して基台1cを正
逆回動させ、基台1cにピン1dを介して枢支立設した
垂直フレーム1eの上端に一端を枢支した前記アーム1
a、すなわち、掴み部1bを、同一水平面内で正逆回動
させるようになっている。
【0011】5は前記基台1cに取り付けられた前後移
動用のモータであり、このモータ5の出力軸の正逆回動
によって、ピン1dを中心として垂直フレーム1eの先
端側を所定角度揺動させるものである。この垂直フレー
ム1eの先端側の揺動によって、前記アーム1aの先端
側に設置された掴み部1bは前後方向に移動する。
【0012】6は同じく基台1cの、前記モータ5と対
向する位置に取り付けられた上下移動用のモータであ
り、このモータ6の出力軸の正逆回動によって、ピン1
dを中心としてリンク1fの先端側が所定角度上下方向
に揺動し、リンク1fの先端に枢支した上下移動用レバ
ー1gを上下移動させる。
【0013】レバー1gの上端は、前記したアーム1a
を構成する下側のリンク1abの途中に枢支されている
ので、レバー1gの上下移動によってアーム1aは垂直
フレーム1eとの枢支部1kを中心として上下揺動し、
アーム1aの先端側に設置された掴み部1bは上下方向
に移動する。
【0014】7は垂直フレーム1eに取り付けられた垂
直揺動用のモータであり、このモータ7の出力軸の正逆
回動によって、基端側を枢支されたリンク1hの先端側
が所定角度上下方向に揺動し、リンク1hの先端に枢支
した上下移動用レバー1iを上下移動させる。
【0015】レバー1iの上端は、リンク1jを介して
前記した平行リンク構成したアーム1aの後端側の2つ
の枢支部1k,1mに枢支されているので、レバー1i
の上下移動によって、アーム1aを構成する平行リンク
機構は、上側のリンク1aaのみが前方に押され、アー
ム1aの先端側に設置された掴み部1bは、下側のリン
ク1abの前方の枢支部1nを中心として垂直方向に揺
動する。
【0016】上記した構成のロボット1のフレーム配置
を図5に基づいて説明すると、図5に示す座標系1〜4
のリンクパラメータは、ロボットの座標系を設定するの
によく使用されるDHパラメータを使用すると、下記表
1のように表すことができる。なお、図5における座標
系1〜3の原点は一致している。
【0017】
【表1】
【0018】そして、上記した構成のロボット1の座標
変換 01 34 及び 0 4 は下記の数式1〜
5のように表すことができる。
【0019】
【数1】
【0020】
【数2】
【0021】
【数3】
【0022】
【数4】
【0023】
【数5】
【0024】以上より、ロボット1の先端すなわち掴み
部1bの位置・姿勢ベクトルr〔X,Y,Z,θ〕の
X,Y,Z,θは、 X= C 1(a 2C 2+a 3C 23) Y= S 1(a 2C 2+a 3C 23) Z=−a 2S 2−a 3S 23 θ=θ 2 +θ 3 +θ 4 で表すことができる。
【0025】従って、図6に示す構成の逆ヤコビアン制
御装置を用いて座標系1〜4の揺動角速度を求めること
によって掴み部1bの位置を制御することができる。す
なわち、掴み部1bの位置をXからXdに移動させるの
に必要な各座標系1〜4の回動及び揺動角速度、つま
り、モータ3による基台1c(座標系1)の水平回動角
速度θ 1 、モータ5による垂直フレーム1e(座標系
2)の揺動角速度θ 2 、モータ6によるアーム1(座
標系3)の揺動角速度θ 3 、モータ7による掴み部1
b(座標系4)の揺動角速度θ 4 は、制御後の掴み部
1bの位置をXd、現在の掴み部1bの位置をXとする
と、図6に示すように、XdからXを減算した後、これ
に下記の数式6で示すヤコビアンJ(前記数式4をθ
1 〜θ 4 について偏微分したもの)の逆行列J -1を掛
けることによって求めることができるのである。なお、
フィードバック成分のXは、上記で計算した各関節角速
度にゲインを掛けた速度指令により、ロボットアームが
動作した時の各関節角を順変換したものである。
【0026】
【数6】
【0027】上記したようにして掴み部1bを位置制御
するロボット1は、夫々のアーム1aが同調して駆動す
るように制御される。8は移動台車2上における上記し
た2つのロボット1の中央部に設置される自重補償装置
であり、ロボット1のアーム1aの前後方向の移動範囲
を移動可能なように、例えばロボット1の上方にレール
8aを片持ち支持し、このレール8aに沿って、ホイス
ト8bが移動するようになっている。加えて、自重補償
装置8のレール8aは、旋回が可能なように、図示省略
したが、軸受けにより柱部材8cに支持されている。こ
れにより、ワーク9を3自由座標間のいたるところに移
動できるようにしている。
【0028】この自重補償装置8は、ロボット1による
作業時、ワーク9の重量を支えるものであるため、ロボ
ット1による作業時、ロボット1にワーク9の自重が作
用することはない。
【0029】本発明の複数腕協調ロボットシステムは上
記した構成であり、ワーク9を搬送したり、ワーク9に
作業を施す際には、自重補償装置8によるワーク9の支
持制御と、先に説明したロボット1の協調駆動制御を同
時に行う。従って、ロボット1による作業時、ワーク9
の重量は自重補償装置8で支えられており、ロボット1
にはほとんど負荷が作用しないので、ロボット1はより
高精度な位置及び姿勢制御が可能となる。加えて、本実
施例のように、ロボットのハンド部すなわち掴み部1b
の駆動源(モータ3,5〜7)を、ロボット1の根本付
近すなわち移動台車2やこの移動台車2に直接設置する
垂直フレーム1eに設けた場合には、アーム1aに駆動
源の重量が作用しないので、さらなる高精度化が図れ
る。
【0030】本実施例では、自重補償装置8として、レ
ール8aに案内されて移動するホイスト8bを示した
が、ロボット1のアーム1aの前後左右方向の移動範囲
を移動可能で、かつ、ワーク9の重量を支持できるもの
であればその構成は問わない。
【0031】
【発明の効果】以上説明したように、本発明の複数腕協
調ロボットシステムによれば、搬送、組立の対象となる
ワークの重量を自重補償装置で支え、ロボットにはほと
んど負荷が作用しない。従って、本発明の複数腕協調ロ
ボットシステムでは、より高精度な位置・姿勢の制御が
行えることになる。このロボットの位置・姿勢を制御す
る際、ロボットのハンド部の駆動源を、ロボットの根本
付近に設けた場合にはさらなる高精度化が図れる。
【0032】また、本発明の複数腕協調ロボットシステ
ムによれば、作業対象であるワークの寸法や重量が変化
しても、自重補償装置の変更だけで良く、ロボットの仕
様を変更する必要がない。これにより、比較的大きなワ
ークを、コンパクトなロボットシステムで、ハンドリン
グすることが可能となり、コスト的にも有利である。
【図面の簡単な説明】
【図1】双腕協調ロボットを備えた本発明の複数腕協調
ロボットシステムの全体側面図である。
【図2】図1を平面方向から見た図である。
【図3】図1の正面図である。
【図4】本発明の複数腕協調ロボットシステムに使用す
るロボットの一例を示す側面図である。
【図5】本発明の複数腕協調ロボットシステムを構成す
る双腕協調ロボットのフレーム配置を示す説明図であ
る。
【図6】本発明の複数腕協調ロボットシステムが採用す
る逆ヤコビアン制御装置の概略構成図である。
【符号の説明】
1 ロボット 1a アーム 3 モータ 5 モータ 6 モータ 7 モータ 8 自重補償装置 9 ワーク
フロントページの続き (72)発明者 砂山 和之 大阪府大阪市住之江区南港北1丁目7番89 号 日立造船株式会社内 Fターム(参考) 3F059 AA01 AA03 BA03 FC01 3F060 AA01 AA03 BA06 CA12 DA10 EA01 EB13 EC13 FA02 GA13 GB12 GB24 HA21

Claims (2)

    【特許請求の範囲】
  1. 【請求項1】 夫々のロボットのアームが同調駆動され
    る複数のロボットと、これら複数のロボットの中央部に
    設置され、ロボットのアームが把持するワークの重心
    (中心部)の移動範囲内を自由に移動可能なワーク自重
    補償装置を備えたことを特徴とする複数腕協調ロボット
    システム。
  2. 【請求項2】 ロボットのハンド部の駆動源を、全体の
    駆動トルクを小さくするようロボットの根元付近に設け
    たことを特徴とする請求項1記載の複数腕協調ロボット
    システム。
JP11002778A 1999-01-08 1999-01-08 複数腕協調ロボットシステム Pending JP2000198091A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP11002778A JP2000198091A (ja) 1999-01-08 1999-01-08 複数腕協調ロボットシステム

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP11002778A JP2000198091A (ja) 1999-01-08 1999-01-08 複数腕協調ロボットシステム

Publications (1)

Publication Number Publication Date
JP2000198091A true JP2000198091A (ja) 2000-07-18

Family

ID=11538812

Family Applications (1)

Application Number Title Priority Date Filing Date
JP11002778A Pending JP2000198091A (ja) 1999-01-08 1999-01-08 複数腕協調ロボットシステム

Country Status (1)

Country Link
JP (1) JP2000198091A (ja)

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006315178A (ja) * 2006-09-04 2006-11-24 Nachi Fujikoshi Corp 産業用ロボット
JP2011051048A (ja) * 2009-08-31 2011-03-17 Yaskawa Electric Corp 搬送システム,ロボット装置及び搬送方法
CN102357897A (zh) * 2011-09-09 2012-02-22 燕山大学 一种4自由度串并联混合重载机械臂
CN102528819A (zh) * 2011-12-27 2012-07-04 燕山大学 一种具有冗余驱动的三自由度串并联混合重载机械臂
JP2014128860A (ja) * 2012-12-28 2014-07-10 Kawasaki Heavy Ind Ltd 搬送システム
CN104175331A (zh) * 2014-08-18 2014-12-03 天津航天机电设备研究所 关节式机械臂微低重力补偿系统
CN105369843A (zh) * 2015-11-20 2016-03-02 覃珠强 多角度工作的连杆式码垛臂
WO2016103299A1 (ja) * 2014-12-25 2016-06-30 川崎重工業株式会社 自動物体搬送方法、及び自動物体搬送システム
KR20170078789A (ko) * 2014-10-31 2017-07-07 가와사끼 쥬고교 가부시끼 가이샤 반송 시스템 및 그 제어 방법
JPWO2017002266A1 (ja) * 2015-07-02 2018-03-15 株式会社安川電機 物品支持システム
CN108712945A (zh) * 2016-01-08 2018-10-26 弗鲁特科尔股份有限公司 呈轻质结构形式的具有多个联接传动装置的机器人
CN109623804A (zh) * 2018-12-20 2019-04-16 武汉理工大学 一种可搬运重负荷的轻型机械臂
WO2020039508A1 (ja) * 2018-08-21 2020-02-27 株式会社安川電機 搬送システムおよび搬送方法

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006315178A (ja) * 2006-09-04 2006-11-24 Nachi Fujikoshi Corp 産業用ロボット
JP2011051048A (ja) * 2009-08-31 2011-03-17 Yaskawa Electric Corp 搬送システム,ロボット装置及び搬送方法
CN102357897A (zh) * 2011-09-09 2012-02-22 燕山大学 一种4自由度串并联混合重载机械臂
CN102528819A (zh) * 2011-12-27 2012-07-04 燕山大学 一种具有冗余驱动的三自由度串并联混合重载机械臂
JP2014128860A (ja) * 2012-12-28 2014-07-10 Kawasaki Heavy Ind Ltd 搬送システム
CN104175331A (zh) * 2014-08-18 2014-12-03 天津航天机电设备研究所 关节式机械臂微低重力补偿系统
KR20170078789A (ko) * 2014-10-31 2017-07-07 가와사끼 쥬고교 가부시끼 가이샤 반송 시스템 및 그 제어 방법
WO2016103299A1 (ja) * 2014-12-25 2016-06-30 川崎重工業株式会社 自動物体搬送方法、及び自動物体搬送システム
JPWO2016103299A1 (ja) * 2014-12-25 2017-07-27 川崎重工業株式会社 自動物体搬送方法、及び自動物体搬送システム
TWI626133B (zh) * 2014-12-25 2018-06-11 Kawasaki Heavy Ind Ltd Automatic object transport system
JPWO2017002266A1 (ja) * 2015-07-02 2018-03-15 株式会社安川電機 物品支持システム
CN105369843A (zh) * 2015-11-20 2016-03-02 覃珠强 多角度工作的连杆式码垛臂
CN105369843B (zh) * 2015-11-20 2018-08-21 南宁邃丛赋语科技开发有限责任公司 多角度工作的连杆式码垛臂
CN108712945A (zh) * 2016-01-08 2018-10-26 弗鲁特科尔股份有限公司 呈轻质结构形式的具有多个联接传动装置的机器人
CN108712945B (zh) * 2016-01-08 2022-02-08 弗鲁特科尔机器人股份有限公司 机器人
WO2020039508A1 (ja) * 2018-08-21 2020-02-27 株式会社安川電機 搬送システムおよび搬送方法
CN109623804A (zh) * 2018-12-20 2019-04-16 武汉理工大学 一种可搬运重负荷的轻型机械臂

Similar Documents

Publication Publication Date Title
JP2000198091A (ja) 複数腕協調ロボットシステム
CN101913144B (zh) 移动机械臂
US8326454B2 (en) Power assist apparatus, and its control method
CN104526685B (zh) 含平行四边形支链的冗余驱动平面二自由度并联机械手
JP2007118176A (ja) 移動型マニピュレータ
CN104589333A (zh) 具有五自由度的码垛机械臂
CN114482583A (zh) 一种砌砖设备
CN113119079A (zh) 一种五轴机械臂
CN113183184A (zh) 一种具有重力补偿的六自由度力反馈遥操作主手
JP2001054889A (ja) 組立用垂直多関節型ロボット
JP4669801B2 (ja) 無慣性タイプの荷重取扱装置
JP2020062715A (ja) ロボットおよび第1アーム部材
JP2002036154A (ja) 自立型ワーク移送装置
KR101707831B1 (ko) 수평유지 유닛을 구비한 다기능 고정형 로봇
CN106903495A (zh) 一种用于大型零件对准装配操作的机器人机构
JP3415611B2 (ja) マニピュレータの姿勢角度制御装置
CN103962847A (zh) 双向爬行轻型移动式并联法向制孔装置
CN215825312U (zh) 一种五轴机械臂
JPH0750412B2 (ja) ロボツトの制御装置
US11667043B2 (en) Counterbalance mechanism for robotic assist device
JP2001211517A (ja) 配電線作業ロボット
WO2013183190A1 (ja) ロボットシステム、ロボット制御装置、及びロボットシステムの制御方法
Chandak et al. Mobile gantry robot for pick & place application
CN213674118U (zh) 一种轻量型六自由度机械臂
JP2001334426A (ja) 汎用式治具における機種切換装置