JP6435962B2 - 制御装置、工作機械及びコンピュータプログラム - Google Patents

Description

本発明は、工具を装着する主軸の移動を制御する制御装置、工作機械及びコンピュータプログラムに関する。

工作機械は、工具を装着する主軸の移動を制御する制御装置を備える。制御装置は、主軸の位置を指示する複数の指令点を設定し、加工経路を設定する。主軸に装着した工具が３次元の曲面をワークに形成する場合、制御装置は指令点間の微小線分が連続した複数の曲線を演算し、生成する。

例えば前後方向及び左右方向に平行な面（水平面）上に複数の曲線を生成する。複数の曲線は前後方向又は左右方向に並ぶ。制御装置は各曲線に上下方向の位置を設定する。また制御装置は、微小線分の繋ぎ目にて尖った部分が表れるので、スプライン曲線、ベジェ曲線等の滑らかな曲線に基づいて、生成した曲線を補間する。設定された各上下位置にて、補間した曲線に沿って主軸は移動し、ワークを加工する（例えば特許文献１参照）。

特許第３４６６１１１号公報

しかし上述した補間を行っても、隣り合う曲線の傾きの差、制御装置での演算にて発生する量子化誤差等によって、ワーク表面に鱗状の模様が表れる。特許文献１は指令点を修正することなく、指令点間に滑らかな線となるように指令点を挿入している。従って、指令点そのものが誤っているにも関わらず、指令点を通ることになり、上述したワーク表面に鱗状の模様が表れるという問題があった。

本発明は斯かる事情に鑑みてなされたものであり、ワークに滑らかな曲面を形成することができる制御装置、工作機械及びコンピュータプログラムを提供することを目的とする。

本発明に係る制御装置は、主軸の位置を指示する複数の指令点に基づいた加工経路を設定し、前記加工経路に基づいて、前記主軸の移動を制御する制御装置において、前記加工経路に交差する評価断面を設定する設定部と、該設定部が設定した評価断面及び前記加工経路の交点を演算する演算部と、該演算部が演算した交点の位置を修正する交点位置修正部と、該交点位置修正部が修正した交点に基づいて、前記加工経路に交差する方向における前記指令点の位置を修正する指令点位置修正部とを備えることを特徴とする。

本発明に係る制御装置は、前記交点位置修正部は、修正の対象である交点を線形補間することを特徴とする。

本発明に係る制御装置は、前記交点位置修正部は、修正の対象である交点の周囲にある複数の他の交点を用いて曲線を設定し、設定した曲線上に、修正の対象である前記交点を投影することを特徴とする。

本発明に係る制御装置は、前記指令点位置修正部は、前記交点位置修正部が修正した複数の交点を通る第２曲線を設定し、設定した第２曲線上に、修正の対象である前記指令点を投影することを特徴とする。

本発明に係る工作機械は、上述した何れか一つの制御装置と、前記主軸とを備えることを特徴とする。

本発明に係るコンピュータプログラムは、加工プログラムに従って、主軸の位置を指示する複数の指令点に基づいた加工経路を設定し、前記加工経路に基づいて、前記主軸の移動を制御する制御装置で実行可能なコンピュータプログラムにおいて、前記制御装置を、前記加工経路に交差する評価断面を設定する設定部、該設定部が設定した評価断面及び前記加工経路の交点を演算する演算部、該演算部が演算した交点の位置を修正する交点位置修正部、及び該交点位置修正部が修正した交点に基づいて、前記加工経路に交差する方向における前記指令点の位置を修正する指令点位置修正部として機能させることを特徴とする。

本発明においては、加工経路に交差する評価断面を設定し、評価断面と加工経路の交点の位置を修正し、修正した交点の位置に基づいて、前記加工経路に交差する方向における指令点の位置を修正する。

本発明においては、修正の対象である交点を線形補間する。

本発明においては、修正の対象である交点を曲線（スプライン曲線、ベジェ曲線等）によって、補間する。

