JPH08224623A - Robot work gripping control device - Google Patents

Robot work gripping control device

Info

Publication number
JPH08224623A
JPH08224623A JP3540995A JP3540995A JPH08224623A JP H08224623 A JPH08224623 A JP H08224623A JP 3540995 A JP3540995 A JP 3540995A JP 3540995 A JP3540995 A JP 3540995A JP H08224623 A JPH08224623 A JP H08224623A
Authority
JP
Japan
Prior art keywords
work
hand
robot
measured
posture
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.)
Pending
Application number
JP3540995A
Other languages
Japanese (ja)
Inventor
Satoshi Yazaki
聡 矢崎
Hideaki Tachibana
英明 橘
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Komatsu Ltd
Original Assignee
Komatsu Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Komatsu Ltd filed Critical Komatsu Ltd
Priority to JP3540995A priority Critical patent/JPH08224623A/en
Publication of JPH08224623A publication Critical patent/JPH08224623A/en
Pending legal-status Critical Current

Links

Landscapes

  • Manipulator (AREA)
  • Bending Of Plates, Rods, And Pipes (AREA)

Abstract

(57)【要約】 (修正有) 【目的】ワーク載置台に載置されたワークに対するロボ
ットのハンドの相対位置、相対姿勢を任意に変更できる
ようにするワーク把持動作制御装置。 【構成】教示時に、ワーク載置台3上の基準位置(Xs
0、Ys0、θs0)に載置されたワーク12に対してハン
ド41が所望の相対位置および相対姿勢となるようにハ
ンドでワークを把持したときのワークの基準となる第1
の位置(Xs0、Ys0)および姿勢角θs0が計測手段32
で計測されるとともに、ワークを把持したハンドを一定
姿勢角θT0だけ移動させたときのワークの第2の位置
(Xs1、Ys1)を計測手段で計測し、ワークの第1の位
置に対する載置位置ずれΔXs1、ΔYs1、Δθs1をハン
ドの位置および姿勢角の補正量(ΔXT1、ΔYT1、Δθ
T1)に変換、演算され、この補正量によってハンドの位
置および姿勢角が補正される。
(57) [Summary] (Correction) [Purpose] A work gripping motion control device that allows the relative position and relative posture of a robot hand with respect to a work placed on a work placing table to be arbitrarily changed. [Structure] At the time of teaching, the reference position (Xs
0, Ys0, θs0) The first reference serving as a work when the hand 41 grips the work 12 so that the hand 41 has a desired relative position and relative attitude with respect to the work 12 placed on the first work.
Position (Xs0, Ys0) and posture angle θs0 are measured by the measuring means 32.
And the second position (Xs1, Ys1) of the work when the hand holding the work is moved by the constant posture angle θT0, and is measured by the measuring means, and the placement position of the work with respect to the first position is measured. The deviations ΔXs1, ΔYs1, and Δθs1 are used as correction amounts for the hand position and attitude angle (ΔXT1, ΔYT1, and Δθ).
T1) is converted and calculated, and the position and posture angle of the hand are corrected by this correction amount.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】本発明は、ロボットのハンドによ
ってワークが把持されるようロボットを制御する装置に
関し、特にプレス等の板金機械にワークを搬入するに先
だって、ロボットにワークを把持させるための装置に関
する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to an apparatus for controlling a robot so that the hand of the robot grips the work, and more particularly to a device for causing the robot to grip the work before carrying the work into a sheet metal machine such as a press. Regarding the device.

【0002】[0002]

【従来の技術】実開昭63ー133831号公報には、
パレット内にばら積みされたワークをテーブル上に一旦
載置させ、その後、このテーブル上に載置されたワーク
を視覚装置で撮影し、その後、ワークをテーブル上から
取り出し、上記撮影されたワークの現姿勢に基づき修正
を加えてトランスファー装置のトランスファーバー上に
搬送し、トランスファーバー上に常に一定の位置、一定
の姿勢でワークを載置させるワーク移載装置が開示され
ている。
2. Description of the Related Art Japanese Utility Model Publication No. 63-133831 discloses
Work pieces stacked in a pallet are once placed on a table, and then the work pieces placed on the table are photographed by a visual device.Then, the work pieces are taken out from the table, and the work pieces photographed above are displayed. A work transfer device is disclosed in which a work is transferred on a transfer bar of a transfer device with correction based on a posture and a work is always placed on the transfer bar at a fixed position and a fixed posture.

【0003】この場合、ワークをクランプ、アンクラン
プするチャックはスライド軸に装着されており、このス
ライド軸は、ガイドレール上を移動する。従って、チャ
ックはガイドレールによって、自由度が規制されてしま
い、ガイドレールに対して垂直方向の動きは大幅に規制
されてしまう。
In this case, a chuck for clamping and unclamping a work is mounted on a slide shaft, and the slide shaft moves on a guide rail. Therefore, the degree of freedom of the chuck is restricted by the guide rail, and the movement in the direction perpendicular to the guide rail is significantly restricted.

【0004】[0004]

【発明が解決しようとする課題】上述したように、従来
のワーク移載装置は、トランスファーバー上にワークを
常に一定の位置、一定の姿勢となるよう載置させること
はできる。したがって、トランスファーバーが常にワー
クの一定箇所を把持する場合には、この種のワーク移載
装置を使用しても問題は生じない。
As described above, in the conventional work transfer device, the work can be placed on the transfer bar so that the work is always in a fixed position and in a fixed posture. Therefore, if the transfer bar always grips a certain part of the work, no problem will occur even if this kind of work transfer device is used.

【0005】しかし、プレスブレーキロボットにあって
は、前曲げ作業工程と、横曲げ作業工程とでは、ワーク
を把持する箇所、把持姿勢は全く異なる。また、ワーク
の種類に応じて、ワークを把持する箇所、把持姿勢を変
化させる必要が生じる場合もあり得る。ところが、上記
従来のワーク移送装置では、チャックは、上述したよう
自由度が規制されているために、テーブル上のワークを
クランプする際、ワークに対するチャックの相対位置、
相対姿勢を任意に変更することは不可能か、たとえ可能
であっても容易ではない。また、修正を加えてトランス
ファーバー上にワークを載置させるといっても限度があ
り、ワークに対するトランスファーバーの相対位置、相
対姿勢を任意に変更することは不可能か、たとえ可能で
あっても容易ではない。
However, in the press brake robot, the part for gripping the work and the gripping posture are completely different between the front bending work process and the lateral bending work process. In addition, there may be a case where it is necessary to change the gripping position and gripping position of the work depending on the type of work. However, in the above-described conventional work transfer device, since the chuck has a limited degree of freedom as described above, when the work on the table is clamped, the relative position of the chuck with respect to the work,
It is impossible, or even possible, to change the relative attitude arbitrarily. In addition, there is a limit to putting a work on the transfer bar with modification, and it is impossible or even possible to arbitrarily change the relative position and relative posture of the transfer bar with respect to the work. It's not easy.

【0006】以上のように、従来のワーク移送装置にあ
っては、ワークの把持する箇所、把持する姿勢を所望の
ものに任意に変更することは困難であった。
As described above, in the conventional work transfer device, it is difficult to arbitrarily change the gripping position and gripping position of the work to a desired one.

【0007】本発明はこうした実状に鑑みてなされたも
のであり、ワーク載置台に載置されたワークに対するロ
ボットのハンドの相対位置、相対姿勢を、所望のものに
容易に変更することができるワーク把持動作制御装置を
提供することを目的とするものである。
The present invention has been made in view of these circumstances, and the relative position and relative posture of the robot hand with respect to the work placed on the work placement table can be easily changed to a desired work. An object of the present invention is to provide a gripping motion control device.

