JP2006331255A - Control method for industrial robot - Google Patents
Control method for industrial robot Download PDFInfo
- Publication number
- JP2006331255A JP2006331255A JP2005156883A JP2005156883A JP2006331255A JP 2006331255 A JP2006331255 A JP 2006331255A JP 2005156883 A JP2005156883 A JP 2005156883A JP 2005156883 A JP2005156883 A JP 2005156883A JP 2006331255 A JP2006331255 A JP 2006331255A
- Authority
- JP
- Japan
- Prior art keywords
- tool
- movement target
- workpiece
- robot
- teaching
- 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
Links
Images
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
Description
本発明は、産業用ロボットの制御方法に関し、特にロボットの手首部に取り付けられたレーザセンサによって作業線をリアルタイムにトラッキングし、作業線に対するツール制御点の位置と姿勢とを維持することができる産業用ロボットの制御方法に関するものである。 The present invention relates to a method for controlling an industrial robot, and in particular, an industry capable of tracking a work line in real time by a laser sensor attached to a wrist of the robot and maintaining the position and posture of a tool control point with respect to the work line. The present invention relates to a method for controlling a robot.
ティーチングプレイバック方式を採用した産業用ロボットにおいては、ロボットを現在位置から作業者が教示した教示位置に移動させる方法として、現在位置と教示位置との間を予め複数の移動目標位置（補間点）に分割して軌道計画を行い、ロボットのツール制御点を複数の移動目標位置に順次移動させながら最終的に教示位置に到達させる手法が一般的に用いられている。 In an industrial robot adopting the teaching playback method, a plurality of movement target positions (interpolation points) between the current position and the taught position in advance are used as a method of moving the robot from the current position to the taught position taught by the operator. A method is generally used in which a trajectory plan is divided into two and a tool control point of the robot is sequentially moved to a plurality of movement target positions and finally reaches a teaching position.
しかしながら、上記したティーチングプレイバック方式のロボットは作業者が教示した位置姿勢を忠実に再現する能力しか持ち合わせていないため、ワーククランプ治具の締め付け誤差が生じたりワーク形状が不均一だったりすると、作業が行われるべき作業線が教示した作業線とずれてしまうために、作業者が意図したとおりの溶接、切断等の作業が行えないという問題がある。近年では、この問題を解決するために、ロボットの手首部等にレーザセンサを取り付け、公知のリアルタイムトラッキング方式によって、溶接線等の作業線がずれたとしても実際の作業線に沿うようにロボットを移動させながら所定の作業を行う方法が提案されている（例えば、特許文献１参照）。 However, the teaching playback robot described above has only the ability to faithfully reproduce the position and orientation taught by the operator. Therefore, there is a problem that work such as welding and cutting as intended by the operator cannot be performed because the work line to be performed is shifted from the work line taught. In recent years, in order to solve this problem, a laser sensor is attached to the wrist of the robot, etc., and even if the work line such as a welding line is shifted by a known real-time tracking method, the robot is moved along the actual work line. There has been proposed a method of performing a predetermined work while moving (see, for example, Patent Document 1).
公知のリアルタイムトラッキング方式では、レーザセンサによってワークの特徴部位をスキャンし、特徴部位の位置あるいは特徴部位までの距離を検出することによってロボットの教示軌道を補正すると同時に、ワークの特定の面方向あるいは作業線方向等に基づいてロボットの姿勢を補正している。 In a known real-time tracking method, a feature part of a workpiece is scanned by a laser sensor, and the robot's teaching trajectory is corrected by detecting the position of the feature part or the distance to the feature part. The posture of the robot is corrected based on the line direction and the like.
図１０は、ロボットにレーザセンサを取り付けて、ワークの開先をトラッキングしながらアーク溶接を行う様子を示した図である。 FIG. 10 is a diagram illustrating a state in which arc welding is performed while attaching a laser sensor to the robot and tracking the groove of the workpiece.
同図において、図示しないマニピュレータが把持しているツール４３に取付部材４４を介して、ツール４３に先行する位置に配置されるようにセンサヘッド４５が取り付けられている。ツール４３が作業線４２の方向に移動する間、センサヘッド４５はワーク４１上の作業線４２（開先）を横切るようにレーザ光４６を繰り返し照射することによってスキャンを行いながら、実際の作業線に沿うように位置と姿勢を逐次補正する。
In the figure, a
以下、従来技術の動作を説明する。 The operation of the prior art will be described below.
図１１（ａ）及び（ｂ）を参照して、まず位置の補正方法について説明する。 First, a position correction method will be described with reference to FIGS. 11 (a) and 11 (b).
同図（ａ）は、センサヘッド４５が撮像した２次元画像のイメージ図であり、同図（ｂ）は、連続して撮像した２次元画像を繋ぎ合わせることによって、ワーク４１上の作業線４２（図１０）に沿って軌跡が生成されることを表したイメージ図である。同図（ａ）において、レーザ光の反射によって映し出された複数のサンプリング点５１を繋ぎ合わせることによって、開先形状輪郭線５０が生成されている。開先形状輪郭線５０は、図１０のＢ−Ｂ断面図に近い形状であり、図１０の作業線４２の方向に向かって見たイメージ図である。
FIG. 4A is an image diagram of a two-dimensional image captured by the
レーザセンサは、開先形状輪郭線５０の形状と、ロボット制御装置に予め設定されている開先形状照合データとをパターンマッチングの手法によって比較し、開先形状を特定する。開先形状を特定した後は開先形状照合データに記憶されている特徴点の位置を抽出し、開先形状輪郭線５０の線上の該当する位置に付与する。特徴点の位置は、例えば開先形状が重ね継ぎ手であれば、「上板の角の位置」、「上板の角から板厚分下がった位置」等というように開先形状照合データ内で作業者が予め定めておくことができる。
The laser sensor compares the shape of the groove
即ち、同図（ａ）の場合は、「上板の角から板厚分下がった位置」に特徴点５２を付与する。そして、センサヘッド４５が移動しながら繰り返し撮像し処理する度に付与される複数の特徴点を繋ぎ合わせることによって、同図（ｂ）に示すように、ワーク４１上に軌道５５を得ることができる。レーザセンサは特徴点５２を移動目標位置とし、その位置座標値を算出してロボットに通知する。ロボットはツール制御点を複数の移動目標位置に順次移動させていくことによって、位置の補正を行う。
That is, in the case of FIG. 9A, the
次に、姿勢の補正方法について説明する。 Next, a posture correction method will be described.
レーザセンサが、基準軸５３を特徴点５２上に付与する。基準軸５３は、特徴点５２と同様に、ロボット制御装置に予め設定されている開先形状照合データに定義されている。すなわち、特徴点５２をパターンマッチングの手法によって特定された開先形状に基づいて付与するのと同様に、基準軸５３も開先形状に基づいて決定し、付与する。例えば、開先形状を重ね継ぎ手と特定した場合は、同図（ａ）に示す位置に基準軸５３を付与する。次に、基準軸５３に対する予め定められた目標相対角度５４を与える。そして、レーザセンサは基準軸５３と目標相対角度５４と移動目標位置への進行方向とに基づいて姿勢座標値を算出して、ロボットに通知する。ロボットは複数の移動目標位置へ移動すると共に、ツール姿勢も変化させていくことによって、姿勢の補正を行う。
The laser sensor provides the
このように、従来技術においては、まず、レーザヘッドにより撮像された画像に基づいて、レーザセンサがワーク上の特徴点を決定する。次に、レーザ光の反射光の角度やセンサヘッド内部の受光位置等に基づいてレーザセンサが特徴点の位置座標値を算出し、移動目標位置とする。そして、レーザセンサが算出した位置座標値に基づいて、ロボットがツール制御点を移動目標位置に移動させる。これらのステップを繰り返すことによって位置の補正を行っている。また、レーザヘッドにより撮像された画像に基づいて、レーザセンサが特徴点上に基準軸を付与する。次に、基準軸に対して、予め定められた目標相対角度を与える。そして、基準軸に対する目標相対角度と移動目標位置への進行方向とに基づいて、レーザセンサが移動目標位置における姿勢座標値を算出する。この姿勢座標値の算出を移動目標位置毎に行うことによって姿勢の補正を行っている。すなわち、移動目標位置における位置座標値及び姿勢座標値をレーザセンサ自身が算出し、ロボットに通知することによって、位置と姿勢の補正を行っている。
しかしながら、上述した位置及び姿勢の補正のための移動目標位置及び目標姿勢の算出はワークに特徴部位があることが前提となっており、後述するように、ワークが特徴部位を持たない平面または曲面である場合は、特徴部位を捉えることができない。 However, the calculation of the movement target position and target posture for correcting the position and orientation described above is based on the premise that the workpiece has a characteristic part, and as described later, a plane or a curved surface on which the workpiece does not have a characteristic part. In the case of, it is impossible to capture the characteristic part.
図１２（ａ）は、ロボットにレーザセンサを取り付けて、平面ワーク上の作業線を補正する様子を示した図である。同図（ｂ）は、同図（ａ）の平面ワークを曲面ワークに置き換えた図である。同図（ａ）及び（ｂ）において、ワーク４１、作業線４２、ツール４３、取付部材４４、センサヘッド４５、レーザ光４６は図１０と同様であるので説明を省略する。
FIG. 12A is a diagram illustrating a state in which a laser sensor is attached to the robot and the work line on the planar workpiece is corrected. FIG. 4B is a diagram in which the planar work in FIG. 10A and 10B, the
図１３は、図１２（ａ）及び（ｂ）の構成時にセンサヘッドが撮像した２次元画像のイメージ図であり、複数のサンプリング点５１を繋ぎ合わせて、開先形状輪郭線５０を生成したものである。同図に示すように、ワークが特徴部位を持たない平面または曲面である場合は、複数のサンプリング点５１を繋ぎ合わせても開先形状輪郭線５０は直線にしかならないため、特徴点を決定することができない。すなわち、移動目標位置及び姿勢を決定することができないという問題がある。
FIG. 13 is an image diagram of a two-dimensional image captured by the sensor head in the configuration of FIGS. 12A and 12B, and a groove
このように、ワークが特徴部位を持たない平面または曲面である場合は、特徴部位を捉えることができないため、これまでレーザセンサによる補正の対象外とされてきた。 As described above, when the workpiece is a flat surface or a curved surface having no characteristic part, the characteristic part cannot be captured, and thus it has been excluded from correction by the laser sensor.
本発明は、ワークが特徴部位を持たない平面または曲面であってもレーザセンサによって移動目標位置及び目標姿勢を算出することができ、位置及び姿勢をワークに沿って補正することができる産業用ロボットを提供することを目的とする。 The present invention is an industrial robot capable of calculating a movement target position and a target posture by a laser sensor and correcting the position and posture along the workpiece even if the workpiece is a plane or curved surface having no characteristic part. The purpose is to provide.
上記目的を達成するために、第１の発明は、
現在位置と教示位置との間を予め複数の移動目標位置に分割して、ロボットのツール制御点を前記移動目標位置に順次移動させながら前記教示位置に到達させる産業用ロボットの制御方法において、
前記移動目標位置を、前記ツール制御点の進行方向を決めるベクトルである基準方向ベクトルと、前記進行方向の前方に配置されたレーザセンサによって前記基準方向ベクトルの方向にあって前記ツール制御点の現在位置から先行した位置において検出されたワーク表面からの高さ方向距離と、に基づいて算出することを特徴とする産業用ロボットの制御方法である。
In order to achieve the above object, the first invention provides:
In the industrial robot control method, the current position and the teaching position are divided into a plurality of movement target positions in advance, and the tool control point of the robot is sequentially moved to the movement target position to reach the teaching position.
The target position of the tool control point is a reference direction vector that is a vector that determines a traveling direction of the tool control point, and a current direction of the tool control point that is in the direction of the reference direction vector by a laser sensor arranged in front of the traveling direction. A control method for an industrial robot, characterized in that a calculation is made based on a height direction distance from a workpiece surface detected at a position preceding the position.
第２の発明は、
第１の発明に記載の基準方向ベクトルは、前記ツール制御点が現在位置に至るまでの軌道における接線方向ベクトルであることを特徴とする産業用ロボットの制御方法である。
The second invention is
The reference direction vector described in the first invention is a tangential direction vector in a trajectory until the tool control point reaches the current position.
第３の発明は、
前記移動目標位置におけるツールの目標姿勢は、前記ワーク表面からの高さ方向距離を求める基準軸に基づく予め定められた姿勢であることを特徴とする第１又は第２の発明に記載の産業用ロボットの制御方法である。
The third invention is
The industrial posture according to the first or second aspect, wherein the target posture of the tool at the movement target position is a predetermined posture based on a reference axis for obtaining a height direction distance from the workpiece surface. This is a robot control method.
第４の発明は、
移動開始位置における前記基準方向ベクトルは、前記教示位置に向かう教示方向ベクトルであることを特徴とする第１又は第２又は第３の発明に記載の産業用ロボットの制御方法である。
The fourth invention is:
The control method for an industrial robot according to the first, second, or third invention, wherein the reference direction vector at the movement start position is a teaching direction vector toward the teaching position.
第１の発明及び第２の発明によれば、ワークが特徴部位を持たない平面または曲面であってもレーザセンサによって移動目標位置を検出することができるので、ワークの設置位置に誤差が生じている場合等でもツール制御点をワーク表面に沿ってトラッキングさせることができる。例えば、平面または曲面ワーク上に加工された特徴のない加工位置（例えば浅い凹凸のスポット痕等）を検査する等のシステムにおいては、検査ツール先端を所定の高さに保つと同時に加工位置に対して垂直に押し当てる技術が要望されているが、本発明を適用すれば、検査ツールをワークに対して常に所定の高さに保つことができる。 According to the first and second inventions, even if the workpiece is a flat surface or curved surface having no characteristic part, the movement target position can be detected by the laser sensor, so that an error occurs in the installation position of the workpiece. The tool control points can be tracked along the workpiece surface even when the workpiece is present. For example, in a system that inspects a non-characteristic processing position (for example, a shallow uneven spot mark) processed on a flat or curved workpiece, the tip of the inspection tool is kept at a predetermined height and at the same time the processing position However, if the present invention is applied, the inspection tool can always be kept at a predetermined height with respect to the workpiece.
第３の発明によれば、第１の発明による目標位置の検出に加えて、目標姿勢をも検出することができるので、ワークの設置位置に誤差が生じている場合等でもツール先端姿勢をワーク表面に対して予め定められた姿勢に保つことができる。平面または曲面ワーク上に加工された特徴のない加工位置（例えば浅い凹凸のスポット痕等）を検査する等のシステムにおいては、第１の発明が有する効果に加えて、検査ツールをワークに対して垂直に保つことができる。 According to the third invention, in addition to the detection of the target position according to the first invention, the target posture can also be detected. Therefore, even when an error occurs in the workpiece installation position, the tool tip posture is determined. It is possible to maintain a predetermined posture with respect to the surface. In a system for inspecting a non-characteristic processing position (for example, a shallow uneven spot mark) processed on a flat or curved workpiece, in addition to the effect of the first invention, an inspection tool is applied to the workpiece. Can be kept vertical.
第４の発明によれば、移動開始位置における基準方向ベクトルを教示点に向かう教示方向ベクトルとしているので、基準方向ベクトルが与えられていない移動開始段階においても教示方向ベクトルを用いて移動目標位置を算出することができる。 According to the fourth aspect, since the reference direction vector at the movement start position is used as the teaching direction vector toward the teaching point, the movement target position is determined using the teaching direction vector even at the movement start stage where the reference direction vector is not given. Can be calculated.
［実施の形態１］
発明の実施の形態を実施例に基づき図面を参照して説明する。図１は、本発明の産業用ロボットの制御方法を適用したスポット痕検査用ロボットシステムの斜視図である。図２は、本発明の実施の形態１の産業用ロボットの制御方法によってワーク表面に対するツール制御点の位置を一定に保つ様子を示した図であり、図１をＡの方向から見ている。図１及び図２では曲面ワークを例にしているが、平面ワークであってもよい。
[Embodiment 1]
DESCRIPTION OF THE PREFERRED EMBODIMENTS Embodiments of the present invention will be described based on examples with reference to the drawings. FIG. 1 is a perspective view of a spot mark inspection robot system to which the industrial robot control method of the present invention is applied. FIG. 2 is a diagram illustrating a state in which the position of the tool control point with respect to the workpiece surface is kept constant by the industrial robot control method according to the first embodiment of the present invention, and FIG. 1 is viewed from the direction A. In FIGS. 1 and 2, a curved workpiece is taken as an example, but a planar workpiece may be used.
図１において、図示しないマニピュレータが把持しているツール４３に取付部材４４を介して、ツール４３に先行する位置に配置されるようにセンサヘッド４５が取り付けられている。ツール４３が、作業者によって教示された作業開始位置４７と作業終了位置４８との間に施されたスポット痕４９を検査するために、ワーク４１上の作業線４２に沿って移動する間、センサヘッド４５は作業線４２を横切るようにレーザ光４６を繰り返し照射することによってスキャンを行う。そして、同図では、作業開始位置４７から作業を開始し、ツール４３の制御点が現在位置ｂ２に到達した様子を示している。
In FIG. 1, a
ところで、ワーク４１上に施されたスポット痕４９は凹凸を持つが、非常に浅い凹凸となっている。そのため、検査対象となるスポット痕は図示しないＣＣＤカメラで検出している。即ち、レーザセンサは位置と姿勢を制御することを目的に設けられているものであってスポット痕そのものを検出することはない。
By the way, the
作業開始位置４７と作業終了位置４８は、ツール４３の制御点が該２点間を直線動作するように作業者によって教示された位置である。ワーク表面が湾曲していても第１の発明によって位置が補正されるので、作業者は同図に示すような直線動作の教示を行うだけで良い。すなわち、再生動作時は、図２に示すようにツール４３の先端が作業線４２（図１参照）であるワーク表面に対して高さ方向距離を一定に保って移動することになる。また、直線動作するように教示しているのはスポット痕がワーク４１上に直線状に並んでいるからであり、スポット痕が円弧状に並んでいる場合はツール４３が円弧動作するように教示すればよいことになる。
The work start
次に、図３及び図４を参照して、移動目標位置の検出及び補正方法について説明する。図３は、移動目標位置の検出方法を説明するために図２における現在位置ｂ２近傍を拡大した図であり、図４は、移動目標位置を検出し補正する動作の流れを説明するためのフローチャート図である。 Next, a method for detecting and correcting the movement target position will be described with reference to FIGS. 3 is an enlarged view of the vicinity of the current position b2 in FIG. 2 in order to explain the method of detecting the movement target position, and FIG. 4 is a flowchart for explaining the flow of operations for detecting and correcting the movement target position. FIG.
図３は、ツール４３の制御点が現在位置ｂ２にあり、次の移動目標位置を検出する様子を表している。このとき、レーザセンサの制御点はツール４３の現在位置ｂ２よりも進行方向側に先行した位置ｃ２（以下、先行位置ｃ２という）にある。
FIG. 3 shows a state where the control point of the
ワーク４１は同図に示すように表面が湾曲しているため、ツール４３の制御点をｃ３、ｄ４、…の位置に移動させる必要がある。すなわち、ｃ３、ｄ４、…を移動目標位置とする。
Since the surface of the
図４のステップＳ１において、基準方向ベクトルＶｂを算出する。基準方向ベクトルＶｂは、第２の発明によって、ツール４３の制御点が現在位置ｂ２に至るまでの軌道Ｌａにおける接線方向ベクトルとする。このとき、基準方向ベクトルＶｂの大きさはツール４３の制御点とレーザセンサの制御点との相対位置を表すＸ，Ｙ，Ｚ成分を持った変位量Ｑｂ（Ｑｂｘ，Ｑｂｙ，Ｑｂｚ）である。
In step S1 of FIG. 4, a reference direction vector Vb is calculated. The reference direction vector Vb is a tangential direction vector in the trajectory La until the control point of the
ステップＳ２において、ロボットが現在位置ｂ２の位置座標値Ｐｂ２（Ｐｂｘ，Ｐｂｙ，Ｐｂｚ）、及び基準方向ベクトルＶｂをレーザセンサに通知する。 In step S2, the robot notifies the laser sensor of the position coordinate value Pb2 (Pbx, Pby, Pbz) of the current position b2 and the reference direction vector Vb.
ステップＳ３において、レーザセンサが先行位置ｃ２におけるワーク表面からの高さ方向距離Ｈｃを検出する。ここで、ワーク表面からの高さ方向距離Ｈｃは、先行位置ｃ２から鉛直方向（重力方向）へ向けた距離としても、先行位置からワーク表面に対して垂直方向へ向けた距離としてもよく、本発明を適用するアプリケーションに合わせてどちらを採用しても良い。本実施例では、図示しているように、先行位置ｃ２から鉛直方向（重力方向）へ向けた距離を高さ方向距離Ｈｃとしている。 In step S3, the laser sensor detects the height direction distance Hc from the workpiece surface at the preceding position c2. Here, the height direction distance Hc from the workpiece surface may be a distance from the preceding position c2 in the vertical direction (gravity direction) or a distance from the preceding position in the direction perpendicular to the workpiece surface. Either may be adopted according to the application to which the invention is applied. In the present embodiment, as shown in the drawing, the distance from the preceding position c2 in the vertical direction (gravity direction) is defined as the height direction distance Hc.
ステップＳ４において、移動目標位置ｃ３の位置座標値Ｐｃ３を算出する。すなわち、ロボットの現在座標値Ｐｂ２（Ｐｂｘ，Ｐｂｙ，Ｐｂｚ）に、基準方向ベクトルＶｂのＸＹ方向成分の変位量（Ｑｂｘ，Ｑｂｙ，０）と、高さ方向距離ＨｃをＺ方向成分の変位量とした（０，０，Ｈｃ）とを加算する。 In step S4, a position coordinate value Pc3 of the movement target position c3 is calculated. In other words, the current coordinate value Pb2 (Pbx, Pby, Pbz) of the robot, the displacement amount (Qbx, Qby, 0) of the XY direction component of the reference direction vector Vb, the height direction distance Hc and the displacement amount of the Z direction component (0, 0, Hc) is added.
ステップＳ５において、レーザセンサが算出した移動目標位置ｃ３の位置座標値Ｐｃ３をロボットに通知する。 In step S5, the robot is notified of the position coordinate value Pc3 of the movement target position c3 calculated by the laser sensor.
ステップＳ６において、ツール４３の制御点を移動目標位置ｃ３へ移動させる。
In step S6, the control point of the
ステップＳ７において、補正を終了するか否かを判定する。作業終了位置４８までに必要な複数の移動目標位置（補間点）の数は、作業開始位置４７と作業終了位置４８との距離及び速度に基づいて予め定められている。したがって、補正を終了するか否かを、補正を行った移動目標位置（補間点）の数によって判定する。すなわち、作業終了位置４８までに必要な移動目標位置の補正が全て終了していれば、フローを終了する。補正が全て終了していなければ、ステップＳ１に戻り、次の移動目標位置ｄ４の算出に移る。
In step S7, it is determined whether or not to end the correction. The number of a plurality of movement target positions (interpolation points) required up to the
このようにして、複数の移動目標位置の補正が全て終了するまで、移動目標位置ｃ３、ｄ４、…における位置座標値の算出と移動を順次行う。 In this manner, the calculation and movement of the position coordinate values at the movement target positions c3, d4,... Are sequentially performed until the correction of the plurality of movement target positions is completed.
したがって、ワークが特徴部位を持たない平面または曲面であってもレーザセンサによって移動目標位置を検出することができるので、ワークの設置位置に誤差が生じている場合等でもツール制御点をワーク表面に沿ってトラッキングさせることができる。例えば、平面または曲面ワーク上に加工された特徴のない加工位置（例えば浅い凹凸のスポット痕等）を検査する等のシステムにおいては、検査ツール先端を所定の高さに保つと同時に加工位置に対して垂直に押し当てる技術が要望されているが、本発明を適用すれば、検査ツールをワークに対して常に所定の高さに保つことができる。 Therefore, even if the workpiece is a flat surface or curved surface having no characteristic part, the movement target position can be detected by the laser sensor. Can be tracked along. For example, in a system that inspects a non-characteristic processing position (for example, a shallow uneven spot mark) processed on a flat or curved workpiece, the tip of the inspection tool is kept at a predetermined height and at the same time the processing position However, if the present invention is applied, the inspection tool can always be kept at a predetermined height with respect to the workpiece.
［実施の形態２］
図５は、本発明の実施の形態２の産業用ロボットの制御方法によってワーク表面に対するツール先端の位置及び姿勢を一定に保つ様子を示した図であり、図１をＡの方向から見ている。同図に示すように、ツール４３の先端が作業線４２（図１参照）であるワーク表面に対して高さ方向距離及び姿勢を一定に保って移動する。
[Embodiment 2]
FIG. 5 is a diagram illustrating a state in which the position and posture of the tool tip with respect to the workpiece surface are kept constant by the industrial robot control method according to the second embodiment of the present invention, and FIG. 1 is viewed from the direction A. . As shown in the figure, the tip of the
次に、図６及び図７を参照して、目標姿勢の算出方法について説明する。 Next, a method for calculating a target posture will be described with reference to FIGS.
図６は、目標姿勢の検出方法を説明するために図５における現在位置ｂ２近傍を拡大した図である。同図において、ワーク４１、ツール４３、取付部材４４、センサヘッド４５、作業開始位置４７、教示線６０は、図３と同様であるので説明を省略する。
FIG. 6 is an enlarged view of the vicinity of the current position b2 in FIG. 5 in order to explain the target posture detection method. In the figure, the
図７は、本発明の実施の形態２の産業用ロボットの制御方法によって目標姿勢を検出し補正する動作の流れを説明するためのフローチャート図である。同図において、ステップＳ１乃至Ｓ７は、図４の同符号を付したステップと同じであるので、説明を省略する。以下、実線で示したステップＳ３ａ乃至Ｓ５ａについて説明する。 FIG. 7 is a flowchart for explaining a flow of an operation of detecting and correcting a target posture by the industrial robot control method according to the second embodiment of the present invention. In the figure, steps S1 to S7 are the same as the steps denoted by the same reference numerals in FIG. Hereinafter, steps S3a to S5a indicated by solid lines will be described.
図６に示すように、ワーク表面に対してツール４３の姿勢を垂直に保つためには、例えば移動目標位置ｂ２においては姿勢６３を取る必要がある。ワーク表面に対する垂直方向は、レーザセンサが持つ従来技術によって検出可能であるので、図７のステップＳ３ａでワーク表面に対する垂直方向を検出して基準軸５３としておく。
As shown in FIG. 6, in order to keep the posture of the
そして、ステップＳ４ａで、この基準軸５３に対するツール４３の姿勢が所定値になるような目標姿勢座標値を算出する。例えば基準軸５３に対する目標相対角度５４を予め（０°，０°，０°）と定めておけば、ワーク表面に対するツール４３の姿勢が垂直になる目標姿勢座標値を算出することができる。
In step S4a, a target posture coordinate value is calculated so that the posture of the
算出した目標姿勢座標値は、ステップＳ５ａでロボットに通知する。こうすることによって、移動目標位置ｂ２、ｃ３、ｄ４、…における目標姿勢の算出と補正を順次行うことができる。 The calculated target posture coordinate value is notified to the robot in step S5a. By doing so, it is possible to sequentially calculate and correct the target posture at the movement target positions b2, c3, d4,.
したがって、第１の発明による目標位置の検出に加えて、目標姿勢をも検出することができるので、ワークの設置位置に誤差が生じている場合等でもツール先端姿勢をワーク表面に対して予め定められた姿勢に保つことができる。平面または曲面ワーク上に加工された特徴のない加工位置（例えば浅い凹凸のスポット痕等）を検査する等のシステムにおいては、第１の発明が有する効果に加えて、検査ツールをワークに対して垂直に保つことができる。 Therefore, in addition to the detection of the target position according to the first aspect of the invention, the target posture can also be detected. Therefore, even when there is an error in the workpiece installation position, the tool tip posture is determined in advance with respect to the workpiece surface. Can be kept in a given posture. In a system for inspecting a non-characteristic processing position (for example, a shallow uneven spot mark) processed on a flat or curved workpiece, in addition to the effect of the first invention, an inspection tool is applied to the workpiece. Can be kept vertical.
［実施の形態３］
図８は、本発明の実施の形態３の産業用ロボットの制御方法によって、作業開始位置４７において、最初の移動目標位置を検出する方法を説明するための図である。同図において、ワーク４１、ツール４３、取付部材４４、センサヘッド４５、教示線６０は、図３と同様であるので説明を省略する。
[Embodiment 3]
FIG. 8 is a diagram for explaining a method of detecting the first movement target position at the
図９は、最初の移動目標位置を検出し補正する動作の流れを説明するためのフローチャート図である。同図において、ステップＳ３乃至Ｓ６、及びステップＳ３ａ乃至Ｓ５ａは、図７の同符号を付したステップとほぼ同じであるので、説明を省略する。図７と図９の相違は、図７の現在位置ｂ２が図９では現在位置ａに、図７の移動目標位置ｃ３が図９ではｂ２になっている点である。以下、実線で示したステップＳ１、Ｓ２、Ｓ７について説明する。 FIG. 9 is a flowchart for explaining the flow of the operation of detecting and correcting the initial movement target position. In the figure, steps S3 to S6 and steps S3a to S5a are substantially the same as the steps denoted by the same reference numerals in FIG. The difference between FIG. 7 and FIG. 9 is that the current position b2 in FIG. 7 is the current position a in FIG. 9, and the movement target position c3 in FIG. 7 is b2 in FIG. Hereinafter, steps S1, S2, and S7 indicated by solid lines will be described.
図８では、ツール４３の制御点が教示線６０上の作業開始位置４７と同じ位置ａにあり、最初の移動目標位置を検出する様子を表している。このとき、レーザセンサの制御点はツール４３の制御点よりも進行方向側に先行した位置ｂ（以下、先行位置ｂという）にある。ワーク４１は同図に示すように表面が湾曲しているため、最初の移動目標位置はｂ２の位置である。
FIG. 8 shows a state where the control point of the
図９のステップＳ１において、ツール４３の制御点を作業開始位置４７と同じ位置ａに移動させる。
9, the control point of the
ステップＳ２において、ロボットが位置ａの現在座標値Ｐａ（Ｐａｘ，Ｐａｙ，Ｐａｚ）、及び基準方向ベクトルＶａをレーザセンサに通知する。ここで、ツール４３の制御点は未だ移動を開始していないため、現在位置に至るまでの軌道における接線方向が与えられていない。そこで、接線方向ベクトルの代わりに教示点（作業終了位置４８）に向かう教示方向ベクトルを基準方向ベクトルＶａとする。向きは教示方向であり、大きさはツール４３の制御点とレーザセンサの制御点との相対位置を表すＸ，Ｙ，Ｚ成分を持った変位量Ｑ（Ｑｘ，Ｑｙ，Ｑｚ）である。
In step S2, the robot notifies the laser sensor of the current coordinate value Pa (Pax, Pay, Paz) of the position a and the reference direction vector Va. Here, since the control point of the
そして、ステップＳ３乃至ステップＳ６の処理を行う。 And the process of step S3 thru | or step S6 is performed.
ステップＳ７以降は、図４または図７のフローに移る。このようにして、移動開始位置における基準方向ベクトルを、教示点に向かう教示方向ベクトルとすることによって、基準方向ベクトルが与えられていない移動開始段階においても移動目標位置を算出することができる。 After step S7, the flow proceeds to the flow of FIG. 4 or FIG. In this way, by setting the reference direction vector at the movement start position as the teaching direction vector toward the teaching point, the movement target position can be calculated even at the movement start stage where the reference direction vector is not given.
したがって、移動開始位置における基準方向ベクトルを教示点に向かう教示方向ベクトルとしているので、基準方向ベクトルが与えられていない移動開始段階においても教示方向ベクトルを用いて移動目標位置を算出することができる。 Therefore, since the reference direction vector at the movement start position is a teaching direction vector toward the teaching point, the movement target position can be calculated using the teaching direction vector even at the movement start stage where the reference direction vector is not given.
４１ ワーク
４２ 作業線
４３ ツール
４４ 取付部材
４５ センサヘッド
４６ レーザ光
４７ 作業開始位置
４８ 作業終了位置
４９ スポット痕
５０ 開先形状輪郭線
５１ サンプリング点
５２ 特徴点
５３ 基準軸
５４ 目標相対角度
５５ 軌道
６０ 教示線
Ｖａ （４７における）基準方向ベクトル
Ｖｂ （ｂ２における）基準方向ベクトル
Ｖｃ （ｃ３における）基準方向ベクトル
Ｌａ （４７〜ｂ２に至るまでの）軌道
Ｌｂ （ｂ２〜ｃ３に至るまでの）軌道
Ｌｃ （ｃ３〜ｄ４に至るまでの）軌道
Ｈｂ （ｂ２までの）高さ方向距離
Ｈｃ （ｃ３までの）高さ方向距離
Ｈｄ （ｄ４までの）高さ方向距離
ｂ２ 移動目標位置
ｃ３ 移動目標位置
ｄ４ 移動目標位置
41
Claims (4)
前記移動目標位置を、前記ツール制御点の進行方向を決めるベクトルである基準方向ベクトルと、前記進行方向の前方に配置されたレーザセンサによって前記基準方向ベクトルの方向にあって前記ツール制御点の現在位置から先行した位置において検出されたワーク表面からの高さ方向距離と、に基づいて算出することを特徴とする産業用ロボットの制御方法。 In the industrial robot control method, the current position and the teaching position are divided into a plurality of movement target positions in advance, and the tool control point of the robot is sequentially moved to the movement target position to reach the teaching position.
The target position of the tool control point is a reference direction vector that is a vector that determines a traveling direction of the tool control point, and a current direction of the tool control point that is in the direction of the reference direction vector by a laser sensor arranged in front of the traveling direction. A control method for an industrial robot, characterized in that the calculation is performed based on a height direction distance from a workpiece surface detected at a position preceding the position.
The method for controlling an industrial robot according to claim 1, wherein the reference direction vector at the movement start position is a teaching direction vector toward the teaching position.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2005156883A JP2006331255A (en) | 2005-05-30 | 2005-05-30 | Control method for industrial robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2005156883A JP2006331255A (en) | 2005-05-30 | 2005-05-30 | Control method for industrial robot |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP2006331255A true JP2006331255A (en) | 2006-12-07 |
Family
ID=37552858
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2005156883A Pending JP2006331255A (en) | 2005-05-30 | 2005-05-30 | Control method for industrial robot |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2006331255A (en) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2019077026A (en) * | 2017-10-19 | 2019-05-23 | キヤノン株式会社 | Control device, robot system, and control device operating method and program |
| CN110788862A (en) * | 2019-11-19 | 2020-02-14 | 中国工程物理研究院激光聚变研究中心 | Robot automatic teaching control system and method for large-curve high-precision processing |
| WO2021125175A1 (en) * | 2019-12-16 | 2021-06-24 | 川崎重工業株式会社 | Method for controlling following of curved surface by robot |
| US11498209B2 (en) * | 2019-06-18 | 2022-11-15 | Daihen Corporation | Robot control apparatus and robot control system |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6388612A (en) * | 1986-10-02 | 1988-04-19 | Toyota Motor Corp | Foreknowledge pursuing/control type robot |
| JPH0199104A (en) * | 1987-10-12 | 1989-04-18 | Mitsubishi Electric Corp | Profile control system |
-
2005
- 2005-05-30 JP JP2005156883A patent/JP2006331255A/en active Pending
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6388612A (en) * | 1986-10-02 | 1988-04-19 | Toyota Motor Corp | Foreknowledge pursuing/control type robot |
| JPH0199104A (en) * | 1987-10-12 | 1989-04-18 | Mitsubishi Electric Corp | Profile control system |
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2019077026A (en) * | 2017-10-19 | 2019-05-23 | キヤノン株式会社 | Control device, robot system, and control device operating method and program |
| JP7323993B2 (en) | 2017-10-19 | 2023-08-09 | キヤノン株式会社 | Control device, robot system, operating method and program for control device |
| US11498209B2 (en) * | 2019-06-18 | 2022-11-15 | Daihen Corporation | Robot control apparatus and robot control system |
| CN110788862A (en) * | 2019-11-19 | 2020-02-14 | 中国工程物理研究院激光聚变研究中心 | Robot automatic teaching control system and method for large-curve high-precision processing |
| WO2021125175A1 (en) * | 2019-12-16 | 2021-06-24 | 川崎重工業株式会社 | Method for controlling following of curved surface by robot |
| JP2021094633A (en) * | 2019-12-16 | 2021-06-24 | 川崎重工業株式会社 | Robot curve surface copying control method |
| JP7309592B2 (en) | 2019-12-16 | 2023-07-18 | 川崎重工業株式会社 | Robot curved surface scanning control method |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US8706300B2 (en) | Method of controlling a robotic tool | |
| US5465037A (en) | System and method for tracking a feature on an object using a redundant axis | |
| Luo et al. | Laser visual sensing for seam tracking in robotic arc welding of titanium alloys | |
| Tsai et al. | Machine vision based path planning for a robotic golf club head welding system | |
| US20130060369A1 (en) | Method and system for generating instructions for an automated machine | |
| CN113894481B (en) | Welding pose adjusting method and device for complex space curve welding seam | |
| CN112847353B (en) | Multi-segment welding seam track correction method based on offline programming software | |
| Zhou et al. | Autonomous acquisition of seam coordinates for arc welding robot based on visual servoing | |
| CN109732255A (en) | A kind of welding method and welding robot | |
| CN112958959A (en) | Automatic welding and detection method based on three-dimensional vision | |
| Chen et al. | Seam tracking of large pipe structures for an agile robotic welding system mounted on scaffold structures | |
| CN108907526A (en) | A kind of weld image characteristic recognition method with high robust | |
| US10864628B2 (en) | Robot system, robot controller, and method for producing to-be-worked material | |
| JP5686279B2 (en) | Work posture detection device, work processing execution device, and work posture detection method | |
| JP2006331255A (en) | Control method for industrial robot | |
| CN111570974A (en) | Welding deviation measuring method and device based on synchronous drawing and automatic welding system | |
| WO2020129706A1 (en) | Alignment device | |
| JP6343711B1 (en) | Seam tracking system and metal product manufacturing method | |
| JP3082829B2 (en) | Automatic welding line recognition method and device | |
| Shi et al. | Adaptive robotic welding system using laser vision sensing for underwater engineering | |
| Wang et al. | A path correction method based on global and local matching for robotic autonomous systems | |
| JPH04269194A (en) | Plane measuring method | |
| CN109986238B (en) | Robot linear flexible operation vision fuzzy profiling control method | |
| JP2017121649A (en) | Teaching device for a welding robot | |
| Luo et al. | Laser visual sensing and process control in robotic arc welding of titanium alloys |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20080509 |
|
| A977 | Report on retrieval |
Effective date: 20100202 Free format text: JAPANESE INTERMEDIATE CODE: A971007 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100302 |
|
| A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20100713 |