JP6172334B2 - Processing device and work production method - Google Patents

Processing device and work production method Download PDF

Info

Publication number
JP6172334B2
JP6172334B2 JP2016098713A JP2016098713A JP6172334B2 JP 6172334 B2 JP6172334 B2 JP 6172334B2 JP 2016098713 A JP2016098713 A JP 2016098713A JP 2016098713 A JP2016098713 A JP 2016098713A JP 6172334 B2 JP6172334 B2 JP 6172334B2
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.)
Active
Application number
JP2016098713A
Other languages
Japanese (ja)
Other versions
JP2017024160A (en
Inventor
達生 廣
達生 廣
国昭 片峯
国昭 片峯
隆太 香川
隆太 香川
佑輔 木下
佑輔 木下
学 岡久
学 岡久
雅美 中倉
雅美 中倉
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.)
Yaskawa Electric Corp
Original Assignee
Yaskawa Electric 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 Yaskawa Electric Corp filed Critical Yaskawa Electric Corp
Priority to JP2016098713A priority Critical patent/JP6172334B2/en
Publication of JP2017024160A publication Critical patent/JP2017024160A/en
Application granted granted Critical
Publication of JP6172334B2 publication Critical patent/JP6172334B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Description

本開示は、加工装置及びワークの生産方法に関する。   The present disclosure relates to a machining apparatus and a workpiece production method.

特許文献1には、乗用車の車体パネル等をワークとして保持するワーク固定台と、ワークにスポット溶接を施すロボットとを備えるスポット溶接装置が開示されている。   Patent Document 1 discloses a spot welding apparatus including a workpiece fixing base that holds a vehicle body panel or the like of a passenger car as a workpiece, and a robot that performs spot welding on the workpiece.

特開2008−279496号公報JP 2008-279696 A

ロボットを用いた加工装置においては、設備構築容易化の観点又はロボットの台数削減の観点等から、個々のロボットでワークの広範囲に加工を施し得る装置が望まれている。そこで本開示は、個々のロボットでワークの広範囲に加工を施すことが可能な加工装置及び生産方法を提供することを目的とする。   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.

本開示に係る加工装置は、互いに直列に接続された旋回部、第1腕部、第2腕部、手首部及び先端部と、旋回部を第1軸線まわりに旋回させる第1アクチュエータと、第1腕部を第2軸線まわりに揺動させる第2アクチュエータと、第2腕部を第3軸線まわりに揺動させる第3アクチュエータと、先端部の姿勢を調節する複数の姿勢調節アクチュエータと、第2軸線及び第3軸線の間の距離を調節する距離調節アクチュエータと、先端部に設けられ、ワークに対して加工を施すエンドエフェクタと、を有する第1ロボットを備え、第1ロボットは、ワークに正対した状態で、距離を最長にして第2軸線まわりに第1腕部を回転させた場合に、第1腕部の先端部又は第2腕部の基端部がワークに干渉するように位置する。   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.

本開示に係るワークの生産方法は、上記加工装置を用い、ワークの複数の加工対象部位にエンドエフェクタを移動させるように第1ロボットを制御することと、エンドエフェクタが加工対象部位に配置された状態で、エンドエフェクタにより当該加工対象部位に加工を施すように第1ロボットを制御することと、を含み、ワークの複数の加工対象部位にエンドエフェクタを移動させるように第1ロボットを制御することは、第2軸線及び第3軸線の間の距離を距離調節アクチュエータにより変化させながら、第1腕部の基端より高い位置及び当該基端より低い位置の間でエンドエフェクタを移動させることを含む。   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.

第1実施形態に係る加工装置の概略構成を示す模式図である。It is a schematic diagram which shows schematic structure of the processing apparatus which concerns on 1st Embodiment. 第1ロボットの配置条件を示す模式図である。It is a schematic diagram which shows the arrangement | positioning conditions of a 1st robot. 第1ロボットがワークに正対した状態を示す平面図である。It is a top view which shows the state which the 1st robot faced the workpiece | work. 第1ロボットの配置条件を示す模式図である。It is a schematic diagram which shows the arrangement | positioning conditions of a 1st robot. 第1ロボットの他の配置条件を示す模式図である。It is a mimetic diagram showing other arrangement conditions of the 1st robot. 第1ロボットの更に他の配置条件を示す模式図である。It is a mimetic diagram showing other arrangement conditions of the 1st robot. 第1ロボットの更に他の配置条件を示す模式図である。It is a mimetic diagram showing other arrangement conditions of the 1st robot. 第1ロボットの更に他の配置条件を示す模式図である。It is a mimetic diagram showing other arrangement conditions of the 1st robot. コントローラのハードウェア構成図である。It is a hardware block diagram of a controller. 第1ロボットを用いた加工手順を示すフローチャートである。It is a flowchart which shows the process sequence using a 1st robot. 加工実行中の第1ロボットの姿勢を示す模式図である。It is a schematic diagram which shows the attitude | position of the 1st robot in process of execution. 動作パターンの生成手順を示すフローチャートである。It is a flowchart which shows the production | generation procedure of an operation | movement pattern. 距離調節アクチュエータの作用を例示する図である。It is a figure which illustrates the effect | action of a distance adjustment actuator. 第1ロボットの他の配置例を示す平面図である。It is a top view which shows the other example of arrangement | positioning of a 1st robot. 第1ロボットの更に他の配置例を示す平面図である。It is a top view which shows other example of arrangement | positioning of a 1st robot. 第2実施形態に係る加工装置の概略構成を示す模式図である。It is a schematic diagram which shows schematic structure of the processing apparatus which concerns on 2nd Embodiment. ロボットの可動範囲を示す平面図である。It is a top view which shows the movable range of a robot. ロボットの他の配置例を示す斜視図である。It is a perspective view which shows the other example of arrangement | positioning of a robot. ロボットの更に他の配置例を示す斜視図である。It is a perspective view which shows the other example of arrangement | positioning of a robot. ロボットの更に他の配置例を示す斜視図である。It is a perspective view which shows the other example of arrangement | positioning of a robot.

以下、実施形態について図面を参照しつつ詳細に説明する。説明において、同一要素又は同一機能を有する要素には同一の符号を付し、重複する説明を省略する。   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.第1実施形態
〔加工装置〕
図1に示すように、加工装置1は、2台のロボット10(第1ロボット)と、コントローラ100と、プログラミングペンダント120とを備える。
1. First embodiment [processing apparatus]
As shown in FIG. 1, the processing apparatus 1 includes two robots 10 (first robots), a controller 100, and a programming pendant 120.

(ロボット)
ロボット10は、例えば自動車ボディ等のワークWに対して加工を行うものである。一例として、ロボット10は、基台11と、旋回部12と、第1腕部13と、第2腕部14と、手首部15と、先端部16と、エンドエフェクタ17と、第1アクチュエータ21と、第2アクチュエータ22と、第3アクチュエータ23と、第4アクチュエータ24と、第5アクチュエータ25と、第6アクチュエータ26と、第7アクチュエータ27とを備える。
(robot)
The robot 10 processes a workpiece W such as an automobile body. As an example, the robot 10 includes a base 11, a turning part 12, a first arm part 13, a second arm part 14, a wrist part 15, a tip part 16, an end effector 17, and a first actuator 21. A second actuator 22, a third actuator 23, a fourth actuator 24, a fifth actuator 25, a sixth actuator 26, and a seventh actuator 27.

基台11は、床面(設置面)に固定されており、ロボット10全体を支持する。すなわち複数のロボット10の全てが設置面に固定されている。   The base 11 is fixed to the floor surface (installation surface) and supports the entire robot 10. That is, all of the plurality of robots 10 are fixed to the installation surface.

旋回部12、第1腕部13、第2腕部14、手首部15及び先端部16は互いに直列に接続されている。旋回部12は、基台11上に設けられており、鉛直な(図示z軸に沿った)第1軸線Ax1まわりに旋回可能である。以下の説明において、「先端」は先端部16側の端を意味し、「先端部」は先端及びその近傍部分を意味する。「基端」は基台11側の端を意味し、「基端部」は基端及びその近傍部分を意味する。   The turning part 12, the first arm part 13, the second arm part 14, the wrist part 15 and the tip part 16 are connected in series with each other. The turning unit 12 is provided on the base 11 and can turn around a first axis Ax1 that is vertical (along the z-axis in the drawing). In the following description, “tip” means the end on the tip 16 side, and “tip” means the tip and its vicinity. “Base end” means the end on the base 11 side, and “base end” means the base end and its vicinity.

第1腕部13は、旋回部12及び第1腕部13の接続部分を通る水平な第2軸線Ax2まわりに揺動可能である。   The first arm portion 13 can swing around a horizontal second axis Ax2 that passes through a connecting portion between the turning portion 12 and the first arm portion 13.

第2腕部14は、第1腕部13及び第2腕部14の接続部分を通る水平な第3軸線Ax3まわりに揺動可能である。第3軸線Ax3は、第2軸線Ax2に対して平行である。第2腕部14は、その中心軸線に沿う第5軸線Ax5まわりに旋回可能である。   The second arm portion 14 can swing around a horizontal third axis Ax3 that passes through the connecting portion of the first arm portion 13 and the second arm portion 14. The third axis Ax3 is parallel to the second axis Ax2. The second arm portion 14 can turn around the fifth axis Ax5 along the central axis.

手首部15は、第2腕部14及び手首部15の接続部分を通る第4軸線Ax4まわりに揺動可能である。   The wrist portion 15 can swing around a fourth axis Ax4 that passes through a connecting portion between the second arm portion 14 and the wrist portion 15.

先端部16は、手首部15の中心軸線に沿う第6軸線Ax6まわりに旋回可能である。   The distal end portion 16 can turn around the sixth axis Ax6 along the central axis of the wrist portion 15.

エンドエフェクタ17は、例えばスポット溶接装置であり、先端部16に設けられている。一例として、エンドエフェクタ17は、先端部16に対して着脱自在に取り付けられており、他のエンドエフェクタ―と交換可能となっている。エンドエフェクタ17は先端部16に一体化されていてもよい。エンドエフェクタ17は加工用のツールであればどのようなものであってもよく、スポット溶接装置に限られない。例えばエンドエフェクタ17は、アーク溶接装置であってもよいし、溶接以外の作業を行うカッター、ネジ締め装置等であってもよい。   The end effector 17 is a spot welding device, for example, and is provided at the distal end portion 16. As an example, the end effector 17 is detachably attached to the distal end portion 16 and can be exchanged with other end effectors. The end effector 17 may be integrated with the distal end portion 16. The end effector 17 may be any tool as long as it is a processing tool, and is not limited to a spot welding apparatus. For example, the end effector 17 may be an arc welding apparatus, a cutter that performs work other than welding, a screw tightening apparatus, or the like.

ここで、第1腕部13は、互いに直列に接続されたリンク13A,13Bにより構成されており、リンク13Aが旋回部12に接続され、リンク13Bが第2腕部14に接続されている。第1腕部13は、リンク13A,13Bの接続部を通る第7軸線Ax7まわりに屈曲可能である。換言すると、リンク13Bは、リンク13A,13Bの接続部を通る第7軸線Ax7まわりに揺動可能である。第7軸線Ax7は、第2軸線Ax2及び第3軸線Ax3に対して平行である。   Here, the first arm portion 13 is configured by links 13A and 13B connected in series with each other, the link 13A is connected to the turning portion 12, and the link 13B is connected to the second arm portion 14. The first arm portion 13 can be bent around a seventh axis Ax7 that passes through the connecting portion of the links 13A and 13B. In other words, the link 13B can swing around the seventh axis Ax7 that passes through the connecting portion of the links 13A and 13B. The seventh axis Ax7 is parallel to the second axis Ax2 and the third axis Ax3.

第1アクチュエータ21は、例えば基台11に設けられており、旋回部12を第1軸線Ax1まわりに旋回させる。   The first actuator 21 is provided on the base 11, for example, and turns the turning portion 12 around the first axis Ax1.

第2アクチュエータ22は、例えば旋回部12に設けられており、第1腕部13を第2軸線Ax2まわりに揺動させる。   The second actuator 22 is provided in the turning unit 12, for example, and swings the first arm unit 13 around the second axis Ax2.

第3アクチュエータ23は、例えば第1腕部13の先端部に設けられており、第2腕部14を第3軸線Ax3まわりに揺動させる。   The third actuator 23 is provided, for example, at the distal end portion of the first arm portion 13 and swings the second arm portion 14 about the third axis Ax3.

第5アクチュエータ25は、例えば第2腕部14の基端部に設けられており、第2腕部14を第5軸線Ax5まわりに旋回させる。第2腕部14には手首部15が接続されているので、第2腕部14を旋回させることは手首部15を旋回させることに相当する。即ち第5アクチュエータ25は、手首部15を第5軸線Ax5まわりに旋回させる。   The fifth actuator 25 is provided, for example, at the base end portion of the second arm portion 14, and turns the second arm portion 14 about the fifth axis Ax5. Since the wrist part 15 is connected to the second arm part 14, turning the second arm part 14 corresponds to turning the wrist part 15. That is, the fifth actuator 25 turns the wrist portion 15 about the fifth axis Ax5.

第4アクチュエータ24は、例えば第2腕部14の先端部に設けられており、手首部15を第4軸線Ax4まわりに揺動させる。   The fourth actuator 24 is provided, for example, at the distal end portion of the second arm portion 14, and swings the wrist portion 15 about the fourth axis Ax4.

第6アクチュエータ26は、例えば手首部15に設けられており、先端部16を第6軸線Ax6まわりに旋回させる。   The sixth actuator 26 is provided, for example, on the wrist portion 15 and rotates the tip end portion 16 about the sixth axis Ax6.

第4アクチュエータ24、第5アクチュエータ25及び第6アクチュエータ26は、先端部16の姿勢を調節する複数の姿勢調節アクチュエータの一例である。   The fourth actuator 24, the fifth actuator 25, and the sixth actuator 26 are examples of a plurality of posture adjustment actuators that adjust the posture of the distal end portion 16.

第7アクチュエータ27(距離調節アクチュエータ)は、第2軸線Ax2及び第3軸線Ax3の間の距離L1を調節する。図2に示すように、第7アクチュエータ27は、最長距離L11及び最短距離L12の間で距離L1を調節する。   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 seventh actuator 27 adjusts the distance L1 between the longest distance L11 and the shortest distance L12.

図1に示すように、第7アクチュエータ27は、例えばリンク13Aの先端部に設けられており、第1腕部13を第7軸線Ax7まわりに屈曲させる。換言すると、第7アクチュエータ27は、リンク13Bを第7軸線Ax7まわりに揺動させる。この構成において、最長距離L11は、第1腕部13が屈曲していない状態(リンク13Aに対しリンク13Bが傾いていない状態)における距離L1である。最短距離L12は、第7アクチュエータ27の可動限界まで第1腕部13を屈曲させた状態における距離L1である。   As shown in FIG. 1, the seventh actuator 27 is provided, for example, at the distal end portion of the link 13 </ b> A, and bends the first arm portion 13 around the seventh axis Ax <b> 7. In other words, the seventh actuator 27 swings the link 13B about the seventh axis Ax7. In this configuration, the longest distance L11 is a distance L1 when the first arm portion 13 is not bent (the link 13B is not inclined with respect to the link 13A). The shortest distance L12 is a distance L1 when the first arm portion 13 is bent to the movable limit of the seventh actuator 27.