【0008】[0008]

【課題を解決するための手段】そこで、本発明は、ワー
ク載置台上に載置されたワークを、ロボットのハンドで
把持するように前記ロボットハンドの位置および姿勢を
制御する制御手段を具えたロボットのワーク把持動作制
御装置において、前記ワーク載置台に載置されたワーク
の位置および姿勢角を計測する計測手段を具え、前記制
御手段は、教示時に、前記ワーク載置台上において前記
ハンドで前記ワークを把持したときの前記ワークの基準
となる第1の位置および姿勢角を前記計測手段で計測す
るとともに、前記ワークを把持したハンドを一定姿勢角
だけ移動させたときの前記ワークの第2の位置を前記計
測手段で計測し、前記計測手段で計測された前記ワーク
の基準となる第1の位置および第2の位置と、前記ハン
ドの前記一定姿勢角とに基づいて、前記ワークの前記基
準となる第1の位置に対する載置位置ずれを前記ハンド
の位置および姿勢角の補正量に変換するための補正パラ
メータを演算し、再生時に、前記ワークが前記ワーク載
置台上に載置された際の載置位置および載置姿勢角を前
記計測手段で計測し、この計測された載置位置および載
置姿勢角と、教示時に計測された基準となる第1の位置
および姿勢角と、前記補正パラメータとに基づいて、前
記ハンドの位置および姿勢角の補正量を演算し、この演
算された補正量によって前記ハンドが前記ワークを把持
するときの当該ハンドの位置および姿勢角を補正するよ
うにしている。
Therefore, the present invention comprises a control means for controlling the position and posture of the robot hand so that the robot hand holds the work placed on the work placing table. In a work gripping operation control device of a robot, a measuring means for measuring a position and an attitude angle of a work placed on the work placing table is provided, and the control means uses the hand with the hand on the work placing table at the time of teaching. A first position and a posture angle that are the reference of the work when the work is gripped are measured by the measuring means, and a second of the work when the hand that grips the work is moved by a fixed posture angle. The position is measured by the measuring unit, and the first position and the second position, which are the reference of the work measured by the measuring unit, and the constant posture of the hand. On the basis of the above, a correction parameter for converting the mounting position displacement of the work with respect to the reference first position into a correction amount of the position and attitude angle of the hand is calculated, and the work is reproduced at the time of reproduction. The mounting position and the mounting posture angle when mounted on the work mounting table are measured by the measuring means, and the measured mounting position and mounting posture angle and the reference serving as the reference measured at the time of teaching Based on the position and posture angle of No. 1 and the correction parameter, the correction amount of the position and posture angle of the hand is calculated, and the calculated correction amount of the hand when the hand grips the workpiece. The position and posture angle are corrected.

【0009】[0009]

【作用】かかる構成によれば、図1ないし図5に示すよ
うに、教示時に、ワーク載置台3上の基準位置(Xs0、
Ys0、θs0)に載置されたワーク12に対してハンド4
1が所望の相対位置および相対姿勢となるようにハンド
41でワーク12を把持したときのワークの基準となる
第1の位置(Xs0、Ys0)および姿勢角θs0が計測手段
32で計測されるとともに、ワーク12を把持したハン
ド41を一定姿勢角θT0だけ移動させたときのワーク1
2の第2の位置(Xs01、Ys01)が計測手段32で計測
される。
According to this structure, as shown in FIGS. 1 to 5, at the time of teaching, the reference position (Xs0, Xs0,
Ys0, θs0) to the work 12 placed on the hand 4
The measuring means 32 measures the first position (Xs0, Ys0) and the attitude angle θs0 that are the reference of the work when the work 12 is gripped by the hand 41 so that 1 has the desired relative position and relative attitude. , The work 1 when the hand 41 holding the work 12 is moved by a constant posture angle θT0
The second second position (Xs01, Ys01) is measured by the measuring means 32.

【0010】そして、計測手段32で計測されたワーク
12の第1の位置(Xs0、Ys0)および第2の位置(X
s01、Ys01)と、ハンド12の一定姿勢角θT0とに基づ
いて、ワーク12の第1の位置(Xs0、Ys0、θs0)に
対する載置位置ずれΔXs1、ΔYs1、Δθs1をハンド4
1の位置および姿勢角の補正量(ΔXT1、ΔYT1、Δθ
T1)に変換するための補正パラメータh、αが演算され
る。
Then, the first position (Xs0, Ys0) and the second position (Xs) of the work 12 measured by the measuring means 32 are measured.
s01, Ys01) and the constant posture angle θT0 of the hand 12, the placement position deviation ΔXs1, ΔYs1, Δθs1 with respect to the first position (Xs0, Ys0, θs0) of the work 12 is calculated by the hand 4
1 position and attitude angle correction amount (ΔXT1, ΔYT1, Δθ
The correction parameters h and α for conversion into T1) are calculated.

【0011】再生時には、ワーク12がワーク載置台上
3に載置された際の載置位置Xs1、Ys1および載置姿勢
角θs1が計測手段32で計測され、この計測された載置
位置Xs1、Ys1および載置姿勢角θs1と、教示時に計測
された第1の位置(Xs0、Ys0)および姿勢角θs0と、
補正パラメータh、αとに基づいて、ハンド41の位置
および姿勢角の補正量(ΔXT1、ΔYT1、ΔθT1)が演
算される。
At the time of reproduction, the mounting positions Xs1, Ys1 and the mounting attitude angle θs1 when the work 12 is mounted on the work mounting table 3 are measured by the measuring means 32, and the measured mounting position Xs1, Ys1 and the mounting posture angle θs1, the first position (Xs0, Ys0) and the posture angle θs0 measured during teaching,
Based on the correction parameters h and α, the correction amount (ΔXT1, ΔYT1, ΔθT1) of the position and posture angle of the hand 41 is calculated.

【0012】そして、この演算された補正量(ΔXT1、
ΔYT1、ΔθT1)によってハンド41がワーク12を把
持するときの当該ハンド41の位置(XT、YT)および
姿勢角θTが補正される。
Then, the calculated correction amount (ΔXT1,
ΔYT1, ΔθT1) corrects the position (XT, YT) and posture angle θT of the hand 41 when the hand 41 grips the work 12.

【0013】[0013]

【実施例】以下、図面を参照して本発明に係るロボット
のワーク把持動作制御装置の実施例について説明する。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An embodiment of a work gripping operation control device for a robot according to the present invention will be described below with reference to the drawings.

【0014】図1は、実施例の板状ワーク供給システム
の外観を示す斜視図である。また、図2は、図1のセン
サ部32としてCCDカメラを使用した場合のシステム
ブロック図である。
FIG. 1 is a perspective view showing the outer appearance of a plate-like work supply system according to an embodiment. 2 is a system block diagram when a CCD camera is used as the sensor unit 32 of FIG.

【0015】図1に示すように、この板状ワーク供給シ
ステムは、プレスブレーキに対してワークを搬送供給す
るロボット4に対してワーク12を供給させるためのシ
ステムであり、大きくは、板状ワーク供給装置50と、
ロボット装置40とから構成されている。
As shown in FIG. 1, this plate-like work supply system is a system for supplying a work 12 to a robot 4 which conveys and supplies the work to a press brake. A supply device 50,
It is composed of a robot device 40.

【0016】板状ワーク供給装置50は、さらにワーク
積載台1と、移載装置2と、計測装置30とから成って
おり、一方、ロボット装置40は、ロボット4と、コン
トローラ5から成っている。
The plate-like work supply device 50 further comprises a work loading table 1, a transfer device 2 and a measuring device 30, while the robot device 40 comprises a robot 4 and a controller 5. .