本発明においては、修正の対象である指令点を曲線（スプライン曲線、ベジェ曲線等）によって、補間する。

本発明に係る制御装置、工作機械及びコンピュータプログラムにあっては、加工経路に交差する評価断面を設定し、評価断面と加工経路の交点の位置を修正し、修正した交点の位置に基づいて指令点の位置を修正する。加工経路に交差する方向においても、指令点の位置を修正することができるので、滑らかな曲面をワークに形成することができる。

実施の形態に係る工作機械を略示する斜視図である。 制御装置の構成を略示するブロック図である。 ワークに対する加工経路及び評価断面を略示する平面図である ワークに対する評価断面を略示する斜視図である。 指令点と、評価断面及び加工経路の交点とを略示する模式図である。 交点テーブルの一例を示す概念図である。 評価断面上における交点位置の第１の修正方法を説明する説明図である。 評価断面上における交点位置の第２の修正方法を説明する説明図である。 指令点の修正方法を説明する説明図である。 制御装置による加工経路設定処理を説明するフローチャートである。 変更例におけるワークに対する加工経路及び評価断面を略示する平面図である。

以下本発明を実施の形態に係る工作機械を示す図面に基づいて説明する。以下の説明では図において矢印で示す上下、左右及び前後を使用する。図１は工作機械を略示する斜視図である。

工作機械は前後に延びた矩形の基台１を備える。基台１上部の前側にワークを保持するワーク保持部３が設けてある。ワーク保持部３は左右方向を軸方向としたＡ軸及び上下方向を軸方向としたＣ軸回りに回転可能である。

基台１上部の後側に後述するコラム４を支持する為の支持台２が設けてある。支持台２上部に、前後方向に移動するＹ軸方向移動機構１０が設けてある。Ｙ軸方向移動機構１０は、前後に延びた二つのレール１１と、Ｙ軸螺子軸１２と、Ｙ軸モータ１３と、ベアリング１４とを備える。

レール１１は支持台２上部の左右夫々に設けてある。Ｙ軸螺子軸１２は前後に延び、二つのレール１１の間に設けてある。Ｙ軸螺子軸１２の前端部及び中途部夫々にベアリング１４が設けてある。なお中途部に設けたベアリングの図示は省略する。Ｙ軸モータ１３はＹ軸螺子軸１２の後端部に連結している。

Ｙ軸螺子軸１２には転動体（図示略）を介してナット（図示略）が螺合している。転動体は例えばボールである。各レール１１に複数の摺動子１５が摺動可能に設けてある。ナット及び摺動子１５の上部に移動板１６が連結している。移動板１６は水平方向に延びる。Ｙ軸モータ１３の回転によってＹ軸螺子軸１２は回転し、ナットは前後方向に移動し、移動板１６は前後方向に移動する。

移動板１６上面に左右方向に移動するＸ軸方向移動機構２０が設けてある。Ｘ軸方向移動機構２０は、左右に延びた二つのレール２１と、Ｘ軸螺子軸２２と、Ｘ軸モータ（図示略）と、ベアリング２４とを備える。

レール２１は移動板１６上面の前後夫々に設けてある。Ｘ軸螺子軸２２は左右に延び、二つのレール２１の間に設けてある。Ｘ軸螺子軸２２の左端部及び中途部夫々にベアリング２４が設けてある。なおＸ軸螺子軸２２の中途部に設けたベアリングの記載は省略する。Ｘ軸モータはＸ軸螺子軸２２の後端部に連結している。

Ｘ軸螺子軸２２には転動体（図示略）を介してナット（図示略）が螺合している。Ｘ軸螺子軸２２にグリスが塗布してある。各レール２１に複数の摺動子２６が摺動可能に設けてある。ナット及び摺動子２６の上部にコラム４が連結している。コラム４は柱状をなす。Ｘ軸モータの回転によってＸ軸螺子軸２２は回転し、ナットは左右方向に移動し、コラム４は左右方向に移動する。

