JPS59102583A - Palletizing method in industrial robot - Google Patents

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。(57) [Summary] This bulletin contains application data before electronic filing, so abstract data is not recorded.

Description

【発明の詳細な説明】 本発明は工業用ロボットにおけるパレタイジング方法に
係り、ワークの厚さにバラツキがあっても正確にワーク
上の把持点へ工業用ロボットの把持部を位置決めできる
パレタイジング方法に関する。DETAILED DESCRIPTION OF THE INVENTION The present invention relates to a palletizing method for an industrial robot, and more particularly, to a palletizing method that can accurately position the gripping section of an industrial robot to a gripping point on a workpiece even if the thickness of the workpiece varies.

工業用ロボットは予め教示されたロボット指令データに
基いてハンドを移動させ工作機械へのワークの着脱作業
、工具交換作業、パレット上へのワークの積上げ作業、
パレット上のワークの積み降し作業（パレタイジング）
、その他の作業を実行する。か又るロボット動作のうち
、パレタイジング動作は、教示モードにおいて第１図に
示す如く複数のワーク積み上げ或いは積み降し位置Ｐ１
゜Ｐ２・・・・・・・・・・・・・・・Ｐ、？−Ｌと、
最初の列の最上段ワークＷｔと最下段ワークｗｂの把持
位置Ｐｔ１Ｐｂを教示しておくことにより、再生時これ
ら位置データを用いて所望のワークの把持位置を自動的
に演算し、該ワークを所望位置に積み上げ或いはワーク
を所望位置から積み降す。Industrial robots move their hands based on robot command data taught in advance to load and unload workpieces onto machine tools, change tools, stack workpieces on pallets,
Loading and unloading workpieces on pallets (palletizing)
, perform other tasks. Among the robot operations, the palletizing operation is performed at multiple workpiece stacking or unloading positions P1 as shown in FIG. 1 in the teaching mode.
゜P2・・・・・・・・・・・・P,? -L and
By teaching the gripping positions Pt1Pb of the top workpiece Wt and the bottom workpiece wb in the first row, the gripping position of the desired workpiece is automatically calculated using these position data during playback, and the workpiece is moved to the desired position. Stack the workpieces at the desired position or unload them from the desired position.

そして、か又るパレタイジングによれば教示時間の短縮
とデータメモリの節約が図れる。尚、各列のｍ段目のワ
ーク把持位置Ｚｍは次式により演算される。Further, by using the palletizing method, teaching time can be shortened and data memory can be saved. Note that the m-th workpiece gripping position Zm in each row is calculated by the following equation.

但し、第２図を参照するとＺｎは最上段のワークＷｔの
把持部Ｍ、Ｚｔは最下段のワークｗｂの把持位置、Ｚｍ
は第ｍ段目のワークＷｍの把持位置、ｎは撮大積み重ね
数である。However, referring to FIG. 2, Zn is the gripping part M of the uppermost workpiece Wt, Zt is the gripping position of the lowermost workpiece wb, and Zm
is the gripping position of the m-th workpiece Wm, and n is the number of stacked images.

ところで、か匁るパレタイジング動作によればワークの
厚さが均一の場合には正しくワーク上の把持位置へロボ
ットの、把持部を位置決めでき、理想的にワークを把持
することができるが、ワークの厚みに誤差があると正し
いワーク上の把持位置で該ワークを把持することができ
ない。By the way, according to the crawling palletizing operation, if the thickness of the workpiece is uniform, the gripping part of the robot can be correctly positioned to the gripping position on the workpiece, and the workpiece can be gripped ideally. If there is an error in the thickness, the workpiece cannot be gripped at the correct gripping position on the workpiece.

以上から、本発明はワークの厚さにバラツキがあっても
正確なワーク上の把持位置でワークを把持することがで
きるパレタイジング方法を提供することを目的とする。In light of the above, an object of the present invention is to provide a palletizing method that can grip a workpiece at an accurate gripping position on the workpiece even if the thickness of the workpiece varies.