第7アクチュエータ27は、必ずしも第1腕部13を屈曲させるものでなくてよく、第2軸線Ax2及び第3軸線Ax3の間の距離L1を調節できればどのようなものであってもよい。例えば第7アクチュエータ27は、第1腕部13を伸縮させる直動アクチュエータであってもよい。   The seventh actuator 27 does not necessarily have to bend the first arm portion 13 and may be any one as long as the distance L1 between the second axis Ax2 and the third axis Ax3 can be adjusted. For example, the seventh actuator 27 may be a direct acting actuator that expands and contracts the first arm portion 13.

このように、ロボット10は、先端部16の位置及び姿勢を自在に変更可能な所謂6軸ロボットに対し、第2軸線Ax2及び第3軸線Ax3の間の距離L1を調節する冗長自由度を追加したものである。アクチュエータ21〜26は、例えば電動のサーボモータ、ギアヘッド及びブレーキ等により構成されている。サーボモータ、ギアヘッド及びブレーキ等は、必ずしも軸線Ax1〜Ax7上に配置されていなくてもよく、これらの軸線から離れた位置に配置されていてもよい。   As described above, the robot 10 adds a redundancy degree of freedom to adjust the distance L1 between the second axis Ax2 and the third axis Ax3 with respect to the so-called six-axis robot capable of freely changing the position and posture of the tip portion 16. It is a thing. The actuators 21 to 26 are constituted by, for example, an electric servo motor, a gear head, a brake, and the like. The servo motor, the gear head, the brake, and the like are not necessarily arranged on the axes Ax1 to Ax7, and may be arranged at positions away from these axes.

(搬送装置)
加工装置1は、搬送装置30を更に備えてもよい。搬送装置30は、ワークW及びロボット10の相対位置を変更するようにワークWを搬送するものである。一例として、搬送装置30はパレット31(ワーク配置部)と搬送アクチュエータ32とを有する。パレット31はワークWを支持する。搬送アクチュエータ32は、例えば電動モータ又は油圧モータ等を動力源として、パレット31を水平な一直線に沿って(図示x軸に沿って)搬送する。
(Transport device)
The processing device 1 may further include a transport device 30. The conveyance device 30 conveys the workpiece W so as to change the relative position of the workpiece W and the robot 10. As an example, the transport device 30 includes a pallet 31 (work placement unit) and a transport actuator 32. The pallet 31 supports the workpiece W. The transport actuator 32 transports the pallet 31 along a horizontal straight line (along the x-axis in the drawing) using, for example, an electric motor or a hydraulic motor as a power source.

(ロボットの配置)
図2の(a)に示すように、ロボット10は、ワークWに正対した状態で、距離L1を最長距離L11として第2軸線Ax2まわりに第1腕部13を回転させた場合に、第1腕部13の先端部DP1又は第2腕部14の基端部PP2がワークWに干渉するように位置する(以下、この条件を「配置条件1」という。)。
(Robot placement)
As shown in FIG. 2A, when the robot 10 rotates the first arm 13 around the second axis Ax2 with the distance L1 as the longest distance L11 in a state of facing the workpiece W, The distal end portion DP1 of the first arm portion 13 or the proximal end portion PP2 of the second arm portion 14 is positioned so as to interfere with the workpiece W (hereinafter, this condition is referred to as “arrangement condition 1”).

図2の(b)に示すように、ロボット10は、ワークWに正対した状態で、距離L1を最短距離L12として第2軸線Ax2まわりに第1腕部13を回転させた場合に、第1腕部13の先端部DP1及び第2腕部14の基端部PP2がワークWに干渉しないように位置してもよい(以下、この条件を「配置条件2」という。)。   As shown in FIG. 2B, when the robot 10 rotates the first arm 13 around the second axis Ax2 with the distance L1 as the shortest distance L12 in a state of facing the workpiece W, The distal end portion DP1 of the first arm portion 13 and the proximal end portion PP2 of the second arm portion 14 may be positioned so as not to interfere with the workpiece W (hereinafter, this condition is referred to as “arrangement condition 2”).

なお、「正対」とは、図3に示すように、第1腕部13の基端PE1(第1腕部13の中心軸線と第2軸線Ax2との交点)が平面視で第1軸線Ax1とワークWとの間に位置し、第1軸線Ax1からワークWへの垂線PL上に位置する状態を意味する。   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 first arm portion 13 and the second axis Ax2) is the first axis in plan view. It means a state that is located between Ax1 and the workpiece W and is located on a perpendicular line PL from the first axis Ax1 to the workpiece W.

図4を参照し、上記配置条件1,2を満たすための詳細な条件を例示する。図4に示すように、ロボット10は、ワークWに正対した状態にて、ワークWから第1腕部13の基端PE1までの距離が第3長L13未満となるように位置してもよい(以下、この条件を「配置条件1a」という。)。第3長L13は、距離L1を最長距離L11とし、第2軸線Ax2及び第3軸線Ax3に直交する直線に対し第2腕部14を垂直にした状態における、第1腕部13の基端PE1から第2腕部14の外周面の遠位部分までの距離である。「第2腕部14の外周面の遠位部分」とは、第2腕部14の外周面のうち第2軸線Ax2の逆側の部分である。ロボット10の配置が配置条件1aを満たす場合、上記配置条件1も満たされる。   With reference to FIG. 4, detailed conditions for satisfying the arrangement conditions 1 and 2 will be exemplified. As shown in FIG. 4, the robot 10 is positioned so that the distance from the workpiece W to the proximal end PE1 of the first arm portion 13 is less than the third length L13 in a state of facing the workpiece W. Good (hereinafter, this condition is referred to as “placement condition 1a”). The third length L13 is the base end PE1 of the first arm portion 13 in a state where the distance L1 is the longest distance L11 and the second arm portion 14 is perpendicular to the straight lines orthogonal to the second axis Ax2 and the third axis Ax3. To the distal portion of the outer peripheral surface of the second arm portion 14. The “distal portion of the outer peripheral surface of the second arm portion 14” is a portion of the outer peripheral surface of the second arm portion 14 on the side opposite to the second axis Ax2. When the arrangement of the robot 10 satisfies the arrangement condition 1a, the arrangement condition 1 is also satisfied.