コラム４の前面に上下方向に移動するＺ軸方向移動機構３０が設けてある。Ｚ軸方向移動機構３０は、上下に延びた二つのレール３１と、Ｚ軸螺子軸３２と、Ｚ軸モータ３３と、ベアリング３４とを備える。

レール３１はコラム４前面の左右夫々に設けてある。Ｚ軸螺子軸３２は上下に延び、二つのレール３１の間に設けてある。Ｚ軸螺子軸３２の下端部及び中途部夫々にベアリング３４が設けてある。なお中途部に設けたベアリングの図示は省略する。Ｚ軸モータ３３はＺ軸螺子軸３２の上端部に連結している。

Ｚ軸螺子軸３２には転動体（図示略）を介してナット（図示略）が螺合している。Ｚ軸螺子軸３２にグリスが塗布してある。各レール３１に複数の摺動子３５が摺動可能に設けてある。ナット及び摺動子３５の前部に主軸ヘッド５が連結している。Ｚ軸モータ３３の回転によってＺ軸螺子軸３２は回転し、ナットは上下方向に移動し、主軸ヘッド５は上下方向に移動する。Ｚ軸モータ３３、Ｚ軸螺子軸３２、ナット及び転動体はボールねじ機構を構成する。

上下に延びた主軸５ａが主軸ヘッド５内に設けてある。主軸５ａは軸回りに回転する。主軸ヘッド５の上端部に主軸モータ６が設けてある。主軸５ａの下端部は工具を装着する。主軸モータ６の回転によって主軸５ａが回転し、工具が回転する。回転した工具は、ワーク保持部３に保持したワークを加工する。

工作機械は工具を交換する工具交換装置（図示略）を備える。工具交換装置は工具マガジン（図示略）に収容した工具と主軸５ａに装着した工具を交換する。

図２は制御装置５０の構成を略示するブロック図である。制御装置５０は、ＣＰＵ５１、記憶部５２、ＲＡＭ５３及び入出力インタフェース５４を備える。記憶部５２は書き換え可能なメモリであり、例えばＥＰＲＯＭ、ＥＥＰＲＯＭ等である。記憶部５２は後述する交点テーブル、経路番号ｉ、指令点ｐ_k、交点Ｓ_i ^d、ｋの最終番号等を記憶する（ｄ、ｉ、ｋは自然数）。

作業者が操作部７を操作した場合、操作部７から入出力インタフェース５４に信号が入力する。操作部７は例えばキーボード、ボタン、タッチパネル等である。入出力インタフェース５４は表示部８に信号を出力する。表示部８は文字、図形、記号等を表示する。表示部８は例えば液晶表示パネルである。

制御装置５０は、Ｘ軸モータ２３に対応したＸ軸制御回路５５、サーボアンプ５５ａ及び微分器２３ｂを備える。Ｘ軸モータ２３はエンコーダ２３ａを備える。Ｘ軸制御回路５５はＣＰＵ５１からの指令に基づいて、電流量を示す命令をサーボアンプ５５ａに出力する。サーボアンプ５５ａは前記命令を受け、Ｘ軸モータ２３に駆動電流を出力する。

エンコーダ２３ａはＸ軸制御回路５５に位置フィードバック信号を出力する。Ｘ軸制御回路５５は位置フィードバック信号に基づいて、位置のフィードバック制御を実行する。

エンコーダ２３ａは微分器２３ｂに位置フィードバック信号を出力し、微分器２３ｂは位置フィードバック信号を速度フィードバック信号に変換して、Ｘ軸制御回路５５に出力する。Ｘ軸制御回路５５は、速度フィードバック信号に基づいて、速度のフィードバック制御を実行する。

