JP2012139806A - Method for checking interference and robot control device - Google Patents
Method for checking interference and robot control device Download PDFInfo
- Publication number
- JP2012139806A JP2012139806A JP2011000978A JP2011000978A JP2012139806A JP 2012139806 A JP2012139806 A JP 2012139806A JP 2011000978 A JP2011000978 A JP 2011000978A JP 2011000978 A JP2011000978 A JP 2011000978A JP 2012139806 A JP2012139806 A JP 2012139806A
- Authority
- JP
- Japan
- Prior art keywords
- data
- interference
- vector
- 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.)
- Granted
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
Description
本発明は、干渉チェック方法、及びロボット制御装置にかかわり特に、ロボットの干渉に関する。 The present invention relates to an interference check method and a robot control apparatus, and more particularly to robot interference.
ロボットを予め決められた動作条件で逐次動作させるときに、ロボットの動作範囲内に存在するベルトコンベアに代表される搬送装置や、別に設置されるロボットとの干渉の有無を確認する。そして、干渉する場合にはロボット動作の停止や、干渉が発生しないロボット動作へと修正する。
従来、例えば、特許文献1及び特許文献2に記載されているように、ロボットと搬送装置のレイアウトをコンピューター上で仮想配置した上で、ロボット動作をコンピューター上で模擬し、ロボットと搬送装置及び他のロボットとが干渉するかどうかを確認するロボットの干渉チェック方法が知られていた。
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
特許文献1では、干渉の有無を確認する対象ペアを選択し、一方の物体を線分と円弧の組み合わせからなる二次元形状で表現される一般形状柱で近似する。次に他方の物体を単一の直方体または複数の直方体の集合で近似する。続いて、それぞれ近似した物体同士で干渉の有無を確認している。
In
特許文献2では、ロボット及び搬送装置等の周辺機器のレイアウトを設定している。そして、総てのロボット動作に関して、ロボット動作時にロボットが存在する領域の集合和を計算する。そして、その集合和領域に関して、周辺物体と干渉するかどうか、あるいは規定の動作領域に対してはみ出しているかどうかを確認する。
In
しかしながら、特許文献1記載のロボットの干渉チェック方法ではロボット動作で干渉する可能性の有る対象を取り囲む領域である一般形状柱の線分と円弧の組み合わせからなる二次元形状は複雑となる。従って、その領域を表現するためのデータ容量が大きくなり、検証の有無を算出する計算処理量が大きくなる。その結果、干渉計算の計算に時間がかかる。
However, in the robot interference check method described in
特許文献2記載のロボットの干渉領域確認装置においても、ロボットの動作が多くなればなるほど、ロボット動作範囲が大きくなればなるほど、ロボットが存在する領域の集合和も広範な領域となる。従って、広域にわたる干渉計算を行う必要があり、干渉計算の計算に時間がかかる。そこで、干渉計算の計算を簡単に行える干渉チェック方法が望まれていた。
Also in the robot interference area confirmation device described in
加えて、特許文献1記載のロボットの干渉チェック方法及び特許文献2記載のロボットの干渉領域確認装置においては、搬送装置や別に設置されるロボットの動作速度が十分に考慮されていない。従って、時刻に関して離散的に計算される干渉計算において干渉しないとされた動作が実際のロボット動作では干渉するケースが発生する課題が存在する。そこで、移動速度を考慮した干渉チェック方法が望まれていた。
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.
[適用例1]本適用例にかかる干渉チェック方法は、少なくとも1方向への動作が可能なロボットと、少なくとも1方向に動作するワーク搬送装置との干渉をチェックするための干渉チェック方法であって、前記ロボットの移動方向と速さとを定めたベクトルデータである第1ベクトルデータを取得する工程と、前記ワーク搬送装置の移動方向と速さとを定めるベクトルデータである第2ベクトルデータを取得する工程と、前記第1ベクトルデータと前記第2ベクトルデータとを合成した合成ベクトルを演算する工程と、前記合成ベクトル及び所定のデータテーブルを参照して前記合成ベクトルの大きさと対応する広さの干渉領域を演算する工程と、前記干渉領域から前記ロボットと前記ワーク搬送装置との干渉の有無を確認する工程と、を含むことを特徴とする。 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.
本適用例によれば、ロボットの移動方向と速さとを定めたベクトルデータである第1ベクトルデータと、ワーク搬送装置の移動方向と速さとを定める第2ベクトルデータとから合成ベクトルが演算される。そして、合成ベクトルに従って、定められたデータテーブルを参照して干渉領域を演算している。ワーク搬送装置及びロボットの移動方向と速さの双方が含まれる合成ベクトル方向は相対的に移動する方向を示している。この方向は、干渉の可能性がある方向である。そして、合成ベクトルの大きさは速さと相関を有する為、合成ベクトルは相対移動速度と対応した干渉領域を算出できる。これにより、相対移動速度と対応する合成ベクトルの大きさの分だけ干渉領域に広がりを持たせて算出することができる。従って、干渉計算が離散的に計算されるときにおいても干渉を防止可能な演算を行うことができる。 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.
[適用例2]上記適用例に記載の干渉チェック方法において、前記合成ベクトルを演算する工程は、前記第1ベクトルデータと前記第2ベクトルデータとのどちらか一方が基準ベクトルである前記合成ベクトルを演算することが好ましい。 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.
本適用例によれば、第1ベクトルデータと第2ベクトルデータとのどちらか一方を基準ベクトルとしている。合成ベクトルに応じた干渉領域を演算するときロボットを基準とする干渉領域とワーク搬送装置を基準とする干渉領域との二通りの干渉領域を算出できる。そして、ロボットを基準とする干渉領域の広がりとワーク搬送装置を基準とする干渉領域の広がりのいずれかを選択できる。従って、より計算時間が短い方を基準として干渉計算を実行することにより、計算時間を短くすることができる。 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.
[適用例3]上記適用例に記載の干渉チェック方法において、前記合成ベクトルを演算する工程は、前記ロボットの形状と前記ワーク搬送装置の形状とに応じて、前記第1ベクトルデータと前記第2ベクトルデータとのどちらを基準ベクトルとするかを決定することが望ましい。 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.
本適用例によれば、第1ベクトルデータと第2ベクトルデータとのどちらか一方を基準ベクトルとして定めている。このときに、ロボット及びワーク搬送装置の形状に応じてどちらか一方を選択している。例えば複雑な形状である場合、形状に関するデータ数が多くなる。従って、複雑な形状が移動する領域を演算する方が単純な形状が移動するときに比べて演算時間がかかる。合成ベクトルの大きさの分だけ広がりを持つ干渉領域を演算するときに、ロボットを基準に干渉領域を演算する場合と、ワーク搬送装置を基準に干渉領域を演算する場合とで、より演算量が少なくなる方を選択することが可能である。従って、干渉領域の計算時間を短くすることができる。 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.
[適用例4]上記適用例に記載の干渉チェック方法において、前記ロボットの回転方向と回転速さとを定めたベクトルデータである第3ベクトルデータを取得する工程と、前記ワーク搬送装置の回転方向と回転速さとを定めるベクトルデータである第4ベクトルデータを取得する工程と、前記第3ベクトルデータと前記第4ベクトルデータとを合成した回転合成ベクトルを演算する工程と、前記合成ベクトル及び前記回転合成ベクトル及び所定のデータテーブルを参照して前記合成ベクトルの大きさと対応する広さの干渉領域を演算する工程と、を含むことを特徴とする。 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.
[適用例5]上記適用例に記載の干渉チェック方法において、前記回転合成ベクトルを演算する工程は、前記第3ベクトルデータと前記第4ベクトルデータとのどちらか一方が回転基準ベクトルである前記回転合成ベクトルを演算することを特徴とする。 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.
本適用例によれば、第3ベクトルデータと第4ベクトルデータとのどちらか一方を基準ベクトルとしている。合成ベクトルに応じた干渉領域を演算するとき、ロボットを基準とする干渉領域とワーク搬送装置を基準とする干渉領域との二通りを算出できる。そして、ロボットを基準とする干渉領域の広がりとワーク搬送装置を基準とする干渉領域の広がりのいずれかを選択できる。従って、より計算時間が短い方を基準として干渉計算を実行することにより、計算時間を短くすることができる。 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.
[適用例6]上記適用例に記載の干渉チェック方法において、前記回転合成ベクトルを演算する工程は、前記ロボットの形状と前記ワーク搬送装置の形状とに応じて、前記第3ベクトルデータと前記第4ベクトルデータとのどちらを回転基準ベクトルとするかを決定することを特徴とする。 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.
本適用例によれば、第3ベクトルデータと第4ベクトルデータとのどちらか一方を基準ベクトルとして定めている。このときに、ロボット及びワーク搬送装置の形状に応じてどちらか一方を選択している。例えば複雑な形状である場合、形状に関するデータ数が多くなる。従って、複雑な形状が移動する領域を演算する方が単純な形状が移動する領域を演算するときに比べて演算時間がかかる。合成ベクトルの大きさの分だけ広がりを持つ干渉領域を演算するときに、ロボットを基準に干渉領域を演算する場合と、ワーク搬送装置を基準に干渉領域を演算する場合とで、より演算量が少なくなる場合を選択することが可能である。従って、より計算時間が短い方を基準として干渉計算を実行することにより、計算時間を短くすることができる。 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.
[適用例7]本適用例にかかる干渉チェック方法は、少なくとも1方向への動作が可能な第1ロボットと、少なくとも1方向に動作が可能な第2ロボットとの干渉をチェックするための干渉チェック方法であって、前記第1ロボットの移動方向と速さとを定めるベクトルデータである第1ベクトルデータを取得する工程と、前記第2ロボットの移動方向と速さとを定めたベクトルデータである第2ベクトルデータを取得する工程と、前記第1ベクトルデータと前記第2ベクトルデータとを合成した合成ベクトルを演算する工程と、前記合成ベクトル及び所定のデータテーブルを参照して前記合成ベクトルの大きさと対応する広さの干渉領域を演算する工程と、前記干渉領域から、前記第1ロボットと前記第2ロボットとの干渉の有無を確認する工程と、を含むことを特徴とする。 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.
本適用例によれば、第1ロボットの移動方向と速さとを定めるベクトルデータである第1ベクトルデータを取得している。さらに、第2ロボットの移動方向と速さとを定めたベクトルデータである第2ベクトルデータを取得している。そして、第1ベクトルデータと第2ベクトルデータとから合成ベクトルを演算している。従って、定められたデータテーブルを参照して干渉領域を演算することで、第1ロボット及び第2ロボットの移動方向と速さの双方が含まれる合成ベクトル方向にのみ合成ベクトルの大きさと対応する広さを持つ干渉領域を算出できる。これにより、相対移動速度と対応する合成ベクトルの大きさの分だけ干渉領域に広がりを持たせて算出することができる。従って、干渉計算が離散的に計算されるときにおいても干渉を防止可能な演算を行うことができる。 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.
さらに、第1ロボットが移動する場所と第2ロボットが移動する場所とから干渉領域を算出する方法がある。この方法に比べて、合成ベクトルを用いて干渉領域が算出する方が、干渉計算の計算を簡単に行うことができる。 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.
[適用例8]本適用例にかかるロボット制御装置は、上記適用例に記載の干渉チェック方法の内容と順番を規定したプログラムを記憶したことを特徴とする。 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.
(実施形態1)
本実施形態では、ロボットアームとロボットアームが行う特徴的な干渉チェック方法とその例について、図1〜図20に従って説明する。
(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.
(ロボット)
図1は、ロボットの構成を示す模式正面図である。まず、ロボットと部品給材装置の構成について説明する。図1に示すように、ロボットとしてのロボットアーム100は台座部110を備えている。台座部110上に第1リンク120、第2リンク121、第3リンク122、第4リンク123、第5リンク124、第6リンク125がこの順に接続して設置されている。そして、各リンクの間には第1ジョイント130、第2ジョイント131、第3ジョイント132、第4ジョイント133、第5ジョイント134、第6ジョイント135が配置されている。そして、ロボットアーム100の先端にはロボットハンド140が設置されている。これにより、ロボットアーム100は少なくとも1方向への動作可能なロボットとして動作する。そして、ロボットアーム100は第1ジョイント130から第6ジョイント135の6軸のジョイントを有する6軸ロボットアームとなっている。
(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
台座部110は、ロボットアーム100を設置するための架台である。第1リンク120から第6リンク125の隣り合うリンクは、それぞれ第1ジョイント130から第6ジョイント135を介して接続されている。第1リンク120から第6リンク125の各リンクにはモーターが内蔵されている。そのモーターを所定の角度に回転させることで、第1ジョイント130から第6ジョイント135が回転する。これにより、第1リンク120から第6リンク125は姿勢が変動する。これを適宜実行して、ロボットアーム100は所望の姿勢を実現する。そして、ロボットハンド140はチャック部141,142を開閉させることで、部品の把持や解放を実現する。
The
ロボットアーム100は、第1リンク120から第6リンク125の各リンクが並行して動作しロボットハンド140を直線に沿って移動させる並進動作が可能となっている。ロボットアーム100が設置されている作業空間で直交座標系の基底方向が設定されている場合には、その各方向を例えばX軸方向、Y軸方向、Z軸方向とした上で、ロボットアーム100の並進動作の方向をX軸方向、Y軸方向、Z軸方向の3成分に分解したうえでそれぞれの方向の並進動作の和としても良い。
The
ワーク搬送装置としての部品給材装置200は、ワークとしての供給部品210,211,212、台座部220、コンベアベルト230、駆動部240,241等から構成されている。台座部220は、部品給材装置200を設置するための架台である。台座部220上にはコンベアベルト230が設置され、コンベアベルト230の両端には駆動部240と駆動部241とが配置されている。駆動部240と241とはモーターや減速装置等の回転機構を備えている。駆動部240と241とが動作することで、コンベアベルト230が1方向に移動する。従って、部品給材装置200は少なくとも1方向に動作するワーク搬送装置となっている。
A
供給部品210,211,212は部品給材装置200によって所望の位置に搬送される。その後、供給部品210,211,212はロボットハンド140によって把持される。
The
コンベアベルト230の動作は並進動作である。従って、供給部品210,211,212はコンベアベルト230の動きに伴い直線に沿って移動する。部品給材装置200が設置されている作業空間で直交座標系の基底方向が設定されている場合には、その各方向を例えばX軸方向、Y軸方向、Z軸方向とした上で、コンベアベルト230の並進動作の方向をX軸方向、Y軸方向、Z軸方向の3成分のベクトル和としても良い。
The operation of the
ロボットアーム100の近くにはロボットアーム100を制御するロボット制御部300が設置されている。そして、部品給材装置200の図中上側にはコンベアベルト230とロボットハンド140の移動範囲とを撮影するカメラ装置350が設置されている。
A
図2は、ロボット制御部の構成を示すブロック図である。図2に示すように、ロボットアーム100を制御するためのロボット制御部300は、CPU310(Central Processing Unit)、主記憶装置320、補助記憶装置330、ロボット制御装置340、データバス360等から構成されている。データバス360はロボット制御部300が内臓する各装置、カメラ装置350、ロボットアーム100を接続する。
FIG. 2 is a block diagram illustrating a configuration of the robot control unit. As shown in FIG. 2, the
補助記憶装置330は、ロボットアーム100の動作命令群を保持する装置である。そして、補助記憶装置330は、ロボットアーム100の動作命令群を主記憶装置320に出力する。カメラ装置350は、作業領域の様子を撮影した画像情報を生成し主記憶装置320に出力する。主記憶装置320は、補助記憶装置330に保持されているロボットアーム100の動作命令を入力し、CPU310が行う処理の一時記憶場所を有する。他にも、主記憶装置320は、カメラ装置350が撮影する画像情報を入力する機能を有する。ロボット制御装置340は、CPU310が生成するロボットアーム100の動作指示情報を入力する。そして、動作指示情報に応じて第1ジョイント130から第6ジョイント135を稼動させて、ロボットアーム100を駆動する。
The
CPU310は、主記憶装置320からロボットアーム100の動作命令を取得する。そして、CPU310はカメラ装置350が撮影した画像情報を画像処理し、ロボットアーム100や部品給材装置200を検出する。次に、CPU310は現在のロボットアーム100の位置情報や姿勢情報、部品給材装置200の位置情報を生成する。そして、CPU310は各位置情報や姿勢情報は主記憶装置320に転送する。さらにCPU310は、ロボットアーム100の現在の位置情報や姿勢情報、部品給材装置200の位置情報等から、ロボットアーム100と部品給材装置200との干渉の有無を計算する。そして、干渉の有無に応じたロボットアーム100の動作指示情報を生成し、ロボット制御装置340に転送する。
The
図3は、ロボット制御部が実現する機能を示す機能ブロック図である。次に、ロボット制御部300が備える機能ブロックについて説明する。図3に示すように、ロボットの定められたデータテーブルとしてのロボットアーム形状データ400が補助記憶装置330に保持されている。ロボットアーム形状データ400はロボットアーム100の形状を表すデータであり、ロボットアーム形状データ400にはロボットアーム100を構成する台座部、ロボットリンク、ロボットジョイント、ロボットハンド等の形状寸法が含まれている。
FIG. 3 is a functional block diagram illustrating functions realized by the robot control unit. Next, functional blocks provided in the
ロボットアーム形状データ400はロボットアーム100の構成要素の形状寸法等を表すデータである。ロボットアーム100の構成要素の形状寸法を表すデータとしては、例えば、ロボットアームの設計データから生成された三角形ポリゴンデータを用いることができる。
The robot
データテーブルとしての部品給材装置形状データ401は部品給材装置200の形状を表すデータである。詳しくは、部品給材装置形状データ401は部品給材装置200を構成する台座部220、コンベアベルト230、駆動部240、駆動部241等の形状寸法が含まれている。部品給材装置形状データ401は補助記憶装置330に保持されている。
The parts feeding
部品給材装置形状データ401は、部品給材装置200の構成要素の形状寸法等を表すデータである。部品給材装置200の構成要素の形状寸法を表すデータとしては、たとえば、部品給材装置の設計データから生成された三角形ポリゴンデータを用いることができる。
The component supply
干渉チェック対象ペアリングデータ402は、ロボットアーム形状データ400に含まれる構成要素と部品給材装置形状データ401に含まれる構成要素とを重複しないようペアリングしたデータである。干渉チェック対象ペアリングデータ402はロボットアーム形状データ400と部品給材装置形状データ401から生成される。そして、干渉チェック対象ペアリングデータ402は定められたデータテーブルとして主記憶装置320または補助記憶装置330に保持される。
The interference check
第1ベクトルデータとしてのロボットアーム並進速度データ403はロボットの移動方向と速さとを定めたベクトルデータである。ロボットアーム並進速度データ403はロボット制御装置340による動作命令から演算される。あるいは、ロボットアーム並進速度データ403は、カメラ装置350が撮影する画像から検出されたロボットアーム100の構成要素の並進速度データである。ロボットアーム並進速度データ403はデータテーブルとして主記憶装置320に保持される。
Robot arm
第2ベクトルデータとしての部品給材装置の並進速度データ404はワーク搬送装置の移動方向と速さとを定めるベクトルデータである。部品給材装置の並進速度データ404は、カメラ装置350が検出する部品給材装置200の構成要素の並進速度データである。部品給材装置の並進速度データ404は定められたデータテーブルとして主記憶装置320に保持される。
The
ロボットアームの位置姿勢データ405は、ロボットアーム100の構成要素の位置と姿勢の情報である。ロボットアームの位置姿勢データ405は、ロボット制御装置340による動作命令から演算される。あるいは、カメラ装置350が撮影する画像から検出されたロボットアーム100の構成要素の位置と姿勢の情報である。ロボットアームの位置姿勢データ405はデータテーブルとして主記憶装置320に保持される。
The robot arm position and
部品給材装置の位置姿勢データ406は、カメラ装置350が検出する部品給材装置200の構成要素の位置と姿勢の情報である。部品給材装置の位置姿勢データ406はデータテーブルとして主記憶装置320に保持される。
The position /
相対速度データ407は第1ベクトルデータと第2ベクトルデータとを合成した合成ベクトルのデータである。相対速度データ407は、干渉チェック対象ペアリングデータ402でペアリングされているロボットアーム100の構成要素の並進速度と部品給材装置200の構成要素の並進速度の差を表すベクトル情報である。相対速度データ407は主記憶装置320に保持される。
The
干渉領域としての拡大済み干渉ボリュームデータ408は、相対速度データ407及びデータテーブルを参照して演算されるデータである。拡大済み干渉ボリュームデータ408は、ロボットアーム100あるいは部品給材装置200が占める空間情報に対して合成ベクトルを使用する演算によって膨張させたデータである。拡大済み干渉ボリュームデータ408は主記憶装置320に保持される。
The enlarged
干渉有無データ409は、ロボットアーム100と部品給材装置200との干渉の有無を表すデータである。干渉有無データ409は、拡大済み干渉ボリュームデータ408とロボットアーム100あるいは部品給材装置200の形状データと、ロボットアームの位置姿勢データ405と部品給材装置の位置姿勢データ406とから演算される。干渉有無データ409はロボットアーム100と部品給材装置200との干渉の有無を表し、主記憶装置320に保持される。
Interference presence /
干渉チェック対象ペアリングブロック420は、ロボットアームの形状データ400からロボットアーム100の構成要素と、部品給材装置の形状データ401から部品給材装置200の構成要素とを用いる。そして、干渉チェック対象ペアリングブロック420はロボットアーム100の構成要素と部品給材装置200の構成要素との重複を含まない組み合わせを生成する。そして、干渉チェック対象ペアリングブロック420は生成したデータを干渉チェック対象ペアリングデータ402として保持する。
The interference check
ロボットアームの並進速度取得ブロック430は、カメラ装置350が撮影した画像データを用いてロボットアーム100の構成要素の移動方向と速さを算出する。ロボットアームの並進速度取得ブロック430は、ロボットアーム100の構成要素の移動方向と速さのデータをロボットアーム並進速度データ403として保持する。
The robot arm translation
部品給材装置の並進速度取得ブロック431は、カメラ装置350が撮影した画像データを用いて部品給材装置200の構成要素の移動方向と速さを算出する。部品給材装置の並進速度取得ブロック431は部品給材装置200の構成要素の移動方向と速さを部品給材装置の並進速度データ404として保持する。
The translation
相対速度計算ブロック440は、干渉チェック対象ペアリングデータ402、ロボットアーム並進速度データ403、部品給材装置の並進速度データ404を用いて相対速度データ407を算出する。このとき、相対速度計算ブロック440は、干渉チェック対象ペアリングデータ402でペアリングされているロボットアーム100の構成要素の並進速度と部品給材装置200の構成要素の並進速度との差を算出する。算出結果から相対速度データ407を生成する。
The relative
干渉ボリューム拡張ブロック450は、ロボットアーム形状データ400と部品給材装置形状データ401と相対速度データ407とを用いる。そして、干渉ボリューム拡張ブロック450は、ロボットアームの構成要素が占める空間情報に関して合成ベクトルを使用する演算を行う。これにより、ロボットアーム100の構成要素が占める空間情報を膨張させて、拡大済み干渉ボリュームデータ408を生成する。または、干渉ボリューム拡張ブロック450は、部品給材装置200の構成要素が占める空間情報に関して合成ベクトルを使用する演算を行う。これにより、部品給材装置200の構成要素が占める空間情報を膨張させて、拡大済み干渉ボリュームデータ408を生成する。つまり、干渉ボリューム拡張ブロック450は合成ベクトルの大きさと対応する広さの拡大済み干渉ボリュームデータ408を演算する。
The interference
ロボットアームの位置姿勢取得ブロック460は、カメラ装置350が撮影した画像データからロボットアーム100の構成要素の位置と姿勢を算出する。そして、ロボットアームの位置姿勢取得ブロック460はロボットアームの位置姿勢データ405を主記憶装置320に保持する。
The robot arm position /
部品給材装置の位置姿勢取得ブロック461は、カメラ装置350が撮影した画像データから部品給材装置200の構成要素の位置と姿勢を算出する。そして、部品給材装置の位置姿勢取得ブロック461は部品給材装置の位置姿勢データ406として主記憶装置320に保持する。
The position and
干渉チェックブロック470は、ロボットアーム形状データ400、部品給材装置の形状データ401、ロボットアームの位置姿勢データ405、部品給材装置の位置姿勢データ406、干渉領域としての拡大済み干渉ボリュームデータ408を用いる。そして、干渉チェックブロック470は、ロボットアーム100と部品給材装置200との干渉の有無を算出する。そして、干渉チェックブロック470は算出結果である干渉有無データ409を生成する。
The
図4は、ロボットの形状データ構造を示す図である。図4に示すように、ロボットアーム形状データ400はロボットアーム100の構成要素のポリゴン頂点の座標をデータとして保持する。尚、ポリゴン頂点は、各構成要素の表面を三角形にて覆って表面を近似したときの三角形の頂点を示している。ロボットアーム100の基準位置を原点としてポリゴン頂点のX座標、Y座要、Z座標にて記載される。従って、ロボットアーム形状データ400は各構成要素の表面形状を表現するデータとなっている。
FIG. 4 is a diagram illustrating a shape data structure of the robot. As shown in FIG. 4, the robot
図5は、部品給材の形状データ構造を示す図である。図5に示すように、部品給材装置形状データ401は部品給材装置200の構成要素のポリゴン頂点の座標をデータとして保持する。部品給材装置200の基準位置を原点としてポリゴン頂点のX座標、Y座要、Z座標にて記載される。従って、部品給材装置形状データ401は各構成要素の表面形状を表現するデータとなっている。
FIG. 5 is a diagram showing a shape data structure of a component supply material. As shown in FIG. 5, the component supply
図6は、干渉チェックペアリング情報のデータ構造を示す図である。図6に示すように、干渉チェック対象ペアリングデータ402にはロボットアーム100の構成要素と部品給材装置200の構成要素のペアリングが記載されている。尚、ペアリングは一対の組合せを示している。そして、各ペアリングは同じ組合せが重複しないように整理されている。そして、各ペアリングにはインデックスが付与されている。これにより、インデックス順にペアリングを選択することにより、ロボットアーム100の構成要素と部品給材装置200の構成要素の組合せを重複せずに選択することが可能になっている。
FIG. 6 is a diagram illustrating a data structure of interference check pairing information. As shown in FIG. 6, the interference check
図7は、ロボットの並進速度のデータ構造を示す図である。図7に示すように、ロボットアーム並進速度データ403にはロボットアーム100の各構成要素が進行する速度ベクトルをX方向、Y方向、Z方向に分解したデータが記載されている。従って、ロボットアーム並進速度データ403は各構成要素の速度ベクトルを表現するデータとなっている。
FIG. 7 is a diagram illustrating a data structure of the translation speed of the robot. As shown in FIG. 7, the robot arm
図8は、部品給材装置の並進速度のデータ構造を示す図である。図8に示すように、部品給材装置の並進速度データ404には部品給材装置200の各構成要素が進行する速度ベクトルをX方向、Y方向、Z方向に分解したデータが記載されている。従って、部品給材装置の並進速度データ404は各構成要素の速度ベクトルを表現するデータとなっている。
FIG. 8 is a diagram showing a data structure of the translation speed of the component supply device. As shown in FIG. 8, the
図9は、ロボットの位置姿勢のデータ構造を示す図である。図9に示すように、ロボットアームの位置姿勢データ405にはロボットアーム100の各構成要素の位置を、例えば、ロール角、ピッチ角、ヨー角に分解したデータが記載されている。さらに、ロボットアームの位置姿勢データ405にはロボットアーム100の各構成要素の姿勢を表示する方向をX方向、Y方向、Z方向に分解したデータが記載されている。従って、ロボットアームの位置姿勢データ405は各構成要素の位置と姿勢とを表現するデータとなっている。
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
図10は、部品給材装置の位置姿勢のデータ構造を示す図である。図10に示すように、部品給材装置の位置姿勢データ406には部品給材装置200の各構成要素の位置をX方向、Y方向、Z方向に分解したデータが記載されている。さらに、部品給材装置の位置姿勢データ406には部品給材装置200の各構成要素の姿勢を、例えば、ロール角、ピッチ角、ヨー角に分解したデータが記載されている。従って、部品給材装置の位置姿勢データ406は各構成要素の位置と姿勢とを表現するデータとなっている。
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 /
図11は、相対速度のデータ構造を示す図である。図11に示すように、相対速度データ407にはロボットアームの構成要素と部品給材装置の構成要素とのペアリングが記載されている。さらに、各ペアリングにおける相対速度の算出結果が記載されている。従って、相対速度データ407は各ペアリングした構成要素の接近速度を表現するデータとなっている。
FIG. 11 is a diagram illustrating a data structure of relative speed. As shown in FIG. 11, the
図12は、拡大済み干渉ボリュームのデータ構造を示す図である。図12に示すように、拡大済み干渉ボリュームデータ408には干渉チェック対象ペアリングデータ402と同じデータを用いている。さらに、各対となる構成要素のうちどちらを基準とするかを選択した結果が記載されている。そして、相対速度に対応させて拡張したポリゴン頂点の座標が記載されている。従って、拡大済み干渉ボリュームデータ408は相対速度に対応して設定した干渉領域を示すデータとなっている。
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
図13は、干渉有無のデータ構造を示す図である。図13に示すように、干渉有無データ409には干渉チェック対象ペアリングデータ402と同じデータを用いている。さらに、各対の構成要素における干渉の有無を演算した結果が記載されている。従って、干渉有無データ409は各対の構成要素における干渉の有無を示すデータとなっている。
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
(干渉の検出方法)
次に、ロボット制御部300がロボットの干渉チェック方法を実現するときの各機能ブロックの処理の流れについて説明する。
(Interference detection method)
Next, the process flow of each functional block when the
図14は、干渉チェック対象ペアリングブロックフローチャートである。まず、干渉チェック対象ペアリングデータ402を形成する手順を説明する。図14に示すように、まず、ステップS501においてロボットアームの形状データ400を取得する。次に、ステップS502において部品給材装置形状データ401を取得する。その後に、ステップS503においてロボットアームの構成要素と、部品給材装置形状データ401の構成要素とを重複しないペアリングをおこない、干渉チェック対象ペアリングデータ402として保持する。
FIG. 14 is an interference check target pairing block flowchart. First, a procedure for forming the interference check
図15は、相対速度計算ブロックのフローチャートである。次に、相対速度計算ブロック440が相対速度データ407を形成する手順を説明する。図15に示すように、まず、ステップS511においてロボットアーム形状データ400を取得する。次に、ステップS512において部品給材装置形状データ401を取得する。そして、ステップS513において相対速度を演算するペアリングを設定するために、干渉チェック対象ペアリングデータ402を取得する。次に、ステップS514においてロボットの移動方向と速さとを定めたベクトルデータであるロボットアーム並進速度データ403を取得する。ステップS514は第1ベクトルデータを取得する工程に相当する。次に、ステップS515においてワーク搬送装置の移動方向と速さとを定めるベクトルデータである部品給材装置の並進速度データ404を取得する。ステップS515は第2ベクトルデータを取得する工程に相当する。その後に、ステップS516において干渉チェック対象ペアリングデータ402に基づいて、ロボットアーム100の構成要素と部品給材装置200の構成要素との相対速度を算出する。そして、算出した結果を相対速度データ407として保持する。ステップS516は合成ベクトルを演算する工程に相当する。
FIG. 15 is a flowchart of the relative speed calculation block. Next, the procedure in which the relative
図16は、相対速度の演算を説明するための模式図である。図16に示すように、干渉チェック対象ペアリングデータ402から、チャック部141とコンベアベルト230を選択した場合の例にて説明をする。チャック部141が移動する速度ベクトルをチャック並進速度ベクトル600とする。そして、コンベアベルト230の上部が移動する速度ベクトルをベルト並進速度ベクトル610とする。次に、チャック並進速度ベクトル600とベルト並進速度ベクトル610とを用いて第1相対速度ベクトル620または第2相対速度ベクトル621を相対速度計算ブロック440が演算する。そして、演算した結果は相対速度データ407となる。
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
第1相対速度ベクトル620は、チャック部141を基準にとったコンベアベルト230の相対速度であり、チャック部141から観察したコンベアベルト230の並進運動である。第2相対速度ベクトル621は、コンベアベルト230を基準にとったチャック部141の相対速度になるため、コンベアベルト230から観察したチャック部141の並進運動である。
The first
相対速度ベクトルを演算するときに、その基準をチャック部141とするか、コンベアベルト230とするかは、チャック部141の形状寸法データとコンベアベルト230の形状データとのポリゴン情報の容量を比較して選択する。このとき、ポリゴン情報の容量が大きい方を相対速度ベクトルの基準とする。これにより、干渉ボリューム拡張ブロック450が基準でない方の形状寸法データを拡大処理する計算量を削減することができる。つまり、ポリゴン情報の容量が小さい方の構成要素を処理することで、処理量を削減する。
When calculating the relative velocity vector, whether the reference is the
図17は、干渉ボリューム拡張ブロックのフローチャートである。次に、干渉ボリューム拡張ブロック450の処理の流れを説明する。図17に示すように、まず、ステップS521において、ロボットアーム形状データ400を取得する。次に、ステップS522において部品給材装置の形状データ401を取得する。続いて、ステップS523において、ロボットアーム並進速度データ403と部品給材装置の並進速度データ404とを合成した相対速度データ407を取得する。その後に、ステップS524において、拡大済み干渉ボリュームデータ408を生成し、保持する。ステップS524は干渉領域を演算する工程に相当する。以上で、干渉ボリューム拡張ブロック450が実施する工程を終了する。
FIG. 17 is a flowchart of the interference volume expansion block. Next, the process flow of the interference
ステップS524を詳細に説明する。ロボットアーム100の構成要素と部品給材装置200の構成要素のうち、相対速度データ407の基準でない方の形状データを相対速度データ407の方向と大きさに基づいて干渉ボリューム拡張ブロック450は拡大処理の演算を行なう。拡大処理は(数式1)を適用する。
Step S524 will be described in detail. Among the components of the
(数式1)において、右辺のx、y、zは形状データのポリゴン頂点のx方向位置、y方向位置、z方向位置、u、v、wは相対速度データ407のx方向成分、y方向成分、z方向成分、αは拡大率調整のパラメーター(αはゼロ以上、1.0以下とする)である。左辺のx、y、zは拡大処理済み形状データのポリゴン頂点のx方向位置、y方向位置、z方向位置である。(数式1)により、相対速度データの速度成分が大きな方向は、より大きな拡大率になる。
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.
図18は、拡大済み干渉ボリュームを説明するための模式図である。相対速度データ407から、チャック部141とコンベアベルト230が対象となる例を示す。図18(a)では、チャック部141が基準となっている。このとき、干渉ボリューム拡張ブロック450はコンベアベルト230の第1相対速度ベクトル620を用いる。第1相対速度ベクトル620はx方向およびz方向に成分があるくベクトルとなっている。そして、干渉ボリューム拡張ブロック450はz方向と比較してx方向に大きく拡大したコンベアベルト230の干渉領域としての拡大済み干渉ボリュームデータ700を算出する。
FIG. 18 is a schematic diagram for explaining an enlarged interference volume. An example in which the
図18(b)では、コンベアベルト230が基準となっている。このとき、干渉ボリューム拡張ブロック450はチャック部141の第2相対速度ベクトル621を用いる。第2相対速度ベクトル621はx方向およびz方向に成分があるベクトルとなっている。そして、干渉ボリューム拡張ブロック450はz方向と比較してx方向に大きく拡大したチャック部141の干渉領域としての拡大済み干渉ボリュームデータ701を算出する。つまり、干渉ボリューム拡張ブロック450は合成ベクトルの大きさと対応する広さの拡大済み干渉ボリュームデータ700及び拡大済み干渉ボリュームデータ701を演算する。
In FIG. 18B, the
図19は、干渉チェックブロックのフローチャートである。次に、干渉チェックブロック470の処理の流れを説明する。図19に示すように、まず、ステップS531において、干渉チェックブロック470は干渉領域としての拡大済み干渉ボリュームデータ408を取得する。次に、ステップS532において、干渉チェックブロック470は拡大済み干渉ボリュームデータ408においてロボットアーム100と部品給材装置200とのうちどちらが基準であるかを参照する。基準がロボットアーム100の場合は、ステップS533において干渉チェックブロック470はロボットアーム形状データ400を取得する。基準が部品給材装置200場合は、ステップS534において部品給材装置形状データ401を取得する。次に、ステップS535においてロボットアームの位置姿勢データ405を取得する。続いて、ステップS536において部品給材装置の位置姿勢データ406を取得する。次に、ステップS537において干渉の有無を計算する。ステップS537は干渉の有無を確認する工程に相当する。以上で、干渉ボリューム拡張ブロック450が実施する工程を終了する。
FIG. 19 is a flowchart of the interference check block. Next, the processing flow of the
ステップS537を詳細に説明する。干渉ボリューム拡張ブロック450は、拡大済み干渉ボリュームデータ408とロボットアームの形状データ400あるいは部品給材装置の形状データ401とをロボットアームの位置姿勢データ405及び部品給材装置の位置姿勢データ406に従って配置する。そして、干渉ボリューム拡張ブロック450はロボットアーム100と部品給材装置200との干渉の有無を確認するための交差判定計算を行う。その結果得られる干渉の有無を干渉ボリューム拡張ブロック450は干渉有無データ409として保持する。
Step S537 will be described in detail. The interference
交差判定計算において干渉ボリューム拡張ブロック450は、細分化された作業空間要素が木構造で連なるデータ構造により表現される作業空間を用意する。そして、拡大済み干渉ボリュームデータ408をロボットアームの位置姿勢データ405及び部品給材装置の位置姿勢データ406に従って配置する。拡大済み干渉ボリュームデータ408とロボットアーム形状データ400あるいは部品給材装置形状データ401とに関して、隣接する細分化した作業空間要素にない形状データ同士の交差判定計算を省略する処理を行う。そして、省略されない作業空間要素に対して干渉の有無を演算する。
In the intersection determination calculation, the interference
図20は、ロボット制御部300がロボットの干渉チェックを実現するときの処理の流れであり、ロボットの干渉チェック手順を示すフローチャートである。図20に示すように、まず、ステップS801において干渉チェック対象ペアリングブロック420が干渉チェック対象ペアリングデータ402を生成する。次に、ステップS802においてロボット動作命令やロボット動作に基づいて相対速度計算ブロック440が相対速度データ407を生成する。続いて、ステップS803において干渉ボリューム拡張ブロック450が拡大済み干渉ボリュームデータ408を生成する。次に、ステップS804において干渉チェックブロック470が干渉有無データ409を生成する。続いて、ステップS805においてCPU310が干渉有無データ409を参照する。干渉が無い場合はステップS806においてロボットアーム100は引き続いてロボット動作を実行する。干渉がある場合はステップS807においてロボットアーム100を停止させてから、干渉有りを意味する警告表示を行う。以上で、ロボットの干渉をチェックする工程を終了する。
FIG. 20 is a flow chart showing a process flow when the
上述したように、本実施形態によれば、以下の効果を有する。
(1)本実施形態によれば、ロボットアーム並進速度データ403と部品給材装置の並進速度データ404とから相対速度データ407が演算される。そして、相対速度データ407に従って、定められたデータテーブルを参照して拡大済み干渉ボリュームデータ408を演算している。部品給材装置200及びロボットアーム100の移動方向と速さの双方が含まれる相対速度データ407が示す合成ベクトル方向は相対的に移動する方向を示している。この方向は、干渉の可能性がある方向である。そして、合成ベクトルの大きさは速さと相関を有する為、合成ベクトルは相対移動速度を考慮した拡大済み干渉ボリュームデータ408を算出できる。これにより、拡大済み干渉ボリュームデータ408は相対移動速度と対応する合成ベクトルの大きさの分だけに広がりを持たせて算出されている。従って、干渉計算が離散的に計算されるときにおいても干渉を防止可能な演算を行うことができる。
As described above, this embodiment has the following effects.
(1) According to the present embodiment, the
さらに、ロボットアーム100が移動する場所と部品給材装置200が移動する場所とから供給部品210が干渉する領域を算出する方法がある。この方法に比べて、合成ベクトルを用いて供給部品210が干渉する領域を算出する方が、干渉計算の計算を簡単に行うことができる。
Further, there is a method of calculating an area where the
(2)本実施形態によれば、ロボットアーム並進速度データ403と部品給材装置の並進速度データ404とのどちらか一方を基準ベクトルデータとしている。合成ベクトルに応じた干渉領域を演算するときロボットアーム100を基準とする干渉領域と部品給材装置200を基準とする干渉領域との二通りの干渉領域を算出できる。そして、ロボットアーム100を基準とする干渉領域の広がりと部品給材装置200を基準とする干渉領域の広がりのいずれかを選択できる。従って、より計算時間が短い方を基準として干渉計算を実行することにより、計算時間を短くすることができる。
(2) According to the present embodiment, either one of the robot arm
(3)本実施形態によれば、ロボットアーム並進速度データ403と部品給材装置の並進速度データ404とのどちらか一方を基準ベクトルデータとして定めている。このときに、ロボットアーム100及び部品給材装置200の形状に応じてどちらか一方を選択している。例えば複雑な形状である場合、形状に関するデータ数が多くなる。従って、複雑な形状が移動する領域を演算する方が単純な形状が移動するときに比べて演算時間がかかる。合成ベクトルの大きさの分だけ広がりを持つ拡大済み干渉ボリュームデータ408を演算するときに、ロボットアーム100を基準に干渉領域を演算する場合と、部品給材装置200を基準に干渉領域を演算する場合とで、より演算量が少なくなる方を選択することが可能である。従って、拡大済み干渉ボリュームデータ408の計算時間を短くすることができる。
(3) According to the present embodiment, one of the robot arm
(4)本実施形態によれば、ロボットアーム100及び部品給材装置200の移動方向と速さの双方が含まれる合成ベクトル方向にのみ合成ベクトルの大きさの分だけ広がりを持つ拡大済み干渉ボリュームデータ408を算出している。そして、計算時間を抑制しながら適切な干渉計算を実行している。これにより、実際のロボット動作に先立って干渉有無データ409を確認し、この干渉有無データ409に応じたロボットの制御を行うことができる。これによって、部品給材装置200とロボットアーム100との干渉を回避するロボット制御が可能になる。
(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
(実施形態2)
次に、本発明のロボットアームとロボットアームが行う干渉チェック方法について図21〜図26を用いて説明する。本実施形態が実施形態1と異なるところは、ロボットアーム及び部品給材装置が相対移動する回転成分を考慮して干渉チェックを行う点にある。尚、本実施形態において、上記の実施形態1と同様の部材または部位については同じ符号を付し、詳細な説明は省略する。
(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
図21は、ロボット制御部が実現する機能を示す機能ブロック図である。すなわち、図21に示すように、相対速度計算ブロック440は、ロボットアーム並進速度データ403及び部品給材装置の並進速度データ404から第1ベクトルデータと第2ベクトルデータとを合成した回転合成ベクトルとしての相対速度データ407を計算する。さらに、ロボット制御部300は、ロボットの回転方向と回転速さとを定める第3ベクトルデータとしてのロボットアームの回転速度データ410を備える。さらに、部品給材装置200の回転方向と回転速さとを定めたベクトルデータである第4ベクトルデータとしての部品給材装置の回転速度データ411を備える。さらに、ロボット制御部300は第3ベクトルデータと第4ベクトルデータとを合成した回転合成ベクトルとしての相対回転速度データ412を演算する相対回転速度計算ブロック490を備えている。
FIG. 21 is a functional block diagram illustrating functions realized by the robot control unit. That is, as shown in FIG. 21, the relative
ロボット制御部300はロボットアームの回転速度取得ブロック480を備えている。ロボットアームの回転速度取得ブロック480は、カメラ装置350が作業空間を撮影して得られる画像データからロボットアーム100の構成要素の回転方向と速さを検出する。そして、ロボットアームの回転速度取得ブロック480はロボットアームの回転速度データ410を保持する。
The
ロボット制御部300は部品給材装置の回転速度取得ブロック481を備えている。部品給材装置の回転速度取得ブロック481は、カメラ装置350が作業空間を撮影して得られる画像データから部品給材装置200の構成要素の回転方向と速さを検出する。そして、部品給材装置の回転速度取得ブロック481は部品給材装置の回転速度データ411を保持する。
The
ロボット制御部300は相対回転速度計算ブロック490を備えている。相対回転速度計算ブロック490は、干渉チェック対象ペアリングデータ402と、ロボットアームの回転速度データ410と、部品給材装置の回転速度データ411とを参照する。そして、相対回転速度計算ブロック490は干渉チェック対象ペアリングデータ402でペアリングされているロボットアームの構成要素の回転速度と部品給材装置の構成要素の回転速度との差を算出する。これにより、相対回転速度計算ブロック490はロボットアームの回転速度データ410と部品給材装置の回転速度データ411とを合成した相対回転速度データ412を生成する。
The
干渉ボリューム拡張ブロック450は相対速度データ407及び相対回転速度データ412及び定められたデータテーブルを参照して拡大済み干渉ボリュームデータ408を演算する。このとき、干渉ボリューム拡張ブロック450は、さらに、ロボットアーム形状データ400あるいは部品給材装置形状データ401と相対速度データ407と相対回転速度データ412とを参照する。そして、干渉ボリューム拡張ブロック450は、ロボットアーム100の構成要素あるいは部品給材装置200の構成要素が占める空間情報を合成ベクトルを演算によって膨張させた拡大済み干渉ボリュームデータ408を生成する。
The interference
ロボットアーム100の移動方向と速さ及び部品給材装置200の移動方向と速さに加えて、ロボットアーム100の回転方向と回転速さ及びワーク搬送装置の回転方向と回転速さが含まれる合成ベクトル方向にのみ合成ベクトルの大きさの分だけ広がりを持つ干渉領域を干渉ボリューム拡張ブロック450が算出する。これにより、部品給材装置200の回転方向と回転速さ及びロボットアーム100の回転方向と回転速さに関して離散的に計算される干渉計算において、干渉しないとされた動作が実際のロボット動作で干渉するといったケースを発見することができ、より確実な干渉の有無を取得できる。
In addition to the movement direction and speed of the
ロボットの回転方向と回転速さとを定めたベクトルデータであるロボットアームの回転速度データ410は、ロボット制御装置340による動作命令から演算される。あるいは、ロボットアームの回転速度データ410はカメラ装置350が検出するロボットアーム100の構成要素の回転速度データであり、定められたデータテーブルとして主記憶装置320に保持されている。
Robot arm
部品給材装置の回転速度データ411は、部品給材装置200の回転方向と回転速さとを定めるベクトルデータである。そして、部品給材装置の回転速度データ411はカメラ装置350が検出する部品給材装置200の構成要素の回転速度データである。部品給材装置の回転速度データ411は定められたデータテーブルとして主記憶装置320に保持される。
The
図22は、ロボットの回転速度のデータ構造を示す図である。図22に示すように、ロボットアームの回転速度データ410にはロボットアーム100の各構成要素が回転する回転速度ベクトルをX軸周り、Y軸周り、Z軸周りに分解したデータが記載されている。従って、ロボットアームの回転速度データ410は各構成要素の回転速度ベクトルを表現するデータとなっている。
FIG. 22 is a diagram illustrating a data structure of the rotation speed of the robot. As shown in FIG. 22, the
図23は、部品給材装置の回転速度のデータ構造を示す図である。図23に示すように、部品給材装置の回転速度データ411には部品給材装置200の各構成要素が回転する回転速度ベクトルをX軸周り、Y軸周り、Z軸周りに分解したデータが記載されている。従って、部品給材装置の回転速度データ411は各構成要素の回転速度ベクトルを表現するデータとなっている。
FIG. 23 is a diagram illustrating a data structure of the rotation speed of the component supply device. As shown in FIG. 23, the
図24は、相対速度計算ブロックのフローチャートである。図24に示すように、まず、ステップS541において相対回転速度計算ブロック490はロボットアームの形状データ400を取得する。次に、ステップS542において相対回転速度計算ブロック490は部品給材装置形状データ401を取得する。続いて、ステップS543において相対速度を演算するペアリングを設定するために、相対回転速度計算ブロック490は干渉チェック対象ペアリングデータ402を取得する。
FIG. 24 is a flowchart of the relative speed calculation block. As shown in FIG. 24, first, in step S541, the relative rotational
次に、ステップS544において相対回転速度計算ブロック490はロボットアームの回転速度データ410を取得する。ステップS544は第3ベクトルデータを取得する工程に相当する。続いて、ステップS545において部品給材装置200の回転方向と回転速さとを定めるベクトルデータである部品給材装置の回転速度データ411を取得する。ステップS545は第4ベクトルデータを取得する工程に相当する。
Next, in step S544, the relative rotational
その後、ステップS546において干渉チェック対象ペアリングデータ402に基づいて、ロボットアーム100の構成要素と部品給材装置200の構成要素との相対回転速度を計算する。そして、相対回転速度計算ブロック490はロボットアームの回転速度データ410と部品給材装置の回転速度データ411とを合成した相対回転速度データ412として保持する。ステップS546は回転合成ベクトルを演算する工程に相当する。以上で、相対回転速度計算ブロック490が実施する工程を終了する。
Thereafter, in step S546, based on the interference check
ステップS546を詳細に説明する。図25は、相対回転速度データを説明するための模式図である。干渉チェック対象ペアリングデータ402から、チャック部141とコンベアベルト230が対象となる場合の例を用いて説明する。相対回転速度計算ブロック490はチャック部141の回転速度ベクトル630とコンベアベルト230の上部の回転速度ベクトル640とから相対回転速度ベクトル650を演算する。相対回転速度ベクトル650のデータが相対回転速度データ412となる。相対回転速度ベクトル650は、コンベアベルト230を基準にとったチャック部141の相対回転速度になる。従って、相対回転速度ベクトル650はコンベアベルト230から観察したチャック部141の回転運動である。もちろん、チャック部141を基準とすることも可能である。
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
相対回転速度ベクトルを演算するとき相対回転速度計算ブロック490は基準をチャック部141とするか、コンベアベルト230とするかを選択する。相対回転速度計算ブロック490はチャック部141の形状寸法データとコンベアベルト230の形状データとのポリゴン情報の大きさを比較する。そして、相対回転速度計算ブロック490はポリゴン情報の大きさが大きい方を相対回転速度ベクトルの基準とする。これにより、干渉ボリューム拡張ブロック450で基準でない方の形状寸法データを拡大処理するときにポリゴン情報の大きさが小さい方を処理することで計算量を削減することができる。
When calculating the relative rotational speed vector, the relative rotational
図26は、干渉チェックブロック470の処理の流れであり、ロボットの干渉チェック手順を示すフローチャートである。図26に示すように、まず、ステップS551において干渉領域としての拡大済み干渉ボリュームデータ408を取得する。次に、ステップS552において拡大済み干渉ボリュームデータ408を参照して、干渉チェックブロック470はロボットアーム100と部品給材装置200のうち、どちらが基準であるかを判断する。基準がロボットアーム100の場合は、ステップS553においてロボットアーム形状データ400を取得する。基準が部品給材装置200場合は、ステップS554において部品給材装置形状データ401を取得する。そして、ステップS555においてロボットアームの位置姿勢データ405を取得する。次に、ステップS556において部品給材装置の位置姿勢データ406を取得する。
FIG. 26 is a flowchart of the process of the
この後、ステップS557において相対回転速度データ412を拡大済み干渉ボリュームデータ408に反映させるための回転量θを0に初期設定する。つまり回転無しに初期設定する。ステップS558においてこの回転量θの絶対値と相対回転速度データ412の絶対値との比較を行う。回転量θの絶対値が相対回転速度データ412の絶対値よりも小さい場合には、ステップS559において回転量θ分だけ拡大済み干渉ボリュームデータ408を回転変換する処理を行う。ステップS560において回転量分だけ回転変換処理された拡大済み干渉ボリュームデータ408と、ロボットアーム形状データ400あるいは部品給材装置形状データ401とを、ロボットアームの位置姿勢データ405及び部品給材装置の位置姿勢データ406に従って配置する。ステップS560は干渉領域を演算する工程に相当する。ロボットアーム100と部品給材装置200との干渉の有無を確認する交差判定計算を行う。その結果得られる干渉の有無を干渉有無データ409として保持する。そして、ステップS561において回転量θに対して相対回転速度データ412と同じ向きの回転増分dθを加算する。尚、dθの方向は相対回転速度と一致させる。
Thereafter, in step S557, the rotation amount θ for reflecting the relative
ステップS559では、ステップS524と同様に数式を作成して、演算しても良い。他の方法を用いても良い。例えば、実験から干渉する確立を求めて拡大処理する係数を記載したデータテーブルを作成する。尚、データテーブルは数式を元にして作成してもよく、数式を元に算出した値を実験データを考慮して修正してもよい。そして、拡大処理の演算を行なうときにはデータテーブルの係数を用いて行う。 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.
ロボットアーム100と部品給材装置200が干渉の有無を確認するために交差判定計算を行う。このときに、細分化された作業空間要素が木構造で連なるデータ構造により表現される作業空間を用意する。そして、拡大済み干渉ボリュームデータ408はロボットアームの位置姿勢データ405及び部品給材装置の位置姿勢データ406に従って配置されるとともに、回転量分だけ回転変換処理が行なわれる。拡大済み干渉ボリュームデータ408、ロボットアーム形状データ400あるいは部品給材装置形状データ401に関して、隣接する細分化した作業空間要素にない形状データ同士の交差判定計算を省略する処理を行う。そして、省略されない作業空間要素に対して干渉の有無を演算する。
The
以上において、ロボットアーム100とワーク搬送装置としての部品給材装置200との干渉を確認する実施形態について示したが、ロボットとしてロボットアーム同士の干渉の確認についても上記実施形態と同様の方法を行うことが可能である。同様に、部品給材装置200にある供給部品210,211,212や他のワークとロボットアーム100との干渉の確認を行いたい場合も、上記実施形態と同様の方法が適用可能である。
In the above description, the embodiment for confirming the interference between the
さらに、上述の干渉チェック方法は、実施形態1の内容も含めてプログラムとして提供することもできる。このようなプログラムは、コンピューターに付属するCD−ROM、DVD−ROM、メモリカード等のコンピューター読取り可能な記録媒体にて記録させて、プログラム製品として提供することもできる。あるいは、ネットワークを介したダウンロードによって、プログラム製品を提供することもできる。提供されるプログラム製品は、ハードディスク等の補助記憶装置にインストールされて実行される。尚、プログラム製品は、プログラム自体と、プログラムが記録された記録媒体とを含む。 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.
上述したように、本実施形態によれば以下の効果を有する。
(1)本実施形態によれば、ロボットアーム100の回転方向と回転速さ及び部品給材装置200の回転方向と回転速さが含まれる合成ベクトル方向にのみ合成ベクトルの大きさの分だけ広がりを持つ拡大済み干渉ボリュームデータ408を算出できる。これにより、計算時間を抑制しながら適切な干渉計算を実行することができる。さらに、部品給材装置200の回転方向と回転速さ及びロボットアーム100の回転方向と回転速さに関して離散的に計算するときにもロボットアーム100と部品給材装置200の干渉を防止できる。
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)本実施形態によれば、ロボットアームの回転速度データ410と部品給材装置の回転速度データ411とのどちらか一方を基準ベクトルとしている。相対回転速度データ412に応じた拡大済み干渉ボリュームデータ408を演算するとき、ロボットアーム100を基準とする拡大済み干渉ボリュームデータ408と部品給材装置200を基準とする拡大済み干渉ボリュームデータ408との二通りを算出できる。そして、ロボットアーム100を基準とする拡大済み干渉ボリュームデータ408が示す干渉領域の広がりと部品給材装置200を基準とする拡大済み干渉ボリュームデータ408が示す干渉領域の広がりのいずれかを選択できる。従って、より計算時間が短い方を基準として干渉計算を実行することにより、計算時間を短くすることができる。
(2) According to the present embodiment, one of the
(3)本実施形態によれば、ロボットアームの回転速度データ410と部品給材装置の回転速度データ411とのどちらか一方を基準ベクトルのデータとして定めている。このときに、ロボットアーム100及び部品給材装置200の形状に応じてどちらか一方を選択している。例えば複雑な形状である場合、形状に関するデータ数が多くなる。従って、複雑な形状が移動する領域を演算する方が単純な形状が移動する領域を演算するときに比べて演算時間がかかる。干渉ボリューム拡張ブロック450は相対回転速度データ412が示す合成ベクトルの大きさの分だけ広がりを持つ拡大済み干渉ボリュームデータ408を演算する。このときに、干渉ボリューム拡張ブロック450はロボットアーム100を基準に拡大済み干渉ボリュームデータ408を演算する場合と、部品給材装置200を基準に拡大済み干渉ボリュームデータ408を演算する場合とで、より演算量が少なくなる場合を選択することが可能である。従って、より計算時間が短い方を基準として干渉計算を実行することにより、ロボット制御部300は計算時間を短くすることができる。
(3) According to the present embodiment, one of the
(4)本実施形態によれば、ロボットアーム100及び部品給材装置200の移動方向と速さに加えて、ロボットアーム100及び部品給材装置200の回転方向と回転速度が含まれる合成ベクトル方向にのみ合成ベクトルの大きさの分だけ広がりを持つ拡大済み干渉ボリュームデータ408が示す干渉領域を算出している。そして、計算時間を抑制しながら適切な干渉計算を実行している。これにより、実際のロボットアーム100の動作に先立って干渉領域を確認しこの干渉領域に応じたロボットアーム100の制御を行うことができる。これによって、部品給材装置200とロボットアーム100との干渉を回避するロボット制御が可能になる。または、ロボットアーム100同士の干渉を回避するロボットアーム100の制御が可能になる。従って、供給部品210の搬送状態に左右されることの無い連続可動が可能なロボットアーム100の制御を実現できる。または、複数のロボットの状態に左右されることの無い連続可動が可能なロボット制御を実現できる。
(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.
(変形例1)
実施形態1において、ロボットアーム100と部品給材装置200との干渉を演算した。部品給材装置200には供給部品210が含まれていてもよい。チャック部141が供給部品210を把持する前に供給部品210がロボットアーム100と干渉することを防止することができる。
(Modification 1)
In the first embodiment, the interference between the
(変形例2)
実施形態1において、ロボットアーム100は6軸ロボットアームとしたが、ロボットアーム100はこの形態のロボットアームに限らない。2軸〜5軸のロボットアームでも良く、7軸以上のロボットアームでも良い。さらに、水平多関節ロボット、直交ロボット、パラレルリンクロボット等の各種類の形態のロボットにも適用することができる。
(Modification 2)
In the first embodiment, the
(変形例3)
実施形態1において、部品給材装置200はコンベアベルト230を駆動して供給部品210を移動した。部品給材装置200が供給部品210を移動する形態は他の形態でも良い。回転式ローラーを複数配置しても良く、直動機構を用いて供給部品210を移動させても良い。他にも運搬車に載せて供給部品210を移動させてもよい。いずれの方式においてもロボットアーム100との干渉防止に適用することができる。尚、変形例1〜変形例3は実施形態2にも適用することができる。
(Modification 3)
In the first embodiment, the
100…ロボットとしてのロボットアーム、200…ワーク搬送装置としての部品給材装置、210…ワークとしての供給部品、400…データテーブルとしてのロボットアーム形状データ、401…データテーブルとしての部品給材装置形状データ、403…第1ベクトルデータとしてのロボットアーム並進速度データ、404…第2ベクトルデータとしての部品給材装置の並進速度データ、407…合成ベクトル及び回転合成ベクトルとしての相対速度データ、408,700,701…干渉領域としての拡大済み干渉ボリュームデータ、410…第3ベクトルデータとしてのロボットアームの回転速度データ、411…第4ベクトルデータとしての部品給材装置の回転速度データ、412…合成回転ベクトルとしての相対回転速度データ。
DESCRIPTION OF
Claims (8)
前記ロボットの移動方向と速さとを定めたベクトルデータである第1ベクトルデータを取得する工程と、前記ワーク搬送装置の移動方向と速さとを定めるベクトルデータである第2ベクトルデータを取得する工程と、
前記第1ベクトルデータと前記第2ベクトルデータとを合成した合成ベクトルを演算する工程と、
前記合成ベクトル及び所定のデータテーブルを参照して前記合成ベクトルの大きさと対応する広さの干渉領域を演算する工程と、
前記干渉領域から前記ロボットと前記ワーク搬送装置との干渉の有無を確認する工程と、を含むことを特徴とする干渉チェック方法。 An interference check method for checking interference between a robot capable of moving in at least one direction and a work transfer device operating in at least one direction,
Obtaining first vector data that is vector data defining the moving direction and speed of the robot; obtaining second vector data being vector data defining the moving direction and speed of the work transfer device; ,
Calculating a combined vector obtained by combining the first vector data and the second vector data;
Calculating 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 presence / absence of interference between the robot and the workpiece transfer device from the interference region.
前記ワーク搬送装置の回転方向と回転速さとを定めるベクトルデータである第4ベクトルデータを取得する工程と、
前記第3ベクトルデータと前記第4ベクトルデータとを合成した回転合成ベクトルを演算する工程と、
前記合成ベクトル及び前記回転合成ベクトル及び所定のデータテーブルを参照して前記合成ベクトルの大きさと対応する広さの干渉領域を演算する工程と、を含むことを特徴とする請求項1乃至請求項3のいずれか一項に記載の干渉チェック方法。 Obtaining third vector data which is vector data defining a rotation direction and a rotation speed of the robot;
Obtaining fourth vector data, which is vector data that defines 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;
4. A step of calculating an interference area having a size corresponding to the size of the synthesized vector with reference to the synthesized vector, the rotated synthesized vector, and a predetermined data table. The interference check method according to any one of the above.
前記第1ロボットの移動方向と速さとを定めるベクトルデータである第1ベクトルデータを取得する工程と、
前記第2ロボットの移動方向と速さとを定めたベクトルデータである第2ベクトルデータを取得する工程と、
前記第1ベクトルデータと前記第2ベクトルデータとを合成した合成ベクトルを演算する工程と、
前記合成ベクトル及び所定のデータテーブルを参照して前記合成ベクトルの大きさと対応する広さの干渉領域を演算する工程と、
前記干渉領域から、前記第1ロボットと前記第2ロボットとの干渉の有無を確認する工程と、を含むことを特徴とする干渉チェック方法。 An interference check method for checking interference between a first robot capable of moving in at least one direction and a second robot capable of moving in at least one direction,
Obtaining first vector data which is vector data defining a moving direction and speed of the first robot;
Obtaining second vector data which is vector data defining a moving direction and speed of the second robot;
Calculating a combined vector obtained by combining the first vector data and the second vector data;
Calculating 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 presence / absence of interference between the first robot and the second robot from the interference area.
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 true JP2012139806A (en) | 2012-07-26 |
JP2012139806A5 JP2012139806A5 (en) | 2014-02-06 |
JP5754138B2 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) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014180724A (en) * | 2013-03-19 | 2014-09-29 | Yaskawa Electric Corp | Robot system and manufacturing method of work piece |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62168287U (en) * | 1986-04-14 | 1987-10-26 | ||
JP2008065755A (en) * | 2006-09-11 | 2008-03-21 | Hitachi Ltd | Mobile device |
-
2011
- 2011-01-06 JP JP2011000978A patent/JP5754138B2/en not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62168287U (en) * | 1986-04-14 | 1987-10-26 | ||
JP2008065755A (en) * | 2006-09-11 | 2008-03-21 | Hitachi Ltd | Mobile device |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014180724A (en) * | 2013-03-19 | 2014-09-29 | Yaskawa Electric Corp | Robot system and manufacturing method of work piece |
Also Published As
Publication number | Publication date |
---|---|
JP5754138B2 (en) | 2015-07-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5765355B2 (en) | Robot picking system and workpiece manufacturing method | |
JP4560658B2 (en) | Control device for legged mobile robot | |
JP5426719B2 (en) | Robot system motion simulation device | |
EP2660013B1 (en) | Method of controlling seven-shaft multi-joint robot, control program, and robot control device | |
KR101633357B1 (en) | Manipulator and control method thereof | |
JP6706489B2 (en) | Robot direct teaching method | |
US20160158936A1 (en) | Collision avoidance method, control device, and program | |
JP2014024162A (en) | Robot system, robot control device, robot control method and robot control program | |
JP2006048244A (en) | Working program generating device | |
JP5250858B2 (en) | Multiple robot collision detection method and robot apparatus | |
WO2001038048A1 (en) | Robot controller | |
JP2010201592A (en) | Method for generating operation route for robot | |
JP2018111155A (en) | Robot control device, robot and robot system | |
JP2007286976A (en) | Robot simulation apparatus | |
JP2011062793A (en) | Control device for robot | |
JP2004094399A (en) | Control process for multi-joint manipulator and its control program as well as its control system | |
WO2015137162A1 (en) | Control device, robot system, and method for generating control data | |
JP7144754B2 (en) | Articulated robots and articulated robot systems | |
KR101787865B1 (en) | Inverse kinematic solution for multi-joint link mechanism, and device for creating instructional data by using inverse kinematic solution | |
JP5754138B2 (en) | Robot system and robot | |
JP2011131326A (en) | Method for avoiding interference of robot arm | |
JP7314215B2 (en) | Simulator, robot teaching device, robot system, article manufacturing method, simulation method, program and recording medium | |
JP4745921B2 (en) | Control method of welding robot | |
JP3579742B2 (en) | Teaching data correction method, correction program and correction device | |
JP6273783B2 (en) | Tool tip information correction program, tool tip information correction apparatus, and tool tip information correction method |
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 |