【0017】ワーク積載台1には、ロボット4が搬送す
べき板状のワーク12が複数枚、表裏面がそろえられて
積み重ねられてストックされている。
A plurality of plate-shaped works 12 to be conveyed by the robot 4 are stacked and stocked on the work stacking base 1 with their front and back surfaces aligned.

【0018】ここで、積載されるワークの枚数が多い場
合には、ワークの極端な位置ずれや荷崩れ等を防ぐため
に、ワーク荷崩れ防止ピン11が、ワーク12の側面3
点(4点以上の多点でもよい)を支持するよう台1上に
立設されている。なお、この荷崩れ防止ピン11の配設
位置は、ワーク12の大きさに応じて変更できるように
なっている。 ただし、ロボット4のハンド41がワー
ク12を把持する際に、ロボット4側で把持位置ずれが
生じないような後述する高精度な制御がなされるので、
ピン11の位置決めの際には、ピン11の配設位置に関
して精密な調整は不要であり、ワーク12の大きさに応
じた比較的ラフな調整を行うだけでよい。
When a large number of works are stacked, the work load collapse prevention pin 11 is provided on the side surface 3 of the work 12 in order to prevent the work from being excessively displaced and the load collapsed.
It is erected on the base 1 so as to support points (may be four or more points). The position of the load collapse prevention pin 11 can be changed according to the size of the work 12. However, when the hand 41 of the robot 4 grips the work 12, high-precision control described below is performed so that the grip position does not shift on the robot 4 side.
When the pin 11 is positioned, it is not necessary to precisely adjust the position where the pin 11 is arranged, and it is only necessary to make a relatively rough adjustment according to the size of the work 12.

【0019】また、この実施例では、ピン11、11間
に空隙を設けることで、それらの間を移送装置2のアー
ムが通るようにしているが、ピン12の代わりに、容器
によってワーク12を収容、支持する構成をとった場合
には、上記移送装置2のアームを通すスリット部を上記
容器側面に設けるようにすればよい。
Further, in this embodiment, the gaps are provided between the pins 11 to allow the arm of the transfer device 2 to pass between them, but instead of the pin 12, the work 12 is replaced by a container. In the case of a structure for accommodating and supporting, the slit portion through which the arm of the transfer device 2 is inserted may be provided on the side surface of the container.

【0020】また、ワーク12の極端な位置ずれ、荷崩
れ等の虞がなければ、ワーク12を支持するピン11な
いし上記容器の配設は、省略することもできる。
Further, if there is no fear of extreme displacement of the work 12 or collapse of the load, the pin 11 for supporting the work 12 or the container may be omitted.

【0021】移送装置2は、ワーク積載台1に積み重ね
られているワーク12を、一番上のものから一枚づつ取
り出して、この取り出されたワーク12を計測装置30
の計測台3の計測面31上に移送する装置である。
The transfer device 2 takes out the works 12 stacked on the work loading table 1 one by one from the top, and the taken works 12 are measured by a measuring device 30.
It is a device for transferring onto the measurement surface 31 of the measurement table 3.

【0022】この移送装置2は、ワーク12を吸着、把
持する真空パッド等の吸着具を有したハンド21がアー
ム先端に装着されたロボットであり、このハンド21が
装着されたアーム24は、直動シリンダ等のアクチュエ
ータ22によって上下動されるようになっているととも
に、上記アーム24は回転モータ等のアクチュエータ2
3によって水平方向に回動されるようになっている。
The transfer device 2 is a robot in which a hand 21 having an adsorbing tool such as a vacuum pad for adsorbing and gripping the work 12 is attached to the tip of an arm, and the arm 24 to which the hand 21 is attached is a direct arm. It is adapted to be moved up and down by an actuator 22 such as a moving cylinder, and the arm 24 is connected to the actuator 2 such as a rotary motor.
It is designed to be horizontally rotated by 3.

【0023】したがって、これらアクチュエータ22、
23が駆動制御されることによって、ハンド21によっ
て把持されたワーク12は、ワーク積載台1から計測台
3の計測面31まで移送される。
Therefore, these actuators 22,
The work 12 gripped by the hand 21 is transferred from the work stacking base 1 to the measurement surface 31 of the measuring base 3 by driving and controlling 23.

【0024】計測装置30の計測台3は、上記移送装置
2によって移送されたワーク12を一旦載置する計測面
31を有している。
The measuring table 3 of the measuring device 30 has a measuring surface 31 on which the work 12 transferred by the transfer device 2 is once placed.

【0025】計測装置30は、上記計測台3と、この計
測台3に付設されたセンサ部32と、データ処理部33
とから構成されている。
The measuring device 30 includes the measuring table 3, a sensor section 32 attached to the measuring table 3, and a data processing section 33.
It consists of and.

【0026】センサ部32およびデータ処理部33は、
計測面31上に載置されたワーク12の位置および姿勢
角を計測する。すなわち、センサ部32およびデータ処
理部33では、図3に示すように、計測面31に平行で
同計測面31の所定位置を原点とするセンサ座標系Xs
ーYsにおけるワーク重心位置(Xs1、Ys1)および同
重心回りでの位相である姿勢角θs1が計測される。
The sensor unit 32 and the data processing unit 33 are
The position and posture angle of the work 12 placed on the measurement surface 31 are measured. That is, in the sensor unit 32 and the data processing unit 33, as shown in FIG. 3, the sensor coordinate system Xs which is parallel to the measurement surface 31 and whose origin is a predetermined position of the measurement surface 31 is used.
The work center-of-gravity position (Xs1, Ys1) at −Ys and the posture angle θs1 that is the phase around the same center of gravity are measured.

【0027】センサ部32およびデータ処理部33とし
ては、図2に示すように、例えば、上記計測面31の垂
直上方に設置されたCCDカメラと、同CCDカメラに
より撮像された画像を処理してワーク12の位置および
姿勢を求める画像処理部とから構成される。上記計測台
3は、CCDカメラを使用する場合は、照明台を兼ねる
ものとしてもよい。この場合は、同図2に示すように、
計測台3の内部に照明装置34が配設され、計測面31
が光を透過し得るような材質で構成される。このため、
ワーク12を良好な状態で撮像することができる。
As shown in FIG. 2, the sensor unit 32 and the data processing unit 33 process, for example, a CCD camera installed vertically above the measurement surface 31 and an image picked up by the CCD camera. It is composed of an image processing unit for obtaining the position and orientation of the work 12. When using a CCD camera, the measuring table 3 may also serve as an illumination table. In this case, as shown in FIG.
An illumination device 34 is arranged inside the measuring table 3 and the measuring surface 31
Is made of a material capable of transmitting light. For this reason,
The work 12 can be imaged in a good state.

【0028】また、複数のレーザ変位計と、これら複数
の変位計により検出された当該レーザ変位計とワーク間
との距離によってワークの姿勢および位置を算出する位
置データ処理部とによって、上記センサ部32およびデ
ータ処理部33を構成してもよい。
Further, the sensor section is composed of a plurality of laser displacement gauges and a position data processing section for calculating the posture and the position of the work according to the distance between the laser displacement gauges detected by the plurality of displacement gauges and the work. 32 and the data processing unit 33 may be configured.