サーボアンプ５５ａが出力した駆動電流の値を電流検出器５５ｂが検出する。電流検出器５５ｂは駆動電流の値をＸ軸制御回路５５にフィードバックする。Ｘ軸制御回路５５は駆動電流の値に基づいて、電流制御を実行する。一般にＸ軸モータ２３に流れる駆動電流とＸ軸モータ２３に作用する負荷トルクは略一致する。故に電流検出器５５ｂはＸ軸モータ２３に作用する負荷トルクを検出する。

制御装置５０は、Ｙ軸モータ１３に対応したＹ軸制御回路５６、サーボアンプ５６ａ及び微分器１３ｂを備える。Ｙ軸モータ１３はエンコーダ１３ａを備える。Ｙ軸制御回路５６はＣＰＵ５１からの指令に基づいて、電流量を示す命令をサーボアンプ５６ａに出力する。サーボアンプ５６ａは前記命令を受け、Ｙ軸モータ１３に駆動電流を出力する。

エンコーダ１３ａはＹ軸制御回路５６に位置フィードバック信号を出力する。Ｙ軸制御回路５６は位置フィードバック信号に基づいて、位置のフィードバック制御を実行する。

エンコーダ１３ａは微分器１３ｂに位置フィードバック信号を出力し、微分器１３ｂは位置フィードバック信号を速度フィードバック信号に変換して、Ｙ軸制御回路５６に出力する。Ｙ軸制御回路５６は、速度フィードバック信号に基づいて、速度のフィードバック制御を実行する。

サーボアンプ５６ａが出力した駆動電流の値を電流検出器５６ｂが検出する。電流検出器５６ｂは駆動電流の値をＹ軸制御回路５６にフィードバックする。Ｙ軸制御回路５６は駆動電流の値に基づいて、電流制御を実行する。一般にＹ軸モータ１３に流れる駆動電流とＹ軸モータ１３に作用する負荷トルクは略一致する。故に電流検出器５６ｂはＹ軸モータ１３に作用する負荷トルクを検出する。

制御装置５０は、Ｚ軸モータ３３に対応したＺ軸制御回路５７、サーボアンプ５７ａ及び微分器３３ｂを備える。Ｚ軸モータ３３はエンコーダ３３ａを備える。Ｚ軸制御回路５７はＣＰＵ５１からの指令に基づいて、電流量を示す命令をサーボアンプ５７ａに出力する。サーボアンプ５７ａは前記命令を受け、Ｚ軸モータ３３に駆動電流を出力する。

エンコーダ３３ａはＺ軸制御回路５７に位置フィードバック信号を出力する。Ｚ軸制御回路５７は位置フィードバック信号に基づいて、位置のフィードバック制御を実行する。

エンコーダ３３ａは微分器３３ｂに位置フィードバック信号を出力し、微分器３３ｂは位置フィードバック信号を速度フィードバック信号に変換して、Ｚ軸制御回路５７に出力する。Ｚ軸制御回路５７は、速度フィードバック信号に基づいて、速度のフィードバック制御を実行する。

サーボアンプ５７ａが出力した駆動電流の値を電流検出器５７ｂが検出する。電流検出器５７ｂは駆動電流の値をＺ軸制御回路５７にフィードバックする。Ｚ軸制御回路５７は駆動電流の値に基づいて、電流制御を実行する。一般にＺ軸モータ３３に流れる駆動電流とＺ軸モータ３３に作用する負荷トルクは略一致する。故に電流検出器５７ｂはＺ軸モータ３３に作用する負荷トルクを検出する。

制御装置５０は主軸モータ６に対しても、Ｘ〜Ｚ軸モータ１１、１２、１３と同様なフィードバック制御を実行する。

工作機械はマガジンモータ６０と、マガジン制御回路５８とを備える。マガジンモータ６０の回転によって工具マガジンが駆動する。マガジン制御回路５８はマガジンモータ６０の回転を制御する。