以下、本発明を図面に従って詳述する。第３図は本発明
の概略説明図である。さて、本発明においてｍ段のワー
クＷｍを把持するには、まず各ワークの厚みが均一であ
るとしたときのｍ段目のワーク上面（第３図点線参照）
より一定距離ぷ。の位置ＺｍをＺｌ　、　Ｚｎ、　ｎ、
　ｍ、−ｅｃを用いて演算し）該位置Ｚｍに把持部（ｌ
を位置決めする。しかる後把持部ＧＲＫ設けた距離セン
サｌ）Ｓによりワ−りＷｍの上面迄の距離扇を測定する
。尚、距離センサとしては超音波を用いたものが知られ
ている。Hereinafter, the present invention will be explained in detail with reference to the drawings. FIG. 3 is a schematic explanatory diagram of the present invention. Now, in the present invention, in order to grip the m-stage workpiece Wm, first the upper surface of the m-th stage workpiece (see the dotted line in Figure 3) assuming that the thickness of each workpiece is uniform.
More constant distance. Let the position Zm be Zl , Zn, n,
m, -ec) is placed at the position Zm.
position. Thereafter, the distance fan to the upper surface of the workpiece Wm is measured by the distance sensor l)S provided on the gripping part GRK. Note that distance sensors using ultrasonic waves are known.

距離、１３ｏが得られ匁ばワーク上面から把持位置ｔ３
　Ｐ迄の距離Ｇと２０の和を演算し、（Ｇ＋、、ｇｏ　
）に相当する量把持部ＧＲを下方へ移動させれば、把持
部ＧＲはワークＷｍの把持位置ＧＰに正確に位置決めさ
れる。If a distance of 13o is obtained, the grasping position t3 is reached from the top of the workpiece.
Calculate the distance G to P and the sum of 20, (G+,,go
), the gripping portion GR is accurately positioned at the gripping position GP of the workpiece Wm.

第４図は本発明の実施例ブロック図である。ロボット制
御装置）ｔ、ＣＵは処理ユニッ）ＰＲ，Ｃと、制御プロ
グラムメモリＲＯＭと、ロボット指令データを記憶する
ロボット指令プログラムメモリＭＥＭと、最上段のワー
ク把持位置座標Ｚｎ、最下段のワヘク把持位置座標Ｚ１
＋最大段ｅｎ１現在の積み重ね段数ｍ１前記一定距離−
ｇｃなどを記憶するデータメモリＤＭＭを有している。FIG. 4 is a block diagram of an embodiment of the present invention. Robot controller) t, CU are processing units) PR, C, control program memory ROM, robot command program memory MEM for storing robot command data, top workpiece gripping position coordinates Zn, bottom workpiece gripping position Coordinate Z1
+Maximum stage en1 Current number of stacked stages m1 Above fixed distance -
It has a data memory DMM that stores gc, etc.

一方、現在のワークの積み重ね段数ｍを演算する積み重
ね段数演算部ＷＳＵは、最大段数ｎが設定されるレジス
タＲＧ１と、初期時該最大段数ｎがセットされ、１つの
ワークが把持部ＧＲにより持ち去られたときその内容を
カウントダウンするレジスタＲＧ２と、ワーク把持のＳ
コード（ロボット指令データ）により、処理ユニットＰ
ＲＣからＳコード信号ＳＲ８が発生してから把持作業が
完了する所定時間後に“１”を出力する遅延回路ＤＬＣ
と、遅延回路から“１”が出力される毎にレジスタＲＧ
２の内容をカウントダウンし、その結果をレジスタＲＧ
２にセットする演算回路ＣＯＭと、更に該演算結果を現
積み重ね段数ｍとして出力すると共に、ｍ＝０のときレ
ジスタＲＧ１にセットされている最大段数ｎ乞しジスタ
ＲＧ２にプリセットする零判定回路ＺＤＣとを有してい
る。サーボ回路ＳＶＣは、処理ユニットＰＲＣから出力
されるＺ軸方向の移動指令値ΔＺに基いてパルス分配演
算を実行するパルス分配器ＰＩ）Ｃと、分配パルスＰｉ
Ｏ数とモータＭＴが所定量回転する毎にパルスジェネレ
ータＰＱから発生するパルスＰｆの数の差ＥＲを演算し
て記憶する誤差回路ＨＲＣと、誤差ｆｌをＤＡ変換する
ＤＡｉ換器ＤＡＣと、速度制御回路Ｓ　Ｐ　Ｃとを有し
ている。On the other hand, the stacking stage number calculation unit WSU that calculates the current stacking stage number m of the workpieces has a register RG1 in which the maximum number of stages n is set, and a register RG1 in which the maximum number of stages n is set, and one workpiece is removed by the gripping unit GR. register RG2 that counts down the contents when the
By code (robot command data), processing unit P
A delay circuit DLC that outputs “1” after a predetermined time after the S code signal SR8 is generated from RC and the gripping operation is completed.
And every time "1" is output from the delay circuit, the register RG
Count down the contents of 2 and store the result in register RG.
2, and a zero determination circuit ZDC that outputs the result of the calculation as the current number of stacked stages m, and presets the maximum stage number n set in the register RG1 to the register RG2 when m=0. have. The servo circuit SVC includes a pulse distributor PI)C that executes a pulse distribution calculation based on a movement command value ΔZ in the Z-axis direction output from a processing unit PRC, and a distribution pulse Pi).
An error circuit HRC that calculates and stores the difference ER between the O number and the number of pulses Pf generated from the pulse generator PQ every time the motor MT rotates a predetermined amount, a DAi converter DAC that converts the error fl into DA, and a speed control circuit. It has a circuit SPC.