【0029】データ処理部33は、予め記憶された上記
センサ座標系XsーYsにおける基準位置(Xs0、Ys0)
および基準姿勢θs0と、上記センサ部32、データ処理
部33で検出されたワーク12の位置(Xs1、Ys1)お
よび姿勢θs1との間のずれ量ΔXs1、ΔYs1、Δθs1
を、予め記憶された後述する所定の変換手順に従い、ロ
ボット4のロボット座標系XTーYTで表現したずれ量
(ΔXT1、ΔYT1、ΔθT1)に変換し、これをコントロ
ーラ5に出力する。
The data processing unit 33 has a reference position (Xs0, Ys0) in the previously stored sensor coordinate system Xs-Ys.
And the deviation amount ΔXs1, ΔYs1, Δθs1 between the reference posture θs0 and the position (Xs1, Ys1) of the work 12 detected by the sensor unit 32 and the data processing unit 33 and the posture θs1.
Is converted into a deviation amount (ΔXT1, ΔYT1, ΔθT1) expressed by the robot coordinate system XT-YT of the robot 4 according to a predetermined conversion procedure which will be stored in advance and is output to the controller 5.

【0030】コントローラ5は、ロボット4のハンド4
1の動作経路、ハンド41の姿勢、ハンド41の作業内
容(ワークを把持または解放するなど)および周辺装置
(本システムとたとえばプレス機械など)の動作指令な
どを作業順序に従い記述した動作プログラムを記憶して
いる。動作プログラムは、ティーチング等で与えられ
る。
The controller 5 is the hand 4 of the robot 4.
The operation program that describes the operation path of No. 1, the posture of the hand 41, the work content of the hand 41 (such as gripping or releasing the work) and the operation commands of peripheral devices (this system and the press machine, for example) according to the work order is stored. are doing. The operation program is given by teaching or the like.

【0031】ロボット4は、動作プログラムに記述され
た作業順序に従い動作され、周辺機器は、動作プログラ
ムに記述された起動命令によって動作タイミングを得
て、動作される。
The robot 4 is operated according to the work order described in the operation program, and the peripheral devices are operated by obtaining the operation timing according to the activation command described in the operation program.

【0032】なお、外部に新たに設けたシーケンス機能
を持つ装置に、コントローラ5や周辺機器を接続し、こ
れらに動作タイミングを与えるようにしてもよい。こう
してコントローラ5は、上記動作プログラムに記述され
たハンド41のロボット座標系XTーYTでの位置XT、
YTおよび姿勢θTのデータを、データ処理部33から出
力される補正量(ΔXT1、ΔYT1、ΔθT1)に基づい
て、補正し、ハンド41が、この補正したデータに応じ
た位置、姿勢となるよう、水平多関節(4軸)のロボッ
ト4の各軸を駆動制御する。これによってロボット4の
アームの先端軸4aの位置XT、YTおよび回転角θTが
所要に変化され、計測面31上のワーク12に対するハ
ンド41の相対位置、相対姿勢が所望のものとされて、
ワーク12が、ハンド41の吸着パッドによって把持さ
れる。
The controller 5 and peripheral devices may be connected to an externally provided device having a sequence function to give them operation timing. In this way, the controller 5 controls the position XT of the hand 41 described in the above operation program in the robot coordinate system XT-YT,
The data of YT and attitude θT are corrected based on the correction amount (ΔXT1, ΔYT1, ΔθT1) output from the data processing unit 33, and the hand 41 has a position and attitude corresponding to the corrected data. Each axis of the horizontal multi-joint (4 axes) robot 4 is drive-controlled. As a result, the positions XT, YT and the rotation angle θT of the tip axis 4a of the arm of the robot 4 are changed as required, and the relative position and relative attitude of the hand 41 with respect to the work 12 on the measurement surface 31 are made desired,
The work 12 is gripped by the suction pad of the hand 41.

【0033】つぎに、センサ部32がCCDカメラであ
る場合(図2)の処理手順について、図6に示すフロー
チャートおよび図3ないし図5に示す説明図を併せ参照
して説明する。
Next, the processing procedure when the sensor unit 32 is a CCD camera (FIG. 2) will be described with reference to the flowchart shown in FIG. 6 and the explanatory diagrams shown in FIGS.

【0034】・前処理 まず、CCDカメラ32の1画素分に相当する長さGs
(カメラの倍率)と、ロボット座標系XTーYTに対する
センサ座標系XsーYsの回転ずれθTS0とを求めるため
に、図3に示すように、ハンド41の基準位置・姿勢P
T0を設定する。そして、このハンド41の状態で保持で
きる場所にあるワーク12の重心位置G1、およびこの
ワーク12を保持しツール座標XT、YT方向に既知量移
動させることで得られる他の2点の重心位置G2、G3を
センサ座標系で求める。そこで、これら3点G1、G2、
G3の値より、CCDカメラ32の倍率Gsおよび、ロボ
ット先端軸4aに設定されているツール座標系(XTー
YTーZT)のXT、YT軸に対するセンサ座標系(Xsー
YsーZs)におけるXs、Ys軸の傾きθTs0を求める。
ここで、センサ座標系のXsーYs平面とツール座標系の
XTーYT平面とは平行なものとしている。データ処理部
33が必要とするのは、ワーク12の基準位置と現在位
置とのロボットツール座標系におけるずれ量のみであ
り、ワーク12の絶対位置ではないので、ツール座標系
の原点は、特に設定する必要はない。
Pretreatment First, the length Gs corresponding to one pixel of the CCD camera 32
In order to obtain (camera magnification) and the rotational deviation θTS0 of the sensor coordinate system Xs-Ys relative to the robot coordinate system XT-YT, as shown in FIG.
Set T0. Then, the center of gravity position G1 of the work 12 in a position where it can be held in the state of the hand 41, and the other two center of gravity positions G2 obtained by moving the work 12 by a known amount in the tool coordinate XT and YT directions. , G3 in the sensor coordinate system. So, these three points G1, G2,
From the value of G3, the magnification Gs of the CCD camera 32 and XT of the tool coordinate system (XT-YT-ZT) set on the robot tip axis 4a and Xs in the sensor coordinate system (Xs-Ys-Zs) with respect to the YT axis. , Ys axis inclination θTs0 is obtained.
Here, the Xs-Ys plane of the sensor coordinate system and the XT-YT plane of the tool coordinate system are assumed to be parallel. The data processing unit 33 needs only the amount of deviation between the reference position and the current position of the work 12 in the robot tool coordinate system, not the absolute position of the work 12, so the origin of the tool coordinate system is set in particular. do not have to.

【0035】得られたGsとθTs0は、データ処理部33
に記憶される。GsとθTs0によって、センサ座標系にお
けるずれ量を、ハンド41の位置・姿勢PT0におけるツ
ール座標系の軸方向のずれ量に変換することができるよ
うになる。
The obtained Gs and θTs0 are stored in the data processing unit 33.
Is stored. With Gs and θTs0, the shift amount in the sensor coordinate system can be converted into the shift amount in the axial direction of the tool coordinate system at the position / posture PT0 of the hand 41.

【0036】Gs、θTs0、つまりロボット座標系とツー
ル座標系の関係は、ロボット4ないしは本システムの設
置時、本システムの設定を変更した場合(たとえばカメ
ラ32のレンズの倍率を変更した場合)のみに、再度求
めるようにすればよい(ステップ101、102、20
1、301)。
Gs, θTs0, that is, the relationship between the robot coordinate system and the tool coordinate system is only when the setting of this system is changed when the robot 4 or this system is installed (for example, when the magnification of the lens of the camera 32 is changed). Then, it may be determined again (steps 101, 102, 20).
1, 301).