記憶部５２はワークを加工する加工プログラムを格納する。加工プログラムは、主軸５ａの位置を指示する複数の指令点ｐ_k を有する。ｋは加工プログラムを構成する命令の順番を示す。主軸５ａは複数の指令点ｐ_k を順次移動し、主軸５ａに装着した工具はワークを加工する。

記憶部５２は指令点ｐ_k を予め記憶している。制御装置５０は複数の指令点ｐ_k に基づいて、主軸５ａが移動する経路（加工経路）を設定する。制御装置５０は加工経路に基づいて、主軸５ａの移動を実行する。

加工経路の設定方法について説明する。図３はワークに対する加工経路及び評価断面を略示する平面図、図４はワークに対する評価断面を略示する斜視図である。なお図中Ｘ方向は左右方向を示し、Ｙ方向は前後方向を示し、Ｚ方向は上下方向を示す。また図３及び図４におけるワークの形状は加工後の形状を示している。

制御装置５０は、ワークに対して評価断面Ｄ^d （ｄは断面番号を示し、自然数である）を設定する。図３に示すように、主軸５ａはＸ方向に沿って大部分が往復移動する場合、加工経路はＸ方向に沿った経路となる。図３に示す如く、制御装置５０は加工経路に略直交する方向に沿った評価断面Ｄ^d を複数設定する。複数の評価断面はＸ方向に並ぶ。尚、作業者は、加工経路がＸ方向であることを予め指示する。

図５は指令点ｐ_k と、評価断面Ｄ^d 及び加工経路の交点とを略示する模式図、図６は交点テーブルの一例を示す概念図である。図５及び６において、「ｉ」（ｉは自然数）は主軸５ａのＸ方向移動における経路番号を示す。図５に示すように、例えば経路番号１（ｉ＝１）の経路は、左から右に移動する経路を示し、経路番号２（ｉ＝２）の経路は経路番号１の経路を右端で折り返して、右から左に移動する経路を示す。経路番号３以下も同様である。主軸５ａは経路番号順に移動する。

図６に示すように、制御装置５０は、各評価断面Ｄ^d において、移動経路ｐ_k −ｐ_k+1 との交点Ｓ_i ^dを演算し、経路番号ｉ、交点座標Ｓ_i ^d及び移動経路ｐ_k −ｐ_k+1 を対応付けて、交点テーブルに記憶する。

制御装置５０は、評価断面Ｄ^d 上における交点位置を例えば第１の修正方法で修正する。図７は評価断面Ｄ^d 上における交点位置の第１の修正方法を説明する説明図である。制御装置５０は、例えばＺ方向の座標を漸次変更するように修正する。修正の対象となる交点座標Ｓ_i ^dに対し、前後各二点の交点座標ｓ_i-2 ^d、ｓ_i-1 ^d、ｓ_i+1 ^d、ｓ_i+2 ^dを使用して修正点t_i ^dを決定する。

四つの交点座標ｓ_i-2 ^d、ｓ_i-1 ^d、ｓ_i+1 ^d、ｓ_i+2 ^dの各Ｚ座標値をｚ_i-2 、ｚ_i-1 、ｚ_i+1 、ｚ_i+2 とし、修正点t_i ^dのＺ座標値をｚ_i′とし、Ｚ座標値の差分をd₁ ＝ｚ_i-2 −ｚ_i-1、d₂ ＝ｚ_i-1 −ｚ_i、d₃ ＝ｚ_i ′−ｚ_i+1、d₄ ＝ｚ_i+1 −ｚ_i+2とし、Ｚ座標値の二回差分d₁₂′、d₂₃′、d₃₄′（Ｚ座標値の差分d₁ 、d₂ 、d₃ 、d₄ の差分）が線形に変化するようなｚ_i′を演算する。

