JP2787891B2 - Automatic teaching device for laser robot - Google Patents

Automatic teaching device for laser robot

Info

Publication number
JP2787891B2
JP2787891B2 JP5223413A JP22341393A JP2787891B2 JP 2787891 B2 JP2787891 B2 JP 2787891B2 JP 5223413 A JP5223413 A JP 5223413A JP 22341393 A JP22341393 A JP 22341393A JP 2787891 B2 JP2787891 B2 JP 2787891B2
Authority
JP
Japan
Prior art keywords
processing
distance
normal vector
calculating
laser robot
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Lifetime
Application number
JP5223413A
Other languages
Japanese (ja)
Other versions
JPH0775982A (en
Inventor
浩一 印藤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric Corp
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 Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP5223413A priority Critical patent/JP2787891B2/en
Publication of JPH0775982A publication Critical patent/JPH0775982A/en
Application granted granted Critical
Publication of JP2787891B2 publication Critical patent/JP2787891B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【産業上の利用分野】本発明は、任意形状の加工ワーク
に対して、レーザロボットで教示する際、自動的に加工
ポイントの位置及び加工ノズルの姿勢を決定し登録する
レーザロボットの自動教示装置に関するものである。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to an automatic teaching device for a laser robot for automatically determining and registering the position of a processing point and the attitude of a processing nozzle when teaching a work having an arbitrary shape with a laser robot. It is about.

【0002】[0002]

【従来の技術】従来におけるレーザロボットでは、任意
形状の加工ワーク上の加工すべきポイントに対して、作
業者がレーザロボットの各軸に対する操作釦を駆使し
て、最終的にレーザが照射される加工ノズルの位置・姿
勢が決定登録される。次に、登録された位置・姿勢及び
加工条件に基づきプレイバックを行うことにより、レー
ザ溶接またはレーザ切断などのレーザ加工が実施され
る。その際、良好な加工結果を得るためには、加工ノズ
ルから照射されるレーザビームが加工ワークの法線ベク
トルに沿って入射される必要がある。このため、レーザ
ロボットの各軸の操作釦を操作する教示作業は、作業者
の技能と手間を要する難しいものであった。
2. Description of the Related Art In a conventional laser robot, a worker finally irradiates a laser beam to a point to be processed on a workpiece having an arbitrary shape by using an operation button for each axis of the laser robot. The position and orientation of the processing nozzle are determined and registered. Next, by performing playback based on the registered position / posture and processing conditions, laser processing such as laser welding or laser cutting is performed. At that time, in order to obtain a good processing result, it is necessary that the laser beam emitted from the processing nozzle be incident along the normal vector of the processed workpiece. For this reason, the teaching operation of operating the operation buttons of each axis of the laser robot has been difficult and requires the skill and labor of the operator.

【0003】従来、3次元レーザ加工機や産業用ロボッ
トで、作業者が行う教示作業を自動化した例としては、
特開昭62−15063号公報、特開昭62−4940
5号公報、特開昭57−178683号公報及び特開平
3−55184号公報等が知られている。これらのもの
では、加工ワーク上の少なくとも3点を距離測定し、そ
れらの距離データにより加工ポイントの位置と法線方向
とを決定し、加工ヘッドまたはツール先端の位置・姿勢
を教示データとして登録していた。
[0003] Conventionally, examples of automated teaching work performed by a worker using a three-dimensional laser beam machine or an industrial robot include:
JP-A-62-15063, JP-A-62-4940
No. 5, JP-A-57-178683 and JP-A-3-55184 are known. In these devices, at least three points on a processing work are measured for distance, the position and normal direction of the processing point are determined based on the distance data, and the position / posture of the processing head or tool tip is registered as teaching data. I was

【0004】図8は上述の公報等にて、レーザロボット
の教示を行うときの概念図である。図8において、1は
加工対象となる加工ワーク、P0 は加工すべきポイン
ト、P1 ,P2 ,P3 は距離センサからの情報で演算さ
れた加工ワーク1上のポイント、ベクトルV1 は上記3
点(P1 〜P3 )より演算された法線ベクトルである。
FIG. 8 is a conceptual diagram when teaching a laser robot in the above-mentioned publications and the like. In FIG. 8, 1 is a work to be machined, P 0 is a point to be machined, P 1 , P 2 , P 3 are points on the work 1 calculated based on information from the distance sensor, and a vector V 1 is 3 above
This is a normal vector calculated from the points (P 1 to P 3 ).

【0005】次に、その動作について説明する。教示デ
ータの姿勢については、ポイントP1 ,P2 ,P3 より
法線ベクトルV1 を次式にて演算し、その法線ベクトル
1 を加工ノズルまたはツール先端の姿勢に重畳するこ
とにより決定していた。
Next, the operation will be described. The orientation of the teaching data, determined by from points P 1, P 2, P 3 and normal vector V 1 calculated by the following equation, superimposes the normal vector V 1 in the posture of the processing nozzle or tool tip Was.

【0006】[0006]

【数1】 (Equation 1)

【0007】また、教示データの位置については、特開
昭62−15063号公報等では、ポイントP1
2 ,P3 の加工ヘッドからのそれぞれの距離の平均を
求め、それらの距離が予め設定された距離となるように
補正し決定される。また、特開昭62−49405号公
報等ではポイントP1 ,P2 ,P3 より決定される平面
とツール先端との距離を求め、それらの距離が予め設定
された距離となるように補正し決定される。これらの動
作により、教示データとして位置・姿勢を登録してい
た。
[0007] Regarding the position of the teaching data, Japanese Unexamined Patent Publication No. Sho 62-15063 discloses a point P 1 ,
The average of the respective distances of P 2 and P 3 from the processing head is obtained, and the distances are corrected and determined so as to be a preset distance. Also, determine the distance between the plane and the tool tip is determined from the points P 1, P 2, P 3 in JP 62-49405 Patent Publication, corrected such that their distance is preset distance It is determined. With these operations, the position and orientation are registered as teaching data.

【0008】従来の教示データの演算方法では、図8に
示す加工ワーク1上の所定の曲率を有する加工ポイント
4 に対する位置・姿勢も、加工ワーク1が平面である
ときと同様に、距離センサから演算された周辺の3点
(P5 ,P6 ,P7 )により設定される。即ち、加工ポ
イントP4 の法線ベクトルは、ポイントP5 ,P6 ,P
7 より決定される近似平面H1 を基準に演算される法線
ベクトルV2 であるため、実際の曲面に対する法線ベク
トルV3 ではなく、また、加工ポイントP4 の位置につ
いても、近似平面H1 上の位置を補正することで求めて
いた。このため、曲面上の加工ポイントP4 に対して
は、正確に位置・姿勢を教示することができなかった。
更に、このように、少なくとも3個の距離センサを配置
する必要からそれらの配線処理が極めて複雑であった。
[0008] In operation method of the conventional teaching data, the position and orientation with respect to the processing point P 4 having a predetermined curvature on the workpiece 1 shown in FIG. 8, similarly to when workpiece 1 is flat, the distance sensor Are set by three peripheral points (P 5 , P 6 , P 7 ) calculated from. That is, the normal vector of the machining point P 4 is the point P 5, P 6, P
Since the approximate plane H 1 as determined from 7 a normal vector V 2 which is calculated on the basis, rather than the normal vector V 3 to the actual curved, As for the position of the machining point P 4, the approximate plane H It was determined by correcting the position above 1 . Therefore, with respect to the machining point P 4 on the curved surface, it was not possible to teach the precise position and orientation.
Further, as described above, since it is necessary to arrange at least three distance sensors, their wiring processing is extremely complicated.

【0009】そこで、この発明は、かかる教示の不具合
を解決するためになされたもので、レーザロボットの加
工ノズルに配置した1個のセンサにより加工ワークが平
面または曲面であっても区別することなく正確に加工ノ
ズルの位置・姿勢を自動的に決定し、教示データとして
登録するレーザロボットの自動教示装置の提供を課題と
している。
Therefore, the present invention has been made to solve the problem of the teaching, and a single sensor disposed at a processing nozzle of a laser robot makes it possible to distinguish a processed workpiece even if it is a flat or curved surface. It is an object of the present invention to provide an automatic teaching device for a laser robot that automatically determines the position and orientation of a processing nozzle automatically and registers the information as teaching data.

【0010】[0010]

【課題を解決するための手段】請求項1にかかるレーザ
ロボットの自動教示装置は、任意の平面または曲面を有
する加工ワークに対してレーザ発振器から導いたレーザ
ビームを照射する加工ヘッドを任意の方向に移動自在で
あり、前記加工ワーク上の加工ポイントに対向した前記
加工ヘッドに取付けた1個の非接触式の距離センサと、
前記距離センサからのアナログデータをディジタルデー
タに変化する検出データ変換手段と、前記ディジタルデ
ータに基づいて前記加工ヘッド先端と前記加工ワークと
の距離を演算する距離演算手段と、前記距離と予め設定
された適正な加工に必要な距離との差分を演算する残距
離演算手段と、前記差分だけ加工ノズルを前記加工ワー
クに近づける移動指令を演算する加工ノズル方向演算手
段と、前記移動指令に基づいて前記レーザロボットのサ
ーボモータを駆動する駆動手段と、前記移動指令に基づ
く距離に前記加工ヘッドが到達されたのち、前記加工ヘ
ッドを予め設定された制御点で回転移動させ、形状デー
タ群を演算する形状サンプリング手段と、前記形状デー
タ群が平面か曲面かを判定する平面曲面判定手段と、平
面と判定された場合には、前記形状データ群から代表的
な5点を選択し、前記加工ワークに対する法線ベクトル
群を演算する法線ベクトル群演算手段と、前記法線ベク
トル群の平均ベクトルを演算し、前記加工ポイントの法
線ベクトルとする法線ベクトル平均化演算手段と、曲面
と判定された場合には、前記形状データ群と前記加工ポ
イントとから接線を演算する接線演算手段と、前記接線
より前記加工ポイントの法線ベクトルを演算する法線ベ
クトル演算手段と、前記駆動手段で設定された距離と一
致した位置を前記加工ポイントにおける前記レーザロボ
ットの位置とし、前記形状データ群が平面か曲面かに応
じて演算された前記法線ベクトルを前記加工ポイントに
おける前記レーザロボットの姿勢として登録する位置・
姿勢登録手段とを具備するものである。
According to a first aspect of the present invention, there is provided an automatic teaching apparatus for a laser robot, wherein a processing head for irradiating a laser beam guided from a laser oscillator to a processing work having an arbitrary plane or curved surface in an arbitrary direction. One non-contact type distance sensor attached to the processing head, which is movable to a processing point on the processing work,
Detection data conversion means for converting analog data from the distance sensor into digital data, distance calculation means for calculating the distance between the tip of the processing head and the work based on the digital data, and the distance set in advance. Remaining distance calculation means for calculating a difference from the distance required for proper processing, processing nozzle direction calculation means for calculating a movement command for bringing the processing nozzle closer to the processing work by the difference, and Driving means for driving a servo motor of a laser robot, and a shape for calculating a shape data group by rotating the processing head at a preset control point after the processing head reaches a distance based on the movement command. Sampling means; planar curved surface determining means for determining whether the shape data group is a plane or a curved surface; A normal vector group calculating means for selecting five representative points from the shape data group and calculating a normal vector group for the processed workpiece, and calculating an average vector of the normal vector group, Normal vector averaging calculating means for setting a normal vector of a point; tangent calculating means for calculating a tangent from the shape data group and the processing point when it is determined that the surface is a curved surface; A normal vector calculating means for calculating the normal vector of the laser robot, and a position corresponding to the distance set by the driving means as a position of the laser robot at the processing point, and the shape data group is determined based on whether the shape data group is a plane or a curved surface. The position where the calculated normal vector is registered as the posture of the laser robot at the processing point.
Posture registration means.

【0011】また、請求項2にかかるレーザロボットの
自動教示装置は、請求項1の前記形状サンプリング手段
は、前記加工ヘッドをレーザロボット座標系の指定され
た座標軸に沿って予め設定された幅で平行移動させ、形
状データ群を演算するものである。
According to a second aspect of the present invention, in the automatic teaching apparatus for a laser robot, the shape sampling means of the first aspect is configured such that the shape of the processing head is set to a predetermined width along a designated coordinate axis of the laser robot coordinate system. The object is moved in parallel to calculate a group of shape data.

【0012】また、請求項3にかかるレーザロボットの
自動教示装置は、請求項1の前記距離センサを接触式と
し、前記形状サンプリング手段は、前記距離センサを取
付けた前記加工ヘッドをレーザロボット座標系の指定さ
れた座標軸に沿って予め設定された幅の平行移動と予め
設定された距離の加工ノズル方向への移動との組合わせ
で移動させ、形状データ群を演算するものである。
According to a third aspect of the present invention, there is provided an automatic teaching apparatus for a laser robot, wherein the distance sensor according to the first aspect is a contact type, and the shape sampling means is configured to transfer the processing head having the distance sensor to a laser robot coordinate system. Is moved along a combination of parallel movement of a preset width along the designated coordinate axis and movement of the preset distance in the direction of the processing nozzle to calculate a group of shape data.

【0013】[0013]

【作用】請求項1においては、サンプリングしたデータ
群より、曲面か平面かを判定することができるので、加
工ワークのあらゆる加工面に対して、教示データである
位置・姿勢を正確に登録することができる。また、加工
ノズルに配置したただ1個の非接触式の距離センサのた
め配線処理を大幅に簡素化することができる。
According to the first aspect, it is possible to determine whether the surface is a curved surface or a flat surface based on a sampled data group. Can be. Also, the wiring processing can be greatly simplified because only one non-contact type distance sensor is arranged on the processing nozzle.

【0014】請求項2の形状サンプリング手段は、請求
項1の作用に加えて、サンプリングできないような小さ
な曲率を持った加工ワークに対しても、教示データであ
る位置・姿勢を正確に登録することができる。
According to a second aspect of the present invention, in addition to the function of the first aspect, the shape / sampling means for accurately registering the position and orientation as the teaching data even for a work having a small curvature that cannot be sampled. Can be.

【0015】請求項3の形状サンプリング手段は、請求
項1の作用に加えて、ただ1個の接触式の距離センサを
加工ノズルに配置したため、非接触式の距離センサで
は、形状サンプリングができない材質である例えば、木
材等の加工ワークに対しても、教示データである位置・
姿勢を正確に登録することができる。
According to a third aspect of the present invention, in addition to the function of the first aspect, since only one contact-type distance sensor is arranged on the processing nozzle, the material cannot be sampled by a non-contact distance sensor. For example, for a work piece such as wood,
Posture can be registered accurately.

【0016】[0016]

【実施例】以下、本発明を具体的な実施例に基づいて説
明する。 〈実施例1〉 図1は本発明の第一実施例にかかるレーザロボットの自
動教示装置の全体構成を示すブロック図、図2は本発明
の第一実施例にかかるレーザロボットの自動教示装置に
おけるレーザロボット座標系と加工ノズル座標系との関
係を示す説明図である。なお、本実施例は請求項1の実
施例に対応するものである。図1において、1は加工ワ
ーク、2は検出データ変換手段、3は距離演算手段、4
は残距離演算手段、5は加工ノズル方向演算手段、6は
駆動手段、7は形状サンプリング手段、8は平面曲面判
定手段、9は法線ベクトル群演算手段、10は法線ベク
トル平均化演算手段、11は接線演算手段、12は法線
ベクトル演算手段、13は位置・姿勢登録手段、14は
レーザロボット、15はレーザロボット14の先端に取
付けた加工ノズル、16はレーザビームに重畳されてい
る可視光、17は加工ノズル15に取付けた静電容量型
センサ等の非接触式の距離センサである。
DESCRIPTION OF THE PREFERRED EMBODIMENTS The present invention will be described below with reference to specific embodiments. Embodiment 1 FIG. 1 is a block diagram showing the entire configuration of an automatic teaching device for a laser robot according to a first embodiment of the present invention, and FIG. 2 is a block diagram of the automatic teaching device for a laser robot according to the first embodiment of the present invention. FIG. 3 is an explanatory diagram showing a relationship between a laser robot coordinate system and a processing nozzle coordinate system. This embodiment corresponds to the first embodiment. In FIG. 1, 1 is a processed work, 2 is detection data conversion means, 3 is distance calculation means, 4
Is a remaining distance calculating means, 5 is a processing nozzle direction calculating means, 6 is a driving means, 7 is a shape sampling means, 8 is a plane curved surface determining means, 9 is a normal vector group calculating means, 10 is a normal vector averaging calculating means. , 11 are tangent calculation means, 12 is normal vector calculation means, 13 is position / posture registration means, 14 is a laser robot, 15 is a processing nozzle attached to the tip of the laser robot 14, and 16 is superimposed on the laser beam . The visible light 17 is a non-contact type distance sensor such as a capacitance type sensor attached to the processing nozzle 15.

【0017】次に、その動作について説明する。まず、
図示しない教示ペンダント(コントローラ)でレーザロ
ボット14の各関節軸を操作して、加工ワーク1上の加
工ポイントに対して、加工ノズル15の位置・姿勢を概
略設定する。このとき、加工ノズル15の先端から投光
されている可視光16を加工ポイントに合わせる。次
に、教示ペンダント上に設けた自動教示開始釦を押し、
教示動作を開始させる。
Next, the operation will be described. First,
By operating each joint axis of the laser robot 14 with a teaching pendant (controller) (not shown), the position and orientation of the processing nozzle 15 are roughly set with respect to the processing point on the processing work 1. At this time, the visible light 16 projected from the tip of the processing nozzle 15 is adjusted to the processing point. Next, press the automatic teaching start button provided on the teaching pendant,
Start teaching operation.

【0018】検出データ変換手段2では、レーザロボッ
ト14の加工ノズル15の先端に取付けられた距離セン
サ17で検出されたアナログデータ出力がディジタルデ
ータに変換される。次の距離演算手段3では、検出デー
タ変換手段2からの変換されたディジタルデータに基づ
いて、距離センサ17の種類に応じて、図2に示す加工
ノズル15先端と加工ワーク1との間の距離lが演算さ
れる。
The detection data conversion means 2 converts the analog data output detected by the distance sensor 17 attached to the tip of the processing nozzle 15 of the laser robot 14 into digital data. In the following distance calculating means 3, based on the digital data converted from the detection data converting means 2, the distance between the tip of the processing nozzle 15 shown in FIG. 1 is calculated.

【0019】次に、残距離演算手段4では、演算された
距離lと予め設定された適正な加工を実現するための距
離Lとの差分が演算され、次式の残距離Δdとして出力
される。 Δd=l−L ・・・(2)
Next, the remaining distance calculating means 4 calculates a difference between the calculated distance 1 and a predetermined distance L for realizing proper processing, and outputs the difference as a remaining distance Δd of the following equation. . Δd = 1−L (2)

【0020】次の加工ノズル方向演算手段5では、式
(2)で演算された残距離Δdに基づいて、加工ノズル
15の軸方向への移動指令が演算される。即ち、加工ノ
ズル15を図2に示す加工ノズル座標系18のYN 軸方
向(加工ノズル15の軸方向)へ残距離Δdだけ移動さ
せるため、各関節軸の移動量毎に分解され、移動指令と
して出力される。この変換は、通常、次に示す同次変換
行列を用いて行われる。加工ワーク1から距離lに位置
する同次変換行列Π0 は、次式のようになる。
The next processing nozzle direction calculation means 5 calculates a command to move the processing nozzle 15 in the axial direction based on the remaining distance Δd calculated by the equation (2). In other words, for moving the machining nozzle 15 to the Y N axis direction of the processing nozzle coordinate system 18 shown in FIG. 2 (the axial direction of the processing nozzle 15) by the remaining distance [Delta] d, is decomposed for each moving amount of each joint axis, movement command Is output as This conversion is usually performed using the following homogeneous conversion matrix. The homogeneous transformation matrix Π 0 located at a distance 1 from the work 1 is represented by the following equation.

【0021】[0021]

【数2】 (Equation 2)

【0022】ベクトルR0 =(ベクトルXN ベクトル
N ベクトルZN ) ここで、ベクトルXN は加工ノズル座標系18のXN
のレーザロボット座標系19に対する方向余弦、ベクト
ルYN は加工ノズル座標系18のYN 軸のレーザロボッ
ト座標系19に対する方向余弦(加工ノズル15の姿勢
を示す)、ベクトルZN は加工ノズル座標系18のZN
軸のレーザロボット座標系19に対する方向余弦であ
る。 ベクトルP0 =(X0 ,Y0 ,Z0 t このベクトルP0 は、加工ノズル座標系18の原点ON
のレーザロボット座標系19に対する位置、つまり、加
工ノズル15の先端位置を示す。すると、求める加工ポ
イントの同次変換行列Π1 は、次式のようになる。
Vector R 0 = (vector X N vector Y N vector Z N ) where vector X N is the direction cosine of the X N axis of the processing nozzle coordinate system 18 with respect to the laser robot coordinate system 19, and vector Y N is the processing nozzle coordinate system 18 of the Y N axis laser robot coordinate system 19 the direction cosines for the (indicating the posture of the processing nozzle 15), the vector Z N is the processing nozzle coordinate system 18 Z N
The direction cosine of the axis with respect to the laser robot coordinate system 19. Vector P 0 = (X 0 , Y 0 , Z 0 ) t This vector P 0 is the origin O N of the machining nozzle coordinate system 18.
Indicates the position with respect to the laser robot coordinate system 19, that is, the tip position of the processing nozzle 15. Then, the homogeneous transformation matrix Π 1 of the processing point to be obtained is as follows.

【0023】[0023]

【数3】 (Equation 3)

【0024】この同次変換行列Π0 ,Π1 よりレーザロ
ボット14の各軸の移動量に分解され、移動指令として
出力されるのである。
The homogenous transformation matrices Π 0 and Π 1 are decomposed into movement amounts of the respective axes of the laser robot 14 and output as movement commands.

【0025】そして、駆動手段6では、加工ノズル15
と加工ワーク1の距離が予め設定された距離Lとなるよ
う式(4)に基づいて出力された移動指令に基づきレー
ザロボット14の各軸のサーボモータが駆動される。
In the driving means 6, the processing nozzle 15
The servo motors of the respective axes of the laser robot 14 are driven based on the movement command output based on the equation (4) so that the distance between the workpiece robot 1 and the workpiece 1 becomes the preset distance L.

【0026】駆動手段6からの移動指令でレーザロボッ
ト14の各軸のサーボモータが駆動され、残距離演算手
段4で残距離Δd=0となり、加工ノズル15先端と加
工ワーク1との間の距離lが予め設定された距離Lに等
しくなると、形状サンプリング手段7以降の処理に移
る。形状サンプリング手段7では、加工ワーク1の形状
をサンプリングするため、図3に示すように、予め設定
された制御点OC を回転中心として加工ノズル15を回
転移動させ、まず最初に選択したA方向にサンプリング
移動を行い、A方向の形状データ群20として格納し、
続いてA方向と直交するB方向にサンプリング移動を行
い、B方向の形状データ群21として格納する。図4に
示すように、加工ノズル15の制御点OC への制御点の
移動は、先に演算した式(4)の同次変換行列Π1 の加
工ノズル長をN0 からN1 に変更し、新たに同次変換行
列Π2を演算することにより、容易に実現できる。
The servo motor of each axis of the laser robot 14 is driven by a movement command from the driving means 6, and the remaining distance Δd = 0 by the remaining distance calculation means 4, and the distance between the tip of the processing nozzle 15 and the processing work 1 When 1 becomes equal to the preset distance L, the processing proceeds to the processing after the shape sampling means 7. The shape sampling means 7, to sample the shape of the workpiece 1, as shown in FIG. 3, the processing nozzle 15 is rotated moving the control point O C which is set in advance as a rotational center, first selected direction A Is sampled and stored as a shape data group 20 in the A direction.
Subsequently, sampling movement is performed in the B direction orthogonal to the A direction, and stored as a shape data group 21 in the B direction. As shown in FIG. 4, the processing movement of the control point to the control point O C of the nozzle 15, change processing nozzle length of homogeneous transformation matrix [pi 1 of the previously calculated expression (4) from N 0 to N 1 and, by newly calculating a homogeneous transformation matrix [pi 2, it can be easily realized.

【0027】[0027]

【数4】 (Equation 4)

【0028】また、回転移動のための中心軸の選択は、
加工ノズル15の姿勢とレーザロボット座標系19との
各座標軸の内積より行う。 選択座標軸≡MIN(ベクトルYN ・ベクトルXR ,ベクトルYN ・ベクトル YR ,ベクトルYN ・ベクトルZR ) ・・・(6) (XR 軸かYR 軸かZR 軸か選択する。)したがって、
図3に示す加工ノズル15のA方向サンプリング開始点
15a及びA方向サンプリング終了点15bの同次変換
行列Π3 ,Π4 は、選択した回転中心軸を、例えば、X
R 軸、予め設定した回転角度をθP とすると、式(5)
より次式のようになる。
The selection of the center axis for rotational movement is as follows.
This is performed based on the inner product of each coordinate axis of the attitude of the processing nozzle 15 and the laser robot coordinate system 19. Selection axes ≡MIN selecting (vector Y N · vector X R, vector Y N · vectors Y R, vector Y N · vector Z R) or · · · (6) (X R-axis or Y R-axis or Z R axis .)
The homogeneous transformation matrices Π 3 , Π 4 of the A-direction sampling start point 15 a and the A-direction sampling end point 15 b of the processing nozzle 15 shown in FIG.
Assuming that the R axis and the preset rotation angle are θ P , equation (5)
The following equation is obtained.

【0029】[0029]

【数5】 (Equation 5)

【数6】 (Equation 6)

【0030】式(7)及び式(8)の結果、それぞれレ
ーザロボット14の各関節軸を駆動し、図3に示す加工
ノズル15のA方向サンプリング開始点15aからA方
向サンプリング終了点15bまでのサンプリング動作を
実施する。
As a result of the equations (7) and (8), each joint axis of the laser robot 14 is driven, and the processing nozzle 15 shown in FIG. 3 is moved from the A-direction sampling start point 15a to the A-direction sampling end point 15b. Perform a sampling operation.

【0031】予め設定された時間間隔でサンプリングさ
れるデータは、直ちに、加工ノズル15と加工ワーク1
との間の距離に変換され、加工ノズル15の制御点OC
に基づいて、加工ワーク1の形状データ群として演算さ
れ、図示しない補助記憶装置に格納される。例えば、図
3に示すA方向サンプリング開始点15aでサンプリン
グした距離をhとすると、レーザロボット座標系19で
の形状データSA0は、次式のようになる。
The data sampled at a preset time interval is immediately transmitted to the processing nozzle 15 and the processing work 1.
And the control point O C of the processing nozzle 15
Is calculated as a group of shape data of the processed workpiece 1 and stored in an auxiliary storage device (not shown). For example, assuming that the distance sampled at the sampling start point 15a in the A direction shown in FIG. 3 is h, the shape data S A0 in the laser robot coordinate system 19 is as follows.

【0032】[0032]

【数7】 (Equation 7)

【0033】同様な処理により、A方向のデータ群をS
A0〜SAnとして格納する。B方向についても、式(6)
で2番目に小さい回転中心軸を選択し、同様な処理を行
い、B方向サンプリングデータ群SB0〜SBnとして格納
する。
By the same processing, the data group in the A direction is
Stored as A0 to S An . Equation (6) also applies to the B direction.
, The second smallest rotation axis is selected, the same processing is performed, and stored as the B-direction sampling data groups S B0 to S Bn .

【0034】次の平面曲面判定手段8では、A方向、B
方向それぞれのデータ群について、サンプリング開始点
と終了点を結ぶ直線に対して、各サンプリングデータか
ら垂線を下ろし、その垂線の長さの最大値が、経験によ
って予め設定された判定基準εより大きい場合は曲面、
小さい場合は平面として判定する。即ち、図5に示すよ
うに、A方向サンプリング開始点から終了点までSA0
A1,…,SAnとすると、A方向の垂線長さ最大値は、
次式のようになる。
In the next plane curved surface determining means 8, the direction A, the direction B
For each data group in each direction, a perpendicular line is drawn from each sampled data with respect to a straight line connecting the sampling start point and the end point, and the maximum value of the length of the perpendicular line is larger than a criterion ε preset by experience. Is a curved surface,
If smaller, it is determined as a plane. That is, as shown in FIG. 5, S A0 ,
Assuming that S A1 ,..., S An , the maximum perpendicular length in the A direction is
It becomes like the following formula.

【0035】[0035]

【数8】 (Equation 8)

【0036】B方向についても同様に処理し、A/B両
方向合わせた垂線長さ最大値と判定基準εとを比較す
る。
The same processing is performed for the B direction, and the maximum value of the perpendicular length in both the A and B directions is compared with the criterion ε.

【0037】平面曲面判定手段8で平面と判定された場
合には、法線ベクトル群演算手段9にて、A/B両方向
からの代表点4点SA0,SAn,SB0,SBnと更に、式
(4)の求める加工ポイントの同次変換行列Π1 の位置
データとしてのベクトルP1 とを合わせて合計5点のデ
ータより、法線ベクトル群が演算される。例えば、5点
よりSA0,SAn,SB0の3点を選択した場合、法線ベク
トルn1 は次式のようになる。 ベクトルn1 =ベクトルSAnA0×ベクトルSB0A0 ・・・(11) 式(11)の処理を5点より3点を選択する組合わせ 5
3 =10回行って10本の法線ベクトル群ベクトルn
1 〜ベクトルn10を演算する。
When the plane is determined to be a plane by the plane curved surface determining means 8, the normal vector group calculating means 9 calculates four representative points S A0 , S An , S B0 , and S Bn from both A / B directions. Further, a group of normal vectors is calculated from data of a total of five points including the vector P 1 as position data of the homogeneous transformation matrix Π 1 of the processing point obtained by the equation (4). For example, when three points S A0 , S An , and S B0 are selected from five points, the normal vector n 1 is expressed by the following equation. Vector n 1 = vector S An S A0 × vector S B0 S A0 ... (11) A combination of the processing of equation (11) that selects three points from five points 5
C 3 = 10 times, 10 normal vector group vectors n
Calculating a 1-vector n 10.

【0038】次の法線ベクトル平均化演算手段10で
は、法線ベクトル群のベクトルn1 〜ベクトルn10の平
均ベクトルn0 を次式により演算し、平面における加工
ポイントの法線ベクトルとする。
The next normal vector averaging means 10 calculates the average vector n 0 of the vectors n 1 to n 10 of the normal vector group by the following equation to obtain the normal vector of the processing point on the plane.

【0039】[0039]

【数9】 (Equation 9)

【0040】一方、平面曲面判定手段8で曲面と判定さ
れた場合には、接線演算手段11で、式(4)で示す加
工ポイントのベクトルP1 が、形状サンプリング手段7
でサンプリングした形状データ群のどのデータ間に存在
するかをA/B両方向でそれぞれ求め、2点のデータよ
り接線ベクトルをそれぞれ演算する。例えば、A方向の
データ群が図5に示すように、XR 軸を中心軸としてサ
ンプリングされた場合、サンプリングデータ群のXR
分は全て同じ値が入る。したがって、図5では、加工ポ
イントの位置のベクトルP1 のYR 成分が、A方向デー
タ群のどこのデータで囲まれるかを求めれば良い。ここ
では、SA8,SA9が求められたとすると、接線ベクトル
1 を次式のように演算する。 ベクトルt1 =ベクトルSA8A9=(0,m1 ,n1 ) ・・・(13) また、B方向についても、同様な処理により、接線ベク
トルt2 を演算する。 ベクトルt2 =(l2 ,0,n2 ) ・・・(14)
On the other hand, when the plane curved surface determining means 8 determines that the surface is a curved surface, the tangent calculating means 11 converts the machining point vector P 1 shown in the equation (4) into the shape sampling means 7.
In each of the A / B directions, the tangent vector is calculated from the data of two points, respectively, in which of the data of the shape data group sampled in step (1). For example, the data group A direction as shown in FIG. 5, when it is sampled as a central axis X R-axis, X R component of the sampled data set are all the same value is entered. Therefore, in FIG. 5, it is sufficient to find out which data in the A direction data group surrounds the Y R component of the vector P 1 at the position of the processing point. Here, assuming that S A8 and S A9 are obtained, the tangent vector t 1 is calculated as in the following equation. Vector t 1 = Vector S A8 S A9 = (0, m 1 , n 1 ) (13) In the B direction, the tangent vector t 2 is calculated by the same processing. Vector t 2 = (l 2 , 0, n 2 ) (14)

【0041】次の法線ベクトル演算手段12では、接線
ベクトルのベクトルt1 ,ベクトルt2 より、それぞれ
の法線ベクトルのベクトルn1 ,ベクトルn2 を求め、
平均化し、最終的に曲面に対する正確な法線ベクトルの
ベクトルn0 を演算する。即ち、式(13)及び式(1
4)より次式のようになる。 ベクトルn1 =(0,n1 ,−m1 ) ・・・(15) ベクトルn2 =(n2 ,0,−l2 ) ・・・(16) したがって、加工ポイントの法線ベクトルn0 は次式の
ようになる。
The next normal vector calculating means 12 obtains the normal vector n 1 and vector n 2 from the tangent vector t 1 and vector t 2 , respectively.
Averaging is performed, and finally a vector n 0 of an accurate normal vector to the curved surface is calculated. That is, Expression (13) and Expression (1)
4) From the following equation: Vector n 1 = (0, n 1 , −m 1 ) (15) Vector n 2 = (n 2 , 0, −l 2 ) (16) Therefore, the normal vector n 0 of the processing point Becomes as follows.

【0042】[0042]

【数10】 (Equation 10)

【0043】法線ベクトル平均化演算手段10または法
線ベクトル演算手段12における処理ののち、位置・姿
勢登録手段13で、式(4)の加工ポイントの位置ベク
トルP1 と、平面曲面に応じて正確に演算された式(1
2)または式(17)の法線ベクトルn0 を、それぞれ
教示データの位置・姿勢として自動的に登録する。
After the processing in the normal vector averaging calculation means 10 or the normal vector calculation means 12, the position / posture registration means 13 calculates the position vector P 1 of the processing point in the equation (4) and the plane surface. The expression (1
2) or the normal vector n 0 in equation (17) is automatically registered as the position and orientation of the teaching data.

【0044】このように、本実施例にかかるレーザロボ
ットの自動教示装置によれば、加工ワーク1が平面また
は曲面であってもレーザロボット14の加工ノズル15
を概略位置決めするだけで、レーザ加工にとって重要な
条件である加工ワークの法線ベクトルに沿った教示が極
めて正確、且つ簡単に実現できる。
As described above, according to the automatic teaching device for a laser robot according to the present embodiment, even if the workpiece 1 is a flat or curved surface, the processing nozzle 15 of the laser robot 14 can be used.
Only by roughly positioning the position, the teaching along the normal vector of the processed workpiece, which is an important condition for laser processing, can be realized extremely accurately and easily.

【0045】〈実施例2〉次に、本発明の第二実施例に
かかるレーザロボットの自動教示装置について図6を参
照して説明する。なお、本実施例は請求項2の実施例に
対応し、上述の第一実施例と同様の構成または相当部分
からなるものについては同一符号及び同一記号を付して
その詳細な説明を省略する。図6に示すように、本実施
例の形状サンプリング手段7では、式(6)により選択
したレーザロボット座標系19の座標軸に沿って、平行
移動しサンプリングを行う。例えば、式(6)の結果、
A方向にXR 軸が選択された場合、A方向サンプリング
開始点15cの同次変換行列をΠ5 、A方向サンプリン
グ終了点15dの同次変換行列をΠ6 、式(4)より加
工ポイントの同次変換行列をΠ1 、そして、予め設定し
た平行移動量をDP とすると、次式のようになる。
<Embodiment 2> Next, an automatic teaching apparatus for a laser robot according to a second embodiment of the present invention will be described with reference to FIG. This embodiment corresponds to the embodiment of claim 2, and the same reference numerals and symbols are given to those having the same configuration or corresponding parts as those of the above-mentioned first embodiment, and detailed description thereof will be omitted. . As shown in FIG. 6, the shape sampling means 7 of the present embodiment performs sampling by moving in parallel along the coordinate axis of the laser robot coordinate system 19 selected by the equation (6). For example, as a result of equation (6),
When the X R axis is selected in the A direction, the homogeneous transformation matrix at the A direction sampling start point 15c is Π 5 , the homogeneous transformation matrix at the A direction sampling end point 15d is Π 6 , and the processing point Assuming that a homogeneous transformation matrix is Π 1 , and a predetermined parallel movement amount is D P , the following equation is obtained.

【0046】[0046]

【数11】 [Equation 11]

【数12】 (Equation 12)

【0047】式(18)及び式(19)により、図6に
示すようなサンプリング動作を行い、刻々とサンプリン
グしたデータのうち、A方向にサンプリング移動したも
のをA方向の形状データ群20とし、A方向と直交する
B方向にサンプリング移動したものをB方向の形状デー
タ群21として、図示しない補助記憶装置に格納する。
この後の位置・姿勢の登録までの処理は、上述の第一実
施例と同じである。
According to the equations (18) and (19), the sampling operation shown in FIG. 6 is performed, and the data sampled and moved in the A direction among the data sampled every moment is set as the shape data group 20 in the A direction. The data sampled and moved in the B direction orthogonal to the A direction is stored in an auxiliary storage device (not shown) as a shape data group 21 in the B direction.
The subsequent processing up to registration of the position / posture is the same as in the first embodiment.

【0048】このように、本実施例にかかるレーザロボ
ットの自動教示装置によれば、曲率の小さな加工ワーク
の場合でも、加工ワークの法線ベクトルに沿った教示が
極めて正確、且つ簡単に実現できる。
As described above, according to the automatic teaching device for a laser robot according to the present embodiment, teaching along a normal vector of a processed workpiece can be realized extremely accurately and easily even for a processed workpiece having a small curvature. .

【0049】〈実施例3〉次に、本発明の第三実施例に
かかるレーザロボットの自動教示装置について図7を参
照して説明する。なお、本実施例は請求項3の実施例に
対応し、上述の第一実施例と同様の構成または相当部分
からなるものについては同一符号及び同一記号を付して
その詳細な説明を省略する。図7に示すように、本実施
例の形状サンプリング手段7では、加工ノズル15の先
端に例えば、スタイラス式センサ等の接触式の距離セン
サ22を取付け、式(6)により選択したレーザロボッ
ト座標系19の座標軸に沿って、平行移動と加工ノズル
方向への移動を繰返すことによりサンプリングを行う。
例えば、式(6)の結果、A方向としてXR 軸、平行移
動量をDP 、そして、加工ワーク1へのアプローチ高さ
をHP 、式(4)より加工ポイントの同次変換行列をΠ
1 とすると、まず最初に加工ワーク1へアプローチする
ための加工ノズル15のアプローチ開始点15eの同次
変換行列Π7 が次式のように演算される。
Embodiment 3 Next, an automatic teaching device for a laser robot according to a third embodiment of the present invention will be described with reference to FIG. This embodiment corresponds to the embodiment of claim 3, and the same reference numerals and symbols are given to those having the same configuration or corresponding parts as those of the above-mentioned first embodiment, and detailed description thereof will be omitted. . As shown in FIG. 7, in the shape sampling means 7 of this embodiment, for example, a contact type distance sensor 22 such as a stylus type sensor is attached to the tip of the processing nozzle 15, and the laser robot coordinate system selected by the equation (6). Sampling is performed by repeating parallel movement and movement in the direction of the processing nozzle along the 19 coordinate axes.
For example, the result of the expression (6), X R-axis as a direction A, the D P parallel movement amount and approach height H P into workpiece 1, a homogeneous transformation matrix of the working point from equation (4) Π
If it is set to 1 , first, the homogeneous transformation matrix Π 7 of the approach start point 15 e of the machining nozzle 15 for approaching the workpiece 1 is calculated as in the following equation.

【0050】[0050]

【数13】 (Equation 13)

【0051】そして、式(20)で求められたΠ7
り、加工ノズル方向へアプローチし、接触式の距離セン
サ22から接触信号が入力された時の位置データを形状
データとする。即ち、アプローチするときの移動量を時
間に応じて変化する量としてA(t) とすると、アプロー
チ中の同次変換行列Π8 は次式のようになる。
Then, from ら れ7 obtained by equation (20), approach is made in the direction of the processing nozzle, and position data when a contact signal is input from the contact type distance sensor 22 is used as shape data. That is, assuming that the moving amount at the time of approaching is A (t) as an amount that changes with time, the homogeneous transformation matrix ア プ ロ ー チ8 during the approaching is as follows.

【0052】[0052]

【数14】 [Equation 14]

【0053】接触信号が入力された時、直ちに、位置デ
ータのベクトルP8 を形状データSA0として、図示しな
い補助記憶装置に格納する。このように、式(20)及
び式(21)の平行移動と加工ノズル方向への移動を繰
返すサンプリング動作をA方向及びB方向についてそれ
ぞれ実施し、A方向にサンプリング移動したものをA方
向の形状データ群20とし、A方向と直交するB方向に
サンプリング移動したものをB方向の形状データ群21
として格納する。この後の位置・姿勢の登録までの処理
は、上述の第一実施例と同様である。
As soon as the contact signal is input, the position data vector P 8 is stored as shape data S A0 in an auxiliary storage device (not shown). As described above, the sampling operation of repeating the parallel movement and the movement in the processing nozzle direction of Expressions (20) and (21) is performed in each of the A direction and the B direction. A data group 20 is obtained by sampling and moving in the B direction orthogonal to the A direction, and the shape data group 21 in the B direction
Stored as Subsequent processing up to registration of the position / posture is the same as in the above-described first embodiment.

【0054】このように、本実施例にかかるレーザロボ
ットの自動教示装置によれば、非接触式の距離センサが
使用できない材質の例えば、木材等の加工ワークの場合
でも、加工ワークの法線ベクトルに沿った教示が極めて
正確、且つ簡単に実現できる。
As described above, according to the automatic teaching device of the laser robot according to the present embodiment, even if the non-contact type distance sensor cannot be used for a work such as wood, the normal vector of the work is used. Can be realized very accurately and easily.

【0055】[0055]

【発明の効果】以上説明したように、請求項1のレーザ
ロボットの自動教示装置は、レーザロボットの概略位置
決め後、残距離演算手段と加工ノズル方向演算手段とに
より、加工ポイントに対するレーザロボットの加工ノズ
ルの位置を正確に決めたのち、形状サンプリング手段と
平面曲面判定手段と平面また曲面に応じた法線ベクトル
の演算手段を具備しており、加工ポイントに対する教示
データが極めて正確、且つ簡単に登録することができ
る。
As described above, in the automatic teaching device for a laser robot according to the first aspect, after the laser robot is roughly positioned, the remaining distance calculating means and the processing nozzle direction calculating means process the laser robot with respect to the processing point. After accurately determining the position of the nozzle, it is equipped with shape sampling means, plane curved surface determination means, and means for calculating normal vectors corresponding to planes and curved surfaces, and teaching data for machining points is registered very accurately and easily. can do.

【0056】請求項2のレーザロボットの自動教示装置
は、請求項1の効果に加えて、形状サンプリング手段
は、更に、レーザロボット座標系に沿って平行移動によ
るサンプリングにより曲率が小さな加工ワークに対して
も加工ポイントに対する教示データが極めて正確、且つ
簡単に登録することができる。
In the automatic teaching device for a laser robot according to the second aspect, in addition to the effect of the first aspect, the shape sampling means further performs sampling on a work piece having a small curvature by parallel movement along the laser robot coordinate system. However, the teaching data for the processing point can be registered very accurately and easily.

【0057】請求項3のレーザロボットの自動教示装置
は、請求項1の効果に加えて、形状サンプリング手段
は、更に、接触式の距離センサを用いレーザロボット座
標系に沿った平行移動と加工ノズル方向への移動の組合
わせ移動によるサンプリングにより、非接触式の距離セ
ンサでは形状サンプリングができない材質からなる加工
ワークに対しても教示データが極めて正確、且つ簡単に
登録することができる。
According to a third aspect of the present invention, in addition to the effect of the first aspect, the shape sampling means further includes a contact type distance sensor for performing parallel movement along the laser robot coordinate system and processing nozzles. By sampling by a combination of movements in the directions, teaching data can be registered very accurately and easily even for a work piece made of a material that cannot be sampled by a non-contact distance sensor.

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

【図1】図1は本発明の第一実施例にかかるレーザロボ
ットの自動教示装置の全体構成を示すブロック図であ
る。
FIG. 1 is a block diagram showing an entire configuration of an automatic teaching device for a laser robot according to a first embodiment of the present invention.

【図2】図2は本発明の第一実施例にかかるレーザロボ
ットの自動教示装置におけるレーザロボット座標系と加
工ノズル座標系との関係を示す説明図である。
FIG. 2 is an explanatory diagram showing a relationship between a laser robot coordinate system and a processing nozzle coordinate system in the automatic teaching device for a laser robot according to the first embodiment of the present invention.

【図3】図3は本発明の第一実施例にかかるレーザロボ
ットの自動教示装置における加工ノズルの動作を示す説
明図である。
FIG. 3 is an explanatory diagram showing an operation of a processing nozzle in the automatic teaching device of the laser robot according to the first embodiment of the present invention.

【図4】図4は本発明の第一実施例にかかるレーザロボ
ットの自動教示装置における加工ノズルの制御点OC
示す説明図である。
Figure 4 is an explanatory diagram showing a control point O C of the processing nozzle in the automatic teaching apparatus according laser robot to the first embodiment of the present invention.

【図5】図5は本発明の第一実施例にかかるレーザロボ
ットの自動教示装置における加工ポイントの法線ベクト
ルn0 を示す説明図である。
FIG. 5 is an explanatory diagram showing a normal vector n 0 of a processing point in the automatic teaching device for a laser robot according to the first embodiment of the present invention.

【図6】図6は本発明の第二実施例にかかるレーザロボ
ットの自動教示装置における加工ノズルの動作を示す説
明図である。
FIG. 6 is an explanatory diagram showing an operation of a processing nozzle in the automatic teaching device of the laser robot according to the second embodiment of the present invention.

【図7】図7は本発明の第三実施例にかかるレーザロボ
ットの自動教示装置における加工ノズルの動作を示す説
明図である。
FIG. 7 is an explanatory view showing the operation of a processing nozzle in the automatic teaching device for a laser robot according to the third embodiment of the present invention.

【図8】図8は従来のレーザロボットの教示における概
念を示す説明図である。
FIG. 8 is an explanatory diagram showing a concept in teaching of a conventional laser robot.

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

1 加工ワーク 2 検出データ変換手段 3 距離演算手段 4 残距離演算手段 5 加工ノズル方向演算手段 6 駆動手段 7 形状サンプリング手段 8 平面曲面判定手段 9 法線ベクトル群演算手段 10 法線ベクトル平均化演算手段 11 接線演算手段 12 法線ベクトル演算手段 13 位置・姿勢登録手段 14 レーザロボット 15 加工ノズル 16 可視光 17 (非接触式の)距離センサ 18 加工ノズル座標系 19 レーザロボット座標系 DESCRIPTION OF SYMBOLS 1 Processing work 2 Detection data conversion means 3 Distance calculation means 4 Remaining distance calculation means 5 Processing nozzle direction calculation means 6 Driving means 7 Shape sampling means 8 Plane curved surface judgment means 9 Normal vector group calculation means 10 Normal vector averaging calculation means Reference Signs List 11 tangent calculation means 12 normal vector calculation means 13 position / posture registration means 14 laser robot 15 processing nozzle 16 visible light 17 (non-contact type) distance sensor 18 processing nozzle coordinate system 19 laser robot coordinate system

Claims (3)

(57)【特許請求の範囲】(57) [Claims] 【請求項1】 任意の平面または曲面を有する加工ワー
クに対してレーザ発振器から導いたレーザビームを照射
する加工ヘッドを任意の方向に移動自在なレーザロボッ
トの自動教示装置において、 前記加工ワーク上の加工ポイントに対向した前記加工ヘ
ッドに取付けた1個の非接触式の距離センサと、 前記距離センサからのアナログデータをディジタルデー
タに変換する検出データ変換手段と、 前記検出データ変換手段からの前記ディジタルデータに
基づいて前記加工ヘッド先端と前記加工ワークとの距離
を演算する距離演算手段と、 前記距離演算手段で演算された前記距離と予め設定され
た適正な加工に必要な距離との差分を演算する残距離演
算手段と、 前記残距離演算手段で演算された前記差分だけ加工ノズ
ルを前記加工ワークに近づける移動指令を演算する加工
ノズル方向演算手段と、 前記加工ノズル方向演算手段で演算された前記移動指令
に基づいて前記レーザロボットのサーボモータを駆動す
る駆動手段と、 前記駆動手段で前記移動指令に基づく距離に前記加工ヘ
ッドが到達されたのち、前記加工ヘッドを予め設定され
た制御点で回転移動させ、形状データ群を演算する形状
サンプリング手段と、 前記形状サンプリング手段で演算された前記形状データ
群が平面か曲面かを判定する平面曲面判定手段と、 前記平面曲面判定手段で平面と判定された場合には、前
記形状サンプリング手段でサンプリングされた前記形状
データ群から代表的な5点を選択し、前記加工ワークに
対する法線ベクトル群を演算する法線ベクトル群演算手
段と、 前記法線ベクトル群演算手段で演算された前記法線ベク
トル群の平均ベクトルを演算し、前記加工ポイントの法
線ベクトルとする法線ベクトル平均化演算手段と、 前記平面曲面判定手段で曲面と判定された場合には、前
記形状サンプリング手段でサンプリングされた前記形状
データ群と前記加工ポイントとから接線を演算する接線
演算手段と、 前記接線演算手段で演算された前記接線より前記加工ポ
イントの法線ベクトルを演算する法線ベクトル演算手段
と、 前記駆動手段で設定された前記距離と一致した位置を前
記加工ポイントにおける前記レーザロボットの位置と
し、前記形状データ群が平面か曲面かに応じて演算され
た前記法線ベクトルを前記加工ポイントにおける前記レ
ーザロボットの姿勢として登録する位置・姿勢登録手段
とを具備することを特徴とするレーザロボットの自動教
示装置。
1. An automatic teaching device for a laser robot capable of moving a processing head for irradiating a laser beam guided from a laser oscillator onto a processing work having an arbitrary plane or a curved surface in an arbitrary direction. One non-contact distance sensor attached to the processing head facing a processing point; detection data conversion means for converting analog data from the distance sensor into digital data; and the digital data from the detection data conversion means. Distance calculating means for calculating a distance between the tip of the processing head and the workpiece based on data; calculating a difference between the distance calculated by the distance calculating means and a distance required for a predetermined proper processing; Remaining distance calculation means, and moving the processing nozzle closer to the processing work by the difference calculated by the remaining distance calculation means. Processing nozzle direction calculating means for calculating a movement command to be performed; driving means for driving a servo motor of the laser robot based on the movement command calculated by the processing nozzle direction calculating means; After the processing head reaches a distance based on the shape data, the processing head is rotated and moved at a preset control point, and a shape sampling unit that calculates a shape data group; and the shape data group calculated by the shape sampling unit. A plane curved surface determining unit that determines whether the surface is a plane or a curved surface; and when the plane curved surface determining unit determines that the surface is a plane, five representative points are selected from the shape data group sampled by the shape sampling unit. A normal vector group calculating means for calculating a normal vector group for the processed workpiece; and a normal vector group calculating means. An average vector of the calculated normal vector group is calculated, and a normal vector averaging calculation unit as a normal vector of the processing point, and when the plane surface determination unit determines that the surface is a curved surface, the shape is determined. A tangent calculating means for calculating a tangent from the shape data group sampled by the sampling means and the processing point; and a normal vector calculation for calculating a normal vector of the processing point from the tangent calculated by the tangent calculating means. Means, and a position corresponding to the distance set by the driving means is a position of the laser robot at the processing point, and the normal vector calculated according to whether the shape data group is a plane or a curved surface is processed by the processing. A position / posture registration unit for registering the position of the laser robot at a point. Automatic teaching apparatus of the bot.
【請求項2】 前記形状サンプリング手段は、前記加工
ヘッドをレーザロボット座標系の指定された座標軸に沿
って予め設定された幅で平行移動させ、形状データ群を
演算することを特徴とする請求項1に記載のレーザロボ
ットの自動教示装置。
2. The apparatus according to claim 1, wherein said shape sampling means moves the machining head in parallel with a predetermined width along a designated coordinate axis of a laser robot coordinate system to calculate a group of shape data. 2. The automatic teaching device for a laser robot according to 1.
【請求項3】 前記距離センサを接触式とし、前記形状
サンプリング手段は、前記距離センサを取付けた前記加
工ヘッドをレーザロボット座標系の指定された座標軸に
沿って予め設定された幅の平行移動と予め設定された距
離の加工ノズル方向への移動との組合わせで移動させ、
形状データ群を演算することを特徴とする請求項1に記
載のレーザロボットの自動教示装置。
3. The method according to claim 1, wherein the distance sensor is a contact type, and the shape sampling means is configured to move the processing head, to which the distance sensor is attached, by a predetermined width along a specified coordinate axis of a laser robot coordinate system. Move in combination with the movement of the preset distance in the direction of the processing nozzle,
2. The automatic teaching device for a laser robot according to claim 1, wherein a shape data group is calculated.
JP5223413A 1993-09-08 1993-09-08 Automatic teaching device for laser robot Expired - Lifetime JP2787891B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP5223413A JP2787891B2 (en) 1993-09-08 1993-09-08 Automatic teaching device for laser robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP5223413A JP2787891B2 (en) 1993-09-08 1993-09-08 Automatic teaching device for laser robot

Publications (2)

Publication Number Publication Date
JPH0775982A JPH0775982A (en) 1995-03-20
JP2787891B2 true JP2787891B2 (en) 1998-08-20

Family

ID=16797760

Family Applications (1)

Application Number Title Priority Date Filing Date
JP5223413A Expired - Lifetime JP2787891B2 (en) 1993-09-08 1993-09-08 Automatic teaching device for laser robot

Country Status (1)

Country Link
JP (1) JP2787891B2 (en)

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09164494A (en) * 1995-12-13 1997-06-24 Amada Co Ltd Copying axis control method in three dimensional laser beam machine and device therefor
JPH11197866A (en) * 1998-01-16 1999-07-27 Fuji Electric Co Ltd Device for laser beam machining and laser beam cutting method for work
JP6661925B2 (en) * 2015-09-07 2020-03-11 セイコーエプソン株式会社 Control devices, robots and robot systems
JP6821934B2 (en) * 2016-03-30 2021-01-27 株式会社Ihi Robot system and robot control method
CN105783722B (en) * 2016-04-12 2018-04-06 南京航空航天大学 A kind of range sensor method arrow measuring method based on tetrahedral configuration
JP6588380B2 (en) * 2016-04-21 2019-10-09 ファナック株式会社 Laser processing apparatus and laser processing method
JP6755196B2 (en) * 2017-01-18 2020-09-16 倉敷紡績株式会社 Robot teaching device and robot teaching method
CN108806464A (en) * 2018-06-29 2018-11-13 武汉天之逸科技有限公司 Laser welding intelligent teaching training system
CN108890184B (en) * 2018-08-22 2020-03-17 合肥工业大学 Coordination welding control method based on discrete six-axis robot and two-axis positioner
US11396101B2 (en) 2018-11-08 2022-07-26 Kabushiki Kaisha Toshiba Operating system, control device, and computer program product
JP7034971B2 (en) * 2018-11-08 2022-03-14 株式会社東芝 Actuation systems, controls, and programs
CN109559339B (en) * 2018-11-21 2020-07-28 上海交通大学 Rigid surface contact process analysis method and system based on image control point registration
JP7273705B2 (en) * 2019-02-01 2023-05-15 株式会社東芝 Distance measuring device, friction stir welding device, and friction stir welding method
CN109940291A (en) * 2019-04-16 2019-06-28 安徽联合智能装备有限责任公司 Double cross beam type laser cutting machines and moving method
CN112525131B (en) * 2020-10-23 2021-09-14 清华大学 Method and system for measuring curvature of workpiece by non-contact distance sensor array

Also Published As

Publication number Publication date
JPH0775982A (en) 1995-03-20

Similar Documents

Publication Publication Date Title
JP2787891B2 (en) Automatic teaching device for laser robot
US5371836A (en) Position teaching method and control apparatus for robot
JPS61281305A (en) Articulated robot control device
US5014183A (en) Method and means for path offsets memorization and recall in a manipulator
JP3000162B2 (en) Arc welding equipment
JP2773917B2 (en) Work positioning device for bending equipment
JP2556830B2 (en) Automatic teaching method in robot
JP2654206B2 (en) Touch-up method
JPH0146276B2 (en)
JP2649283B2 (en) Robot machining control method
JPH052455B2 (en)
JP2507298B2 (en) Method for melting angle steel using industrial robot
JPH09267282A (en) Work object position detector of multiarticulated robot
CN114800613B (en) Precision compensation system and method for online detection of assembly errors of industrial robot
JP3078884B2 (en) Copying control device
JP2542615B2 (en) Machining line teaching method
JPS6249405A (en) Teaching method for robot
JP3520631B2 (en) Laser processing machine
JP2802117B2 (en) Processing machine with teaching function
JPH079603B2 (en) Robot copy control device
JPH0637444Y2 (en) Machined surface vertical direction detector
JPH05265537A (en) Automatic teaching method for robot
JP2506418B2 (en) Robot controller
JP3198467B2 (en) Sensor position and attitude path tracking control method
JPH0592378A (en) Industrial robot