【0037】つぎに、ワーク12の表裏面をそろえてワ
ーク積載台1上に所定の枚数積み重ねる。この際、積載
台1にストックされたワーク12の水平面内における載
置位置は、上記移送装置2のハンド21でワーク12が
無理なく取れるような位置に設定される。
Next, the front and back surfaces of the works 12 are aligned and a predetermined number of the works 12 are stacked on the work stacking base 1. At this time, the placement position of the works 12 stocked on the loading platform 1 in the horizontal plane is set to a position where the hands 12 of the transfer device 2 can comfortably pick up the works 12.

【0038】また、ワーク12が、荷崩れを起こさぬよ
うに上記荷崩れ防止ピン11がワーク積載台1の適当な
位置に立設される。
Further, the load collapse prevention pin 11 is erected at an appropriate position on the work stacking base 1 so that the work 12 does not collapse.

【0039】この実施例では、ワーク12の表裏をそろ
えて積み重ねた場合の動作について説明するが、ワーク
12の表裏をそろえて積み重ねない実施も可能である。
In this embodiment, the operation of stacking the works 12 with their front and back aligned will be described, but it is also possible to carry out the work 12 without stacking them with their front and back aligned.

【0040】この場合、ワーク表面上に表裏を判別でき
るような特徴(マーク)等を付しておくとともに、ロボ
ット4にワーク12を表裏反転することができる自由度
(軸)を付加しておく。そうすることで、上記マークの
識別結果に応じてワーク12を把持したハンド41を所
要に反転させて、ワーク12の表裏面をそろえることが
できる(ステップ103)。
In this case, a feature (mark) or the like for distinguishing the front and the back is provided on the surface of the work, and the robot 4 is provided with a degree of freedom (axis) capable of reversing the work 12. . By doing so, the hand 41 holding the work 12 can be reversed as required according to the result of identifying the mark, and the front and back surfaces of the work 12 can be aligned (step 103).

【0041】・教示処理 つぎに、ワーク12の基準位置(Xs0、Ys0、θs0)に
対するワーク載置位置ずれΔXs1、ΔYs1、Δθs1をハ
ンド41の位置・姿勢角の補正量(ΔXT1、ΔYT1、Δ
θT1)に変換するための補正パラメータh、αを演算す
る。
Teaching process Next, the work placement position deviations ΔXs1, ΔYs1, and Δθs1 with respect to the reference position (Xs0, Ys0, θs0) of the work 12 are corrected by the correction amounts (ΔXT1, ΔYT1, ΔYT1, ΔYT1, ΔYT1, ΔYT1, ΔTs1) of the hand 41.
The correction parameters h and α for conversion into θT1) are calculated.

【0042】すなわち、図4に示すように、まず、ワー
ク積載台1上のワーク12を1枚だけ、移送装置2によ
って計測台3上の計測面31上に載置させる。つぎに、
前記操作により記憶されたパラメータθTs0の値で規定
される2つの座標系間の関係を有効にするためロボット
ハンド4を前記位置・姿勢PT0の状態にし、これに対し
ワークを計測面31上で回転・移動させるか、さらに、
ロボットハンド4を位置・姿勢PT0の状態からティーチ
ングボックス等によりツール座標軸方向のみに移動させ
る操作を加えることで、ワーク12をハンド41で把持
する時のワーク12に対するハンド41の所望の相対位
置および相対姿勢を教示する。
That is, as shown in FIG. 4, first, only one work 12 on the work loading table 1 is placed on the measurement surface 31 on the measurement table 3 by the transfer device 2. Next,
In order to validate the relationship between the two coordinate systems defined by the value of the parameter θTs0 stored by the above operation, the robot hand 4 is placed in the position / posture PT0 state, while the workpiece is rotated on the measurement surface 31.・ Move it, or
A desired relative position and relative position of the hand 41 with respect to the work 12 when gripping the work 12 by adding an operation of moving the robot hand 4 only in the tool coordinate axis direction from a position / posture PT0 state using a teaching box or the like. Teach the posture.

【0043】上記操作で得られたものをワーク12の基
準位置・姿勢、およびワーク把持時のハンド41の基準
位置・姿勢PT1とする。
The values obtained by the above operation are used as the reference position / posture of the work 12 and the reference position / posture PT1 of the hand 41 when gripping the work.

【0044】つまり、ワーク12を載置後、その位置・
姿勢を修正した際のセンサ座標系におけるワークの重心
位置(Xs0、Ys0)およびその重心軸周りの慣性主軸の
傾き角θs0が計測され、これらが基準位置・姿勢角(X
s0、Ys0、θs0)としてデータ処理部33に記憶され、
また、上記の状態のワーク把持時のハンド41の位置・
姿勢をツール座標系における原点位置・姿勢PT1として
記憶しておく。
That is, after the work 12 is placed, its position and
The center of gravity position (Xs0, Ys0) of the workpiece in the sensor coordinate system when the posture is corrected, and the inclination angle θs0 of the inertial spindle about the center of gravity axis are measured, and these are calculated as the reference position / posture angle (X
s0, Ys0, θs0) stored in the data processing unit 33,
In addition, the position of the hand 41 when gripping the workpiece in the above state
The posture is stored as the origin position / posture PT1 in the tool coordinate system.

【0045】なお、上記教示時に、ロボットハンド4を
上記操作に加え、さらに任意量θTRだけ回転操作して教
示を行うことも可能である。この際は、パラメータθTs
0を再度求め直すか、上記回転量θTR分回転修正を行い
後述する補正量(ΔXT1、ΔYT1、ΔθT1)を求める必
要がある。
At the time of the above teaching, it is also possible to perform the teaching by additionally operating the robot hand 4 by an arbitrary amount θTR in addition to the above operation. In this case, the parameter θTs
It is necessary to determine 0 again or to correct the rotation amount by the above-mentioned rotation amount θTR to obtain the correction amounts (ΔXT1, ΔYT1, ΔθT1) described later.

【0046】上記操作で、前曲げ作業、横曲げ作業の相
違といった作業内容の違い、ワーク種類の違いによって
上記相対位置・姿勢を異ならせた教示を行うことができ
る。つぎに、ワーク12をハンド41で保持した状態
で、ツール座標系のZ軸(XTーYTの原点)回りに(例
えばロボット先端軸4a周りに)、既知量θT0だけハン
ド41を旋回させる(図4参照)。旋回が終了した時点
で、ワーク12を再び計測台3の計測面31上に載置さ
せる。そして、その旋回終了時点のセンサ座標系におけ
るワーク重心位置(Xs01、Ys01)およびその重心軸回
りの慣性主軸の傾き角θs01が計測され、データ処理部
33に記憶される(ステップ104、105、202、
302)。
By the above-mentioned operation, it is possible to perform the teaching in which the relative position / posture is changed according to the difference in work contents such as the difference between the front bending work and the lateral bending work and the difference in the work type. Next, with the work 12 held by the hand 41, the hand 41 is swung by the known amount θT0 around the Z axis (origin of XT-YT) of the tool coordinate system (for example, around the robot tip axis 4a) (see FIG. 4). When the turning is completed, the work 12 is placed on the measuring surface 31 of the measuring table 3 again. Then, the work center of gravity position (Xs01, Ys01) in the sensor coordinate system at the end of the turning and the inclination angle θs01 of the inertial spindle about the center of gravity axis are measured and stored in the data processing unit 33 (steps 104, 105, 202). ,
302).