Ｚ座標値の二回差分d₁₂′、d₂₃′、d₃₄′は次式で求まる。
d₁₂′＝d₂ −d₁ ＝（ｚ_i-1 −ｚ_i ′）−（ｚ_i-2 −ｚ_i-1）＝２ｚ_i-1 −ｚ_i ′−ｚ_i-2 ・・・（１）
d₂₃′＝d₃ −d₂ ＝（ｚ_i ′−ｚ_i+1）−（ｚ_i-1 −ｚ_i ′）＝２ｚ_i ′−ｚ_i+1 −ｚ_i-1 ・・・（２）
d₃₄′＝d₄ −d₃ ＝（ｚ_i+1 −ｚ_i+2 ）−（ｚ_i ′−ｚ_i+1 ）＝２ｚ_i+1 −ｚ_i+2 −ｚ_i ′ ・・（３）

これらが線形に変化することから、
d₂₃′＝（d₁₂′＋d₃₄′）／２・・・（４）
を満たす。

式（１）〜（４）に基づき、ｚ_i ′を解くと、
ｚ_i ′＝（−ｚ_i-2 ＋４ｚ_i-1 ＋４ｚ_i+1 −ｚ_i+2 ）／６
となる。

評価断面Ｄ^d 上における全ての交点Ｓ_i ^dに対して上記修正を行う。なおＺ座標値が他の交点のＺ座標値と比較して、大きく離れた交点のみを修正してもよい。

制御装置５０は、評価断面Ｄ^d 上における交点位置を例えば第２の修正方法で修正する。図８は評価断面上における交点位置の第２の修正方法を説明する説明図である。図８において、ｕはＸＹ座標に相当し、ｖはＺ座標に相当する。制御装置５０は、例えば修正の対象となる交点Ｓ_i ^dの周囲にある他の複数の交点を使用して、滑らかな曲線（スプライン曲線、ベジェ曲線、ＮＵＲＢＳ曲線等）を作成し、該曲線上に修正の対象となる交点Ｓ_i ^dを投影する。

滑らかな曲線として四つの交点ｓ_i-2 ^d、ｓ_i-1 ^d、ｓ_i+1 ^d、ｓ_i+2 ^dを使用する場合、評価断面Ｄ^d （ｕｖ平面）上における区間ｓ_i-2 ^d〜ｓ_i-1 ^d、区間ｓ_i-1 ^d〜ｓ_i+1 ^d、区間ｓ_i+1 ^d〜ｓ_i+2 ^dの夫々の曲線式ｖ₁(ｕ)、ｖ₂(ｕ)、ｖ₃(ｕ)は、以下の式となる。
ｖ_j(ｕ)＝ａ_j (ｕ-ｕ_j )³ ＋ｂ_j (ｕ-ｕ_j )² ＋ｃ_j （ｕ-ｕ_j ）＋ｄ_j
（ｊ＝１、２、３）

交点ｓ_i-2 ^d、ｓ_i-1 ^d、ｓ_i+1 ^d、ｓ_i+2 ^dを通り、且つ境界点における一次導関数及び二次導関数が連続であることに基づいて、制御装置５０はａ_j 〜ｄ_j を決定することができる。

四つの交点の選択は、上述したように、交点Ｓ_i ^dの両隣に位置する連続した二点を使用する場合に限らない。例えば交点ｓ_i-3 ^d、ｓ_i-1 ^d、ｓ_i+1 ^d、ｓ_i+3 ^dのように、二点毎に不連続に交点を選択してもよい。

図８に示すように、修正点t_i ^d位置は、滑らかな曲線上において、修正の対象となる交点Ｓ_i ^dからの距離が最小となる位置である。

ｄ番目の評価断面Ｄ^d 上に存在する修正後の交点群Ｓ^d をＴ^d とする。
Ｔ^d ＝{t_i ^d|ｄ：断面番号、ｉ：経路番号}

制御装置５０は、交点群をＴ^d を使用して、指令点の位置を修正する。図９は指令点の修正方法を説明する説明図である。図９において、ｐ_a 〜ｐ_f は指令点を示す。

