[go: up one dir, main page]

JP7446925B2 - robot system - Google Patents

robot system Download PDF

Info

Publication number
JP7446925B2
JP7446925B2 JP2020097837A JP2020097837A JP7446925B2 JP 7446925 B2 JP7446925 B2 JP 7446925B2 JP 2020097837 A JP2020097837 A JP 2020097837A JP 2020097837 A JP2020097837 A JP 2020097837A JP 7446925 B2 JP7446925 B2 JP 7446925B2
Authority
JP
Japan
Prior art keywords
arm
angle
axis
control unit
teaching point
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
JP2020097837A
Other languages
Japanese (ja)
Other versions
JP2021186955A (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.)
Shibaura Machine Co Ltd
Original Assignee
Shibaura Machine Co Ltd
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 Shibaura Machine Co Ltd filed Critical Shibaura Machine Co Ltd
Priority to JP2020097837A priority Critical patent/JP7446925B2/en
Publication of JP2021186955A publication Critical patent/JP2021186955A/en
Application granted granted Critical
Publication of JP7446925B2 publication Critical patent/JP7446925B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Numerical Control (AREA)
  • Manipulator (AREA)

Description

本発明による実施形態は、ロボットシステムに関する。 Embodiments according to the invention relate to robotic systems.

複数のアームを有するロボットは、各アームを同時に動作させる場合がある。例えば、或るアームの動作の開始および終了のタイミングを、他のアームの開始および終了のタイミングと合わせる制御方法が知られている。 A robot with multiple arms may operate each arm simultaneously. For example, a control method is known in which the timing of the start and end of the motion of one arm is aligned with the start and end timing of another arm.

しかし、上記の制御方法では、他のアームと開始および終了のタイミングを合わせるために、或るアームの動作に無駄が生じ、効率が低下して動作時間(作業に要する時間)が長くなってしまう可能性があった。 However, with the above control method, in order to synchronize the start and end timing with other arms, there is waste in the operation of a certain arm, which reduces efficiency and increases the operation time (time required for work). There was a possibility.

特開平7-20915号公報Japanese Patent Application Publication No. 7-20915

複数のアームをより効率よく制御することができるロボットシステムを提供することを目的とする。 The purpose is to provide a robot system that can control multiple arms more efficiently.

本実施形態によるロボットシステムは、複数のアームと、複数のアームと接続するように設けられるアーム接続部を支持し、アーム接続部を可動とする軸を含む支持部と、を有するロボットと、ロボットの動作を制御するプログラムに含まれる、第1アームの動作における軸の角度である第1角度と、プログラムに含まれる、第2アームの動作における軸の角度である第2角度と、が略一致するか否かに基づいて、第1アームと第2アームとを互いに独立して動作させる制御部と、を備える。 The robot system according to the present embodiment includes a robot having a plurality of arms, a support section including a shaft that supports an arm connection section provided to connect to the plurality of arms and makes the arm connection section movable; The first angle, which is the angle of the axis in the movement of the first arm, included in the program that controls the movement of the second arm, and the second angle, which is the angle of the axis in the movement of the second arm, included in the program substantially match. The control unit includes a control unit that operates the first arm and the second arm independently of each other based on whether or not to perform the operation.

第1実施形態によるロボットシステムの構成を示す図。FIG. 1 is a diagram showing the configuration of a robot system according to a first embodiment. 第1実施形態によるロボットにおける軸構成の全体を示す模式図。FIG. 1 is a schematic diagram showing the entire axis configuration of the robot according to the first embodiment. 右アームおよび左アームの教示点および動作軌道の一例を示す図。The figure which shows an example of the teaching point and movement trajectory of a right arm and a left arm. プログラムの一例を示す図。The figure which shows an example of a program. 図4のプログラムにより生成された動作軌道の速度と時間との関係の一例を示すグラフ。5 is a graph showing an example of the relationship between the speed and time of the motion trajectory generated by the program of FIG. 4. FIG. 右アームおよび左アームの並列動作の一例を示すフロー図。FIG. 3 is a flow diagram showing an example of parallel operation of the right arm and the left arm. 逐次実行のプログラムにより生成された動作軌道の速度と時間との関係の一例を示すグラフ。The graph which shows an example of the relationship between the speed of the motion trajectory generated by the program of sequential execution, and time. 右アームおよび左アームの逐次実行の一例を示すフロー図。FIG. 7 is a flow diagram showing an example of sequential execution of the right arm and the left arm.

以下、図面を参照して本発明に係る実施形態を説明する。本実施形態は、本発明を限定するものではない。図面は模式的または概念的なものであり、各部分の比率などは、必ずしも現実のものと同一とは限らない。明細書と図面において、既出の図面に関して前述したものと同様の要素には同一の符号を付して詳細な説明は適宜省略する。 Embodiments of the present invention will be described below with reference to the drawings. This embodiment does not limit the present invention. The drawings are schematic or conceptual, and the proportions of each part are not necessarily the same as in reality. In the specification and drawings, the same elements as those described above with respect to the existing drawings are denoted by the same reference numerals, and detailed description thereof will be omitted as appropriate.

(第1実施形態)
図1は、第1実施形態によるロボットシステム1の構成を示す図である。ロボットシステム1は、ロボット10と、制御装置70と、を備える。
(First embodiment)
FIG. 1 is a diagram showing the configuration of a robot system 1 according to the first embodiment. The robot system 1 includes a robot 10 and a control device 70.

図2は、第1実施形態によるロボット10における軸構成の全体を示す模式図である。図2は、ロボット10における軸構成の全体を概観できるように示す。尚、図2では、図1において示されていない軸(JR4軸、JR5軸、JL3軸、JL4軸)も示されている。 FIG. 2 is a schematic diagram showing the entire axis configuration of the robot 10 according to the first embodiment. FIG. 2 shows an overall overview of the axis configuration of the robot 10. Note that FIG. 2 also shows axes that are not shown in FIG. 1 (JR4 axis, JR5 axis, JL3 axis, and JL4 axis).

ロボット10は、腰部12と、胴体14と、右腕16Rと、左腕16Lと、を有する。図1および図2に示す例では、ロボット10は、人間の体に似た構造をもつ双腕ヒト型ロボットである。 The robot 10 has a waist 12, a torso 14, a right arm 16R, and a left arm 16L. In the example shown in FIGS. 1 and 2, the robot 10 is a dual-arm humanoid robot with a structure similar to a human body.

アーム接続部としての胴体14は、複数のアームとしての右腕16Rおよび左腕16Lと接続するように設けられる。 The body 14 as an arm connection portion is provided so as to be connected to a right arm 16R and a left arm 16L as a plurality of arms.

支持部としての腰部12は、胴体14を支持し、胴体14を可動とする軸(腰軸)を含む。腰軸は、胴体14を旋回および傾動の少なくとも一方をさせる。従って、腰部12は、胴体14の中心を通る軸回りに胴体14を旋回させる旋回軸、および、胴体14を前後方向に傾動させる傾動軸の少なくとも一方を含む。 The waist part 12 as a support part supports the body 14 and includes an axis (waist axis) that allows the body 14 to move. The hip axis allows the torso 14 to pivot and/or tilt. Therefore, the waist portion 12 includes at least one of a pivot axis for rotating the body 14 around an axis passing through the center of the body 14 and a tilting axis for tilting the body 14 in the front-rear direction.