ロボット10は、ワークWに正対した状態にて、ワークWから第1腕部13の基端PE1までの距離が第4長L14を超えるように位置してもよい(以下、この条件を「配置条件2a」という。)。第4長L14は、距離L1を最短距離L12とし、第2軸線Ax2及び第3軸線Ax3に直交する直線に対し第2腕部14を垂直にした状態における、第1腕部13の基端PE1から第2腕部14の外周面の遠位部分までの距離である。ロボット10の配置が配置条件2aを満たす場合、上記配置条件2も満たされる。   The robot 10 may be positioned so that the distance from the workpiece W to the base end PE1 of the first arm portion 13 exceeds the fourth length L14 in a state of facing the workpiece W (hereinafter, this condition is “ Arrangement condition 2a "). The fourth length L14 has the distance L1 as the shortest distance L12, and the base end PE1 of the first arm 13 in a state in which the second arm 14 is perpendicular to the straight lines orthogonal to the second axis Ax2 and the third axis Ax3. To the distal portion of the outer peripheral surface of the second arm portion 14. When the arrangement of the robot 10 satisfies the arrangement condition 2a, the arrangement condition 2 is also satisfied.

図5に示すように、ロボット10は、ワークWに正対した状態にて、ワークWにおける最高位置の加工対象部位P1から第1腕部13の基端PE1までの距離と、最低位置の加工対象部位P1から第1腕部13の基端PE1までの距離とが、式(1)で求まる長さLa以下となるように位置してもよい。
La=L11+L21+L31・・・(1)
L11:第2軸線Ax2から第3軸線Ax3までの最長距離
L21:第3軸線Ax3から第4軸線Ax4までの距離
L31:第4軸線Ax4からエンドエフェクタ17までの距離
なお、「エンドエフェクタ17までの距離」とは、エンドエフェクタ17のうち加工対象部位P1に作用する部位(以下、「作用部」という。)までの距離を意味する。
As shown in FIG. 5, the robot 10 faces the workpiece W in a state facing the workpiece W, the distance from the highest processing target site P1 to the proximal end PE1 of the first arm 13 and the lowest processing. The distance from the target site P1 to the base end PE1 of the first arm portion 13 may be positioned to be equal to or shorter than the length La obtained by the expression (1).
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 end effector 17 The “distance” means a distance to a portion of the end effector 17 that acts on the processing target portion P1 (hereinafter referred to as “action portion”).

図6に示すように、ロボット10は、ワークWに正対した状態にて、ワークWにおける最高位置の加工対象部位P1に対して加工を施し得るようにエンドエフェクタ17を配置した場合の第4軸線Ax4の位置から第1腕部13の基端PE1までの距離と、ワークWにおける最低位置の加工対象部位P1に対して加工を施し得るようにエンドエフェクタ17を配置した場合の第4軸線Ax4の位置から第1腕部13の基端PE1までの距離とが、式(2)で求まる長さLb以下となるように位置してもよい。
Lb=L11+L21・・・(2)
As shown in FIG. 6, the robot 10 is the fourth in the case where the end effector 17 is disposed so that the processing can be performed on the processing target portion P1 at the highest position in the workpiece W in a state of facing the workpiece W. The fourth axis Ax4 when the end effector 17 is disposed so that the distance from the position of the axis Ax4 to the base end PE1 of the first arm 13 and the lowest position to be processed P1 in the workpiece W can be processed. The distance from the position 1 to the base end PE1 of the first arm portion 13 may be positioned so as to be equal to or shorter than the length Lb obtained by Expression (2).
Lb = L11 + L21 (2)

加工対象部位P1に対してエンドエフェクタ17を配置するとは、エンドエフェクタ17の上記作用部を加工対象部位P1に配置することを意味する。加工対象部位P1に加工を施し得るエンドエフェクタ17の姿勢は、加工対象部位P1の状態に応じて定まる。例えばエンドエフェクタ17がスポット溶接装置である場合には、溶接対象を電極で挟み得るようにエンドエフェクタ17の姿勢が定まる。一例として、図6は、加工対象部位P1に加工を施し得るエンドエフェクタ17の姿勢が鉛直である場合(手首部15の中心軸線が鉛直軸線に沿う場合)を例示している。このような場合も想定し、ロボット10は、ワークWに正対した状態にて、手首部15を鉛直下方に向けてワークWにおける最高位置の加工対象部位P1にエンドエフェクタ17を配置した場合の第4軸線Ax4の位置から第1腕部13の基端PE1までの距離と、手首部15を鉛直上方に向けてエンドエフェクタ17をワークWにおける最低位置の加工対象部位P1に配置した場合の第4軸線Ax4の位置から第1腕部13の基端PE1までの距離とが、上記式(2)で求まる長さLb以下となるように位置してもよい。   Arranging the end effector 17 with respect to the processing target site P1 means that the above-described action part of the end effector 17 is arranged at the processing target site P1. The posture of the end effector 17 that can process the processing target part P1 is determined according to the state of the processing target part P1. For example, when the end effector 17 is a spot welding apparatus, the posture of the end effector 17 is determined so that the welding target can be sandwiched between electrodes. As an example, FIG. 6 illustrates a case where the posture of the end effector 17 that can perform processing on the processing target site P1 is vertical (when the central axis of the wrist portion 15 is along the vertical axis). Assuming such a case, the robot 10 faces the work W in a state where the end effector 17 is disposed at the highest processing target site P1 of the work W with the wrist 15 facing vertically downward. The distance from the position of the fourth axis Ax4 to the proximal end PE1 of the first arm 13 and the first effector 17 when the end effector 17 is arranged at the lowest position to be processed P1 in the workpiece W with the wrist 15 facing vertically upward. You may position so that the distance from the position of 4 axis line Ax4 to the base end PE1 of the 1st arm part 13 may be below length Lb calculated | required by said Formula (2).

図7に示すように、ロボット10は、第1腕部13の基端PE1の高さが式(3)で求まる高さHa以上となるように位置してもよい。
Ha=HH−L21・cosθ−L11・・・(3)
HH:前記手首部を鉛直下方に向けて前記エンドエフェクタを前記ワークにおける最高位置の加工対象部位に配置した場合の前記第4軸線の高さ
θ:第3軸線Ax3及び第4軸線Ax4に直交する直線と、手首部15の中心軸線との角度の最小値
なお、「角度の最小値」とは、可動範囲における最小値を意味する。
As shown in FIG. 7, the robot 10 may be positioned such that the height of the base end PE1 of the first arm portion 13 is equal to or higher than the height Ha obtained by Expression (3).
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 wrist 15 The “minimum value of the angle” means the minimum value in the movable range.

ロボット10は、第1腕部13の基端PE1の高さが式(4)で求まる高さHb以下となるように位置してもよい。
Hb=HL+L21・cosθ+L11・・・(4)
HL:前記手首部を鉛直上方に向けて前記エンドエフェクタを前記ワークにおける最低位置の加工対象部位に配置した場合の前記第4軸線の高さ
The robot 10 may be positioned such that the height of the base end PE1 of the first arm portion 13 is equal to or less than the 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

図8に示すように、ワークWに正対した状態にて、手首部15を鉛直下方に向けてエンドエフェクタ17をワークWにおける最高位置の加工対象部位P1に配置した場合の第4軸線Ax4の位置から式(5)で求まる距離Lcで手前側にシフトし、式(6)で求まる高さHcで下方にシフトした位置から第1腕部13の基端PE1までの距離と、手首部15を鉛直上方に向けてエンドエフェクタ17をワークWにおける最低位置の加工対象部位P1に配置した場合の第4軸線Ax4の位置から式(5)で求まる距離Lcで手前側にシフトし、式(6)で求まる高さHcで上方にシフトした位置から第1腕部13の基端PE1までの距離とが、最長距離L11以下となるように位置してもよい。
Lc=L21・sinθ・・・(5)
Hc=L21・cosθ・・・(6)
As shown in FIG. 8, the fourth axis Ax4 when the end effector 17 is disposed at the highest processing target site P1 of the workpiece W with the wrist 15 facing vertically downward in a state of facing the workpiece W is shown. The distance from the position to the front side by the distance Lc determined by Equation (5) and the position shifted downward by the height Hc determined by Equation (6) to the proximal end PE1 of the first arm portion 13 and the wrist portion 15 Is shifted upward from the position of the fourth axis Ax4 when the end effector 17 is disposed at the lowest position to be processed P1 in the workpiece W by a distance Lc determined by Expression (5), and the expression (6 The distance from the position shifted upward at the height Hc determined by (1) to the base end PE1 of the first arm portion 13 may be positioned to be equal to or less than the longest distance L11.
Lc = L21 · sin θ (5)
Hc = L21 · cos θ (6)

2台のロボット10は、搬送装置30による搬送方向(図示x軸に沿う方向)に直交する方向(図示y軸に沿う方向)でワークWを挟むように配置されている。以下、図示y軸の正の方向を「左方向」とし、図示y軸の負の方向を「右方向」とする。左側のロボット10は、ワークWの左側の加工対象部位P1に対して加工を行い、右側のロボット10は、ワークWの右側の加工対象部位P2に対して加工を行う。   The two robots 10 are arranged so as to sandwich the workpiece W in a direction (a direction along the y axis in the drawing) orthogonal to a transfer direction (a direction along the x axis in the drawing) by the transfer device 30. Hereinafter, the positive direction of the illustrated y axis is referred to as “left direction”, and the negative direction of the illustrated y axis is referred to as “right direction”. The left robot 10 performs processing on the processing target portion P1 on the left side of the workpiece W, and the right robot 10 performs processing on the processing target portion P2 on the right side of the workpiece W.

左側のロボット10は、当該ロボット10側(左側)からの全加工対象部位P1に対し、ワークWに干渉することなく加工を行うことが可能となるように配置されている。一例として、左側のロボット10は、最上部の加工対象部位P1及び最下部の加工対象部位P1の両方に対し、ワークWに干渉することなくエンドエフェクタ17を到達させられるように配置されている。   The robot 10 on the left side is arranged so as to be able to perform machining without interfering with the workpiece W with respect to the entire machining target portion P1 from the robot 10 side (left side). As an example, the left robot 10 is arranged so that the end effector 17 can reach both the uppermost processing target site P1 and the lowermost processing target site P1 without interfering with the workpiece W.

右側のロボット10は、当該ロボット10側(右側)からの全加工対象部位P2に対し、ワークWに干渉することなく加工を行うことが可能となるように配置されている。
一例として、右側のロボット10は、最上部の加工対象部位P2及び最下部の加工対象部位P2の両方に対し、ワークWに干渉することなくエンドエフェクタ17を到達させられるように配置されている。
The robot 10 on the right side is arranged so as to be able to perform machining without interfering with the workpiece W with respect to the entire machining target portion P2 from the robot 10 side (right side).
As an example, the robot 10 on the right side is arranged so that the end effector 17 can reach both the uppermost processing target site P2 and the lowermost processing target site P2 without interfering with the workpiece W.

(コントローラ及びプログラミングペンダント)
コントローラ100は、2台のロボット10及び搬送装置30を制御する装置である。プログラミングペンダント120は、有線又は無線により、コントローラ100に対するデータの入出力を行う装置である。
(Controller and programming pendant)
The controller 100 is a device that controls the two robots 10 and the transfer device 30. The programming pendant 120 is a device that inputs and outputs data to and from the controller 100 by wire or wireless.

コントローラ100は、機能的な構成として、目標取得部111と、第1算出部112と、判定部113と、第2算出部114と、出力部115と、蓄積部116とを有する。   The controller 100 includes a target acquisition unit 111, a first calculation unit 112, a determination unit 113, a second calculation unit 114, an output unit 115, and an accumulation unit 116 as functional configurations.

蓄積部116は、ロボット10の動作パターンを蓄積する。動作パターンは、例えばアクチュエータ21〜27の動作目標値の時系列データである。   The accumulation unit 116 accumulates the operation pattern of the robot 10. The operation pattern is, for example, time series data of operation target values of the actuators 21 to 27.

目標取得部111は、先端部16の位置・姿勢の目標値をプログラミングペンダント120から取得する。目標取得部111が取得する位置・姿勢の目標値は、ユーザによりプログラミングペンダント120に入力されたものであってもよいし、プログラミングペンダント120を介して記録媒体から読み込まれたものであってもよい。   The target acquisition unit 111 acquires the target value of the position / posture of the distal end portion 16 from the programming pendant 120. The position / posture target values acquired by the target acquisition unit 111 may be input to the programming pendant 120 by the user or may be read from the recording medium via the programming pendant 120. .

第1算出部112は、距離調節用の第7アクチュエータ27の動作目標値を初期値に固定した条件にて、位置・姿勢の目標値に対応するアクチュエータ21〜26の動作目標値を算出し、アクチュエータ21〜27の動作目標値を蓄積部116に記憶させる。   The first calculation unit 112 calculates the operation target values of the actuators 21 to 26 corresponding to the position / posture target values under the condition that the operation target value of the seventh actuator 27 for distance adjustment is fixed to the initial value. The operation target values of the actuators 21 to 27 are stored in the storage unit 116.

第7アクチュエータ27の動作目標値は、第2軸線Ax2及び第3軸線Ax3の間の距離L1を調節する動作量の目標値であり、例えば第1腕部13の屈曲角の目標値である。第1腕部13の屈曲角の初期値は例えば0°である。   The operation target value of the seventh actuator 27 is a target value of the operation amount for adjusting the distance L1 between the second axis Ax2 and the third axis Ax3, for example, the target value of the bending angle of the first arm portion 13. The initial value of the bending angle of the first arm portion 13 is, for example, 0 °.

第1アクチュエータ21の動作目標値は例えば旋回部12の旋回角の目標値である。第2アクチュエータ22の動作目標値は例えば第1腕部13の揺動角の目標値である。第3アクチュエータ23の動作目標値は例えば第2腕部14の揺動角の目標値である。第5アクチュエータ25の動作目標値は例えば手首部15の旋回角の目標値である。第4アクチュエータ24の動作目標値は例えば手首部15の揺動角の目標値である。第6アクチュエータ26の動作目標値は先端部16の旋回角の目標値である。   The operation target value of the first actuator 21 is a target value of the turning angle of the turning unit 12, for example. The operation target value of the second actuator 22 is, for example, a target value of the swing angle of the first arm portion 13. The operation target value of the third actuator 23 is, for example, a target value of the swing angle of the second arm portion 14. The operation target value of the fifth actuator 25 is, for example, a target value of the turning angle of the wrist portion 15. The operation target value of the fourth actuator 24 is, for example, a target value of the swing angle of the wrist portion 15. The operation target value of the sixth actuator 26 is a target value of the turning angle of the tip portion 16.

アクチュエータ21〜26の動作目標値は、例えば逆運動学演算により算出される。第1算出部112は、アクチュエータ21〜27の動作目標値の算出結果を蓄積部116に記憶させる。   The operation target values of the actuators 21 to 26 are calculated by, for example, inverse kinematic calculation. The first calculation unit 112 causes the accumulation unit 116 to store the calculation results of the operation target values of the actuators 21 to 27.

判定部113は、蓄積部116に記憶された動作目標値が出力可能か否かを判定する。例えば判定部113は、蓄積部116に記憶された動作目標値でアクチュエータ21〜27を動作させるとロボット10とワークWとの干渉が生じる場合に、当該動作目標値が出力不可であると判定する。   The determination unit 113 determines whether or not the operation target value stored in the storage unit 116 can be output. For example, the determination unit 113 determines that the operation target value cannot be output when the actuators 21 to 27 are operated with the operation target values stored in the storage unit 116 and the robot 10 and the workpiece W interfere with each other. .

判定部113は、アクチュエータ21〜26の少なくともいずれかを判定対象とし、判定対象のアクチュエータについて、第1算出部112により算出された動作目標値が許容範囲外である場合にも、当該動作目標値が出力不可であると判定してもよい。判定部113は、アクチュエータ21〜26の全てを判定対象としてもよいし、アクチュエータ21〜26の一部(例えば第2アクチュエータ22、第3アクチュエータ23及び第4アクチュエータ24)のみを判定対象としてもよい。判定部113は、第3アクチュエータ23及び第4アクチュエータ24のみを判定対象としてもよいし、第3アクチュエータ23及び第4アクチュエータ24のいずれか一方のみを判定対象としてもよい。許容範囲は、判定対象のアクチュエータにより駆動される部分の動作量が可動範囲内となるように設定される。例えば第3アクチュエータ23が判定対象である場合に、第3アクチュエータ23の動作目標値の許容範囲は、第2腕部14の揺動角が可動範囲内となるように設定される。   The determination unit 113 sets at least one of the actuators 21 to 26 as a determination target, and even when the operation target value calculated by the first calculation unit 112 is outside the allowable range for the determination target actuator, May not be output. The determination unit 113 may set all of the actuators 21 to 26 as determination targets or only a part of the actuators 21 to 26 (for example, the second actuator 22, the third actuator 23, and the fourth actuator 24) as determination targets. . The determination unit 113 may set only the third actuator 23 and the fourth actuator 24 as a determination target, or may set only one of the third actuator 23 and the fourth actuator 24 as a determination target. The allowable range is set so that the operation amount of the portion driven by the determination target actuator is within the movable range. For example, when the third actuator 23 is a determination target, the allowable range of the operation target value of the third actuator 23 is set so that the swing angle of the second arm portion 14 is within the movable range.

第2算出部114は、判定部113により動作目標値が出力不可であると判定された場合に、出力可となるようにアクチュエータ21〜27の動作目標値を修正する。例えば第2算出部114は、ロボット10とワークWとの干渉が生じることが判定部113により判定された場合に、第2軸線Ax2及び第3軸線Ax3の距離L1を小さくしてロボット10とワークWとの干渉を回避するようにアクチュエータ21〜27の動作目標値を修正する。具体的に、第2算出部114は、ロボット10とワークWとの干渉を回避するように拘束条件を設定し、その拘束条件を適用した逆運動学演算によりアクチュエータ21〜27の動作目標値を修正してもよい。   When the determination unit 113 determines that the operation target value cannot be output, the second calculation unit 114 corrects the operation target values of the actuators 21 to 27 so that the output can be performed. For example, when the determination unit 113 determines that interference between the robot 10 and the workpiece W occurs, the second calculation unit 114 decreases the distance L1 between the second axis Ax2 and the third axis Ax3, and the robot 10 and the workpiece The operation target values of the actuators 21 to 27 are corrected so as to avoid interference with W. Specifically, the second calculation unit 114 sets a constraint condition so as to avoid the interference between the robot 10 and the workpiece W, and sets the operation target values of the actuators 21 to 27 by inverse kinematic calculation to which the constraint condition is applied. It may be corrected.

第2算出部114は、少なくとも一つの判定対象のアクチュエータについて動作目標値が許容範囲外となった場合に、当該動作目標値が許容範囲内に収まるように、アクチュエータ21〜27の動作目標値を修正してもよい。具体的に、第2算出部114は、動作目標値が許容範囲外となっているアクチュエータについて、当該動作目標値が許容範囲内に収まるように拘束条件を設定した上で、その拘束条件を適用した逆運動学演算によりアクチュエータ21〜27の動作目標値を修正してもよい。   The second calculation unit 114 sets the operation target values of the actuators 21 to 27 so that the operation target value falls within the allowable range when the operation target value of the at least one determination target actuator falls outside the allowable range. It may be corrected. Specifically, the second calculation unit 114 sets the constraint condition for the actuator whose operation target value is outside the allowable range so that the operation target value falls within the allowable range, and then applies the constraint condition. The operation target values of the actuators 21 to 27 may be corrected by the inverse kinematic calculation.

第2算出部114は、距離調節用の第7軸線Ax7がワークWから遠ざかる方向に第1腕部13を屈曲させるように上記拘束条件を設定し、アクチュエータ21〜27の動作目標値を算出してもよい。   The second calculation unit 114 sets the constraint condition such that the first arm portion 13 is bent in a direction in which the seventh axis Ax7 for distance adjustment moves away from the workpiece W, and calculates the operation target values of the actuators 21 to 27. May be.

第2算出部114は、アクチュエータ21〜27の動作目標値の算出結果を蓄積部116に記憶させ、直前の算出結果を上書きする。   The second calculation unit 114 stores the calculation result of the operation target value of the actuators 21 to 27 in the storage unit 116 and overwrites the previous calculation result.

出力部115は、動作目標値に応じてアクチュエータ21〜27を制御する。具体的に、出力部115は、アクチュエータ21〜27による各部の動作量が設定された動作目標値に略一致するように、アクチュエータ21〜27を制御する。出力部115は、アクチュエータ21〜27に加えて搬送アクチュエータ32も制御する。   The output unit 115 controls the actuators 21 to 27 according to the operation target value. Specifically, the output unit 115 controls the actuators 21 to 27 so that the operation amounts of the respective units by the actuators 21 to 27 substantially coincide with the set operation target values. The output unit 115 controls the transport actuator 32 in addition to the actuators 21 to 27.

コントローラ100は、先端部16の位置・姿勢の目標値を取得すること、距離調節用の第7アクチュエータ27の動作目標値を固定した条件にて、位置・姿勢の目標値に対応するアクチュエータ21〜26の動作目標値を算出すること、算出された動作目標値が出力可能であるかを判定すること、動作目標値が出力不可であると判定した場合に、出力可となるようにアクチュエータ21〜27の動作目標値を修正すること、動作目標値に応じてアクチュエータ21〜27を制御すること、を実行するように構成されていればよいので、そのハードウェア構成は必ずしも目標取得部111、第1算出部112、判定部113、第2算出部114及び出力部115及び蓄積部116に分離していなくてもよい。   The controller 100 acquires the target value of the position / posture of the distal end portion 16 and the actuators 21 to 21 corresponding to the target value of the position / posture under the condition that the operation target value of the seventh actuator 27 for distance adjustment is fixed. 26 to calculate the motion target value, to determine whether the calculated motion target value can be output, and to determine that the output of the motion target value is not possible. It is sufficient that the operation target value of 27 is corrected and the actuators 21 to 27 are controlled in accordance with the operation target value. The first calculation unit 112, the determination unit 113, the second calculation unit 114, the output unit 115, and the storage unit 116 may not be separated.

図9は、コントローラ100のハードウェア構成の一例を示す図である。図9に例示されるコントローラ100は、回路130を有する。回路130は、プロセッサ131と、メモリ132と、ストレージ133と、入出力ポート134と、複数のモータドライバ136とを有する。入出力ポート134は、プログラミングペンダント120及び複数のモータドライバ136に対するデータの入出力を行う。複数のモータドライバ136は、2台のロボット10のアクチュエータ21〜27及び搬送アクチュエータ32をそれぞれ制御する。プロセッサ131は、メモリ132及びストレージ133の少なくとも一方と協働してプログラムを実行し、入出力ポート134を介したデータの入出力を行うことで、コントローラ100を目標取得部111、第1算出部112、判定部113、第2算出部114、出力部115及び蓄積部116として機能させる。   FIG. 9 is a diagram illustrating an example of a hardware configuration of the controller 100. The controller 100 illustrated in FIG. 9 includes a circuit 130. The circuit 130 includes a processor 131, a memory 132, a storage 133, an input / output port 134, and a plurality of motor drivers 136. The input / output port 134 inputs / outputs data to / from the programming pendant 120 and the plurality of motor drivers 136. The plurality of motor drivers 136 respectively control the actuators 21 to 27 and the transport actuator 32 of the two robots 10. The processor 131 executes the program in cooperation with at least one of the memory 132 and the storage 133, and inputs / outputs data via the input / output port 134, thereby causing the controller 100 to execute the target acquisition unit 111, the first calculation unit. 112, function as the determination unit 113, the second calculation unit 114, the output unit 115, and the storage unit 116.

コントローラ100のハードウェア構成は、必ずしもプログラムの実行により各機能をなすものに限られない。例えば目標取得部111、第1算出部112、判定部113、第2算出部114、出力部115及び蓄積部116の少なくとも一部はその機能に特化した論理回路により構成されていてもよいし、当該論理回路を集積したASIC(Application Specific integrated circuit)により構成されていてもよい。   The hardware configuration of the controller 100 is not necessarily limited to one that performs each function by executing a program. For example, at least a part of the target acquisition unit 111, the first calculation unit 112, the determination unit 113, the second calculation unit 114, the output unit 115, and the storage unit 116 may be configured by a logic circuit specialized for the function. Alternatively, the logic circuit may be configured by an ASIC (Application Specific integrated circuit).

〔制御方法〕
続いて、本開示に係る制御方法の一例として、コントローラ100によるロボット10及び搬送装置30の制御手順を説明する。
[Control method]
Subsequently, a control procedure of the robot 10 and the transfer device 30 by the controller 100 will be described as an example of a control method according to the present disclosure.

(制御手順の概要)
図10に示すように、まずコントローラ100はステップS01を実行する。ステップS01では、第1算出部112及び第2算出部114の少なくとも一方がアクチュエータ21〜27の動作目標値の算出結果を蓄積部116に記憶させ、2台のロボット10の動作パターンを構築する。2台のロボット10の動作パターンは、ワークWに対する加工を行うように構築される。
(Outline of control procedure)
As shown in FIG. 10, first, the controller 100 executes step S01. In step S01, at least one of the first calculation unit 112 and the second calculation unit 114 stores the calculation results of the operation target values of the actuators 21 to 27 in the storage unit 116, and constructs the operation patterns of the two robots 10. The operation patterns of the two robots 10 are constructed so as to process the workpiece W.

次に、コントローラ100はステップS02〜S04を実行する。ステップS02では、ワークWの搬送を開始するように出力部115が搬送アクチュエータ32を制御する。ステップS03では、ワークWに対する加工を実行するように、出力部115が2台のロボット10を制御する。即ち出力部115は、蓄積部116に記憶された動作目標値に応じて2台のロボット10のアクチュエータ21〜27を制御する。ステップS04では、ワークWの搬送を終了するように出力部115が搬送アクチュエータ32を制御する。   Next, the controller 100 executes steps S02 to S04. In step S02, the output unit 115 controls the transport actuator 32 so as to start transporting the workpiece W. In step S03, the output unit 115 controls the two robots 10 so as to execute machining on the workpiece W. That is, the output unit 115 controls the actuators 21 to 27 of the two robots 10 according to the operation target value stored in the storage unit 116. In step S04, the output unit 115 controls the transport actuator 32 so as to end the transport of the workpiece W.

次に、コントローラ100はステップS05を実行する。ステップS05では、加工終了の指令が入力されているか否かを出力部115が判定する。加工終了の指令は、例えばプログラミングペンダント120を介して入力される。加工終了の指令が入力されていない場合、コントローラ100は処理をステップS02に戻す。これにより、同一の加工手順が繰り返される。加工終了の指令が入力されている場合、コントローラ100は処理を終了する。   Next, the controller 100 executes step S05. In step S05, the output unit 115 determines whether or not a machining end command has been input. The processing end command is input through the programming pendant 120, for example. If the machining end command has not been input, the controller 100 returns the process to step S02. Thereby, the same processing procedure is repeated. If a machining end command is input, the controller 100 ends the process.

(動作パターンの生成手順)
続いて上記ステップS01における動作パターンの生成手順について、より詳細に説明する。図11に示すように、まずコントローラ100はステップS11を実行する。ステップS11では、目標取得部111が、先端部16の位置・姿勢の目標値をプログラミングペンダント120から取得する。
(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 controller 100 first executes step S11. In step S <b> 11, the target acquisition unit 111 acquires the target value of the position / posture of the distal end portion 16 from the programming pendant 120.

次に、コントローラ100はステップS12,S13を実行する。ステップS12では、第1算出部112が、距離調節用の第7アクチュエータ27の動作目標値を初期値に設定する。例えば第1算出部112は、第1腕部13の屈曲角を0°に設定する。ステップS13では、第1算出部112が、第7アクチュエータ27の動作目標値を初期値に固定した条件にて、位置・姿勢の目標値に対応するアクチュエータ21〜26の動作目標値を算出し、アクチュエータ21〜27の算出結果を蓄積部116に記憶させる。   Next, the controller 100 executes steps S12 and S13. In step S12, the first calculation unit 112 sets the operation target value of the seventh actuator 27 for distance adjustment to an initial value. For example, the 1st calculation part 112 sets the bending angle of the 1st arm part 13 to 0 degree. In step S13, the first calculation unit 112 calculates the operation target values of the actuators 21 to 26 corresponding to the position / posture target values under the condition that the operation target value of the seventh actuator 27 is fixed to the initial value. The calculation results of the actuators 21 to 27 are stored in the storage unit 116.

次に、コントローラ100はステップS14を実行する。ステップS14では、判定部113が、蓄積部116に記憶された動作目標値が出力可能か否かを判定する。例えば判定部113は、蓄積部116に記憶された動作目標値でアクチュエータ21〜27を動作させた場合に、ロボット10とワークWとの干渉が生じる場合に、当該動作目標値が出力不可であると判定する。   Next, the controller 100 performs step S14. In step S <b> 14, the determination unit 113 determines whether or not the operation target value stored in the storage unit 116 can be output. For example, when the actuators 21 to 27 are operated with the operation target values stored in the storage unit 116 and the interference between the robot 10 and the workpiece W occurs, the determination unit 113 cannot output the operation target value. Is determined.

判定部113は、アクチュエータ21〜26の少なくともいずれかを判定対象とし、判定対象のアクチュエータについて動作目標値が許容範囲外である場合にも、当該動作目標値が出力不可であると判定してもよい。   The determination unit 113 determines at least one of the actuators 21 to 26 as a determination target and determines that the operation target value cannot be output even when the operation target value of the determination target actuator is outside the allowable range. Good.

ステップS14において、動作目標値が出力不可であると判定された場合に、コントローラ100はステップS15,S16を実行する。   When it is determined in step S14 that the operation target value cannot be output, the controller 100 executes steps S15 and S16.

ステップS15では、動作目標値を出力可とするように、第2算出部114が第7アクチュエータ27の動作目標値を設定する。例えば第2算出部114は、距離L1を短縮してロボット10とワークWとの干渉を回避するように第7アクチュエータ27の動作目標値を設定する。第2算出部114は、他のアクチュエータにおいて許容範囲外となっている動作目標値の一部を分担するように、第7アクチュエータ27の動作目標値を設定してもよい。   In step S15, the second calculation unit 114 sets the operation target value of the seventh actuator 27 so that the operation target value can be output. For example, the second calculation unit 114 sets the operation target value of the seventh actuator 27 so as to shorten the distance L1 and avoid the interference between the robot 10 and the workpiece W. The second calculation unit 114 may set the operation target value of the seventh actuator 27 so as to share a part of the operation target value that is outside the allowable range in the other actuators.

ステップS16では、第2算出部114が、第7アクチュエータ27の動作目標値をステップS15における設定値に固定した条件にて、位置・姿勢の目標値に対応するアクチュエータ21〜26の動作目標値を算出する。第2算出部114は、アクチュエータ21〜27の動作目標値の算出結果を蓄積部116に記憶させ、直前の算出結果を上書きする。   In step S16, the second calculation unit 114 calculates the operation target values of the actuators 21 to 26 corresponding to the position / posture target values under the condition that the operation target value of the seventh actuator 27 is fixed to the set value in step S15. calculate. The second calculation unit 114 stores the calculation result of the operation target value of the actuators 21 to 27 in the storage unit 116 and overwrites the previous calculation result.

その後、コントローラ100は処理をステップS14に戻す。これにより、動作目標値が出力可となるまでステップS14〜S15が繰り返される。   Thereafter, the controller 100 returns the process to step S14. Thus, steps S14 to S15 are repeated until the operation target value can be output.

ステップS15,S16において、第2算出部114は、距離調節用の第7軸線Ax7がワークWから遠ざかる方向に第1腕部13を屈曲させるように、アクチュエータ21〜27の動作目標値を算出してもよい。即ちコントローラ100は、第7軸線Ax7がワークWから遠ざかる方向に第1腕部13を屈曲させるようにアクチュエータ21〜27を制御するものであってもよい。   In Steps S15 and S16, the second calculation unit 114 calculates the operation target values of the actuators 21 to 27 so that the first arm portion 13 is bent in the direction in which the seventh axis Ax7 for distance adjustment moves away from the workpiece W. May be. That is, the controller 100 may control the actuators 21 to 27 so as to bend the first arm portion 13 in the direction in which the seventh axis Ax7 moves away from the workpiece W.

第2算出部114によるアクチュエータ21〜27の動作目標値の算出手順は上述したものに限られない。例えば、ステップS15において、第7アクチュエータ27の動作目標値を設定するのに代えて、動作目標値が許容範囲外となっているアクチュエータ自体の動作目標値を許容範囲内の値に設定してもよい。これに対応し、ステップS16においては、アクチュエータ21〜26のうちステップS15において動作目標値を設定したアクチュエータを除いたもの、及び第7アクチュエータ27の動作目標値を算出してもよい。   The calculation procedure of the operation target values of the actuators 21 to 27 by the second calculation unit 114 is not limited to the above. For example, instead of setting the operation target value of the seventh actuator 27 in step S15, the operation target value of the actuator itself whose operation target value is outside the allowable range may be set to a value within the allowable range. Good. Correspondingly, in step S16, the actuators 21 to 26 excluding the actuator for which the operation target value was set in step S15, and the operation target value of the seventh actuator 27 may be calculated.

ステップS14において、動作目標値が出力可であると判定された場合に、コントローラ100はステップS17を実行する。ステップS17では、動作パターンの構築が完了したか否かをコントローラ100が判定する。具体的には、例えば目標取得部111が、動作パターンの構築に必要な位置・姿勢の目標値を全て取得したか否かを判定する。位置・姿勢の目標値を全て取得したか否かは、例えばユーザがプログラミングペンダント120に入力した完了指令又はプログラミングペンダント120が記録媒体から読み込んだ完了指令に基づいて判定される。   When it is determined in step S14 that the operation target value can be output, the controller 100 executes step S17. In step S17, the controller 100 determines whether or not the construction of the operation pattern is completed. Specifically, for example, the target acquisition unit 111 determines whether or not all target values of positions and orientations necessary for construction of the motion pattern have been acquired. Whether or not all position / posture target values have been acquired is determined based on, for example, a completion command input by the user to the programming pendant 120 or a completion command read by the programming pendant 120 from the recording medium.

ステップS17において、動作パターンの構築が完了していないと判定した場合、コントローラ100は処理をステップS11に戻す。これにより、動作パターンの構築が完了するまでステップS11〜S17が繰り返され、アクチュエータ21〜27の動作目標値の時系列データが構築される。   If it is determined in step S17 that the construction of the operation pattern has not been completed, the controller 100 returns the process to step S11. Thereby, steps S11 to S17 are repeated until the construction of the operation pattern is completed, and time series data of the operation target values of the actuators 21 to 27 is constructed.

ステップS17において、動作パターンの構築が完了していると判定した場合、コントローラ100は処理を終了する。   If it is determined in step S17 that the construction of the operation pattern has been completed, the controller 100 ends the process.

(ロボットの動作)
上記構成により、コントローラ100は、ステップS11〜S17により生成された動作パターンにて動作するようにロボット10を制御する。例えばコントローラ100は、ワークWの複数の加工対象部位P1にエンドエフェクタ17を移動させるようにロボット10を制御することと、エンドエフェクタ17が加工対象部位P1に配置された状態で、エンドエフェクタ17により当該加工対象部位P1に加工を施すようにロボット10を制御することとを実行する。
(Robot motion)
With the above configuration, the controller 100 controls the robot 10 so as to operate in the operation pattern generated in steps S11 to S17. For example, the controller 100 controls the robot 10 to move the end effector 17 to a plurality of processing target parts P1 of the workpiece W, and the end effector 17 causes the end effector 17 to be placed in the processing target part P1. The robot 10 is controlled so as to process the processing target part P1.

複数の加工対象部位P1は、第1腕部13の基端部より高い位置にある加工対象部位P1と、第1腕部13の基端部より低い位置にある加工対象部位P1とを含む場合がある。この場合、コントローラ100は、図12の(a)〜(f)に示すように、第2腕部14の先端部が第1腕部13の基端部よりワークW側に位置する状態で、第1腕部13の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ17を移動させるようにロボット10を制御する。   The plurality of processing target sites P1 include a processing target site P1 that is higher than the base end portion of the first arm portion 13 and a processing target site P1 that is lower than the base end portion of the first arm portion 13. There is. In this case, as shown in FIGS. 12A to 12F, the controller 100 is in a state where the distal end portion of the second arm portion 14 is located closer to the workpiece W than the proximal end portion of the first arm portion 13. The robot 10 is controlled to move the end effector 17 between a position higher than the base end of the first arm 13 and a position lower than the base end.

この過程において、第1腕部13の基端部より高い位置及び当該基端部より低い位置の間で第1腕部13の先端部が移動する場合もある。すなわち、第1腕部13の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ17を移動させるようにロボット10を制御することは、第1腕部13の基端部より高い位置及び当該基端部より低い位置の間で第1腕部13の先端部を移動させるようにロボット10を制御することを含んでもよい。   In this process, the distal end of the first arm 13 may move between a position higher than the base end of the first arm 13 and a position lower than the base end. That is, controlling the robot 10 to move the end effector 17 between a position higher than the base end portion of the first arm portion 13 and a position lower than the base end portion means that the base end portion of the first arm portion 13 It may include controlling the robot 10 to move the distal end portion of the first arm portion 13 between a higher position and a lower position than the base end portion.

上述したように、ロボット10は、ワークWに正対した状態で、距離L1を最長距離L11として第2軸線Ax2まわりに第1腕部13を回転させた場合に、第1腕部13の先端部DP1又は第2腕部14の基端部PP2がワークWに干渉するように位置する。このため、距離L1を最長距離L11に固定した状態にて、第1腕部13の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ17を移動させると、ロボット10がワークWに干渉する場合がある。距離L1を最長距離L11に固定した状態にて、第1腕部13の基端部より高い位置及び当該基端部より低い位置の間で第1腕部13の先端部を移動させると、ロボット10がワークWに干渉する可能性が更に高まる。   As described above, when the robot 10 rotates the first arm 13 around the second axis Ax2 with the distance L1 as the longest distance L11 in a state of facing the workpiece W, the tip of the first arm 13 is reached. The base part PP2 of the part DP1 or the second arm part 14 is positioned so as to interfere with the workpiece W. For this reason, when the end effector 17 is moved between a position higher than the base end of the first arm 13 and a position lower than the base end with the distance L1 fixed to the longest distance L11, the robot 10 It may interfere with the workpiece W. When the distal end of the first arm 13 is moved between a position higher than the base end of the first arm 13 and a position lower than the base end with the distance L1 fixed to the longest distance L11, the robot The possibility that 10 will interfere with the workpiece W is further increased.

これに対し、ステップS11〜S17によれば、距離L1を短縮してロボット10とワークWとの干渉を回避するようにアクチュエータ21〜27の動作パターンが生成される。この場合、コントローラ100は、第1腕部13の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ17を移動させる過程で、第2軸線Ax2及び第3軸線Ax3の間の距離L1を第7アクチュエータ27により変化させるようにロボット10を制御する。すなわち、第1腕部13の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ17を移動させるようにロボット10を制御することは、第2軸線Ax2及び第3軸線Ax3の間の距離を第7アクチュエータ27により変化させるようにロボット10を制御することを含んでもよい。   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 robot 10 and the workpiece W. In this case, the controller 100 moves the end effector 17 between a position higher than the base end of the first arm 13 and a position lower than the base end between the second axis Ax2 and the third axis Ax3. Is controlled by the seventh actuator 27. That is, controlling the robot 10 to move the end effector 17 between a position higher than the base end portion of the first arm 13 and a position lower than the base end portion means that the second axis Ax2 and the third axis Ax3 The robot 10 may be controlled to change the distance between them by the seventh actuator 27.

〔第1実施形態による効果〕
以上に説明したように、加工装置1によれば、ワークWに正対した状態で、第2軸線Ax2及び第3軸線Ax3の間の距離L1を最長距離L11として第2軸線Ax2まわりに第1腕部13を回転させた場合に、第1腕部13の先端部又は第2腕部14の基端部が前記ワークに干渉するように、ロボット10がワークWに近接する。このため、より遠位の加工対象部位までエンドエフェクタ17を到達させ易い。ロボット10がワークWに近接配置されていても、第7アクチュエータ27により第2軸線Ax2及び第3軸線Ax3の間の距離L1を短縮することで、ロボット10とワークWとの干渉を回避しながらエンドエフェクタ17を移動させることができる。従って、近接配置による到達範囲の広域化と、干渉回避による可動範囲の広域化との両立を図り、個々のロボット10でワークWの広範囲に加工を施すことができる。
[Effects of First Embodiment]
As described above, according to the machining apparatus 1, in the state of facing the workpiece W, the distance L1 between the second axis Ax2 and the third axis Ax3 is set to the longest distance L11, and the first axis around the second axis Ax2. When the arm portion 13 is rotated, the robot 10 approaches the workpiece W so that the distal end portion of the first arm portion 13 or the proximal end portion of the second arm portion 14 interferes with the workpiece. For this reason, it is easy to make the end effector 17 reach a more distal processing target site. Even when the robot 10 is disposed close to the workpiece W, the distance L1 between the second axis Ax2 and the third axis Ax3 is shortened by the seventh actuator 27, thereby avoiding interference between the robot 10 and the workpiece W. The end effector 17 can be moved. Therefore, it is possible to achieve both the widening of the reach range by the proximity arrangement and the widening of the movable range by avoiding the interference, and the individual robot 10 can process the work W over a wide range.

図13は、第7アクチュエータ27の作用を例示する図である。図13中の二点鎖線で示されるロボット10は、第1腕部13を屈曲させることなくエンドエフェクタ17を加工対象部位に配置した場合を示している。二点鎖線で示されるロボット10は、ワークWに干渉している。これに対し、実線で示されるロボット10は、第1腕部13を屈曲させて第2軸線Ax2及び第3軸線Ax3の間の距離を短縮するように第7アクチュエータ27を動作させた場合を示している。実線で示されるロボット10では、先端部16の位置・姿勢を維持した状態で、第4軸線Ax4及び第2軸線Ax2の間の部分がワークWから遠ざかり、ワークWに対するロボット10の干渉が防止されている。   FIG. 13 is a diagram illustrating the operation of the seventh actuator 27. The robot 10 indicated by a two-dot chain line in FIG. 13 shows a case where the end effector 17 is arranged at the processing target portion without bending the first arm portion 13. The robot 10 indicated by a two-dot chain line interferes with the workpiece W. On the other hand, the robot 10 indicated by a solid line shows a case where the seventh actuator 27 is operated so as to shorten the distance between the second axis Ax2 and the third axis Ax3 by bending the first arm 13. ing. In the robot 10 indicated by the solid line, the portion between the fourth axis Ax4 and the second axis Ax2 moves away from the workpiece W while the position and posture of the tip end portion 16 are maintained, and the robot 10 is prevented from interfering with the workpiece W. ing.

ロボット10は、ワークWに正対した状態で、距離L1を最短距離L12として第2軸線Ax2まわりに第1腕部13を回転させた場合には、第1腕部13の先端部及び第2腕部14の基端部がワークWに干渉しないように位置してもよい。この場合、ロボット10とワークWとの干渉をより確実に回避できる。従って、近接配置による到達範囲の広域化と、干渉の回避による可動範囲の広域化との両立をより確実に図ることができる。   When the robot 10 rotates the first arm 13 around the second axis Ax2 with the distance L1 as the shortest distance L12 while facing the workpiece W, the robot 10 and the second arm 13 You may position so that the base end part of the arm part 14 may not interfere with the workpiece | work W. FIG. In this case, the interference between the robot 10 and the workpiece W can be avoided more reliably. Accordingly, it is possible to more reliably achieve both the widening of the reachable range by the proximity arrangement and the widening of the movable range by avoiding interference.

第2腕部14の先端部が第1腕部13の基端部よりワークW側に位置する状態で、第1腕部13の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ17を移動させるようにロボット10を制御するコントローラ100を更に備えてもよい。この場合、近接配置による到達範囲の広域化と、干渉の回避による可動範囲の広域化との両立を可能とする構成を有効に活用し、個々のロボット10でワークWの広範囲に加工を施すことができる。   Between the position higher than the base end portion of the first arm portion 13 and the position lower than the base end portion in a state where the tip end portion of the second arm portion 14 is positioned closer to the workpiece W than the base end portion of the first arm portion 13. The controller 100 for controlling the robot 10 to move the end effector 17 may be further provided. In this case, it is possible to effectively utilize a configuration that enables both a wide reachable range by proximity arrangement and a wide movable range by avoiding interference, and processing a wide range of the workpiece W by each robot 10. Can do.

第1腕部13の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ17を移動させるようにロボット10を制御することは、第1腕部13の基端部より高い位置及び当該基端部より低い位置の間で第1腕部13の先端部を移動させるようにロボット10を制御することを含んでもよい。この場合、近接配置による到達範囲の広域化と、干渉の回避による可動範囲の広域化との両立を可能とする構成を更に有効に活用し、個々のロボット10でワークWの広範囲に加工を施すことができる。   Controlling the robot 10 to move the end effector 17 between a position higher than the base end of the first arm 13 and a position lower than the base end is higher than the base end of the first arm 13. The robot 10 may be controlled to move the distal end portion of the first arm portion 13 between the position and a position lower than the base end portion. In this case, it is possible to further effectively utilize the configuration that enables both the widening of the reachable range due to the proximity arrangement and the widening of the movable range due to avoidance of interference, and processing the wide range of the workpiece W by the individual robots 10. be able to.

第1腕部13の基端部より高い位置及び当該基端部より低い位置の間でエンドエフェクタ17を移動させるようにロボット10を制御することは、第2軸線Ax2及び第3軸線Ax3の間の距離L1を第7アクチュエータ27により変化させるようにロボット10を制御することを含んでもよい。この場合、近接配置による到達範囲の広域化と、干渉の回避による可動範囲の広域化との両立を可能とする構成をより確実に活用し、個々のロボットでワークの広範囲に加工を施すことができる。   Controlling the robot 10 to move the end effector 17 between a position higher than the base end of the first arm 13 and a position lower than the base end is between the second axis Ax2 and the third axis Ax3. The robot 10 may be controlled to change the distance L1 by the seventh actuator 27. In this case, it is possible to more reliably utilize a configuration that enables both a wide reach range by proximity arrangement and a wide movable range by avoiding interference, and machining a wide range of workpieces with individual robots. it can.

複数の姿勢調節アクチュエータは、第4軸線Ax4まわりに手首部15を搖動させる第4アクチュエータ24を含み、ロボット10は、ワークWに正対した状態にて、ワークWにおける最高位置の加工対象部位から第1腕部13の基端PE1までの距離と、最低位置の加工対象部位の両方から第1腕部13の基端PE1までの距離とが、上記式(1)で求まる長さLa以下となるように位置してもよい。この場合、ワークWにおける最高位置の加工対象部位及び最低位置の加工対象部位の両方にエンドエフェクタ17を配置できる。従って、個々のロボット10でより広範囲に加工を施すことができる。   The plurality of posture adjustment actuators include a fourth actuator 24 that swings the wrist 15 about the fourth axis Ax4, and the robot 10 faces the workpiece W from the processing target portion at the highest position in a state of facing the workpiece W. The distance to the base end PE1 of the first arm 13 and the distance from both of the lowest positions to be processed to the base end PE1 of the first arm 13 are equal to or less than the length La determined by the above formula (1). You may be located so that. In this case, the end effector 17 can be arranged on both the highest position and the lowest position of the workpiece W. Therefore, the processing can be performed in a wider range by each robot 10.

ロボット10は、ワークWに正対した状態にて、ワークWにおける最高位置の加工対象部位に対し、第4軸線Ax4からエンドエフェクタ17までの距離と等距離で上方にシフトした位置から第1腕部13の基端PE1までの距離と、ワークWにおける最低位置の加工対象部位に対し、第4軸線Ax4からエンドエフェクタ17までの距離と等距離で下方にシフトした位置から第1腕部13の基端PE1までの距離とが、上記式(2)で求まる長さLb以下となるように位置してもよい。この場合、ワークWにおける最高位置の加工対象部位及び最低位置の加工対象部位の両方に対し、より多様な姿勢でエンドエフェクタ17を配置できる。従って、個々のロボット10でより広範囲に加工を施すことができる。   With the robot 10 facing the workpiece W, the first arm moves from a position shifted upward at an equal distance from the fourth axis Ax4 to the end effector 17 with respect to the highest processing target portion of the workpiece W. The position of the first arm 13 from the position shifted downward at the same distance as the distance from the fourth axis Ax4 to the end effector 17 with respect to the distance to the base end PE1 of the portion 13 and the lowest position of the workpiece W in the workpiece W You may position so that the distance to base end PE1 may become below length Lb calculated | required by said Formula (2). In this case, the end effector 17 can be arranged in various postures with respect to both the highest processing target portion and the lowest processing target portion in the workpiece W. Therefore, the processing can be performed in a wider range by each robot 10.

ロボット10は、第1腕部13の基端PE1の高さが上記式(3)で求まる高さHa以上となるように位置してもよい。この場合、ワークWにおける最高位置の加工対象部位に対し、より多様な姿勢でエンドエフェクタ17を配置できる。従って、個々のロボット10でより広範囲に加工を施すことができる。   The robot 10 may be positioned such that the height of the base end PE1 of the first arm portion 13 is equal to or higher than the height Ha obtained by the above formula (3). In this case, the end effector 17 can be arranged in various postures with respect to the processing target portion at the highest position in the workpiece W. Therefore, the processing can be performed in a wider range by each robot 10.

ロボット10は、第1腕部13の基端PE1の高さが上記式(4)で求まる高さHb以下となるように位置してもよい。この場合、ワークWにおける最高位置の加工対象部位及び最低位置の加工対象部位の両方に対し、より多様な姿勢でエンドエフェクタ17を配置できる。従って、個々のロボット10でワークWのより広範囲に加工を施すことができる。   The robot 10 may be positioned such that the height of the base end PE1 of the first arm 13 is equal to or less than the height Hb obtained by the above formula (4). In this case, the end effector 17 can be arranged in various postures with respect to both the highest processing target portion and the lowest processing target portion in the workpiece W. Accordingly, it is possible to process the workpiece W in a wider range by the individual robots 10.

ロボット10がワークWに対し加工を実行するときに、ワークW及びロボット10の相対位置を変更するようにワークW及びロボット10の少なくとも一方を搬送する搬送装置30を更に備えてもよい。この場合、搬送装置30及びロボット10を協調させることにより、広範囲の加工対象部位に対して先端部16を適正配置することが可能となる。一方、ワークW及びロボット10の相対的な配置が変わるので、ワークWに対するロボット10の干渉の生じ易さも変化する。これに対し、ロボット10は、先端部16の位置・姿勢を調整するアクチュエータ21〜26に加え、距離調節用の第7アクチュエータ27を更に有する。このため、先端部16の位置・姿勢を維持した状態で、基台11及び先端部16の間におけるロボット10の姿勢を自在に変更可能である。これにより、ワークW及びロボット10の相対的な配置の変化に柔軟に対応して相互の干渉を抑制できる。ワークWを回避し易い特性により、ロボット10の配置の選択肢も多くなる。従って、容易な生産設備構築が可能となる。   When the robot 10 performs processing on the workpiece W, the robot 10 may further include a transfer device 30 that transfers at least one of the workpiece W and the robot 10 so as to change a relative position between the workpiece W and the robot 10. In this case, by coordinating the transfer device 30 and the robot 10, it is possible to properly arrange the distal end portion 16 with respect to a wide range of processing target parts. On the other hand, since the relative arrangement of the workpiece W and the robot 10 changes, the ease with which the robot 10 interferes with the workpiece W also changes. On the other hand, the robot 10 further includes a seventh actuator 27 for adjusting the distance, in addition to the actuators 21 to 26 that adjust the position and posture of the distal end portion 16. Therefore, the posture of the robot 10 between the base 11 and the distal end portion 16 can be freely changed while maintaining the position / posture of the distal end portion 16. Thereby, it is possible to flexibly cope with a change in the relative arrangement of the workpiece W and the robot 10 and suppress mutual interference. Due to the characteristic of easily avoiding the workpiece W, there are many options for arranging the robot 10. Therefore, an easy production facility can be constructed.

また、ロボット10の姿勢を自在に変更することで、周辺機器に対するロボット10の干渉も抑制できる。このため、ロボット10を高密度に配置することで作業時間を短縮することも可能となる。   In addition, by freely changing the posture of the robot 10, it is possible to suppress the interference of the robot 10 with peripheral devices. For this reason, it is possible to shorten the work time by arranging the robots 10 at high density.

ロボット10は、当該ロボット側からの全加工対象部位に対し、ワークWに干渉することなく加工を行うことが可能となるように配置されていてもよい。この場合、一台のロボット10にて当該ロボット10側からの全加工対象部位に加工を施すこともできるし、同一側に複数のロボット10を配置し、全加工対象部位をこれらのロボット10に分担させることもできる。これにより、生産量に応じた柔軟な生産設備構築が可能となる。但し、全加工対象部位に対する加工を可能とするようにロボット10を配置することは必須ではない。   The robot 10 may be arranged so as to be able to perform processing without interfering with the workpiece W with respect to all the processing target parts from the robot side. In this case, it is possible to perform processing on all the processing target parts from the robot 10 side with one robot 10, or a plurality of robots 10 are arranged on the same side, and all the processing target parts are assigned to these robots 10. It can also be shared. This makes it possible to construct a flexible production facility according to the production volume. However, it is not indispensable to arrange the robot 10 so as to be able to process all the parts to be processed.

搬送装置30はワークWを搬送してもよい。この場合、多数の動力源を含むロボット10を搬送するのに比べ、搬送装置30の構成を単純化し易い。従って、更に容易な生産設備構築が可能となる。但し、搬送装置30は、ワークW及びロボット10の相対位置を変更するものであればよいので、ロボット10を搬送するものであってもよいし、ワークW及びロボット10の双方を搬送するものであってもよい。   The conveyance device 30 may convey the workpiece W. In this case, it is easier to simplify the configuration of the transfer device 30 than to transfer the robot 10 including a large number of power sources. Therefore, it is possible to construct an easier production facility. However, the transport device 30 may be any device that changes the relative positions of the workpiece W and the robot 10, and may transport the robot 10, or may transport both the workpiece W and the robot 10. There may be.

加工装置1は、図14に示すように、搬送装置30による搬送方向に沿って並ぶように配置された複数のロボット10を備えていてもよい。搬送方向に沿って並ぶロボット10のそれぞれが、上述したように広範囲の加工対象部位に加工を行うことが可能である。このため、搬送方向に沿って並ぶ複数のロボット10に対し、様々なパターンで加工対象部位を割り当て、より効率的な生産設備を構築できる。   As illustrated in FIG. 14, the processing apparatus 1 may include a plurality of robots 10 arranged so as to be aligned in the conveyance direction by the conveyance device 30. As described above, each of the robots 10 arranged along the transport direction can perform processing on a wide range of processing target parts. For this reason, a process target site | part can be allocated with the various pattern with respect to the several robot 10 located along a conveyance direction, and more efficient production equipment can be constructed | assembled.

図14には、搬送装置30による搬送方向に沿って並ぶ2台のロボット10が示されているが、これに限られず、加工装置1は搬送装置30の搬送方向に沿って並ぶように配置された3台以上のロボット10を備えるものであってもよい。   In FIG. 14, two robots 10 arranged along the conveyance direction by the conveyance device 30 are shown. However, the present invention is not limited to this, and the processing device 1 is arranged so as to line up along the conveyance direction of the conveyance device 30. Alternatively, three or more robots 10 may be provided.

加工装置1は、搬送装置30による搬送方向に直交する方向でワークWを挟むように配置された複数のロボット10を備えていてもよい。この場合、全加工対象部位を複数のロボット10に分担させることで、それぞれのロボット10の動作量を抑制できる。これにより、ワークWに対するロボット10の干渉が更に抑制される。また、搬送装置30による搬送方向に直交する方向でワークWを挟む配置により、ロボット10同士の干渉も抑制される。従って、更に容易な生産設備構築が可能となる。   The processing apparatus 1 may include a plurality of robots 10 arranged so as to sandwich the workpiece W in a direction orthogonal to the conveyance direction by the conveyance device 30. In this case, the amount of movement of each robot 10 can be suppressed by sharing all the processing target parts to the plurality of robots 10. Thereby, interference of the robot 10 with respect to the workpiece | work W is further suppressed. In addition, the arrangement in which the workpiece W is sandwiched in a direction orthogonal to the conveyance direction by the conveyance device 30 also suppresses interference between the robots 10. Therefore, it is possible to construct an easier production facility.

複数のロボット10が、搬送装置30による搬送方向に直交する方向でワークWを挟むように配置されることは必須ではない。例えば、図15に示すように、ロボット10はワークWの左側のみに配置されていてもよい。この場合においても、ロボット10は、当該ロボット10側からの全加工対象部位に対し、ワークWに干渉することなく加工を行うことが可能となるように配置されていてもよい。例えば図15において、それぞれのロボット10は、左側の全加工対象部位P1及び右側の全加工対象部位P1の両方に加工を行うことが可能となるように配置されていてもよい。   It is not essential that the plurality of robots 10 be arranged so as to sandwich the workpiece W in a direction orthogonal to the conveyance direction by the conveyance device 30. For example, as shown in FIG. 15, the robot 10 may be disposed only on the left side of the workpiece W. Also in this case, the robot 10 may be arranged so as to be able to perform machining without interfering with the workpiece W with respect to all the machining target parts from the robot 10 side. For example, in FIG. 15, each robot 10 may be arranged so as to be able to perform processing on both the left all processing target site P1 and the right all processing target site P1.

図15には、搬送装置30による搬送方向に沿って並ぶ2台のロボット10が示されているが、これに限られず、加工装置1は一台のロボット10のみを備えるものであってもよい。   FIG. 15 shows two robots 10 arranged in the direction of conveyance by the conveyance device 30. However, the present invention is not limited to this, and the processing device 1 may include only one robot 10. .

コントローラ100は、先端部16の位置・姿勢の目標値を取得する目標取得部111と、距離調節用の第7アクチュエータ27の動作目標値を固定した条件にて、位置・姿勢の目標値に対応するアクチュエータ21〜26の動作目標値を算出する第1算出部112と、アクチュエータ21〜26の少なくともいずれかを判定対象とし、判定対象のアクチュエータについて動作目標値が許容範囲内であるか否かを判定する判定部113と、少なくとも一つの判定対象のアクチュエータについて動作目標値が許容範囲外となった場合に、当該動作目標値が許容範囲内に収まるように、位置・姿勢の目標値に対応するアクチュエータ21〜26及び距離調節用の第7アクチュエータ27の動作目標値を算出する第2算出部114と、動作目標値に応じてアクチュエータ21〜27を制御する出力部115と、を有してもよい。   The controller 100 responds to the target value of the position / orientation under the condition that the target acquisition unit 111 that acquires the target value of the position / orientation of the distal end portion 16 and the operation target value of the seventh actuator 27 for distance adjustment are fixed. The first calculation unit 112 that calculates the operation target value of the actuators 21 to 26 to be performed and at least one of the actuators 21 to 26 is set as a determination target, and whether or not the operation target value is within an allowable range for the determination target actuator. Corresponding to the position / posture target values so that the operation target value falls within the allowable range when the operation target value is out of the allowable range for the determination unit 113 and the at least one determination target actuator. A second calculation unit 114 that calculates the operation target values of the actuators 21 to 26 and the seventh actuator 27 for adjusting the distance; Flip an output unit 115 for controlling the actuators 21 to 27 and may have.

上述したように、ロボット10によれば干渉を抑制できる一方で、先端部16の位置・姿勢の目標値に対応するアクチュエータ21〜27の動作目標値は一通りに定まらない。このため、ロボット10の動作教示においては何らかの拘束条件を適宜設定する必要がある。   As described above, according to the robot 10, while interference can be suppressed, the operation target values of the actuators 21 to 27 corresponding to the position / posture target values of the distal end portion 16 are not fixed. For this reason, in the operation teaching of the robot 10, it is necessary to appropriately set some constraint condition.

これに対し、コントローラ100は、まず第7アクチュエータ27の動作目標値を固定した条件にて、アクチュエータ21〜26の動作目標値を算出する。次に、判定対象のアクチュエータの動作目標値が許容範囲外となった場合には、当該動作目標値が許容範囲内に収まるように、アクチュエータ21〜26及び距離調節用の第7アクチュエータ27の動作目標値を自動的に再計算する。ロボット10のアクチュエータの動作量を許容範囲内に抑えると、ロボット10全体の動作量も抑制されるので、ワークW又は周辺機器との干渉が生じ難くなる傾向がある。   On the other hand, the controller 100 first calculates the operation target values of the actuators 21 to 26 under the condition that the operation target value of the seventh actuator 27 is fixed. Next, when the operation target value of the determination target actuator is outside the allowable range, the operations of the actuators 21 to 26 and the seventh actuator 27 for adjusting the distance are adjusted so that the operation target value falls within the allowable range. The target value is automatically recalculated. If the operation amount of the actuator of the robot 10 is suppressed within an allowable range, the operation amount of the entire robot 10 is also suppressed, so that there is a tendency that interference with the workpiece W or peripheral equipment is less likely to occur.

例えば図13において二点鎖線で示されるロボット10では、第3アクチュエータ23の動作目標値が許容範囲外となっている。すなわち、第1腕部13に対する第2腕部14の揺動角の目標値θ3が過大になっている。これに対し、図13において実線で示されるロボット10では、第1腕部13に対する第2腕部14の揺動角の目標値θ3を緩和するようにアクチュエータ21〜26及び距離調節用の第7アクチュエータ27の動作目標値が再計算されている。これに伴って第4軸線Ax4及び第2軸線Ax2の間の部分がワークWから遠ざかり、ワークWに対するロボット10の干渉が防止されている。   For example, in the robot 10 indicated by a two-dot chain line in FIG. 13, the operation target value of the third actuator 23 is outside the allowable range. That is, the target value θ3 of the swing angle of the second arm portion 14 with respect to the first arm portion 13 is excessive. On the other hand, in the robot 10 indicated by the solid line in FIG. 13, the actuators 21 to 26 and the seventh distance adjusting seventh are set so as to relax the target value θ3 of the swing angle of the second arm 14 relative to the first arm 13. The operation target value of the actuator 27 is recalculated. Accordingly, the portion between the fourth axis Ax4 and the second axis Ax2 is moved away from the work W, and the robot 10 is prevented from interfering with the work W.

このように、判定対象のアクチュエータの動作目標値を許容範囲内に抑えるという条件を採用することにより、ワークW又は周辺機器との干渉の発生確率を下げることができる。これにより、ワークW又は周辺機器との干渉を回避しつつ、先端部16を各加工対象部位の近傍に適正配置する動作パターンの大部分を自動的に構築できる。従って、ロボット10に対する動作教示の負担が軽減されるので、更に容易な生産設備構築が可能となる。   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 distal end portion 16 is appropriately disposed in the vicinity of each processing target portion while avoiding interference with the workpiece W or peripheral devices. Therefore, since the burden of teaching operation to the robot 10 is reduced, it is possible to construct a production facility more easily.

距離調節用の第7アクチュエータ27は、第1腕部13を距離調節用の第7軸線Ax7まわりに屈曲させることで、第2軸線Ax2及び第3軸線Ax3の間の距離L1を調節する。この場合、第1腕部13を単純に伸縮させて第2軸線Ax2及び第3軸線Ax3の間の距離L1を調節するのに比べ、アクチュエータ21〜26の動作量を抑制し易い傾向がある。また、ロボット10の姿勢をより多様に調節し、ワークW又は周辺機器を回避し易くなる傾向がある。従って、更に容易な生産設備構築が可能である。但し、第7アクチュエータ27は、第2軸線Ax2及び第3軸線Ax3の間の距離L1を調節できればどのようなものであってもよいので、例えば第1腕部13を伸縮させる直動アクチュエータであってもよい。   The seventh actuator 27 for distance adjustment adjusts the distance L1 between the second axis Ax2 and the third axis Ax3 by bending the first arm portion 13 around the seventh axis Ax7 for distance adjustment. In this case, compared with simply adjusting the distance L1 between the second axis Ax2 and the third axis Ax3 by simply extending and contracting the first arm portion 13, the amount of operation of the actuators 21 to 26 tends to be suppressed. In addition, the posture of the robot 10 is adjusted in various ways, and the work W or peripheral devices tend to be avoided. Therefore, it is possible to construct an easier production facility. However, the seventh actuator 27 may be any actuator as long as the distance L1 between the second axis Ax2 and the third axis Ax3 can be adjusted. For example, the seventh actuator 27 is a linear motion actuator that expands and contracts the first arm portion 13. May be.

距離調節用の第7軸線Ax7は、第2軸線Ax2に対して平行である。仮に、第7軸線Ax7が第2軸線Ax2に対して垂直であるロボットを用いる場合、ワークWに対するロボットの干渉を避けながら先端部16を所望の位置・姿勢に配置するためには、第1腕部13及び第2腕部14に相当する部分を大きく側方(ワークW側を正面とした場合の側方)に傾ける必要が生じ得る。これにより周辺機器(例えば隣接する他のロボット)との干渉が生じ得るため、ロボット及び周辺機器の配置間隔を大きくする必要がある。このことは、例えば複数のロボットの高密度配置を妨げる一因となる。これに対し、ロボット10においては第7軸線Ax7が第2軸線Ax2に対して平行であるので、少なくとも第7軸線Ax7まわりの回転動作に起因して第1腕部13及び第2腕部14を側方に傾ける必要が生じ難く、隣接する周辺機器との干渉が生じ難い。従って、ロボット10の配置の選択肢がより多くなるので、更に容易な生産設備構築が可能となる。複数のロボットをより高密度に配置し、作業時間を更に短縮することも可能となる。但し、第7軸線Ax7が第2軸線Ax2に対して平行であることは必須ではない。   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 first arm 16 can be placed at a desired position / posture while avoiding robot interference with the workpiece W. It may be necessary to tilt the portions corresponding to the portion 13 and the second arm portion 14 largely to the side (side when the workpiece W side is the front). As a result, interference with peripheral devices (for example, other adjacent robots) may occur. Therefore, it is necessary to increase the interval between the robot and the peripheral devices. This is one factor that hinders high-density arrangement of a plurality of robots, for example. On the other hand, in the robot 10, since the seventh axis Ax7 is parallel to the second axis Ax2, the first arm 13 and the second arm 14 are caused to move at least around the seventh axis Ax7. It is difficult to incline to the side, and interference with adjacent peripheral devices hardly occurs. Therefore, since there are more choices for the arrangement of the robot 10, it is possible to construct an easier production facility. It is also possible to arrange a plurality of robots at higher density and further reduce the work time. However, it is not essential that the seventh axis Ax7 is parallel to the second axis Ax2.

距離調節用の第7軸線Ax7は、第3軸線に対しても平行である。この場合、先端部16を所望の位置・姿勢に配置する際に、第1腕部13及び第2腕部14を側方に傾ける必要が更に生じ難くなるので、更に容易な生産設備構築が可能となる。複数のロボットをより高密度に配置し、作業時間を更に短縮することも可能となる。但し、第7軸線Ax7が第3軸線Ax3に対して平行であることも必須ではない。   The seventh axis Ax7 for adjusting the distance is also parallel to the third axis. In this case, when the distal end portion 16 is arranged at a desired position / posture, it is further difficult to cause the first arm portion 13 and the second arm portion 14 to be tilted to the side, so that it is possible to construct an easier production facility. It becomes. It is also possible to arrange a plurality of robots at higher density and further reduce the work time. However, it is not essential that the seventh axis Ax7 is parallel to the third axis Ax3.

第2算出部114は、距離調節用の第7軸線Ax7がワークWから遠ざかる方向に第1腕部13を屈曲させるように、アクチュエータ21〜27の動作目標値を算出してもよい。即ちコントローラ100は、第7軸線Ax7がワークWから遠ざかる方向に第1腕部13を屈曲させるように、アクチュエータ21〜27を制御するものであってもよい。この場合、ワークW及び隣接する周辺機器に対するロボット10の干渉がより確実に抑制される。   The second calculation unit 114 may calculate the operation target values of the actuators 21 to 27 such that the first arm portion 13 is bent in a direction in which the seventh axis Ax7 for distance adjustment moves away from the workpiece W. That is, the controller 100 may control the actuators 21 to 27 such that the first arm portion 13 is bent in a direction in which the seventh axis Ax7 moves away from the workpiece W. In this case, the interference of the robot 10 with respect to the workpiece W and adjacent peripheral devices is more reliably suppressed.

先端部16の姿勢を調節する複数の姿勢調節アクチュエータは、手首部15を第5軸線Ax5まわりに旋回させる第5アクチュエータ25、手首部15を第4軸線Ax4まわりに揺動させる第4アクチュエータ24、及び先端部16を第6軸線Ax6まわりに旋回させる第6アクチュエータ26である。この場合、アクチュエータ24〜26の協働により先端部16の姿勢を自在に調節できる。但し、複数の姿勢調節アクチュエータは、アクチュエータ24〜26に限定されず、先端部16の姿勢を調節可能であればどのようなものであってもよい。例えば、必要とされる姿勢調節の程度に応じて、第4アクチュエータ24、第5アクチュエータ25及び第6アクチュエータ26のいずれかが省略されていてもよい。   A plurality of posture adjustment actuators for adjusting the posture of the tip portion 16 include a fifth actuator 25 for turning the wrist portion 15 about the fifth axis Ax5, a fourth actuator 24 for swinging the wrist portion 15 about the fourth axis Ax4, And a sixth actuator 26 that pivots the distal end portion 16 about the sixth axis Ax6. In this case, the posture of the distal end portion 16 can be freely adjusted by cooperation of the actuators 24 to 26. However, the plurality of posture adjustment actuators are not limited to the actuators 24 to 26, and may be any one as long as the posture of the distal end portion 16 can be adjusted. For example, one of the fourth actuator 24, the fifth actuator 25, and the sixth actuator 26 may be omitted depending on the required degree of posture adjustment.

判定部113は、第2アクチュエータ22、第3アクチュエータ23及び第4アクチュエータ24の少なくともいずれかを判定対象としてもよい。これらのアクチュエータの動作量は、ロボット全体の動作量に相関し易い傾向がある。このため、これらのアクチュエータを判定対象にして、その動作範囲を許容範囲内に抑えることで、ロボット10全体の動作量をより確実に抑制し、干渉を更に抑制できる。   The determination unit 113 may set at least one of the second actuator 22, the third actuator 23, and the fourth actuator 24 as a determination target. The movement amounts of these actuators tend to correlate easily with the movement amount of the entire robot. Therefore, by setting these actuators as determination targets and suppressing the operation range within an allowable range, the operation amount of the entire robot 10 can be more reliably suppressed, and interference can be further suppressed.

判定部113は、第3アクチュエータ23及び第4アクチュエータ24の少なくともいずれかを判定対象としてもよい。これらのアクチュエータの動作量は、ロボット全体の動作量に特に相関し易い傾向がある。このため、これらのアクチュエータを判定対象にして、その動作範囲を許容範囲内に抑えることで、ロボット10全体の動作量をより確実に抑制し、干渉を更に抑制できる。   The determination unit 113 may set at least one of the third actuator 23 and the fourth actuator 24 as a determination target. The movement amount of these actuators tends to be particularly correlated with the movement amount of the entire robot. Therefore, by setting these actuators as determination targets and suppressing the operation range within an allowable range, the operation amount of the entire robot 10 can be more reliably suppressed, and interference can be further suppressed.

ロボット10は、エンドエフェクタ17として、先端部16に設けられた溶接装置を更に備えていてもよい。この場合、ワークW又は周辺機器に対するロボット10の干渉を抑制しつつ、広範囲の加工対象部位に対して溶接を行うことができる。   The robot 10 may further include a welding device provided at the distal end portion 16 as the end effector 17. In this case, welding can be performed on a wide range of parts to be processed while suppressing interference of the robot 10 with the workpiece W or peripheral devices.

加工装置1によれば、ロボット10により加工可能となるようにパレット31上にワークWを配置すること、ワークWとロボット10との相対位置を変更するように、搬送アクチュエータ32によりパレット31を搬送すること、ロボット10によりワークWに対し加工を行うこと、を含むワークWの生産方法が実行可能である。   According to the processing apparatus 1, the workpiece W is arranged on the pallet 31 so that the robot 10 can process it, and the pallet 31 is transferred by the transfer actuator 32 so that the relative position between the workpiece W and the robot 10 is changed. It is possible to execute a method for producing a workpiece W including performing processing on the workpiece W by the robot 10.

また、先端部16の位置・姿勢の目標値を取得すること、第7アクチュエータ27の動作目標値を固定した条件にて、位置・姿勢の目標値に対応するアクチュエータ21〜26の動作目標値を算出すること、アクチュエータ21〜26の少なくともいずれかを判定対象とし、判定対象のアクチュエータについて動作目標値が許容範囲内であるか否かを判定すること、少なくとも一つの判定対象のアクチュエータについて動作目標値が許容範囲外となった場合に、当該動作目標値が許容範囲内に収まるように、位置・姿勢の目標値に対応するアクチュエータ21〜27の動作目標値を算出すること、動作目標値に応じてアクチュエータ21〜27を制御すること、を含むワークWの生産方法も実行可能である。   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 distal end portion 16 is acquired and the target value of the seventh actuator 27 is fixed. Calculating, determining at least one of the actuators 21 to 26 as a determination target, determining whether the operation target value is within an allowable range for the determination target actuator, and determining an operation target value for at least one determination target actuator If the target value of the actuators 21 to 27 corresponding to the position / posture target value is calculated so that the target operation value falls within the allowable range, Thus, a method for producing the workpiece W including controlling the actuators 21 to 27 is also feasible.

コントローラ100に位置・姿勢の目標値を入力すること、位置・姿勢の目標値に対応するようにコントローラ100により算出されたアクチュエータ21〜27の動作目標値をコントローラに記憶させること、を含む教示方法も実行可能である。   A teaching method including inputting position / posture target values to the controller 100 and storing the operation target values of the actuators 21 to 27 calculated by the controller 100 so as to correspond to the position / posture target values. Is also feasible.

2.第2実施形態
図16に示すように、第2実施形態に係る加工装置1Aは、第1実施形態に係る加工装置1の搬送装置30を保持台50(ワーク配置部)に置き換えたものである。保持台50は、ロボット10により加工可能な位置にワークWを保持する。図17に示すように、2台のロボット10は、ワークWを囲む線EL1に沿って並んでおり、互いに協働して同一のワークWに対する加工を行う。なお、「ワークWを囲む線」は、必ずしもワークWの周縁に沿っていなくてもよいが、ワークWの周縁に直交する線を含まないものとする。ロボット10は、隣り合う他のロボット10と可動範囲WRが重複するように配置されている。個々のロボット10とワークWに対する配置条件については、第1実施形態と同様である。
2. Second Embodiment As shown in FIG. 16, a processing apparatus 1 </ b> A according to the second embodiment is obtained by replacing the conveyance device 30 of the processing apparatus 1 according to the first embodiment with a holding base 50 (work placement unit). . The holding table 50 holds the workpiece W at a position where the robot 10 can process it. As shown in FIG. 17, the two robots 10 are arranged along the line EL <b> 1 surrounding the workpiece W, and perform processing on the same workpiece W in cooperation with each other. The “line surrounding the workpiece W” does not necessarily have to be along the periphery of the workpiece W, but does not include a line orthogonal to the periphery of the workpiece W. The robot 10 is arranged so that the movable range WR overlaps with another adjacent robot 10. The arrangement conditions for the individual robots 10 and the workpieces W are the same as in the first embodiment.

〔第2実施形態による効果〕
以上に説明したように、加工装置1は、ロボット10を含み、互いに協働して同一のワークに対する加工を行う複数のロボットを備える。ロボット10が、同一のワークWに対する加工を行う複数のロボットに含まれていることにより、ワークWに対するロボットの干渉及びロボット同士の干渉を抑制できる。従って、容易な生産設備構築が可能となる。複数のロボットを高密度に配置することで作業時間を短縮することも可能となる。
[Effects of Second Embodiment]
As described above, the processing apparatus 1 includes the robot 10 and includes a plurality of robots that perform processing on the same workpiece in cooperation with each other. Since the robot 10 is included in a plurality of robots that process the same workpiece W, it is possible to suppress the interference of the robot with respect to the workpiece W and the interference between the robots. Therefore, an easy production facility can be constructed. It is also possible to shorten the work time by arranging a plurality of robots at high density.

加工装置1は、同一のワークWに対する加工を行う複数のロボットを備えていればよいので、ロボットの台数は2台に限られない。例えば、図18に示すように、3台以上のロボットを備えていてもよい。図18の加工装置1は、4台のロボット10を備える。4台のロボット10は、ワークWを囲む線に沿い、ワークWを取り囲むように配置されている。   Since the processing apparatus 1 only needs to include a plurality of robots that perform processing on the same workpiece W, the number of robots is not limited to two. For example, as shown in FIG. 18, three or more robots may be provided. The processing apparatus 1 in FIG. 18 includes four robots 10. The four robots 10 are arranged along the line surrounding the workpiece W so as to surround the workpiece W.

図16及び図18の加工装置1では、複数のロボットの全てがロボット10である。このため、全てのロボットにおいて、先端部16の位置・姿勢を維持した状態で、基台11及び先端部16の間におけるロボットの姿勢を自在に変更可能である。従って、ワークWに対するロボットの干渉及びロボット同士の干渉をより確実に抑制できる。   16 and 18, all of the plurality of robots are robots 10. For this reason, in all the robots, the posture of the robot between the base 11 and the tip portion 16 can be freely changed while maintaining the position and posture of the tip portion 16. Therefore, the interference of the robot with respect to the workpiece W and the interference between the robots can be more reliably suppressed.

但し、全てのロボットがロボット10であることは必須ではない。例えば図19及び図20に示すように、加工装置1の複数のロボットは、ロボット40(第2ロボット)を更に含んでもよい。ロボット40は、アクチュエータ21〜26を有し、距離調節用の第7アクチュエータ27を有しない。ロボット40は、第1腕部13及び第7アクチュエータ27を、第1腕部43に置き換えたものである。このような構成においても、複数のロボットにロボット10を含むことにより、ワークWに対するロボットの干渉及びロボット同士の干渉を抑制する効果が得られる。ロボットの台数に制限はなく、図19に示すように2台であってもよいし、図20に示すように3台以上であってもよい。   However, it is not essential that all the robots are robots 10. For example, as shown in FIGS. 19 and 20, the plurality of robots of the processing apparatus 1 may further include a robot 40 (second robot). The robot 40 includes actuators 21 to 26 and does not include the seventh actuator 27 for adjusting the distance. The robot 40 is obtained by replacing the first arm portion 13 and the seventh actuator 27 with a first arm portion 43. Even in such a configuration, by including the robot 10 in a plurality of robots, an effect of suppressing the interference of the robot with the workpiece W and the interference between the robots can be obtained. The number of robots is not limited, and may be two as shown in FIG. 19, or may be three or more as shown in FIG.

ロボット10及びロボット40は、互いに隣り合うように配置されていてもよい。この場合、ロボット同士の干渉をより確実に抑制できる。   The robot 10 and the robot 40 may be arranged adjacent to each other. In this case, interference between robots can be more reliably suppressed.

図19に示すように、加工装置1は、ロボット10の方がロボット40に比べワークWの近位側に加工を行うように構成されていてもよい。ワークWの近位側に加工を行う場合、ロボットはアームを折り畳んだ姿勢となる。このような姿勢においては、一部のアクチュエータの動作量が許容限界に達し易い傾向がある。また、折り畳んだアームがワークW又は他のロボットに干渉し易い傾向がある。そこで、干渉を抑制可能なロボット10に、ワークWの近位側への加工を割り当てることにより、ワークWに対するロボットの干渉及びロボット同士の干渉をより確実に抑制できる。   As illustrated in FIG. 19, the processing apparatus 1 may be configured such that the robot 10 performs processing closer to the workpiece W than the robot 40. When processing on the proximal side of the workpiece W, the robot takes a posture in which the arm is folded. In such a posture, the movement amount of some actuators tends to reach the allowable limit. Also, the folded arm tends to easily interfere with the workpiece W or another robot. Therefore, by assigning the processing toward the proximal side of the workpiece W to the robot 10 that can suppress the interference, the interference of the robot with respect to the workpiece W and the interference between the robots can be more reliably suppressed.

図20に示すように、加工装置1は、ロボット10の方がロボット40に比べワークW寄りに位置するように構成されていてもよい。即ち、ロボット10の基台11からワークWまでの距離D1が、ロボット40からワークWまでの距離D2に比べ小さくなっていてもよい。この場合、干渉を抑制可能なロボット10をワークW寄りに配置することで、ワークWの広範囲に亘ってエンドエフェクタ17を到達させることが可能となる。これにより、ロボット40により加工できない部分をロボット10によって補い、ワークWの広範囲に亘って加工を行うことができる。   As illustrated in FIG. 20, the processing apparatus 1 may be configured such that the robot 10 is positioned closer to the workpiece W than the robot 40. That is, the distance D1 from the base 11 of the robot 10 to the workpiece W may be smaller than the distance D2 from the robot 40 to the workpiece W. In this case, the end effector 17 can be reached over a wide range of the workpiece W by arranging the robot 10 capable of suppressing interference closer to the workpiece W. As a result, a portion that cannot be processed by the robot 40 can be supplemented by the robot 10 and processing can be performed over a wide range of the workpiece W.

全てのロボットは設置面に固定されており、ロボット10は、隣り合う他のロボットと可動範囲が重複するように配置されていてもよい。この場合、ロボット10による干渉抑制の効果がより顕著となる。   All the robots are fixed to the installation surface, and the robot 10 may be arranged so that the movable range overlaps with other adjacent robots. In this case, the effect of interference suppression by the robot 10 becomes more remarkable.

以上、実施形態について説明したが、本発明は必ずしも上述した実施形態に限定されるものではなく、その要旨を逸脱しない範囲で様々な変更が可能である。例えば、加工装置1のワークWは自動車ボディに限られない。加工装置1は、自動車のドアパネルの加工等にも適用可能であるし、自動車以外の技術分野における様々な部品又は製品の加工・組立にも適用可能である。   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 processing apparatus 1 is not limited to an automobile body. The processing apparatus 1 can be applied to processing of door panels of automobiles, and can also be applied to processing / assembly of various parts or products in technical fields other than automobiles.

本開示は、加工装置に利用可能である。   The present disclosure can be used for a processing apparatus.

1,1A…加工装置、10…ロボット(第1ロボット)、12…旋回部、13…第1腕部、14…第2腕部、15…手首部、16…先端部、17…エンドエフェクタ(溶接装置)、21…第1アクチュエータ、22…第2アクチュエータ、23…第3アクチュエータ、24…第4アクチュエータ(姿勢調節アクチュエータ)、25…第5アクチュエータ(姿勢調節アクチュエータ)、26…第6アクチュエータ(姿勢調節アクチュエータ)、27…第7アクチュエータ(距離調節アクチュエータ)、30…搬送装置、40…ロボット(第2ロボット)、100…コントローラ、Ax1…第1軸線、Ax2…第2軸線、Ax3…第3軸線、Ax4…第4軸線、Ax5…第5軸線、Ax6…第6軸線、Ax7…第7軸線(距離調節用の軸線)、L1…第2軸線及び第3軸線の間の距離、P1,P2…加工対象部位、W…ワーク、L11…最長距離、L12…最短距離、PE1…第1腕部13の基端、DP1…第1腕部13の先端部、PP2…第2腕部14の基端部、WR…可動範囲。   DESCRIPTION OF SYMBOLS 1,1A ... Processing apparatus, 10 ... Robot (1st robot), 12 ... Turning part, 13 ... 1st arm part, 14 ... 2nd arm part, 15 ... Wrist part, 16 ... Tip part, 17 ... End effector ( Welding device), 21 ... first actuator, 22 ... second actuator, 23 ... third actuator, 24 ... fourth actuator (posture adjustment actuator), 25 ... fifth actuator (posture adjustment actuator), 26 ... sixth actuator ( Posture adjustment actuator), 27 ... seventh actuator (distance adjustment actuator), 30 ... transport device, 40 ... robot (second robot), 100 ... controller, Ax1 ... first axis, Ax2 ... second axis, Ax3 ... third Axis, Ax4 ... 4th axis, Ax5 ... 5th axis, Ax6 ... 6th axis, Ax7 ... 7th axis (distance adjustment axis), L ... distance between second axis and third axis, P1, P2 ... part to be processed, W ... workpiece, L11 ... longest distance, L12 ... shortest distance, PE1 ... proximal end of first arm 13, DP1 ... first The distal end of the arm 13, PP2... The proximal end of the second arm 14, WR.

Claims (14)

ワークを搬送する搬送装置と、
前記搬送装置による搬送方向に沿って並ぶように配置され、当該搬送装置により搬送されている前記ワークに対して加工を行う複数のロボットと、を備え、
前記複数のロボットは、互いに隣り合う少なくとも2台の第1ロボットを含み、
前記第1ロボットは、
互いに直列に接続された旋回部、第1腕部、第2腕部、手首部及び先端部と、
前記旋回部を第1軸線まわりに旋回させる第1アクチュエータと、
前記旋回部及び前記第1腕部の接続部分を通り、前記第1軸線に交差する第2軸線まわりに前記第1腕部を揺動させる第2アクチュエータと、
前記第1腕部及び前記第2腕部の接続部分を通り、前記第2軸線に平行な第3軸線まわりに前記第2腕部を揺動させる第3アクチュエータと、
前記第2腕部及び前記手首部の接続部分を通り、前記第2腕部の中心軸線に交差する第4軸線まわりに前記手首部を揺動させる第4アクチュエータと、
前記第2腕部の中心軸線に沿い、前記第3軸線及び前記第4軸線に交差する第5軸線まわりに前記手首部を旋回させる第5アクチュエータと、
前記手首部の中心軸線に沿い、前記第4軸線に交差する第6軸線まわりに前記先端部を旋回させる第6アクチュエータと、
前記第2軸線及び前記第3軸線に平行な距離調節用の軸線まわりに前記第1腕部を屈曲させることで、前記第2軸線及び前記第3軸線の間の距離を調節する距離調節アクチュエータと、
前記先端部に設けられ、自動車生産用のワークに対してスポット溶接を施すエンドエフェクタと、を有し、前記ワークに正対した状態で、前記距離を最長にして前記第2軸線まわりに前記第1腕部を回転させる場合には、前記第1腕部の先端部又は第2腕部の基端部の可動範囲が前記ワークに干渉し、前記ワークに正対した状態で、前記距離を最短にして前記第2軸線まわりに前記第1腕部を回転させる場合には、前記第1腕部の先端部及び第2腕部の基端部の可動範囲が前記ワークに干渉しないように位置し、
前記第1ロボットの可動範囲は、隣り合う他のロボットの可動範囲と重複している、加工装置。
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.
前記第2腕部の先端部が前記第1腕部の基端部より前記ワーク側に位置する状態で、前記第1腕部の基端部より高い位置及び当該基端部より低い位置の間で前記エンドエフェクタを移動させるように前記第1ロボットを制御するコントローラを更に備える請求項1記載の加工装置。   Between a position higher than the base end of the first arm and a position lower than the base end in a state where the tip of the second arm is positioned closer to the workpiece than the base end of the first arm The processing apparatus according to claim 1, further comprising a controller that controls the first robot so as to move the end effector. 前記第1腕部の基端部より高い位置及び当該基端部より低い位置の間で前記エンドエフェクタを移動させるように前記第1ロボットを制御することは、前記第1腕部の基端部より高い位置及び当該基端部より低い位置の間で前記第1腕部の先端部を移動させるように前記第1ロボットを制御することを含む、請求項2記載の加工装置。   Controlling the first robot 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 is the base end of the first arm The processing apparatus according to claim 2, further comprising: controlling the first robot to move a distal end portion of the first arm portion between a higher position and a position lower than the base end portion. 前記第1腕部の基端部より高い位置及び当該基端部より低い位置の間で前記エンドエフェクタを移動させるように前記第1ロボットを制御することは、前記第2軸線及び前記第3軸線の間の距離を前記距離調節アクチュエータにより変化させるように前記第1ロボットを制御することを含む、請求項2又は3記載の加工装置。   Controlling the first robot 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 is the second axis and the third axis. The processing apparatus according to claim 2, further comprising: controlling the first robot to change a distance between the first robot and the distance adjustment actuator. 前記第1ロボットは、
前記ワークに正対した状態にて、前記ワークにおける最高位置の加工対象部位から前記第1腕部の基端までの距離と、最低位置の加工対象部位から前記第1腕部の基端までの距離とが、式(1)で求まる長さLa以下となるように位置する、請求項1〜4のいずれか一項記載の加工装置。
La=L11+L21+L31・・・(1)
L11:前記第2軸線から前記第3軸線までの最長距離
L21:前記第3軸線から前記第4軸線までの距離
L31:前記第4軸線から前記エンドエフェクタまでの距離
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
前記第1ロボットは、
前記ワークに正対した状態にて、前記ワークにおける最高位置の加工対象部位に対して加工を施し得るように前記エンドエフェクタを配置した場合の前記第4軸線の位置から前記第1腕部の基端までの距離と、前記ワークにおける最低位置の加工対象部位に対して加工を施し得るように前記エンドエフェクタを配置した場合の前記第4軸線の位置から前記第1腕部の基端までの距離とが、式(2)で求まる長さLb以下となるように位置する、請求項5記載の加工装置。
Lb=L11+L21・・・(2)
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)
前記第1ロボットは、
前記ワークに正対した状態にて、前記手首部を鉛直下方に向けて前記ワークにおける最高位置の加工対象部位に前記エンドエフェクタを配置した場合の前記第4軸線の位置から前記第1腕部の基端までの距離と、前記手首部を鉛直上方に向けて前記エンドエフェクタを前記ワークにおける最低位置の加工対象部位に配置した場合の前記第4軸線の位置から前記第1腕部の基端までの距離とが、式(2)で求まる長さLb以下となるように位置する、請求項5又は6記載の加工装置。
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)
前記第1ロボットは、
前記第1腕部の基端の高さが式(3)で求まる高さHa以上となるように位置する、請求項7記載の加工装置。
Ha=HH−L21・cosθ−L11・・・(3)
HH:前記手首部を鉛直下方に向けて前記エンドエフェクタを前記ワークにおける最高位置の加工対象部位に配置した場合の前記第4軸線の高さ
θ:前記第3軸線及び前記第4軸線に直交する直線と、前記手首部の中心軸線との角度の最小値
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
前記第1ロボットは、
前記第1腕部の基端の高さが式(4)で求まる高さHb以下となるように位置する、請求項8記載の加工装置。
Hb=HL+L21・cosθ+L11・・・(4)
HL:前記手首部を鉛直上方に向けて前記エンドエフェクタを前記ワークにおける最低位置の加工対象部位に配置した場合の前記第4軸線の高さ
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
前記第1ロボットは、
前記ワークに正対した状態にて、前記手首部を鉛直下方に向けて前記エンドエフェクタを前記ワークにおける最高位置の加工対象部位に配置した場合の前記第4軸線の位置から式(5)で求まる距離Lcで手前側にシフトし、式(6)で求まる高さHcで下方にシフトした位置から前記第1腕部の基端までの距離と、前記手首部を鉛直上方に向けて前記エンドエフェクタを前記ワークにおける最低位置の加工対象部位に配置した場合の前記第4軸線の位置から式(5)で求まる距離Lcで手前側にシフトし、式(6)で求まる高さHcで上方にシフトした位置から前記第1腕部の基端までの距離とが、前記第2軸線から前記第3軸線までの最長距離以下となるように位置する、請求項9記載の加工装置。
Lc=L21・sinθ・・・(5)
Hc=L21・cosθ・・・(6)
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)
前記第1ロボットは、前記搬送方向に直交する方向における前記ワークの両側のうち、当該第1ロボット側からの全加工対象部位に対し、前記ワークに干渉することなく加工を行うことが可能となるように位置する、請求項1〜10のいずれか一項記載の加工装置。   The first robot can perform machining without interfering with the workpiece on all machining target portions from the first robot side among both sides of the workpiece in a direction orthogonal to the transfer direction. The processing apparatus according to claim 1, which is positioned as described above. 前記搬送装置による搬送方向に直交する方向で前記ワークを挟むように配置された複数の前記第1ロボットを備える、請求項1〜11のいずれか一項記載の加工装置。   The processing apparatus according to claim 1, comprising a plurality of the first robots arranged so as to sandwich the workpiece in a direction orthogonal to a conveyance direction by the conveyance apparatus. 前記複数のロボットの全てが設置面に固定されている、請求項1〜12のいずれか一項記載の加工装置。   The processing apparatus according to claim 1, wherein all of the plurality of robots are fixed to an installation surface. ワークを搬送する搬送装置と、
前記搬送装置による搬送方向に沿って並ぶように配置され、当該搬送装置により搬送されている前記ワークに対して加工を行う複数のロボットと、を備え、
前記複数のロボットは、互いに隣り合う少なくとも2台の第1ロボットを含み、
前記第1ロボットは、
互いに直列に接続された旋回部、第1腕部、第2腕部、手首部及び先端部と、
前記旋回部を第1軸線まわりに旋回させる第1アクチュエータと、
前記旋回部及び前記第1腕部の接続部分を通り、前記第1軸線に交差する第2軸線まわりに前記第1腕部を揺動させる第2アクチュエータと、
前記第1腕部及び前記第2腕部の接続部分を通り、前記第2軸線に平行な第3軸線まわりに前記第2腕部を揺動させる第3アクチュエータと、
前記第2腕部及び前記手首部の接続部分を通り、前記第2腕部の中心軸線に交差する第4軸線まわりに前記手首部を揺動させる第4アクチュエータと、
前記第2腕部の中心軸線に沿い、前記第3軸線及び前記第4軸線に交差する第5軸線まわりに前記手首部を旋回させる第5アクチュエータと、
前記手首部の中心軸線に沿い、前記第4軸線に交差する第6軸線まわりに前記先端部を旋回させる第6アクチュエータと、
前記第2軸線及び前記第3軸線に平行な距離調節用の軸線まわりに前記第1腕部を屈曲させることで、前記第2軸線及び前記第3軸線の間の距離を調節する距離調節アクチュエータと、
前記先端部に設けられ、自動車生産用のワークに対してスポット溶接を施すエンドエフェクタと、を有し、前記ワークに正対した状態で、前記距離を最長にして前記第2軸線まわりに前記第1腕部を回転させる場合には、前記第1腕部の先端部又は第2腕部の基端部の可動範囲が前記ワークに干渉し、前記ワークに正対した状態で、前記距離を最短にして前記第2軸線まわりに前記第1腕部を回転させる場合には、前記第1腕部の先端部及び第2腕部の基端部の可動範囲が前記ワークに干渉しないように位置し、
前記第1ロボットの可動範囲は、隣り合う他のロボットの可動範囲と重複している加工装置を用い、
前記第1ロボット及び前記搬送装置の協調により、前記ワークの複数の加工対象部位に前記エンドエフェクタを移動させるように当該第1ロボット及び当該搬送装置を制御することと、
前記エンドエフェクタが前記加工対象部位に配置された状態で、前記エンドエフェクタにより当該加工対象部位に加工を施すように前記第1ロボットを制御することと、を含み、
前記第1ロボット及び前記搬送装置の協調により、前記ワークの複数の加工対象部位に前記エンドエフェクタを移動させるように当該第1ロボット及び当該搬送装置を制御することは、前記第2軸線及び前記第3軸線の間の距離を前記距離調節アクチュエータにより変化させながら、前記第1腕部の基端より高い位置及び当該基端より低い位置の間で前記エンドエフェクタを移動させるように当該第1ロボットを制御することを含む、ワークの生産方法。
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.
JP2016098713A 2016-05-17 2016-05-17 Processing device and work production method Active JP6172334B2 (en)

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 JP2017024160A (en) 2017-02-02
JP6172334B2 true 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)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3453492A1 (en) 2017-09-08 2019-03-13 Kabushiki Kaisha Yaskawa Denki Robot system, robot controller, and method for producing to-be-worked material