例えば指令点ｐ_c が修正対象である場合、図９Ａに示す如く、指令点ｐ_c は断面Ｄ^d-1 と断面Ｄ^d の間に位置し、経路番号はｉである。制御装置５０は前述した交点テーブルを参照し、指令点ｐ_c に関する断面位置及び経路番号を取得する。

図９Ｂに示す如く、制御装置５０は指令点ｐ_c の周囲にある交点、例えば加工経路上に並んだ四つの交点t_i ^d+1、t_i ^d、t_i ^d-1、t_i ^d-2を探索する。制御装置５０は四つの交点t_i ^d+1、t_i ^d、t_i ^d-1、t_i ^d-2から滑らかな曲線（スプライン曲線、ベジェ曲線、ＮＵＲＢＳ曲線等）を作成し、該曲線上に指令点ｐ_c を投影し、修正点ｐ_c ′を決定する。制御装置５０は、滑らかな曲線を前述した第２の修正方法と同様な方法で求める。修正点ｐ_c ′の位置は、滑らかな曲線上において、指令点ｐ_c からの距離が最小となる位置である。制御装置５０は他の指令点の位置を同様に修正する。

図１０は制御装置５０による加工経路設定処理を説明するフローチャートである。ＣＰＵ５１は評価断面Ｄ^d を設定する（ステップＳ１、図３及び図４参照）。次にＣＰＵ５１は交点テーブル作成する（図５及び図６参照）。具体的には、ＣＰＵ５１は往復動作の経路番号を示す変数ｉ及び加工プログラムを構成する命令の順番を示す変数ｋに「１」を設定する（ステップＳ２）。そしてＣＰＵ５１は移動経路ｐ_k −ｐ_k+1 を読み込む（ステップＳ３）。ＣＰＵ５１は移動経路ｐ_k −ｐ_k+1 が評価断面Ｄ^d と交差するか否かを判定する（ステップＳ４）。移動経路ｐ_k −ｐ_k+1 が評価断面Ｄ^d と交差しない場合（ステップＳ４：ＮＯ）、ＣＰＵ５１はｋをインクリメントする（ステップＳ８）。

移動経路ｐ_k −ｐ_k+1 が評価断面Ｄ^d と交差する場合（ステップＳ４：ＹＥＳ）、ＣＰＵ５１は、評価断面Ｄ^d と移動経路ｐ_k −ｐ_k+1 との交点Ｓ_i ^dが既に存在しているか否かを判定する（ステップＳ５）。

評価断面Ｄ^d と移動経路ｐ_k −ｐ_k+1 との交点Ｓ_i ^dが既に存在していない場合（ステップＳ５：ＮＯ）、ＣＰＵ５１は記憶部５２の交点テーブル（図６参照）に、経路番号ｉ、交点座標Ｓ_i ^d及び移動経路ｐ_k −ｐ_k+1 を対応付けて記憶する（ステップＳ７）。

評価断面Ｄ^d と移動経路ｐ_k −ｐ_k+1 との交点Ｓ_i ^dが既に存在している場合（ステップＳ５：ＹＥＳ）、ＣＰＵ５１はｉをインクリメントし（ステップＳ６）、ＣＰＵ５１は記憶部５２の交点テーブルに、経路番号ｉ、交点座標Ｓ_i ^d及び移動経路ｐ_k −ｐ_k+1 を対応付けて記憶し（ステップＳ７）、ｋをインクリメントする（ステップＳ８）。ステップＳ２〜Ｓ８は演算部を構成する。

ｋをインクリメントした後、ＣＰＵ５１はｋが最終番号であるか否かを判定する（ステップＳ９）。ｋが最終番号でない場合（ステップＳ９：ＮＯ）、ＣＰＵ５１はステップＳ３に処理を戻す。ｋが最終番号である場合（ステップＳ９：ＹＥＳ）、ＣＰＵ５１は、上述したように、交点の位置を修正する（ステップＳ１０、式（１）〜式（４）、図７及び図８参照）。

