JPH04323705A - 回転軸同期繰り返し制御方法及び装置 - Google Patents
回転軸同期繰り返し制御方法及び装置Info
- Publication number
- JPH04323705A JPH04323705A JP11907391A JP11907391A JPH04323705A JP H04323705 A JPH04323705 A JP H04323705A JP 11907391 A JP11907391 A JP 11907391A JP 11907391 A JP11907391 A JP 11907391A JP H04323705 A JPH04323705 A JP H04323705A
- Authority
- JP
- Japan
- Prior art keywords
- rotational position
- command
- rotational
- servo motor
- interpolation
- 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.)
- Granted
Links
Landscapes
- Numerical Control (AREA)
- Control Of Position Or Direction (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【０００１】
【産業上の利用分野】本発明は、工作機械等に用いられ
るサーボモータの制御に関するもので、特に、所定周期
で同一パターンが繰返し指令されるような制御に関する
。
るサーボモータの制御に関するもので、特に、所定周期
で同一パターンが繰返し指令されるような制御に関する
。
【０００２】
【従来の技術】工作機械等を制御するサボモータ制御お
いて、図７に示すような、回転軸と直線軸で構成された
旋盤等の工作機械では、被加工物３０を回転軸駆動モー
タ２６で駆動し、被加工物３０を回転させながら、刃物
３１が取り付けられた直線軸を駆動するサーボモータ２
４で刃物３１を同一パターンで繰り返し移動させて加工
を行う場合ある。例えば、図８に示すように、回転軸１
回転を周期Ｌとして、直線軸を該周期１周期として繰り
返し、直線移動させて加工を行う場合がある。このよう
な同じパターンを繰り返す動作を行う時、位置偏差を零
に収束させて高い精度の加工を得る方法として、繰り返
し制御方式がすでに公知である。例えば、特開平２−３
０７１０４号公報，特願平２−１２４２５４号，特願平
１−３１４１５４号等参照。
いて、図７に示すような、回転軸と直線軸で構成された
旋盤等の工作機械では、被加工物３０を回転軸駆動モー
タ２６で駆動し、被加工物３０を回転させながら、刃物
３１が取り付けられた直線軸を駆動するサーボモータ２
４で刃物３１を同一パターンで繰り返し移動させて加工
を行う場合ある。例えば、図８に示すように、回転軸１
回転を周期Ｌとして、直線軸を該周期１周期として繰り
返し、直線移動させて加工を行う場合がある。このよう
な同じパターンを繰り返す動作を行う時、位置偏差を零
に収束させて高い精度の加工を得る方法として、繰り返
し制御方式がすでに公知である。例えば、特開平２−３
０７１０４号公報，特願平２−１２４２５４号，特願平
１−３１４１５４号等参照。
【０００３】図９は、上記繰り返し制御方式を適用した
サーボモータの制御における要部ブロック線図である。 図９において、ｒ（ｔ）は位置指令、ε（ｔ）は該位置
指令ｒ（ｔ）と実際の位置ｙ（ｔ）との差である位置偏
差、２は位置ループの伝達関数および速度ループの伝達
関数の積で、ＰＩ（比例・積分）制御等を行うものであ
る。そして、繰り返し制御を行うために繰り返しコント
ローラ１０が付加されており、該繰り返しコントローラ
１０は帯域制限フィルタ６、所定周期Ｌで繰り返される
指令に応じた１周期分のデータを記憶する遅れ要素７、
及び、制御対象の位相遅れ、ゲイン低下を補償するため
の動特性補償要素８で構成されている。
サーボモータの制御における要部ブロック線図である。 図９において、ｒ（ｔ）は位置指令、ε（ｔ）は該位置
指令ｒ（ｔ）と実際の位置ｙ（ｔ）との差である位置偏
差、２は位置ループの伝達関数および速度ループの伝達
関数の積で、ＰＩ（比例・積分）制御等を行うものであ
る。そして、繰り返し制御を行うために繰り返しコント
ローラ１０が付加されており、該繰り返しコントローラ
１０は帯域制限フィルタ６、所定周期Ｌで繰り返される
指令に応じた１周期分のデータを記憶する遅れ要素７、
及び、制御対象の位相遅れ、ゲイン低下を補償するため
の動特性補償要素８で構成されている。
【０００４】上記繰り返しコントローラ１０は所定サン
プリング周期Ｔ毎に位置偏差εに遅れ要素７から出力さ
れる１周期Ｌ前のサンプリング時のデータｘを加算し、
帯域制限フィルタ６の処理を行って遅れ要素７にそのデ
ータを格納する。遅れ要素７はｎ（＝Ｌ／Ｔ）個のメモ
リを有し、１周期Ｌ分の各サンプリングデータを記憶で
きるようになっており、各サンプリング時には一番古い
データを出力するようになっている。即ち、各サンプリ
ング毎１番地シフトして１番地のメモリに入力データを
格納し、ｎ番地のデータを出力する。その結果、遅れ要
素７の出力は１周期Ｌ分遅れたサンプリングデータが出
力される。そのため、周期Ｌで同一パターンの位置指令
ｒ（ｔ）が与えられるから、加算器２６で加算される位
置偏差εと遅れ要素７の出力は、位置指令ｒ（ｔ）のパ
ターン上において同一位置のデータが加算されることと
なる。
プリング周期Ｔ毎に位置偏差εに遅れ要素７から出力さ
れる１周期Ｌ前のサンプリング時のデータｘを加算し、
帯域制限フィルタ６の処理を行って遅れ要素７にそのデ
ータを格納する。遅れ要素７はｎ（＝Ｌ／Ｔ）個のメモ
リを有し、１周期Ｌ分の各サンプリングデータを記憶で
きるようになっており、各サンプリング時には一番古い
データを出力するようになっている。即ち、各サンプリ
ング毎１番地シフトして１番地のメモリに入力データを
格納し、ｎ番地のデータを出力する。その結果、遅れ要
素７の出力は１周期Ｌ分遅れたサンプリングデータが出
力される。そのため、周期Ｌで同一パターンの位置指令
ｒ（ｔ）が与えられるから、加算器２６で加算される位
置偏差εと遅れ要素７の出力は、位置指令ｒ（ｔ）のパ
ターン上において同一位置のデータが加算されることと
なる。
【０００５】また、遅れ要素７の出力は動特性補償要素
８で制御対象の位相遅れ、ゲイン以下が補償されて、繰
り返しコントローラ１０の出力、すなわち補正量ｄ（ｔ
）として出力され、該補正量（ｔ）が位置偏差εに加算
されて、この加算データによって位置・速度ループ処理
が実行される。
８で制御対象の位相遅れ、ゲイン以下が補償されて、繰
り返しコントローラ１０の出力、すなわち補正量ｄ（ｔ
）として出力され、該補正量（ｔ）が位置偏差εに加算
されて、この加算データによって位置・速度ループ処理
が実行される。
【０００６】その結果、所定周期Ｌで同一パターンの処
置が繰返され、あるサンプリング時において前周期で当
該サンプリング時に対応するサンプリング時の位置偏差
ε（ｔ）が大きな値の場合には、今周期においては、繰
り返しコントローラ１０から大きな値の補正量ｄ（ｔ）
が出力され、位置偏差に加算されることとなるから、位
置ループ処理に入力される位置偏差は大きく変り、実位
置ｙ（ｔ）もそれに対して変化するから、位置偏差ε（
ｔ）はその値が零に収束するように修正されることにな
り、高精度のモータ制御が可能となる。
置が繰返され、あるサンプリング時において前周期で当
該サンプリング時に対応するサンプリング時の位置偏差
ε（ｔ）が大きな値の場合には、今周期においては、繰
り返しコントローラ１０から大きな値の補正量ｄ（ｔ）
が出力され、位置偏差に加算されることとなるから、位
置ループ処理に入力される位置偏差は大きく変り、実位
置ｙ（ｔ）もそれに対して変化するから、位置偏差ε（
ｔ）はその値が零に収束するように修正されることにな
り、高精度のモータ制御が可能となる。
【０００７】
【発明が解決しようとする課題】加工物３０の精度は回
転軸や直線軸の回転精度によって決まる。直線軸に関し
ては高い位置や速度の精度を得ることができるが、回転
軸に関しては、重い回転機構やギヤ，ベルト等による機
械構造のため、精度を高く制御することが難しい。また
、回転軸を位置ではなく速度で制御するスピンドルモー
タを使用できるようにすることが望ましい。
転軸や直線軸の回転精度によって決まる。直線軸に関し
ては高い位置や速度の精度を得ることができるが、回転
軸に関しては、重い回転機構やギヤ，ベルト等による機
械構造のため、精度を高く制御することが難しい。また
、回転軸を位置ではなく速度で制御するスピンドルモー
タを使用できるようにすることが望ましい。
【０００８】図７，図８に示すように、回転軸１回転を
１周期Ｌとし、直線軸が同一パターンで繰り返される場
合等においては、該１周期ないの同一時点では、直線軸
の位置も回転軸の位置も、どの周期においても同一であ
ることが望ましい。すなわち、回転軸の位置と直線軸の
位置は同期して各周期Ｌないで同一対応関係にあること
が望ましい。この対応関係がずれると、同一パターンで
直線軸に対して指令を出しても、加工された加工物３０
の形状は各周期毎ことなることになり、常に一定の同一
形状を得ることができなくなる。
１周期Ｌとし、直線軸が同一パターンで繰り返される場
合等においては、該１周期ないの同一時点では、直線軸
の位置も回転軸の位置も、どの周期においても同一であ
ることが望ましい。すなわち、回転軸の位置と直線軸の
位置は同期して各周期Ｌないで同一対応関係にあること
が望ましい。この対応関係がずれると、同一パターンで
直線軸に対して指令を出しても、加工された加工物３０
の形状は各周期毎ことなることになり、常に一定の同一
形状を得ることができなくなる。
【０００９】上述したように、従来の繰り返し制御方式
では、時間を仲介として、上記所定周期ないのある時点
においては、回転軸の位置も直線軸の位置も、所定対応
位置にあるものとして繰り返し制御を行っている。しか
しながら、回転軸を高精度に制御することが難しいこと
から、回転軸と直線軸の対応関係がずれる場合が生じ、
常に同一形状の加工物形状を得ることは難しい。
では、時間を仲介として、上記所定周期ないのある時点
においては、回転軸の位置も直線軸の位置も、所定対応
位置にあるものとして繰り返し制御を行っている。しか
しながら、回転軸を高精度に制御することが難しいこと
から、回転軸と直線軸の対応関係がずれる場合が生じ、
常に同一形状の加工物形状を得ることは難しい。
【００１０】そこで、本発明の目的は、回転軸と直線軸
を位置を仲介として同期を取り、回転軸と直線軸の対応
位置関係のずれを防止する回転軸同期繰り返し制御方式
を提供することにある。
を位置を仲介として同期を取り、回転軸と直線軸の対応
位置関係のずれを防止する回転軸同期繰り返し制御方式
を提供することにある。
【００１１】
【課題を解決するための手段】本発明は、予め、回転軸
の回転位置に対する繰り返し所定周期Ｌ内のサーボモー
タに対する位置指令を記憶しておき、サンプリング時毎
、上記回転軸の回転位置を読み取り、上記記憶手段より
該読み取った回転位置に対する上記位置指令を求め、該
位置指令を上記繰り返しコントローラの処理およびサー
ボ制御処理に対する位置指令としてサーボモータを制御
することによって上記課題を解決した。
の回転位置に対する繰り返し所定周期Ｌ内のサーボモー
タに対する位置指令を記憶しておき、サンプリング時毎
、上記回転軸の回転位置を読み取り、上記記憶手段より
該読み取った回転位置に対する上記位置指令を求め、該
位置指令を上記繰り返しコントローラの処理およびサー
ボ制御処理に対する位置指令としてサーボモータを制御
することによって上記課題を解決した。
【００１２】
【作用】回転軸の回転位置を読み取り、記憶手段に記憶
した回転位置に対するサーボモータの位置を補間によっ
て求めサーボモータに対する位置指令とする。この位置
指令からサーボモータの現在位置を減じて位置偏差を求
め、当該回転位置までの繰り返しコントローラの処理を
行ない、位置偏差を補正し、補正された位置偏差によっ
て位置・速度ループの処理を行なってサーボモータを駆
動制御する。
した回転位置に対するサーボモータの位置を補間によっ
て求めサーボモータに対する位置指令とする。この位置
指令からサーボモータの現在位置を減じて位置偏差を求
め、当該回転位置までの繰り返しコントローラの処理を
行ない、位置偏差を補正し、補正された位置偏差によっ
て位置・速度ループの処理を行なってサーボモータを駆
動制御する。
【００１３】
【実施例】図２は本発明の一実施例を実施する工作機械
のサーボモータ制御の要部ブロック図で、図中、２０は
工作機械を制御する数値制御装置、２１は該数値制御装
置２０から出力されるサーボモータへの各種指令等を受
信し、デジタルサーボ回路２２のプロセッサに受け渡す
ための共有メモリ、２２はデジタルサーボ回路であり、
プロセッサ，ＲＯＭ，ＲＡＭ等で構成され、プロセッサ
によって直線軸を駆動するサーボモータ２４の位置，速
度，電流制御などを行うと共に繰り返し制御等の処理を
も行うものである。２３はトランジスタインバータ等で
構成されるサーボアンプ、２４は直線軸を駆動するサー
ボモータ、２５はサーボモータ２４の回転位置を検出し
デジタルサーボ回路２２にフィードバックする位置検出
器としてのパルスコーダである。また、２６は回転軸を
駆動するモータで、２７は該回転軸の回転位置を検出す
る位置検出器としてのパルスコーダである。
のサーボモータ制御の要部ブロック図で、図中、２０は
工作機械を制御する数値制御装置、２１は該数値制御装
置２０から出力されるサーボモータへの各種指令等を受
信し、デジタルサーボ回路２２のプロセッサに受け渡す
ための共有メモリ、２２はデジタルサーボ回路であり、
プロセッサ，ＲＯＭ，ＲＡＭ等で構成され、プロセッサ
によって直線軸を駆動するサーボモータ２４の位置，速
度，電流制御などを行うと共に繰り返し制御等の処理を
も行うものである。２３はトランジスタインバータ等で
構成されるサーボアンプ、２４は直線軸を駆動するサー
ボモータ、２５はサーボモータ２４の回転位置を検出し
デジタルサーボ回路２２にフィードバックする位置検出
器としてのパルスコーダである。また、２６は回転軸を
駆動するモータで、２７は該回転軸の回転位置を検出す
る位置検出器としてのパルスコーダである。
【００１４】上記構成は工作機械等のサーボモータの制
御における公知のデジタルサーボ回路の構成と同一であ
るが、従来のものと相違する点は、回転軸のパルスコー
ダからディジタル回路２２が、回転軸の回転位置を受信
するようになっている点が相違し、また、従来のディジ
タルサーボ制御においては直線軸モータであるサーボモ
ータ２４に対する位置指令が、数値制御装置２０から共
有メモリ２１を介してディジタルサーボ回路２２に送ら
れてくる点が、本発明は、回転軸のパルスコーダ２７か
ら送られてくる回転軸の回転位置より、ディジタルサー
ボ回路２２のプロセッサが位置指令を作り出している点
が相違する。
御における公知のデジタルサーボ回路の構成と同一であ
るが、従来のものと相違する点は、回転軸のパルスコー
ダからディジタル回路２２が、回転軸の回転位置を受信
するようになっている点が相違し、また、従来のディジ
タルサーボ制御においては直線軸モータであるサーボモ
ータ２４に対する位置指令が、数値制御装置２０から共
有メモリ２１を介してディジタルサーボ回路２２に送ら
れてくる点が、本発明は、回転軸のパルスコーダ２７か
ら送られてくる回転軸の回転位置より、ディジタルサー
ボ回路２２のプロセッサが位置指令を作り出している点
が相違する。
【００１５】すなわち、ディジタルサーボ回路２２のＲ
ＡＭ（若しくはＲＯＭ）には、予め、図３に示すように
、繰り返し周期１周期Ｌ内の回転軸の位置θｉとこの回
転位置θｉに対応する直線軸の位置ｒｉをｎ分割して（
ｉ＝１〜ｎ）、テーブルＴＢとして作成し、記憶させて
おく。そして、回転軸のパルスコーダ２７から回転軸の
回転位置θ（ｔ）が入力されると、このテーブルより内
挿補間して直線軸の位置ｒ（θｔ）を求め、このこの位
置ｒ（θｔ）を直線軸のサーボモータの指令位置とする
ものである。
ＡＭ（若しくはＲＯＭ）には、予め、図３に示すように
、繰り返し周期１周期Ｌ内の回転軸の位置θｉとこの回
転位置θｉに対応する直線軸の位置ｒｉをｎ分割して（
ｉ＝１〜ｎ）、テーブルＴＢとして作成し、記憶させて
おく。そして、回転軸のパルスコーダ２７から回転軸の
回転位置θ（ｔ）が入力されると、このテーブルより内
挿補間して直線軸の位置ｒ（θｔ）を求め、このこの位
置ｒ（θｔ）を直線軸のサーボモータの指令位置とする
ものである。
【００１６】図１は直線軸のサーボモータを駆動制御す
るディジタルサーボ回路２２が実施する繰り返し制御を
伴うサーボ制御のブロック線図で、図９に示す従来の繰
り返し制御と相違する点は、補間Ａ，Ｂ，Ｃを行う要素
１，４，５が加わっていること、および、位置指令ｒ（
θｔ）が補間Ａによって作り出され、数値制御装置から
の指令ではない点が相違する。また、繰り返しコントロ
ーラ３の遅れ要素７としては、上記繰り返し周期の１周
期Ｌを分割したｎの数だけのメモリが遅れ要素として設
けられている。
るディジタルサーボ回路２２が実施する繰り返し制御を
伴うサーボ制御のブロック線図で、図９に示す従来の繰
り返し制御と相違する点は、補間Ａ，Ｂ，Ｃを行う要素
１，４，５が加わっていること、および、位置指令ｒ（
θｔ）が補間Ａによって作り出され、数値制御装置から
の指令ではない点が相違する。また、繰り返しコントロ
ーラ３の遅れ要素７としては、上記繰り返し周期の１周
期Ｌを分割したｎの数だけのメモリが遅れ要素として設
けられている。
【００１７】各サンプリング周期（直線軸の位置・速度
制御周期）Ｔ毎、回転軸の回転位置θ（ｔ）を読み取り
、上記テーブルＴＢより、該回転位置θ（ｔ）に対する
直線軸の位置ｒ（θｔ）を補間Ａを行って求める。この
補間Ａの処理を、例えば直線補間を行うとすれば、図４
に示すように、例えば、回転位置θ（ｔ）が上記テーブ
ルＴＢに記憶するθｍとθｍ＋１ 間にあるとすると、
テーブルＴＢよりこの回転位置θｍとθｍ＋１ 対応す
る直線軸の位置ｒｍとｒｍ＋１ を読み取り、次の第１
式の演算を行って回転位置θ（ｔ）に対応する直線軸の
位置ｒ（θｔ）を求める。 ｒ（θｔ）＝ｒｍ＋（θ（ｔ） −θｍ）・（ｒｍ＋１
−ｒｍ）／（θｍ＋１ −θｍ）
…（１） そして、この演算によって求められ
た、位置ｒ（θｔ）を位置指令とし、パルスコーダ２５
からのフィードバック信号である直線軸の位置ｙ（ｔ）
をこの指令位置ｒ（θｔ）から減じて位置偏差ε（θｔ
）を求める。
制御周期）Ｔ毎、回転軸の回転位置θ（ｔ）を読み取り
、上記テーブルＴＢより、該回転位置θ（ｔ）に対する
直線軸の位置ｒ（θｔ）を補間Ａを行って求める。この
補間Ａの処理を、例えば直線補間を行うとすれば、図４
に示すように、例えば、回転位置θ（ｔ）が上記テーブ
ルＴＢに記憶するθｍとθｍ＋１ 間にあるとすると、
テーブルＴＢよりこの回転位置θｍとθｍ＋１ 対応す
る直線軸の位置ｒｍとｒｍ＋１ を読み取り、次の第１
式の演算を行って回転位置θ（ｔ）に対応する直線軸の
位置ｒ（θｔ）を求める。 ｒ（θｔ）＝ｒｍ＋（θ（ｔ） −θｍ）・（ｒｍ＋１
−ｒｍ）／（θｍ＋１ −θｍ）
…（１） そして、この演算によって求められ
た、位置ｒ（θｔ）を位置指令とし、パルスコーダ２５
からのフィードバック信号である直線軸の位置ｙ（ｔ）
をこの指令位置ｒ（θｔ）から減じて位置偏差ε（θｔ
）を求める。
【００１８】次に、当該サンプリング時の回転軸の位置
θ（ｔ），位置偏差ε（θｔ）および１つ前のサンプリ
ング時の位置θ（ｔ−Ｔ）と位置偏差ε（θ（ｔ−Ｔ）
）より、当該サンプリング期間における各分割回転位置
θｉ（θｉは１つ前のサンプリング時の位置θ（ｔ−Ｔ
）が存在する次の回転位置から当該サンプリング時の回
転位置θ（ｔ）が存在する回転位置までの回転位置）に
対応する位置偏差εｉを補間Ｂで求める。
θ（ｔ），位置偏差ε（θｔ）および１つ前のサンプリ
ング時の位置θ（ｔ−Ｔ）と位置偏差ε（θ（ｔ−Ｔ）
）より、当該サンプリング期間における各分割回転位置
θｉ（θｉは１つ前のサンプリング時の位置θ（ｔ−Ｔ
）が存在する次の回転位置から当該サンプリング時の回
転位置θ（ｔ）が存在する回転位置までの回転位置）に
対応する位置偏差εｉを補間Ｂで求める。
【００１９】図５はこの補間Ｂの処理の説明図で、当該
サンプリング時の回転位置θ（ｔ）がテーブルＴＢに記
憶するθｍとθｍ＋１ 間にあり、１つ前のサンプリン
グ時（ｔ−Ｔ）時の回転位置θ（ｔ−Ｔ）はθｋとθｋ
＋１ 間にあったとすると、回転位置θｋ＋１ からθ
ｍまでの回転位置θｉ（ｉ＝ｋ＋１〜ｍ）に対応する位
置偏差ε（θｉ）を例えば次の第２式により直線補間し
て求める。 ε（θｉ）＝ε（θ （ｔ−Ｔ）） ＋
（θｉ−θ（ｔ−Ｔ））・｛ ε（θｔ）− ε（
θ（ｔ−Ｔ））｝ ／（θ（ｔ）−θ（ｔ−Ｔ））
…（２）そして、この求められた
位置偏差ε（θｉ）に遅れ要素に記憶する繰り返し周期
Ｌの１周期前のデータｘを加算し、フィルタ処理（要素
６の処理）を行って、かつ、遅れ要素７を１つシフトし
、遅れ要素７の１番目のメモリにフイルタ処理を行った
データを格納する。以下、ｉがｋ＋１からｍになるまで
の位置偏差ε（θ（ｋ＋１） 〜ε（θｍ）を順次求め
上述した処理を行う。
サンプリング時の回転位置θ（ｔ）がテーブルＴＢに記
憶するθｍとθｍ＋１ 間にあり、１つ前のサンプリン
グ時（ｔ−Ｔ）時の回転位置θ（ｔ−Ｔ）はθｋとθｋ
＋１ 間にあったとすると、回転位置θｋ＋１ からθ
ｍまでの回転位置θｉ（ｉ＝ｋ＋１〜ｍ）に対応する位
置偏差ε（θｉ）を例えば次の第２式により直線補間し
て求める。 ε（θｉ）＝ε（θ （ｔ−Ｔ）） ＋
（θｉ−θ（ｔ−Ｔ））・｛ ε（θｔ）− ε（
θ（ｔ−Ｔ））｝ ／（θ（ｔ）−θ（ｔ−Ｔ））
…（２）そして、この求められた
位置偏差ε（θｉ）に遅れ要素に記憶する繰り返し周期
Ｌの１周期前のデータｘを加算し、フィルタ処理（要素
６の処理）を行って、かつ、遅れ要素７を１つシフトし
、遅れ要素７の１番目のメモリにフイルタ処理を行った
データを格納する。以下、ｉがｋ＋１からｍになるまで
の位置偏差ε（θ（ｋ＋１） 〜ε（θｍ）を順次求め
上述した処理を行う。
【００２０】また、要素５の補間Ｃで、θｍとθｍ＋１
に対応する補正量ｄ（θｍ），ｄ（θｍ＋１ ）より
次の第３式を演算して補正値ｄ（θｔ）を求める。 ｄ（θｔ）＝ｄ（θｍ ）＋ （θ（ｔ） −θｍ ）・｛ｄ（θｍ
＋１）−ｄ（θｍ）｝／（θｍ＋１ −θｍ ）
…（３）こうして求められた、補正
値ｄ（θｔ）を位置偏差ε（θｔ）に加算し、繰り返し
コントローラ３で補正された位置偏差を求め、位置、速
度ループ処理を行いサーボモータ２４を駆動する。その
結果、回転軸の位置に応じて対応する直線軸の位置が位
置指令として入力され、この指令に基づいて繰り返しコ
ントローラ３および位置・速度ループ処理が行われ、サ
ーボモータが駆動制御されることになるので、回転軸と
直線軸の同期が位置によってとられ、回転軸の速度が変
動しても、位置関係のずれが生じることがなく、高精度
の加工ができる。
に対応する補正量ｄ（θｍ），ｄ（θｍ＋１ ）より
次の第３式を演算して補正値ｄ（θｔ）を求める。 ｄ（θｔ）＝ｄ（θｍ ）＋ （θ（ｔ） −θｍ ）・｛ｄ（θｍ
＋１）−ｄ（θｍ）｝／（θｍ＋１ −θｍ ）
…（３）こうして求められた、補正
値ｄ（θｔ）を位置偏差ε（θｔ）に加算し、繰り返し
コントローラ３で補正された位置偏差を求め、位置、速
度ループ処理を行いサーボモータ２４を駆動する。その
結果、回転軸の位置に応じて対応する直線軸の位置が位
置指令として入力され、この指令に基づいて繰り返しコ
ントローラ３および位置・速度ループ処理が行われ、サ
ーボモータが駆動制御されることになるので、回転軸と
直線軸の同期が位置によってとられ、回転軸の速度が変
動しても、位置関係のずれが生じることがなく、高精度
の加工ができる。
【００２１】図６は所定サンプリング周期毎、ディジタ
ルサーボ回路のプロセッサが行う上記処理のフローチャ
ートである。まず、加工開始指令時に初期設定が行われ
、プロセッサは、繰り返しコントローラ３の遅れ要素に
対応するメモリＭ１〜Ｍｎ、および１サンプリング前の
回転位置θ（ｔ），位置偏差ε（θｔ），回転位置が存
在するテーブルＴＢ上の位置を示す上記ｍの値を記憶す
るレジスタＲθ，Ｒε，Ｒｍ が「０」に初期設定し、
図６に示す処理をサンプリング周期毎実施する。
ルサーボ回路のプロセッサが行う上記処理のフローチャ
ートである。まず、加工開始指令時に初期設定が行われ
、プロセッサは、繰り返しコントローラ３の遅れ要素に
対応するメモリＭ１〜Ｍｎ、および１サンプリング前の
回転位置θ（ｔ），位置偏差ε（θｔ），回転位置が存
在するテーブルＴＢ上の位置を示す上記ｍの値を記憶す
るレジスタＲθ，Ｒε，Ｒｍ が「０」に初期設定し、
図６に示す処理をサンプリング周期毎実施する。
【００２２】まず、プロセッサはパルスコーダ２５，２
７から出力される回転軸の位置フィードバックθ（ｔ）
および直線軸の位置フィードバックｙ（ｔ）を読み取る
（ステップＳ１）。次に上記読み取った回転軸の位置θ
（ｔ）に対応するテーブルに記憶した回転位置を求める
。すなわたθｍ≦θ（ｔ）＜θｍ＋１ となるテープル
ＴＢのポインタｍを探す（ステップＳ２）。このポイン
タｍが検出されると、ポインタｍおよびｍ＋１に記憶さ
れている回転位置θｍ，θｍ＋１ および直線軸の位置
ｒｍ，ｒｍ＋１ をテーブルＴＢより読みだし、第１式
演算を行い指令位置ｒ（θｔ）を求める（補間Ａの処理
）（ステップＳ３）。
７から出力される回転軸の位置フィードバックθ（ｔ）
および直線軸の位置フィードバックｙ（ｔ）を読み取る
（ステップＳ１）。次に上記読み取った回転軸の位置θ
（ｔ）に対応するテーブルに記憶した回転位置を求める
。すなわたθｍ≦θ（ｔ）＜θｍ＋１ となるテープル
ＴＢのポインタｍを探す（ステップＳ２）。このポイン
タｍが検出されると、ポインタｍおよびｍ＋１に記憶さ
れている回転位置θｍ，θｍ＋１ および直線軸の位置
ｒｍ，ｒｍ＋１ をテーブルＴＢより読みだし、第１式
演算を行い指令位置ｒ（θｔ）を求める（補間Ａの処理
）（ステップＳ３）。
【００２３】次に、該指令位置ｒ（θｔ）からステップ
Ｓ１で読み取った直線軸の位置ｙ（ｔ）を減じて位置偏
差ε（θｔ）を求め（ステップＳ５）、レジスタＲｍ
に記憶する値（加工開始最初のサンプリング時には「０
」が記憶されている）に「１」加算した値を指標ｉにセ
ットし（ステップＳ５）、レジスタＲθ，Ｒεに記憶す
る１サンプリング前のデータ（加工開始時の最初のサン
プリング時には「０」）とステップＳ１，Ｓ４で求めた
回転位置θ（ｔ）と位置偏差ε（θｔ）より第２式の演
算を行って、前サンプリング時と当該サンプリング時の
間における指標ｉで示される回転位置θｉに対応する位
置偏差ε（θｉ）を求める（ステップＳ６）。
Ｓ１で読み取った直線軸の位置ｙ（ｔ）を減じて位置偏
差ε（θｔ）を求め（ステップＳ５）、レジスタＲｍ
に記憶する値（加工開始最初のサンプリング時には「０
」が記憶されている）に「１」加算した値を指標ｉにセ
ットし（ステップＳ５）、レジスタＲθ，Ｒεに記憶す
る１サンプリング前のデータ（加工開始時の最初のサン
プリング時には「０」）とステップＳ１，Ｓ４で求めた
回転位置θ（ｔ）と位置偏差ε（θｔ）より第２式の演
算を行って、前サンプリング時と当該サンプリング時の
間における指標ｉで示される回転位置θｉに対応する位
置偏差ε（θｉ）を求める（ステップＳ６）。
【００２４】次に、メモリＭｎに記憶する１周期Ｌ前の
データに動特性補償要素８の係数Ｇｘを乗じて補正量ｄ
（θｍ）を記憶するレジスタに格納する（ステップＳ７
）。そして、メモリＭｎのデータをステップＳ６で求め
た位置偏差ε（θｉ）に加算しフイルタ処理（要素６の
処理）を行ない、メモリＭ１〜Ｍｎをシフトし（Ｍｎ←
Ｍｎ−１ ，…Ｍ２←Ｍ１）、メモリＭ１に上記フイル
タ処理したデータを格納する（ステップＳ８）。次に、
指標ｉがポインタｍに等しいか否か判断し（ステップＳ
９）等しくなければ、指標ｉを「１」インクリメントし
（ステップＳ１０）、ステップＳ６〜Ｓ１０を繰り返し
、指標ｉがポインタｍと等しくなるとステップＳ１１に
移行する。
データに動特性補償要素８の係数Ｇｘを乗じて補正量ｄ
（θｍ）を記憶するレジスタに格納する（ステップＳ７
）。そして、メモリＭｎのデータをステップＳ６で求め
た位置偏差ε（θｉ）に加算しフイルタ処理（要素６の
処理）を行ない、メモリＭ１〜Ｍｎをシフトし（Ｍｎ←
Ｍｎ−１ ，…Ｍ２←Ｍ１）、メモリＭ１に上記フイル
タ処理したデータを格納する（ステップＳ８）。次に、
指標ｉがポインタｍに等しいか否か判断し（ステップＳ
９）等しくなければ、指標ｉを「１」インクリメントし
（ステップＳ１０）、ステップＳ６〜Ｓ１０を繰り返し
、指標ｉがポインタｍと等しくなるとステップＳ１１に
移行する。
【００２５】その結果、ステップＳ７の処理でレジスタ
に記憶される補正量は回転位置θｍに対応する補正量ｄ
（θｍ）となる。そしてステップＳ１１でメモリＭｎに
記憶するデータに動特性補償要素８の係数Ｇｘを乗じて
回転位置θｍ＋１ に対応する補正量ｄ（θｍ＋１ ）
を求め、回転位置θｍ，θｍ＋１ ，補正量ｄ（θｍ）
，ｄ（θｍ＋１ ）より第３式の演算を行なうことによ
って補正量ｄ（θｔ）を求め（ステップＳ１２）、当該
サンプリング時の回転位置θ（ｔ），位置偏差ε（θｔ
）およびポインタの値ｍをレジスタＲθ，Ｒε，Ｒｍ
に格納する（ステップＳ１３）。そして、ステップＳ３
で求めた位置偏差ε（θｔ）にステップＳ１２で求めた
補正量ｄ（θｔ）を加算して、繰り返しコントローラ３
の処理による補正量で補正された位置偏差を求めこの位
置偏差により、位置・速度ループの処理を行ない（ステ
ップＳ１４，Ｓ１５）、当該サンプリング時の処理を終
了する。
に記憶される補正量は回転位置θｍに対応する補正量ｄ
（θｍ）となる。そしてステップＳ１１でメモリＭｎに
記憶するデータに動特性補償要素８の係数Ｇｘを乗じて
回転位置θｍ＋１ に対応する補正量ｄ（θｍ＋１ ）
を求め、回転位置θｍ，θｍ＋１ ，補正量ｄ（θｍ）
，ｄ（θｍ＋１ ）より第３式の演算を行なうことによ
って補正量ｄ（θｔ）を求め（ステップＳ１２）、当該
サンプリング時の回転位置θ（ｔ），位置偏差ε（θｔ
）およびポインタの値ｍをレジスタＲθ，Ｒε，Ｒｍ
に格納する（ステップＳ１３）。そして、ステップＳ３
で求めた位置偏差ε（θｔ）にステップＳ１２で求めた
補正量ｄ（θｔ）を加算して、繰り返しコントローラ３
の処理による補正量で補正された位置偏差を求めこの位
置偏差により、位置・速度ループの処理を行ない（ステ
ップＳ１４，Ｓ１５）、当該サンプリング時の処理を終
了する。
【００２６】以下各サンプリング時毎に上記処理を実行
しすることになるが、始めは、繰り返しコントローラ３
の遅れ要素７の各メモリＭ１〜Ｍｎおよび１サンプリン
グ時のデータを記憶する各レジスタＲθ，Ｒε，Ｒｍ
の値は初期設定で「０」であるが、少なくとも繰り返し
周期の１周期Ｌを経過するとこれらの値は「０」ではな
くなり、回転軸の位置に同期して直線軸の位置が制御さ
れることになる。
しすることになるが、始めは、繰り返しコントローラ３
の遅れ要素７の各メモリＭ１〜Ｍｎおよび１サンプリン
グ時のデータを記憶する各レジスタＲθ，Ｒε，Ｒｍ
の値は初期設定で「０」であるが、少なくとも繰り返し
周期の１周期Ｌを経過するとこれらの値は「０」ではな
くなり、回転軸の位置に同期して直線軸の位置が制御さ
れることになる。
【００２７】
【発明の効果】本発明は、同一パターンの動作を繰り返
し行なうサーボモータを回転軸の位置に同期して制御す
るようにしたから、回転軸が回転むらや一定のオフセッ
トをもつ場合でも、加工物の精度は向上する。
し行なうサーボモータを回転軸の位置に同期して制御す
るようにしたから、回転軸が回転むらや一定のオフセッ
トをもつ場合でも、加工物の精度は向上する。
【００２８】そのため、回転軸のモータに対して位置制
御を行なう必要がないので、速度制御のみを行なうスピ
ンドルモータを使用することができる。
御を行なう必要がないので、速度制御のみを行なうスピ
ンドルモータを使用することができる。
【図１】本発明の一実施例のブロック線図である。
【図２】同実施例を実施する工作機械の要部ブロック図
である。
である。
【図３】同実施例においてディジタルサーボ回路の記憶
装置に記憶する回転位置と直線軸の位置の関係を記憶す
るテーブルの一例を示す図である。
装置に記憶する回転位置と直線軸の位置の関係を記憶す
るテーブルの一例を示す図である。
【図４】同実施例における回転位置から直線軸の位置を
直線補間で求める説明図である。
直線補間で求める説明図である。
【図５】同実施例におけるテーブルに記憶した回転位置
に対応する位置偏差を直線補間で求める説明図である。
に対応する位置偏差を直線補間で求める説明図である。
【図６】同実施例におけるディジタルサーボ回路のプロ
セッサが実施する処理のフローチャートである。
セッサが実施する処理のフローチャートである。
【図７】本発明を適用する加工の一例を示すブロック図
である。
である。
【図８】同実施例における回転軸と直線軸の動作の説明
図である。
図である。
【図９】従来の繰り返しコントローラによる制御のブロ
ック線図である。
ック線図である。
１ 補間Ａの要素
２ 制御対象の伝達関数の要素
３ 繰り返しコントローラ
４ 補間Ｂの要素
５ 補間Ｃの要素
６ 帯域制限フィルタ
７ 遅れ要素
８ 動特性補償要素
Claims (2)
- 【請求項１】 繰り返しコントローラを有し、回転軸
を駆動すると共に、所定周期で繰り返される位置指令に
よって回転軸に同期してサーボモータを制御するサーボ
モータの制御方式において、予め、上記回転軸の回転位
置に対する上記所定周期の位置指令を記憶しておき、サ
ンプリング時毎、上記回転軸の回転位置を読み取り、上
記記憶手段より該読み取った回転位置に対する上記位置
指令を求め、該位置指令を上記繰り返しコントローラの
処理およびサーボ制御処理に対する位置指令としてサー
ボモータを制御する回転軸同期繰り返し制御方式。 - 【請求項２】 読み取った回転位置が存在する区間を
上記記憶手段より読み取り、該区間の両端の回転位置，
サーボモータへの指令位置より補間して回転位置に対す
る指令位置を求め、この指令位置より位置偏差を求め、
前サンプリング時の回転位置と位置偏差および当該サン
プリング時の回転位置と位置偏差より、記憶手段に記憶
する各回転位置に対する位置偏差を補間して求め、繰り
返しコントローラの処理を行って得られる当該サンプリ
ング時の回転位置が存在する区間の記憶手段に記憶する
両端の回転位置に対する補正量より、当該サンプリング
時の補正量を補間して求め、位置偏差を補正する請求項
１記載の回転軸同期繰り返し制御方式。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP3119073A JP2757269B2 (ja) | 1991-04-24 | 1991-04-24 | 回転軸同期繰り返し制御方法及び装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP3119073A JP2757269B2 (ja) | 1991-04-24 | 1991-04-24 | 回転軸同期繰り返し制御方法及び装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH04323705A true JPH04323705A (ja) | 1992-11-12 |
| JP2757269B2 JP2757269B2 (ja) | 1998-05-25 |
Family
ID=14752214
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP3119073A Expired - Fee Related JP2757269B2 (ja) | 1991-04-24 | 1991-04-24 | 回転軸同期繰り返し制御方法及び装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2757269B2 (ja) |
Cited By (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6859007B2 (en) | 2003-01-20 | 2005-02-22 | Fanuc Ltd | Servo motor drive control device |
| EP1566713A3 (en) * | 2004-01-30 | 2007-12-26 | Fanuc Ltd | Threading/tapping control apparatus |
| JP2011234603A (ja) * | 2010-04-09 | 2011-11-17 | Canon Inc | 振動型アクチュエータの制御回路 |
| CN102298347A (zh) * | 2011-05-26 | 2011-12-28 | 清华大学 | 基于虚拟位置域重复控制器的控制方法 |
| JP2014035629A (ja) * | 2012-08-08 | 2014-02-24 | Okuma Corp | 高速同期軸位置制御装置 |
| JP2014048953A (ja) * | 2012-08-31 | 2014-03-17 | Okuma Corp | 繰返し学習位置制御装置 |
| WO2014073365A1 (ja) * | 2012-11-07 | 2014-05-15 | カルソニックカンセイ株式会社 | 電動コンプレッサの制御装置 |
| WO2016148116A1 (ja) * | 2015-03-18 | 2016-09-22 | シチズンホールディングス株式会社 | 工作機械及びこの工作機械の制御装置 |
| JP2019096219A (ja) * | 2017-11-27 | 2019-06-20 | ファナック株式会社 | 工作機械の制御装置 |
| CN117955372A (zh) * | 2024-03-27 | 2024-04-30 | 珠海格力电器股份有限公司 | 电机的控制方法及装置、电子设备和存储介质 |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS53141990A (en) * | 1977-05-16 | 1978-12-11 | Okuma Mach Works Ltd | Special screw cutting system |
| JPS6089201A (ja) * | 1983-10-20 | 1985-05-20 | Nissin Electric Co Ltd | 数値制御装置 |
| JPH02256417A (ja) * | 1989-03-30 | 1990-10-17 | Okuma Mach Works Ltd | ねじ切り制御方法及びその装置 |
-
1991
- 1991-04-24 JP JP3119073A patent/JP2757269B2/ja not_active Expired - Fee Related
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS53141990A (en) * | 1977-05-16 | 1978-12-11 | Okuma Mach Works Ltd | Special screw cutting system |
| JPS6089201A (ja) * | 1983-10-20 | 1985-05-20 | Nissin Electric Co Ltd | 数値制御装置 |
| JPH02256417A (ja) * | 1989-03-30 | 1990-10-17 | Okuma Mach Works Ltd | ねじ切り制御方法及びその装置 |
Cited By (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6859007B2 (en) | 2003-01-20 | 2005-02-22 | Fanuc Ltd | Servo motor drive control device |
| EP1439440A3 (en) * | 2003-01-20 | 2007-10-31 | Fanuc Ltd | Servo motor drive control device |
| EP1566713A3 (en) * | 2004-01-30 | 2007-12-26 | Fanuc Ltd | Threading/tapping control apparatus |
| JP2011234603A (ja) * | 2010-04-09 | 2011-11-17 | Canon Inc | 振動型アクチュエータの制御回路 |
| CN102298347A (zh) * | 2011-05-26 | 2011-12-28 | 清华大学 | 基于虚拟位置域重复控制器的控制方法 |
| JP2014035629A (ja) * | 2012-08-08 | 2014-02-24 | Okuma Corp | 高速同期軸位置制御装置 |
| JP2014048953A (ja) * | 2012-08-31 | 2014-03-17 | Okuma Corp | 繰返し学習位置制御装置 |
| JP2014093928A (ja) * | 2012-11-07 | 2014-05-19 | Calsonic Kansei Corp | 電動コンプレッサの制御装置 |
| WO2014073365A1 (ja) * | 2012-11-07 | 2014-05-15 | カルソニックカンセイ株式会社 | 電動コンプレッサの制御装置 |
| CN104769836A (zh) * | 2012-11-07 | 2015-07-08 | 康奈可关精株式会社 | 电动压缩机的控制装置 |
| US9991835B2 (en) | 2012-11-07 | 2018-06-05 | Calsonic Kansei Corporation | Control device for electric compressor |
| WO2016148116A1 (ja) * | 2015-03-18 | 2016-09-22 | シチズンホールディングス株式会社 | 工作機械及びこの工作機械の制御装置 |
| JPWO2016148116A1 (ja) * | 2015-03-18 | 2018-01-11 | シチズン時計株式会社 | 工作機械及びこの工作機械の制御装置 |
| JP2019096219A (ja) * | 2017-11-27 | 2019-06-20 | ファナック株式会社 | 工作機械の制御装置 |
| US10866574B2 (en) | 2017-11-27 | 2020-12-15 | Fanuc Corporation | Machine tool controller with learning error compensation |
| CN117955372A (zh) * | 2024-03-27 | 2024-04-30 | 珠海格力电器股份有限公司 | 电机的控制方法及装置、电子设备和存储介质 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2757269B2 (ja) | 1998-05-25 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4361071B2 (ja) | サーボ制御装置 | |
| US5404308A (en) | Numerical control (NC) device to control feed speed of tool based on speed of spindle and amount of change of spindle speed | |
| EP0012620A2 (en) | Closed loop type numerical-controlled machine tool | |
| EP1967924A1 (en) | Apparatus for synchronously controlling a plurality of servomotors | |
| EP0553356B1 (en) | Method and apparatus for prediction repetition control of servo motor | |
| US6823235B2 (en) | Controller for machining gears | |
| WO2000039646A1 (en) | Numerical control device | |
| JP2000250614A (ja) | バックラッシ補正装置および数値制御システム | |
| JPH04323705A (ja) | 回転軸同期繰り返し制御方法及び装置 | |
| JPH03271813A (ja) | Ｎｃ装置 | |
| JPH0736514A (ja) | ３次元工具径補正方式 | |
| JPH0239303A (ja) | 追従誤差の検出機能を持った数値制御装置 | |
| EP0364593B1 (en) | Machine tool having two main spindles | |
| JP4193799B2 (ja) | ネジ切り制御方法及びその装置 | |
| US5479353A (en) | System for correcting tool deformation amount | |
| US5313403A (en) | Numerical control apparatus having a circular interpolation locus display function and control method thereof | |
| JPH02309401A (ja) | 数値制御装置 | |
| JPH03157704A (ja) | 機械位置変動の位置補正方式 | |
| JPS59182003A (ja) | 異形形状形成装置 | |
| EP0540761A1 (en) | Method of controlling backlash acceleration | |
| KR960007510B1 (ko) | 2개의 서어보계간의 추종제어 방식 | |
| JP2800124B2 (ja) | 数値制御工作機械の制御方法及びそのための制御装置 | |
| JPS6377638A (ja) | 数値制御工作機械 | |
| JPH0887312A (ja) | 円筒補間方式 | |
| JPH07100281B2 (ja) | 数値制御工作機械 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080313 Year of fee payment: 10 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090313 Year of fee payment: 11 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100313 Year of fee payment: 12 |
|
| LAPS | Cancellation because of no payment of annual fees |