【0047】以上の操作によって得られた値から、ワー
ク12の旋回最終位置(Xs01、Ys01)とハンド41の
基準位置PT1(ツール座標原点)との距離h、およびワ
ーク12の基準位置(Xs0、Ys0)と旋回最終位置(X
s01、Ys01)とを結んだ直線のツール座標軸YTに対す
る傾きαが次式によって求められる。
From the values obtained by the above operation, the distance h between the final turning position (Xs01, Ys01) of the work 12 and the reference position PT1 (tool coordinate origin) of the hand 41, and the reference position (Xs0, Ys0) and final turning position (X
The inclination α of the straight line connecting (s01, Ys01) to the tool coordinate axis YT is calculated by the following equation.

【0048】 ここで、上記補正パラメータh、αは、ワーク12に対
するハンド41の相対位置、相対姿勢が異なれば、それ
に応じて異なる値をとる(ステップ106)。こうした
補正パラメータを求めるための一連の作業は、ワークの
基準位置を設定する作業以外は、パラメータ設定用のロ
ボットおよび周辺機器動作プログラムとしてコントロー
ラ5に登録できる(ステップ202参照)ので、半自動
で容易に行うことができる。なお、この補正パラメータ
を求める作業は、上記相対位置、相対姿勢を変えない限
りは、あらためて行う必要はない。
[0048] Here, if the relative position and the relative posture of the hand 41 with respect to the work 12 are different, the correction parameters h and α take different values accordingly (step 106). A series of operations for obtaining such correction parameters can be registered semi-automatically and easily since they can be registered in the controller 5 as a parameter setting robot and peripheral device operation program, except for the operation of setting the reference position of the work. It can be carried out. The operation of obtaining the correction parameter does not need to be performed again unless the relative position and the relative attitude are changed.

【0049】さらに、ロボット4が計測台3上からワー
ク12を取り上げ所定の位置まで搬送する一連の動作に
ついてのティーチングが行われる。こうして、ロボット
4の動作プログラムが作成され、コントローラ5内に記
憶される。
Further, teaching is performed for a series of operations in which the robot 4 picks up the work 12 from the measuring table 3 and conveys it to a predetermined position. In this way, the operation program of the robot 4 is created and stored in the controller 5.

【0050】・再生処理 以上のような教示処理が行われると、再生動作がなさ
れ、実作業が開始される。
Reproduction Process When the teaching process as described above is performed, the reproduction operation is performed and the actual work is started.

【0051】再生時には、ワーク12が計測台3上に載
置された際の載置位置Xs1、Ys1および載置姿勢角θs1
が計測され、この計測された載置位置Xs1、Ys1および
載置姿勢角θs1と、教示時に計測された基準位置(Xs
0、Ys0)および基準姿勢角θs0と、補正パラメータ
h、αとに基づいて、ハンド41の位置および姿勢角の
補正量(ΔXT1、ΔYT1、ΔθT1)が演算される。そし
て、この演算された補正量(ΔXT1、ΔYT1、ΔθT1)
によってハンド41がワーク12を把持するときの当該
ハンド41の位置(XT、YT)および姿勢角θTが補正
される。
At the time of reproduction, the mounting positions Xs1, Ys1 and the mounting posture angle θs1 when the work 12 is mounted on the measuring table 3 are reproduced.
Is measured, and the measured mounting positions Xs1, Ys1 and the mounting posture angle θs1 and the reference position (Xs1
0, Ys0) and the reference posture angle θs0, and the correction amounts (ΔXT1, ΔYT1, ΔθT1) of the position and posture angle of the hand 41 are calculated based on the correction parameters h and α. Then, the calculated correction amount (ΔXT1, ΔYT1, ΔθT1)
The position (XT, YT) and posture angle θT of the hand 41 when the hand 41 holds the work 12 are corrected by the correction.

【0052】すなわち、まず、ワーク積載台1にストッ
クされたワーク12…の一番上のものを移送装置2のハ
ンド21の吸着具により吸着、把持し、垂直方向アクチ
ュエータ22を作動させ、ハンド21を上昇させ所定の
高さまで引き上げる。さらに、移送装置2の回転アクチ
ュエータ23を作動させ、ワーク12を計測台3の計測
面31上まで水平移動させる。その後、ハンド21の吸
着把持状態を解除しワーク12を計測台3の計測面31
上に載置させる(ステップ107、108)。ワーク1
2がこうして移送された後、上記アクチュエータ22、
23が駆動され移送装置2のハンド21はワーク積載台
1上にスタックされたワーク12上に戻り、つぎのワー
ク12の吸着把持を準備する状態で待機する。この一連
の動作は、移送装置2にシーケンサを搭載させることで
簡単に実現できるので、コントローラ5は移送装置2に
起動指令を送るのみでよい。
That is, first, the uppermost one of the works 12 ... Stocked on the work loading table 1 is adsorbed and gripped by the adsorbing tool of the hand 21 of the transfer device 2, and the vertical actuator 22 is operated to operate the hand 21. And raise it to a specified height. Further, the rotary actuator 23 of the transfer device 2 is operated to horizontally move the work 12 onto the measurement surface 31 of the measurement table 3. After that, the suction holding state of the hand 21 is released, and the work 12 is placed on the measurement surface 31
It is placed on top (steps 107, 108). Work 1
After the 2 is thus transferred, the actuator 22,
23 is driven and the hand 21 of the transfer device 2 returns to the top of the work 12 stacked on the work loading table 1 and stands by in a state of preparing for suction gripping of the next work 12. Since this series of operations can be easily realized by mounting a sequencer on the transfer device 2, the controller 5 only needs to send a start command to the transfer device 2.

【0053】つぎに、計測台3の計測面31上に載置さ
れたワーク12が、CCDカメラ32によって撮像さ
れ、このワーク12のセンサ座標系における重心位置
(Xs1、Ys1)およびこの重心回りでの慣性主軸回転角
θs1が計測される(ステップ109)。
Next, the work 12 placed on the measuring surface 31 of the measuring table 3 is imaged by the CCD camera 32, and the center of gravity (Xs1, Ys1) in the sensor coordinate system of this work 12 and its center of gravity are measured. The inertial spindle rotation angle θs1 of is measured (step 109).

【0054】つぎに、データ処理部33では、上記ステ
ップ104ですでに求められ記憶しておいたワーク基準
位置(Xs0、Ys0)および基準姿勢角θs0と、上記ステ
ップ109で計測された実際の載置位置(Xs1、Ys1)
および載置姿勢角θs1との偏差から、基準位置、姿勢に
対するずれ量ΔXs1、ΔYs1、Δθs1をセンサ座標系に
関して求める。さらに、このセンサ座標系におけるずれ
量を、上記ステップ106で求められ記憶しておいた補
正パラメータh、α等によって、ツール座標系における
ハンド41の位置、姿勢の補正量ΔXT1、ΔYT1、Δθ
T1に変換する。変換式は以下の通りである。
Next, in the data processing unit 33, the work reference position (Xs0, Ys0) and the reference attitude angle θs0 which are already obtained and stored in the above step 104 and the actual mounting measured in the above step 109. Position (Xs1, Ys1)
And the deviations ΔXs1, ΔYs1, and Δθs1 with respect to the reference position and the posture are obtained from the deviation from the mounting posture angle θs1 with respect to the sensor coordinate system. Further, the amount of deviation in this sensor coordinate system is corrected by the correction parameters h, α, etc. obtained and stored in step 106, and the correction amounts ΔXT1, ΔYT1, Δθ of the position and orientation of the hand 41 in the tool coordinate system.
Convert to T1. The conversion formula is as follows.

【0055】 (ステップ110) コントローラ5では、上記演算が実行し終わるまでの間
に、ハンド41が基準位置・姿勢PT1を取るようにロボ
ット4を動作させており、上記補正量が算出された時点
で、ハンド41は上記基準位置・姿勢を取っており、待
機状態となっている(ステップ203、204、30
3、304、305)。
[0055] (Step 110) In the controller 5, the robot 4 is operated so that the hand 41 takes the reference position / posture PT1 until the above calculation is completed, and when the correction amount is calculated, the hand 4 is moved. Reference numeral 41 is in the reference position / posture, and is in a standby state (steps 203, 204, 30).
3, 304, 305).