ＣＰＵ５１は、上述したように、指令点の周囲にある交点を探索し（ステップＳ１１）、指令点の位置を修正する（ステップＳ１２、図９Ａ及び図９Ｂ参照）。

実施の形態に係る制御装置５０及び工作機械にあっては、加工経路に交差する評価断面を設定し、評価断面と加工経路の交点の位置を修正し、修正した交点の位置に基づいて指令点の位置を修正する。加工経路に交差する方向においても、指令点の位置を修正することができるので、滑らかな曲面をワークに形成することができる。

上述した実施の形態において、主軸５ａはＸ方向に沿って往復移動しているが、Ｙ方向に往復移動してもよい。この場合、加工経路はＹ方向に沿った経路となり、制御装置５０は加工経路に略直交する方向に沿った評価断面を複数設定する。複数の評価断面はＹ方向に並ぶ。

図１１は変更例におけるワークに対する加工経路及び評価断面を略示する平面図である。図１１に示す如く、加工経路が渦巻き状をなす場合、制御装置５０は渦巻きの中心及び該中心周りの角度を設定し、渦巻きの中心を基準として放射状に複数の評価断面を設定する。

２ 支持台
３ ワーク保持部
４ コラム
５ 主軸ヘッド
５ａ 主軸
６ 主軸モータ
１０ Ｙ軸方向移動機構
２０ Ｘ軸方向移動機構
３０ Ｚ軸方向移動機構
５０ 制御装置
５１ ＣＰＵ
５２ 記憶部
５３ ＲＡＭ

Claims (6)

1. 主軸の位置を指示する複数の指令点に基づいた加工経路を設定し、前記加工経路に基づいて、前記主軸の移動を制御する制御装置において、
   前記加工経路に交差する評価断面を設定する設定部と、
   該設定部が設定した評価断面及び前記加工経路の複数の交点を演算する演算部と、
   該演算部が演算した前記複数の交点の位置を修正する交点位置修正部と、
   該交点位置修正部が修正した交点に基づいて、前記加工経路に交差する方向における前記指令点の位置を修正する指令点位置修正部と
   を備え、
   前記交点位置修正部は、修正の対象である第一の交点の位置を、前記第一の交点の周囲にある複数の第二の交点を用いて修正すること
   を特徴とする制御装置。
2. 前記交点位置修正部は、前記第一の交点を線形補間すること
   を特徴とする請求項１に記載の制御装置。
3. 前記交点位置修正部は、
   前記第一の交点の周囲にある前記複数の第二の交点を用いて曲線を設定し、
   設定した曲線上に、前記第一の交点を投影すること
   を特徴とする請求項１に記載の制御装置。
4. 前記指令点位置修正部は、前記交点位置修正部が修正した複数の交点を通る第２曲線を設定し、
   設定した第２曲線上に、修正の対象である前記指令点を投影すること
   を特徴とする請求項１から３の何れか一つに記載の制御装置。
5. 請求項１から４の何れか一つに記載の制御装置と、
   前記主軸と
   を備えることを特徴とする工作機械。
6. 加工プログラムに従って、主軸の位置を指示する複数の指令点に基づいた加工経路を設定し、前記加工経路に基づいて、前記主軸の移動を制御する制御装置で実行可能なコンピュータプログラムにおいて、
   前記制御装置を、
   前記加工経路に交差する評価断面を設定する設定部、
   該設定部が設定した評価断面及び前記加工経路の複数の交点を演算する演算部、
   該演算部が演算した前記複数の交点の位置を修正する交点位置修正部、及び
   該交点位置修正部が修正した交点に基づいて、前記加工経路に交差する方向における前記指令点の位置を修正する指令点位置修正部
   として機能させ、
   前記交点位置修正部に、修正の対象である第一の交点の位置を、前記第一の交点の周囲にある複数の第二の交点を用いて、修正させる
   ことを特徴とするコンピュータプログラム。

Images