次に、ロボット10の各構成について詳細に説明する。 Next, each configuration of the robot 10 will be explained in detail.

腰部12は、台(図示せず)などに載せられており、腰部12そのものは動くことはない。 The waist part 12 is placed on a stand (not shown) or the like, and the waist part 12 itself does not move.

ここで、以下の説明における方向は、次のようなものとする。図1において、上下方向とは、腰部12を水平面上に設置した場合の上下をいい、前後方向とは、胴体14を基準にその前面側を前、背面側を後とし、左右は、胴体14を基準にいうものとする。 Here, the directions in the following description are as follows. In FIG. 1, the vertical direction refers to the vertical direction when the waist portion 12 is installed on a horizontal plane, and the longitudinal direction refers to the front side of the torso 14 as a reference, and the rear side to the back side. shall be based on.

胴体14は、その中心を通る鉛直な中心軸回りに回動可能であり、この軸をJB1とする。さらに、胴体14は、左右に延びる水平な軸JB2回りに傾動可能である。この実施形態では、胴体14は、JB1軸、JB2軸からなる2自由度を有している。 The body 14 is rotatable around a vertical central axis passing through its center, and this axis is designated as JB1. Furthermore, the body 14 is tiltable around a horizontal axis JB2 extending left and right. In this embodiment, the fuselage 14 has two degrees of freedom consisting of the JB1 axis and the JB2 axis.

次に、右腕16Rと左腕16Lについて説明する。 Next, the right arm 16R and left arm 16L will be explained.

右腕16Rは、肩部18Rと、上腕部19Rと、ひじ関節部20Rと、前腕部21Rと、手首部22Rと、から構成されている。同様に、左腕16Lは、肩部18Lと、上腕部19Lと、ひじ関節部20Lと、前腕部21Lと、手首部22Lと、から構成されている。 The right arm 16R includes a shoulder portion 18R, an upper arm portion 19R, an elbow joint portion 20R, a forearm portion 21R, and a wrist portion 22R. Similarly, the left arm 16L includes a shoulder portion 18L, an upper arm portion 19L, an elbow joint portion 20L, a forearm portion 21L, and a wrist portion 22L.

図1および図2において、右腕16Rの肩部18Rは、上腕部19Rが回動するJR1軸、JR2軸を有し、2自由度である。右腕16Rのひじ関節部20Rは、JR3軸、JR4軸、JR5軸の都合3自由度の関節になっている。右腕16Rの手首部22Rは、JR6軸、JR7軸の2自由度を有している。したがって、右腕16Rは、合計で7自由度をもっている。 In FIGS. 1 and 2, the shoulder portion 18R of the right arm 16R has two degrees of freedom, having JR1 axis and JR2 axis around which the upper arm portion 19R rotates. The elbow joint 20R of the right arm 16R is a joint with three degrees of freedom: JR3 axis, JR4 axis, and JR5 axis. The wrist portion 22R of the right arm 16R has two degrees of freedom: the JR6 axis and the JR7 axis. Therefore, the right arm 16R has a total of 7 degrees of freedom.

同様に、左腕16Lの肩部18Lは、上腕部19Lが回動するJL1軸、JL2軸を有し、2自由度である。左腕16Lのひじ関節部20Lは、JL3軸、JL4軸、JL5軸の都合3自由度の関節になっている。左腕16Lの手首部22Lは、JL6軸、JL7軸の2自由度を有している。したがって、左腕16Lも、合計で7自由度をもっている。 Similarly, the shoulder portion 18L of the left arm 16L has two degrees of freedom, having JL1 axis and JL2 axis around which the upper arm portion 19L rotates. The elbow joint 20L of the left arm 16L is a joint with three degrees of freedom: the JL3 axis, the JL4 axis, and the JL5 axis. The wrist portion 22L of the left arm 16L has two degrees of freedom: the JL6 axis and the JL7 axis. Therefore, the left arm 16L also has seven degrees of freedom in total.

JR1軸、JL1軸は、上腕部19R、19Lをそれぞれ上腕部19R、19Lの長さ方向の中心線回りに回動させる軸である。JR2軸、JL2軸は、胴体14に垂直な面内で、上腕部19R、19Lをそれぞれ旋回させる軸である。胴体14が直立していれば、上腕部19R、19Lは水平面上を旋回することになる。 The JR1 axis and the JL1 axis are axes for rotating the upper arm parts 19R and 19L about the longitudinal center lines of the upper arm parts 19R and 19L, respectively. The JR2 axis and the JL2 axis are axes for rotating the upper arm portions 19R and 19L, respectively, in a plane perpendicular to the body 14. If the body 14 is upright, the upper arms 19R and 19L will rotate on a horizontal plane.

JR3軸、JL3軸は、JR1軸、JL1軸と同軸な軸線回りに、ひじ関節部20R、20Lの全体がそれぞれ旋回する軸である。JR4軸、JL4軸は、ひじ関節部20R、20Lの下半分をJR3軸、JL3軸と直交する軸回りに回転させる軸である。JR5軸、JL5軸は、前腕部21R、21LをJR4軸、JL4軸と直交する軸回りに回転させる軸である。 The JR3 axis and the JL3 axis are axes around which the entire elbow joints 20R and 20L pivot, respectively, around axes that are coaxial with the JR1 axis and the JL1 axis. The JR4 axis and the JL4 axis are axes that rotate the lower halves of the elbow joints 20R and 20L around axes perpendicular to the JR3 axis and the JL3 axis. The JR5 axis and the JL5 axis are axes for rotating the forearm portions 21R and 21L around axes perpendicular to the JR4 axis and the JL4 axis.

手首部22R、22LのJR6軸、JL6軸は、前腕部21R、21Lの長さ方向と平行な面内でそれぞれ手首部22R、22Lを旋回させる軸である。JR7軸、JL7軸は、JR6軸、JL6軸と直交し、手首部22R、22Lに取り付けられるエンドエフェクタを旋回させる軸である。 The JR6 axis and JL6 axis of the wrist portions 22R and 22L are axes for rotating the wrist portions 22R and 22L, respectively, within a plane parallel to the longitudinal direction of the forearm portions 21R and 21L. The JR7 axis and the JL7 axis are orthogonal to the JR6 axis and the JL6 axis, and are axes for rotating the end effectors attached to the wrist parts 22R and 22L.

また、ロボット10は、角度センサ(図示せず)をさらに有している。各回転軸JB1、JB2、JL1~JL7、JR1~JR7にはそれぞれモータが設けられている。モータは、回転軸の駆動に用いられる。各モータは、それぞれの回転位置を検出する角度センサを有している。角度センサは、例えば、エンコーダである。また、より詳細には、角度センサは、腰軸の角度を検出する。「腰軸」は、旋回軸であるJB1軸および傾動軸であるJB2軸の少なくとも一方である。 Moreover, the robot 10 further includes an angle sensor (not shown). Each rotating shaft JB1, JB2, JL1 to JL7, and JR1 to JR7 is provided with a motor, respectively. The motor is used to drive the rotating shaft. Each motor has an angle sensor that detects its respective rotational position. The angle sensor is, for example, an encoder. Further, more specifically, the angle sensor detects the angle of the waist axis. The "waist axis" is at least one of the JB1 axis, which is a turning axis, and the JB2 axis, which is a tilting axis.