Family Cites Families (12)

* Cited by examiner, † Cited by third party
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
JP3900930B2 (en) * 2002-01-07 2007-04-04 株式会社小松製作所 Work loading device
JP2005014108A (en) * 2003-06-23 2005-01-20 Honda Motor Co Ltd Interference avoiding method of multi-articulated robot
JP5190983B2 (en) * 2007-11-27 2013-04-24 株式会社安川電機 Robot system
US9782789B2 (en) * 2012-09-10 2017-10-10 Fanuc America Corporation Robotic apparatus for painting
JP5513661B2 (en) * 2013-05-09 2014-06-04 ファナック株式会社 Offline program creation device for robot with additional axis
JP2015123516A (en) * 2013-12-25 2015-07-06 川崎重工業株式会社 Industrial robot

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3453492A1 (en) 2017-09-08 2019-03-13 Kabushiki Kaisha Yaskawa Denki Robot system, robot controller, and method for producing to-be-worked material
JP2019048349A (en) * 2017-09-08 2019-03-28 株式会社安川電機 Robot system, robot control device, and manufacturing method of workpiece
US10864628B2 (en) 2017-09-08 2020-12-15 Kabushiki Kaisha Yashawa Denki Robot system, robot controller, and method for producing to-be-worked material

Also Published As