【0056】そこで、補正量(ΔXT1、ΔYT1、ΔθT
1)は、データ処理部33からコントローラ5に出力さ
れ、動作プログラムの修正がなされる。すなわち コン
トローラ5は、上記補正量を受け取ると、これに従い予
め記憶された動作プログラム中の移動指令のデータを修
正し(ステップ205)、図5の矢印Aに示すように、
ハンド41を基準位置・姿勢PT1(XT1、YT1、θT1)
から演算補正量(ΔXT1、ΔYT1、ΔθT1)分だけずら
した位置、姿勢(XT1+ΔXT1、YT1+ΔYT1、θT1+
ΔθT1)まで動作させ、このずらした位置、姿勢でハン
ド41にワーク12を把持させる(ステップ206、3
06)。
Therefore, the correction amount (ΔXT1, ΔYT1, ΔθT
1) is output from the data processing unit 33 to the controller 5, and the operation program is corrected. That is, when the controller 5 receives the correction amount, it corrects the movement command data in the operation program stored in advance according to the correction amount (step 205), and as shown by the arrow A in FIG.
Set the hand 41 to the reference position / posture PT1 (XT1, YT1, θT1)
Position and posture (XT1 + ΔXT1, YT1 + ΔYT1, θT1 +) shifted by the amount of calculation correction (ΔXT1, ΔYT1, ΔθT1) from
ΔθT1), and the hand 41 grips the work 12 in this displaced position and posture (steps 206, 3
06).

【0057】この結果、ワーク12に対するハンド41
の相対位置、相対姿勢は、教示時に設定したものと等し
くなる(図5参照)。ハンド41がワーク12を把持し
た後の搬送指令については、補正はなされず動作プログ
ラム中に記述されたままのものが出力される。この結
果、ロボット4はワーク12を毎回、搬送先の同じ位置
に、同じ姿勢で搬送することができる(ステップ20
7、307)。
As a result, the hand 41 for the work 12
The relative position and relative attitude of are equal to those set at the time of teaching (see FIG. 5). The conveyance command after the hand 41 grips the work 12 is not corrected and is output as described in the operation program. As a result, the robot 4 can transfer the work 12 to the same position of the transfer destination in the same posture every time (step 20).
7, 307).

【0058】以後、ワーク積載台1上にストックされた
ワーク12がなくなるまで、ステップ107以降の動作
が繰り返し実行される(ステップ111、112、20
8)。
Thereafter, the operations after step 107 are repeatedly executed until there are no works 12 stocked on the work stacking base 1 (steps 111, 112, 20).
8).

【0059】なお、実施例では、センサ部32がCCD
カメラである場合について説明したが、センサ部として
は、圧力を検出媒体とするものであってもよい。
In the embodiment, the sensor section 32 is a CCD.
Although the case where the sensor is a camera has been described, the sensor section may use pressure as a detection medium.

【0060】例えば、センサ部として、圧力パッド(複
数個のパッドからなり各パッドに加えられた圧力の大き
さを、信号として出力するもの)を用い、圧力パッドか
ら出力される圧力信号の分布に応じて、圧力パッド上に
置かれたワークの位置、姿勢を検出するようにしてもよ
い。
For example, a pressure pad (composed of a plurality of pads and outputting the magnitude of the pressure applied to each pad as a signal) is used as the sensor unit, and the distribution of the pressure signal output from the pressure pad is calculated. Accordingly, the position and orientation of the work placed on the pressure pad may be detected.

【0061】また、前述の、レーザ変位計を複数個設け
たセンサ部によってワークの位置、姿勢を検出する代わ
りに、1つのレーザ変位計を走査させることでワークの
位置、姿勢を検出するようにしてもよい。また、ワーク
積載台1も複数個設けるとともに、移送装置2のハンド
21の動作範囲を拡大し、各積載台から順次ワークを計
測台上に移載するようにし、ワーク移載の作業効率を高
めるようにしてもよい。
Further, instead of detecting the position and orientation of the work by the above-mentioned sensor unit provided with a plurality of laser displacement gauges, the position and orientation of the work can be detected by scanning one laser displacement meter. May be. In addition, a plurality of work loading platforms 1 are provided, the operating range of the hand 21 of the transfer device 2 is expanded, and the work is sequentially loaded from the respective loading platforms onto the measuring table to improve the work transfer efficiency. You may do it.

【0062】なお、ワーク積載台1および移載装置2
は、システムの完全自動化の上では不可欠であるが、こ
れらを省略し計測台3上に手動でワークを移載するよう
な実施も可能である。
The work loading table 1 and the transfer device 2
Is indispensable for complete automation of the system, but it is also possible to omit these and manually transfer the work on the measuring table 3.

【0063】[0063]

【発明の効果】以上説明したように本発明によれば、ワ
ーク載置台に載置されたワークに対するロボットのハン
ドの相対位置、相対姿勢を所望のものとするよう任意に
変更することができるので、ワークの種類の変更や作業
内容の変更に応じて把持位置、把持姿勢を柔軟に変更す
ることができる。
As described above, according to the present invention, the relative position and relative posture of the robot hand with respect to the work placed on the work placing table can be arbitrarily changed to a desired one. The gripping position and gripping posture can be flexibly changed according to the change of the type of work and the change of work content.

【図面の簡単な説明】[Brief description of drawings]

【図1】図1は本発明に係るロボットのワーク把持動作
制御装置の実施例のシステムの外観を示す斜視図であ
る。
FIG. 1 is a perspective view showing an external appearance of a system of an embodiment of a work gripping operation control device for a robot according to the present invention.

【図2】図2は実施例のシステムの構成を示すブロック
図である。
FIG. 2 is a block diagram showing the configuration of the system of the embodiment.

【図3】図3は、実施例のロボットのハンドがワークを
把持する様子を示す平面図であり、前処理の内容を説明
する図である。
FIG. 3 is a plan view showing a state in which the hand of the robot of the embodiment grips a work, and is a diagram for explaining the contents of preprocessing.

【図4】図4は、実施例のロボットのハンドがワークを
把持する様子を示す平面図であり、教示処理の内容を説
明する図である。
FIG. 4 is a plan view showing a state in which the hand of the robot of the embodiment grips the work, and is a diagram for explaining the contents of the teaching process.

【図5】図5は、実施例のロボットのハンドがワークを
把持する様子を示す平面図であり、再生処理の内容を説
明する図である。
FIG. 5 is a plan view showing a state in which the hand of the robot of the embodiment grips the work, and is a diagram for explaining the content of the reproduction processing.

【図6】図6は、実施例のシステムで行われる処理の手
順を示すフローチャートである。
FIG. 6 is a flowchart showing a procedure of processing performed in the system of the embodiment.

【符号の説明】[Explanation of symbols]

3 計測台 4 ロボット 5 コントローラ 12 ワーク 32 センサ部 41 ハンド 3 Measuring stand 4 Robot 5 Controller 12 Work 32 Sensor part 41 Hand

Claims (2)