Claims (3)

【特許請求の範囲】[Claims] （１）ワークを所定位置から積降し或いは積上げする工
業用ロボットのパレタイジング方法において、把持部に
ワーク塩の距離を検出できるセンサを取付けると共に、
最大積み重ね数ｎと、最上段のワーク把持位置Ｚｎと、
最下段のワーク把持位置Ｚｌを入力し、ｍ段のワークを
把持する場合、各ワークの厚みが均一であるとしたとき
のｍ段目のワーク上面より一定の距離ＩＣの位置Ｚｍを
前記Ｚ　１　。 Ｚｎ、　ｎ、　ｒｎ、　Ｊ３ｃを用いて求め、該位置に
把持部を位置決め後、前記距離センサによりワーク上面
迄の距離Ａｏを測定し、ワーク上面から把持位置迄の距
離Ｇと前記距離感０の和に相当する量だけ把持部を下方
へ移動させて把持部をワーク把持点へ位置決めすること
を特徴とする工業用ロボットにおけるパレタイジング方
法。(1) In a palletizing method for an industrial robot that loads and unloads or stacks workpieces from a predetermined position, a sensor that can detect the distance of the workpiece salt is attached to the gripping part, and
The maximum number of stacks n, the uppermost workpiece gripping position Zn,
When inputting the lowest workpiece gripping position Zl and gripping m-stage workpieces, the position Zm at a certain distance IC from the top surface of the m-th workpiece, assuming that the thickness of each workpiece is uniform, is set to Z1. . Zn, n, rn, J3c, and after positioning the gripping part at the position, measure the distance Ao to the top surface of the workpiece with the distance sensor, and calculate the distance G from the top surface of the workpiece to the gripping position and the distance sense of 0. A palletizing method for an industrial robot, characterized by moving the gripping part downward by an amount corresponding to the sum of the parts and positioning the gripping part to a workpiece gripping point. （２）　ｔｔｉＪ　Ｗｅワーク上面から把持位置迄の距
離Ｇを予め与えることを特徴とする特許請求の範囲第（
１）項記載の工業用ロポッ）Ｋおけるパレタイジング方
法。(2) ttiJ We Claim No. 1 (
1) The palletizing method in the industrial robot described in section 1). （３）ワークをワーク厚みに対しａ：ｂの位置で把持す
る場合、前記距離Ｇを Ｇ＝□・ｈｅ ａ　−）−ｂ 但し、ｈｅはワークの真の厚みで ｈｃ　＝　ｈ　＋　（４−Ｊｔｏ　　）／ｍｈ　＝　（
Ｚｎ−Ｚｌ）／（ｎ　　１）より演算することを特徴と
する特許請求の範囲第（１）項記載の工業用ロボットに
おけるパレタイジング方法。(3) When gripping a workpiece at the position a:b relative to the workpiece thickness, the distance G is G=□・he a-)-b, where he is the true thickness of the workpiece and hc = h + (4- Jto )/mh = (
A palletizing method for an industrial robot according to claim 1, wherein the palletizing method is calculated using Zn-Zl)/(n 1).