Publication number Publication date
JP2017024160A (en) 2017-02-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
JP6914811B2 (en) Horizontal articulated robot and its origin return method
JP5765355B2 (en) Robot picking system and workpiece manufacturing method
US8423190B1 (en) Manipulator system
JP4852719B2 (en) Articulated robot
EP1749621A2 (en) Robot programming device
JP4595053B2 (en) Articulated robot
KR101182600B1 (en) Parallel-kinematic robotic manipulator with a large cylindrical workspace
JP7144754B2 (en) Articulated robots and articulated robot systems
JP2019048349A (en) Robot system, robot control device, and manufacturing method of workpiece
US20190084156A1 (en) Robot system and method for controlling robot
US11220004B2 (en) Robot system
JP6172334B2 (en) Processing device and work production method
JP5939364B1 (en) Processing equipment
JP5933450B2 (en) Robot control apparatus and control method
US20200238512A1 (en) Teaching Data Generation System For Vertical Multi-Joint Robot
JP6057284B2 (en) Articulated robot and semiconductor wafer transfer device
JP2011189440A (en) Robot control device, robot system, program and robot control method
JP2016087704A (en) Processing device and workpiece production method
EP3213883B1 (en) Machining device and production method of workpiece
JP7124880B2 (en) robot system
JP2016087705A (en) Processing device and workpiece production method
JP7481941B2 (en) Robots and Robot Systems
JP2009050949A (en) Method and apparatus for teaching track of robot arm

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