【特許請求の範囲】[Claims] 【請求項1】 ワーク載置台上に載置されたワーク
を、ロボットのハンドで把持するように前記ロボットハ
ンドの位置および姿勢を制御する制御手段を具えたロボ
ットのワーク把持動作制御装置において、 前記ワーク載置台に載置されたワークの位置および姿勢
角を計測する計測手段を具え、 前記制御手段は、 教示時に、前記ワーク載置台上において前記ハンドで前
記ワークを把持したときの前記ワークの基準となる第1
の位置および姿勢角を前記計測手段で計測するととも
に、前記ワークを把持したハンドを一定姿勢角だけ移動
させたときの前記ワークの第2の位置を前記計測手段で
計測し、 前記計測手段で計測された前記ワークの基準となる第1
の位置および第2の位置と、前記ハンドの前記一定姿勢
角とに基づいて、前記ワークの前記基準となる第1の位
置に対する載置位置ずれを前記ハンドの位置および姿勢
角の補正量に変換するための補正パラメータを演算し、 再生時に、前記ワークが前記ワーク載置台上に載置され
た際の載置位置および載置姿勢角を前記計測手段で計測
し、この計測された載置位置および載置姿勢角と、教示
時に計測された基準となる第1の位置および姿勢角と、
前記補正パラメータとに基づいて、前記ハンドの位置お
よび姿勢角の補正量を演算し、 この演算された補正量によって前記ハンドが前記ワーク
を把持するときの当該ハンドの位置および姿勢角を補正
するようにした、 ロボットの把持動作制御装置。
1. A work gripping operation control device for a robot, comprising: a control means for controlling the position and posture of the robot hand so that a work placed on a work mounting table is gripped by the robot hand. The control means includes a measuring means for measuring the position and the attitude angle of the work placed on the work placing table, and the control means, when teaching, the reference of the work when the hand is grasped by the hand on the work placing table. Becomes the first
Position and posture angle of the work is measured by the measuring means, and the second position of the work when the hand holding the work is moved by a fixed posture angle is measured by the measuring means, and is measured by the measuring means. The first that serves as a reference for the aforesaid workpiece
Position and second position and the constant posture angle of the hand, the placement position shift of the workpiece with respect to the reference first position is converted into a correction amount of the hand position and posture angle. A correction parameter for performing the calculation is calculated, and at the time of reproduction, the mounting position and the mounting attitude angle when the work is mounted on the work mounting table are measured by the measuring means, and the measured mounting position is measured. And a mounting posture angle, and a first position and posture angle which are the reference measured at the time of teaching,
A correction amount of the position and posture angle of the hand is calculated based on the correction parameter, and the position and posture angle of the hand when the hand grips the work are corrected by the calculated correction amount. The gripping motion control device for the robot.
【請求項2】 ワークが積み重ねられたワーク積載
台と、 前記ワーク積載台にあるワークを取り出して前記ワーク
載置台上に載置させる移送装置とをさらに具えた請求項
1記載のロボットの把持動作制御装置。
2. The robot gripping operation according to claim 1, further comprising: a work stacking platform on which works are stacked; and a transfer device that takes out the work from the work stacking platform and mounts it on the work mounting platform. Control device.
JP3540995A 1995-02-23 1995-02-23 Robot work gripping control device Pending JPH08224623A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP3540995A JPH08224623A (en) 1995-02-23 1995-02-23 Robot work gripping control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP3540995A JPH08224623A (en) 1995-02-23 1995-02-23 Robot work gripping control device

Publications (1)

Publication Number Publication Date
JPH08224623A true JPH08224623A (en) 1996-09-03

Family

ID=12441093

Family Applications (1)

Application Number Title Priority Date Filing Date
JP3540995A Pending JPH08224623A (en) 1995-02-23 1995-02-23 Robot work gripping control device

Country Status (1)

Country Link
JP (1) JPH08224623A (en)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1997030804A1 (en) * 1996-02-23 1997-08-28 Toyo Kohan Co., Ltd. Method of operating robot for press-brake, and control device
JP2007237394A (en) * 2007-06-29 2007-09-20 Amada Co Ltd Workpiece positioning device
EP1914023A1 (en) * 2006-10-20 2008-04-23 Trumpf Maschinen Austria GmbH & CO. KG. Separation device
EP2177326A3 (en) * 2008-10-14 2012-04-04 Safan B.V. Method for aligning a workpiece to a robot
JP2013107080A (en) * 2011-11-17 2013-06-06 Amada Co Ltd Method for supplying bending machine with rectangular workpieces stacked without being aligned
WO2019207687A1 (en) * 2018-04-25 2019-10-31 川崎重工業株式会社 Horizontal articulated robot
CN111468629A (en) * 2019-01-24 2020-07-31 会田工程技术有限公司 Workpiece conveying system, number-of-workpieces-conveyed detection device, and control method for workpiece conveying system
JP2025536320A (en) * 2022-10-21 2025-11-05 バイストロニック レーザー アクチェンゲゼルシャフト Apparatus and method for automatically bending a workpiece

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1997030804A1 (en) * 1996-02-23 1997-08-28 Toyo Kohan Co., Ltd. Method of operating robot for press-brake, and control device
EP1914023A1 (en) * 2006-10-20 2008-04-23 Trumpf Maschinen Austria GmbH & CO. KG. Separation device
JP2007237394A (en) * 2007-06-29 2007-09-20 Amada Co Ltd Workpiece positioning device
EP2177326A3 (en) * 2008-10-14 2012-04-04 Safan B.V. Method for aligning a workpiece to a robot
JP2013107080A (en) * 2011-11-17 2013-06-06 Amada Co Ltd Method for supplying bending machine with rectangular workpieces stacked without being aligned
WO2019207687A1 (en) * 2018-04-25 2019-10-31 川崎重工業株式会社 Horizontal articulated robot
CN111468629A (en) * 2019-01-24 2020-07-31 会田工程技术有限公司 Workpiece conveying system, number-of-workpieces-conveyed detection device, and control method for workpiece conveying system
JP2025536320A (en) * 2022-10-21 2025-11-05 バイストロニック レーザー アクチェンゲゼルシャフト Apparatus and method for automatically bending a workpiece

Similar Documents

Publication Publication Date Title
KR100787704B1 (en) Teaching method for conveying robot and conveying robot
US20060072988A1 (en) Transfer robot system
JP2001511237A (en) Positioning system
US20040266276A1 (en) Connector gripping device, connector inspection system comprising the device, and connector connection system
KR20040018196A (en) Device for Handling a Robot
JP3326175B2 (en) Method and apparatus for calibrating the motion axis of an industrial robot
JP2017035754A (en) Robot system comprising a visual sensor and a plurality of robots
JP4289619B2 (en) Tool position correction method for articulated robots
JPWO2018092236A1 (en) Work robot and work position correction method
JPH08224623A (en) Robot work gripping control device
US12459131B2 (en) Picking system
CN107443404A (en) End effector, robot and robot controller
JP7797558B2 (en) Robot-mounted mobile device and its control method
JP5061965B2 (en) Robot production system
JP5088187B2 (en) Robot installation method and robot production system
CN119585685A (en) Method and system for determining workpiece loading position in a CNC machine having a robotic arm
JP2018116617A (en) Processing system provided with robot for transporting workpieces to processing machine
JP7384653B2 (en) Control device for robot equipment that controls the position of the robot
JPH06278007A (en) Grinding robot
TWI910344B (en) A camera device that calculates three-dimensional position based on images captured by a vision sensor.
CN210012312U (en) Automatic cylinder feeding system
JP4056662B2 (en) Appearance inspection device
JP2007237394A (en) Workpiece positioning device
JP7495864B2 (en) Workpiece transport system and workpiece transport method
JPH06187021A (en) Coordinate correcting method for robot with visual sense