JP6347399B2 - Polishing robot and its trajectory generation method - Google Patents
Polishing robot and its trajectory generation method Download PDFInfo
- Publication number
- JP6347399B2 JP6347399B2 JP2014010373A JP2014010373A JP6347399B2 JP 6347399 B2 JP6347399 B2 JP 6347399B2 JP 2014010373 A JP2014010373 A JP 2014010373A JP 2014010373 A JP2014010373 A JP 2014010373A JP 6347399 B2 JP6347399 B2 JP 6347399B2
- Authority
- JP
- Japan
- Prior art keywords
- workpiece
- vector
- posture
- tool
- machining
- 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.)
- Active
Links
Images
Description
本発明は、ワークを磨き加工する研磨ロボットとその軌道生成方法に関する。 The present invention relates to a polishing robot for polishing a workpiece and a method for generating a trajectory thereof.
ロボットアームの手先に加工工具を取り付け、加工経路に沿って動作させてワークを加工する加工ロボットにおいて、狭隘部の加工は、ロボットとワークや工具とワークの干渉が問題となる。
このような狭隘部の加工手段として、例えば特許文献１、２が既に提案されている。
In a processing robot that processes a workpiece by attaching a processing tool to the end of the robot arm and moving it along the processing path, interference between the robot and the workpiece or between the tool and the workpiece becomes a problem when processing a narrow part.
For example,
特許文献１の「ロボット機構制御方法」は、作業対象物の３次元モデルに対して、研削工具の非干渉領域を算出し、研削工具の動作経路を算出し、ツール姿勢やコンプライアンス制御用変数をオフラインで計画してロボット制御装置に転送して研削等の加工をするものである。
The “robot mechanism control method” of
特許文献２の「研削ロボットの研削姿勢生成装置」は、研削作業前に教示された研削経路の位置データに基づき研削工具を移動して研削対象物を研削する研削ロボットにおいて、研削しようとする研削対象物の形態を検出し、検出された形態データに基づいてロボット研削姿勢を生成するものである。
The "grinding posture generation device for a grinding robot" in
上述した従来の狭隘部の加工手段では、ワークに対する工具姿勢や経由点をオフラインで教示していた。
しかし、特にワークの加工位置が狭隘部（例えば狭隘口の内側）にある場合には、ワークに対する工具姿勢の教示が煩雑であった。
The conventional narrow section machining means described above teaches the tool posture and via points for the workpiece offline.
However, particularly when the machining position of the workpiece is in a narrow portion (for example, inside the narrow mouth), teaching of the tool posture with respect to the workpiece is complicated.
本発明は、上述した問題点を解決するために創案されたものである。すなわち、本発明の目的は、ワークの加工位置が狭隘部にある場合において、工具姿勢の教示とロボットの動作軌道の設定を容易にすることができる研磨ロボットとその軌道生成方法を提供することにある。 The present invention has been developed to solve the above-described problems. That is, an object of the present invention is to provide a polishing robot capable of facilitating teaching of a tool posture and setting of an operation trajectory of the robot and a method of generating the trajectory when the machining position of the workpiece is in a narrow part. is there.
本発明によれば、先端部で加工する加工工具でワークの円筒内面以外の加工面を研磨する研磨ロボットであって、前記加工工具を通す前記ワークの表面に形成される狭隘口の内部に前記加工面が位置しており、
前記加工工具を３次元空間内で移動するロボットアームと、
ワークの加工面形状に基づいて前記加工工具の姿勢を制御する姿勢制御装置と、を備え、
前記姿勢制御装置は、
前記狭隘口を直視できる空間上に指定され、工具回転軸の姿勢を拘束する拘束点を記憶する記憶部と、
前記ワークの形状データから、ワークの前記加工面に沿った軌道上の点位置と該点位置における法線ベクトルからなる軌道データを作成する軌道データ作成部と、
前記拘束点と前記法線ベクトルを含む拘束平面内において、前記先端部の側面とワークの前記加工面が平行になるように加工工具の姿勢を設定する姿勢設定部と、を含む、ことを特徴とする研磨ロボットが提供される。
According to the present invention, there is provided a polishing robot for polishing a processing surface other than a cylindrical inner surface of a workpiece with a processing tool processed at a tip portion, and the inside of a narrow opening formed on a surface of the workpiece through the processing tool. The processing surface is located,
A robot arm that moves the machining tool in a three-dimensional space;
An attitude control device that controls the attitude of the machining tool based on the machining surface shape of the workpiece,
The attitude control device includes:
A storage unit that is designated on a space where the narrow opening can be directly viewed and stores a restraint point that restrains the posture of the tool rotation axis;
From the shape data of the workpiece, the trajectory data creation section that creates a trajectory data consisting of the normal vector at the position and the point position point on the trajectory along the machined surface of the workpiece,
Wherein in the restrained plane, including a position setting unit for setting a posture of the machining tool so that the working surface of the side and the workpiece of the tip is parallel, to include the normal vector and the constraint point A polishing robot is provided.
また本発明によれば、先端部で加工する加工工具でワークの円筒内面以外の加工面を研磨する研磨ロボットの軌道生成方法であって、前記加工工具を通す前記ワークの表面に形成される狭隘口の内部に前記加工面が位置しており、
前記加工工具を３次元空間内で移動するロボットアームと、
ワークの加工面形状に基づいて前記加工工具の姿勢を制御する姿勢制御装置と、を準備し、
前記姿勢制御装置により
（Ａ）前記狭隘口を直視できる空間上に指定され、工具回転軸の姿勢を拘束する拘束点を記憶し、
（Ｂ）前記ワークの形状データから、ワークの前記加工面に沿った軌道上の点位置と該点位置における法線ベクトルを含む軌道データを作成し、
（Ｃ）前記拘束点と前記法線ベクトルを含む拘束平面内において、前記先端部の側面とワークの前記加工面が平行になるように加工工具の姿勢を設定する、ことを特徴とする研磨ロボットの軌道生成方法が提供される。
Further, according to the present invention, there is provided a method for generating a trajectory of a polishing robot that polishes a machining surface other than a cylindrical inner surface of a workpiece with a machining tool machined at a tip portion, the narrow path formed on the surface of the workpiece that passes the machining tool. The machining surface is located inside the mouth,
A robot arm that moves the machining tool in a three-dimensional space;
Preparing an attitude control device for controlling the attitude of the machining tool based on the machining surface shape of the workpiece,
By the posture control device, (A) a constraint point that is designated on a space where the narrow opening can be directly viewed and restrains the posture of the tool rotation axis is stored;
(B) from the shape data of the workpiece, creates a trajectory data including the normal vector at the position and the point position point on the trajectory along the machined surface of the workpiece,
(C) a polishing robot in the constrained plane comprising said constraint points and the normal vectors, sets the posture of the machining tool so that the working surface of the side and the workpiece of the tip is parallel, characterized in that A trajectory generation method is provided.
前記先端部の形状は、軸心を中心とする円柱形状であり、
前記（Ｃ）において、
前記拘束点と前記法線ベクトルを含む拘束平面に垂直な第１ベクトルを求め、
次いで、前記法線ベクトルと前記第１ベクトルとに垂直な第２ベクトルを求め、
前記第２ベクトルの姿勢を前記加工工具の姿勢として設定する、ことが好ましい。
The shape of the tip is a cylindrical shape centered on the axis,
In the above (C),
Obtaining a first vector perpendicular to a constraint plane including the constraint point and the normal vector;
Next, a second vector perpendicular to the normal vector and the first vector is obtained,
It is preferable that the posture of the second vector is set as the posture of the processing tool.
また前記先端部の形状は、軸心に対し傾斜角を有する円錐形状であり、
前記（Ｃ）において、
前記拘束点と前記法線ベクトルを含む拘束平面に垂直な第１ベクトルを求め、
次いで、前記法線ベクトルと前記第１ベクトルとに垂直な第２ベクトルを求め、
前記第２ベクトルに対し前記第１ベクトルの方向を中心として前記狭隘口の内方に前記傾斜角を有する姿勢を前記加工工具の姿勢として設定する、ことが好ましい。
The shape of the tip is a conical shape having an inclination angle with respect to the axis,
In the above (C),
Obtaining a first vector perpendicular to a constraint plane including the constraint point and the normal vector;
Next, a second vector perpendicular to the normal vector and the first vector is obtained,
It is preferable that an attitude having the inclination angle inward of the narrow mouth with respect to the second vector as a center is set as an attitude of the machining tool.
前記加工工具の姿勢は、前記工具回転軸の姿勢である。 The posture of the machining tool is the posture of the tool rotation axis.
上記本発明の装置と方法によれば、加工工具の先端部側面とワークの加工面が平行になるように加工工具の姿勢を設定するので、先端部側面をワークの加工面に密着させた状態でワークを研磨（磨き加工）することができる。
また、空間上（例えば、狭隘口の内側又はその上下空間）の拘束点と軌道上の点位置における法線ベクトルを含む拘束平面内において加工工具の姿勢を設定するので、拘束点を適切に設定することで、加工領域を加工する際に、加工工具が通過する空間の形状を変えることができ、ワークと加工工具との干渉を回避することができる。
従って、ワークの形状データ（例えばＣＡＤモデル）から加工面に沿った軌道上の点位置である軌道データと加工工具の姿勢を自動的に算出できるため、教示作業の手間が省ける。
さらに、加工工具の先端部（例えば、円柱形状、円錐形状）の側面をワークの加工面に密着させるという拘束条件も同時に満たすことができる。
According to the apparatus and method of the present invention, since the posture of the machining tool is set so that the side surface of the tip of the machining tool and the machining surface of the workpiece are parallel, the state where the side surface of the tip is in close contact with the machining surface of the workpiece The workpiece can be polished (polished).
Also, since the machining tool posture is set in the constraint plane including the constraint point in space (for example, inside the narrow mouth or its upper and lower spaces) and the normal vector at the point position on the trajectory, the constraint point is set appropriately. By doing so, when machining the machining area, the shape of the space through which the machining tool passes can be changed, and interference between the workpiece and the machining tool can be avoided.
Therefore, since the trajectory data, which is the point position on the trajectory along the machining surface, and the attitude of the machining tool can be automatically calculated from the workpiece shape data (for example, a CAD model), the teaching work can be saved.
Furthermore, the constraint condition that the side surface of the tip of the processing tool (for example, cylindrical shape or conical shape) is brought into close contact with the processing surface of the workpiece can be satisfied at the same time.
以下、本発明の好ましい実施形態を添付図面に基づいて詳細に説明する。なお、各図において共通する部分には同一の符号を付し、重複した説明を省略する。 Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the accompanying drawings. In addition, the same code | symbol is attached | subjected to the common part in each figure, and the overlapping description is abbreviate | omitted.
図１は、本発明の研磨ロボット１０の全体構成図である。
この図において、研磨ロボット１０は、先端部１２ａで加工する加工工具１２でワーク１の加工面２を研磨する装置であり、ロボットアーム２０と姿勢制御装置２２を備える。
FIG. 1 is an overall configuration diagram of a
In this figure, a
図２は、本発明が対象とするワーク１の模式図であり、（Ａ）は正面断面図、（Ｂ）はＢ−Ｂ線における側面断面図である。
この図に示すように、本発明が対象とするワーク１は、加工工具１２を通す狭隘口１ａを有しており、狭隘口１ａの内部（この図では下方）にワーク１の加工面２が位置している。狭隘口１ａは、加工工具１２を通すことができる限りで、形状及び大きさは任意である。
なお、この例において、「狭隘部」は狭隘口１ａの内部又は内側であるが、本発明はこれに限定されず、ワーク１の狭隘部分であればよい。
2A and 2B are schematic views of the
As shown in this figure, a
In this example, the “narrow part” is the inside or the inside of the
ワーク１は、この例では加工工具１２の先端部１２ａにより、加工面２を研磨される被加工部材であり、例えば鋳鉄等の硬い材質からなる。
ワーク１は、この例ではワーク保持装置３により所定位置に正確に固定される。所定位置は、研磨ロボット１０のロボットアーム２０の作動範囲内において予め設定された位置である。
In this example, the
In this example, the
図１において、研磨ロボット１０は、ロボットアーム２０の先端に加工工具１２を取り付け、加工経路に沿って動作させてワーク１を加工する。
また、ロボットアーム２０は、加工工具１２を３次元空間内で移動する。
なお研磨ロボット１０は、この例では、多関節ロボットであるが、本発明はこれに限定されず、その他のロボットであってもよい。
In FIG. 1, a
The
The
加工工具１２は、ロボットアーム２０の先端に取り付けられ、ワーク１を加工する。
この例において、加工工具１２は、ワーク１を加工する先端部１２ａとこれを駆動する駆動装置１３とからなる。
この例で、加工工具１２は回転工具であり、駆動装置１３は電動スピンドルモータ又はエアモータである。また、先端部１２ａは、砥石、超硬カッター、ブラシ、クッションサンダ（砥粒入りの樹脂のスポンジ）、等である。
なお、加工工具１２は回転工具に限定されず、先端部１２ａを軸方向に往復動させる工具であってもよい。
The
In this example, the
In this example, the
The
図１において、ロボットアーム２０の先端に力覚センサ１４が取り付けられ、力覚センサ１４に加工工具１２が取り付けられている。
力覚センサ１４は、例えばロードセルであり、加工工具１２に作用する外力を検出するようになっている。
この力覚センサ１４で検出される外力は、好ましくは６自由度の外力（３方向の力と、３軸まわりのトルク）であるが、本発明はこれに限定されず、ワーク１に対する押付力が検出できる限りで、その他の力覚センサであってもよい。
In FIG. 1, a
The
The external force detected by the
研磨ロボット１０は、ロボットコントローラ１６を備える。ロボットコントローラ１６は、例えば数値制御装置であり、指令信号によりロボットアーム２０の先端を６自由度（３次元位置と３軸まわりの回転）に制御する。
The polishing
図１において、姿勢制御装置２２は、記憶部２３、軌道データ作成部２４、及び姿勢設定部２５を有し、ワーク１の加工面形状に基づいて加工工具１２の姿勢を制御する。
なお、以下の説明において、加工工具１２の姿勢とは、工具回転軸ｚの姿勢を意味する。
In FIG. 1, the
In the following description, the attitude of the
記憶部２３は、空間上に指定され、工具回転軸ｚの姿勢を拘束する拘束点ｐを記憶する。拘束点ｐの位置（３次元位置）は、ワーク１の形状データ（例えばＣＡＤデータ）を基に設定する。この設定は外部から入力してもよく、或いはワーク１の形状から、その図心等に自動設定してもよい。また適切な自動でも手入力でもよい。
ここで「空間」とは、狭隘口１ａを直視できる空間、例えば狭隘口１ａの図２における上側の空間であることが好ましい。
例えば、ワーク１が特定の狭隘部（例えば図２の狭隘口１ａの内部）がある形状の場合は、拘束点ｐを狭隘部の中間（例えば狭隘口１ａの内側）又はその上下空間に設定すると、工具軸が狭隘部に干渉するのを回避しやすい。
記憶部２３は、さらに、加工工具１２の位置、姿勢、及び押付け方向を含む軌道データＤを記憶する。
軌道データＤは、例えば、ワーク座標系における加工工具１２の３次元位置（ｘ，ｙ，ｚ）と姿勢（ａ，ｂ，ｃ）で表され、姿勢パラメータａ，ｂ，ｃは、例えばオイラー角などである。また、加工工具１２の押付け方向は、ワーク座標系における単位ベクトル（ｖｘ，ｖｙ，ｖｚ）で表される。
なお、本発明は、加工工具１２の位置、姿勢、及び押付け方向を設定できる限りで、これらの座標系と姿勢パラメータの定義（一般に、姿勢表現には多種の定義のパラメータが使用されている）に限定されない。
The
Here, the “space” is preferably a space in which the
For example, when the
The
The trajectory data D is represented by, for example, the three-dimensional position (x, y, z) and posture (a, b, c) of the
In the present invention, as long as the position, posture, and pressing direction of the
軌道データ作成部２４と姿勢設定部２５は、例えば、制御ＰＣである。
軌道データ作成部２４は、ワーク１の形状データ（例えばＣＡＤデータ）から、ワーク１の加工面２に沿った軌道上の点位置ｒと点位置ｒにおける法線ベクトルｖからなる軌道データＤを作成する。
姿勢設定部２５は、拘束点ｐと法線ベクトルｖを含む平面（以下、「拘束平面」）内において、先端部１２ａの側面とワーク１の加工面２が平行になるように加工工具１２の姿勢（先端部１２ａの軸心ｚ）を設定する。
軌道データＤと加工工具１２の姿勢データは、ロボットコントローラ１６に出力される。
なお、姿勢制御装置２２は、この例では、ロボットコントローラ１６と別個に設けられているが、ロボットコントローラ１６と姿勢制御装置２２を同一の制御ＰＣで構成してもよい。
The trajectory
The trajectory
The
The trajectory data D and the attitude data of the
In this example, the
図３は、本発明の軌道生成方法の全体フロー図である。
本発明の軌道生成方法は、上述した装置を準備し、Ｓ１〜Ｓ３の各ステップ（工程）を実施する。
FIG. 3 is an overall flowchart of the trajectory generation method of the present invention.
In the trajectory generation method of the present invention, the above-described apparatus is prepared, and steps (steps) S1 to S3 are performed.
ステップＳ１（拘束点記憶ステップ）では、空間上（例えば、狭隘口１ａの内側又はその上下空間）に指定され、工具回転軸ｚの姿勢を拘束する拘束点ｐを記憶する。
In step S1 (constraint point storage step), a restraint point p that is designated on the space (for example, inside the
ステップＳ２（軌道データ作成ステップ）では、ワーク１の形状データから、ワーク１の加工面２に沿った軌道上の点位置ｒと点位置ｒにおける法線ベクトルｖを含む軌道データＤを作成する。
なお、ステップＳ１とステップＳ２は、この順に限定されず、逆でも、同時でもよい。
In step S2 (trajectory data creation step), trajectory data D including a point position r on the trajectory along the
Note that step S1 and step S2 are not limited to this order, and may be reversed or simultaneous.
ステップＳ３（姿勢設定ステップ）では、拘束点ｐと法線ベクトルｖを含む拘束平面内において、先端部１２ａの側面とワーク１の加工面２が平行になるように加工工具１２の姿勢（先端部１２ａの軸心ｚ）を設定する。
ステップＳ３によって、ワーク１の形状データ（例えばＣＡＤモデル）から加工面２に沿った軌道上の点位置ｒと点位置ｒにおける法線ベクトルｖからなる軌道データＤと加工工具１２の姿勢を自動的に算出できる。「軌道データＤと加工工具１２の姿勢」が本発明で生成する軌道である。
In step S3 (posture setting step), the posture (tip portion) of the
In step S3, the trajectory data D including the point position r on the trajectory along the
図４は、加工工具１２の先端部１２ａの形状が軸心ｚを中心とする円柱形状である場合の模式図である。
加工工具１２が回転工具である場合、先端部１２ａの回転軸１２ｂの軸心が、円柱形状の軸心ｚと一致する。この場合、加工工具１２の先端部１２ａ（円柱形状）の側面を図に示すようにワーク１の加工面２に密着させるという拘束条件を満たす必要がある。
ここで、「密着」とは、加工工具１２の先端部１２ａの側面形状がワーク１の加工面２と一致して接触する状態を意味する。
FIG. 4 is a schematic diagram when the shape of the
When the
Here, “close contact” means a state in which the side surface shape of the
先端部１２ａが円柱形状である場合、上述したステップＳ３（姿勢設定ステップ）は、Ｓ３−１〜Ｓ３−３の各ステップ（工程）からなる。
When the
ステップＳ３−１では、拘束点ｐと法線ベクトルｖを含む拘束平面に垂直な第１ベクトルｕを求める。第１ベクトルｕは、式（１）で求めることができる。なお、（ｐ−ｒ）はベクトルであり、×は外積である。
ｕ＝（ｐ−ｒ）×ｖ・・・（１）
In step S3-1, a first vector u perpendicular to the constraint plane including the constraint point p and the normal vector v is obtained. The first vector u can be obtained by Expression (1). Note that (p−r) is a vector and x is an outer product.
u = (p−r) × v (1)
第１ベクトルｕは、単位ベクトルであることが好ましい。この場合、第１ベクトルｕは、式（２）で求めることができる。
ｕ＝（（ｐ−ｒ）×ｖ）／｜（ｐ−ｒ）×ｖ｜・・・（２）
The first vector u is preferably a unit vector. In this case, the first vector u can be obtained by Expression (2).
u = ((pr) × v) / | (pr) × v | (2)
次いで、ステップＳ３−２では、法線ベクトルｖと第１ベクトルｕとに垂直な第２ベクトルｗを求める。
第２ベクトルｗは、式（３）で求めることができる。
ｗ＝ｖ×ｕ・・・（３）
Next, in step S3-2, a second vector w perpendicular to the normal vector v and the first vector u is obtained.
The second vector w can be obtained by Expression (3).
w = v × u (3)
次いで、ステップＳ３−３では、第２ベクトルｗの姿勢を加工工具１２の姿勢（先端部１２ａの軸心ｚ）として設定する。
Next, in step S3-3, the posture of the second vector w is set as the posture of the machining tool 12 (the axis center z of the
第１ベクトルｕは、拘束点ｐと法線ベクトルｖを含む拘束平面に垂直なベクトルであり、第２ベクトルｗは、法線ベクトルｖと第１ベクトルｕとに垂直なベクトルであるから、第２ベクトルｗは、拘束点ｐと法線ベクトルｖを含む拘束平面上にあり、かつ法線ベクトルｖに直交する方向となる。
従って、第２ベクトルｗの姿勢を加工工具１２の姿勢として設定することにより、加工工具１２の先端部１２ａの側面とワーク１の加工面２が平行になるように加工工具１２、すなわち先端部１２ａの軸心ｚの姿勢を設定することができる。
The first vector u is a vector perpendicular to the constraint plane including the constraint point p and the normal vector v, and the second vector w is a vector perpendicular to the normal vector v and the first vector u. The two vectors w are on the constraint plane including the constraint point p and the normal vector v, and are in a direction orthogonal to the normal vector v.
Accordingly, by setting the posture of the second vector w as the posture of the
図５は、加工工具１２の先端部１２ａの形状が軸心ｚに対し傾斜角αを有する円錐形状である場合の模式図である。
加工工具１２が回転工具である場合、先端部１２ａの回転軸１２ｂの軸心が、円柱形状の軸心ｚと一致する。この場合、加工工具１２の先端部１２ａ（円錐形状）の側面を図に示すようにワーク１の加工面２に密着させるという拘束条件を満たす必要がある。
FIG. 5 is a schematic diagram when the shape of the
When the
先端部１２ａが円錐形状である場合、上述したステップＳ３（姿勢設定ステップ）は、Ｓ３−１〜Ｓ３−３の各ステップ（工程）からなる。
ステップＳ３−１、Ｓ３−２は、図４の場合と同様である。
すなわち、ステップＳ３−１では、拘束点ｐと法線ベクトルｖを含む拘束平面に垂直な第１ベクトルｕを求め、ステップＳ３−２では、法線ベクトルｖと第１ベクトルｕとに垂直な第２ベクトルｗを求める。
When the
Steps S3-1 and S3-2 are the same as in FIG.
That is, in step S3-1, the first vector u perpendicular to the constraint plane including the constraint point p and the normal vector v is obtained, and in step S3-2, the first vector u perpendicular to the normal vector v and the first vector u is obtained. 2 vector w is obtained.
次いで、先端部１２ａが円錐形状である場合、ステップＳ３−３では、第２ベクトルｗに対し第１ベクトルｕの方向を中心として狭隘部（例えば狭隘口１ａの内側）の内方に傾斜角αを有する姿勢を加工工具１２の姿勢（先端部１２ａの軸心ｚ）として設定する。
加工工具１２の姿勢、すなわち先端部１２ａの軸心ｚの方向ベクトルＺは、式（４）で求めることができる。
Ｚ＝（Ｒ・ｗ）／｜Ｒ・ｗ｜・・・（４）
ここでＲは、回転行列であり、数１の式（５）で表される。
Next, when the
The posture of the
Z = (R · w) / | R · w | (4)
Here, R is a rotation matrix, and is expressed by Equation (5) of
第１ベクトルｕは、拘束点ｐと法線ベクトルｖを含む拘束平面に垂直なベクトルであり、第２ベクトルｗは、法線ベクトルｖと第１ベクトルｕとに垂直なベクトルであるから、第２ベクトルｗは、拘束点ｐと法線ベクトルｖを含む拘束平面上にあり、かつ法線ベクトルｖに直交する方向となる。
さらに、加工工具１２の姿勢、すなわち先端部１２ａの軸心ｚの方向は、第２ベクトルｗに対し第１ベクトルｕの方向を中心として狭隘部（例えば狭隘口１ａの内側）の内方に傾斜角αを有する姿勢であるから、加工工具１２の先端部１２ａの側面とワーク１の加工面２が平行になるように加工工具１２、すなわち先端部１２ａの軸心ｚの姿勢を設定することができる。
The first vector u is a vector perpendicular to the constraint plane including the constraint point p and the normal vector v, and the second vector w is a vector perpendicular to the normal vector v and the first vector u. The two vectors w are on the constraint plane including the constraint point p and the normal vector v, and are in a direction orthogonal to the normal vector v.
Further, the posture of the
上述した本発明の装置と方法によれば、加工工具１２の先端部１２ａの側面とワーク１の加工面２が平行になるように加工工具１２の姿勢を設定するので、先端部１２ａの側面をワーク１の加工面２に密着させた状態でワーク１を研磨（磨き加工）することができる。
また、狭隘口１ａの内側の拘束点ｐと軌道上の点位置ｒにおける法線ベクトルｖを含む拘束平面内において加工工具１２の姿勢を設定するので、加工工具１２が拘束点近傍を通り、狭隘口１ａと加工工具１２との干渉を回避することができる。
従って、ワーク１の形状データ（例えばＣＡＤモデル）から加工面２に沿った軌道上の点位置ｒである軌道データＤと加工工具１２の姿勢を自動的に算出できるため、教示作業の手間が省ける。
さらに、加工工具１２の先端部１２ａ（例えば、円柱形状、円錐形状）の側面をワーク１の加工面２に密着させるという拘束条件も同時に満たすことができる。
According to the above-described apparatus and method of the present invention, the posture of the
Further, since the posture of the
Accordingly, since the trajectory data D, which is the point position r on the trajectory along the
Furthermore, the constraint condition that the side surface of the
なお、本発明は上述した実施形態に限定されず、特許請求の範囲の記載によって示され、さらに特許請求の範囲の記載と均等の意味および範囲内でのすべての変更を含むものである。 In addition, this invention is not limited to embodiment mentioned above, is shown by description of a claim, and also includes all the changes within the meaning and range equivalent to description of a claim.
ｐ 拘束点、ｒ 点位置、ｖ 法線ベクトル、ｕ 第１ベクトル、
ｗ 第２ベクトル、Ｄ 軌道データ、ｚ 軸心（工具回転軸）、
１ ワーク、１ａ 狭隘口、２ 加工面、３ ワーク保持装置、
１０ 研磨ロボット、１２ 加工工具、１２ａ 先端部、
１３ 駆動装置、１４ 力覚センサ、１６ ロボットコントローラ、
２０ ロボットアーム、２２ 姿勢制御装置、２３ 記憶部、
２４ 軌道データ作成部、２５ 姿勢設定部
p constraint point, r point position, v normal vector, u first vector,
w second vector, D orbit data, z axis (tool rotation axis),
1 workpiece, 1a narrow opening, 2 machining surface, 3 workpiece holding device,
10 polishing robot, 12 processing tool, 12a tip,
13 drive device, 14 force sensor, 16 robot controller,
20 robot arms, 22 attitude control devices, 23 storage units,
24 orbit data creation unit, 25 attitude setting unit
Claims (4)
前記加工工具を３次元空間内で移動するロボットアームと、
ワークの加工面形状に基づいて前記加工工具の姿勢を制御する姿勢制御装置と、を備え、
前記姿勢制御装置は、
前記狭隘口を直視できる空間上に指定され、工具回転軸の姿勢を拘束する拘束点を記憶する記憶部と、
前記ワークの形状データから、ワークの前記加工面に沿った軌道上の点位置と該点位置における法線ベクトルからなる軌道データを作成する軌道データ作成部と、
前記拘束点と前記法線ベクトルを含む拘束平面内において、前記先端部の側面とワークの前記加工面が平行になるように加工工具の姿勢を設定する姿勢設定部と、を含む、ことを特徴とする研磨ロボット。 A polishing robot for polishing a processing surface other than a cylindrical inner surface of a workpiece with a processing tool for processing at a tip portion, wherein the processing surface is positioned inside a narrow opening formed on a surface of the workpiece through which the processing tool is passed. And
A robot arm that moves the machining tool in a three-dimensional space;
An attitude control device that controls the attitude of the machining tool based on the machining surface shape of the workpiece,
The attitude control device includes:
A storage unit that is designated on a space where the narrow opening can be directly viewed and stores a restraint point that restrains the posture of the tool rotation axis;
From the shape data of the workpiece, the trajectory data creation section that creates a trajectory data consisting of the normal vector at the position and the point position point on the trajectory along the machined surface of the workpiece,
Wherein in the restrained plane, including a position setting unit for setting a posture of the machining tool so that the working surface of the side and the workpiece of the tip is parallel, to include the normal vector and the constraint point A polishing robot.
前記加工工具を３次元空間内で移動するロボットアームと、
ワークの加工面形状に基づいて前記加工工具の姿勢を制御する姿勢制御装置と、を準備し、
前記姿勢制御装置により
（Ａ）前記狭隘口を直視できる空間上に指定され、工具回転軸の姿勢を拘束する拘束点を記憶し、
（Ｂ）前記ワークの形状データから、ワークの前記加工面に沿った軌道上の点位置と該点位置における法線ベクトルを含む軌道データを作成し、
（Ｃ）前記拘束点と前記法線ベクトルを含む拘束平面内において、前記先端部の側面とワークの前記加工面が平行になるように加工工具の姿勢を設定する、ことを特徴とする研磨ロボットの軌道生成方法。 A method for generating a trajectory of a polishing robot that polishes a machining surface other than a cylindrical inner surface of a workpiece with a machining tool machined at a tip portion, wherein the machining surface is inside a narrow opening formed on a surface of the workpiece through which the machining tool is passed. Is located,
A robot arm that moves the machining tool in a three-dimensional space;
Preparing an attitude control device for controlling the attitude of the machining tool based on the machining surface shape of the workpiece,
By the posture control device, (A) a constraint point that is designated on a space where the narrow opening can be directly viewed and restrains the posture of the tool rotation axis is stored;
(B) from the shape data of the workpiece, creates a trajectory data including the normal vector at the position and the point position point on the trajectory along the machined surface of the workpiece,
(C) a polishing robot in the constrained plane comprising said constraint points and the normal vectors, sets the posture of the machining tool so that the working surface of the side and the workpiece of the tip is parallel, characterized in that Orbit generation method.
前記（Ｃ）において、
前記拘束点と前記法線ベクトルを含む拘束平面に垂直な第１ベクトルを求め、
次いで、前記法線ベクトルと前記第１ベクトルとに垂直な第２ベクトルを求め、
前記第２ベクトルの姿勢を前記加工工具の姿勢として設定する、ことを特徴とする請求項２に記載の研磨ロボットの軌道生成方法。 The shape of the tip is a cylindrical shape centered on the axis,
In the above (C),
Obtaining a first vector perpendicular to a constraint plane including the constraint point and the normal vector;
Next, a second vector perpendicular to the normal vector and the first vector is obtained,
The method of generating a trajectory for a polishing robot according to claim 2, wherein the posture of the second vector is set as the posture of the machining tool.
前記（Ｃ）において、
前記拘束点と前記法線ベクトルを含む拘束平面に垂直な第１ベクトルを求め、
次いで、前記法線ベクトルと前記第１ベクトルとに垂直な第２ベクトルを求め、
前記第２ベクトルに対し前記第１ベクトルの方向を中心として前記狭隘口の内方に前記傾斜角を有する姿勢を前記加工工具の姿勢として設定する、ことを特徴とする請求項２に記載の研磨ロボットの軌道生成方法。
The shape of the tip is a conical shape having an inclination angle with respect to the axis,
In the above (C),
Obtaining a first vector perpendicular to a constraint plane including the constraint point and the normal vector;
Next, a second vector perpendicular to the normal vector and the first vector is obtained,
3. The polishing according to claim 2, wherein a posture having the inclination angle inside the narrow opening with respect to the second vector as a center with respect to a direction of the first vector is set as a posture of the processing tool. Robot trajectory generation method.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2014010373A JP6347399B2 (en) | 2014-01-23 | 2014-01-23 | Polishing robot and its trajectory generation method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2014010373A JP6347399B2 (en) | 2014-01-23 | 2014-01-23 | Polishing robot and its trajectory generation method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2015136772A JP2015136772A (en) | 2015-07-30 |
| JP6347399B2 true JP6347399B2 (en) | 2018-06-27 |
Family
ID=53768140
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2014010373A Active JP6347399B2 (en) | 2014-01-23 | 2014-01-23 | Polishing robot and its trajectory generation method |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP6347399B2 (en) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107598918B (en) * | 2017-08-16 | 2018-09-21 | 广东工业大学 | Surface grinding process automatic programming method based on milling robot and device |
| CN114453630B (en) * | 2022-01-20 | 2023-04-04 | 湖北文理学院 | Method and device for controlling machine tool to mill non-stick tool, electronic equipment and storage medium |
Family Cites Families (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| GB8305667D0 (en) * | 1983-03-01 | 1983-03-30 | Burwell Reed & Kinghorn | Polishing machine |
| JPH02311257A (en) * | 1989-05-23 | 1990-12-26 | Daikin Ind Ltd | Groove polishing method and device for this |
| JP3380028B2 (en) * | 1994-01-25 | 2003-02-24 | 新日本製鐵株式会社 | Profile control method of pipe surface by force control robot |
| JP2001038598A (en) * | 1999-07-26 | 2001-02-13 | Prima Meat Packers Ltd | Automatic polisher |
| JP2001105294A (en) * | 1999-10-07 | 2001-04-17 | Nitta Ind Corp | Grinding system |
| JP2009072872A (en) * | 2007-09-21 | 2009-04-09 | Nachi Fujikoshi Corp | Crossing hole deburring method and deburring robot system |
| JP5765615B2 (en) * | 2011-02-28 | 2015-08-19 | 株式会社Ihi | Trajectory tracking device and method for machining robot |
-
2014
- 2014-01-23 JP JP2014010373A patent/JP6347399B2/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| JP2015136772A (en) | 2015-07-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5720876B2 (en) | Processing robot and gravity compensation method thereof | |
| KR940003204B1 (en) | Control robot | |
| JP5765615B2 (en) | Trajectory tracking device and method for machining robot | |
| JP5220183B2 (en) | Numerical control device and control method of the numerical control device | |
| JP5962242B2 (en) | Grinding equipment | |
| US9815194B2 (en) | Force control robot and method for controlling same | |
| JP2011041992A (en) | Machining robot system | |
| KR940009090B1 (en) | Grinder robot | |
| JP6418483B2 (en) | Processing trajectory generating apparatus and method | |
| JP5452788B1 (en) | Numerical controller | |
| JP6208701B2 (en) | Robot system for adjusting position of coolant nozzle and robot control method | |
| JP5549330B2 (en) | Machining robot and its machining control method | |
| JP6274561B2 (en) | Rotary grinding wheel dressing apparatus and method | |
| CN105717870A (en) | Apparatus and Method for Recording Positions | |
| JPH074765B2 (en) | Curved surface processing equipment | |
| JP5534189B2 (en) | Machining robot and its machining control method | |
| JP6347399B2 (en) | Polishing robot and its trajectory generation method | |
| JP5765557B2 (en) | Trajectory tracking device and method for machining robot | |
| JP6323744B2 (en) | Polishing robot and its control method | |
| JP6390832B2 (en) | Processing trajectory generating apparatus and method | |
| JP2011189417A (en) | Processing robot and gravity compensating method thereof | |
| JP2018202582A (en) | Processing method and processing device | |
| JP6089731B2 (en) | Molding control device, molding control method, and program | |
| WO2023013559A1 (en) | Robot system, machining method of robot, and machining program | |
| WO2023013560A1 (en) | Robot system, robotic processing method, and processing program |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20161124 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20170908 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20170922 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20171114 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20180507 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 6347399 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20180520 |