(57)【要約】【課題】送り軸反転時からロストモーション補正完了時までの間に送り軸の移動状態が変化し、送り軸の速度変化が一定でなくなる場合にも、発生する送り軸反転時の飛び越しや追従遅れ等の追従誤差を抑制する。【解決手段】反転時の送り軸の加速度に応じて求めた速度あるいはトルク補償量に対し、反転前後の送り軸移動状態を検出し、反転前後の送り軸移動状態に応じて所定のルールで係数を算出し、該係数を前記送り軸の速度反転以降の加速度により求められるロストモーション補正量に乗算し、実ロストモーション補正量を演算する補正量算出手段を具備し、算出された実ロストモーション補正量を用いて送り軸制御部による実ロストモーション補正を行う。【選択図】図１
2006195664.tif 000002
【特許請求の範囲】
【請求項１】
工作機械の送り軸の移動指令に基づき駆動制御指令を出力して送り軸の駆動制御を行う送り軸制御部と、送り軸の反転時に、前記駆動制御指令をロストモーション補正するロストモーション補正部と、を含み、送り軸の反転時にロストモーション補正しながら送り軸の駆動制御を行う数値制御装置において、
前記ロストモーション補正部は、
前記送り軸制御部に入力される前の移動指令を監視し、送り軸の反転および反転時の送り軸の加速度を検出する検出手段と、
ロストモーション補正中に反転時の送り軸の加速度が継続する場合に用いられるロストモーション補正量を、加速度毎に記憶する補正データ記憶手段と、
検出された加速度に基づき、該加速度がロストモーション補正中に継続する場合における反転後の第一の送り軸移動量を算出し、また反転後に前記送り軸制御部に入力される予定の所定回数分の移動指令に基づき、該移動指令による反転後の第二の送り軸移動量を算出し、この反転後の第一及び第二送り軸移動量と、検出された加速度に基づき前記補正量データ記憶手段から取得した補正量と、を用いて、実際のロストモーション補正に用いる実ロストモーション補正量を算出する補正量算出手段と、
を含み、
前記送り軸制御部は、入力された移動指令と、補正量算出手段で算出された実ロストモーション補正量と、に基づいて、反転時のロストモーション補正を行いながら送り軸の駆動制御を行うことを特徴とする数値制御装置。
【請求項２】
請求項１に記載の数値制御装置において、
前記補正量算出手段は、
検出された加速度が反転前にも継続していた場合における反転前の第一の送り軸移動量を算出し、また反転前に前記送り軸制御部に入力済みの所定回数分の移動指令に基づき、該移動指令による反転前の第二の送り軸移動量を算出し、この反転前の第一及び第二の反転前移動量と、前記反転後の第一及び第二の送り移動量と、検出された加速度に基づき前記補正量データ記憶部から取得した補正量と、を用いて実ロストモーション補正量を算出することを特徴とする数値制御装置。
【請求項３】
工作機械の送り軸の移動指令に基づき駆動制御指令を出力して送り軸の駆動制御を行う送り軸制御部と、送り軸の反転時に、前記駆動制御指令をロストモーション補正するロストモーション補正部と、を含み、送り軸の反転時にロストモーション補正しながら送り軸の駆動制御を行う数値制御装置において、
前記送り軸制御部に入力される前の移動指令を、所定の指令回数分だけ記憶可能な入力前指令記憶手段と、
移動指令を入力前指令記憶手段に逐次記憶させる入力前指令記憶制御手段であって、所定回数分の移動指令を記憶済みの入力前指令記憶手段に最新の移動指令を更新記憶させる場合に、入力前指令記憶手段内の最古の移動指令を当該入力前指令記憶手段から出力する入力前指令記憶制御手段と、
入力前指令記憶手段から出力された移動指令を監視し、送り軸の反転および反転時の送り軸の加速度を検出する検出手段と、
ロストモーション補正中に反転時の送り軸の加速度が継続する場合に用いられるロストモーション補正量を、加速度毎に記憶する補正データ記憶手段と、
検出された加速度に基づき、該加速度がロストモーション補正中に継続する場合における反転後の第一の送り軸移動量を算出し、また反転検出時の入力前指令記憶部内に記憶される移動指令に基づき、実際に制御される反転後の第二の送り軸移動量を算出し、この反転後の第一及び第二送り軸移動量と、検出された加速度に基づき前記補正量データ記憶手段から取得した補正量と、を用いて、実際のロストモーション補正に用いる実ロストモーション補正量を算出する補正量算出手段と、
を含み、
前記送り軸制御部は、入力前指令記憶手段から出力された移動指令と、補正量算出手段で算出された実ロストモーション補正量と、に基づいて、反転時のロストモーション補正を行いながら送り軸の駆動制御を行うことを特徴とする数値制御装置。
【請求項４】
請求項３に記載の数値制御装置において、
前記入力前指令記憶手段から出力される移動指令を更新記憶可能な入力後指令記憶手段と、
前記入力前指令記憶手段から出力される移動指令を入力後指令記憶手段に逐次記憶させる入力後指令記憶制御手段と、
をさらに備え、
前記補正量算出手段は、
検出された加速度に基づき、該加速度がロストモーション補正中に継続する場合における反転前の第一の送り軸移動量を算出し、また反転検出時の入力後指令記憶部内に記憶される移動指令に基づき、実際に制御された反転前の第二の送り軸移動量を算出し、この反転前の第一及び第二の送り軸移動量と、前記反転後の第一及び第二送り軸移動量と、検出された加速度に基づき前記補正量データ記憶手段から取得した補正量と、を用いて実ロストモーション補正量を算出することを特徴とする数値制御装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、数値制御（ＮＣ）工作機械の送り軸駆動系の送り軸反転時に発生する送り軸追従誤差を抑制するために、送り軸を駆動する送り軸モータの制御を行う数値制御装置に関する。
【背景技術】
【０００２】
近年、ＮＣ工作機械の切削送り速度の高速化に伴い、駆動系の非線形要素に起因する問題が顕著に表れてきており、例えばその１つに、円弧切削時等において円弧象限切り換わり部に象限突起と呼ばれる現象が生じるという問題がある。この象限突起は、円弧象限切り換わり部において送り軸が反転する際に送り軸モータの出力トルクが俊敏に応答できないため、実速度に遅れが生じることにより形状誤差が発生し、この形状誤差に起因して生じるものである。
【０００３】
従来、このような送り軸の反転に起因して生じる問題を解決するために、送り軸反転時に様々な補償制御が行われている。例えば、送り軸の移動指令や速度指令を監視し、送り軸の移動方向あるいは速度指令値の符号が反転した際に、反転した軸移動方向へ一定のトルク指令値を加算補償して送り軸反転時の起動トルクを補償制御する方法がある。
【０００４】
しかしながら、このような補償制御方法によると、送り軸速度により変化する摺動抵抗の影響を考慮せずに一定のトルク指令値で補償制御が行われるため、送り軸反転時の送り速度の変化の度合い（加速度）によっては補償制御が過補償あるいは補償不足となる等、加工条件によっては十分な補償効果が得られなかった。
【０００５】
そこで、このような問題を解決するため、送り軸反転時の送り速度変化の度合いを考慮した補償制御が立案されている。この補償制御について、図３を参照して説明する。
【０００６】
まず、プログラム解析部１は、入力された加工プログラム（ＮＣプログラム）を解析する。補間演算部２は、プログラム解析部１にて得られた解析結果に基づいて補間演算を行い、各送り軸の移動指令Ｐｃを生成し、この移動指令Ｐｃを位置制御部８に出力する。
【０００７】
位置制御部８は、移動指令Ｐｃにおける位置指令値と位置フィードバック信号Ｐａにおける実際の送り軸の位置を示す値との差に基づいて速度指令Ｖｃを算出し、速度制御部９に向けて出力する。ここで、位置フィードバック信号Ｐａは、実際の送り軸の位置が指令値通りに制御されるようにするためのフィードバック信号であり、送り軸モータに結合された位置検出器１２から出力される信号である。そして、位置制御部８から出力された速度指令Ｖｃは、後述の如くロストモーション補正演算部７１により速度の補正が行われ、補正後の指令が速度制御部９に入力される。
【０００８】
速度制御部９は、ロストモーション補正された速度指令における速度指令値と速度フィードバック信号Ｖａにおける実際の送り速度を示す値との差に基づいてトルク指令Ｔｃを算出し、電力増幅部１０に向けて出力する。ここで、速度フィードバック信号Ｖａは、実際の送り速度が指令値通りに制御されるようにするためのフィードバック信号であり、位置検出器１２からの位置フィードバック信号Ｐａが速度検出部（微分器）１３により処理されて得られる信号である。そして、速度制御部９から出力されたトルク指令Ｔｃは、速度指令Ｖｃと同様に、ロストモーション補正演算部７１によりトルクの補正が行われ、補正後の指令が電力増幅部１０に入力される。
【０００９】
電力増幅部１０は、ロストモーション補正されたトルク指令におけるトルク指令値と電力増幅部１０からのフィードバック信号の値との差に基づいて電流値を算出し、送り軸駆動モータ１１に出力する。こうして電力増幅部１０から出力された電流により、送り軸駆動モータ１１の駆動制御が行われる。
【００１０】
次に、ロストモーション補正演算部７１により行われる速度指令Ｖｃ及びトルク指令Ｔｃのロストモーション補正について説明する。
【００１１】
図３の数値制御装置において、速度反転検出部５は、補間演算部２からの移動指令Ｐｃ（特に、送り軸の移動方向や送り速度などの移動状態）を監視し、送り軸の移動方向の反転や反転時における送り軸の加速度を検出している。また、ロストモーション補正データ記憶部６は、例えば図４に示すような、送り軸反転時の加速度に応じて必要とされるロストモーション補正量のデータを予め記憶している。尚、この補正量の求め方としては、例えばＮＣ工作機械を所定の円弧補間で送り速度条件を変えながら動作させ、円弧象限切り換わり部の送り軸追従性を送り速度毎に確認し、送り軸反転時の加速度毎に必要となる補正量を求めるといった方法がある。
【００１２】
そして、速度反転検出部５が送り軸の移動方向の反転を検出すると、ロストモーション補正演算部７１は、速度反転検出部５から、送り軸反転時における加速度ΔＶを取得し、
しかる後に、この加速度ΔＶに応じたロストモーション補正量をロストモーション補正デ
ータ記憶部６から読み出し、読み出されたロストモーション補正量に基づいて速度及びトルクの補正値を算出して出力する。こうして出力された補正値は、速度制御部９及び電力増幅部１０の入力指令の指令値に加算され、速度指令Ｖｃ及びトルク指令Ｔｃのロストモーション補正が行われる。
【００１３】
ここで、ロストモーション補正演算部７１でのロストモーション補正量の算出は、図４に示すようなデータを用い、検出された加速度に対応する補正量を取り出す方法で行われる。従って、送り軸の送り速度の速度パターンが、例えば図５に示す３つの速度パターンＶ１，Ｖ２，Ｖ３である場合、加速度ΔＶ１，ΔＶ２，ΔＶ３に応じた補正量ε１，ε２
，ε３がロストモーション補正量として算出されることになる。尚、図５における加速度ΔＶは、送り軸の移動方向に対し反対の方向への加速度（すなわち、送り速度を減速させ
る加速度）を正、送り軸の移動方向への加速度（すなわち、送り速度を加速させる加速度）を負、としている。そして、送り軸反転時における加速度がΔＶ１，ΔＶ２，ΔＶ３である場合には、図６のように、算出された補正量ε１，ε２，ε３によるロストモーション補正が行われる。ここで、図６における補正量εは、反転後の送り軸の移動方向（速度の方向）に加算する補正量を負としている。従って、図６では、反転後の送り軸の移動方向に、補正量ε１，ε２，ε３を加算するようなロストモーション補正が行われることを示している。また、図６に示すように、ロストモーション補正は送り軸反転時から開始し、加速度の大きさによらず、時間Ｔa+nの時点で完了するように制御される。
【００１４】
【特許文献１】特開平９−３１９４１８号公報
【発明の開示】
【発明が解決しようとする課題】
【００１５】
上記の従来技術によれば、送り軸の駆動制御を行うにあたり、送り軸反転時の送り軸の加速度に応じて、ロストモーション補正量、及び速度やトルクの補正値を算出しているため、図６のように、送り軸反転時Ｔaからロストモーション補正完了時Ｔa+nまでの送り軸の速度変化が一定である場合には、送り軸反転時の送り軸追従誤差を抑制した適切な補償制御を行うことができる。
【００１６】
しかしながら、送り軸反転時Ｔaにおける送り軸の速度変化の度合い（加速度）が同じでも、送り軸反転時Ｔaからロストモーション補正完了時Ｔa+nまでの間に送り軸の移動状態が変化し、速度変化が一定でなくなる（送り軸反転時における速度変化と異なる状態となる）場合には、送り軸反転時Ｔaの加速度に応じた補正量では、ロストモーション補正完了前における送り軸の移動状態の変化に十分対応した補正を行うことができなかった。その結果、ロストモーション補正による速度やトルクの補償制御が過補償あるいは補償不足となり、送り軸が反転する際の飛び越しや追従遅れ等による追従誤差の発生を十分に抑制することができず、結果的には形状精度向上の阻害要因となっていた。
【００１７】
本発明の目的は、送り軸反転時からロストモーション補正完了時までの間に送り軸の移動状態が変化し、送り軸の速度変化が一定でなくなる場合にも、その変化に十分対応した補正値によりロストモーション補正を行うことが可能な数値制御装置を提供することにある。
【課題を解決するための手段】
【００１８】
本発明は、工作機械の送り軸の移動指令に基づき駆動制御指令を出力して送り軸の駆動制御を行う送り軸制御部と、送り軸の反転時に、前記駆動制御指令をロストモーション補正するロストモーション補正部と、を含み、送り軸の反転時にロストモーション補正しながら送り軸の駆動制御を行う数値制御装置において、前記ロストモーション補正部は、前記送り軸制御部に入力される前の移動指令を監視し、送り軸の反転および反転時の送り軸の加速度を検出する検出手段と、ロストモーション補正中に反転時の送り軸の加速度が継続する場合に用いられるロストモーション補正量を、加速度毎に記憶する補正データ記憶手段と、検出された加速度に基づき、該加速度がロストモーション補正中に継続する場合における反転後の第一の送り軸移動量を算出し、また反転後に前記送り軸制御部に入力される予定の所定回数分の移動指令に基づき、該移動指令による反転後の第二の送り軸移動量を算出し、この反転後の第一及び第二送り軸移動量と、検出された加速度に基づき前記補正量データ記憶手段から取得した補正量と、を用いて、実際のロストモーション補正に用いる実ロストモーション補正量を算出する補正量算出手段と、を含み、前記送り軸制御部は、入力された移動指令と、補正量算出手段で算出された実ロストモーション補正量と、に基づいて、反転時のロストモーション補正を行いながら送り軸の駆動制御を行うことを特徴とする。
【００１９】
また、前記補正量算出手段は、検出された加速度が反転前にも継続していた場合における反転前の第一の送り軸移動量を算出し、また反転前に前記送り軸制御部に入力済みの所定回数分の移動指令に基づき、該移動指令による反転前の第二の送り軸移動量を算出し、この反転前の第一及び第二の反転前移動量と、前記反転後の第一及び第二の送り移動量と、検出された加速度に基づき前記補正量データ記憶部から取得した補正量と、を用いて実ロストモーション補正量を算出することを特徴とする。
【発明の効果】
【００２０】
本発明の数値制御装置によれば、送り軸反転時の速度変化度合い（加速度）及び送り軸反転後の送り軸移動状態に応じて、適正な値で速度指令及びトルク指令をフィードフォワード補償するため、送り軸反転後の送り軸移動状態がロストモーション補正完了前に変化する場合においても、ロストモーション補正における速度やトルク補償の過補償または補償不足といった状態を抑制し、形状精度を向上させることができる。
【発明を実施するための最良の形態】
【００２１】
本発明の一実施形態に係る数値制御装置について、図１を参照して説明する。尚、図３に示す従来技術と同等な部分については、図１中で同一の符号としている。
【００２２】
本実施形態の数値制御装置において、プログラム解析部１は、入力された加工プログラム（ＮＣプログラム）を解析し、補間演算部２は、プログラム解析部１で得られた解析結果に基づき補間演算を行う。ここで、補間演算部２から出力された補間演算結果たる移動指令は、出力される毎に第一補間記憶制御部３によって第一記憶部３１に記憶される。
【００２３】
第一記憶部３１は、位置制御部８に入力される前の所定回数ｎ回分の移動指令を逐次更新記憶することができる。ここで、第一記憶部３１が所定回数ｎ回分の移動指令を既に記憶済みの場合に補間演算部２からの最新の移動指令が出力されると、第一補間記憶制御部３は、第一記憶部３１内に記憶済みの移動指令の内、所定回数ｎ回分を経過した最古の移動指令を第二補間記憶制御部４及び位置制御部８に出力し、補間演算部２からの最新の移動指令を第一記憶部３１内に更新記憶させる。
【００２４】
第二記憶部４１は、第一記憶部３１から出力された所定回数ｎ回分の移動指令を逐次更新記憶することができる。ここで、第二記憶部４１が所定回数ｎ回分の移動指令を既に記憶済みの場合に第一記憶部３１から移動指令が出力されると、第二補間記憶制御部４は、第二記憶部４１内に記憶済みの移動指令の内、所定回数ｎ回分を経過した最古の移動指令を削除し、第一補間記憶制御部３から移された移動指令を第二記憶部４１内に更新記憶させる。
【００２５】
また、第一補間記憶制御部３により第一記憶部３１から出力された移動指令が位置制御部８に入力すると、従来と同様に、ロストモーション補正演算部７によるロストモーション補正（速度指令及びトルク指令のフィードフォワード補償）及び位置検出器１２からのフィードバック制御が行われながら、位置制御部８、速度制御部９、及び電力増幅部１０を介して送り軸駆動モータ１１の駆動制御が行われる。
【００２６】
次に、本実施形態の数値制御装置において、ロストモーション補正演算部７により行われる速度指令Ｖｃ及びトルク指令Ｔｃのロストモーション補正について説明する。
【００２７】
速度反転検出部５は、第一記憶部３１から出力される移動指令Ｐｃ（特に、送り軸の移動方向や送り速度などの移動状態）を監視し、送り軸の移動方向の反転や反転時における送り軸の加速度を検出している。また、ロストモーション補正データ記憶部６は、従来技術と同様に、例えば図４に示すような、送り軸反転時の加速度に応じて必要とされるロストモーション補正量のデータを予め記憶している。尚、本実施形態では、速度の符号の反転を検出することで送り軸の移動方向の反転を検出しているが、移動方向の反転検出方法は、これに限定されるものではない。
【００２８】
そして、速度反転検出部５が送り軸の移動方向の反転を検出すると、ロストモーション補正演算部７は、送り軸反転時における加速度ΔＶを速度反転検出部５から取得し、しか
る後に、この加速度ΔＶに応じたロストモーション補正量をロストモーション補正データ
記憶部６から読み出す。また、ロストモーション補正演算部７は、送り軸反転検出時に第一記憶部３１及び第二記憶部４１に記憶されている移動指令に基づいて、後述の如く送り軸反転前後の送り軸の移動量を算出し、得られた値を用いて後述の係数値を算出する。そして、この係数値をロストモーション補正データ記憶部６から読み出されたロストモーション補正量に乗算して実ロストモーション補正量を算出し、さらにこの実ロストモーション補正量に基づいて速度及びトルクの補正値を算出して当該補正値を出力する。こうして出力された補正値は、速度制御部９及び電力増幅部１０の入力指令の指令値に加算され、速度指令Ｖｃ及びトルク指令Ｔｃのロストモーション補正が行われる。
【００２９】
ここで、ロストモーション補正演算部７による実ロストモーション補正量の算出ルールについて、以下説明する。
【００３０】
ロストモーション補正演算部７は、第一記憶部３１に記憶されている移動量の総和Σ１を算出する。第一記憶部３１に記憶されている補間結果たる移動指令は、まだ位置制御部８に出力されていない各補間時点の位置を示すものであるから、第一記憶部３１は、送り軸反転が発生した時点以降の軸移動位置データを所定回数ｎ回分記憶していることになる。従って、第一記憶部３１に記憶されている補間結果の中で最も新しい補間結果に示された送り軸位置と、送り軸反転時における送り軸位置との差分を算出することにより、送り軸反転以降の所定回数ｎ回分の移動指令による移動量の総和Σ１を算出することができる。
【００３１】
また、ロストモーション補正演算部７は、第二記憶部４１に記憶されている移動量の総和Σ２も算出する。第二記憶部４１に記憶されている補間結果たる移動指令は、既に位置制御部８に出力された各補間時点の位置を示すものであるから、第二記憶部４１は、送り軸反転が発生する前の軸移動位置データを所定回数ｎ回分記憶していることになる。従って、送り軸反転時における送り軸位置と、第二記憶部４１に記憶されている補間結果の中で最も古い補間結果に示された送り軸位置との差分を算出することにより、送り軸反転前の所定回数ｎ回分の移動指令による移動量の総和Σ２を算出することができる。
【００３２】
また、送り軸反転時のロストモーション補正の補正量の基準となるロストモーション補正量は、従来技術と同様に、図４に示すように送り軸の反転時に検出された加速度ΔＶに
よって求められる。このロストモーション補正量は、送り軸反転前後の加速度ΔＶがロス
トモーション補正完了時（図６の時間Ｔa+nの時点に相当）まで継続するような場合に最適な補正量である。そして、送り軸の軸反転前後の加速度ΔＶがロストモーション補正完
了時まで継続する場合における、送り軸反転前の所定回数ｎ回分の移動指令による送り軸移動量と送り軸反転後の所定回数ｎ回分の移動指令による送り軸移動量との総和Σ３が、Σ３＝1／２×ΔＶ×ｎ×ｎ×２＝ｎ2×ΔＶにより算出される。
【００３３】
こうして算出された各送り軸移動量Σ１、Σ２、Σ３を用いて、ロストモーション補正演算部７は、係数Ｋ＝（Σ１＋Σ２）／Σ３を算出する。
【００３４】
そして、算出された係数Ｋをロストモーション補正データ記憶部６から読み出されたロストモーション補正量に乗算し、実ロストモーション補正量を算出する。こうして算出された実ロストモーション補正量に基づいて、速度及びトルクの補正値を算出して出力し、この補正値を速度制御部９及び電力増幅部１０の入力指令の指令値に加算することで、速度指令Ｖｃ及びトルク指令Ｔｃのロストモーション補正が行われる。
【００３５】
例えば、送り軸が図２のような送り軸反転前後の移動状態を示して移動する場合、まずロストモーション補正演算部７は、送り軸反転時Ｔaにおける加速度ΔＶ１に応じたロス
トモーション補正量ε１をロストモーション補正データ記憶部６から読み出す。次に、第一記憶部３１に記憶されている所定回数ｎ回分の移動指令に基づいて、送り軸反転後の送り軸の移動量Σ１を算出する。さらに、第二記憶部４１に記憶されている所定回数ｎ回分の移動指令に基づいて、送り軸反転前の送り軸の移動量Σ２を算出する。
【００３６】
また、ロストモーション補正演算部７は、送り軸の軸反転前後の加速度ΔＶ１がロスト
モーション補正完了時まで継続するとした場合における、送り軸反転前の所定回数ｎ回分の送り軸移動量と送り軸反転後の所定回数ｎ回分の送り軸移動量との総和Σ３を、上述の如く算出する。そして、算出された各移動量Σ１、Σ２、Σ３を用いて上述の如く係数Ｋを算出し、この係数Ｋをロストモーション補正データ記憶部６から読み出したロストモーション補正量ε１に乗算し、実ロストモーション補正量εｒを求める。
【００３７】
このように、速度指令Ｖｃ及びトルク指令Ｔｃのロストモーション補正に用いられるロストモーション補正量は、送り軸反転後の移動状態（送り軸の移動量）によって、送り軸反転時Ｔaの加速度ΔＶ１に応じたロストモーション補正量ε１から実ロストモーション
補正量εｒに抑制される。そして、この実ロストモーション補正量εｒに基づいて速度及びトルクの補正値が算出され、この補正値が速度制御部９及び電力増幅部１０の入力指令の指令値にそれぞれ加算されることで、実ロストモーション補正量εｒに基づく速度指令Ｖｃ及びトルク指令Ｔｃのロストモーション補正が行われる。
【００３８】
以上のように、本実施形態の数値制御装置によれば、送り軸反転後の送り軸移動状態がロストモーション補正完了前に変化するような場合には、その移動状態の変化に応じてロストモーション補正量を抑制する。従って、同様の場合に従来の装置では生じていた速度やトルク補償の過補償または補償不足といった状態を抑制でき、形状精度を向上させることができる。
【００３９】
尚、図６の速度パターンＶ１のように、送り軸反転後の送り軸移動状態がロストモーション補正完了前に変化することなく、送り軸の反転前後において一定の速度変化が継続し、ロストモーション補正完了時まで続くような場合には、係数Ｋ＝１と算出される。従って、この場合の実ロストモーション補正量εｒは、結局のところ、送り軸反転時Ｔaにおける加速度ΔＶ１に応じたロストモーション補正量ε１となる。このように、送り軸反転後の送り軸移動状態がロストモーション補正完了前に変化せずに一定の速度変化が継続されるような場合には、従来と同様、ロストモーション補正量ε１に基づいて速度及びトルクの補正値が算出され、この補正値により、送り軸反転時Ｔaから時間Ｔa+nまでの間で速度指令Ｖｃ及びトルク指令Ｔｃのロストモーション補正が行われる。
【００４０】
また、今回のケースでは、送り軸反転前後の送り軸移動量Σ１，Σ２と、送り軸の反転前後の加速度がロストモーション補正完了時まで継続する場合における送り軸の軸反転前後の各所定回数ｎ回分の送り軸移動量Σ３とを用いて係数Ｋを算出するようにしているが、これに限定されるものではない。例えば、送り軸反転後の送り軸移動量Σ１１と、送り軸の反転前後の加速度がロストモーション補正完了時まで継続する場合における送り軸反転後の所定回数ｎ回分の送り軸移動量Σ３１とを用いて、係数Ｋ１（＝Σ１１／Σ３１）を算出しても良い。そして、得られた係数Ｋ１を用いて上記と同様にして実ロストモーション補正量を求め、この実ロストモーション補正量に基づいて得られた速度及びトルクの補正値により速度指令Ｖｃ及びトルク指令Ｔｃのロストモーション補正が行われても、同様の効果を得ることができる。尚、この場合には、数値制御装置において、第二記憶制御部４及び第二記憶部４１は不要な構成となる。
【図面の簡単な説明】
【００４１】
【図１】本発明の一実施形態に係る数値制御装置の構成を示す図である。
【図２】本発明の数値制御装置により算出される送り軸反転時のロストモーション補正量の一例を示す図である。
【図３】従来の数値制御装置の構成を示す図である。
【図４】ロストモーション補正データ記憶部に記憶される、送り軸反転時の加速度に応じて必要とされるロストモーション補正量の関係を示す図である。
【図５】送り軸反転時の加速度の関係を示す図である。
【図６】従来の数値制御装置により算出される送り軸反転時のロストモーション補正量を示す図である。
【符号の説明】
【００４２】
１  プログラム解析部、２  補間演算部、３  第一補間記憶制御部、３１  第一記憶部、４  第二補間記憶制御部、４１  第二記憶部、５  速度反転検出部、６  ロストモーション補正データ記憶部、７  ロストモーション補正演算部、８  位置制御部、９  速度制御部、１０  電力増幅部、１１  送り軸駆動モータ、１２  位置検出器、１３  速度検出部。
【図１】
2006195664.tif 000003
【図２】
2006195664.tif 000004
【図３】
2006195664.tif 000005
【図４】
2006195664.tif 000006
【図５】
2006195664.tif 000007
【図６】
2006195664.tif 000008