JP2009009274A - 数値制御装置 - Google Patents
数値制御装置 Download PDFInfo
- Publication number
- JP2009009274A JP2009009274A JP2007168825A JP2007168825A JP2009009274A JP 2009009274 A JP2009009274 A JP 2009009274A JP 2007168825 A JP2007168825 A JP 2007168825A JP 2007168825 A JP2007168825 A JP 2007168825A JP 2009009274 A JP2009009274 A JP 2009009274A
- Authority
- JP
- Japan
- Prior art keywords
- error
- tool
- coordinate system
- axis
- machine coordinate
- 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)
Abstract
【課題】指令加工形状を定義する基準座標系と実際の加工時の座標系との間に存在する誤差を補正できる数値制御装置を得る。
【解決手段】基準座標系と実座標系間には、並進誤差、回転誤差がある。基準座標系上で指令された工具先端点位置Ptにそのときの工具長補正ベクトルTを加算し、直線軸機械座標位置Pmを求める。この直線軸機械座標位置Pmと、与えられた並進誤差、回転誤差の誤差行列より、工具先端点位置の補正量ΔDを求める。直線軸機械座標位置Pmにこの補正量ΔDを加算して、直線軸修正機械座標位置Pm’を求め、各直線軸をこの直線軸修正機械座標位置Pm’に駆動する。回転軸は、指令された回転位置に駆動する。基準機械座標系上の工具先端点位置Ptと実機械座標系上の工具先端点位置Pt'が等しくなる。その結果、被加工物に対して高精度な加工を行うことができる。
【選択図】図1
【解決手段】基準座標系と実座標系間には、並進誤差、回転誤差がある。基準座標系上で指令された工具先端点位置Ptにそのときの工具長補正ベクトルTを加算し、直線軸機械座標位置Pmを求める。この直線軸機械座標位置Pmと、与えられた並進誤差、回転誤差の誤差行列より、工具先端点位置の補正量ΔDを求める。直線軸機械座標位置Pmにこの補正量ΔDを加算して、直線軸修正機械座標位置Pm’を求め、各直線軸をこの直線軸修正機械座標位置Pm’に駆動する。回転軸は、指令された回転位置に駆動する。基準機械座標系上の工具先端点位置Ptと実機械座標系上の工具先端点位置Pt'が等しくなる。その結果、被加工物に対して高精度な加工を行うことができる。
【選択図】図1
Description
本発明は、直線軸3軸と回転軸2軸を有する5軸加工機を制御する数値制御装置に関する。特に、組立誤差等から生じる並進誤差、回転誤差等の誤差を補正する数値制御装置に関する。
工作機械による実際の加工形状は指令加工形状に対して誤差がある。この誤差は、ボールネジのピッチ誤差、工作機械の組立誤差や、コラム等の機械各部や被加工物の自重による変形、温度変化による変形によっても生じる。又、被加工物(ワーク)が取り付けられたテーブルの案内面上の位置に応じて、案内面等が変形し、この変形が加工誤差の原因となる。加工形状は基準座標系に基づいて指令されるが、実際に加工を行うときの座標系はこの基準座標系に対してずれ、誤差が発生しこの誤差によって、加工形状誤差が発生する。
これらの誤差を補正する方法とした、非特許文献1には、座標系間に存在する並進誤差(δx,δy,δz)と回転誤差(α,β,γ)を補正する方法が述べられている。
これらの誤差を補正する方法とした、非特許文献1には、座標系間に存在する並進誤差(δx,δy,δz)と回転誤差(α,β,γ)を補正する方法が述べられている。
工作機械が有するi軸とk軸間の組立誤差(真直度誤差と平行度誤差)を表す誤差行列εikは、X軸周り、Y軸周り、Z軸周りそれぞれの回転誤差αik、βik、γikによって次の式(1)になることが示されている。なお、αik、βik、γikはそれぞれ十分小さいものとし、sin(αik)をαikで、sin(βik)をβikで、sin(γik)をγikで近似している。また、同次座標系で示している。なお、i、kは工作機械が有する任意の軸(直線軸X、Y、Z、回転軸A、B、C)である。
従来、数値制御装置では、図9、図10に示すように各軸の加減速処理を行われた後に、補正手段において各軸の機械位置に対してピッチ誤差補正や真直度補正などの補正を行っている。
図9は、工具長補正指令の場合での、数値制御装置の動作処理の概要ブロック図である。又、図10は、工具先端点制御の場合での、数値制御装置の動作処理の概要ブロック図である。
図9は、工具長補正指令の場合での、数値制御装置の動作処理の概要ブロック図である。又、図10は、工具先端点制御の場合での、数値制御装置の動作処理の概要ブロック図である。
図9に示す、工具長補正指令の場合、プログラムのブロックを指令解析部1で解析し、この解析結果の工具先端点位置による指令位置に対して工具長補正ベクトル加算要素2により、指令位置である工具先端点位置に工具長補正ベクトルを加算し、直線軸機械座標位置を求める(図11参照)。該直線軸機械座標位置及び回転軸の指令位置に対して補間手段3で補間を行い各軸の機械座標値を生成し、各軸(X、Y、Z、B(A)、C軸)の加減速処理部4x、4y、4z、4b(a)、4cでそれぞれ加減速を行った後、補正手段5で各軸の加減速処理終了後の指令位置に対し、上述したピッチ誤差補正や真直度補正等が行った後、各軸のサーボモータ6x、6y、6z、6b(a)、6cを駆動する。
また、工具先端点制御の場合は、数値制御装置は、図10に示したように補間手段3で工具先端点の補間を行い補間された工具先端点位置に対して工具長補正ベクトル加算要素2により工具長補正ベクトルを加算し、直線軸機械座標位置を生成し、該直線軸機械座標位置及び補間された回転軸の位置に対して各加減速処理部4x〜4cで加減速を行った後に各軸の各種補正を行い、各軸のサーボモータを駆動する。
この図9(図10)に示す従来の数値制御装置により、上述した非特許文献1に記載された組立誤差等により生じる誤差ΔDを、補正手段5で補正した場合を図11に示す。
図11では、工具10が取り付けられている工具ヘッド11の端面が機械座標位置とされ、数値制御装置は工具ヘッド11の端面の位置を制御する。そこで、指令位置である工具先端点位置Ptcに工具長補正ベクトルTを加算し、工具長補正ベクトルTが加算された直線軸機械座標位置Pmcを求め、該直線軸機械座標位置Pmc、及び回転軸位置を補間手段3で補間を行い、各軸の機械座標位置を生成し、加減速処理部4x、4y、4z、4b(a)、4cでそれぞれ加減速を行った後の加減速処理終了後の指令位置に対し、上述した組立誤差等により生じる誤差ΔD補正して、機械座標位置Pmc’を求めて各軸のサーボモータを駆動することになる。しかし、後述するように、この補正により、基準座標系から実座標系へ座標変換による補正を行っても工具先端点位置に対する補正とはならない。つまり、基準座標系上の指令位置と実座標系上の工具先端点位置は相違する。
図11では、工具10が取り付けられている工具ヘッド11の端面が機械座標位置とされ、数値制御装置は工具ヘッド11の端面の位置を制御する。そこで、指令位置である工具先端点位置Ptcに工具長補正ベクトルTを加算し、工具長補正ベクトルTが加算された直線軸機械座標位置Pmcを求め、該直線軸機械座標位置Pmc、及び回転軸位置を補間手段3で補間を行い、各軸の機械座標位置を生成し、加減速処理部4x、4y、4z、4b(a)、4cでそれぞれ加減速を行った後の加減速処理終了後の指令位置に対し、上述した組立誤差等により生じる誤差ΔD補正して、機械座標位置Pmc’を求めて各軸のサーボモータを駆動することになる。しかし、後述するように、この補正により、基準座標系から実座標系へ座標変換による補正を行っても工具先端点位置に対する補正とはならない。つまり、基準座標系上の指令位置と実座標系上の工具先端点位置は相違する。
又、上述した非特許文献1以外にも、工作機械の組付誤差等を補正する方法として、特許文献1には、基準軸心に対する回転軸誤差と指令角度に基づき加工原点を補正することによって、テーブル等の組付誤差や加工誤差から生じる回転軸の傾き誤差、位置誤差を補正する方法が記載されて公知である。
又、特許文献2には、回転軸のずれ量、又は主軸旋回中心のずれ量から、機械誤差がない場合の工具と被加工物の相対関係が保持されるように補正する方法が記載されている。
又、特許文献2には、回転軸のずれ量、又は主軸旋回中心のずれ量から、機械誤差がない場合の工具と被加工物の相対関係が保持されるように補正する方法が記載されている。
図9、図10に示した従来の補正手段5で、指令加工形状を定義する基準座標系に対して誤差のある実座標系へ座標変換による補正を行っても機械座標位置に対する補正であるため工具先端点位置に対する補正とはならない。つまり、工具先端点位置に工具長補正ベクトルを加算して直線軸の機械座標位置を求め、該機械座標位置に対して補正したとしても、工具先端点位置を補正したものとはならない。数式上の説明は後述する。さらに、回転軸がなく直線軸だけであれば基準座標系上の指令位置と実座標系上の工具先端点位置の相違量はおおむね静的であり座標系原点を変更するなどの方法で対応可能だが、5軸加工機のように回転軸があると基準座標系上の指令位置と実座標系上の工具先端点位置の相違量は回転軸の位置や工具先端点位置の回転中心からの距離などによって動的に変化する。 したがって、工具先端点位置(加工点)での補正が正しく行われないため精度の良い加工ができない。
又、特許文献1に記載された発明は、基準軸心に対する回転軸誤差と指令角度に基づき加工原点を補正する方法であり、基準軸心に対する回転軸誤差を対象としているのみでは、基準座標系と実座標系の間に存在する並進誤差(δx,δy,δz)と回転誤差(α,β,γ)は正確に補正ができない。例えば、直線軸間(X軸とY軸の間など)に存在する真直度誤差はこの特許文献1の方法では補正できない。
同様に、特許文献2に記載された回転軸のずれ量、主軸旋回中心のずれ量を補正対象とする補正では、前述したように基準座標系と実座標系の間に存在する並進誤差(δx,δy,δz)と回転誤差(α,β,γ)に対して正確な補正ができない。
そこで、本発明の目的は、指令加工形状を定義する基準座標系と実際の加工時の座標系との間に存在する全ての誤差を補正できる数値制御装置を提供することにある。
同様に、特許文献2に記載された回転軸のずれ量、主軸旋回中心のずれ量を補正対象とする補正では、前述したように基準座標系と実座標系の間に存在する並進誤差(δx,δy,δz)と回転誤差(α,β,γ)に対して正確な補正ができない。
そこで、本発明の目的は、指令加工形状を定義する基準座標系と実際の加工時の座標系との間に存在する全ての誤差を補正できる数値制御装置を提供することにある。
本願請求項1に係る発明は、テーブルに取付られた被加工物に対して直線軸3軸と回転軸2軸によって加工する5軸加工機を制御する数値制御装置において、与えられた基準機械座標系に対する実機械座標系の並進誤差(δx,δy,δz)と回転誤差(α,β,γ)と、直線軸機械座標位置及び工具長補正ベクトルから工具先端点位置の補正量(ΔX,ΔY,ΔZ)Tを求める補正量算出手段と、前記補正量(ΔX,ΔY,ΔZ)Tに基づいて直線軸修正機械座標位置を求める補正手段と、各直線軸は前記直線軸修正機械座標位置へ、各回転軸は指令された回転位置に駆動する手段を備え、工具先端点位置の誤差補正を行うものである。
請求項2に係る発明は、前記補正量算出手段を、補間周期毎に前記工具先端点位置の補正量を求めるものとした。さらに、請求項3に係る発明は、補間周期において前記工具先端点位置の補正量を求める周期かどうか判断する判断手段を備え、前記判断手段において工具先端点位置の補正量を求めると判断した周期において前記補正量算出手段は前記工具先端点位置の補正量を求めて更新記憶するようにし、前記補正手段は、記憶した補正量に基づいて補間周期毎に前記直線軸修正機械座標位置を求めるものとした。
請求項4に係る発明は、並進誤差(δx,δy,δz)及び回転誤差(α,β,γ)の誤差基準値を設定する手段を有し、前記並進誤差(δx,δy,δz)及び回転誤差(α,β,γ)は変更可能とし、変更前と変更後の前記並進誤差(δx,δy,δz)及び回転誤差(α,β,γ)の差を求める手段を有し、前記判断手段は、変更前と変更後の前記並進誤差(δx,δy,δz)又は回転誤差(α,β,γ)の差が該設定された誤差基準値よりも大きい場合に前記工具先端点位置の補正量を求める周期と判断するようにした。
請求項5に係る発明は、補間周期回数を設定する手段を有し、前記判断手段は該設定された補間周期回数毎に前記工具先端点位置の補正量を求める周期と判断するものとした。
請求項6に係る発明は、前記工具長補正ベクトルを前記基準機械座標系で指令された基準工具長補正ベクトルT(Tx,Ty,Tz)Tと前記実機械座標系での実工具長補正ベクトルT'(Tx',Ty',Tz') Tとした。又、請求項7に係る発明は、前記実工具長補正ベクトルを並進誤差(Tδx,Tδy,Tδz)と回転誤差(Tα,Tβ,Tγ)から成る実工具長補正ベクトル用誤差によって前記基準工具長補正ベクトルから求めるものとした。又、請求項8に係る発明は、前記実工具長補正ベクトルを工具方向誤差(ΔTa)と工具直角方向誤差(ΔTrx,ΔTry)から成る実工具長補正ベクトル用誤差によって前記基準工具長補正ベクトルから求めるものとした。又、請求項9に係る発明は、前記実工具長補正ベクトルを直線軸方向誤差(ΔTz,ΔTx,ΔTy)Tから成る実工具長補正ベクトル用誤差によって前記基準工具長補正ベクトルから求めるものとした。
請求項5に係る発明は、補間周期回数を設定する手段を有し、前記判断手段は該設定された補間周期回数毎に前記工具先端点位置の補正量を求める周期と判断するものとした。
請求項6に係る発明は、前記工具長補正ベクトルを前記基準機械座標系で指令された基準工具長補正ベクトルT(Tx,Ty,Tz)Tと前記実機械座標系での実工具長補正ベクトルT'(Tx',Ty',Tz') Tとした。又、請求項7に係る発明は、前記実工具長補正ベクトルを並進誤差(Tδx,Tδy,Tδz)と回転誤差(Tα,Tβ,Tγ)から成る実工具長補正ベクトル用誤差によって前記基準工具長補正ベクトルから求めるものとした。又、請求項8に係る発明は、前記実工具長補正ベクトルを工具方向誤差(ΔTa)と工具直角方向誤差(ΔTrx,ΔTry)から成る実工具長補正ベクトル用誤差によって前記基準工具長補正ベクトルから求めるものとした。又、請求項9に係る発明は、前記実工具長補正ベクトルを直線軸方向誤差(ΔTz,ΔTx,ΔTy)Tから成る実工具長補正ベクトル用誤差によって前記基準工具長補正ベクトルから求めるものとした。
指令加工形状を定義する基準座標系と加工時の実際の座標系との間の誤差を、加工点である工具先端点位置で補正できることから、高精度な加工ができる。
まず、本発明の原理、基本的なアルゴリズムについて説明する。図1は、本発明の原理、基本的なアルゴリズムの説明図である。図1において、符号10は、工具であり、符号11は工具ヘッドである。又、数値制御装置が指令する直線軸機械座標位置Pmは、工具ヘッド11の端面とされているものとして図1では説明する。
加工形状を指令する基礎となる基準座標系と実際に加工するときの実座標系間の、並進誤差(δx,δy,δz)と回転誤差(α,β,γ)が与えられたとき、現在の機械座標位置Pm(Pmx,Pmy,Pmz) Tと現在の工具長補正ベクトルT(Tx,Ty,Tz) Tから、次の式(5)によって工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ) Tを求める。
加工形状を指令する基礎となる基準座標系と実際に加工するときの実座標系間の、並進誤差(δx,δy,δz)と回転誤差(α,β,γ)が与えられたとき、現在の機械座標位置Pm(Pmx,Pmy,Pmz) Tと現在の工具長補正ベクトルT(Tx,Ty,Tz) Tから、次の式(5)によって工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ) Tを求める。
そして、次の式(6)によって直線軸修正機械座標位置Pm’(Pmx',Pmy',Pmz') Tを求め、その位置へ各直線軸を駆動する。又、回転軸は指令された位置に駆動する。これによって、加工点である工具先端点位置Pt(Ptx,Pty,Ptz)Tでの並進誤差(δx,δy,δz)と回転誤差(α,β,γ)が補正されて精度の良い加工がなされる。
上記式(6)によって求められる直線軸修正機械座標位置Pm’(Pmx',Pmy',Pmz') Tに各直線軸を駆動することによって、工具先端点位置Pt(Ptx,Pty,Ptz)Tでの並進誤差(δx,δy,δz)Tと回転誤差(α,β,γ)が補正される理由は、次の通りである。
まず、誤差行列εに単位行列Eを加算して実機械座標値から基準機械座標値に変換する位置変換行列をMとする(M=E+ε)。該位置変換行列Mは次の式(7)で表される。
Pt'=M-1(Pm’−T)
=M-1(Pm+ΔD−T)
=M-1(Pm−T+ε(Pm−T))
=M-1(E+ε)(Pm−T)
=M-1M(Pm−T)
=Pt
となる。つまり、基準座標系上の工具先端点位置Pt(Ptx,Pty,Ptz) Tと実座標系上の工具先端点位置Pt'(Ptx' ,Pty' ,Ptz') Tは等しい。
したがって、修正機械座標位置Pm'(Pmx', Pmy', Pmz') Tへ駆動することによって工具先端点(加工点)におけるすべての誤差を補正することが可能であり、高精度な加工を行うことができることを意味している。
ここで、図9、図10に示した従来の補正手段5で、指令加工形状を定義する基準座標系に対して誤差のある実座標系へ座標変換による補正を行っても工具先端点位置に対する補正とはならないことを、数式でも説明する。図11において、基準座標系上の工具先端点位置(指令位置)Ptc(Ptcx,Ptcy,Ptcz) T、実座標系上の工具先端点位置Ptc'(Ptcx',Ptcy',Ptcz') T、工具長補正ベクトルT(Tx,Ty,Tz)T、直線軸機械座標位置Pmc(Pmcx,Pmcy,Pmcz)T、修正された直線軸機械座標位置Pmc’(Pmcx',Pmcy',Pmcz')Tは、次の関係となる。ここでΔDは式(5)と同様のPmcとPmc’の間における誤差とする。
Ptc'=M-1(Pmc’−T)
=M-1(Pmc+ΔD−T)
=M-1(Pmc−T+εPmc)
=M-1(Pmc−T+ε(Pmc−T)+εT)
=M-1M(Pmc−T) +M-1εT
=Ptc+M-1εT
つまり、Ptc' とPtcはM-1εTだけ相違する。
さらに、図13に示したように、工具長補正ベクトルは基準機械座標系ではプログラムで指令された基準工具長補正ベクトルT(Tx,Ty,Tz)Tだが実機械座標系では誤差を持った実工具長補正ベクトルT'(Tx',Ty',Tz' )Tである場合がある。つまり、実機械座標系での実工具長補正ベクトルT'(Tx',Ty',Tz' )Tは工具自重によるたわみや熱膨張または伸縮あるいは組立誤差などによって基準機械座標系でプログラム指令された基準工具長補正ベクトルT(Tx,Ty,Tz)Tに対して誤差を持つ場合がある。この場合、補正量ΔD(ΔX,ΔY,ΔZ)Tは前記数式(5)ではなく次の式(8)によって計算される。
=M-1(Pm+ΔD−T)
=M-1(Pm−T+ε(Pm−T))
=M-1(E+ε)(Pm−T)
=M-1M(Pm−T)
=Pt
となる。つまり、基準座標系上の工具先端点位置Pt(Ptx,Pty,Ptz) Tと実座標系上の工具先端点位置Pt'(Ptx' ,Pty' ,Ptz') Tは等しい。
したがって、修正機械座標位置Pm'(Pmx', Pmy', Pmz') Tへ駆動することによって工具先端点(加工点)におけるすべての誤差を補正することが可能であり、高精度な加工を行うことができることを意味している。
ここで、図9、図10に示した従来の補正手段5で、指令加工形状を定義する基準座標系に対して誤差のある実座標系へ座標変換による補正を行っても工具先端点位置に対する補正とはならないことを、数式でも説明する。図11において、基準座標系上の工具先端点位置(指令位置)Ptc(Ptcx,Ptcy,Ptcz) T、実座標系上の工具先端点位置Ptc'(Ptcx',Ptcy',Ptcz') T、工具長補正ベクトルT(Tx,Ty,Tz)T、直線軸機械座標位置Pmc(Pmcx,Pmcy,Pmcz)T、修正された直線軸機械座標位置Pmc’(Pmcx',Pmcy',Pmcz')Tは、次の関係となる。ここでΔDは式(5)と同様のPmcとPmc’の間における誤差とする。
Ptc'=M-1(Pmc’−T)
=M-1(Pmc+ΔD−T)
=M-1(Pmc−T+εPmc)
=M-1(Pmc−T+ε(Pmc−T)+εT)
=M-1M(Pmc−T) +M-1εT
=Ptc+M-1εT
つまり、Ptc' とPtcはM-1εTだけ相違する。
さらに、図13に示したように、工具長補正ベクトルは基準機械座標系ではプログラムで指令された基準工具長補正ベクトルT(Tx,Ty,Tz)Tだが実機械座標系では誤差を持った実工具長補正ベクトルT'(Tx',Ty',Tz' )Tである場合がある。つまり、実機械座標系での実工具長補正ベクトルT'(Tx',Ty',Tz' )Tは工具自重によるたわみや熱膨張または伸縮あるいは組立誤差などによって基準機械座標系でプログラム指令された基準工具長補正ベクトルT(Tx,Ty,Tz)Tに対して誤差を持つ場合がある。この場合、補正量ΔD(ΔX,ΔY,ΔZ)Tは前記数式(5)ではなく次の式(8)によって計算される。
次に、本発明を各種5軸加工機に適用した動作原理を説明する。
図2は、本発明の数値制御装置が制御対象とする工具ヘッド回転型機械における本発明の動作原理説明図である。この工具ヘッド回転型機械は、直線軸のX、Y、Z軸と工具10をY軸周りに回転させる回転軸のB軸と、Z軸周りに回転させる回転軸のC軸を備えるものである。ここで、被加工物を取り付けるテーブル12の実テーブル位置が基準テーブル位置に対して誤差を持っている。実テーブル位置に対応する機械座標系が実機械座標系であり、基準テーブル位置に対応する機械座標系が基準機械座標系である。基準機械座標系に対して実機械座標系は並進誤差(δx,δy,δz)と回転誤差(α,β,γ)を持っている。回転軸B、C軸によって工具10が傾斜しており、工具長補正ベクトルT(Tx,Ty,Tz) Tも工具10の傾斜に応じた値を持っている。
図2は、本発明の数値制御装置が制御対象とする工具ヘッド回転型機械における本発明の動作原理説明図である。この工具ヘッド回転型機械は、直線軸のX、Y、Z軸と工具10をY軸周りに回転させる回転軸のB軸と、Z軸周りに回転させる回転軸のC軸を備えるものである。ここで、被加工物を取り付けるテーブル12の実テーブル位置が基準テーブル位置に対して誤差を持っている。実テーブル位置に対応する機械座標系が実機械座標系であり、基準テーブル位置に対応する機械座標系が基準機械座標系である。基準機械座標系に対して実機械座標系は並進誤差(δx,δy,δz)と回転誤差(α,β,γ)を持っている。回転軸B、C軸によって工具10が傾斜しており、工具長補正ベクトルT(Tx,Ty,Tz) Tも工具10の傾斜に応じた値を持っている。
この場合、基準機械座標系に対する実機械座標系の並進誤差(δx,δy,δz)と回転誤差(α,β,γ)が与えられ、現在の直線軸機械座標値Pm(Pmx, Pmy, Pmz) Tと現在の工具長補正ベクトルT(Tx,Ty,Tz) Tおよび実工具長補正ベクトル用誤差から式(5)又は式(8)によって工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tを求める。なお、工具ヘッド11における、B軸の回転中心軸とC軸の回転中心軸が交差する点が直線軸機械座標位置Pm(Pmx, Pmy, Pmz) Tである。
そして式(6)によって直線軸修正機械座標位置Pm’(Pmx',Pmy',Pmz')Tを求めその位置へ各直線軸を駆動する。又、回転軸のB軸、C軸は指令された回転位置に駆動する。このことにより、基準機械座標系上の工具先端点位置Pt(Ptx,Pty,Ptz) Tと実機械座標系上の工具先端点位置Pt'(Ptx' ,Pty' ,Ptz') Tが等しくなる。その結果、実テーブル12上に設置された被加工物に対して工具先端点(加工点)における高精度な加工を行うことができる。
なお、工具先端点位置の補正量は、補間周期毎に求めてもよいものであるが、前記並進誤差(δx,δy,δz)及び回転誤差(α,β,γ)は変更可能とし変更前と変更後の前記並進誤差(δx,δy,δz)及び回転誤差(α,β,γ)の差を求め、その変更前と変更後の前記並進誤差(δx,δy,δz)及び回転誤差(α,β,γ)の差が設定された誤差基準値よりも大きい場合に前記工具先端点位置の補正量を求め更新するようにすることも可能である。
また、回数を設定し、設定された補間周期回数毎に前記工具先端点位置の補正量を求め更新するようにしてもよいものである。
また、回数を設定し、設定された補間周期回数毎に前記工具先端点位置の補正量を求め更新するようにしてもよいものである。
図3は、本発明の数値制御装置が制御対象とするテーブル回転型機械おける本発明の動作原理説明図である。このテーブル回転型機械は、直線軸としてX、Y、Z軸を備え、被加工物が取り付けられるテーブル12をX軸周りに回転させる回転軸A軸とZ軸周りに回転させる回転軸C軸とを備えるものである。この例においても、実テーブル位置が基準テーブル位置に対して誤差を持っている。実テーブル位置に対応する機械座標系が実機械座標系であり、基準テーブル位置に対応する機械座標系が基準機械座標系である。基準機械座標系に対して実機械座標系は並進誤差(δx,δy,δz)と回転誤差(α,β,γ)を持っている。工具は傾斜しないため、工具長補正ベクトルT(Tx,Ty,Tz) TについてTzのみ0でない値を持ちTx、Tyは0である。
この場合、基準機械座標系に対する実機械座標系の並進誤差(δx,δy,δz)と回転誤差(α,β,γ)が与えられ、現在の機械座標値Pm(Pmx, Pmy, Pmz) Tと現在の工具長補正ベクトルT(Tx,Ty,Tz)Tおよび実工具長補正ベクトル用誤差から、式(5)又は式(8)によって工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tを求める。そして式(6)によって修正機械座標値Pm’(Pmx',Pmy',Pmz') Tを求め、その位置へ各直線軸X、Y、Z軸を駆動する。又、回転軸のC軸、A軸は、指令された回転位置に駆動する。そのことにより、基準機械座標系上の工具先端点位置Pt(Ptx,Pty,Ptz) Tと実機械座標系上の工具先端点位置Pt'(Ptx' ,Pty' ,Ptz') Tが等しくなる。その結果、実テーブル12上に設置された被加工物に対して工具先端点(加工点)における高精度な加工を行うことができる。
図4は、本発明の数値制御装置が制御対象とする混合型機械おける本発明の動作原理説明図である。この混合型機械は、X、Y、Z軸の直線軸と被加工物が取り付けられるテーブル12をZ軸周りに回転させる回転軸C軸と工具10をY軸周りに回転させる回転軸B軸とを備えたものである。
テーブル12の実テーブル位置が基準テーブル位置に対して誤差を持っている。実テーブル位置に対応する機械座標系が実機械座標系であり、基準テーブル位置に対応する機械座標系が基準機械座標系である。基準機械座標系に対して実機械座標系は並進誤差(δx,δy,δz)と回転誤差(α,β,γ)を持っている。工具10はY軸回りの回転軸B軸で傾斜するため、工具長補正ベクトルT(Tx,Ty,Tz)TについてTx,Tzは0でない値を持ちTyは0である。
テーブル12の実テーブル位置が基準テーブル位置に対して誤差を持っている。実テーブル位置に対応する機械座標系が実機械座標系であり、基準テーブル位置に対応する機械座標系が基準機械座標系である。基準機械座標系に対して実機械座標系は並進誤差(δx,δy,δz)と回転誤差(α,β,γ)を持っている。工具10はY軸回りの回転軸B軸で傾斜するため、工具長補正ベクトルT(Tx,Ty,Tz)TについてTx,Tzは0でない値を持ちTyは0である。
この場合、基準機械座標系に対する実機械座標系の並進誤差(δx,δy,δz)と回転誤差(α,β,γ)が与えられ、現在の直線軸機械座標位置Pm(Pmx,Pmy,Pmz) Tと現在の工具長補正ベクトルT(Tx,Ty,Tz) T および実工具長補正ベクトル用誤差から、式(5)又は式(8)によって工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tを求める。そして式(6)によって直線軸修正機械座標位置Pm’(Pmx',Pmy',Pmz') Tを求めその位置へ各直線軸X、Y、Z軸を駆動する。又、回転軸のC軸、A軸は、指令された回転位置に駆動する。そのことにより、基準機械座標系上の工具先端点位置と実機械座標系上の工具先端点位置が等しくなる。その結果、実テーブル上に設置された被加工物に対して工具先端点(加工点)における高精度な加工を行うことができる。
図14は、本発明の数値制御装置において実工具長補正ベクトルは並進誤差(Tδx,Tδy,Tδz)と回転誤差(Tα,Tβ,Tγ)から成る実工具長補正ベクトル用誤差によって前記基準工具長補正ベクトルから求める場合の動作原理説明図である。ここでは、基準機械座標系における工具ヘッド座標系を(Xt,Yt,Zt)座標で表すと実機械座標系では工具ヘッド座標系が(Xt’,Yt’,Zt’)座標となり、それらの座標系間の誤差が並進誤差(Tδx,Tδy,Tδz)と回転誤差(Tα,Tβ,Tγ)であることを示している。この場合、実工具長補正ベクトルT’(Tx’,Ty’,Tz’)Tは基準工具長補正ベクトルT(Tx,Ty,Tz)Tから次のように計算して求める。なお、図14では実施例として工具ヘッド回転型機械における工具ヘッドの図としている。したがって工具ヘッドには2軸の回転軸がある。
図14は、本発明の数値制御装置において実工具長補正ベクトルは並進誤差(Tδx,Tδy,Tδz)と回転誤差(Tα,Tβ,Tγ)から成る実工具長補正ベクトル用誤差によって前記基準工具長補正ベクトルから求める場合の動作原理説明図である。ここでは、基準機械座標系における工具ヘッド座標系を(Xt,Yt,Zt)座標で表すと実機械座標系では工具ヘッド座標系が(Xt’,Yt’,Zt’)座標となり、それらの座標系間の誤差が並進誤差(Tδx,Tδy,Tδz)と回転誤差(Tα,Tβ,Tγ)であることを示している。この場合、実工具長補正ベクトルT’(Tx’,Ty’,Tz’)Tは基準工具長補正ベクトルT(Tx,Ty,Tz)Tから次のように計算して求める。なお、図14では実施例として工具ヘッド回転型機械における工具ヘッドの図としている。したがって工具ヘッドには2軸の回転軸がある。
図5は、本発明の第1の実施形態の数値制御装置の要部ブロック図である。この第1の実施形態は、図9に示した工具長補正指令により数値制御を実行する数値制御装置の例であり、図9と比較し、補正手段5にデータを入力する入力データ部7が追加されている点で相違する。
又、図6は、本発明の第2の実施形態の数値制御装置の要部ブロック図である。この第2の実施形態は、図10に示した工具先端点制御により数値制御を実行する数値制御装置の例であり、図10と比較し、補正手段5にデータを入力する入力データ部7が追加されている点で相違する。
又、図6は、本発明の第2の実施形態の数値制御装置の要部ブロック図である。この第2の実施形態は、図10に示した工具先端点制御により数値制御を実行する数値制御装置の例であり、図10と比較し、補正手段5にデータを入力する入力データ部7が追加されている点で相違する。
この入力データ部7は、基準機械座標系に対する実機械座標系の並進誤差(δx,δy,δz)と回転誤差(α,β,γ)、工具長補正ベクトルT(Tx,Ty,Tz) T、さらには、工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tを更新するタイミングを決める誤差基準値、補間周期回数を補正手段5に入力するものである。ここで、工具長補正ベクトルが基準機械座標系ではプログラムで指令された基準工具長補正ベクトルT(Tx,Ty,Tz) Tだが実機械座標系では誤差を持った実工具長補正ベクトルT'(Tx',Ty',Tz' )Tである場合、前記工具長補正ベクトルT(Tx,Ty,Tz)Tに対しては基準工具長補正ベクトルT(Tx,Ty,Tz)Tと実工具長補正ベクトルT'(Tx',Ty',Tz' )T用誤差を補正手段5に入力するものである。
基準機械座標系に対する実機械座標系の並進誤差(δx,δy,δz)と回転誤差(α,β,γ)および実工具長補正ベクトル用誤差は、予め機械座標位置に対応して求められており、加工を開始する際には、数値制御装置のメモリに格納されている。又、工具長補正ベクトルT(Tx,Ty,Tz)Tは指令解析処理、補間処理を行うときに従来から求められており、これを利用する。図5に示す第1の実施形態においては、指令解析部1で工具先端点位置に工具長補正ベクトルT(Tx,Ty,Tz)Tを加算する演算を従来から行っており、この処理で求められた工具長補正ベクトルT(Tx,Ty,Tz)Tを利用する。又、図6に示す第2の実施形態は、補間手段3で補間された工具先端点位置に対して工具長補正ベクトルT(Tx,Ty,Tz)Tを加算する処理を従来から行っており、この処理で求められた工具長補正ベクトルT(Tx,Ty,Tz)Tを利用する。
さらに、並進誤差(δx,δy,δz)と回転誤差(α,β,γ)および実工具長補正ベクトル用誤差は、前記のように加工を開始する際に数値制御装置のメモリに格納されている場合以外にも、図12のようにパーソナルコンピュータなどの数値制御装置外の装置から加工状況に応じて通信回線を通じて数値制御装置のインタフェースメモリに格納されるように数値制御装置外から与えられる場合もある。
さらに、並進誤差(δx,δy,δz)と回転誤差(α,β,γ)および実工具長補正ベクトル用誤差は、前記のように加工を開始する際に数値制御装置のメモリに格納されている場合以外にも、図12のようにパーソナルコンピュータなどの数値制御装置外の装置から加工状況に応じて通信回線を通じて数値制御装置のインタフェースメモリに格納されるように数値制御装置外から与えられる場合もある。
又、工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tを更新するタイミングを決める誤差基準値、補間周期回数は予め設定しておく。この補正量ΔD(ΔX,ΔY,ΔZ)Tの更新は、移動指令が出力される補間周期毎に行ってもよいものであるが、並進誤差や回転誤差は大きな値になるものではないことから、これらを補正する補正量ΔD(ΔX,ΔY,ΔZ)Tを必ずしも補間周期毎に更新する必要がないことから、この更新タイミングを設定するものである。
誤差基準値を設定したときは、入力された並進誤差(δx,δy,δz)と記憶する並進誤差(δx,δy,δz)の差、又は入力された回転誤差(α,β,γ)と記憶する回転誤差(α,β,γ)の差が設定した誤差基準値を超えたとき、工具先端点位置を補正する補正量ΔD(ΔX,ΔY,ΔZ)Tを更新するものであり、補正量ΔD(ΔX,ΔY,ΔZ)Tを更新させるため誤差基準値を設定するものである。
又、補間周期回数は、工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tを更新するタイミングを補間周期数で設定するものであり、この補間周期回数を「1」と設定すれば、補間周期毎に補正量ΔD(ΔX,ΔY,ΔZ)Tの更新がなされ、「n」と設定すれば、補間周期n回毎に補正量ΔD(ΔX,ΔY,ΔZ)Tの更新がなされるように設定するものである。
又、補間周期回数は、工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tを更新するタイミングを補間周期数で設定するものであり、この補間周期回数を「1」と設定すれば、補間周期毎に補正量ΔD(ΔX,ΔY,ΔZ)Tの更新がなされ、「n」と設定すれば、補間周期n回毎に補正量ΔD(ΔX,ΔY,ΔZ)Tの更新がなされるように設定するものである。
図5に示す第1の実施形態の場合、プログラムのブロックを指令解析部1で解析し、この解析結果の工具先端点位置の指令位置に対して、工具長補正ベクトル加算要素2により工具長補正ベクトルT(Tx,Ty,Tz) Tを加算し、工具長補正ベクトルが加算された直線軸機械座標位置Pm(Pmx,Pmy,Pmz) Tを求める。該直線軸機械座標位置Pm(Pmx,Pmy,Pmz) T及び指令された回転軸の回転位置に対して補間手段3で補間を行い各軸の機械座標位置を生成し、各軸(X、Y、Z、B(A)、C軸)の加減速処理部4x、4y、4z、4b(a)、4cでそれぞれ加減速を行い、この各軸の加減速処理終了後の直線軸の指令機械座標位置Pm(Pmx,Pmy,Pmz)Tに対して補正手段5で誤差補正処理を実行し、修正された直線軸機械座標位置Pm’(Pmx',Pmy',Pmz')Tを求めて、各直線軸X、Y、Z軸は、この直線軸機械座標位置Pm’(Pmx',Pmy',Pmz')Tに、回転軸B(A)軸、C軸は加減速処理終了後の指令回転位置に各軸のサーボモータ6x、6y、6z、6b(a)、6cを駆動する。
また、図6に示す第2の実施形態の場合は、指令解析部1でプログラムのブロックを解析しこの解析結果の指令工具先端点位置を補間手段3で補間を行い補間された工具先端点位置に対して工具長補正ベクトル加算要素2により工具長補正ベクトルT(Tx,Ty,Tz)Tを加算し、直線軸機械座標位置Pm(Pmx,Pmy,Pmz)Tを生成し、該直線軸機械座標位置Pm(Pmx,Pmy,Pmz)T及び補間された回転軸の回転位置を各加減速処理部4x〜4cでそれぞれ加減速を行った後、直線軸機械座標位置Pm(Pmx,Pmy,Pmz)Tに対して補正手段5で誤差補正処理を実行し、修正された機械座標位置Pm’(Pmx',Pmy',Pmz')Tを求めて各軸のサーボモータ6x、6y、6z、6b(a)、6cを駆動する。なお、回転軸のB(A)軸、C軸に対しては、加減速処理部4b(a)、4cから出力される加減速処理後の指令位置がそのまま出力される。
図7は、上述した第1、第2の実施形態において、補正手段5で実行する基準機械座標系に対する実機械座標系の誤差を補正する誤差補正処理のアルゴリズムを示すフローチャートである。なお、このフローチャートでは設定された誤差基準値(δx0,δy0,δz0)、(α0,β0,γ0)に基づいて補正量ΔD(ΔX,ΔY,ΔZ)Tの更新を行うものとしている。
数値制御装置のプロセッサは、補間周期毎にこの図7に示す処理を実行する。
まず、プログラムで指令された工具先端点位置に対する並進誤差(δx,δy,δz)と回転誤差(α,β,γ)および実工具長補正ベクトル用誤差を読み出し、又、レジスタに記憶されている工具長補正ベクトルT(Tx,Ty,Tz)Tを読み出す(ステップS1)。次に、工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tを更新するか否かの判断処理を行う(ステップS2)。この実施形態では、設定された誤差基準値(δx0,δy0,δz0)、(α0,β0,γ0)に基づいて、この判断を行うものとしており、まず、ステップS1で読み取った並進誤差(δx,δy,δz)から、レジスタに記憶する並進誤差(δxp,δyp,δzp)を差し引き、その各要素の絶対値が設定された並進誤差の各基準値(δx0,δy0,δz0)を超えているか判断する。又、ステップS1で読み取った回転誤差(α,β,γ)から、レジスタに記憶する回転誤差(αp,βp,γp)を差し引き、その各要素の絶対値が、設定された回転誤差の各基準値(α0,β0,γ0)を超えているか判断する。この並進誤差又は回転誤差の差の要素のいずれかがそれぞれの設定基準値を超えていれば、工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tの更新を行うとしてステップS3に進む。又、いずれもそれぞれの設定基準値を超えていなければステップS5に進む。
なお、レジスタに記憶される並進誤差(δxp,δyp,δzp)、回転誤差(αp,βp,γp)は、加工開始の初期設定で最初は「0」が記憶されている。又、レジスタに記憶する工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tも、最初は初期設定で「0」が記憶されている。
まず、プログラムで指令された工具先端点位置に対する並進誤差(δx,δy,δz)と回転誤差(α,β,γ)および実工具長補正ベクトル用誤差を読み出し、又、レジスタに記憶されている工具長補正ベクトルT(Tx,Ty,Tz)Tを読み出す(ステップS1)。次に、工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tを更新するか否かの判断処理を行う(ステップS2)。この実施形態では、設定された誤差基準値(δx0,δy0,δz0)、(α0,β0,γ0)に基づいて、この判断を行うものとしており、まず、ステップS1で読み取った並進誤差(δx,δy,δz)から、レジスタに記憶する並進誤差(δxp,δyp,δzp)を差し引き、その各要素の絶対値が設定された並進誤差の各基準値(δx0,δy0,δz0)を超えているか判断する。又、ステップS1で読み取った回転誤差(α,β,γ)から、レジスタに記憶する回転誤差(αp,βp,γp)を差し引き、その各要素の絶対値が、設定された回転誤差の各基準値(α0,β0,γ0)を超えているか判断する。この並進誤差又は回転誤差の差の要素のいずれかがそれぞれの設定基準値を超えていれば、工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tの更新を行うとしてステップS3に進む。又、いずれもそれぞれの設定基準値を超えていなければステップS5に進む。
なお、レジスタに記憶される並進誤差(δxp,δyp,δzp)、回転誤差(αp,βp,γp)は、加工開始の初期設定で最初は「0」が記憶されている。又、レジスタに記憶する工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tも、最初は初期設定で「0」が記憶されている。
ステップS2で、「No」の場合、すなわち、並進誤差の差も回転誤差の差のいずれかもそれぞれの設定基準値を超えてないときには、ステップS5に進み、、各軸(X、Y、Z、B(A)、C軸)の加減速処理部4x、4y、4zで加減速処理された直線軸機械座標位置Pm(Pmx,Pmy,Pmz)Tと、レジスタに記憶する工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tに基づいて、式(6)の演算を行って、直線軸修正機械座標位置Pm’(Pmx',Pmy',Pmz')Tを求める(ステップS5)。そして、該直線軸修正機械座標位置Pm’(Pmx',Pmy',Pmz')Tを出力してX、Y、Z軸のサーボモータ6x、6y、6zを駆動する。又、回転軸のB(A)軸、C軸に対しては、加減速処理部4b(a)、4cから出力される加減速処理後の指令位置がそのまま出力し、回転軸のサーボモータ6b(a)、6cを駆動する。
一方、ステップS2で、「Yes」のとき、すなわち、並進誤差の差もしくは回転誤差の差、のいずれかがその設定基準値を超えているときには、ステップS1で読み込んだ並進誤差(δx,δy,δz)、回転誤差(α,β,γ)を、ステップS2での誤差の変化を判断するために、前回変更時の並進誤差(δxp,δyp,δzp)、回転誤差(αp,βp,γp)として、レジスタに記憶し更新する(ステップS3)。
次に、加減速処理された直線軸機械座標位置Pm(Pmx,Pmy,Pmz)TとステップS1で読み込んだ工具先端点位置に対する並進誤差(δx,δy,δz)、回転誤差(α,β,γ)、工具長補正ベクトルT(Tx,Ty,Tz)T および実工具長補正ベクトル用誤差により、式(5)又は式(8)の演算を行って、工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tを求め、レジスタに格納しこの補正量ΔD(ΔX,ΔY,ΔZ)Tを更新する(ステップS4)。その後、ステップS5に移行し、前述したステップS5の処理を実行する。
以上のように、並進誤差の差及び回転誤差の差がいずれもその設定基準値を超えないときは、ステップS1、S2、S5の処理がなされて、レジスタに記憶されている工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tに基づいて、式(6)の演算がなされて直線軸修正機械座標位置Pm’(Pmx',Pmy',Pmz')Tが求められて出力され、X、Y、Z軸のサーボモータ6x、6y、6zが駆動されることになる。又、回転軸B、A、C軸は、加減速処理された指令回転位置がそのまま出力されて、それぞれの回転軸のサーボモータ6b、6a、6cが駆動されることになる。又、並進誤差の差(変化量)又は回転誤差の差(変化量)、のいずれかがその設定基準値を超える毎に、ステップS1、S2、S3〜S5の処理がなされて工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tが更新され、この補正量ΔD(ΔX,ΔY,ΔZ)Tによって、直線軸修正機械座標位置Pm’(Pmx',Pmy',Pmz')Tが求められることになる。
なお、図7で示した例では、工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tが更新タイミングを並進誤差の差(変化量)又は回転誤差の差(変化量)がその設定基準値を超えた補間周期としたが、補間周期毎に、工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tを更新するものとしたときは、ステップS2、S3の処理がなくなりステップS1からステップS4に移行するようにすればよい。又、設定補間周期数毎に工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tを更新するものとしたときは、ステップS2、S3の代わりに、補間周期を計数するカウンタ(1インクリメントするカウンタ)を設け、該カウンタの値が設定値以上か判断し、設定値以上になったとき、該カウンタを「0」にクリアして、ステップS4に移行し、ステップS4、ステップS5の処理を実行させ、カウンタが設定値まで達していないときには、ステップS4の処理は実行せず、ステップS5の処理だけを実行するようにすればよいものである。
さらに、ステップS2では,実工具補正ベクトル用誤差についても判断を行うことも可能である。例えば実工具補正ベクトル用誤差が工具方向誤差(ΔTa)と工具直角方向誤差(ΔTrx,ΔTry)から成る場合、図7のステップS2でNOと判断されると、さらに設定された工具方向誤差基準値(ΔTa0)と工具直角方向誤差基準値(ΔTrx0,Δtry0)に基づいて判断を行う。まず、ステップS1で読み取った工具方向誤差(ΔTa)からレジスタに記憶する工具方向誤差(ΔTap)を差し引き、その要素の絶対値が設定された工具方向誤差基準値(ΔTa0)を超えているか判断する。又、ステップS1で読み取った工具直角方向誤差(ΔTrx,ΔTry)からレジスタに記憶する工具直角方向誤差(ΔTrxp,ΔTryp)を差し引きその各要素の絶対値が設定された工具直角方向誤差基準値(ΔTrx0,ΔTry0)を超えているか判断する。この工具方向誤差と工具直角方向誤差の差の要素のいずれかがそれぞれの設定基準値を超えていれば、ステップS5に進むのでなく工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tの更新を行うとしてステップS3に進む。又、いずれもそれぞれの設定基準値を超えていなければステップS5に進む。又、ステップS3では、今回の工具方向誤差(ΔTa)と工具直角方向誤差(ΔTrx,ΔTry)をレジスタΔTap、レジスタΔTrxpおよびΔTrypに記憶する。
さらに、ステップS2では,実工具補正ベクトル用誤差についても判断を行うことも可能である。例えば実工具補正ベクトル用誤差が工具方向誤差(ΔTa)と工具直角方向誤差(ΔTrx,ΔTry)から成る場合、図7のステップS2でNOと判断されると、さらに設定された工具方向誤差基準値(ΔTa0)と工具直角方向誤差基準値(ΔTrx0,Δtry0)に基づいて判断を行う。まず、ステップS1で読み取った工具方向誤差(ΔTa)からレジスタに記憶する工具方向誤差(ΔTap)を差し引き、その要素の絶対値が設定された工具方向誤差基準値(ΔTa0)を超えているか判断する。又、ステップS1で読み取った工具直角方向誤差(ΔTrx,ΔTry)からレジスタに記憶する工具直角方向誤差(ΔTrxp,ΔTryp)を差し引きその各要素の絶対値が設定された工具直角方向誤差基準値(ΔTrx0,ΔTry0)を超えているか判断する。この工具方向誤差と工具直角方向誤差の差の要素のいずれかがそれぞれの設定基準値を超えていれば、ステップS5に進むのでなく工具先端点位置の補正量ΔD(ΔX,ΔY,ΔZ)Tの更新を行うとしてステップS3に進む。又、いずれもそれぞれの設定基準値を超えていなければステップS5に進む。又、ステップS3では、今回の工具方向誤差(ΔTa)と工具直角方向誤差(ΔTrx,ΔTry)をレジスタΔTap、レジスタΔTrxpおよびΔTrypに記憶する。
1 指令解析部
2 工具長補正ベクトル加算要素
3 補間手段
4x〜4c 加減速処理部
5 補正手段
6x〜6c サーボモータ
7 入力データ部
10 工具
11 工具ヘッド
12 テーブル
2 工具長補正ベクトル加算要素
3 補間手段
4x〜4c 加減速処理部
5 補正手段
6x〜6c サーボモータ
7 入力データ部
10 工具
11 工具ヘッド
12 テーブル
Claims (9)
- テーブルに取付られた被加工物に対して直線軸3軸と回転軸2軸によって加工する5軸加工機を制御する数値制御装置において、
与えられた基準機械座標系に対する実機械座標系の並進誤差(δx,δy,δz)と回転誤差(α,β,γ)と、直線軸機械座標位置及び工具長補正ベクトルから工具先端点位置の補正量(ΔX,ΔY,ΔZ)Tを求める補正量算出手段と、前記補正量(ΔX,ΔY,ΔZ)Tに基づいて直線軸修正機械座標位置を求める補正手段と、各直線軸は前記直線軸修正機械座標位置へ、各回転軸は指令された回転位置に駆動する手段を有する数値制御装置。 - 前記補正量算出手段は、補間周期毎に前記工具先端点位置の補正量を求める請求項1記載の数値制御装置。
- 補間周期において前記工具先端点位置の補正量を求める周期かどうか判断する判断手段を有し、前記判断手段において工具先端点位置の補正量を求めると判断した周期において前記補正量算出手段は前記工具先端点位置の補正量を求めて更新記憶し、前記補正手段は、記憶した補正量に基づいて補間周期毎に前記直線軸修正機械座標位置を求める請求項1記載の数値制御装置。
- 並進誤差(δx,δy,δz)及び回転誤差(α,β,γ)の誤差基準値を設定する手段を有し、前記並進誤差(δx,δy,δz)及び回転誤差(α,β,γ)は変更可能とし、変更前と変更後の前記並進誤差(δx,δy,δz)及び回転誤差(α,β,γ)の差を求める手段を有し、前記判断手段は、変更前と変更後の前記並進誤差(δx,δy,δz)又は回転誤差(α,β,γ)の差が該設定された誤差基準値よりも大きい場合に前記工具先端点位置の補正量を求める周期と判断する請求項3記載の数値制御装置。
- 補間周期回数を設定する手段を有し、前記判断手段は該設定された補間周期回数毎に前記工具先端点位置の補正量を求める周期と判断する請求項3記載の数値制御装置。
- 前記工具長補正ベクトルは前記基準機械座標系で指令された基準工具長補正ベクトルT(Tx,Ty,Tz)Tと前記実機械座標系での実工具長補正ベクトルT'(Tx',Ty',Tz') Tとする請求項1乃至請求項5記載の数値制御装置。
- 前記実工具長補正ベクトルは並進誤差(Tδx,Tδy,Tδz)と回転誤差(Tα,Tβ,Tγ)から成る実工具長補正ベクトル用誤差によって前記基準工具長補正ベクトルから求める請求項6記載の数値制御装置。
- 前記実工具長補正ベクトルは工具方向誤差(ΔTa)と工具直角方向誤差(ΔTrx,ΔTry)から成る実工具長補正ベクトル用誤差によって前記基準工具長補正ベクトルから求める請求項6記載の数値制御装置。
- 前記実工具長補正ベクトルは直線軸方向誤差(ΔTz,ΔTx,ΔTy)Tから成る実工具長補正ベクトル用誤差によって前記基準工具長補正ベクトルから求める請求項6記載の数値制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007168825A JP2009009274A (ja) | 2007-06-27 | 2007-06-27 | 数値制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007168825A JP2009009274A (ja) | 2007-06-27 | 2007-06-27 | 数値制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2009009274A true JP2009009274A (ja) | 2009-01-15 |
Family
ID=40324311
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007168825A Pending JP2009009274A (ja) | 2007-06-27 | 2007-06-27 | 数値制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2009009274A (ja) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011100266A (ja) * | 2009-11-05 | 2011-05-19 | Mitsubishi Electric Corp | 数値制御装置 |
WO2011104757A1 (ja) * | 2010-02-25 | 2011-09-01 | 三菱電機株式会社 | 数値制御装置 |
JP2012043243A (ja) * | 2010-08-20 | 2012-03-01 | Fanuc Ltd | 工具先端点位置を制御する多軸加工機用数値制御装置 |
US8350514B2 (en) | 2010-06-30 | 2013-01-08 | Fanuc Corporation | Numerical controller for multi-axis machine |
JP2014074956A (ja) * | 2012-10-02 | 2014-04-24 | Fanuc Ltd | 並進回転誤差補正量作成装置 |
CN110977978A (zh) * | 2019-12-13 | 2020-04-10 | 易思维(杭州)科技有限公司 | 车门装配沉降补偿的示教方法 |
CN113917888A (zh) * | 2021-10-27 | 2022-01-11 | 中国航发沈阳黎明航空发动机有限责任公司 | 一种基于固定角向标定及补偿的加工精度提升方法 |
CN114322765A (zh) * | 2021-12-27 | 2022-04-12 | 科德数控股份有限公司 | 一种通过坐标系旋转方式的刀具测量方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001269839A (ja) * | 2000-03-23 | 2001-10-02 | Toshiba Mach Co Ltd | 多軸工作機械の主軸頭位置誤差補正方法 |
JP2004272887A (ja) * | 2003-02-19 | 2004-09-30 | Fanuc Ltd | 数値制御装置及び数値制御方法 |
JP2005059102A (ja) * | 2003-08-08 | 2005-03-10 | Toyoda Mach Works Ltd | 数値制御装置及びncデータ作成装置 |
-
2007
- 2007-06-27 JP JP2007168825A patent/JP2009009274A/ja active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001269839A (ja) * | 2000-03-23 | 2001-10-02 | Toshiba Mach Co Ltd | 多軸工作機械の主軸頭位置誤差補正方法 |
JP2004272887A (ja) * | 2003-02-19 | 2004-09-30 | Fanuc Ltd | 数値制御装置及び数値制御方法 |
JP2005059102A (ja) * | 2003-08-08 | 2005-03-10 | Toyoda Mach Works Ltd | 数値制御装置及びncデータ作成装置 |
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011100266A (ja) * | 2009-11-05 | 2011-05-19 | Mitsubishi Electric Corp | 数値制御装置 |
WO2011104757A1 (ja) * | 2010-02-25 | 2011-09-01 | 三菱電機株式会社 | 数値制御装置 |
CN102782598B (zh) * | 2010-02-25 | 2014-11-12 | 三菱电机株式会社 | 数控装置 |
CN102782598A (zh) * | 2010-02-25 | 2012-11-14 | 三菱电机株式会社 | 数控装置 |
JP5105024B2 (ja) * | 2010-02-25 | 2012-12-19 | 三菱電機株式会社 | 数値制御装置 |
US8350514B2 (en) | 2010-06-30 | 2013-01-08 | Fanuc Corporation | Numerical controller for multi-axis machine |
CN102402199B (zh) * | 2010-08-20 | 2014-08-27 | 发那科株式会社 | 控制刀具前端点位置的多轴加工机用数值控制装置 |
CN102402199A (zh) * | 2010-08-20 | 2012-04-04 | 发那科株式会社 | 控制刀具前端点位置的多轴加工机用数值控制装置 |
JP2012043243A (ja) * | 2010-08-20 | 2012-03-01 | Fanuc Ltd | 工具先端点位置を制御する多軸加工機用数値制御装置 |
DE102011110111B4 (de) * | 2010-08-20 | 2017-06-14 | Fanuc Corporation | Numerische Steuerung einer mehrachsigen Werkzeugmaschine für das Steuern der Lage der Tool Center Point Position |
JP2014074956A (ja) * | 2012-10-02 | 2014-04-24 | Fanuc Ltd | 並進回転誤差補正量作成装置 |
US9448551B2 (en) | 2012-10-02 | 2016-09-20 | Fanuc Corporation | Translation/rotation error compensation amount creating device |
CN110977978A (zh) * | 2019-12-13 | 2020-04-10 | 易思维(杭州)科技有限公司 | 车门装配沉降补偿的示教方法 |
CN110977978B (zh) * | 2019-12-13 | 2021-09-21 | 易思维(杭州)科技有限公司 | 车门装配沉降补偿的示教方法 |
CN113917888A (zh) * | 2021-10-27 | 2022-01-11 | 中国航发沈阳黎明航空发动机有限责任公司 | 一种基于固定角向标定及补偿的加工精度提升方法 |
CN113917888B (zh) * | 2021-10-27 | 2023-05-23 | 中国航发沈阳黎明航空发动机有限责任公司 | 一种基于固定角向标定及补偿的加工精度提升方法 |
CN114322765A (zh) * | 2021-12-27 | 2022-04-12 | 科德数控股份有限公司 | 一种通过坐标系旋转方式的刀具测量方法 |
CN114322765B (zh) * | 2021-12-27 | 2023-09-26 | 科德数控股份有限公司 | 一种通过坐标系旋转方式的刀具测量方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2009009274A (ja) | 数値制御装置 | |
JP5399624B2 (ja) | 数値制御方法及び数値制御装置 | |
JP4291386B2 (ja) | ワーク設置誤差補正手段を有する数値制御装置 | |
JP3703664B2 (ja) | バックラッシ補正装置 | |
JP5221724B2 (ja) | ワーク設置誤差補正部を有する多軸工作機械用数値制御装置 | |
JP5426153B2 (ja) | 回転軸を有する工作機械用の数値制御装置 | |
JP6942577B2 (ja) | 工作機械の数値制御装置及び数値制御方法 | |
JP6450732B2 (ja) | 数値制御装置 | |
JP2006065716A (ja) | 変形誤差の補正方法 | |
JP2012248098A (ja) | 機械の誤差補償値計算方法 | |
KR19980080106A (ko) | 수치제어장치 | |
JP2002263973A (ja) | 工作機械 | |
EP1775065B1 (en) | Roundness working method and roundness working device in nc machine tool | |
US6539274B1 (en) | Method for compensating for temperature-related dimensional deviations in machine geometry | |
JP2628924B2 (ja) | 数値制御装置のギヤピッチ誤差補正方式 | |
JP5788260B2 (ja) | 誤差補正部を備えた数値制御装置 | |
JP2016038674A (ja) | 工作機械の補正値演算方法及び補正値演算プログラム | |
JP4356857B2 (ja) | 多軸nc研磨加工機 | |
JP2787872B2 (ja) | 数値制御装置 | |
JP4734439B2 (ja) | 4軸加工機用数値制御装置 | |
JP7278507B1 (ja) | 数値制御装置、数値制御工作機械、加工プログラム生成装置および加工プログラム生成方法 | |
JP6985563B1 (ja) | 数値制御装置 | |
JP7445006B2 (ja) | 表示装置 | |
JPH05169351A (ja) | 工作機械の熱変位補正方法 | |
JP2000099156A (ja) | 位置制御装置および位置制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090210 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20090623 |