JP5754138B2 - Robot system and robot - Google Patents
Robot system and robot Download PDFInfo
- Publication number
- JP5754138B2 JP5754138B2 JP2011000978A JP2011000978A JP5754138B2 JP 5754138 B2 JP5754138 B2 JP 5754138B2 JP 2011000978 A JP2011000978 A JP 2011000978A JP 2011000978 A JP2011000978 A JP 2011000978A JP 5754138 B2 JP5754138 B2 JP 5754138B2
- Authority
- JP
- Japan
- Prior art keywords
- data
- vector
- interference
- robot
- robot arm
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Manipulator (AREA)
Description
本発明は、ロボットシステム及びロボットに関する。
The present invention relates to a robot system and a robot .
ロボットを予め決められた動作条件で逐次動作させるときに、ロボットの動作範囲内に存在するベルトコンベアに代表される搬送装置や、別に設置されるロボットとの干渉の有無を確認する。そして、干渉する場合にはロボット動作の停止や、干渉が発生しないロボット動作へと修正する。
従来、例えば、特許文献１及び特許文献２に記載されているように、ロボットと搬送装置のレイアウトをコンピューター上で仮想配置した上で、ロボット動作をコンピューター上で模擬し、ロボットと搬送装置及び他のロボットとが干渉するかどうかを確認するロボットの干渉チェック方法が知られていた。
When the robot is sequentially operated under a predetermined operation condition, it is checked whether there is interference with a transfer device represented by a belt conveyor existing within the operation range of the robot or a robot installed separately. When the interference occurs, the robot operation is stopped or corrected to a robot operation that does not cause interference.
Conventionally, as described in
特許文献１では、干渉の有無を確認する対象ペアを選択し、一方の物体を線分と円弧の組み合わせからなる二次元形状で表現される一般形状柱で近似する。次に他方の物体を単一の直方体または複数の直方体の集合で近似する。続いて、それぞれ近似した物体同士で干渉の有無を確認している。
In
特許文献２では、ロボット及び搬送装置等の周辺機器のレイアウトを設定している。そして、総てのロボット動作に関して、ロボット動作時にロボットが存在する領域の集合和を計算する。そして、その集合和領域に関して、周辺物体と干渉するかどうか、あるいは規定の動作領域に対してはみ出しているかどうかを確認する。
In
しかしながら、特許文献１記載のロボットの干渉チェック方法ではロボット動作で干渉する可能性の有る対象を取り囲む領域である一般形状柱の線分と円弧の組み合わせからなる二次元形状は複雑となる。従って、その領域を表現するためのデータ容量が大きくなり、検証の有無を算出する計算処理量が大きくなる。その結果、干渉計算の計算に時間がかかる。
However, in the robot interference check method described in
特許文献２記載のロボットの干渉領域確認装置においても、ロボットの動作が多くなればなるほど、ロボット動作範囲が大きくなればなるほど、ロボットが存在する領域の集合和も広範な領域となる。従って、広域にわたる干渉計算を行う必要があり、干渉計算の計算に時間がかかる。そこで、干渉計算の計算を簡単に行える干渉チェック方法が望まれていた。
Also in the robot interference area confirmation device described in
加えて、特許文献１記載のロボットの干渉チェック方法及び特許文献２記載のロボットの干渉領域確認装置においては、搬送装置や別に設置されるロボットの動作速度が十分に考慮されていない。従って、時刻に関して離散的に計算される干渉計算において干渉しないとされた動作が実際のロボット動作では干渉するケースが発生する課題が存在する。そこで、移動速度を考慮した干渉チェック方法が望まれていた。
In addition, in the robot interference check method described in
本発明は、上述の課題の少なくとも一部を解決するためになされたものであり、以下の形態または適用例として実現することが可能である。 SUMMARY An advantage of some aspects of the invention is to solve at least a part of the problems described above, and the invention can be implemented as the following forms or application examples.
［適用例１］本適用例にかかる干渉チェック方法は、少なくとも１方向への動作が可能なロボットと、少なくとも１方向に動作するワーク搬送装置との干渉をチェックするための干渉チェック方法であって、前記ロボットの移動方向と速さとを定めたベクトルデータである第１ベクトルデータを取得する工程と、前記ワーク搬送装置の移動方向と速さとを定めるベクトルデータである第２ベクトルデータを取得する工程と、前記第１ベクトルデータと前記第２ベクトルデータとを合成した合成ベクトルを演算する工程と、前記合成ベクトル及び所定のデータテーブルを参照して前記合成ベクトルの大きさと対応する広さの干渉領域を演算する工程と、前記干渉領域から前記ロボットと前記ワーク搬送装置との干渉の有無を確認する工程と、を含むことを特徴とする。 Application Example 1 An interference check method according to this application example is an interference check method for checking interference between a robot capable of moving in at least one direction and a workpiece transfer apparatus operating in at least one direction. Obtaining first vector data which is vector data defining the moving direction and speed of the robot; and obtaining second vector data being vector data defining the moving direction and speed of the work transfer device. A step of calculating a combined vector obtained by combining the first vector data and the second vector data, and an interference area having a width corresponding to the size of the combined vector with reference to the combined vector and a predetermined data table And a step of confirming the presence or absence of interference between the robot and the workpiece transfer device from the interference area. And wherein the Mukoto.
本適用例によれば、ロボットの移動方向と速さとを定めたベクトルデータである第１ベクトルデータと、ワーク搬送装置の移動方向と速さとを定める第２ベクトルデータとから合成ベクトルが演算される。そして、合成ベクトルに従って、定められたデータテーブルを参照して干渉領域を演算している。ワーク搬送装置及びロボットの移動方向と速さの双方が含まれる合成ベクトル方向は相対的に移動する方向を示している。この方向は、干渉の可能性がある方向である。そして、合成ベクトルの大きさは速さと相関を有する為、合成ベクトルは相対移動速度と対応した干渉領域を算出できる。これにより、相対移動速度と対応する合成ベクトルの大きさの分だけ干渉領域に広がりを持たせて算出することができる。従って、干渉計算が離散的に計算されるときにおいても干渉を防止可能な演算を行うことができる。 According to this application example, a combined vector is calculated from first vector data that is vector data that defines the moving direction and speed of the robot and second vector data that defines the moving direction and speed of the work transfer device. . Then, according to the combined vector, the interference area is calculated with reference to the determined data table. The combined vector direction including both the moving direction and the speed of the work transfer device and the robot indicates a relative moving direction. This direction is a direction in which there is a possibility of interference. Since the magnitude of the combined vector has a correlation with the speed, the combined vector can calculate an interference area corresponding to the relative moving speed. As a result, it is possible to perform the calculation by expanding the interference area by the size of the combined vector corresponding to the relative movement speed. Therefore, even when the interference calculation is calculated discretely, an operation capable of preventing interference can be performed.
さらに、ロボットが移動する場所とワーク搬送装置が移動する場所とから干渉領域を算出する方法がある。この方法に比べて、合成ベクトルを用いて干渉領域を算出する方が、干渉計算の計算を簡単に行うことができる。 Furthermore, there is a method for calculating the interference area from the place where the robot moves and the place where the work transfer device moves. Compared with this method, the calculation of interference can be performed more easily by calculating the interference region using the combined vector.
［適用例２］上記適用例に記載の干渉チェック方法において、前記合成ベクトルを演算する工程は、前記第１ベクトルデータと前記第２ベクトルデータとのどちらか一方が基準ベクトルである前記合成ベクトルを演算することが好ましい。 Application Example 2 In the interference check method according to the application example described above, in the step of calculating the composite vector, the composite vector in which one of the first vector data and the second vector data is a reference vector is used. It is preferable to calculate.
本適用例によれば、第１ベクトルデータと第２ベクトルデータとのどちらか一方を基準ベクトルとしている。合成ベクトルに応じた干渉領域を演算するときロボットを基準とする干渉領域とワーク搬送装置を基準とする干渉領域との二通りの干渉領域を算出できる。そして、ロボットを基準とする干渉領域の広がりとワーク搬送装置を基準とする干渉領域の広がりのいずれかを選択できる。従って、より計算時間が短い方を基準として干渉計算を実行することにより、計算時間を短くすることができる。 According to this application example, one of the first vector data and the second vector data is used as the reference vector. When calculating the interference area according to the combined vector, two kinds of interference areas, that is, the interference area based on the robot and the interference area based on the workpiece transfer device can be calculated. Then, it is possible to select one of the extension of the interference area based on the robot and the extension of the interference area based on the workpiece transfer device. Therefore, the calculation time can be shortened by executing the interference calculation based on the shorter calculation time.
［適用例３］上記適用例に記載の干渉チェック方法において、前記合成ベクトルを演算する工程は、前記ロボットの形状と前記ワーク搬送装置の形状とに応じて、前記第１ベクトルデータと前記第２ベクトルデータとのどちらを基準ベクトルとするかを決定することが望ましい。 Application Example 3 In the interference check method according to the application example described above, the step of calculating the combined vector may include the first vector data and the second vector according to the shape of the robot and the shape of the workpiece transfer device. It is desirable to determine which of the vector data is the reference vector.
本適用例によれば、第１ベクトルデータと第２ベクトルデータとのどちらか一方を基準ベクトルとして定めている。このときに、ロボット及びワーク搬送装置の形状に応じてどちらか一方を選択している。例えば複雑な形状である場合、形状に関するデータ数が多くなる。従って、複雑な形状が移動する領域を演算する方が単純な形状が移動するときに比べて演算時間がかかる。合成ベクトルの大きさの分だけ広がりを持つ干渉領域を演算するときに、ロボットを基準に干渉領域を演算する場合と、ワーク搬送装置を基準に干渉領域を演算する場合とで、より演算量が少なくなる方を選択することが可能である。従って、干渉領域の計算時間を短くすることができる。 According to this application example, one of the first vector data and the second vector data is defined as the reference vector. At this time, either one is selected according to the shapes of the robot and the workpiece transfer device. For example, in the case of a complicated shape, the number of data regarding the shape increases. Therefore, it takes more time to calculate the region where the complex shape moves than when the simple shape moves. When calculating an interference area having a spread corresponding to the size of the combined vector, the amount of calculation is greater when calculating the interference area based on the robot and when calculating the interference area based on the work transfer device. It is possible to select the lesser one. Therefore, the calculation time of the interference area can be shortened.
［適用例４］上記適用例に記載の干渉チェック方法において、前記ロボットの回転方向と回転速さとを定めたベクトルデータである第３ベクトルデータを取得する工程と、前記ワーク搬送装置の回転方向と回転速さとを定めるベクトルデータである第４ベクトルデータを取得する工程と、前記第３ベクトルデータと前記第４ベクトルデータとを合成した回転合成ベクトルを演算する工程と、前記合成ベクトル及び前記回転合成ベクトル及び所定のデータテーブルを参照して前記合成ベクトルの大きさと対応する広さの干渉領域を演算する工程と、を含むことを特徴とする。 Application Example 4 In the interference checking method according to the application example described above, a step of obtaining third vector data, which is vector data defining a rotation direction and a rotation speed of the robot, and a rotation direction of the work transfer device, A step of obtaining fourth vector data which is vector data for determining a rotation speed; a step of calculating a rotation synthesized vector obtained by synthesizing the third vector data and the fourth vector data; and the synthesized vector and the rotation synthesis. Calculating an interference area having a size corresponding to the size of the combined vector with reference to the vector and a predetermined data table.
本適用例によれば、ロボットの移動方向と速さ及びワーク搬送装置の移動方向と速さのみならず、ロボットの回転方向と回転速さ及びワーク搬送装置の回転方向と回転速さが含まれる回転合成ベクトル方向にのみ回転合成ベクトルの大きさと対応する広さを持つ干渉領域を算出できる。これにより、計算時間を抑制しながら適切な干渉計算を実行することができる。さらに、ワーク搬送装置の回転方向と回転速さ及びロボットの回転方向と回転速さに関して離散的に計算するときにもロボット動作で干渉することを防止できる。 According to this application example, not only the moving direction and speed of the robot and the moving direction and speed of the workpiece transfer apparatus, but also the rotation direction and rotation speed of the robot and the rotating direction and rotation speed of the workpiece transfer apparatus are included. It is possible to calculate an interference region having a width corresponding to the magnitude of the rotation synthesized vector only in the direction of the rotation synthesized vector. Thereby, it is possible to execute an appropriate interference calculation while suppressing the calculation time. Furthermore, it is possible to prevent the robot operation from interfering when discretely calculating the rotation direction and rotation speed of the workpiece transfer device and the rotation direction and rotation speed of the robot.
［適用例５］上記適用例に記載の干渉チェック方法において、前記回転合成ベクトルを演算する工程は、前記第３ベクトルデータと前記第４ベクトルデータとのどちらか一方が回転基準ベクトルである前記回転合成ベクトルを演算することを特徴とする。 Application Example 5 In the interference checking method according to the application example described above, the step of calculating the rotation combined vector includes the rotation in which one of the third vector data and the fourth vector data is a rotation reference vector. A composite vector is calculated.
本適用例によれば、第３ベクトルデータと第４ベクトルデータとのどちらか一方を基準ベクトルとしている。合成ベクトルに応じた干渉領域を演算するとき、ロボットを基準とする干渉領域とワーク搬送装置を基準とする干渉領域との二通りを算出できる。そして、ロボットを基準とする干渉領域の広がりとワーク搬送装置を基準とする干渉領域の広がりのいずれかを選択できる。従って、より計算時間が短い方を基準として干渉計算を実行することにより、計算時間を短くすることができる。 According to this application example, one of the third vector data and the fourth vector data is used as the reference vector. When calculating the interference area according to the combined vector, two types of the interference area based on the robot and the interference area based on the workpiece transfer device can be calculated. Then, it is possible to select one of the extension of the interference area based on the robot and the extension of the interference area based on the workpiece transfer device. Therefore, the calculation time can be shortened by executing the interference calculation based on the shorter calculation time.
［適用例６］上記適用例に記載の干渉チェック方法において、前記回転合成ベクトルを演算する工程は、前記ロボットの形状と前記ワーク搬送装置の形状とに応じて、前記第３ベクトルデータと前記第４ベクトルデータとのどちらを回転基準ベクトルとするかを決定することを特徴とする。 Application Example 6 In the interference checking method according to the application example described above, the step of calculating the rotation combined vector may include the third vector data and the third vector data according to the shape of the robot and the shape of the workpiece transfer device. It is characterized in that which of the four vector data is used as the rotation reference vector is determined.
本適用例によれば、第３ベクトルデータと第４ベクトルデータとのどちらか一方を基準ベクトルとして定めている。このときに、ロボット及びワーク搬送装置の形状に応じてどちらか一方を選択している。例えば複雑な形状である場合、形状に関するデータ数が多くなる。従って、複雑な形状が移動する領域を演算する方が単純な形状が移動する領域を演算するときに比べて演算時間がかかる。合成ベクトルの大きさの分だけ広がりを持つ干渉領域を演算するときに、ロボットを基準に干渉領域を演算する場合と、ワーク搬送装置を基準に干渉領域を演算する場合とで、より演算量が少なくなる場合を選択することが可能である。従って、より計算時間が短い方を基準として干渉計算を実行することにより、計算時間を短くすることができる。 According to this application example, one of the third vector data and the fourth vector data is defined as the reference vector. At this time, either one is selected according to the shapes of the robot and the workpiece transfer device. For example, in the case of a complicated shape, the number of data regarding the shape increases. Therefore, it takes more time to calculate a region where a complex shape moves than when calculating a region where a simple shape moves. When calculating an interference area having a spread corresponding to the size of the combined vector, the amount of calculation is greater when calculating the interference area based on the robot and when calculating the interference area based on the work transfer device. It is possible to select a case where there are fewer. Therefore, the calculation time can be shortened by executing the interference calculation based on the shorter calculation time.
［適用例７］本適用例にかかる干渉チェック方法は、少なくとも１方向への動作が可能な第１ロボットと、少なくとも１方向に動作が可能な第２ロボットとの干渉をチェックするための干渉チェック方法であって、前記第１ロボットの移動方向と速さとを定めるベクトルデータである第１ベクトルデータを取得する工程と、前記第２ロボットの移動方向と速さとを定めたベクトルデータである第２ベクトルデータを取得する工程と、前記第１ベクトルデータと前記第２ベクトルデータとを合成した合成ベクトルを演算する工程と、前記合成ベクトル及び所定のデータテーブルを参照して前記合成ベクトルの大きさと対応する広さの干渉領域を演算する工程と、前記干渉領域から、前記第１ロボットと前記第２ロボットとの干渉の有無を確認する工程と、を含むことを特徴とする。 Application Example 7 The interference check method according to this application example is an interference check for checking interference between a first robot capable of moving in at least one direction and a second robot operable in at least one direction. A method of obtaining first vector data, which is vector data for determining the moving direction and speed of the first robot, and second vector data for determining the moving direction and speed of the second robot. A step of obtaining vector data, a step of calculating a combined vector obtained by combining the first vector data and the second vector data, and the size of the combined vector with reference to the combined vector and a predetermined data table A step of calculating an interference area having a width to be confirmed, and whether or not there is interference between the first robot and the second robot is confirmed from the interference area. Characterized in that it comprises a step.
本適用例によれば、第１ロボットの移動方向と速さとを定めるベクトルデータである第１ベクトルデータを取得している。さらに、第２ロボットの移動方向と速さとを定めたベクトルデータである第２ベクトルデータを取得している。そして、第１ベクトルデータと第２ベクトルデータとから合成ベクトルを演算している。従って、定められたデータテーブルを参照して干渉領域を演算することで、第１ロボット及び第２ロボットの移動方向と速さの双方が含まれる合成ベクトル方向にのみ合成ベクトルの大きさと対応する広さを持つ干渉領域を算出できる。これにより、相対移動速度と対応する合成ベクトルの大きさの分だけ干渉領域に広がりを持たせて算出することができる。従って、干渉計算が離散的に計算されるときにおいても干渉を防止可能な演算を行うことができる。 According to this application example, the first vector data, which is vector data for determining the moving direction and speed of the first robot, is acquired. Furthermore, second vector data, which is vector data defining the moving direction and speed of the second robot, is acquired. Then, a composite vector is calculated from the first vector data and the second vector data. Therefore, by calculating the interference area with reference to the determined data table, a wide range corresponding to the size of the combined vector only in the combined vector direction including both the moving direction and speed of the first robot and the second robot. It is possible to calculate an interference region having a certain length. As a result, it is possible to perform the calculation by expanding the interference area by the size of the combined vector corresponding to the relative movement speed. Therefore, even when the interference calculation is calculated discretely, an operation capable of preventing interference can be performed.
さらに、第１ロボットが移動する場所と第２ロボットが移動する場所とから干渉領域を算出する方法がある。この方法に比べて、合成ベクトルを用いて干渉領域が算出する方が、干渉計算の計算を簡単に行うことができる。 Further, there is a method for calculating an interference area from a place where the first robot moves and a place where the second robot moves. Compared to this method, the calculation of interference can be performed more easily when the interference region is calculated using the combined vector.
［適用例８］本適用例にかかるロボット制御装置は、上記適用例に記載の干渉チェック方法の内容と順番を規定したプログラムを記憶したことを特徴とする。 Application Example 8 The robot control apparatus according to this application example stores a program that defines the content and order of the interference check method described in the application example.
本適用例によれば、ロボット及びワーク搬送装置の移動方向と速さの双方が含まれる合成ベクトル方向にのみ合成ベクトルの大きさの分だけ広がりを持つ干渉領域を算出している。そして、計算時間を抑制しながら適切な干渉計算を実行している。これにより、実際のロボット動作に先立って干渉領域を確認しこの干渉領域に応じたロボットの制御を行うことができる。これによって、ワーク搬送装置とロボットとの干渉を回避するロボット制御が可能になる。または、ロボット同士の干渉を回避するロボット制御が可能になる。従って、ワーク搬送の状態に左右されることの無い連続可動が可能なロボット制御を実現できる。または、複数のロボットの状態に左右されることの無い連続可動が可能なロボット制御を実現できる。 According to this application example, an interference region having a spread corresponding to the size of the combined vector is calculated only in the combined vector direction including both the moving direction and the speed of the robot and the work transfer device. And the appropriate interference calculation is performed, suppressing calculation time. Accordingly, it is possible to confirm the interference area prior to the actual robot operation and to control the robot according to the interference area. This enables robot control that avoids interference between the workpiece transfer device and the robot. Or robot control which avoids interference between robots is attained. Accordingly, it is possible to realize robot control capable of continuous movement without being influenced by the state of workpiece conveyance. Alternatively, it is possible to realize robot control capable of continuous movement without being influenced by the states of a plurality of robots.
以下、本発明を具体化した実施形態について、図面を参照して説明する。尚、以下の各図においては、各構成要素を認識可能な程度の大きさにするため、各構成要素の尺度を実際とは異ならせしめている。 DESCRIPTION OF EXEMPLARY EMBODIMENTS Embodiments of the invention will be described below with reference to the drawings. In the following drawings, the scale of each component is made different from the actual scale in order to make each component recognizable.
（実施形態１）
本実施形態では、ロボットアームとロボットアームが行う特徴的な干渉チェック方法とその例について、図１〜図２０に従って説明する。
(Embodiment 1)
In the present embodiment, a robot arm, a characteristic interference check method performed by the robot arm, and an example thereof will be described with reference to FIGS.
（ロボット）
図１は、ロボットの構成を示す模式正面図である。まず、ロボットと部品給材装置の構成について説明する。図１に示すように、ロボットとしてのロボットアーム１００は台座部１１０を備えている。台座部１１０上に第１リンク１２０、第２リンク１２１、第３リンク１２２、第４リンク１２３、第５リンク１２４、第６リンク１２５がこの順に接続して設置されている。そして、各リンクの間には第１ジョイント１３０、第２ジョイント１３１、第３ジョイント１３２、第４ジョイント１３３、第５ジョイント１３４、第６ジョイント１３５が配置されている。そして、ロボットアーム１００の先端にはロボットハンド１４０が設置されている。これにより、ロボットアーム１００は少なくとも１方向への動作可能なロボットとして動作する。そして、ロボットアーム１００は第１ジョイント１３０から第６ジョイント１３５の６軸のジョイントを有する６軸ロボットアームとなっている。
(robot)
FIG. 1 is a schematic front view showing the configuration of the robot. First, the configuration of the robot and the component supply device will be described. As shown in FIG. 1, a
台座部１１０は、ロボットアーム１００を設置するための架台である。第１リンク１２０から第６リンク１２５の隣り合うリンクは、それぞれ第１ジョイント１３０から第６ジョイント１３５を介して接続されている。第１リンク１２０から第６リンク１２５の各リンクにはモーターが内蔵されている。そのモーターを所定の角度に回転させることで、第１ジョイント１３０から第６ジョイント１３５が回転する。これにより、第１リンク１２０から第６リンク１２５は姿勢が変動する。これを適宜実行して、ロボットアーム１００は所望の姿勢を実現する。そして、ロボットハンド１４０はチャック部１４１，１４２を開閉させることで、部品の把持や解放を実現する。
The
ロボットアーム１００は、第１リンク１２０から第６リンク１２５の各リンクが並行して動作しロボットハンド１４０を直線に沿って移動させる並進動作が可能となっている。ロボットアーム１００が設置されている作業空間で直交座標系の基底方向が設定されている場合には、その各方向を例えばＸ軸方向、Ｙ軸方向、Ｚ軸方向とした上で、ロボットアーム１００の並進動作の方向をＸ軸方向、Ｙ軸方向、Ｚ軸方向の３成分に分解したうえでそれぞれの方向の並進動作の和としても良い。
The
ワーク搬送装置としての部品給材装置２００は、ワークとしての供給部品２１０，２１１，２１２、台座部２２０、コンベアベルト２３０、駆動部２４０，２４１等から構成されている。台座部２２０は、部品給材装置２００を設置するための架台である。台座部２２０上にはコンベアベルト２３０が設置され、コンベアベルト２３０の両端には駆動部２４０と駆動部２４１とが配置されている。駆動部２４０と２４１とはモーターや減速装置等の回転機構を備えている。駆動部２４０と２４１とが動作することで、コンベアベルト２３０が１方向に移動する。従って、部品給材装置２００は少なくとも１方向に動作するワーク搬送装置となっている。
A
供給部品２１０，２１１，２１２は部品給材装置２００によって所望の位置に搬送される。その後、供給部品２１０，２１１，２１２はロボットハンド１４０によって把持される。
The
コンベアベルト２３０の動作は並進動作である。従って、供給部品２１０，２１１，２１２はコンベアベルト２３０の動きに伴い直線に沿って移動する。部品給材装置２００が設置されている作業空間で直交座標系の基底方向が設定されている場合には、その各方向を例えばＸ軸方向、Ｙ軸方向、Ｚ軸方向とした上で、コンベアベルト２３０の並進動作の方向をＸ軸方向、Ｙ軸方向、Ｚ軸方向の３成分のベクトル和としても良い。
The operation of the
ロボットアーム１００の近くにはロボットアーム１００を制御するロボット制御部３００が設置されている。そして、部品給材装置２００の図中上側にはコンベアベルト２３０とロボットハンド１４０の移動範囲とを撮影するカメラ装置３５０が設置されている。
A
図２は、ロボット制御部の構成を示すブロック図である。図２に示すように、ロボットアーム１００を制御するためのロボット制御部３００は、ＣＰＵ３１０（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）、主記憶装置３２０、補助記憶装置３３０、ロボット制御装置３４０、データバス３６０等から構成されている。データバス３６０はロボット制御部３００が内臓する各装置、カメラ装置３５０、ロボットアーム１００を接続する。
FIG. 2 is a block diagram illustrating a configuration of the robot control unit. As shown in FIG. 2, the
補助記憶装置３３０は、ロボットアーム１００の動作命令群を保持する装置である。そして、補助記憶装置３３０は、ロボットアーム１００の動作命令群を主記憶装置３２０に出力する。カメラ装置３５０は、作業領域の様子を撮影した画像情報を生成し主記憶装置３２０に出力する。主記憶装置３２０は、補助記憶装置３３０に保持されているロボットアーム１００の動作命令を入力し、ＣＰＵ３１０が行う処理の一時記憶場所を有する。他にも、主記憶装置３２０は、カメラ装置３５０が撮影する画像情報を入力する機能を有する。ロボット制御装置３４０は、ＣＰＵ３１０が生成するロボットアーム１００の動作指示情報を入力する。そして、動作指示情報に応じて第１ジョイント１３０から第６ジョイント１３５を稼動させて、ロボットアーム１００を駆動する。
The
ＣＰＵ３１０は、主記憶装置３２０からロボットアーム１００の動作命令を取得する。そして、ＣＰＵ３１０はカメラ装置３５０が撮影した画像情報を画像処理し、ロボットアーム１００や部品給材装置２００を検出する。次に、ＣＰＵ３１０は現在のロボットアーム１００の位置情報や姿勢情報、部品給材装置２００の位置情報を生成する。そして、ＣＰＵ３１０は各位置情報や姿勢情報は主記憶装置３２０に転送する。さらにＣＰＵ３１０は、ロボットアーム１００の現在の位置情報や姿勢情報、部品給材装置２００の位置情報等から、ロボットアーム１００と部品給材装置２００との干渉の有無を計算する。そして、干渉の有無に応じたロボットアーム１００の動作指示情報を生成し、ロボット制御装置３４０に転送する。
The
図３は、ロボット制御部が実現する機能を示す機能ブロック図である。次に、ロボット制御部３００が備える機能ブロックについて説明する。図３に示すように、ロボットの定められたデータテーブルとしてのロボットアーム形状データ４００が補助記憶装置３３０に保持されている。ロボットアーム形状データ４００はロボットアーム１００の形状を表すデータであり、ロボットアーム形状データ４００にはロボットアーム１００を構成する台座部、ロボットリンク、ロボットジョイント、ロボットハンド等の形状寸法が含まれている。
FIG. 3 is a functional block diagram illustrating functions realized by the robot control unit. Next, functional blocks provided in the
ロボットアーム形状データ４００はロボットアーム１００の構成要素の形状寸法等を表すデータである。ロボットアーム１００の構成要素の形状寸法を表すデータとしては、例えば、ロボットアームの設計データから生成された三角形ポリゴンデータを用いることができる。
The robot
データテーブルとしての部品給材装置形状データ４０１は部品給材装置２００の形状を表すデータである。詳しくは、部品給材装置形状データ４０１は部品給材装置２００を構成する台座部２２０、コンベアベルト２３０、駆動部２４０、駆動部２４１等の形状寸法が含まれている。部品給材装置形状データ４０１は補助記憶装置３３０に保持されている。
The parts feeding
部品給材装置形状データ４０１は、部品給材装置２００の構成要素の形状寸法等を表すデータである。部品給材装置２００の構成要素の形状寸法を表すデータとしては、たとえば、部品給材装置の設計データから生成された三角形ポリゴンデータを用いることができる。
The component supply
干渉チェック対象ペアリングデータ４０２は、ロボットアーム形状データ４００に含まれる構成要素と部品給材装置形状データ４０１に含まれる構成要素とを重複しないようペアリングしたデータである。干渉チェック対象ペアリングデータ４０２はロボットアーム形状データ４００と部品給材装置形状データ４０１から生成される。そして、干渉チェック対象ペアリングデータ４０２は定められたデータテーブルとして主記憶装置３２０または補助記憶装置３３０に保持される。
The interference check
第１ベクトルデータとしてのロボットアーム並進速度データ４０３はロボットの移動方向と速さとを定めたベクトルデータである。ロボットアーム並進速度データ４０３はロボット制御装置３４０による動作命令から演算される。あるいは、ロボットアーム並進速度データ４０３は、カメラ装置３５０が撮影する画像から検出されたロボットアーム１００の構成要素の並進速度データである。ロボットアーム並進速度データ４０３はデータテーブルとして主記憶装置３２０に保持される。
Robot arm
第２ベクトルデータとしての部品給材装置の並進速度データ４０４はワーク搬送装置の移動方向と速さとを定めるベクトルデータである。部品給材装置の並進速度データ４０４は、カメラ装置３５０が検出する部品給材装置２００の構成要素の並進速度データである。部品給材装置の並進速度データ４０４は定められたデータテーブルとして主記憶装置３２０に保持される。
The
ロボットアームの位置姿勢データ４０５は、ロボットアーム１００の構成要素の位置と姿勢の情報である。ロボットアームの位置姿勢データ４０５は、ロボット制御装置３４０による動作命令から演算される。あるいは、カメラ装置３５０が撮影する画像から検出されたロボットアーム１００の構成要素の位置と姿勢の情報である。ロボットアームの位置姿勢データ４０５はデータテーブルとして主記憶装置３２０に保持される。
The robot arm position and
部品給材装置の位置姿勢データ４０６は、カメラ装置３５０が検出する部品給材装置２００の構成要素の位置と姿勢の情報である。部品給材装置の位置姿勢データ４０６はデータテーブルとして主記憶装置３２０に保持される。
The position /
相対速度データ４０７は第１ベクトルデータと第２ベクトルデータとを合成した合成ベクトルのデータである。相対速度データ４０７は、干渉チェック対象ペアリングデータ４０２でペアリングされているロボットアーム１００の構成要素の並進速度と部品給材装置２００の構成要素の並進速度の差を表すベクトル情報である。相対速度データ４０７は主記憶装置３２０に保持される。
The
干渉領域としての拡大済み干渉ボリュームデータ４０８は、相対速度データ４０７及びデータテーブルを参照して演算されるデータである。拡大済み干渉ボリュームデータ４０８は、ロボットアーム１００あるいは部品給材装置２００が占める空間情報に対して合成ベクトルを使用する演算によって膨張させたデータである。拡大済み干渉ボリュームデータ４０８は主記憶装置３２０に保持される。
The enlarged
干渉有無データ４０９は、ロボットアーム１００と部品給材装置２００との干渉の有無を表すデータである。干渉有無データ４０９は、拡大済み干渉ボリュームデータ４０８とロボットアーム１００あるいは部品給材装置２００の形状データと、ロボットアームの位置姿勢データ４０５と部品給材装置の位置姿勢データ４０６とから演算される。干渉有無データ４０９はロボットアーム１００と部品給材装置２００との干渉の有無を表し、主記憶装置３２０に保持される。
Interference presence /
干渉チェック対象ペアリングブロック４２０は、ロボットアームの形状データ４００からロボットアーム１００の構成要素と、部品給材装置の形状データ４０１から部品給材装置２００の構成要素とを用いる。そして、干渉チェック対象ペアリングブロック４２０はロボットアーム１００の構成要素と部品給材装置２００の構成要素との重複を含まない組み合わせを生成する。そして、干渉チェック対象ペアリングブロック４２０は生成したデータを干渉チェック対象ペアリングデータ４０２として保持する。
The interference check
ロボットアームの並進速度取得ブロック４３０は、カメラ装置３５０が撮影した画像データを用いてロボットアーム１００の構成要素の移動方向と速さを算出する。ロボットアームの並進速度取得ブロック４３０は、ロボットアーム１００の構成要素の移動方向と速さのデータをロボットアーム並進速度データ４０３として保持する。
The robot arm translation
部品給材装置の並進速度取得ブロック４３１は、カメラ装置３５０が撮影した画像データを用いて部品給材装置２００の構成要素の移動方向と速さを算出する。部品給材装置の並進速度取得ブロック４３１は部品給材装置２００の構成要素の移動方向と速さを部品給材装置の並進速度データ４０４として保持する。
The translation
相対速度計算ブロック４４０は、干渉チェック対象ペアリングデータ４０２、ロボットアーム並進速度データ４０３、部品給材装置の並進速度データ４０４を用いて相対速度データ４０７を算出する。このとき、相対速度計算ブロック４４０は、干渉チェック対象ペアリングデータ４０２でペアリングされているロボットアーム１００の構成要素の並進速度と部品給材装置２００の構成要素の並進速度との差を算出する。算出結果から相対速度データ４０７を生成する。
The relative
干渉ボリューム拡張ブロック４５０は、ロボットアーム形状データ４００と部品給材装置形状データ４０１と相対速度データ４０７とを用いる。そして、干渉ボリューム拡張ブロック４５０は、ロボットアームの構成要素が占める空間情報に関して合成ベクトルを使用する演算を行う。これにより、ロボットアーム１００の構成要素が占める空間情報を膨張させて、拡大済み干渉ボリュームデータ４０８を生成する。または、干渉ボリューム拡張ブロック４５０は、部品給材装置２００の構成要素が占める空間情報に関して合成ベクトルを使用する演算を行う。これにより、部品給材装置２００の構成要素が占める空間情報を膨張させて、拡大済み干渉ボリュームデータ４０８を生成する。つまり、干渉ボリューム拡張ブロック４５０は合成ベクトルの大きさと対応する広さの拡大済み干渉ボリュームデータ４０８を演算する。
The interference
ロボットアームの位置姿勢取得ブロック４６０は、カメラ装置３５０が撮影した画像データからロボットアーム１００の構成要素の位置と姿勢を算出する。そして、ロボットアームの位置姿勢取得ブロック４６０はロボットアームの位置姿勢データ４０５を主記憶装置３２０に保持する。
The robot arm position /
部品給材装置の位置姿勢取得ブロック４６１は、カメラ装置３５０が撮影した画像データから部品給材装置２００の構成要素の位置と姿勢を算出する。そして、部品給材装置の位置姿勢取得ブロック４６１は部品給材装置の位置姿勢データ４０６として主記憶装置３２０に保持する。
The position and
干渉チェックブロック４７０は、ロボットアーム形状データ４００、部品給材装置の形状データ４０１、ロボットアームの位置姿勢データ４０５、部品給材装置の位置姿勢データ４０６、干渉領域としての拡大済み干渉ボリュームデータ４０８を用いる。そして、干渉チェックブロック４７０は、ロボットアーム１００と部品給材装置２００との干渉の有無を算出する。そして、干渉チェックブロック４７０は算出結果である干渉有無データ４０９を生成する。
The
図４は、ロボットの形状データ構造を示す図である。図４に示すように、ロボットアーム形状データ４００はロボットアーム１００の構成要素のポリゴン頂点の座標をデータとして保持する。尚、ポリゴン頂点は、各構成要素の表面を三角形にて覆って表面を近似したときの三角形の頂点を示している。ロボットアーム１００の基準位置を原点としてポリゴン頂点のＸ座標、Ｙ座要、Ｚ座標にて記載される。従って、ロボットアーム形状データ４００は各構成要素の表面形状を表現するデータとなっている。
FIG. 4 is a diagram illustrating a shape data structure of the robot. As shown in FIG. 4, the robot
図５は、部品給材の形状データ構造を示す図である。図５に示すように、部品給材装置形状データ４０１は部品給材装置２００の構成要素のポリゴン頂点の座標をデータとして保持する。部品給材装置２００の基準位置を原点としてポリゴン頂点のＸ座標、Ｙ座要、Ｚ座標にて記載される。従って、部品給材装置形状データ４０１は各構成要素の表面形状を表現するデータとなっている。
FIG. 5 is a diagram showing a shape data structure of a component supply material. As shown in FIG. 5, the component supply
図６は、干渉チェックペアリング情報のデータ構造を示す図である。図６に示すように、干渉チェック対象ペアリングデータ４０２にはロボットアーム１００の構成要素と部品給材装置２００の構成要素のペアリングが記載されている。尚、ペアリングは一対の組合せを示している。そして、各ペアリングは同じ組合せが重複しないように整理されている。そして、各ペアリングにはインデックスが付与されている。これにより、インデックス順にペアリングを選択することにより、ロボットアーム１００の構成要素と部品給材装置２００の構成要素の組合せを重複せずに選択することが可能になっている。
FIG. 6 is a diagram illustrating a data structure of interference check pairing information. As shown in FIG. 6, the interference check
図７は、ロボットの並進速度のデータ構造を示す図である。図７に示すように、ロボットアーム並進速度データ４０３にはロボットアーム１００の各構成要素が進行する速度ベクトルをＸ方向、Ｙ方向、Ｚ方向に分解したデータが記載されている。従って、ロボットアーム並進速度データ４０３は各構成要素の速度ベクトルを表現するデータとなっている。
FIG. 7 is a diagram illustrating a data structure of the translation speed of the robot. As shown in FIG. 7, the robot arm
図８は、部品給材装置の並進速度のデータ構造を示す図である。図８に示すように、部品給材装置の並進速度データ４０４には部品給材装置２００の各構成要素が進行する速度ベクトルをＸ方向、Ｙ方向、Ｚ方向に分解したデータが記載されている。従って、部品給材装置の並進速度データ４０４は各構成要素の速度ベクトルを表現するデータとなっている。
FIG. 8 is a diagram showing a data structure of the translation speed of the component supply device. As shown in FIG. 8, the
図９は、ロボットの位置姿勢のデータ構造を示す図である。図９に示すように、ロボットアームの位置姿勢データ４０５にはロボットアーム１００の各構成要素の位置を、例えば、ロール角、ピッチ角、ヨー角に分解したデータが記載されている。さらに、ロボットアームの位置姿勢データ４０５にはロボットアーム１００の各構成要素の姿勢を表示する方向をＸ方向、Ｙ方向、Ｚ方向に分解したデータが記載されている。従って、ロボットアームの位置姿勢データ４０５は各構成要素の位置と姿勢とを表現するデータとなっている。
FIG. 9 is a diagram illustrating a data structure of the position and orientation of the robot. As shown in FIG. 9, the position and
図１０は、部品給材装置の位置姿勢のデータ構造を示す図である。図１０に示すように、部品給材装置の位置姿勢データ４０６には部品給材装置２００の各構成要素の位置をＸ方向、Ｙ方向、Ｚ方向に分解したデータが記載されている。さらに、部品給材装置の位置姿勢データ４０６には部品給材装置２００の各構成要素の姿勢を、例えば、ロール角、ピッチ角、ヨー角に分解したデータが記載されている。従って、部品給材装置の位置姿勢データ４０６は各構成要素の位置と姿勢とを表現するデータとなっている。
FIG. 10 is a diagram illustrating a data structure of the position and orientation of the component supply device. As shown in FIG. 10, the position /
図１１は、相対速度のデータ構造を示す図である。図１１に示すように、相対速度データ４０７にはロボットアームの構成要素と部品給材装置の構成要素とのペアリングが記載されている。さらに、各ペアリングにおける相対速度の算出結果が記載されている。従って、相対速度データ４０７は各ペアリングした構成要素の接近速度を表現するデータとなっている。
FIG. 11 is a diagram illustrating a data structure of relative speed. As shown in FIG. 11, the
図１２は、拡大済み干渉ボリュームのデータ構造を示す図である。図１２に示すように、拡大済み干渉ボリュームデータ４０８には干渉チェック対象ペアリングデータ４０２と同じデータを用いている。さらに、各対となる構成要素のうちどちらを基準とするかを選択した結果が記載されている。そして、相対速度に対応させて拡張したポリゴン頂点の座標が記載されている。従って、拡大済み干渉ボリュームデータ４０８は相対速度に対応して設定した干渉領域を示すデータとなっている。
FIG. 12 is a diagram illustrating a data structure of the expanded interference volume. As shown in FIG. 12, the same data as the interference check
図１３は、干渉有無のデータ構造を示す図である。図１３に示すように、干渉有無データ４０９には干渉チェック対象ペアリングデータ４０２と同じデータを用いている。さらに、各対の構成要素における干渉の有無を演算した結果が記載されている。従って、干渉有無データ４０９は各対の構成要素における干渉の有無を示すデータとなっている。
FIG. 13 is a diagram illustrating a data structure with and without interference. As shown in FIG. 13, the same data as the interference check
（干渉の検出方法）
次に、ロボット制御部３００がロボットの干渉チェック方法を実現するときの各機能ブロックの処理の流れについて説明する。
(Interference detection method)
Next, the process flow of each functional block when the
図１４は、干渉チェック対象ペアリングブロックフローチャートである。まず、干渉チェック対象ペアリングデータ４０２を形成する手順を説明する。図１４に示すように、まず、ステップＳ５０１においてロボットアームの形状データ４００を取得する。次に、ステップＳ５０２において部品給材装置形状データ４０１を取得する。その後に、ステップＳ５０３においてロボットアームの構成要素と、部品給材装置形状データ４０１の構成要素とを重複しないペアリングをおこない、干渉チェック対象ペアリングデータ４０２として保持する。
FIG. 14 is an interference check target pairing block flowchart. First, a procedure for forming the interference check
図１５は、相対速度計算ブロックのフローチャートである。次に、相対速度計算ブロック４４０が相対速度データ４０７を形成する手順を説明する。図１５に示すように、まず、ステップＳ５１１においてロボットアーム形状データ４００を取得する。次に、ステップＳ５１２において部品給材装置形状データ４０１を取得する。そして、ステップＳ５１３において相対速度を演算するペアリングを設定するために、干渉チェック対象ペアリングデータ４０２を取得する。次に、ステップＳ５１４においてロボットの移動方向と速さとを定めたベクトルデータであるロボットアーム並進速度データ４０３を取得する。ステップＳ５１４は第１ベクトルデータを取得する工程に相当する。次に、ステップＳ５１５においてワーク搬送装置の移動方向と速さとを定めるベクトルデータである部品給材装置の並進速度データ４０４を取得する。ステップＳ５１５は第２ベクトルデータを取得する工程に相当する。その後に、ステップＳ５１６において干渉チェック対象ペアリングデータ４０２に基づいて、ロボットアーム１００の構成要素と部品給材装置２００の構成要素との相対速度を算出する。そして、算出した結果を相対速度データ４０７として保持する。ステップＳ５１６は合成ベクトルを演算する工程に相当する。
FIG. 15 is a flowchart of the relative speed calculation block. Next, the procedure in which the relative
図１６は、相対速度の演算を説明するための模式図である。図１６に示すように、干渉チェック対象ペアリングデータ４０２から、チャック部１４１とコンベアベルト２３０を選択した場合の例にて説明をする。チャック部１４１が移動する速度ベクトルをチャック並進速度ベクトル６００とする。そして、コンベアベルト２３０の上部が移動する速度ベクトルをベルト並進速度ベクトル６１０とする。次に、チャック並進速度ベクトル６００とベルト並進速度ベクトル６１０とを用いて第１相対速度ベクトル６２０または第２相対速度ベクトル６２１を相対速度計算ブロック４４０が演算する。そして、演算した結果は相対速度データ４０７となる。
FIG. 16 is a schematic diagram for explaining the calculation of the relative speed. As shown in FIG. 16, description will be made with an example in which the
第１相対速度ベクトル６２０は、チャック部１４１を基準にとったコンベアベルト２３０の相対速度であり、チャック部１４１から観察したコンベアベルト２３０の並進運動である。第２相対速度ベクトル６２１は、コンベアベルト２３０を基準にとったチャック部１４１の相対速度になるため、コンベアベルト２３０から観察したチャック部１４１の並進運動である。
The first
相対速度ベクトルを演算するときに、その基準をチャック部１４１とするか、コンベアベルト２３０とするかは、チャック部１４１の形状寸法データとコンベアベルト２３０の形状データとのポリゴン情報の容量を比較して選択する。このとき、ポリゴン情報の容量が大きい方を相対速度ベクトルの基準とする。これにより、干渉ボリューム拡張ブロック４５０が基準でない方の形状寸法データを拡大処理する計算量を削減することができる。つまり、ポリゴン情報の容量が小さい方の構成要素を処理することで、処理量を削減する。
When calculating the relative velocity vector, whether the reference is the
図１７は、干渉ボリューム拡張ブロックのフローチャートである。次に、干渉ボリューム拡張ブロック４５０の処理の流れを説明する。図１７に示すように、まず、ステップＳ５２１において、ロボットアーム形状データ４００を取得する。次に、ステップＳ５２２において部品給材装置の形状データ４０１を取得する。続いて、ステップＳ５２３において、ロボットアーム並進速度データ４０３と部品給材装置の並進速度データ４０４とを合成した相対速度データ４０７を取得する。その後に、ステップＳ５２４において、拡大済み干渉ボリュームデータ４０８を生成し、保持する。ステップＳ５２４は干渉領域を演算する工程に相当する。以上で、干渉ボリューム拡張ブロック４５０が実施する工程を終了する。
FIG. 17 is a flowchart of the interference volume expansion block. Next, the process flow of the interference
ステップＳ５２４を詳細に説明する。ロボットアーム１００の構成要素と部品給材装置２００の構成要素のうち、相対速度データ４０７の基準でない方の形状データを相対速度データ４０７の方向と大きさに基づいて干渉ボリューム拡張ブロック４５０は拡大処理の演算を行なう。拡大処理は（数式１）を適用する。
Step S524 will be described in detail. Among the components of the
（数式１）において、右辺のｘ、ｙ、ｚは形状データのポリゴン頂点のｘ方向位置、ｙ方向位置、ｚ方向位置、ｕ、ｖ、ｗは相対速度データ４０７のｘ方向成分、ｙ方向成分、ｚ方向成分、αは拡大率調整のパラメーター（αはゼロ以上、１．０以下とする）である。左辺のｘ、ｙ、ｚは拡大処理済み形状データのポリゴン頂点のｘ方向位置、ｙ方向位置、ｚ方向位置である。（数式１）により、相対速度データの速度成分が大きな方向は、より大きな拡大率になる。
In (Expression 1), x, y, and z on the right side are the x direction position, y direction position, z direction position, u, v, and w of the polygon vertex of the shape data, and the x direction component and y direction component of the
拡大処理の演算は、数式を用いる方法に限らない。実験から干渉する確立を求めて拡大処理する係数を記載したデータテーブルを作成する。尚、データテーブルは数式を元にして作成してもよく、数式を元に算出した値を実験データを考慮して修正してもよい。そして、拡大処理の演算を行なうときにはデータテーブルの係数を用いて行う。 The calculation of the enlargement process is not limited to a method using a mathematical formula. Create a data table that describes the coefficients to be expanded in order to obtain interference from the experiment. The data table may be created based on mathematical formulas, and values calculated based on the mathematical formulas may be corrected in consideration of experimental data. Then, when performing the enlargement processing, the coefficient of the data table is used.
図１８は、拡大済み干渉ボリュームを説明するための模式図である。相対速度データ４０７から、チャック部１４１とコンベアベルト２３０が対象となる例を示す。図１８（ａ）では、チャック部１４１が基準となっている。このとき、干渉ボリューム拡張ブロック４５０はコンベアベルト２３０の第１相対速度ベクトル６２０を用いる。第１相対速度ベクトル６２０はｘ方向およびｚ方向に成分があるくベクトルとなっている。そして、干渉ボリューム拡張ブロック４５０はｚ方向と比較してｘ方向に大きく拡大したコンベアベルト２３０の干渉領域としての拡大済み干渉ボリュームデータ７００を算出する。
FIG. 18 is a schematic diagram for explaining an enlarged interference volume. An example in which the
図１８（ｂ）では、コンベアベルト２３０が基準となっている。このとき、干渉ボリューム拡張ブロック４５０はチャック部１４１の第２相対速度ベクトル６２１を用いる。第２相対速度ベクトル６２１はｘ方向およびｚ方向に成分があるベクトルとなっている。そして、干渉ボリューム拡張ブロック４５０はｚ方向と比較してｘ方向に大きく拡大したチャック部１４１の干渉領域としての拡大済み干渉ボリュームデータ７０１を算出する。つまり、干渉ボリューム拡張ブロック４５０は合成ベクトルの大きさと対応する広さの拡大済み干渉ボリュームデータ７００及び拡大済み干渉ボリュームデータ７０１を演算する。
In FIG. 18B, the
図１９は、干渉チェックブロックのフローチャートである。次に、干渉チェックブロック４７０の処理の流れを説明する。図１９に示すように、まず、ステップＳ５３１において、干渉チェックブロック４７０は干渉領域としての拡大済み干渉ボリュームデータ４０８を取得する。次に、ステップＳ５３２において、干渉チェックブロック４７０は拡大済み干渉ボリュームデータ４０８においてロボットアーム１００と部品給材装置２００とのうちどちらが基準であるかを参照する。基準がロボットアーム１００の場合は、ステップＳ５３３において干渉チェックブロック４７０はロボットアーム形状データ４００を取得する。基準が部品給材装置２００場合は、ステップＳ５３４において部品給材装置形状データ４０１を取得する。次に、ステップＳ５３５においてロボットアームの位置姿勢データ４０５を取得する。続いて、ステップＳ５３６において部品給材装置の位置姿勢データ４０６を取得する。次に、ステップＳ５３７において干渉の有無を計算する。ステップＳ５３７は干渉の有無を確認する工程に相当する。以上で、干渉ボリューム拡張ブロック４５０が実施する工程を終了する。
FIG. 19 is a flowchart of the interference check block. Next, the processing flow of the
ステップＳ５３７を詳細に説明する。干渉ボリューム拡張ブロック４５０は、拡大済み干渉ボリュームデータ４０８とロボットアームの形状データ４００あるいは部品給材装置の形状データ４０１とをロボットアームの位置姿勢データ４０５及び部品給材装置の位置姿勢データ４０６に従って配置する。そして、干渉ボリューム拡張ブロック４５０はロボットアーム１００と部品給材装置２００との干渉の有無を確認するための交差判定計算を行う。その結果得られる干渉の有無を干渉ボリューム拡張ブロック４５０は干渉有無データ４０９として保持する。
Step S537 will be described in detail. The interference
交差判定計算において干渉ボリューム拡張ブロック４５０は、細分化された作業空間要素が木構造で連なるデータ構造により表現される作業空間を用意する。そして、拡大済み干渉ボリュームデータ４０８をロボットアームの位置姿勢データ４０５及び部品給材装置の位置姿勢データ４０６に従って配置する。拡大済み干渉ボリュームデータ４０８とロボットアーム形状データ４００あるいは部品給材装置形状データ４０１とに関して、隣接する細分化した作業空間要素にない形状データ同士の交差判定計算を省略する処理を行う。そして、省略されない作業空間要素に対して干渉の有無を演算する。
In the intersection determination calculation, the interference
図２０は、ロボット制御部３００がロボットの干渉チェックを実現するときの処理の流れであり、ロボットの干渉チェック手順を示すフローチャートである。図２０に示すように、まず、ステップＳ８０１において干渉チェック対象ペアリングブロック４２０が干渉チェック対象ペアリングデータ４０２を生成する。次に、ステップＳ８０２においてロボット動作命令やロボット動作に基づいて相対速度計算ブロック４４０が相対速度データ４０７を生成する。続いて、ステップＳ８０３において干渉ボリューム拡張ブロック４５０が拡大済み干渉ボリュームデータ４０８を生成する。次に、ステップＳ８０４において干渉チェックブロック４７０が干渉有無データ４０９を生成する。続いて、ステップＳ８０５においてＣＰＵ３１０が干渉有無データ４０９を参照する。干渉が無い場合はステップＳ８０６においてロボットアーム１００は引き続いてロボット動作を実行する。干渉がある場合はステップＳ８０７においてロボットアーム１００を停止させてから、干渉有りを意味する警告表示を行う。以上で、ロボットの干渉をチェックする工程を終了する。
FIG. 20 is a flow chart showing a process flow when the
上述したように、本実施形態によれば、以下の効果を有する。
（１）本実施形態によれば、ロボットアーム並進速度データ４０３と部品給材装置の並進速度データ４０４とから相対速度データ４０７が演算される。そして、相対速度データ４０７に従って、定められたデータテーブルを参照して拡大済み干渉ボリュームデータ４０８を演算している。部品給材装置２００及びロボットアーム１００の移動方向と速さの双方が含まれる相対速度データ４０７が示す合成ベクトル方向は相対的に移動する方向を示している。この方向は、干渉の可能性がある方向である。そして、合成ベクトルの大きさは速さと相関を有する為、合成ベクトルは相対移動速度を考慮した拡大済み干渉ボリュームデータ４０８を算出できる。これにより、拡大済み干渉ボリュームデータ４０８は相対移動速度と対応する合成ベクトルの大きさの分だけに広がりを持たせて算出されている。従って、干渉計算が離散的に計算されるときにおいても干渉を防止可能な演算を行うことができる。
As described above, this embodiment has the following effects.
(1) According to the present embodiment, the
さらに、ロボットアーム１００が移動する場所と部品給材装置２００が移動する場所とから供給部品２１０が干渉する領域を算出する方法がある。この方法に比べて、合成ベクトルを用いて供給部品２１０が干渉する領域を算出する方が、干渉計算の計算を簡単に行うことができる。
Further, there is a method of calculating an area where the
（２）本実施形態によれば、ロボットアーム並進速度データ４０３と部品給材装置の並進速度データ４０４とのどちらか一方を基準ベクトルデータとしている。合成ベクトルに応じた干渉領域を演算するときロボットアーム１００を基準とする干渉領域と部品給材装置２００を基準とする干渉領域との二通りの干渉領域を算出できる。そして、ロボットアーム１００を基準とする干渉領域の広がりと部品給材装置２００を基準とする干渉領域の広がりのいずれかを選択できる。従って、より計算時間が短い方を基準として干渉計算を実行することにより、計算時間を短くすることができる。
(2) According to the present embodiment, either one of the robot arm
（３）本実施形態によれば、ロボットアーム並進速度データ４０３と部品給材装置の並進速度データ４０４とのどちらか一方を基準ベクトルデータとして定めている。このときに、ロボットアーム１００及び部品給材装置２００の形状に応じてどちらか一方を選択している。例えば複雑な形状である場合、形状に関するデータ数が多くなる。従って、複雑な形状が移動する領域を演算する方が単純な形状が移動するときに比べて演算時間がかかる。合成ベクトルの大きさの分だけ広がりを持つ拡大済み干渉ボリュームデータ４０８を演算するときに、ロボットアーム１００を基準に干渉領域を演算する場合と、部品給材装置２００を基準に干渉領域を演算する場合とで、より演算量が少なくなる方を選択することが可能である。従って、拡大済み干渉ボリュームデータ４０８の計算時間を短くすることができる。
(3) According to the present embodiment, one of the robot arm
（４）本実施形態によれば、ロボットアーム１００及び部品給材装置２００の移動方向と速さの双方が含まれる合成ベクトル方向にのみ合成ベクトルの大きさの分だけ広がりを持つ拡大済み干渉ボリュームデータ４０８を算出している。そして、計算時間を抑制しながら適切な干渉計算を実行している。これにより、実際のロボット動作に先立って干渉有無データ４０９を確認し、この干渉有無データ４０９に応じたロボットの制御を行うことができる。これによって、部品給材装置２００とロボットアーム１００との干渉を回避するロボット制御が可能になる。
(4) According to the present embodiment, the expanded interference volume having a spread corresponding to the size of the combined vector only in the combined vector direction including both the moving direction and the speed of the
（実施形態２）
次に、本発明のロボットアームとロボットアームが行う干渉チェック方法について図２１〜図２６を用いて説明する。本実施形態が実施形態１と異なるところは、ロボットアーム及び部品給材装置が相対移動する回転成分を考慮して干渉チェックを行う点にある。尚、本実施形態において、上記の実施形態１と同様の部材または部位については同じ符号を付し、詳細な説明は省略する。
(Embodiment 2)
Next, the robot arm of the present invention and the interference check method performed by the robot arm will be described with reference to FIGS. This embodiment is different from the first embodiment in that an interference check is performed in consideration of a rotational component in which the robot arm and the component supply device move relative to each other. In addition, in this embodiment, the same code | symbol is attached | subjected about the member or site | part similar to said
図２１は、ロボット制御部が実現する機能を示す機能ブロック図である。すなわち、図２１に示すように、相対速度計算ブロック４４０は、ロボットアーム並進速度データ４０３及び部品給材装置の並進速度データ４０４から第１ベクトルデータと第２ベクトルデータとを合成した回転合成ベクトルとしての相対速度データ４０７を計算する。さらに、ロボット制御部３００は、ロボットの回転方向と回転速さとを定める第３ベクトルデータとしてのロボットアームの回転速度データ４１０を備える。さらに、部品給材装置２００の回転方向と回転速さとを定めたベクトルデータである第４ベクトルデータとしての部品給材装置の回転速度データ４１１を備える。さらに、ロボット制御部３００は第３ベクトルデータと第４ベクトルデータとを合成した回転合成ベクトルとしての相対回転速度データ４１２を演算する相対回転速度計算ブロック４９０を備えている。
FIG. 21 is a functional block diagram illustrating functions realized by the robot control unit. That is, as shown in FIG. 21, the relative
ロボット制御部３００はロボットアームの回転速度取得ブロック４８０を備えている。ロボットアームの回転速度取得ブロック４８０は、カメラ装置３５０が作業空間を撮影して得られる画像データからロボットアーム１００の構成要素の回転方向と速さを検出する。そして、ロボットアームの回転速度取得ブロック４８０はロボットアームの回転速度データ４１０を保持する。
The
ロボット制御部３００は部品給材装置の回転速度取得ブロック４８１を備えている。部品給材装置の回転速度取得ブロック４８１は、カメラ装置３５０が作業空間を撮影して得られる画像データから部品給材装置２００の構成要素の回転方向と速さを検出する。そして、部品給材装置の回転速度取得ブロック４８１は部品給材装置の回転速度データ４１１を保持する。
The
ロボット制御部３００は相対回転速度計算ブロック４９０を備えている。相対回転速度計算ブロック４９０は、干渉チェック対象ペアリングデータ４０２と、ロボットアームの回転速度データ４１０と、部品給材装置の回転速度データ４１１とを参照する。そして、相対回転速度計算ブロック４９０は干渉チェック対象ペアリングデータ４０２でペアリングされているロボットアームの構成要素の回転速度と部品給材装置の構成要素の回転速度との差を算出する。これにより、相対回転速度計算ブロック４９０はロボットアームの回転速度データ４１０と部品給材装置の回転速度データ４１１とを合成した相対回転速度データ４１２を生成する。
The
干渉ボリューム拡張ブロック４５０は相対速度データ４０７及び相対回転速度データ４１２及び定められたデータテーブルを参照して拡大済み干渉ボリュームデータ４０８を演算する。このとき、干渉ボリューム拡張ブロック４５０は、さらに、ロボットアーム形状データ４００あるいは部品給材装置形状データ４０１と相対速度データ４０７と相対回転速度データ４１２とを参照する。そして、干渉ボリューム拡張ブロック４５０は、ロボットアーム１００の構成要素あるいは部品給材装置２００の構成要素が占める空間情報を合成ベクトルを演算によって膨張させた拡大済み干渉ボリュームデータ４０８を生成する。
The interference
ロボットアーム１００の移動方向と速さ及び部品給材装置２００の移動方向と速さに加えて、ロボットアーム１００の回転方向と回転速さ及びワーク搬送装置の回転方向と回転速さが含まれる合成ベクトル方向にのみ合成ベクトルの大きさの分だけ広がりを持つ干渉領域を干渉ボリューム拡張ブロック４５０が算出する。これにより、部品給材装置２００の回転方向と回転速さ及びロボットアーム１００の回転方向と回転速さに関して離散的に計算される干渉計算において、干渉しないとされた動作が実際のロボット動作で干渉するといったケースを発見することができ、より確実な干渉の有無を取得できる。
In addition to the movement direction and speed of the
ロボットの回転方向と回転速さとを定めたベクトルデータであるロボットアームの回転速度データ４１０は、ロボット制御装置３４０による動作命令から演算される。あるいは、ロボットアームの回転速度データ４１０はカメラ装置３５０が検出するロボットアーム１００の構成要素の回転速度データであり、定められたデータテーブルとして主記憶装置３２０に保持されている。
Robot arm
部品給材装置の回転速度データ４１１は、部品給材装置２００の回転方向と回転速さとを定めるベクトルデータである。そして、部品給材装置の回転速度データ４１１はカメラ装置３５０が検出する部品給材装置２００の構成要素の回転速度データである。部品給材装置の回転速度データ４１１は定められたデータテーブルとして主記憶装置３２０に保持される。
The
図２２は、ロボットの回転速度のデータ構造を示す図である。図２２に示すように、ロボットアームの回転速度データ４１０にはロボットアーム１００の各構成要素が回転する回転速度ベクトルをＸ軸周り、Ｙ軸周り、Ｚ軸周りに分解したデータが記載されている。従って、ロボットアームの回転速度データ４１０は各構成要素の回転速度ベクトルを表現するデータとなっている。
FIG. 22 is a diagram illustrating a data structure of the rotation speed of the robot. As shown in FIG. 22, the
図２３は、部品給材装置の回転速度のデータ構造を示す図である。図２３に示すように、部品給材装置の回転速度データ４１１には部品給材装置２００の各構成要素が回転する回転速度ベクトルをＸ軸周り、Ｙ軸周り、Ｚ軸周りに分解したデータが記載されている。従って、部品給材装置の回転速度データ４１１は各構成要素の回転速度ベクトルを表現するデータとなっている。
FIG. 23 is a diagram illustrating a data structure of the rotation speed of the component supply device. As shown in FIG. 23, the
図２４は、相対速度計算ブロックのフローチャートである。図２４に示すように、まず、ステップＳ５４１において相対回転速度計算ブロック４９０はロボットアームの形状データ４００を取得する。次に、ステップＳ５４２において相対回転速度計算ブロック４９０は部品給材装置形状データ４０１を取得する。続いて、ステップＳ５４３において相対速度を演算するペアリングを設定するために、相対回転速度計算ブロック４９０は干渉チェック対象ペアリングデータ４０２を取得する。
FIG. 24 is a flowchart of the relative speed calculation block. As shown in FIG. 24, first, in step S541, the relative rotational
次に、ステップＳ５４４において相対回転速度計算ブロック４９０はロボットアームの回転速度データ４１０を取得する。ステップＳ５４４は第３ベクトルデータを取得する工程に相当する。続いて、ステップＳ５４５において部品給材装置２００の回転方向と回転速さとを定めるベクトルデータである部品給材装置の回転速度データ４１１を取得する。ステップＳ５４５は第４ベクトルデータを取得する工程に相当する。
Next, in step S544, the relative rotational
その後、ステップＳ５４６において干渉チェック対象ペアリングデータ４０２に基づいて、ロボットアーム１００の構成要素と部品給材装置２００の構成要素との相対回転速度を計算する。そして、相対回転速度計算ブロック４９０はロボットアームの回転速度データ４１０と部品給材装置の回転速度データ４１１とを合成した相対回転速度データ４１２として保持する。ステップＳ５４６は回転合成ベクトルを演算する工程に相当する。以上で、相対回転速度計算ブロック４９０が実施する工程を終了する。
Thereafter, in step S546, based on the interference check
ステップＳ５４６を詳細に説明する。図２５は、相対回転速度データを説明するための模式図である。干渉チェック対象ペアリングデータ４０２から、チャック部１４１とコンベアベルト２３０が対象となる場合の例を用いて説明する。相対回転速度計算ブロック４９０はチャック部１４１の回転速度ベクトル６３０とコンベアベルト２３０の上部の回転速度ベクトル６４０とから相対回転速度ベクトル６５０を演算する。相対回転速度ベクトル６５０のデータが相対回転速度データ４１２となる。相対回転速度ベクトル６５０は、コンベアベルト２３０を基準にとったチャック部１４１の相対回転速度になる。従って、相対回転速度ベクトル６５０はコンベアベルト２３０から観察したチャック部１４１の回転運動である。もちろん、チャック部１４１を基準とすることも可能である。
Step S546 will be described in detail. FIG. 25 is a schematic diagram for explaining the relative rotational speed data. A description will be given using an example in which the
相対回転速度ベクトルを演算するとき相対回転速度計算ブロック４９０は基準をチャック部１４１とするか、コンベアベルト２３０とするかを選択する。相対回転速度計算ブロック４９０はチャック部１４１の形状寸法データとコンベアベルト２３０の形状データとのポリゴン情報の大きさを比較する。そして、相対回転速度計算ブロック４９０はポリゴン情報の大きさが大きい方を相対回転速度ベクトルの基準とする。これにより、干渉ボリューム拡張ブロック４５０で基準でない方の形状寸法データを拡大処理するときにポリゴン情報の大きさが小さい方を処理することで計算量を削減することができる。
When calculating the relative rotational speed vector, the relative rotational
図２６は、干渉チェックブロック４７０の処理の流れであり、ロボットの干渉チェック手順を示すフローチャートである。図２６に示すように、まず、ステップＳ５５１において干渉領域としての拡大済み干渉ボリュームデータ４０８を取得する。次に、ステップＳ５５２において拡大済み干渉ボリュームデータ４０８を参照して、干渉チェックブロック４７０はロボットアーム１００と部品給材装置２００のうち、どちらが基準であるかを判断する。基準がロボットアーム１００の場合は、ステップＳ５５３においてロボットアーム形状データ４００を取得する。基準が部品給材装置２００場合は、ステップＳ５５４において部品給材装置形状データ４０１を取得する。そして、ステップＳ５５５においてロボットアームの位置姿勢データ４０５を取得する。次に、ステップＳ５５６において部品給材装置の位置姿勢データ４０６を取得する。
FIG. 26 is a flowchart of the process of the
この後、ステップＳ５５７において相対回転速度データ４１２を拡大済み干渉ボリュームデータ４０８に反映させるための回転量θを０に初期設定する。つまり回転無しに初期設定する。ステップＳ５５８においてこの回転量θの絶対値と相対回転速度データ４１２の絶対値との比較を行う。回転量θの絶対値が相対回転速度データ４１２の絶対値よりも小さい場合には、ステップＳ５５９において回転量θ分だけ拡大済み干渉ボリュームデータ４０８を回転変換する処理を行う。ステップＳ５６０において回転量分だけ回転変換処理された拡大済み干渉ボリュームデータ４０８と、ロボットアーム形状データ４００あるいは部品給材装置形状データ４０１とを、ロボットアームの位置姿勢データ４０５及び部品給材装置の位置姿勢データ４０６に従って配置する。ステップＳ５６０は干渉領域を演算する工程に相当する。ロボットアーム１００と部品給材装置２００との干渉の有無を確認する交差判定計算を行う。その結果得られる干渉の有無を干渉有無データ４０９として保持する。そして、ステップＳ５６１において回転量θに対して相対回転速度データ４１２と同じ向きの回転増分ｄθを加算する。尚、ｄθの方向は相対回転速度と一致させる。
Thereafter, in step S557, the rotation amount θ for reflecting the relative
ステップＳ５５９では、ステップＳ５２４と同様に数式を作成して、演算しても良い。他の方法を用いても良い。例えば、実験から干渉する確立を求めて拡大処理する係数を記載したデータテーブルを作成する。尚、データテーブルは数式を元にして作成してもよく、数式を元に算出した値を実験データを考慮して修正してもよい。そして、拡大処理の演算を行なうときにはデータテーブルの係数を用いて行う。 In step S559, mathematical expressions may be created and calculated in the same manner as in step S524. Other methods may be used. For example, a data table is created in which coefficients for performing enlargement processing are obtained from an experiment to find interference. The data table may be created based on mathematical formulas, and values calculated based on the mathematical formulas may be corrected in consideration of experimental data. Then, when performing the enlargement processing, the coefficient of the data table is used.
ロボットアーム１００と部品給材装置２００が干渉の有無を確認するために交差判定計算を行う。このときに、細分化された作業空間要素が木構造で連なるデータ構造により表現される作業空間を用意する。そして、拡大済み干渉ボリュームデータ４０８はロボットアームの位置姿勢データ４０５及び部品給材装置の位置姿勢データ４０６に従って配置されるとともに、回転量分だけ回転変換処理が行なわれる。拡大済み干渉ボリュームデータ４０８、ロボットアーム形状データ４００あるいは部品給材装置形状データ４０１に関して、隣接する細分化した作業空間要素にない形状データ同士の交差判定計算を省略する処理を行う。そして、省略されない作業空間要素に対して干渉の有無を演算する。
The
以上において、ロボットアーム１００とワーク搬送装置としての部品給材装置２００との干渉を確認する実施形態について示したが、ロボットとしてロボットアーム同士の干渉の確認についても上記実施形態と同様の方法を行うことが可能である。同様に、部品給材装置２００にある供給部品２１０，２１１，２１２や他のワークとロボットアーム１００との干渉の確認を行いたい場合も、上記実施形態と同様の方法が適用可能である。
In the above description, the embodiment for confirming the interference between the
さらに、上述の干渉チェック方法は、実施形態１の内容も含めてプログラムとして提供することもできる。このようなプログラムは、コンピューターに付属するＣＤ−ＲＯＭ、ＤＶＤ−ＲＯＭ、メモリカード等のコンピューター読取り可能な記録媒体にて記録させて、プログラム製品として提供することもできる。あるいは、ネットワークを介したダウンロードによって、プログラム製品を提供することもできる。提供されるプログラム製品は、ハードディスク等の補助記憶装置にインストールされて実行される。尚、プログラム製品は、プログラム自体と、プログラムが記録された記録媒体とを含む。 Furthermore, the above-described interference check method can be provided as a program including the contents of the first embodiment. Such a program can be recorded on a computer-readable recording medium such as a CD-ROM, a DVD-ROM, or a memory card attached to the computer and provided as a program product. Alternatively, the program product can be provided by downloading via a network. The provided program product is installed in an auxiliary storage device such as a hard disk and executed. The program product includes the program itself and a recording medium on which the program is recorded.
上述したように、本実施形態によれば以下の効果を有する。
（１）本実施形態によれば、ロボットアーム１００の回転方向と回転速さ及び部品給材装置２００の回転方向と回転速さが含まれる合成ベクトル方向にのみ合成ベクトルの大きさの分だけ広がりを持つ拡大済み干渉ボリュームデータ４０８を算出できる。これにより、計算時間を抑制しながら適切な干渉計算を実行することができる。さらに、部品給材装置２００の回転方向と回転速さ及びロボットアーム１００の回転方向と回転速さに関して離散的に計算するときにもロボットアーム１００と部品給材装置２００の干渉を防止できる。
As described above, the present embodiment has the following effects.
(1) According to the present embodiment, the rotation direction and rotation speed of the
（２）本実施形態によれば、ロボットアームの回転速度データ４１０と部品給材装置の回転速度データ４１１とのどちらか一方を基準ベクトルとしている。相対回転速度データ４１２に応じた拡大済み干渉ボリュームデータ４０８を演算するとき、ロボットアーム１００を基準とする拡大済み干渉ボリュームデータ４０８と部品給材装置２００を基準とする拡大済み干渉ボリュームデータ４０８との二通りを算出できる。そして、ロボットアーム１００を基準とする拡大済み干渉ボリュームデータ４０８が示す干渉領域の広がりと部品給材装置２００を基準とする拡大済み干渉ボリュームデータ４０８が示す干渉領域の広がりのいずれかを選択できる。従って、より計算時間が短い方を基準として干渉計算を実行することにより、計算時間を短くすることができる。
(2) According to the present embodiment, one of the
（３）本実施形態によれば、ロボットアームの回転速度データ４１０と部品給材装置の回転速度データ４１１とのどちらか一方を基準ベクトルのデータとして定めている。このときに、ロボットアーム１００及び部品給材装置２００の形状に応じてどちらか一方を選択している。例えば複雑な形状である場合、形状に関するデータ数が多くなる。従って、複雑な形状が移動する領域を演算する方が単純な形状が移動する領域を演算するときに比べて演算時間がかかる。干渉ボリューム拡張ブロック４５０は相対回転速度データ４１２が示す合成ベクトルの大きさの分だけ広がりを持つ拡大済み干渉ボリュームデータ４０８を演算する。このときに、干渉ボリューム拡張ブロック４５０はロボットアーム１００を基準に拡大済み干渉ボリュームデータ４０８を演算する場合と、部品給材装置２００を基準に拡大済み干渉ボリュームデータ４０８を演算する場合とで、より演算量が少なくなる場合を選択することが可能である。従って、より計算時間が短い方を基準として干渉計算を実行することにより、ロボット制御部３００は計算時間を短くすることができる。
(3) According to the present embodiment, one of the
（４）本実施形態によれば、ロボットアーム１００及び部品給材装置２００の移動方向と速さに加えて、ロボットアーム１００及び部品給材装置２００の回転方向と回転速度が含まれる合成ベクトル方向にのみ合成ベクトルの大きさの分だけ広がりを持つ拡大済み干渉ボリュームデータ４０８が示す干渉領域を算出している。そして、計算時間を抑制しながら適切な干渉計算を実行している。これにより、実際のロボットアーム１００の動作に先立って干渉領域を確認しこの干渉領域に応じたロボットアーム１００の制御を行うことができる。これによって、部品給材装置２００とロボットアーム１００との干渉を回避するロボット制御が可能になる。または、ロボットアーム１００同士の干渉を回避するロボットアーム１００の制御が可能になる。従って、供給部品２１０の搬送状態に左右されることの無い連続可動が可能なロボットアーム１００の制御を実現できる。または、複数のロボットの状態に左右されることの無い連続可動が可能なロボット制御を実現できる。
(4) According to the present embodiment, in addition to the moving direction and speed of the
今回開示された実施形態は総ての点で例示である。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味及び範囲内での総ての変更が含まれることが意図される。 The embodiments disclosed herein are illustrative in all respects. The scope of the present invention is defined by the terms of the claims, rather than the description above, and is intended to include any modifications within the scope and meaning equivalent to the terms of the claims.
尚、本発明は上述した実施形態に限定されるものではなく、種々の変更や改良を加えることも可能である。変形例を以下に述べる。 In addition, this invention is not limited to embodiment mentioned above, A various change and improvement can also be added. A modification will be described below.
（変形例１）
実施形態１において、ロボットアーム１００と部品給材装置２００との干渉を演算した。部品給材装置２００には供給部品２１０が含まれていてもよい。チャック部１４１が供給部品２１０を把持する前に供給部品２１０がロボットアーム１００と干渉することを防止することができる。
(Modification 1)
In the first embodiment, the interference between the
（変形例２）
実施形態１において、ロボットアーム１００は６軸ロボットアームとしたが、ロボットアーム１００はこの形態のロボットアームに限らない。２軸〜５軸のロボットアームでも良く、７軸以上のロボットアームでも良い。さらに、水平多関節ロボット、直交ロボット、パラレルリンクロボット等の各種類の形態のロボットにも適用することができる。
(Modification 2)
In the first embodiment, the
（変形例３）
実施形態１において、部品給材装置２００はコンベアベルト２３０を駆動して供給部品２１０を移動した。部品給材装置２００が供給部品２１０を移動する形態は他の形態でも良い。回転式ローラーを複数配置しても良く、直動機構を用いて供給部品２１０を移動させても良い。他にも運搬車に載せて供給部品２１０を移動させてもよい。いずれの方式においてもロボットアーム１００との干渉防止に適用することができる。尚、変形例１〜変形例３は実施形態２にも適用することができる。
(Modification 3)
In the first embodiment, the
１００…ロボットとしてのロボットアーム、２００…ワーク搬送装置としての部品給材装置、２１０…ワークとしての供給部品、４００…データテーブルとしてのロボットアーム形状データ、４０１…データテーブルとしての部品給材装置形状データ、４０３…第１ベクトルデータとしてのロボットアーム並進速度データ、４０４…第２ベクトルデータとしての部品給材装置の並進速度データ、４０７…合成ベクトル及び回転合成ベクトルとしての相対速度データ、４０８，７００，７０１…干渉領域としての拡大済み干渉ボリュームデータ、４１０…第３ベクトルデータとしてのロボットアームの回転速度データ、４１１…第４ベクトルデータとしての部品給材装置の回転速度データ、４１２…合成回転ベクトルとしての相対回転速度データ。
DESCRIPTION OF
Claims (5)
少なくとも１方向にワークを搬送するワーク搬送装置と、を含み、
前記ロボットの前記アームの移動方向と速さとを定めた第１ベクトルデータを取得し、
前記ワーク搬送装置が前記ワークを搬送する搬送方向と速さとを定める第２ベクトルデータを取得し、
前記ロボットの形状と前記ワーク搬送装置の形状とに応じて、前記第１ベクトルデータと前記第２ベクトルデータとのどちらを基準ベクトルとするかを決定し、
前記第１ベクトルデータと前記第２ベクトルデータとを合成した合成ベクトルを演算し、
前記合成ベクトル及び所定のデータテーブルを参照して前記合成ベクトルの大きさと対応する干渉領域を演算し、
前記干渉領域から前記ロボットと前記ワーク搬送装置との干渉の有無を確認する、
ことを特徴とするロボットシステム。 A robot comprising an arm that moves in at least one direction;
A workpiece transfer device that transfers the workpiece in at least one direction,
Obtaining first vector data defining the moving direction and speed of the arm of the robot;
Obtaining second vector data defining a conveying direction and a speed at which the workpiece conveying device conveys the workpiece;
In accordance with the shape of the robot and the shape of the work transfer device, it is determined which of the first vector data and the second vector data is a reference vector,
Calculating a combined vector obtained by combining the first vector data and the second vector data;
Calculating an interference area corresponding to the size of the combined vector with reference to the combined vector and a predetermined data table;
Confirming the presence or absence of interference between the robot and the work transfer device from the interference area,
A robot system characterized by this.
前記ワーク搬送装置の回転方向と回転速さとを定めた第４ベクトルデータを取得し、
前記第３ベクトルデータと前記第４ベクトルデータとを合成した回転合成ベクトルを演算し、
前記合成ベクトル及び前記回転合成ベクトル及び所定のデータテーブルを参照して前記合成ベクトルの大きさと対応する広さの干渉領域を演算する、
ことを特徴とする請求項１に記載のロボットシステム。 Obtaining third vector data defining a rotation direction and a rotation speed of the robot;
Obtaining fourth vector data defining a rotation direction and a rotation speed of the workpiece transfer device;
Calculating a rotation synthesized vector obtained by synthesizing the third vector data and the fourth vector data;
An interference area having a width corresponding to the size of the combined vector is calculated with reference to the combined vector, the rotated combined vector, and a predetermined data table.
The robot system according to claim 1 .
ことを特徴とする請求項２に記載のロボットシステム。 Either one of the third vector data and the fourth vector data is a reference vector .
The robot system according to claim 2.
ことを特徴とする請求項２または請求項３に記載のロボットシステム。 According to the shape of the robot and the shape of the work transfer device, which of the third vector data and the fourth vector data is determined as a rotation reference vector,
The robot system according to claim 2 or claim 3, wherein
前記アームの移動方向と速さとを定めた第１ベクトルデータを取得し、
少なくとも１方向にワークを搬送するワーク搬送装置が前記ワークを搬送する搬送方向と速さとを定める第２ベクトルデータを取得し、
前記アームの形状と前記ワーク搬送装置の形状とに応じて、前記第１ベクトルデータと前記第２ベクトルデータとのどちらを基準ベクトルとするかを決定し、
前記第１ベクトルデータと前記第２ベクトルデータとを合成した合成ベクトルを演算し、
前記合成ベクトル及び所定のデータテーブルを参照して前記合成ベクトルの大きさと対応する干渉領域を演算し、
前記干渉領域から前記ロボットと前記ワーク搬送装置との干渉の有無を確認する、
ことを特徴とするロボット。 An arm that moves in at least one direction;
Obtaining first vector data defining the moving direction and speed of the arm;
Second workpiece data for determining a transport direction and a speed at which the work transport device that transports the work in at least one direction transports the work,
In accordance with the shape of the arm and the shape of the work transfer device, it is determined which of the first vector data and the second vector data is a reference vector,
Calculating a combined vector obtained by combining the first vector data and the second vector data;
Calculating an interference area corresponding to the size of the combined vector with reference to the combined vector and a predetermined data table;
Confirming the presence or absence of interference between the robot and the work transfer device from the interference area,
A robot characterized by that.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2011000978A JP5754138B2 (en) | 2011-01-06 | 2011-01-06 | Robot system and robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2011000978A JP5754138B2 (en) | 2011-01-06 | 2011-01-06 | Robot system and robot |
Publications (3)
| Publication Number | Publication Date |
|---|---|
| JP2012139806A JP2012139806A (en) | 2012-07-26 |
| JP2012139806A5 JP2012139806A5 (en) | 2014-02-06 |
| JP5754138B2 true JP5754138B2 (en) | 2015-07-29 |
Family
ID=46676619
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2011000978A Expired - Fee Related JP5754138B2 (en) | 2011-01-06 | 2011-01-06 | Robot system and robot |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5754138B2 (en) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP5673717B2 (en) * | 2013-03-19 | 2015-02-18 | 株式会社安川電機 | Robot system and method of manufacturing workpiece |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH0810526Y2 (en) * | 1986-04-14 | 1996-03-29 | 日産自動車株式会社 | Manufacturing line control device |
| JP5112666B2 (en) * | 2006-09-11 | 2013-01-09 | 株式会社日立製作所 | Mobile device |
-
2011
- 2011-01-06 JP JP2011000978A patent/JP5754138B2/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2012139806A (en) | 2012-07-26 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5765355B2 (en) | Robot picking system and workpiece manufacturing method | |
| JP4560658B2 (en) | Control device for legged mobile robot | |
| JP5754454B2 (en) | Robot picking system and workpiece manufacturing method | |
| JP5426719B2 (en) | Robot system motion simulation device | |
| KR101633357B1 (en) | Manipulator and control method thereof | |
| JP6706489B2 (en) | Robot direct teaching method | |
| EP2660013B1 (en) | Method of controlling seven-shaft multi-joint robot, control program, and robot control device | |
| JP5458769B2 (en) | Robot control device | |
| JP2006048244A (en) | Working program generating device | |
| JP6445092B2 (en) | Robot system displaying information for teaching robots | |
| JP2014024162A (en) | Robot system, robot control device, robot control method and robot control program | |
| WO2001038048A1 (en) | Robot controller | |
| JP2010201592A (en) | Method for generating operation route for robot | |
| JP5250858B2 (en) | Multiple robot collision detection method and robot apparatus | |
| JP2007286976A (en) | Robot simulation apparatus | |
| JP6228097B2 (en) | Mobile robot | |
| JP2018111155A (en) | Robot control device, robot and robot system | |
| WO2015137162A1 (en) | Control device, robot system, and method for generating control data | |
| JP2020093364A (en) | Trajectory generation device | |
| JP7144754B2 (en) | Articulated robots and articulated robot systems | |
| JP5754138B2 (en) | Robot system and robot | |
| KR101787865B1 (en) | Inverse kinematic solution for multi-joint link mechanism, and device for creating instructional data by using inverse kinematic solution | |
| JP2011131326A (en) | Method for avoiding interference of robot arm | |
| JP4745921B2 (en) | Control method of welding robot | |
| JP3579742B2 (en) | Teaching data correction method, correction program and correction device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20131216 |
|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20131216 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20140909 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20140911 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20141017 |
|
| RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20150106 |
|
| 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: 20150428 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20150511 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 5754138 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| LAPS | Cancellation because of no payment of annual fees |