尚、以下では、「右腕16R」は、「右アーム16R」または「ARM1」と呼ばれる場合がある。「左腕16L」は、「左アーム16L」または「ARM2」と呼ばれる場合がある。 Note that, hereinafter, the "right arm 16R" may be referred to as the "right arm 16R" or "ARM1". The "left arm 16L" may be referred to as the "left arm 16L" or "ARM2."

図1に示すように、制御装置70は、記憶部71と、制御部72と、を備える。 As shown in FIG. 1, the control device 70 includes a storage section 71 and a control section 72.

記憶部71は、例えば、メインメモリとして機能するRAM(Random Access Memory)またはROM(Read Only Memory)、および、ストレージとして機能するHDD(Hard Disk Drive)またはSSD(Solid State Drive)を備えてもよい。記憶部71は、例えば、ロボット10を動作させる各種プログラムやデータを格納する。また、記憶部71は、教示により作成されたプログラムを格納する。教示は、例えば、アームの先端位置のXYZ座標を記憶部71が記憶することにより行われる。尚、記憶部71は、ロボットシステム1の外部に設けられていてもよい。 The storage unit 71 may include, for example, a RAM (Random Access Memory) or a ROM (Read Only Memory) that functions as a main memory, and an HDD (Hard Disk Drive) or an SSD (Solid State Drive) that functions as a storage. . The storage unit 71 stores, for example, various programs and data for operating the robot 10. Furthermore, the storage unit 71 stores a program created by the teaching. Teaching is performed by, for example, storing the XYZ coordinates of the tip position of the arm in the storage unit 71. Note that the storage unit 71 may be provided outside the robot system 1.

制御部72は、ロボット10と接続し、ロボット10を制御する。制御部72は、例えば、ロボット10の動作を制御するプログラムを実行することによって、各モータを制御する。これにより、各回転軸(関節)が所望の角度に制御され、例えば、エンドエフェクタ(右アーム16Rおよび左アーム16Lの先端)を所望の位置および所望の角度に移動させることができる。このように、プログラムは、ロボット10を実際に動作させるために用いられる。 The control unit 72 is connected to the robot 10 and controls the robot 10. The control unit 72 controls each motor by, for example, executing a program that controls the operation of the robot 10. Thereby, each rotational axis (joint) is controlled to a desired angle, and for example, the end effectors (the tips of the right arm 16R and left arm 16L) can be moved to a desired position and a desired angle. In this way, the program is used to actually operate the robot 10.

プログラムには、例えば、アームの先端位置が含まれる。制御部72は、プログラムに基づいて、アームの動作軌道を生成する。尚、制御部72は、プログラムからアームの姿勢情報を取得し、動作軌道の生成に用いてもよい。この場合、制御部72は、教示の際に、アームの先端位置に加えてアームの姿勢情報をプログラムに含めればよい。これにより、目標の先端位置におけるアームの形態(例えば、アームの関節の曲がり具合等)を、途中経路によらずほぼ同じにすることができる。しかし、これに限られず、アームの姿勢情報の教示が行われず、動作軌道の生成にアームの姿勢情報が用いられなくてもよい。 The program includes, for example, the position of the tip of the arm. The control unit 72 generates the motion trajectory of the arm based on the program. Note that the control unit 72 may acquire arm posture information from the program and use it to generate the motion trajectory. In this case, the control unit 72 may include arm posture information in addition to the arm tip position in the program during teaching. Thereby, the shape of the arm at the target tip position (for example, the degree of bending of the joints of the arm, etc.) can be made almost the same regardless of the intermediate route. However, the present invention is not limited to this, and the arm posture information may not be taught and the arm posture information may not be used to generate the motion trajectory.

また、制御部72は、第1アームの教示点毎に、角度センサの検出結果をプログラムに含まれる第1角度とする。また、制御部72は、第2アームの教示点毎に、角度センサの検出結果をプログラムに含まれる第2角度とする。すなわち、制御部72は、アームの教示の際に、現在の腰軸の角度をアームの先端位置とともに記憶部71内のプログラムに取り込む。「第1アーム」および「第2アーム」は、複数のアームのうち任意のアームである。例えば、第1アームが右アーム16Rであり、第2アームが左アーム16Lであってもよい。一方、第1アームが左アーム16Lであり、第2アームが右アーム16Rであってもよい。この対応関係は、例えば、図5(A)および図5(B)を参照して後で説明するように、時間の経過等によって切り替わる場合がある。 Further, the control unit 72 sets the detection result of the angle sensor as the first angle included in the program for each teaching point of the first arm. Further, the control unit 72 sets the detection result of the angle sensor as the second angle included in the program for each teaching point of the second arm. That is, when teaching the arm, the control section 72 takes in the current angle of the hip axis and the position of the tip of the arm into the program in the storage section 71. The "first arm" and the "second arm" are arbitrary arms among the plurality of arms. For example, the first arm may be the right arm 16R, and the second arm may be the left arm 16L. On the other hand, the first arm may be the left arm 16L, and the second arm may be the right arm 16R. This correspondence relationship may change over time, for example, as will be explained later with reference to FIGS. 5(A) and 5(B).

また、制御部72は、ロボット10の動作を制御するプログラムに含まれる、第1アームの動作における腰軸の角度である第1角度と、プログラムに含まれる、第2アームの動作における腰軸の角度である第2角度と、が略一致するか否かに基づいて、第1アームと第2アームとを互いに独立して動作させる。「第1アームと第2アームとを互いに独立して動作させる」ことは、第1アームが第2アームの動作の影響を受けることなく動作し、第2アームが第1アームの動作の影響を受けることなく動作することを示す。従って、第1アームおよび第2アームは、例えば、教示点における動作開始または動作終了のタイミングを同期することなく動作する。 The control unit 72 also controls a first angle, which is the angle of the hip axis in the movement of the first arm, which is included in the program for controlling the movement of the robot 10, and a first angle, which is the angle of the hip axis in the movement of the second arm, which is included in the program. The first arm and the second arm are operated independently of each other based on whether or not the second angle substantially coincides with each other. "Operating the first arm and the second arm independently of each other" means that the first arm operates without being influenced by the operation of the second arm, and the second arm operates without being influenced by the operation of the first arm. Indicates that it operates without being affected. Therefore, the first arm and the second arm operate, for example, without synchronizing the timing of starting or ending the operation at the teaching point.

腰軸を有するロボット10では、腰軸の角度がアームの先端位置および動作に影響を与える場合がある。もし、アームが動作せずに腰軸の角度が変化すると、アームの先端位置がずれてしまう。また、教示の際にアームの姿勢情報がプログラムに含まれる場合であっても、教示時とプログラム実行時との間で腰軸の角度に差があると、教示時とプログラム時との間でアームの形態が異なってしまう可能性がある。これは、教示において、アームの先端位置のXYZ座標が設定されるためである。また、複数のアームを有するロボット10では、それぞれ別の動作(作業)を行わせるために、アーム毎に教示が行われる場合がある。また、このように個別に教示されたアームは、効率化のために、同時に動作する場合がある。 In the robot 10 having a waist axis, the angle of the waist axis may affect the position and operation of the tip of the arm. If the arm does not move and the angle of the hip axis changes, the position of the tip of the arm will shift. Furthermore, even if arm posture information is included in the program during teaching, if there is a difference in the angle of the hip axis between the teaching and program execution, the The shape of the arm may be different. This is because the XYZ coordinates of the tip position of the arm are set during teaching. Further, in the robot 10 having a plurality of arms, teaching may be performed for each arm in order to have each arm perform a different operation (work). Also, such individually taught arms may operate simultaneously for efficiency.

ここで、腰軸は、複数のアームが共通に接続された胴体14を可動とする。従って、腰軸の角度は、各アームの先端位置および動作に影響を与える。従って、各アームの動作内容によっては、各アームが適切に動作することが難しく、また、各アームの動作が制限される可能性がある。そこで、制御部72は、プログラム中の腰軸の角度を比較することにより、各アームが別の作業が実行できるか否かを判断し、アームを独立して制御する。これにより、腰軸を有するロボット10において、異なる作業を実行する複数のアームをより効率よく制御することができる。 Here, the waist axis allows the body 14 to which a plurality of arms are commonly connected to be movable. Therefore, the angle of the hip axis affects the position and movement of the tip of each arm. Therefore, depending on the operation content of each arm, it may be difficult for each arm to operate appropriately, and the operation of each arm may be restricted. Therefore, the control unit 72 determines whether each arm can perform a different task by comparing the angles of the waist axes in the program, and controls the arms independently. Thereby, in the robot 10 having a waist axis, it is possible to more efficiently control a plurality of arms that perform different tasks.

また、制御部72は、第1アームの教示点毎に、第1角度および第1アームの先端位置を取得する。制御部72は、第1角度および第1アームの先端位置に基づいて、第1アームの動作軌道を生成する。同様に、制御部72は、第2アームの教示点毎に、第2角度および第2アームの先端位置を取得する。制御部72は、第2角度および第2アームの先端位置に基づいて、第2アームの動作軌道を生成する。 Further, the control unit 72 acquires the first angle and the tip position of the first arm for each teaching point of the first arm. The control unit 72 generates a motion trajectory of the first arm based on the first angle and the position of the tip of the first arm. Similarly, the control unit 72 acquires the second angle and the tip position of the second arm for each teaching point of the second arm. The control unit 72 generates a motion trajectory of the second arm based on the second angle and the position of the tip of the second arm.

図3は、右アーム16Rおよび左アーム16Lの教示点および動作軌道の一例を示す図である。図3(A)は、右アーム16Rの教示点および動作軌道の一例を示す。図3(B)は、左アーム16Lの教示点および動作軌道の一例を示す。 FIG. 3 is a diagram showing an example of teaching points and motion trajectories of the right arm 16R and left arm 16L. FIG. 3(A) shows an example of the teaching point and motion trajectory of the right arm 16R. FIG. 3(B) shows an example of the teaching point and motion trajectory of the left arm 16L.

RP0~RP3は、右アーム16Rの教示点を示す。LP0~LP4は、左アーム16Lの教示点を示す。尚、教示点RP0、LP0は、一連の軌道の開始教示点である。教示点RP0から教示点RP3までの軌道は、右アーム16Rの連続する複数の教示点を含む右アーム軌道である。右アーム16Rは、右アーム軌道に沿って移動する。教示点LP0から教示点LP4までの軌道は、左アーム16Lの連続する複数の教示点を含む左アーム軌道である。左アーム16Lは、左アーム軌道に沿って移動する。 RP0 to RP3 indicate teaching points of the right arm 16R. LP0 to LP4 indicate teaching points of the left arm 16L. The teaching points RP0 and LP0 are the starting teaching points of a series of trajectories. The trajectory from teaching point RP0 to teaching point RP3 is a right arm trajectory including a plurality of consecutive teaching points of right arm 16R. The right arm 16R moves along the right arm trajectory. The trajectory from teaching point LP0 to teaching point LP4 is a left arm trajectory including a plurality of consecutive teaching points of left arm 16L. The left arm 16L moves along the left arm trajectory.

矢印は、教示点間の軌道を示す。矢印の距離は、軌道の距離を示す。図3(A)および図3(B)に示す例では、教示点LP1と教示点LP2との間の距離、および、教示点LP2と教示点LP3との間の距離は、他の教示点間の距離に比べて短くなっている。 Arrows indicate trajectories between teaching points. The distance of the arrow indicates the distance of the trajectory. In the examples shown in FIGS. 3(A) and 3(B), the distance between teaching point LP1 and teaching point LP2 and the distance between teaching point LP2 and teaching point LP3 are the same as those between other teaching points. is shorter than the distance of

図4は、プログラムの一例を示す図である。 FIG. 4 is a diagram showing an example of a program.

「PARALLEL ARM1」は、右アーム16Rに「PARALLEL END」までの動作を並列動作として実行させることを示す。「PARALLEL ARM2」は、左アーム16Lに「PARALLEL END」までの動作を並列動作として実行させることを示す。「PARALLEL END」は、並列動作の終了を示す。図4に示す例では、右アーム16RであるARM1に関する「MOVE ARM1 RPn(n=1、2、3)」と、左アーム16LであるARM2に関する「MOVE ARM2 LPm(m=1、2、3、4)」と、が並列で実行される。 "PARALLEL ARM1" indicates that the right arm 16R is caused to execute the operations up to "PARALLEL END" as parallel operations. "PARALLEL ARM2" indicates that the left arm 16L is caused to execute the operations up to "PARALLEL END" as parallel operations. "PARALLEL END" indicates the end of parallel operation. In the example shown in FIG. 4, "MOVE ARM1 RPn (n=1, 2, 3)" regarding ARM1, which is the right arm 16R, and "MOVE ARM2 LPm (m=1, 2, 3, 4)'' are executed in parallel.

「MOVE ARM1 RPn(n=1、2、3)」は、右アーム16Rを教示点RPn(n=1、2、3)まで移動させることを示す。従って、「MOVE ARM1 RPn(n=1、2、3)」は、図3(A)に示す右アーム軌道のプログラム行である。「MOVE ARM2 LPm(m=1、2、3、4)」は、左アーム16Lを教示点LPm(m=1、2、3、4)まで移動させることを示す。従って、「MOVE ARM2 LPm(m=1、2、3、4)」は、図3(B)に示す左腕アーム軌道のプログラム行である。 “MOVE ARM1 RPn (n=1, 2, 3)” indicates moving the right arm 16R to the teaching point RPn (n=1, 2, 3). Therefore, "MOVE ARM1 RPn (n=1, 2, 3)" is the program line for the right arm trajectory shown in FIG. 3(A). “MOVE ARM2 LPm (m=1, 2, 3, 4)” indicates moving the left arm 16L to the teaching point LPm (m=1, 2, 3, 4). Therefore, "MOVE ARM2 LPm (m=1, 2, 3, 4)" is the program line for the left arm trajectory shown in FIG. 3(B).

制御部72は、第1角度と第2角度とが略一致する場合、第1アームと第2アームとを互いに独立して動作させる。また、制御部72は、第1角度と第2角度とが一致しない場合、第1アームおよび第2アームの動作を停止させる。第1角度と第2角度とが略一致する場合、教示点のタイミングを同期させることなく、第1アームと第2アームとを適切に動作させることができる。これは、各アームの教示の際に腰軸の角度が略一致しているためである。一方、第1角度と第2角度とが一致しない場合、第1アームと第2アームとを同時に動作させると、例えば、予期せず第1アームおよび第2アームが危険な動作をする可能性がある。従って、腰軸の角度が一致していない場合、例えば、プログラムエラーとして、第1アームおよび第2アームを動作させないようにする必要がある。制御部72は、例えば、表示部(図示せず)にエラーを表示してもよい。 The control unit 72 operates the first arm and the second arm independently of each other when the first angle and the second angle substantially match. Further, if the first angle and the second angle do not match, the control unit 72 stops the operations of the first arm and the second arm. When the first angle and the second angle substantially match, the first arm and the second arm can be appropriately operated without synchronizing the timing of the teaching points. This is because the angles of the hip axes are approximately the same when each arm is taught. On the other hand, when the first angle and the second angle do not match, if the first arm and the second arm are operated at the same time, for example, there is a possibility that the first arm and the second arm may unexpectedly make dangerous movements. be. Therefore, if the angles of the waist axes do not match, it is necessary to prevent the first arm and the second arm from operating, for example, as a program error. For example, the control unit 72 may display an error on a display unit (not shown).

また、制御部72は、腰軸の複数の角度の差が所定値以下である場合、腰軸の複数の角度が略一致すると判定する。角度センサであるエンコーダの精度等によっては、腰軸の角度は、必ずしも一致しない場合がある。そこで、制御部72は、角度の差が小さい場合に、腰軸の角度が略一致すると判断する。所定値は、例えば、ユーザによって予め設定される。所定値は、例えば、作業内容によって変更される場合がある。例えば、細かい位置精度を必要とする作業が実行される場合、所定値は小さい値である必要がある。一方、位置精度が荒くてもよい作業が実行される場合、所定値は大きい値であってもよい。 Further, if the difference between the plurality of angles of the waist axis is less than or equal to a predetermined value, the control unit 72 determines that the plurality of angles of the waist axis substantially match. Depending on the accuracy of the encoder, which is an angle sensor, the angles of the waist axes may not necessarily match. Therefore, the control unit 72 determines that the angles of the hip axes substantially match when the difference in angle is small. The predetermined value is set in advance by the user, for example. The predetermined value may be changed depending on the work content, for example. For example, when an operation requiring fine positional accuracy is performed, the predetermined value needs to be a small value. On the other hand, when work is performed that requires poor positional accuracy, the predetermined value may be a large value.

また、制御部72は、第1アームの連続する複数の教示点を含む第1経路における第1角度と、第2アームの連続する複数の教示点を含む第2経路における第2角度と、が略一致するか否かに基づいて、第1アームと第2アームとを互いに独立して動作させる。「第1経路」および「第2経路」は、例えば、右アーム軌道および左アーム軌道である。すなわち、制御部72は、右アーム軌道における腰軸の角度と、左アーム軌道における腰軸の角度と、を比較する。これにより、複数のアームは、互いに独立して一連の動作を行うことができる。 The control unit 72 also controls the control unit 72 to adjust the first angle in the first path including the plurality of consecutive teaching points of the first arm and the second angle in the second path including the plurality of consecutive teaching points of the second arm. The first arm and the second arm are operated independently of each other based on whether or not they substantially match. The "first route" and the "second route" are, for example, a right arm trajectory and a left arm trajectory. That is, the control unit 72 compares the angle of the waist axis in the right arm trajectory with the angle of the waist axis in the left arm trajectory. This allows the plurality of arms to perform a series of operations independently of each other.

図4に示す「PARALLEL」において、制御部72は、腰軸の角度が略一致しているか否かを比較判定する。腰軸の角度が略一致している場合、制御部72は、「MOVE」のプログラム行を実行し、右アーム16Rおよび左アーム16Lの並列動作を実行させる。 In "PARALLEL" shown in FIG. 4, the control unit 72 compares and determines whether the angles of the hip axes substantially match. If the angles of the hip axes substantially match, the control unit 72 executes the "MOVE" program line to cause the right arm 16R and left arm 16L to perform parallel movements.

「MOVE」において、制御部72は、教示点毎に、腰軸の角度およびアームの先端位置に基づいて軌道生成の演算を行う。制御部72は、上記判定により、右アーム16Rと左アーム16Lとの間で略一致した腰軸の角度の値を用いて軌道生成の演算を行う。制御部72は、生成した動作軌道をアームに実行させる。 In "MOVE", the control unit 72 performs trajectory generation calculations for each teaching point based on the angle of the hip axis and the position of the tip of the arm. The control unit 72 performs trajectory generation calculations using the angle values of the waist axes that are approximately the same between the right arm 16R and the left arm 16L based on the above determination. The control unit 72 causes the arm to execute the generated motion trajectory.

また、より詳細には、制御部72は、第1経路および第2経路に含まれる教示点毎の腰軸の全ての角度が略一致するか否かに基づいて、第1アームと第2アームとを互いに独立して動作させる。すなわち、制御部72は、第1経路に含まれる教示点毎の全ての第1角度が略一致するか否かと、第2経路に含まれる教示点毎の全ての第2角度が略一致するか否かと、をさらに判定する。図4に示す例では、制御部72は、教示点RP0~RP3、LP0~LP4における腰軸の角度が全て略一致するか否かを判定する。従って、制御部72は、腰軸をほぼ固定で、第1アームと第2アームとを互いに独立して動作させる。 In addition, in more detail, the control unit 72 controls the first arm and the second arm based on whether all the angles of the hip axes for each teaching point included in the first route and the second route substantially match. and operate independently of each other. That is, the control unit 72 determines whether all the first angles for each teaching point included in the first path substantially match, and whether all the second angles for each teaching point included in the second path substantially match. It is further determined whether or not. In the example shown in FIG. 4, the control unit 72 determines whether the angles of the hip axes at the teaching points RP0 to RP3 and LP0 to LP4 all substantially match. Therefore, the control unit 72 operates the first arm and the second arm independently of each other while keeping the waist axis substantially fixed.

尚、ユーザは、例えば、個別に教示される第1アームおよび第2アームの動作を確認し、同時に独立して制御させる区間を選択(指定)する。また、ユーザは、例えば、腰軸の角度がほぼ変化しない区間として、並列動作が実行される右アーム軌道および左アーム軌道を選択する。ユーザは、選択した軌道に対して、「PARALLEL」を用いてプログラムを作成すればよい。 Note that the user, for example, confirms the individually taught movements of the first arm and the second arm, and simultaneously selects (designates) a section to be independently controlled. Further, the user selects, for example, a right arm trajectory and a left arm trajectory in which parallel motions are performed as sections in which the angle of the hip axis does not substantially change. The user may create a program using "PARALLEL" for the selected trajectory.

以下では、教示点RP0~RP3、LP0~LP4における腰軸の角度が全て略一致している場合について、説明する。 In the following, a case will be described in which the angles of the hip axes at the teaching points RP0 to RP3 and LP0 to LP4 are all substantially the same.

図5は、図4のプログラムにより生成された動作軌道の速度と時間との関係の一例を示すグラフである。図5(A)は、図3(A)に示す動作軌道における時間と速度との関係を示すグラフである。図5(B)は、図3(B)に示す動作軌道における時間と速度との関係を示すグラフである。縦軸はアームの移動速度を示し、横軸は時間を示す。尚、図5(A)の横軸は、図5(B)の横軸と対応する。また、右アーム16Rおよび左アーム16Lは、或る教示点から加速し、最大速度に達し、減速して次の教示点で停止する。また、速度のグラフの面積は、アームの移動距離を示す。 FIG. 5 is a graph showing an example of the relationship between the velocity of the motion trajectory generated by the program of FIG. 4 and time. FIG. 5(A) is a graph showing the relationship between time and speed in the motion trajectory shown in FIG. 3(A). FIG. 5(B) is a graph showing the relationship between time and speed in the motion trajectory shown in FIG. 3(B). The vertical axis shows the moving speed of the arm, and the horizontal axis shows time. Note that the horizontal axis in FIG. 5(A) corresponds to the horizontal axis in FIG. 5(B). Further, the right arm 16R and the left arm 16L accelerate from a certain teaching point, reach the maximum speed, decelerate, and stop at the next teaching point. Furthermore, the area of the velocity graph indicates the distance traveled by the arm.

制御部72は、第1角度と第2角度とが略一致するか否かに基づいて、教示点間における第1アームの動作中に、教示点における動作の開始および終了の少なくとも一方を第2アームにさせる。すなわち、制御部72は、教示点毎の動作開始または動作終了のタイミングを合わせないように(同期させないように)、右アーム16Rと左アーム16Lとを制御する。これにより、第2アームは、第1アームの動作の完了を待たずに、次の動作を実行することができる。 The control unit 72 controls at least one of the start and end of the operation at the teaching point during the movement of the first arm between the teaching points, based on whether the first angle and the second angle substantially match. Let it be an arm. That is, the control unit 72 controls the right arm 16R and the left arm 16L so that the timing of the start or end of the operation for each teaching point is not synchronized (not synchronized). Thereby, the second arm can perform the next operation without waiting for the completion of the operation of the first arm.

図5(A)および図5(B)に示す例では、t0において、右アーム16Rおよび左アーム16Lは、それぞれ、教示点RP0および教示点LP0から略同時に動作を開始する。次に、t1において、右アーム16Rおよび左アーム16Lは、それぞれ、教示点RP1および教示点LP1に達する。尚、教示点RP1、LP1のタイミングは、略同時である。次に、t2において、左アーム16Lは、教示点LP2に達する。尚、t2において、右アーム16Rは、教示点RP1と教示点RP2との間の動作を実行中である。次に、t3において、左アーム16Lは、教示点LP3に達する。尚、t3において、右アーム16Rは、教示点RP1と教示点RP2との間の動作を実行中である。次に、t4において、右アーム16Rは、教示点RP2に達する。尚、t4において、左アーム16Lは、教示点LP3と教示点LP4との間の動作を実行中である。次に、t5において、左アーム16Lは、教示点LP4に達し、左アーム軌道の動作を終了する。尚、t5において、右アーム16Rは、教示点RP2と教示点RP3との間の動作を実行中である。次に、t6において、右アーム16Rは、教示点RP3に達し、右アーム軌道の動作を終了する。 In the example shown in FIGS. 5(A) and 5(B), at t0, the right arm 16R and the left arm 16L start operating substantially simultaneously from the teaching point RP0 and the teaching point LP0, respectively. Next, at t1, the right arm 16R and the left arm 16L reach the teaching point RP1 and the teaching point LP1, respectively. Note that the timings of the teaching points RP1 and LP1 are substantially the same. Next, at t2, the left arm 16L reaches the teaching point LP2. Note that at t2, the right arm 16R is performing an operation between the teaching point RP1 and the teaching point RP2. Next, at t3, the left arm 16L reaches the teaching point LP3. Note that at t3, the right arm 16R is performing an operation between the teaching point RP1 and the teaching point RP2. Next, at t4, the right arm 16R reaches the teaching point RP2. Note that at t4, the left arm 16L is performing an operation between the teaching point LP3 and the teaching point LP4. Next, at t5, the left arm 16L reaches the teaching point LP4 and ends the operation of the left arm trajectory. Note that at t5, the right arm 16R is performing an operation between the teaching point RP2 and the teaching point RP3. Next, at t6, the right arm 16R reaches the teaching point RP3 and ends the right arm trajectory operation.

従って、t2、t3およびt5において、左アーム16Lは、教示点における右アーム16Rの動作開始および動作終了のタイミングとは無関係に、教示点における動作の開始および終了を行っている。この場合、右アーム16Rが第1アームに対応し、左アーム16Lが第2アームに対応する。一方、t4およびt6において、右アーム16Rは、教示点における左アーム16Lの動作開始および動作終了のタイミングとは無関係に、教示点における動作の開始および終了を行っている。この場合、左アーム16Lが第1アームに対応し、右アーム16Rが第2アームに対応する。 Therefore, at t2, t3, and t5, the left arm 16L starts and ends the operation at the teaching point, regardless of the timing of the start and end of the operation of the right arm 16R at the teaching point. In this case, the right arm 16R corresponds to the first arm, and the left arm 16L corresponds to the second arm. On the other hand, at t4 and t6, the right arm 16R starts and ends its motion at the teaching point, regardless of the timing at which the left arm 16L starts and ends its motion at the teaching point. In this case, the left arm 16L corresponds to the first arm, and the right arm 16R corresponds to the second arm.

図6は、右アーム16Rおよび左アーム16Lの並列動作の一例を示すフロー図である。 FIG. 6 is a flow diagram showing an example of parallel operation of the right arm 16R and left arm 16L.

図6に示すように、右アーム16Rと左アーム16Lとは、互いに影響することなく、並列動作する。従って、タイミングの同期のために、無駄な待機時間または低速動作等がほとんどなく、複数のアームを効率的に動作させることができる。 As shown in FIG. 6, the right arm 16R and left arm 16L operate in parallel without influencing each other. Therefore, due to timing synchronization, there is almost no wasted waiting time or low-speed operation, and a plurality of arms can be operated efficiently.

以上のように、第1実施形態によれば、制御部72は、プログラムに含まれる、第1アームの動作における腰軸の角度である第1角度と、プログラムに含まれる、第2アームの動作における腰軸の角度である第2角度と、が略一致するか否かに基づいて、第1アームと第2アームとを互いに独立して動作させる。これにより、動作開始および動作終了のタイミングを同期させることなく、第1アームと第2アームとを並列動作させることができる。この結果、腰軸を有するロボット10において、異なる作業を実行する複数のアームをより効率よく制御することができる。 As described above, according to the first embodiment, the control unit 72 controls the first angle, which is the angle of the waist axis in the movement of the first arm, included in the program, and the movement of the second arm, which is included in the program. The first arm and the second arm are operated independently from each other based on whether or not the second angle, which is the angle of the waist axis in , substantially coincides with each other. Thereby, the first arm and the second arm can be operated in parallel without synchronizing the timing of the start and end of the operation. As a result, in the robot 10 having a waist axis, a plurality of arms that perform different tasks can be controlled more efficiently.

複数アームを有するロボットでは、或るアームの動作の開始および終了のタイミングを、他のアームの開始および終了のタイミングと合わせる、逐次動作(逐次実行)の制御方法が用いられる場合がある。 In a robot having multiple arms, a sequential motion (sequential execution) control method may be used in which the timing of the start and end of the motion of one arm is matched with the start and end timing of another arm.

図7は、逐次実行のプログラムにより生成された動作軌道の速度と時間との関係の一例を示すグラフである。図7(A)は、図3(A)に示す動作軌道における時間と速度との関係を示すグラフである。図7(B)は、図3(B)に示す動作軌道における時間と速度との関係を示すグラフである。 FIG. 7 is a graph showing an example of the relationship between the velocity of a motion trajectory generated by a sequentially executed program and time. FIG. 7(A) is a graph showing the relationship between time and speed in the motion trajectory shown in FIG. 3(A). FIG. 7(B) is a graph showing the relationship between time and speed in the motion trajectory shown in FIG. 3(B).

尚、逐次実行のプログラムとして、例えば、「MOVE ARM1 RPl,ARM2 LPl(l=1、2、3)」が用いられる。このプログラム行は、1行で右アーム16Rおよび左アーム16Lの両方を次の教示点に移動させることを示す。 Note that, for example, "MOVE ARM1 RPl, ARM2 LPl (l=1, 2, 3)" is used as the sequentially executed program. This program line indicates that both the right arm 16R and the left arm 16L are moved to the next teaching point in one line.

図7(A)および図7(B)に示す例では、t0~t1において、右アーム16Rおよび左アーム16Lは、図5(A)および図5(B)と同様に動作する。次に、t2aにおいて、右アーム16Rおよび左アーム16Lは、それぞれ、教示点RP2および教示点LP2に達する。尚、教示点RP2、LP2のタイミングは、略同時である。次に、t3aにおいて、右アーム16Rおよび左アーム16Lは、それぞれ、教示点RP3および教示点LP3に達する。尚、教示点RP3、LP3のタイミングは、略同時である。また、右アーム16Rは、教示点RP3に達して右アーム軌道の動作を終了する。次に、左アーム16Lは、教示点LP4に達し、左アーム軌道の動作を終了する。 In the example shown in FIGS. 7(A) and 7(B), the right arm 16R and left arm 16L operate in the same manner as in FIGS. 5(A) and 5(B) from t0 to t1. Next, at t2a, the right arm 16R and the left arm 16L reach the teaching point RP2 and the teaching point LP2, respectively. Note that the timings of the teaching points RP2 and LP2 are substantially the same. Next, at t3a, the right arm 16R and the left arm 16L reach the teaching point RP3 and the teaching point LP3, respectively. Note that the timings of the teaching points RP3 and LP3 are substantially the same. Further, the right arm 16R reaches the teaching point RP3 and ends the operation of the right arm trajectory. Next, the left arm 16L reaches the teaching point LP4 and ends the operation of the left arm trajectory.

図3(A)および図3(B)に示すように、教示点LP1と教示点LP2との間の距離は、教示点RP1と教示点RP2との間の距離よりも短い。同様に、教示点LP2と教示点LP3との間の距離は、教示点RP2と教示点RP3との間の距離よりも短い。従って、t1~t3aにおいて、左アーム16Lは、図5(B)に示すt1~t3よりも低速で動作する。すなわち、左アーム16Lは、t1~t3aの区間において、最大速度よりも低速で動作する。この結果、全動作の終了までの時間が長くかかり、効率が低下してしまう。 As shown in FIGS. 3(A) and 3(B), the distance between teaching point LP1 and teaching point LP2 is shorter than the distance between teaching point RP1 and teaching point RP2. Similarly, the distance between teaching point LP2 and teaching point LP3 is shorter than the distance between teaching point RP2 and teaching point RP3. Therefore, from t1 to t3a, the left arm 16L operates at a lower speed than from t1 to t3 shown in FIG. 5(B). That is, the left arm 16L operates at a speed lower than the maximum speed in the period from t1 to t3a. As a result, it takes a long time to complete all operations, resulting in a decrease in efficiency.

図8は、右アーム16Rおよび左アーム16Lの逐次実行の一例を示すフロー図である。 FIG. 8 is a flow diagram showing an example of sequential execution of the right arm 16R and the left arm 16L.

図8に示すように、右アーム16Rおよび左アーム16Lは、教示点毎に、動作開始および動作終了のタイミングを同期させるように逐次動作する。 As shown in FIG. 8, the right arm 16R and the left arm 16L operate sequentially for each teaching point so as to synchronize the timing of the start and end of the operation.

これに対して、第1実施形態では、図6に示すように、腰軸の角度が略一致する場合に、複数のアームを同期させることなく並列動作させる。これにより、待機時間を低減させ、また、アームの低速動作を抑制することにより、作業効率を向上させることができる。 In contrast, in the first embodiment, as shown in FIG. 6, when the angles of the hip axes substantially match, the plurality of arms are operated in parallel without synchronization. This reduces standby time and suppresses low-speed movement of the arm, thereby improving work efficiency.

尚、アームの数は、2つに限られず、3つ以上設けられてもよい。この場合、例えば、第1アームを複数のアームとし、または、第2アームを複数のアームとすればよい。 Note that the number of arms is not limited to two, and three or more arms may be provided. In this case, for example, the first arm may be a plurality of arms, or the second arm may be a plurality of arms.

また、腰軸は、旋回軸および傾動軸に限られず、胴体14を腰部12に対して並行移動させる軸であってもよい。 Further, the waist axis is not limited to the pivot axis and the tilt axis, but may be an axis that moves the body 14 in parallel with the waist 12.

本実施形態によるロボットシステム1の少なくとも一部は、ハードウェアで構成してもよいし、ソフトウェアで構成してもよい。ソフトウェアで構成する場合には、ロボットシステム1の少なくとも一部の機能を実現するプログラムをフレキシブルディスクやCD-ROM等の記録媒体に収納し、コンピュータに読み込ませて実行させてもよい。記録媒体は、磁気ディスクや光ディスク等の着脱可能なものに限定されず、ハードディスク装置やメモリなどの固定型の記録媒体でもよい。また、ロボットシステム1の少なくとも一部の機能を実現するプログラムを、インターネット等の通信回線(無線通信も含む)を介して頒布してもよい。さらに、同プログラムを暗号化したり、変調をかけたり、圧縮した状態で、インターネット等の有線回線や無線回線を介して、あるいは記録媒体に収納して頒布してもよい。 At least a portion of the robot system 1 according to this embodiment may be configured with hardware or software. When configured with software, a program for realizing at least part of the functions of the robot system 1 may be stored in a recording medium such as a flexible disk or a CD-ROM, and may be read and executed by a computer. The recording medium is not limited to a removable one such as a magnetic disk or an optical disk, but may be a fixed recording medium such as a hard disk device or memory. Furthermore, a program that implements at least some of the functions of the robot system 1 may be distributed via a communication line (including wireless communication) such as the Internet. Furthermore, the program may be distributed in an encrypted, modulated, or compressed state via a wired or wireless line such as the Internet, or stored in a recording medium.

本発明のいくつかの実施形態を説明したが、これらの実施形態は、例として提示したものであり、発明の範囲を限定することは意図していない。これら実施形態は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で、種々の省略、置き換え、変更を行うことができる。これら実施形態やその変形は、発明の範囲や要旨に含まれると同様に、特許請求の範囲に記載された発明とその均等の範囲に含まれるものである。 Although several embodiments of the invention have been described, these embodiments are presented by way of example and are not intended to limit the scope of the invention. These embodiments can be implemented in various other forms, and various omissions, substitutions, and changes can be made without departing from the gist of the invention. These embodiments and their modifications are included within the scope and gist of the invention as well as within the scope of the invention described in the claims and its equivalents.

1 ロボットシステム、10 ロボット、12 腰部、14 胴体、16R 右アーム、16L 左アーム、71 記憶部、72 制御部、JB1 旋回軸、JB2 傾動軸、RP0~RP3 教示点、LP0~LP4 教示点 1 robot system, 10 robot, 12 waist, 14 torso, 16R right arm, 16L left arm, 71 memory section, 72 control section, JB1 rotation axis, JB2 tilting axis, RP0 to RP3 teaching points, LP0 to LP4 teaching points

Claims (8)

複数のアームと、該複数のアームと接続するように設けられるアーム接続部を支持し、前記アーム接続部を可動とする軸を含む支持部と、を有するロボットと、
前記ロボットの動作を制御するプログラムに含まれる、第1アームの動作における前記軸の角度である第1角度と、前記プログラムに含まれる、第2アームの動作における前記軸の角度である第2角度と、が略一致するか否かに基づいて、前記第1アームと前記第2アームとを互いに独立して動作させる制御部と、を備える、ロボットシステム。
A robot having a plurality of arms and a support part including a shaft that supports an arm connection part provided to connect with the plurality of arms and makes the arm connection part movable;
A first angle, which is the angle of the axis in the movement of the first arm, included in a program for controlling the movement of the robot, and a second angle, which is the angle of the axis in the movement of the second arm, included in the program. A robot system, comprising: a control unit that operates the first arm and the second arm independently of each other based on whether or not substantially coincide with each other.
前記制御部は、前記第1角度と前記第2角度とが略一致するか否かに基づいて、教示点間における前記第1アームの動作中に、教示点における動作の開始および終了の少なくとも一方を前記第2アームにさせる、請求項1に記載のロボットシステム。 The control unit controls at least one of the start and end of the operation at the teaching point during the operation of the first arm between the teaching points, based on whether the first angle and the second angle substantially match. The robot system according to claim 1 , wherein the second arm is configured to make the second arm. 前記制御部は、
前記第1角度と前記第2角度とが略一致する場合、前記第1アームと前記第2アームとを互いに独立して動作させ、
前記第1角度と前記第2角度とが一致しない場合、前記第1アームおよび前記第2アームの動作を停止させる、請求項1または請求項2に記載のロボットシステム。
The control unit includes:
When the first angle and the second angle substantially match, the first arm and the second arm are operated independently of each other;
The robot system according to claim 1 or 2, wherein the robot system stops the operations of the first arm and the second arm when the first angle and the second angle do not match.
前記制御部は、前記第1アームの連続する複数の教示点を含む第1経路における前記第1角度と、前記第2アームの連続する複数の教示点を含む第2経路における前記第2角度と、が略一致するか否かに基づいて、前記第1アームと前記第2アームとを互いに独立して動作させる、請求項1から請求項3のいずれか一項に記載のロボットシステム。 The control unit is configured to set the first angle in a first path including a plurality of consecutive teaching points of the first arm, and the second angle in a second path including a plurality of consecutive teaching points of the second arm. The robot system according to any one of claims 1 to 3, wherein the first arm and the second arm are operated independently of each other based on whether or not substantially coincide with each other. 前記制御部は、前記第1経路および前記第2経路に含まれる教示点毎の前記軸の全ての角度が略一致するか否かに基づいて、前記第1アームと前記第2アームとを互いに独立して動作させる、請求項4に記載のロボットシステム。 The control unit moves the first arm and the second arm relative to each other based on whether all angles of the axes for each teaching point included in the first path and the second path substantially match. 5. The robot system of claim 4, which operates independently. 前記制御部は、前記軸の複数の角度の差が所定値以下である場合、前記軸の複数の角度が略一致すると判定する、請求項1から請求項5のいずれか一項に記載のロボットシステム。 The robot according to any one of claims 1 to 5, wherein the control unit determines that the plurality of angles of the axes substantially match when a difference between the plurality of angles of the axes is less than or equal to a predetermined value. system. 前記ロボットは、前記軸の角度を検出するセンサをさらに有し、
前記制御部は、前記第1アームの教示点毎に、前記センサの検出結果を前記プログラムに含まれる前記第1角度とし、前記第2アームの教示点毎に、前記センサの検出結果を前記プログラムに含まれる前記第2角度とする、請求項1から請求項6のいずれか一項に記載のロボットシステム。
The robot further includes a sensor that detects the angle of the axis,
The control unit sets the detection result of the sensor to the first angle included in the program for each teaching point of the first arm, and sets the detection result of the sensor to the first angle included in the program for each teaching point of the second arm. The robot system according to any one of claims 1 to 6, wherein the second angle is included in the second angle.
前記軸は、前記アーム接続部を旋回および傾動の少なくとも一方をさせる、請求項1から請求項7のいずれか一項に記載のロボットシステム。 The robot system according to any one of claims 1 to 7, wherein the axis allows the arm connection portion to at least one of pivot and tilt.
JP2020097837A 2020-06-04 2020-06-04 robot system Active JP7446925B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2020097837A JP7446925B2 (en) 2020-06-04 2020-06-04 robot system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020097837A JP7446925B2 (en) 2020-06-04 2020-06-04 robot system

Publications (2)

Publication Number Publication Date
JP2021186955A JP2021186955A (en) 2021-12-13
JP7446925B2 true JP7446925B2 (en) 2024-03-11

Family

ID=78850589

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020097837A Active JP7446925B2 (en) 2020-06-04 2020-06-04 robot system

Country Status (1)

Country Link
JP (1) JP7446925B2 (en)

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003266252A (en) 2002-03-19 2003-09-24 Ricoh Co Ltd Automatic assembly and disassembly equipment

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5915041B2 (en) * 2011-09-12 2016-05-11 セイコーエプソン株式会社 Robot controller
JP5549716B2 (en) * 2012-08-31 2014-07-16 株式会社安川電機 Robot system and teaching method

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003266252A (en) 2002-03-19 2003-09-24 Ricoh Co Ltd Automatic assembly and disassembly equipment

Also Published As

Publication number Publication date
JP2021186955A (en) 2021-12-13

Similar Documents

Publication Publication Date Title
JP6268819B2 (en) Trajectory generation method for multi-axis robot
JP5458769B2 (en) Robot control device
JP5701055B2 (en) 7-axis articulated robot control method, control program, and robot controller
JP2006187803A5 (en)
JP6582491B2 (en) robot
JP7028151B2 (en) Orbit generator
WO2019220827A1 (en) Vertical multi-joint welding robot
KR102219543B1 (en) Articulated robot and articulated robot system
JP2005309990A (en) Route setting method
WO2019163997A1 (en) Working device using parallel link mechanism and control method thereof
JP7446925B2 (en) robot system
WO2020161910A1 (en) Control device, control method, and recording medium
JP7396829B2 (en) Device, robot control device, robot system, and method for setting robot coordinate system
JP2010110878A (en) Articulated robot device and method for controlling the same
JP4613539B2 (en) Robot motion planning method
CN108475051B (en) Method and system for aligning a tool during programming of an industrial robot
JP2007000954A (en) Robot teaching device and method
JP2009050949A (en) Method and apparatus for teaching track of robot arm
WO1992018293A1 (en) Articulated manipulator having seven degrees of freedom of motion
JPH06190750A (en) Robot control device
JP3199059B2 (en) Robot apparatus and attitude control method thereof
JP2025115762A (en) ROBOT SYSTEM, ROBOT CONTROL METHOD, AND ROBOT CONTROL PROGRAM
JP2000326280A (en) Interference check method in scalar type robot
JPS6057408A (en) Robot trajectory control device
JP7311971B2 (en) ROBOT CONTROL DEVICE AND ROBOT CONTROL METHOD

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20230419

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20240118

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: 20240130

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20240228

R150 Certificate of patent or registration of utility model

Ref document number: 7446925

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150