JP2017024160A - Processing device and workpiece production method - Google Patents
Processing device and workpiece production method Download PDFInfo
- Publication number
- JP2017024160A JP2017024160A JP2016098713A JP2016098713A JP2017024160A JP 2017024160 A JP2017024160 A JP 2017024160A JP 2016098713 A JP2016098713 A JP 2016098713A JP 2016098713 A JP2016098713 A JP 2016098713A JP 2017024160 A JP2017024160 A JP 2017024160A
- Authority
- JP
- Japan
- Prior art keywords
- axis
- workpiece
- robot
- arm
- distance
- 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.)
- Granted
Links
Images
Abstract
Description
本開示は、加工装置及びワークの生産方法に関する。 The present disclosure relates to a machining apparatus and a workpiece production method.
特許文献１には、乗用車の車体パネル等をワークとして保持するワーク固定台と、ワークにスポット溶接を施すロボットとを備えるスポット溶接装置が開示されている。
ロボットを用いた加工装置においては、設備構築容易化の観点又はロボットの台数削減の観点等から、個々のロボットでワークの広範囲に加工を施し得る装置が望まれている。そこで本開示は、個々のロボットでワークの広範囲に加工を施すことが可能な加工装置及び生産方法を提供することを目的とする。 In a processing apparatus using a robot, an apparatus capable of processing a wide range of workpieces with individual robots is desired from the viewpoint of facilitating equipment construction or the reduction of the number of robots. Therefore, an object of the present disclosure is to provide a machining apparatus and a production method capable of machining a wide range of workpieces with individual robots.
本開示に係る加工装置は、互いに直列に接続された旋回部、第１腕部、第２腕部、手首部及び先端部と、旋回部を第１軸線まわりに旋回させる第１アクチュエータと、第１腕部を第２軸線まわりに揺動させる第２アクチュエータと、第２腕部を第３軸線まわりに揺動させる第３アクチュエータと、先端部の姿勢を調節する複数の姿勢調節アクチュエータと、第２軸線及び第３軸線の間の距離を調節する距離調節アクチュエータと、先端部に設けられ、ワークに対して加工を施すエンドエフェクタと、を有する第１ロボットを備え、第１ロボットは、ワークに正対した状態で、距離を最長にして第２軸線まわりに第１腕部を回転させた場合に、第１腕部の先端部又は第２腕部の基端部がワークに干渉するように位置する。 A processing apparatus according to the present disclosure includes a swivel unit, a first arm unit, a second arm unit, a wrist unit, and a tip unit that are connected in series with each other, a first actuator that swivels the swivel unit around a first axis, A second actuator that swings one arm portion around the second axis, a third actuator that swings the second arm portion around the third axis, a plurality of posture adjustment actuators that adjust the posture of the tip portion, A first robot having a distance adjusting actuator that adjusts a distance between the two axes and the third axis, and an end effector that is provided at a distal end and performs processing on the workpiece; When the first arm is rotated around the second axis with the distance being the longest in the face-to-face state, the distal end of the first arm or the base end of the second arm interferes with the workpiece. To position.
本開示に係るワークの生産方法は、上記加工装置を用い、ワークの複数の加工対象部位にエンドエフェクタを移動させるように第１ロボットを制御することと、エンドエフェクタが加工対象部位に配置された状態で、エンドエフェクタにより当該加工対象部位に加工を施すように第１ロボットを制御することと、を含み、ワークの複数の加工対象部位にエンドエフェクタを移動させるように第１ロボットを制御することは、第２軸線及び第３軸線の間の距離を距離調節アクチュエータにより変化させながら、第１腕部の基端より高い位置及び当該基端より低い位置の間でエンドエフェクタを移動させることを含む。 In the workpiece production method according to the present disclosure, the first robot is controlled so as to move the end effector to a plurality of machining target portions of the workpiece using the machining apparatus, and the end effector is arranged at the machining target portion. And controlling the first robot so as to process the processing target part by the end effector, and controlling the first robot to move the end effector to a plurality of processing target parts of the workpiece. Includes moving the end effector between a position higher than the base end of the first arm and a position lower than the base end while changing the distance between the second axis and the third axis by the distance adjusting actuator. .
本開示によれば、個々のロボットでワークの広範囲に加工を施すことが可能となる。 According to the present disclosure, it is possible to process a wide range of workpieces with individual robots.
以下、実施形態について図面を参照しつつ詳細に説明する。説明において、同一要素又は同一機能を有する要素には同一の符号を付し、重複する説明を省略する。 Hereinafter, embodiments will be described in detail with reference to the drawings. In the description, the same elements or elements having the same functions are denoted by the same reference numerals, and redundant description is omitted.
１．第１実施形態
〔加工装置〕
図１に示すように、加工装置１は、２台のロボット１０（第１ロボット）と、コントローラ１００と、プログラミングペンダント１２０とを備える。
1. First embodiment [processing apparatus]
As shown in FIG. 1, the
（ロボット）
ロボット１０は、例えば自動車ボディ等のワークＷに対して加工を行うものである。一例として、ロボット１０は、基台１１と、旋回部１２と、第１腕部１３と、第２腕部１４と、手首部１５と、先端部１６と、エンドエフェクタ１７と、第１アクチュエータ２１と、第２アクチュエータ２２と、第３アクチュエータ２３と、第４アクチュエータ２４と、第５アクチュエータ２５と、第６アクチュエータ２６と、第７アクチュエータ２７とを備える。
(robot)
The
基台１１は、床面（設置面）に固定されており、ロボット１０全体を支持する。すなわち複数のロボット１０の全てが設置面に固定されている。
The
旋回部１２、第１腕部１３、第２腕部１４、手首部１５及び先端部１６は互いに直列に接続されている。旋回部１２は、基台１１上に設けられており、鉛直な（図示ｚ軸に沿った）第１軸線Ａｘ１まわりに旋回可能である。以下の説明において、「先端」は先端部１６側の端を意味し、「先端部」は先端及びその近傍部分を意味する。「基端」は基台１１側の端を意味し、「基端部」は基端及びその近傍部分を意味する。
The turning
第１腕部１３は、旋回部１２及び第１腕部１３の接続部分を通る水平な第２軸線Ａｘ２まわりに揺動可能である。
The
第２腕部１４は、第１腕部１３及び第２腕部１４の接続部分を通る水平な第３軸線Ａｘ３まわりに揺動可能である。第３軸線Ａｘ３は、第２軸線Ａｘ２に対して平行である。第２腕部１４は、その中心軸線に沿う第５軸線Ａｘ５まわりに旋回可能である。
The
手首部１５は、第２腕部１４及び手首部１５の接続部分を通る第４軸線Ａｘ４まわりに揺動可能である。
The
先端部１６は、手首部１５の中心軸線に沿う第６軸線Ａｘ６まわりに旋回可能である。
The
エンドエフェクタ１７は、例えばスポット溶接装置であり、先端部１６に設けられている。一例として、エンドエフェクタ１７は、先端部１６に対して着脱自在に取り付けられており、他のエンドエフェクタ―と交換可能となっている。エンドエフェクタ１７は先端部１６に一体化されていてもよい。エンドエフェクタ１７は加工用のツールであればどのようなものであってもよく、スポット溶接装置に限られない。例えばエンドエフェクタ１７は、アーク溶接装置であってもよいし、溶接以外の作業を行うカッター、ネジ締め装置等であってもよい。
The
ここで、第１腕部１３は、互いに直列に接続されたリンク１３Ａ，１３Ｂにより構成されており、リンク１３Ａが旋回部１２に接続され、リンク１３Ｂが第２腕部１４に接続されている。第１腕部１３は、リンク１３Ａ，１３Ｂの接続部を通る第７軸線Ａｘ７まわりに屈曲可能である。換言すると、リンク１３Ｂは、リンク１３Ａ，１３Ｂの接続部を通る第７軸線Ａｘ７まわりに揺動可能である。第７軸線Ａｘ７は、第２軸線Ａｘ２及び第３軸線Ａｘ３に対して平行である。
Here, the
第１アクチュエータ２１は、例えば基台１１に設けられており、旋回部１２を第１軸線Ａｘ１まわりに旋回させる。
The first actuator 21 is provided on the
第２アクチュエータ２２は、例えば旋回部１２に設けられており、第１腕部１３を第２軸線Ａｘ２まわりに揺動させる。
The
第３アクチュエータ２３は、例えば第１腕部１３の先端部に設けられており、第２腕部１４を第３軸線Ａｘ３まわりに揺動させる。
The
第５アクチュエータ２５は、例えば第２腕部１４の基端部に設けられており、第２腕部１４を第５軸線Ａｘ５まわりに旋回させる。第２腕部１４には手首部１５が接続されているので、第２腕部１４を旋回させることは手首部１５を旋回させることに相当する。即ち第５アクチュエータ２５は、手首部１５を第５軸線Ａｘ５まわりに旋回させる。
The
第４アクチュエータ２４は、例えば第２腕部１４の先端部に設けられており、手首部１５を第４軸線Ａｘ４まわりに揺動させる。
The
第６アクチュエータ２６は、例えば手首部１５に設けられており、先端部１６を第６軸線Ａｘ６まわりに旋回させる。
The sixth actuator 26 is provided, for example, on the
第４アクチュエータ２４、第５アクチュエータ２５及び第６アクチュエータ２６は、先端部１６の姿勢を調節する複数の姿勢調節アクチュエータの一例である。
The
第７アクチュエータ２７（距離調節アクチュエータ）は、第２軸線Ａｘ２及び第３軸線Ａｘ３の間の距離Ｌ１を調節する。図２に示すように、第７アクチュエータ２７は、最長距離Ｌ１１及び最短距離Ｌ１２の間で距離Ｌ１を調節する。
The seventh actuator 27 (distance adjustment actuator) adjusts the distance L1 between the second axis Ax2 and the third axis Ax3. As shown in FIG. 2, the
図１に示すように、第７アクチュエータ２７は、例えばリンク１３Ａの先端部に設けられており、第１腕部１３を第７軸線Ａｘ７まわりに屈曲させる。換言すると、第７アクチュエータ２７は、リンク１３Ｂを第７軸線Ａｘ７まわりに揺動させる。この構成において、最長距離Ｌ１１は、第１腕部１３が屈曲していない状態（リンク１３Ａに対しリンク１３Ｂが傾いていない状態）における距離Ｌ１である。最短距離Ｌ１２は、第７アクチュエータ２７の可動限界まで第１腕部１３を屈曲させた状態における距離Ｌ１である。
As shown in FIG. 1, the
第７アクチュエータ２７は、必ずしも第１腕部１３を屈曲させるものでなくてよく、第２軸線Ａｘ２及び第３軸線Ａｘ３の間の距離Ｌ１を調節できればどのようなものであってもよい。例えば第７アクチュエータ２７は、第１腕部１３を伸縮させる直動アクチュエータであってもよい。
The
このように、ロボット１０は、先端部１６の位置及び姿勢を自在に変更可能な所謂６軸ロボットに対し、第２軸線Ａｘ２及び第３軸線Ａｘ３の間の距離Ｌ１を調節する冗長自由度を追加したものである。アクチュエータ２１〜２６は、例えば電動のサーボモータ、ギアヘッド及びブレーキ等により構成されている。サーボモータ、ギアヘッド及びブレーキ等は、必ずしも軸線Ａｘ１〜Ａｘ７上に配置されていなくてもよく、これらの軸線から離れた位置に配置されていてもよい。
As described above, the
（搬送装置）
加工装置１は、搬送装置３０を更に備えてもよい。搬送装置３０は、ワークＷ及びロボット１０の相対位置を変更するようにワークＷを搬送するものである。一例として、搬送装置３０はパレット３１（ワーク配置部）と搬送アクチュエータ３２とを有する。パレット３１はワークＷを支持する。搬送アクチュエータ３２は、例えば電動モータ又は油圧モータ等を動力源として、パレット３１を水平な一直線に沿って（図示ｘ軸に沿って）搬送する。
(Transport device)
The
（ロボットの配置）
図２の（ａ）に示すように、ロボット１０は、ワークＷに正対した状態で、距離Ｌ１を最長距離Ｌ１１として第２軸線Ａｘ２まわりに第１腕部１３を回転させた場合に、第１腕部１３の先端部ＤＰ１又は第２腕部１４の基端部ＰＰ２がワークＷに干渉するように位置する（以下、この条件を「配置条件１」という。）。
(Robot placement)
As shown in FIG. 2A, when the
図２の（ｂ）に示すように、ロボット１０は、ワークＷに正対した状態で、距離Ｌ１を最短距離Ｌ１２として第２軸線Ａｘ２まわりに第１腕部１３を回転させた場合に、第１腕部１３の先端部ＤＰ１及び第２腕部１４の基端部ＰＰ２がワークＷに干渉しないように位置してもよい（以下、この条件を「配置条件２」という。）。
As shown in FIG. 2B, when the
なお、「正対」とは、図３に示すように、第１腕部１３の基端ＰＥ１（第１腕部１３の中心軸線と第２軸線Ａｘ２との交点）が平面視で第１軸線Ａｘ１とワークＷとの間に位置し、第１軸線Ａｘ１からワークＷへの垂線ＰＬ上に位置する状態を意味する。
In addition, as shown in FIG. 3, “directly facing” means that the base end PE1 of the first arm portion 13 (intersection of the central axis of the
図４を参照し、上記配置条件１，２を満たすための詳細な条件を例示する。図４に示すように、ロボット１０は、ワークＷに正対した状態にて、ワークＷから第１腕部１３の基端ＰＥ１までの距離が第３長Ｌ１３未満となるように位置してもよい（以下、この条件を「配置条件１ａ」という。）。第３長Ｌ１３は、距離Ｌ１を最長距離Ｌ１１とし、第２軸線Ａｘ２及び第３軸線Ａｘ３に直交する直線に対し第２腕部１４を垂直にした状態における、第１腕部１３の基端ＰＥ１から第２腕部１４の外周面の遠位部分までの距離である。「第２腕部１４の外周面の遠位部分」とは、第２腕部１４の外周面のうち第２軸線Ａｘ２の逆側の部分である。ロボット１０の配置が配置条件１ａを満たす場合、上記配置条件１も満たされる。
With reference to FIG. 4, detailed conditions for satisfying the
ロボット１０は、ワークＷに正対した状態にて、ワークＷから第１腕部１３の基端ＰＥ１までの距離が第４長Ｌ１４を超えるように位置してもよい（以下、この条件を「配置条件２ａ」という。）。第４長Ｌ１４は、距離Ｌ１を最短距離Ｌ１２とし、第２軸線Ａｘ２及び第３軸線Ａｘ３に直交する直線に対し第２腕部１４を垂直にした状態における、第１腕部１３の基端ＰＥ１から第２腕部１４の外周面の遠位部分までの距離である。ロボット１０の配置が配置条件２ａを満たす場合、上記配置条件２も満たされる。
The
図５に示すように、ロボット１０は、ワークＷに正対した状態にて、ワークＷにおける最高位置の加工対象部位Ｐ１から第１腕部１３の基端ＰＥ１までの距離と、最低位置の加工対象部位Ｐ１から第１腕部１３の基端ＰＥ１までの距離とが、式（１）で求まる長さＬａ以下となるように位置してもよい。
Ｌａ＝Ｌ１１＋Ｌ２１＋Ｌ３１・・・（１）
Ｌ１１：第２軸線Ａｘ２から第３軸線Ａｘ３までの最長距離
Ｌ２１：第３軸線Ａｘ３から第４軸線Ａｘ４までの距離
Ｌ３１：第４軸線Ａｘ４からエンドエフェクタ１７までの距離
なお、「エンドエフェクタ１７までの距離」とは、エンドエフェクタ１７のうち加工対象部位Ｐ１に作用する部位（以下、「作用部」という。）までの距離を意味する。
As shown in FIG. 5, the
La = L11 + L21 + L31 (1)
L11: longest distance from the second axis Ax2 to the third axis Ax3 L21: distance from the third axis Ax3 to the fourth axis Ax4 L31: distance from the fourth axis Ax4 to the
図６に示すように、ロボット１０は、ワークＷに正対した状態にて、ワークＷにおける最高位置の加工対象部位Ｐ１に対して加工を施し得るようにエンドエフェクタ１７を配置した場合の第４軸線Ａｘ４の位置から第１腕部１３の基端ＰＥ１までの距離と、ワークＷにおける最低位置の加工対象部位Ｐ１に対して加工を施し得るようにエンドエフェクタ１７を配置した場合の第４軸線Ａｘ４の位置から第１腕部１３の基端ＰＥ１までの距離とが、式（２）で求まる長さＬｂ以下となるように位置してもよい。
Ｌｂ＝Ｌ１１＋Ｌ２１・・・（２）
As shown in FIG. 6, the
Lb = L11 + L21 (2)
加工対象部位Ｐ１に対してエンドエフェクタ１７を配置するとは、エンドエフェクタ１７の上記作用部を加工対象部位Ｐ１に配置することを意味する。加工対象部位Ｐ１に加工を施し得るエンドエフェクタ１７の姿勢は、加工対象部位Ｐ１の状態に応じて定まる。例えばエンドエフェクタ１７がスポット溶接装置である場合には、溶接対象を電極で挟み得るようにエンドエフェクタ１７の姿勢が定まる。一例として、図６は、加工対象部位Ｐ１に加工を施し得るエンドエフェクタ１７の姿勢が鉛直である場合（手首部１５の中心軸線が鉛直軸線に沿う場合）を例示している。このような場合も想定し、ロボット１０は、ワークＷに正対した状態にて、手首部１５を鉛直下方に向けてワークＷにおける最高位置の加工対象部位Ｐ１にエンドエフェクタ１７を配置した場合の第４軸線Ａｘ４の位置から第１腕部１３の基端ＰＥ１までの距離と、手首部１５を鉛直上方に向けてエンドエフェクタ１７をワークＷにおける最低位置の加工対象部位Ｐ１に配置した場合の第４軸線Ａｘ４の位置から第１腕部１３の基端ＰＥ１までの距離とが、上記式（２）で求まる長さＬｂ以下となるように位置してもよい。
Arranging the
図７に示すように、ロボット１０は、第１腕部１３の基端ＰＥ１の高さが式（３）で求まる高さＨａ以上となるように位置してもよい。
Ｈａ＝ＨＨ−Ｌ２１・ｃｏｓθ−Ｌ１１・・・（３）
ＨＨ：前記手首部を鉛直下方に向けて前記エンドエフェクタを前記ワークにおける最高位置の加工対象部位に配置した場合の前記第４軸線の高さ
θ：第３軸線Ａｘ３及び第４軸線Ａｘ４に直交する直線と、手首部１５の中心軸線との角度の最小値
なお、「角度の最小値」とは、可動範囲における最小値を意味する。
As shown in FIG. 7, the
Ha = HH−L21 · cos θ−L11 (3)
HH: Height of the fourth axis when the end effector is disposed at the highest processing target site in the workpiece with the wrist facing vertically downward θ: orthogonal to the third axis Ax3 and the fourth axis Ax4 The minimum value of the angle between the straight line and the central axis of the
ロボット１０は、第１腕部１３の基端ＰＥ１の高さが式（４）で求まる高さＨｂ以下となるように位置してもよい。
Ｈｂ＝ＨＬ＋Ｌ２１・ｃｏｓθ＋Ｌ１１・・・（４）
ＨＬ：前記手首部を鉛直上方に向けて前記エンドエフェクタを前記ワークにおける最低位置の加工対象部位に配置した場合の前記第４軸線の高さ
The
Hb = HL + L21 · cos θ + L11 (4)
HL: the height of the fourth axis when the end effector is arranged at the lowest processing target site in the workpiece with the wrist facing vertically upward
図８に示すように、ワークＷに正対した状態にて、手首部１５を鉛直下方に向けてエンドエフェクタ１７をワークＷにおける最高位置の加工対象部位Ｐ１に配置した場合の第４軸線Ａｘ４の位置から式（５）で求まる距離Ｌｃで手前側にシフトし、式（６）で求まる高さＨｃで下方にシフトした位置から第１腕部１３の基端ＰＥ１までの距離と、手首部１５を鉛直上方に向けてエンドエフェクタ１７をワークＷにおける最低位置の加工対象部位Ｐ１に配置した場合の第４軸線Ａｘ４の位置から式（５）で求まる距離Ｌｃで手前側にシフトし、式（６）で求まる高さＨｃで上方にシフトした位置から第１腕部１３の基端ＰＥ１までの距離とが、最長距離Ｌ１１以下となるように位置してもよい。
Ｌｃ＝Ｌ２１・ｓｉｎθ・・・（５）
Ｈｃ＝Ｌ２１・ｃｏｓθ・・・（６）
As shown in FIG. 8, the fourth axis Ax4 when the
Lc = L21 · sin θ (5)
Hc = L21 · cos θ (6)
２台のロボット１０は、搬送装置３０による搬送方向（図示ｘ軸に沿う方向）に直交する方向（図示ｙ軸に沿う方向）でワークＷを挟むように配置されている。以下、図示ｙ軸の正の方向を「左方向」とし、図示ｙ軸の負の方向を「右方向」とする。左側のロボット１０は、ワークＷの左側の加工対象部位Ｐ１に対して加工を行い、右側のロボット１０は、ワークＷの右側の加工対象部位Ｐ２に対して加工を行う。
The two
左側のロボット１０は、当該ロボット１０側（左側）からの全加工対象部位Ｐ１に対し、ワークＷに干渉することなく加工を行うことが可能となるように配置されている。一例として、左側のロボット１０は、最上部の加工対象部位Ｐ１及び最下部の加工対象部位Ｐ１の両方に対し、ワークＷに干渉することなくエンドエフェクタ１７を到達させられるように配置されている。
The
右側のロボット１０は、当該ロボット１０側（右側）からの全加工対象部位Ｐ２に対し、ワークＷに干渉することなく加工を行うことが可能となるように配置されている。
一例として、右側のロボット１０は、最上部の加工対象部位Ｐ２及び最下部の加工対象部位Ｐ２の両方に対し、ワークＷに干渉することなくエンドエフェクタ１７を到達させられるように配置されている。
The
As an example, the
（コントローラ及びプログラミングペンダント）
コントローラ１００は、２台のロボット１０及び搬送装置３０を制御する装置である。プログラミングペンダント１２０は、有線又は無線により、コントローラ１００に対するデータの入出力を行う装置である。
(Controller and programming pendant)
The
コントローラ１００は、機能的な構成として、目標取得部１１１と、第１算出部１１２と、判定部１１３と、第２算出部１１４と、出力部１１５と、蓄積部１１６とを有する。
The
蓄積部１１６は、ロボット１０の動作パターンを蓄積する。動作パターンは、例えばアクチュエータ２１〜２７の動作目標値の時系列データである。
The
目標取得部１１１は、先端部１６の位置・姿勢の目標値をプログラミングペンダント１２０から取得する。目標取得部１１１が取得する位置・姿勢の目標値は、ユーザによりプログラミングペンダント１２０に入力されたものであってもよいし、プログラミングペンダント１２０を介して記録媒体から読み込まれたものであってもよい。
The
第１算出部１１２は、距離調節用の第７アクチュエータ２７の動作目標値を初期値に固定した条件にて、位置・姿勢の目標値に対応するアクチュエータ２１〜２６の動作目標値を算出し、アクチュエータ２１〜２７の動作目標値を蓄積部１１６に記憶させる。
The
第７アクチュエータ２７の動作目標値は、第２軸線Ａｘ２及び第３軸線Ａｘ３の間の距離Ｌ１を調節する動作量の目標値であり、例えば第１腕部１３の屈曲角の目標値である。第１腕部１３の屈曲角の初期値は例えば０°である。
The operation target value of the
第１アクチュエータ２１の動作目標値は例えば旋回部１２の旋回角の目標値である。第２アクチュエータ２２の動作目標値は例えば第１腕部１３の揺動角の目標値である。第３アクチュエータ２３の動作目標値は例えば第２腕部１４の揺動角の目標値である。第５アクチュエータ２５の動作目標値は例えば手首部１５の旋回角の目標値である。第４アクチュエータ２４の動作目標値は例えば手首部１５の揺動角の目標値である。第６アクチュエータ２６の動作目標値は先端部１６の旋回角の目標値である。
The operation target value of the first actuator 21 is a target value of the turning angle of the turning
アクチュエータ２１〜２６の動作目標値は、例えば逆運動学演算により算出される。第１算出部１１２は、アクチュエータ２１〜２７の動作目標値の算出結果を蓄積部１１６に記憶させる。
The operation target values of the actuators 21 to 26 are calculated by, for example, inverse kinematic calculation. The
判定部１１３は、蓄積部１１６に記憶された動作目標値が出力可能か否かを判定する。例えば判定部１１３は、蓄積部１１６に記憶された動作目標値でアクチュエータ２１〜２７を動作させるとロボット１０とワークＷとの干渉が生じる場合に、当該動作目標値が出力不可であると判定する。
The
判定部１１３は、アクチュエータ２１〜２６の少なくともいずれかを判定対象とし、判定対象のアクチュエータについて、第１算出部１１２により算出された動作目標値が許容範囲外である場合にも、当該動作目標値が出力不可であると判定してもよい。判定部１１３は、アクチュエータ２１〜２６の全てを判定対象としてもよいし、アクチュエータ２１〜２６の一部（例えば第２アクチュエータ２２、第３アクチュエータ２３及び第４アクチュエータ２４）のみを判定対象としてもよい。判定部１１３は、第３アクチュエータ２３及び第４アクチュエータ２４のみを判定対象としてもよいし、第３アクチュエータ２３及び第４アクチュエータ２４のいずれか一方のみを判定対象としてもよい。許容範囲は、判定対象のアクチュエータにより駆動される部分の動作量が可動範囲内となるように設定される。例えば第３アクチュエータ２３が判定対象である場合に、第３アクチュエータ２３の動作目標値の許容範囲は、第２腕部１４の揺動角が可動範囲内となるように設定される。
The
第２算出部１１４は、判定部１１３により動作目標値が出力不可であると判定された場合に、出力可となるようにアクチュエータ２１〜２７の動作目標値を修正する。例えば第２算出部１１４は、ロボット１０とワークＷとの干渉が生じることが判定部１１３により判定された場合に、第２軸線Ａｘ２及び第３軸線Ａｘ３の距離Ｌ１を小さくしてロボット１０とワークＷとの干渉を回避するようにアクチュエータ２１〜２７の動作目標値を修正する。具体的に、第２算出部１１４は、ロボット１０とワークＷとの干渉を回避するように拘束条件を設定し、その拘束条件を適用した逆運動学演算によりアクチュエータ２１〜２７の動作目標値を修正してもよい。
When the
第２算出部１１４は、少なくとも一つの判定対象のアクチュエータについて動作目標値が許容範囲外となった場合に、当該動作目標値が許容範囲内に収まるように、アクチュエータ２１〜２７の動作目標値を修正してもよい。具体的に、第２算出部１１４は、動作目標値が許容範囲外となっているアクチュエータについて、当該動作目標値が許容範囲内に収まるように拘束条件を設定した上で、その拘束条件を適用した逆運動学演算によりアクチュエータ２１〜２７の動作目標値を修正してもよい。
The
第２算出部１１４は、距離調節用の第７軸線Ａｘ７がワークＷから遠ざかる方向に第１腕部１３を屈曲させるように上記拘束条件を設定し、アクチュエータ２１〜２７の動作目標値を算出してもよい。
The
第２算出部１１４は、アクチュエータ２１〜２７の動作目標値の算出結果を蓄積部１１６に記憶させ、直前の算出結果を上書きする。
The
出力部１１５は、動作目標値に応じてアクチュエータ２１〜２７を制御する。具体的に、出力部１１５は、アクチュエータ２１〜２７による各部の動作量が設定された動作目標値に略一致するように、アクチュエータ２１〜２７を制御する。出力部１１５は、アクチュエータ２１〜２７に加えて搬送アクチュエータ３２も制御する。
The
コントローラ１００は、先端部１６の位置・姿勢の目標値を取得すること、距離調節用の第７アクチュエータ２７の動作目標値を固定した条件にて、位置・姿勢の目標値に対応するアクチュエータ２１〜２６の動作目標値を算出すること、算出された動作目標値が出力可能であるかを判定すること、動作目標値が出力不可であると判定した場合に、出力可となるようにアクチュエータ２１〜２７の動作目標値を修正すること、動作目標値に応じてアクチュエータ２１〜２７を制御すること、を実行するように構成されていればよいので、そのハードウェア構成は必ずしも目標取得部１１１、第１算出部１１２、判定部１１３、第２算出部１１４及び出力部１１５及び蓄積部１１６に分離していなくてもよい。
The
図９は、コントローラ１００のハードウェア構成の一例を示す図である。図９に例示されるコントローラ１００は、回路１３０を有する。回路１３０は、プロセッサ１３１と、メモリ１３２と、ストレージ１３３と、入出力ポート１３４と、複数のモータドライバ１３６とを有する。入出力ポート１３４は、プログラミングペンダント１２０及び複数のモータドライバ１３６に対するデータの入出力を行う。複数のモータドライバ１３６は、２台のロボット１０のアクチュエータ２１〜２７及び搬送アクチュエータ３２をそれぞれ制御する。プロセッサ１３１は、メモリ１３２及びストレージ１３３の少なくとも一方と協働してプログラムを実行し、入出力ポート１３４を介したデータの入出力を行うことで、コントローラ１００を目標取得部１１１、第１算出部１１２、判定部１１３、第２算出部１１４、出力部１１５及び蓄積部１１６として機能させる。
FIG. 9 is a diagram illustrating an example of a hardware configuration of the
コントローラ１００のハードウェア構成は、必ずしもプログラムの実行により各機能をなすものに限られない。例えば目標取得部１１１、第１算出部１１２、判定部１１３、第２算出部１１４、出力部１１５及び蓄積部１１６の少なくとも一部はその機能に特化した論理回路により構成されていてもよいし、当該論理回路を集積したＡＳＩＣ（Ａｐｐｌｉｃａｔｉｏｎ Ｓｐｅｃｉｆｉｃ ｉｎｔｅｇｒａｔｅｄ ｃｉｒｃｕｉｔ）により構成されていてもよい。
The hardware configuration of the
〔制御方法〕
続いて、本開示に係る制御方法の一例として、コントローラ１００によるロボット１０及び搬送装置３０の制御手順を説明する。
[Control method]
Subsequently, a control procedure of the
（制御手順の概要）
図１０に示すように、まずコントローラ１００はステップＳ０１を実行する。ステップＳ０１では、第１算出部１１２及び第２算出部１１４の少なくとも一方がアクチュエータ２１〜２７の動作目標値の算出結果を蓄積部１１６に記憶させ、２台のロボット１０の動作パターンを構築する。２台のロボット１０の動作パターンは、ワークＷに対する加工を行うように構築される。
(Outline of control procedure)
As shown in FIG. 10, first, the
次に、コントローラ１００はステップＳ０２〜Ｓ０４を実行する。ステップＳ０２では、ワークＷの搬送を開始するように出力部１１５が搬送アクチュエータ３２を制御する。ステップＳ０３では、ワークＷに対する加工を実行するように、出力部１１５が２台のロボット１０を制御する。即ち出力部１１５は、蓄積部１１６に記憶された動作目標値に応じて２台のロボット１０のアクチュエータ２１〜２７を制御する。ステップＳ０４では、ワークＷの搬送を終了するように出力部１１５が搬送アクチュエータ３２を制御する。
Next, the
次に、コントローラ１００はステップＳ０５を実行する。ステップＳ０５では、加工終了の指令が入力されているか否かを出力部１１５が判定する。加工終了の指令は、例えばプログラミングペンダント１２０を介して入力される。加工終了の指令が入力されていない場合、コントローラ１００は処理をステップＳ０２に戻す。これにより、同一の加工手順が繰り返される。加工終了の指令が入力されている場合、コントローラ１００は処理を終了する。
Next, the
（動作パターンの生成手順）
続いて上記ステップＳ０１における動作パターンの生成手順について、より詳細に説明する。図１１に示すように、まずコントローラ１００はステップＳ１１を実行する。ステップＳ１１では、目標取得部１１１が、先端部１６の位置・姿勢の目標値をプログラミングペンダント１２０から取得する。
(Operation pattern generation procedure)
Next, the operation pattern generation procedure in step S01 will be described in more detail. As shown in FIG. 11, the
次に、コントローラ１００はステップＳ１２，Ｓ１３を実行する。ステップＳ１２では、第１算出部１１２が、距離調節用の第７アクチュエータ２７の動作目標値を初期値に設定する。例えば第１算出部１１２は、第１腕部１３の屈曲角を０°に設定する。ステップＳ１３では、第１算出部１１２が、第７アクチュエータ２７の動作目標値を初期値に固定した条件にて、位置・姿勢の目標値に対応するアクチュエータ２１〜２６の動作目標値を算出し、アクチュエータ２１〜２７の算出結果を蓄積部１１６に記憶させる。
Next, the
次に、コントローラ１００はステップＳ１４を実行する。ステップＳ１４では、判定部１１３が、蓄積部１１６に記憶された動作目標値が出力可能か否かを判定する。例えば判定部１１３は、蓄積部１１６に記憶された動作目標値でアクチュエータ２１〜２７を動作させた場合に、ロボット１０とワークＷとの干渉が生じる場合に、当該動作目標値が出力不可であると判定する。
Next, the
判定部１１３は、アクチュエータ２１〜２６の少なくともいずれかを判定対象とし、判定対象のアクチュエータについて動作目標値が許容範囲外である場合にも、当該動作目標値が出力不可であると判定してもよい。
The
ステップＳ１４において、動作目標値が出力不可であると判定された場合に、コントローラ１００はステップＳ１５，Ｓ１６を実行する。
When it is determined in step S14 that the operation target value cannot be output, the
ステップＳ１５では、動作目標値を出力可とするように、第２算出部１１４が第７アクチュエータ２７の動作目標値を設定する。例えば第２算出部１１４は、距離Ｌ１を短縮してロボット１０とワークＷとの干渉を回避するように第７アクチュエータ２７の動作目標値を設定する。第２算出部１１４は、他のアクチュエータにおいて許容範囲外となっている動作目標値の一部を分担するように、第７アクチュエータ２７の動作目標値を設定してもよい。
In step S15, the
ステップＳ１６では、第２算出部１１４が、第７アクチュエータ２７の動作目標値をステップＳ１５における設定値に固定した条件にて、位置・姿勢の目標値に対応するアクチュエータ２１〜２６の動作目標値を算出する。第２算出部１１４は、アクチュエータ２１〜２７の動作目標値の算出結果を蓄積部１１６に記憶させ、直前の算出結果を上書きする。
In step S16, the
その後、コントローラ１００は処理をステップＳ１４に戻す。これにより、動作目標値が出力可となるまでステップＳ１４〜Ｓ１５が繰り返される。
Thereafter, the
ステップＳ１５，Ｓ１６において、第２算出部１１４は、距離調節用の第７軸線Ａｘ７がワークＷから遠ざかる方向に第１腕部１３を屈曲させるように、アクチュエータ２１〜２７の動作目標値を算出してもよい。即ちコントローラ１００は、第７軸線Ａｘ７がワークＷから遠ざかる方向に第１腕部１３を屈曲させるようにアクチュエータ２１〜２７を制御するものであってもよい。
In Steps S15 and S16, the
第２算出部１１４によるアクチュエータ２１〜２７の動作目標値の算出手順は上述したものに限られない。例えば、ステップＳ１５において、第７アクチュエータ２７の動作目標値を設定するのに代えて、動作目標値が許容範囲外となっているアクチュエータ自体の動作目標値を許容範囲内の値に設定してもよい。これに対応し、ステップＳ１６においては、アクチュエータ２１〜２６のうちステップＳ１５において動作目標値を設定したアクチュエータを除いたもの、及び第７アクチュエータ２７の動作目標値を算出してもよい。
The calculation procedure of the operation target values of the actuators 21 to 27 by the
ステップＳ１４において、動作目標値が出力可であると判定された場合に、コントローラ１００はステップＳ１７を実行する。ステップＳ１７では、動作パターンの構築が完了したか否かをコントローラ１００が判定する。具体的には、例えば目標取得部１１１が、動作パターンの構築に必要な位置・姿勢の目標値を全て取得したか否かを判定する。位置・姿勢の目標値を全て取得したか否かは、例えばユーザがプログラミングペンダント１２０に入力した完了指令又はプログラミングペンダント１２０が記録媒体から読み込んだ完了指令に基づいて判定される。
When it is determined in step S14 that the operation target value can be output, the
ステップＳ１７において、動作パターンの構築が完了していないと判定した場合、コントローラ１００は処理をステップＳ１１に戻す。これにより、動作パターンの構築が完了するまでステップＳ１１〜Ｓ１７が繰り返され、アクチュエータ２１〜２７の動作目標値の時系列データが構築される。
If it is determined in step S17 that the construction of the operation pattern has not been completed, the
ステップＳ１７において、動作パターンの構築が完了していると判定した場合、コントローラ１００は処理を終了する。
If it is determined in step S17 that the construction of the operation pattern has been completed, the
（ロボットの動作）
上記構成により、コントローラ１００は、ステップＳ１１〜Ｓ１７により生成された動作パターンにて動作するようにロボット１０を制御する。例えばコントローラ１００は、ワークＷの複数の加工対象部位Ｐ１にエンドエフェクタ１７を移動させるようにロボット１０を制御することと、エンドエフェクタ１７が加工対象部位Ｐ１に配置された状態で、エンドエフェクタ１７により当該加工対象部位Ｐ１に加工を施すようにロボット１０を制御することとを実行する。
(Robot motion)
With the above configuration, the
複数の加工対象部位Ｐ１は、第１腕部１３の基端部より高い位置にある加工対象部位Ｐ１と、第１腕部１３の基端部より低い位置にある加工対象部位Ｐ１とを含む場合がある。この場合、コントローラ１００は、図１２の（ａ）〜（ｆ）に示すように、第２腕部１４の先端部が第１腕部１３の基端部よりワークＷ側に位置する状態で、第１腕部１３の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ１７を移動させるようにロボット１０を制御する。
The plurality of processing target sites P1 include a processing target site P1 that is higher than the base end portion of the
この過程において、第１腕部１３の基端部より高い位置及び当該基端部より低い位置の間で第１腕部１３の先端部が移動する場合もある。すなわち、第１腕部１３の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ１７を移動させるようにロボット１０を制御することは、第１腕部１３の基端部より高い位置及び当該基端部より低い位置の間で第１腕部１３の先端部を移動させるようにロボット１０を制御することを含んでもよい。
In this process, the distal end of the
上述したように、ロボット１０は、ワークＷに正対した状態で、距離Ｌ１を最長距離Ｌ１１として第２軸線Ａｘ２まわりに第１腕部１３を回転させた場合に、第１腕部１３の先端部ＤＰ１又は第２腕部１４の基端部ＰＰ２がワークＷに干渉するように位置する。このため、距離Ｌ１を最長距離Ｌ１１に固定した状態にて、第１腕部１３の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ１７を移動させると、ロボット１０がワークＷに干渉する場合がある。距離Ｌ１を最長距離Ｌ１１に固定した状態にて、第１腕部１３の基端部より高い位置及び当該基端部より低い位置の間で第１腕部１３の先端部を移動させると、ロボット１０がワークＷに干渉する可能性が更に高まる。
As described above, when the
これに対し、ステップＳ１１〜Ｓ１７によれば、距離Ｌ１を短縮してロボット１０とワークＷとの干渉を回避するようにアクチュエータ２１〜２７の動作パターンが生成される。この場合、コントローラ１００は、第１腕部１３の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ１７を移動させる過程で、第２軸線Ａｘ２及び第３軸線Ａｘ３の間の距離Ｌ１を第７アクチュエータ２７により変化させるようにロボット１０を制御する。すなわち、第１腕部１３の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ１７を移動させるようにロボット１０を制御することは、第２軸線Ａｘ２及び第３軸線Ａｘ３の間の距離を第７アクチュエータ２７により変化させるようにロボット１０を制御することを含んでもよい。
On the other hand, according to steps S11 to S17, the operation patterns of the actuators 21 to 27 are generated so as to reduce the distance L1 and avoid the interference between the
〔第１実施形態による効果〕
以上に説明したように、加工装置１によれば、ワークＷに正対した状態で、第２軸線Ａｘ２及び第３軸線Ａｘ３の間の距離Ｌ１を最長距離Ｌ１１として第２軸線Ａｘ２まわりに第１腕部１３を回転させた場合に、第１腕部１３の先端部又は第２腕部１４の基端部が前記ワークに干渉するように、ロボット１０がワークＷに近接する。このため、より遠位の加工対象部位までエンドエフェクタ１７を到達させ易い。ロボット１０がワークＷに近接配置されていても、第７アクチュエータ２７により第２軸線Ａｘ２及び第３軸線Ａｘ３の間の距離Ｌ１を短縮することで、ロボット１０とワークＷとの干渉を回避しながらエンドエフェクタ１７を移動させることができる。従って、近接配置による到達範囲の広域化と、干渉回避による可動範囲の広域化との両立を図り、個々のロボット１０でワークＷの広範囲に加工を施すことができる。
[Effects of First Embodiment]
As described above, according to the
図１３は、第７アクチュエータ２７の作用を例示する図である。図１３中の二点鎖線で示されるロボット１０は、第１腕部１３を屈曲させることなくエンドエフェクタ１７を加工対象部位に配置した場合を示している。二点鎖線で示されるロボット１０は、ワークＷに干渉している。これに対し、実線で示されるロボット１０は、第１腕部１３を屈曲させて第２軸線Ａｘ２及び第３軸線Ａｘ３の間の距離を短縮するように第７アクチュエータ２７を動作させた場合を示している。実線で示されるロボット１０では、先端部１６の位置・姿勢を維持した状態で、第４軸線Ａｘ４及び第２軸線Ａｘ２の間の部分がワークＷから遠ざかり、ワークＷに対するロボット１０の干渉が防止されている。
FIG. 13 is a diagram illustrating the operation of the
ロボット１０は、ワークＷに正対した状態で、距離Ｌ１を最短距離Ｌ１２として第２軸線Ａｘ２まわりに第１腕部１３を回転させた場合には、第１腕部１３の先端部及び第２腕部１４の基端部がワークＷに干渉しないように位置してもよい。この場合、ロボット１０とワークＷとの干渉をより確実に回避できる。従って、近接配置による到達範囲の広域化と、干渉の回避による可動範囲の広域化との両立をより確実に図ることができる。
When the
第２腕部１４の先端部が第１腕部１３の基端部よりワークＷ側に位置する状態で、第１腕部１３の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ１７を移動させるようにロボット１０を制御するコントローラ１００を更に備えてもよい。この場合、近接配置による到達範囲の広域化と、干渉の回避による可動範囲の広域化との両立を可能とする構成を有効に活用し、個々のロボット１０でワークＷの広範囲に加工を施すことができる。
Between the position higher than the base end portion of the
第１腕部１３の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ１７を移動させるようにロボット１０を制御することは、第１腕部１３の基端部より高い位置及び当該基端部より低い位置の間で第１腕部１３の先端部を移動させるようにロボット１０を制御することを含んでもよい。この場合、近接配置による到達範囲の広域化と、干渉の回避による可動範囲の広域化との両立を可能とする構成を更に有効に活用し、個々のロボット１０でワークＷの広範囲に加工を施すことができる。
Controlling the
第１腕部１３の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ１７を移動させるようにロボット１０を制御することは、第２軸線Ａｘ２及び第３軸線Ａｘ３の間の距離Ｌ１を第７アクチュエータ２７により変化させるようにロボット１０を制御することを含んでもよい。この場合、近接配置による到達範囲の広域化と、干渉の回避による可動範囲の広域化との両立を可能とする構成をより確実に活用し、個々のロボットでワークの広範囲に加工を施すことができる。
Controlling the
複数の姿勢調節アクチュエータは、第４軸線Ａｘ４まわりに手首部１５を搖動させる第４アクチュエータ２４を含み、ロボット１０は、ワークＷに正対した状態にて、ワークＷにおける最高位置の加工対象部位から第１腕部１３の基端ＰＥ１までの距離と、最低位置の加工対象部位の両方から第１腕部１３の基端ＰＥ１までの距離とが、上記式（１）で求まる長さＬａ以下となるように位置してもよい。この場合、ワークＷにおける最高位置の加工対象部位及び最低位置の加工対象部位の両方にエンドエフェクタ１７を配置できる。従って、個々のロボット１０でより広範囲に加工を施すことができる。
The plurality of posture adjustment actuators include a
ロボット１０は、ワークＷに正対した状態にて、ワークＷにおける最高位置の加工対象部位に対し、第４軸線Ａｘ４からエンドエフェクタ１７までの距離と等距離で上方にシフトした位置から第１腕部１３の基端ＰＥ１までの距離と、ワークＷにおける最低位置の加工対象部位に対し、第４軸線Ａｘ４からエンドエフェクタ１７までの距離と等距離で下方にシフトした位置から第１腕部１３の基端ＰＥ１までの距離とが、上記式（２）で求まる長さＬｂ以下となるように位置してもよい。この場合、ワークＷにおける最高位置の加工対象部位及び最低位置の加工対象部位の両方に対し、より多様な姿勢でエンドエフェクタ１７を配置できる。従って、個々のロボット１０でより広範囲に加工を施すことができる。
With the
ロボット１０は、第１腕部１３の基端ＰＥ１の高さが上記式（３）で求まる高さＨａ以上となるように位置してもよい。この場合、ワークＷにおける最高位置の加工対象部位に対し、より多様な姿勢でエンドエフェクタ１７を配置できる。従って、個々のロボット１０でより広範囲に加工を施すことができる。
The
ロボット１０は、第１腕部１３の基端ＰＥ１の高さが上記式（４）で求まる高さＨｂ以下となるように位置してもよい。この場合、ワークＷにおける最高位置の加工対象部位及び最低位置の加工対象部位の両方に対し、より多様な姿勢でエンドエフェクタ１７を配置できる。従って、個々のロボット１０でワークＷのより広範囲に加工を施すことができる。
The
ロボット１０がワークＷに対し加工を実行するときに、ワークＷ及びロボット１０の相対位置を変更するようにワークＷ及びロボット１０の少なくとも一方を搬送する搬送装置３０を更に備えてもよい。この場合、搬送装置３０及びロボット１０を協調させることにより、広範囲の加工対象部位に対して先端部１６を適正配置することが可能となる。一方、ワークＷ及びロボット１０の相対的な配置が変わるので、ワークＷに対するロボット１０の干渉の生じ易さも変化する。これに対し、ロボット１０は、先端部１６の位置・姿勢を調整するアクチュエータ２１〜２６に加え、距離調節用の第７アクチュエータ２７を更に有する。このため、先端部１６の位置・姿勢を維持した状態で、基台１１及び先端部１６の間におけるロボット１０の姿勢を自在に変更可能である。これにより、ワークＷ及びロボット１０の相対的な配置の変化に柔軟に対応して相互の干渉を抑制できる。ワークＷを回避し易い特性により、ロボット１０の配置の選択肢も多くなる。従って、容易な生産設備構築が可能となる。
When the
また、ロボット１０の姿勢を自在に変更することで、周辺機器に対するロボット１０の干渉も抑制できる。このため、ロボット１０を高密度に配置することで作業時間を短縮することも可能となる。
In addition, by freely changing the posture of the
ロボット１０は、当該ロボット側からの全加工対象部位に対し、ワークＷに干渉することなく加工を行うことが可能となるように配置されていてもよい。この場合、一台のロボット１０にて当該ロボット１０側からの全加工対象部位に加工を施すこともできるし、同一側に複数のロボット１０を配置し、全加工対象部位をこれらのロボット１０に分担させることもできる。これにより、生産量に応じた柔軟な生産設備構築が可能となる。但し、全加工対象部位に対する加工を可能とするようにロボット１０を配置することは必須ではない。
The
搬送装置３０はワークＷを搬送してもよい。この場合、多数の動力源を含むロボット１０を搬送するのに比べ、搬送装置３０の構成を単純化し易い。従って、更に容易な生産設備構築が可能となる。但し、搬送装置３０は、ワークＷ及びロボット１０の相対位置を変更するものであればよいので、ロボット１０を搬送するものであってもよいし、ワークＷ及びロボット１０の双方を搬送するものであってもよい。
The
加工装置１は、図１４に示すように、搬送装置３０による搬送方向に沿って並ぶように配置された複数のロボット１０を備えていてもよい。搬送方向に沿って並ぶロボット１０のそれぞれが、上述したように広範囲の加工対象部位に加工を行うことが可能である。このため、搬送方向に沿って並ぶ複数のロボット１０に対し、様々なパターンで加工対象部位を割り当て、より効率的な生産設備を構築できる。
As illustrated in FIG. 14, the
図１４には、搬送装置３０による搬送方向に沿って並ぶ２台のロボット１０が示されているが、これに限られず、加工装置１は搬送装置３０の搬送方向に沿って並ぶように配置された３台以上のロボット１０を備えるものであってもよい。
In FIG. 14, two
加工装置１は、搬送装置３０による搬送方向に直交する方向でワークＷを挟むように配置された複数のロボット１０を備えていてもよい。この場合、全加工対象部位を複数のロボット１０に分担させることで、それぞれのロボット１０の動作量を抑制できる。これにより、ワークＷに対するロボット１０の干渉が更に抑制される。また、搬送装置３０による搬送方向に直交する方向でワークＷを挟む配置により、ロボット１０同士の干渉も抑制される。従って、更に容易な生産設備構築が可能となる。
The
複数のロボット１０が、搬送装置３０による搬送方向に直交する方向でワークＷを挟むように配置されることは必須ではない。例えば、図１５に示すように、ロボット１０はワークＷの左側のみに配置されていてもよい。この場合においても、ロボット１０は、当該ロボット１０側からの全加工対象部位に対し、ワークＷに干渉することなく加工を行うことが可能となるように配置されていてもよい。例えば図１５において、それぞれのロボット１０は、左側の全加工対象部位Ｐ１及び右側の全加工対象部位Ｐ１の両方に加工を行うことが可能となるように配置されていてもよい。
It is not essential that the plurality of
図１５には、搬送装置３０による搬送方向に沿って並ぶ２台のロボット１０が示されているが、これに限られず、加工装置１は一台のロボット１０のみを備えるものであってもよい。
FIG. 15 shows two
コントローラ１００は、先端部１６の位置・姿勢の目標値を取得する目標取得部１１１と、距離調節用の第７アクチュエータ２７の動作目標値を固定した条件にて、位置・姿勢の目標値に対応するアクチュエータ２１〜２６の動作目標値を算出する第１算出部１１２と、アクチュエータ２１〜２６の少なくともいずれかを判定対象とし、判定対象のアクチュエータについて動作目標値が許容範囲内であるか否かを判定する判定部１１３と、少なくとも一つの判定対象のアクチュエータについて動作目標値が許容範囲外となった場合に、当該動作目標値が許容範囲内に収まるように、位置・姿勢の目標値に対応するアクチュエータ２１〜２６及び距離調節用の第７アクチュエータ２７の動作目標値を算出する第２算出部１１４と、動作目標値に応じてアクチュエータ２１〜２７を制御する出力部１１５と、を有してもよい。
The
上述したように、ロボット１０によれば干渉を抑制できる一方で、先端部１６の位置・姿勢の目標値に対応するアクチュエータ２１〜２７の動作目標値は一通りに定まらない。このため、ロボット１０の動作教示においては何らかの拘束条件を適宜設定する必要がある。
As described above, according to the
これに対し、コントローラ１００は、まず第７アクチュエータ２７の動作目標値を固定した条件にて、アクチュエータ２１〜２６の動作目標値を算出する。次に、判定対象のアクチュエータの動作目標値が許容範囲外となった場合には、当該動作目標値が許容範囲内に収まるように、アクチュエータ２１〜２６及び距離調節用の第７アクチュエータ２７の動作目標値を自動的に再計算する。ロボット１０のアクチュエータの動作量を許容範囲内に抑えると、ロボット１０全体の動作量も抑制されるので、ワークＷ又は周辺機器との干渉が生じ難くなる傾向がある。
On the other hand, the
例えば図１３において二点鎖線で示されるロボット１０では、第３アクチュエータ２３の動作目標値が許容範囲外となっている。すなわち、第１腕部１３に対する第２腕部１４の揺動角の目標値θ３が過大になっている。これに対し、図１３において実線で示されるロボット１０では、第１腕部１３に対する第２腕部１４の揺動角の目標値θ３を緩和するようにアクチュエータ２１〜２６及び距離調節用の第７アクチュエータ２７の動作目標値が再計算されている。これに伴って第４軸線Ａｘ４及び第２軸線Ａｘ２の間の部分がワークＷから遠ざかり、ワークＷに対するロボット１０の干渉が防止されている。
For example, in the
このように、判定対象のアクチュエータの動作目標値を許容範囲内に抑えるという条件を採用することにより、ワークＷ又は周辺機器との干渉の発生確率を下げることができる。これにより、ワークＷ又は周辺機器との干渉を回避しつつ、先端部１６を各加工対象部位の近傍に適正配置する動作パターンの大部分を自動的に構築できる。従って、ロボット１０に対する動作教示の負担が軽減されるので、更に容易な生産設備構築が可能となる。
Thus, by adopting the condition that the operation target value of the determination target actuator is kept within the allowable range, it is possible to reduce the probability of occurrence of interference with the workpiece W or peripheral equipment. Thereby, it is possible to automatically construct a large part of the operation pattern in which the
距離調節用の第７アクチュエータ２７は、第１腕部１３を距離調節用の第７軸線Ａｘ７まわりに屈曲させることで、第２軸線Ａｘ２及び第３軸線Ａｘ３の間の距離Ｌ１を調節する。この場合、第１腕部１３を単純に伸縮させて第２軸線Ａｘ２及び第３軸線Ａｘ３の間の距離Ｌ１を調節するのに比べ、アクチュエータ２１〜２６の動作量を抑制し易い傾向がある。また、ロボット１０の姿勢をより多様に調節し、ワークＷ又は周辺機器を回避し易くなる傾向がある。従って、更に容易な生産設備構築が可能である。但し、第７アクチュエータ２７は、第２軸線Ａｘ２及び第３軸線Ａｘ３の間の距離Ｌ１を調節できればどのようなものであってもよいので、例えば第１腕部１３を伸縮させる直動アクチュエータであってもよい。
The
距離調節用の第７軸線Ａｘ７は、第２軸線Ａｘ２に対して平行である。仮に、第７軸線Ａｘ７が第２軸線Ａｘ２に対して垂直であるロボットを用いる場合、ワークＷに対するロボットの干渉を避けながら先端部１６を所望の位置・姿勢に配置するためには、第１腕部１３及び第２腕部１４に相当する部分を大きく側方（ワークＷ側を正面とした場合の側方）に傾ける必要が生じ得る。これにより周辺機器（例えば隣接する他のロボット）との干渉が生じ得るため、ロボット及び周辺機器の配置間隔を大きくする必要がある。このことは、例えば複数のロボットの高密度配置を妨げる一因となる。これに対し、ロボット１０においては第７軸線Ａｘ７が第２軸線Ａｘ２に対して平行であるので、少なくとも第７軸線Ａｘ７まわりの回転動作に起因して第１腕部１３及び第２腕部１４を側方に傾ける必要が生じ難く、隣接する周辺機器との干渉が生じ難い。従って、ロボット１０の配置の選択肢がより多くなるので、更に容易な生産設備構築が可能となる。複数のロボットをより高密度に配置し、作業時間を更に短縮することも可能となる。但し、第７軸線Ａｘ７が第２軸線Ａｘ２に対して平行であることは必須ではない。
The seventh axis Ax7 for distance adjustment is parallel to the second axis Ax2. If a robot having the seventh axis Ax7 perpendicular to the second axis Ax2 is used, the
距離調節用の第７軸線Ａｘ７は、第３軸線に対しても平行である。この場合、先端部１６を所望の位置・姿勢に配置する際に、第１腕部１３及び第２腕部１４を側方に傾ける必要が更に生じ難くなるので、更に容易な生産設備構築が可能となる。複数のロボットをより高密度に配置し、作業時間を更に短縮することも可能となる。但し、第７軸線Ａｘ７が第３軸線Ａｘ３に対して平行であることも必須ではない。
The seventh axis Ax7 for adjusting the distance is also parallel to the third axis. In this case, when the
第２算出部１１４は、距離調節用の第７軸線Ａｘ７がワークＷから遠ざかる方向に第１腕部１３を屈曲させるように、アクチュエータ２１〜２７の動作目標値を算出してもよい。即ちコントローラ１００は、第７軸線Ａｘ７がワークＷから遠ざかる方向に第１腕部１３を屈曲させるように、アクチュエータ２１〜２７を制御するものであってもよい。この場合、ワークＷ及び隣接する周辺機器に対するロボット１０の干渉がより確実に抑制される。
The
先端部１６の姿勢を調節する複数の姿勢調節アクチュエータは、手首部１５を第５軸線Ａｘ５まわりに旋回させる第５アクチュエータ２５、手首部１５を第４軸線Ａｘ４まわりに揺動させる第４アクチュエータ２４、及び先端部１６を第６軸線Ａｘ６まわりに旋回させる第６アクチュエータ２６である。この場合、アクチュエータ２４〜２６の協働により先端部１６の姿勢を自在に調節できる。但し、複数の姿勢調節アクチュエータは、アクチュエータ２４〜２６に限定されず、先端部１６の姿勢を調節可能であればどのようなものであってもよい。例えば、必要とされる姿勢調節の程度に応じて、第４アクチュエータ２４、第５アクチュエータ２５及び第６アクチュエータ２６のいずれかが省略されていてもよい。
A plurality of posture adjustment actuators for adjusting the posture of the
判定部１１３は、第２アクチュエータ２２、第３アクチュエータ２３及び第４アクチュエータ２４の少なくともいずれかを判定対象としてもよい。これらのアクチュエータの動作量は、ロボット全体の動作量に相関し易い傾向がある。このため、これらのアクチュエータを判定対象にして、その動作範囲を許容範囲内に抑えることで、ロボット１０全体の動作量をより確実に抑制し、干渉を更に抑制できる。
The
判定部１１３は、第３アクチュエータ２３及び第４アクチュエータ２４の少なくともいずれかを判定対象としてもよい。これらのアクチュエータの動作量は、ロボット全体の動作量に特に相関し易い傾向がある。このため、これらのアクチュエータを判定対象にして、その動作範囲を許容範囲内に抑えることで、ロボット１０全体の動作量をより確実に抑制し、干渉を更に抑制できる。
The
ロボット１０は、エンドエフェクタ１７として、先端部１６に設けられた溶接装置を更に備えていてもよい。この場合、ワークＷ又は周辺機器に対するロボット１０の干渉を抑制しつつ、広範囲の加工対象部位に対して溶接を行うことができる。
The
加工装置１によれば、ロボット１０により加工可能となるようにパレット３１上にワークＷを配置すること、ワークＷとロボット１０との相対位置を変更するように、搬送アクチュエータ３２によりパレット３１を搬送すること、ロボット１０によりワークＷに対し加工を行うこと、を含むワークＷの生産方法が実行可能である。
According to the
また、先端部１６の位置・姿勢の目標値を取得すること、第７アクチュエータ２７の動作目標値を固定した条件にて、位置・姿勢の目標値に対応するアクチュエータ２１〜２６の動作目標値を算出すること、アクチュエータ２１〜２６の少なくともいずれかを判定対象とし、判定対象のアクチュエータについて動作目標値が許容範囲内であるか否かを判定すること、少なくとも一つの判定対象のアクチュエータについて動作目標値が許容範囲外となった場合に、当該動作目標値が許容範囲内に収まるように、位置・姿勢の目標値に対応するアクチュエータ２１〜２７の動作目標値を算出すること、動作目標値に応じてアクチュエータ２１〜２７を制御すること、を含むワークＷの生産方法も実行可能である。
Further, the target values of the actuators 21 to 26 corresponding to the target values of the position / posture are obtained under the condition that the target value of the position / posture of the
コントローラ１００に位置・姿勢の目標値を入力すること、位置・姿勢の目標値に対応するようにコントローラ１００により算出されたアクチュエータ２１〜２７の動作目標値をコントローラに記憶させること、を含む教示方法も実行可能である。
A teaching method including inputting position / posture target values to the
２．第２実施形態
図１６に示すように、第２実施形態に係る加工装置１Ａは、第１実施形態に係る加工装置１の搬送装置３０を保持台５０（ワーク配置部）に置き換えたものである。保持台５０は、ロボット１０により加工可能な位置にワークＷを保持する。図１７に示すように、２台のロボット１０は、ワークＷを囲む線ＥＬ１に沿って並んでおり、互いに協働して同一のワークＷに対する加工を行う。なお、「ワークＷを囲む線」は、必ずしもワークＷの周縁に沿っていなくてもよいが、ワークＷの周縁に直交する線を含まないものとする。ロボット１０は、隣り合う他のロボット１０と可動範囲ＷＲが重複するように配置されている。個々のロボット１０とワークＷに対する配置条件については、第１実施形態と同様である。
2. Second Embodiment As shown in FIG. 16, a
〔第２実施形態による効果〕
以上に説明したように、加工装置１は、ロボット１０を含み、互いに協働して同一のワークに対する加工を行う複数のロボットを備える。ロボット１０が、同一のワークＷに対する加工を行う複数のロボットに含まれていることにより、ワークＷに対するロボットの干渉及びロボット同士の干渉を抑制できる。従って、容易な生産設備構築が可能となる。複数のロボットを高密度に配置することで作業時間を短縮することも可能となる。
[Effects of Second Embodiment]
As described above, the
加工装置１は、同一のワークＷに対する加工を行う複数のロボットを備えていればよいので、ロボットの台数は２台に限られない。例えば、図１８に示すように、３台以上のロボットを備えていてもよい。図１８の加工装置１は、４台のロボット１０を備える。４台のロボット１０は、ワークＷを囲む線に沿い、ワークＷを取り囲むように配置されている。
Since the
図１６及び図１８の加工装置１では、複数のロボットの全てがロボット１０である。このため、全てのロボットにおいて、先端部１６の位置・姿勢を維持した状態で、基台１１及び先端部１６の間におけるロボットの姿勢を自在に変更可能である。従って、ワークＷに対するロボットの干渉及びロボット同士の干渉をより確実に抑制できる。
16 and 18, all of the plurality of robots are
但し、全てのロボットがロボット１０であることは必須ではない。例えば図１９及び図２０に示すように、加工装置１の複数のロボットは、ロボット４０（第２ロボット）を更に含んでもよい。ロボット４０は、アクチュエータ２１〜２６を有し、距離調節用の第７アクチュエータ２７を有しない。ロボット４０は、第１腕部１３及び第７アクチュエータ２７を、第１腕部４３に置き換えたものである。このような構成においても、複数のロボットにロボット１０を含むことにより、ワークＷに対するロボットの干渉及びロボット同士の干渉を抑制する効果が得られる。ロボットの台数に制限はなく、図１９に示すように２台であってもよいし、図２０に示すように３台以上であってもよい。
However, it is not essential that all the robots are
ロボット１０及びロボット４０は、互いに隣り合うように配置されていてもよい。この場合、ロボット同士の干渉をより確実に抑制できる。
The
図１９に示すように、加工装置１は、ロボット１０の方がロボット４０に比べワークＷの近位側に加工を行うように構成されていてもよい。ワークＷの近位側に加工を行う場合、ロボットはアームを折り畳んだ姿勢となる。このような姿勢においては、一部のアクチュエータの動作量が許容限界に達し易い傾向がある。また、折り畳んだアームがワークＷ又は他のロボットに干渉し易い傾向がある。そこで、干渉を抑制可能なロボット１０に、ワークＷの近位側への加工を割り当てることにより、ワークＷに対するロボットの干渉及びロボット同士の干渉をより確実に抑制できる。
As illustrated in FIG. 19, the
図２０に示すように、加工装置１は、ロボット１０の方がロボット４０に比べワークＷ寄りに位置するように構成されていてもよい。即ち、ロボット１０の基台１１からワークＷまでの距離Ｄ１が、ロボット４０からワークＷまでの距離Ｄ２に比べ小さくなっていてもよい。この場合、干渉を抑制可能なロボット１０をワークＷ寄りに配置することで、ワークＷの広範囲に亘ってエンドエフェクタ１７を到達させることが可能となる。これにより、ロボット４０により加工できない部分をロボット１０によって補い、ワークＷの広範囲に亘って加工を行うことができる。
As illustrated in FIG. 20, the
全てのロボットは設置面に固定されており、ロボット１０は、隣り合う他のロボットと可動範囲が重複するように配置されていてもよい。この場合、ロボット１０による干渉抑制の効果がより顕著となる。
All the robots are fixed to the installation surface, and the
以上、実施形態について説明したが、本発明は必ずしも上述した実施形態に限定されるものではなく、その要旨を逸脱しない範囲で様々な変更が可能である。例えば、加工装置１のワークＷは自動車ボディに限られない。加工装置１は、自動車のドアパネルの加工等にも適用可能であるし、自動車以外の技術分野における様々な部品又は製品の加工・組立にも適用可能である。
Although the embodiment has been described above, the present invention is not necessarily limited to the above-described embodiment, and various modifications can be made without departing from the scope of the invention. For example, the workpiece W of the
本開示は、加工装置に利用可能である。 The present disclosure can be used for a processing apparatus.
１，１Ａ…加工装置、１０…ロボット（第１ロボット）、１２…旋回部、１３…第１腕部、１４…第２腕部、１５…手首部、１６…先端部、１７…エンドエフェクタ（溶接装置）、２１…第１アクチュエータ、２２…第２アクチュエータ、２３…第３アクチュエータ、２４…第４アクチュエータ（姿勢調節アクチュエータ）、２５…第５アクチュエータ（姿勢調節アクチュエータ）、２６…第６アクチュエータ（姿勢調節アクチュエータ）、２７…第７アクチュエータ（距離調節アクチュエータ）、３０…搬送装置、４０…ロボット（第２ロボット）、１００…コントローラ、Ａｘ１…第１軸線、Ａｘ２…第２軸線、Ａｘ３…第３軸線、Ａｘ４…第４軸線、Ａｘ５…第５軸線、Ａｘ６…第６軸線、Ａｘ７…第７軸線（距離調節用の軸線）、Ｌ１…第２軸線及び第３軸線の間の距離、Ｐ１，Ｐ２…加工対象部位、Ｗ…ワーク、Ｌ１１…最長距離、Ｌ１２…最短距離、ＰＥ１…第１腕部１３の基端、ＤＰ１…第１腕部１３の先端部、ＰＰ２…第２腕部１４の基端部、ＷＲ…可動範囲。
DESCRIPTION OF
Claims (14)
前記搬送装置による搬送方向に沿って並ぶように配置され、当該搬送装置により搬送されている前記ワークに対して加工を行う複数のロボットと、を備え、
前記複数のロボットは、互いに隣り合う少なくとも２台の第１ロボットを含み、
前記第１ロボットは、
互いに直列に接続された旋回部、第１腕部、第２腕部、手首部及び先端部と、
前記旋回部を第１軸線まわりに旋回させる第１アクチュエータと、
前記旋回部及び前記第１腕部の接続部分を通り、前記第１軸線に交差する第２軸線まわりに前記第１腕部を揺動させる第２アクチュエータと、
前記第１腕部及び前記第２腕部の接続部分を通り、前記第２軸線に平行な第３軸線まわりに前記第２腕部を揺動させる第３アクチュエータと、
前記第２腕部及び前記手首部の接続部分を通り、前記第２腕部の中心軸線に交差する第４軸線まわりに前記手首部を揺動させる第４アクチュエータと、
前記第２腕部の中心軸線に沿い、前記第３軸線及び前記第４軸線に交差する第５軸線まわりに前記手首部を旋回させる第５アクチュエータと、
前記手首部の中心軸線に沿い、前記第４軸線に交差する第６軸線まわりに前記先端部を旋回させる第６アクチュエータと、
前記第２軸線及び前記第３軸線に平行な距離調節用の軸線まわりに前記第１腕部を屈曲させることで、前記第２軸線及び前記第３軸線の間の距離を調節する距離調節アクチュエータと、
前記先端部に設けられ、自動車生産用のワークに対してスポット溶接を施すエンドエフェクタと、を有し、前記ワークに正対した状態で、前記距離を最長にして前記第２軸線まわりに前記第１腕部を回転させる場合には、前記第１腕部の先端部又は第２腕部の基端部の可動範囲が前記ワークに干渉し、前記ワークに正対した状態で、前記距離を最短にして前記第２軸線まわりに前記第１腕部を回転させる場合には、前記第１腕部の先端部及び第２腕部の基端部の可動範囲が前記ワークに干渉しないように位置し、
前記第１ロボットの可動範囲は、隣り合う他のロボットの可動範囲と重複している、加工装置。 A transfer device for transferring a workpiece;
A plurality of robots arranged so as to line up in the transport direction by the transport device and performing processing on the workpiece transported by the transport device;
The plurality of robots includes at least two first robots adjacent to each other,
The first robot is
A swivel unit, a first arm unit, a second arm unit, a wrist unit and a tip unit connected in series with each other;
A first actuator for turning the turning portion around a first axis;
A second actuator that swings the first arm portion around a second axis that passes through the connecting portion of the turning portion and the first arm portion and intersects the first axis;
A third actuator that swings the second arm portion around a third axis that passes through the connecting portion of the first arm portion and the second arm portion and is parallel to the second axis;
A fourth actuator that swings the wrist portion around a fourth axis that passes through a connecting portion of the second arm portion and the wrist portion and intersects a central axis of the second arm portion;
A fifth actuator that pivots the wrist portion around a fifth axis that intersects the third axis and the fourth axis along a central axis of the second arm;
A sixth actuator that pivots the tip portion around a sixth axis that intersects the fourth axis along the central axis of the wrist;
A distance adjusting actuator that adjusts a distance between the second axis and the third axis by bending the first arm portion around a distance adjusting axis parallel to the second axis and the third axis; ,
An end effector that is provided at the distal end portion and that performs spot welding on a workpiece for automobile production. When rotating one arm, the distance between the distal end of the first arm or the base end of the second arm interferes with the workpiece and faces the workpiece with the shortest distance. When the first arm portion is rotated around the second axis, the movable range of the distal end portion of the first arm portion and the proximal end portion of the second arm portion is positioned so as not to interfere with the workpiece. ,
The processing apparatus in which the movable range of the first robot overlaps the movable range of another adjacent robot.
前記ワークに正対した状態にて、前記ワークにおける最高位置の加工対象部位から前記第１腕部の基端までの距離と、最低位置の加工対象部位から前記第１腕部の基端までの距離とが、式（１）で求まる長さＬａ以下となるように位置する、請求項１〜４のいずれか一項記載の加工装置。
Ｌａ＝Ｌ１１＋Ｌ２１＋Ｌ３１・・・（１）
Ｌ１１：前記第２軸線から前記第３軸線までの最長距離
Ｌ２１：前記第３軸線から前記第４軸線までの距離
Ｌ３１：前記第４軸線から前記エンドエフェクタまでの距離 The first robot is
In a state of facing the workpiece, the distance from the highest processing target site in the workpiece to the base end of the first arm and the lowest processing target site to the base end of the first arm. The processing apparatus according to any one of claims 1 to 4, wherein the distance is positioned such that the distance is equal to or shorter than a length La obtained by the expression (1).
La = L11 + L21 + L31 (1)
L11: longest distance from the second axis to the third axis L21: distance from the third axis to the fourth axis L31: distance from the fourth axis to the end effector
前記ワークに正対した状態にて、前記ワークにおける最高位置の加工対象部位に対して加工を施し得るように前記エンドエフェクタを配置した場合の前記第４軸線の位置から前記第１腕部の基端までの距離と、前記ワークにおける最低位置の加工対象部位に対して加工を施し得るように前記エンドエフェクタを配置した場合の前記第４軸線の位置から前記第１腕部の基端までの距離とが、式（２）で求まる長さＬｂ以下となるように位置する、請求項５記載の加工装置。
Ｌｂ＝Ｌ１１＋Ｌ２１・・・（２） The first robot is
When the end effector is arranged so that machining can be performed on the processing target portion at the highest position in the workpiece in a state of facing the workpiece, the base of the first arm portion is determined from the position of the fourth axis. The distance to the end, and the distance from the position of the fourth axis to the base end of the first arm when the end effector is arranged so that processing can be performed on the lowest processing target portion of the workpiece Is a processing apparatus according to claim 5, which is positioned so as to be equal to or shorter than a length Lb obtained by the expression (2).
Lb = L11 + L21 (2)
前記ワークに正対した状態にて、前記手首部を鉛直下方に向けて前記ワークにおける最高位置の加工対象部位に前記エンドエフェクタを配置した場合の前記第４軸線の位置から前記第１腕部の基端までの距離と、前記手首部を鉛直上方に向けて前記エンドエフェクタを前記ワークにおける最低位置の加工対象部位に配置した場合の前記第４軸線の位置から前記第１腕部の基端までの距離とが、式（２）で求まる長さＬｂ以下となるように位置する、請求項５又は６記載の加工装置。
Ｌｂ＝Ｌ１１＋Ｌ２１・・・（２） The first robot is
In a state of facing the workpiece, the wrist portion is directed vertically downward from the position of the fourth axis when the end effector is arranged at the highest processing target site in the workpiece. From the position of the fourth axis to the base end of the first arm when the distance between the base end and the wrist effector is directed vertically upward and the end effector is disposed at the lowest processing target site in the workpiece The processing apparatus according to claim 5, wherein the distance is a length Lb or less determined by the expression (2).
Lb = L11 + L21 (2)
前記第１腕部の基端の高さが式（３）で求まる高さＨａ以上となるように位置する、請求項７記載の加工装置。
Ｈａ＝ＨＨ−Ｌ２１・ｃｏｓθ−Ｌ１１・・・（３）
ＨＨ：前記手首部を鉛直下方に向けて前記エンドエフェクタを前記ワークにおける最高位置の加工対象部位に配置した場合の前記第４軸線の高さ
θ：前記第３軸線及び前記第４軸線に直交する直線と、前記手首部の中心軸線との角度の最小値 The first robot is
The processing apparatus according to claim 7, wherein the height of the base end of the first arm portion is positioned so as to be equal to or higher than a height Ha obtained by Expression (3).
Ha = HH−L21 · cos θ−L11 (3)
HH: Height of the fourth axis when the end effector is placed at the highest processing target site in the workpiece with the wrist facing vertically downward θ: orthogonal to the third axis and the fourth axis Minimum value of angle between straight line and center axis of wrist
前記第１腕部の基端の高さが式（４）で求まる高さＨｂ以下となるように位置する、請求項８記載の加工装置。
Ｈｂ＝ＨＬ＋Ｌ２１・ｃｏｓθ＋Ｌ１１・・・（４）
ＨＬ：前記手首部を鉛直上方に向けて前記エンドエフェクタを前記ワークにおける最低位置の加工対象部位に配置した場合の前記第４軸線の高さ The first robot is
The processing apparatus according to claim 8, wherein the height of the base end of the first arm portion is positioned to be equal to or less than a height Hb obtained by Expression (4).
Hb = HL + L21 · cos θ + L11 (4)
HL: the height of the fourth axis when the end effector is arranged at the lowest processing target site in the workpiece with the wrist facing vertically upward
前記ワークに正対した状態にて、前記手首部を鉛直下方に向けて前記エンドエフェクタを前記ワークにおける最高位置の加工対象部位に配置した場合の前記第４軸線の位置から式（５）で求まる距離Ｌｃで手前側にシフトし、式（６）で求まる高さＨｃで下方にシフトした位置から前記第１腕部の基端までの距離と、前記手首部を鉛直上方に向けて前記エンドエフェクタを前記ワークにおける最低位置の加工対象部位に配置した場合の前記第４軸線の位置から式（５）で求まる距離Ｌｃで手前側にシフトし、式（６）で求まる高さＨｃで上方にシフトした位置から前記第１腕部の基端までの距離とが、前記第２軸線から前記第３軸線までの最長距離以下となるように位置する、請求項９記載の加工装置。
Ｌｃ＝Ｌ２１・ｓｉｎθ・・・（５）
Ｈｃ＝Ｌ２１・ｃｏｓθ・・・（６） The first robot is
From the position of the fourth axis when the end effector is disposed at the highest position of the workpiece in the workpiece with the wrist facing vertically downward in the state of facing the workpiece, the equation (5) is obtained. The end effector with the distance Lc shifted to the near side and the distance from the position shifted downward with the height Hc determined by Equation (6) to the base end of the first arm portion, with the wrist portion directed vertically upward Is shifted to the near side by the distance Lc determined by the equation (5) from the position of the fourth axis when the workpiece is disposed at the lowest position of the workpiece in the workpiece, and is shifted upward by the height Hc determined by the equation (6). The processing apparatus according to claim 9, wherein a distance from the position to the base end of the first arm portion is set to be equal to or shorter than a longest distance from the second axis to the third axis.
Lc = L21 · sin θ (5)
Hc = L21 · cos θ (6)
前記搬送装置による搬送方向に沿って並ぶように配置され、当該搬送装置により搬送されている前記ワークに対して加工を行う複数のロボットと、を備え、
前記複数のロボットは、互いに隣り合う少なくとも２台の第１ロボットを含み、
前記第１ロボットは、
互いに直列に接続された旋回部、第１腕部、第２腕部、手首部及び先端部と、
前記旋回部を第１軸線まわりに旋回させる第１アクチュエータと、
前記旋回部及び前記第１腕部の接続部分を通り、前記第１軸線に交差する第２軸線まわりに前記第１腕部を揺動させる第２アクチュエータと、
前記第１腕部及び前記第２腕部の接続部分を通り、前記第２軸線に平行な第３軸線まわりに前記第２腕部を揺動させる第３アクチュエータと、
前記第２腕部及び前記手首部の接続部分を通り、前記第２腕部の中心軸線に交差する第４軸線まわりに前記手首部を揺動させる第４アクチュエータと、
前記第２腕部の中心軸線に沿い、前記第３軸線及び前記第４軸線に交差する第５軸線まわりに前記手首部を旋回させる第５アクチュエータと、
前記手首部の中心軸線に沿い、前記第４軸線に交差する第６軸線まわりに前記先端部を旋回させる第６アクチュエータと、
前記第２軸線及び前記第３軸線に平行な距離調節用の軸線まわりに前記第１腕部を屈曲させることで、前記第２軸線及び前記第３軸線の間の距離を調節する距離調節アクチュエータと、
前記先端部に設けられ、自動車生産用のワークに対してスポット溶接を施すエンドエフェクタと、を有し、前記ワークに正対した状態で、前記距離を最長にして前記第２軸線まわりに前記第１腕部を回転させる場合には、前記第１腕部の先端部又は第２腕部の基端部の可動範囲が前記ワークに干渉し、前記ワークに正対した状態で、前記距離を最短にして前記第２軸線まわりに前記第１腕部を回転させる場合には、前記第１腕部の先端部及び第２腕部の基端部の可動範囲が前記ワークに干渉しないように位置し、
前記第１ロボットの可動範囲は、隣り合う他のロボットの可動範囲と重複している加工装置を用い、
前記第１ロボット及び前記搬送装置の協調により、前記ワークの複数の加工対象部位に前記エンドエフェクタを移動させるように当該第１ロボット及び当該搬送装置を制御することと、
前記エンドエフェクタが前記加工対象部位に配置された状態で、前記エンドエフェクタにより当該加工対象部位に加工を施すように前記第１ロボットを制御することと、を含み、
前記第１ロボット及び前記搬送装置の協調により、前記ワークの複数の加工対象部位に前記エンドエフェクタを移動させるように当該第１ロボット及び当該搬送装置を制御することは、前記第２軸線及び前記第３軸線の間の距離を前記距離調節アクチュエータにより変化させながら、前記第１腕部の基端より高い位置及び当該基端より低い位置の間で前記エンドエフェクタを移動させるように当該第１ロボットを制御することを含む、ワークの生産方法。 A transfer device for transferring a workpiece;
A plurality of robots arranged so as to line up in the transport direction by the transport device and performing processing on the workpiece transported by the transport device;
The plurality of robots includes at least two first robots adjacent to each other,
The first robot is
A swivel unit, a first arm unit, a second arm unit, a wrist unit and a tip unit connected in series with each other;
A first actuator for turning the turning portion around a first axis;
A second actuator that swings the first arm portion around a second axis that passes through the connecting portion of the turning portion and the first arm portion and intersects the first axis;
A third actuator that swings the second arm portion around a third axis that passes through the connecting portion of the first arm portion and the second arm portion and is parallel to the second axis;
A fourth actuator that swings the wrist portion around a fourth axis that passes through a connecting portion of the second arm portion and the wrist portion and intersects a central axis of the second arm portion;
A fifth actuator that pivots the wrist portion around a fifth axis that intersects the third axis and the fourth axis along a central axis of the second arm;
A sixth actuator that pivots the tip portion around a sixth axis that intersects the fourth axis along the central axis of the wrist;
A distance adjusting actuator that adjusts a distance between the second axis and the third axis by bending the first arm portion around a distance adjusting axis parallel to the second axis and the third axis; ,
An end effector that is provided at the distal end portion and that performs spot welding on a workpiece for automobile production. When rotating one arm, the distance between the distal end of the first arm or the base end of the second arm interferes with the workpiece and faces the workpiece with the shortest distance. When the first arm portion is rotated around the second axis, the movable range of the distal end portion of the first arm portion and the proximal end portion of the second arm portion is positioned so as not to interfere with the workpiece. ,
The movable range of the first robot uses a processing device that overlaps the movable range of another adjacent robot,
Controlling the first robot and the transfer device so as to move the end effector to a plurality of processing target portions of the workpiece by cooperation of the first robot and the transfer device;
Controlling the first robot so that the end effector performs processing on the processing target portion with the end effector disposed at the processing target portion,
Controlling the first robot and the transfer device so as to move the end effector to a plurality of processing target parts of the workpiece by the cooperation of the first robot and the transfer device is the second axis and the second The first robot is moved so as to move the end effector between a position higher than the base end of the first arm and a position lower than the base end while changing the distance between the three axes by the distance adjusting actuator. A method for producing workpieces, including controlling.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2016098713A JP6172334B2 (en) | 2016-05-17 | 2016-05-17 | Processing device and work production method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2016098713A JP6172334B2 (en) | 2016-05-17 | 2016-05-17 | Processing device and work production method |
Related Parent Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2015553701A Division JP5939364B1 (en) | 2015-07-24 | 2015-07-24 | Processing equipment |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2017024160A true JP2017024160A (en) | 2017-02-02 |
| JP6172334B2 JP6172334B2 (en) | 2017-08-02 |
Family
ID=57945348
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2016098713A Active JP6172334B2 (en) | 2016-05-17 | 2016-05-17 | Processing device and work production method |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP6172334B2 (en) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP6906404B2 (en) * | 2017-09-08 | 2021-07-21 | 株式会社安川電機 | Manufacturing method for robot systems, robot control devices and workpieces |
Citations (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS60123263A (en) * | 1983-12-06 | 1985-07-01 | Hitachi Zosen Corp | Surface treating device |
| JPS60123294A (en) * | 1983-12-05 | 1985-07-01 | 三菱電機株式会社 | Industrial robot |
| JPH0283191A (en) * | 1988-09-19 | 1990-03-23 | Toshiba Corp | Industrial robot |
| JPH0379284A (en) * | 1989-08-18 | 1991-04-04 | Nissan Motor Co Ltd | Control method for industrial robot |
| JPH0647689A (en) * | 1992-07-30 | 1994-02-22 | Kobe Steel Ltd | Control method of articulated robot |
| JPH0642090U (en) * | 1992-11-20 | 1994-06-03 | 株式会社アマダ | Articulated robot |
| JP2003205331A (en) * | 2002-01-07 | 2003-07-22 | Komatsu Ltd | Workpiece loading method and device |
| JP2005014108A (en) * | 2003-06-23 | 2005-01-20 | Honda Motor Co Ltd | Interference avoiding method of multi-articulated robot |
| JP2009125892A (en) * | 2007-11-27 | 2009-06-11 | Yaskawa Electric Corp | Robot system |
| JP2013146859A (en) * | 2013-05-09 | 2013-08-01 | Fanuc Ltd | Off-line program creation device of robot with additional axis |
| JP2014061589A (en) * | 2012-09-10 | 2014-04-10 | Fanuc Robotics America Inc | Robotic painting apparatus |
| JP2015123516A (en) * | 2013-12-25 | 2015-07-06 | 川崎重工業株式会社 | Industrial robot |
-
2016
- 2016-05-17 JP JP2016098713A patent/JP6172334B2/en active Active
Patent Citations (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS60123294A (en) * | 1983-12-05 | 1985-07-01 | 三菱電機株式会社 | Industrial robot |
| JPS60123263A (en) * | 1983-12-06 | 1985-07-01 | Hitachi Zosen Corp | Surface treating device |
| JPH0283191A (en) * | 1988-09-19 | 1990-03-23 | Toshiba Corp | Industrial robot |
| JPH0379284A (en) * | 1989-08-18 | 1991-04-04 | Nissan Motor Co Ltd | Control method for industrial robot |
| JPH0647689A (en) * | 1992-07-30 | 1994-02-22 | Kobe Steel Ltd | Control method of articulated robot |
| JPH0642090U (en) * | 1992-11-20 | 1994-06-03 | 株式会社アマダ | Articulated robot |
| JP2003205331A (en) * | 2002-01-07 | 2003-07-22 | Komatsu Ltd | Workpiece loading method and device |
| JP2005014108A (en) * | 2003-06-23 | 2005-01-20 | Honda Motor Co Ltd | Interference avoiding method of multi-articulated robot |
| JP2009125892A (en) * | 2007-11-27 | 2009-06-11 | Yaskawa Electric Corp | Robot system |
| JP2014061589A (en) * | 2012-09-10 | 2014-04-10 | Fanuc Robotics America Inc | Robotic painting apparatus |
| JP2013146859A (en) * | 2013-05-09 | 2013-08-01 | Fanuc Ltd | Off-line program creation device of robot with additional axis |
| JP2015123516A (en) * | 2013-12-25 | 2015-07-06 | 川崎重工業株式会社 | Industrial robot |
Also Published As
| Publication number | Publication date |
|---|---|
| JP6172334B2 (en) | 2017-08-02 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5896003B1 (en) | Processing apparatus, teaching method, workpiece production method, controller, and control method | |
| WO2016067689A1 (en) | Machining device and production method of workpiece | |
| JP5765355B2 (en) | Robot picking system and workpiece manufacturing method | |
| JP6914811B2 (en) | Horizontal articulated robot and its origin return method | |
| US8826766B2 (en) | Manipulator system | |
| JP4852719B2 (en) | Articulated robot | |
| EP1749621A2 (en) | Robot programming device | |
| JP4595053B2 (en) | Articulated robot | |
| WO2006109791A1 (en) | Multi-joint robot | |
| KR101182600B1 (en) | Parallel-kinematic robotic manipulator with a large cylindrical workspace | |
| JP6906404B2 (en) | Manufacturing method for robot systems, robot control devices and workpieces | |
| US11220004B2 (en) | Robot system | |
| JP6172334B2 (en) | Processing device and work production method | |
| JP5939364B1 (en) | Processing equipment | |
| JP5933450B2 (en) | Robot control apparatus and control method | |
| JP6057284B2 (en) | Articulated robot and semiconductor wafer transfer device | |
| US10807238B2 (en) | Robot system and method for controlling robot | |
| JP2016087704A (en) | Processing device and workpiece production method | |
| JP2011189440A (en) | Robot control device, robot system, program and robot control method | |
| EP3213883B1 (en) | Machining device and production method of workpiece | |
| JPWO2018199035A1 (en) | Articulated robot and articulated robot system | |
| JP2016087705A (en) | Processing device and workpiece production method | |
| JP2009050949A (en) | Method and apparatus for teaching track of robot arm | |
| KR20200078885A (en) | Calculating method of maximum rectangular prism working volume for multi-axis machine | |
| WO2021132632A1 (en) | Multi-axis robot and control method therefor, and work tool |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20170606 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20170619 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 6172334 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |