(57)【特許請求の範囲】
【請求項１】
同一の位置指令に基づいて複数のサーボモータを同期駆動して１つの可動部の動作を制御するための同期制御装置であって、
前記複数のサーボモータのそれぞれに対応して設けられ、入力された位置指令に基づいて各サーボモータの制御をそれぞれ行うサーボコントローラと、
前記サーボコントローラに対応して設けられ、前記位置指令に基づいて、モデルトルク情報、モデル速度情報、モデル位置情報を生成し、生成した前記モデルトルク情報と、対応して設けられたサーボコントローラにおけるモータトルク情報との差に一定のゲインを乗算して位相補償をした信号を該サーボコントローラにおけるトルク指令に帰還し、生成した前記モデル速度情報と、対応して設けられた前記サーボコントローラにおけるモータ速度情報との差に一定のゲインを乗算して位相補償をした信号を該サーボコントローラにおける速度指令に帰還し、生成した前記モデル位置情報と、対応して設けられたサーボコントローラにおけるモータ位置情報との差に一定のゲインを乗算した信号を該サーボコントローラに入力された前記位置指令に加算するモータ制御装置モデルと、
を備えた同期制御装置。
【請求項２】
前記モータ制御装置モデルが、
入力された前記位置指令からモデル位置情報を減算して出力する第１の減算器と、
前記第１の減算器からの出力に位置ゲインを乗算してモデル速度指令として出力するモデル乗算器と、
前記モデル乗算器からのモデル速度指令から前記モデル速度情報を減算して出力する第２の減算器と、
前記第２の減算器からの出力を積分することにより得られたモデルトルク情報を出力する第１のモデル積分器と、
前記第１のモデル積分器からのモデルトルク情報に、サーボモータ、負荷および速度ゲインを表した伝達関数を乗算することにより得られたモデル速度情報を出力するモデル速度制御部と、
前記モデル速度制御部からのモデル速度情報に対して積分演算を行うことにより得られたモデル位置情報を出力する第２のモデル積分器と、
前記第２のモデル積分器からのモデル位置情報から、対応するサーボコントローラにより制御されるサーボモータのモータ位置情報を減算して出力する第３の減算器と、
前記第３の減算器の出力に一定のゲインを乗算した信号を、対応するサーボコントローラに入力された前記位置指令に加算するための信号として出力する第１の乗算器と、
前記モデル速度制御部からのモデル速度情報から、対応するサーボコントローラからのモータ速度情報を減算して出力する第４の減算器と、
前記４の減算器の出力に一定のゲインを乗算した信号を、対応するサーボコントローラにおける速度指令に帰還するための信号として出力する第２の乗算器と、
前記第１のモデル積分器からのモデルトルク情報から、対応するサーボコントローラからのモータトルク情報を減算して出力する第５の減算器と、
前記第５の減算器の出力に一定のゲインを乗算した信号を、対応するサーボコントローラにおけるトルク指令に帰還するための信号として出力する第３の乗算器と、
から構成されている、請求項１記載の同期制御装置。
【請求項３】
前記サーボコントローラが、
制御を行っているサーボモータのモータ位置情報からモータ速度を検出しモータ速度情報として出力する差分演算器と、
入力された前記位置指令から、制御を行っているサーボモータのモータ位置情報を減算するとともに、対応するモータ制御装置モデルにおける第１の乗算器からの出力を加算して出力する第１の演算器と、
前記第１の演算器からの出力に位置ゲインを乗算して速度指令として出力する第４の乗算器と、
前記第４の乗算器から出力された速度指令から、前記差分演算器から出力されたモータ速度情報を減算するとともに、対応するモータ制御装置モデルにおける第２の乗算器からの出力を加算して出力する第２の演算器と、
前記第２の演算器からの出力を積分することにより得られたトルク指令を出力する積分器と、
前記積分器から出力されたトルク指令から、前記差分演算器から出力されたモータ速度情報を減算するとともに、対応するモータ制御装置モデルにおける第３の乗算器からの出力を加算してモータトルク情報として出力する第３の演算器と、
前記第３の演算器から出力されたモータトルク情報に速度ゲインを乗算することにより、サーボモータを制御するための電圧を生成する第５の乗算器と、
から構成されている、請求項２記載の同期制御装置。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
本発明は、同一の位置指令に基づいて複数のサーボモータを同期駆動して１つの可動部の動作を制御するための同期制御装置に関する。
【０００２】
【従来の技術】
重量が大きい可動部を１つのサーボモータにより制御する場合、トルクが足りず、目標とする加速度及び速度が得られない場合がある。このような場合には、複数のサーボモータを同期駆動して、１つの可動部を複数のサーボモータにより制御することが行われる。そして、複数のサーボモータを同期駆動するために同期制御装置が用いられている。このような同期制御装置の従来の構成は、特開平１１−３０５８３９号公報の「複数のサーボモータの制御方法」等に開示されているように、機器の可動部に複数の推進軸をボールネジなどで螺合させ、この推進軸をそれぞれサーボモータによって駆動制御するものであった。
【０００３】
このような従来の同期制御装置の構成を図６に示す。この従来の同期制御装置は、図６に示されるように、サーボコントローラ３２、３３と、減算器５１、加算器５２と、位置補正ゲイン乗算器３１と、サーボモータ５、８と、エンコーダ４、９と、推進軸であるボールねじ１０、１１と、可動部であるテーブル１２とから構成されている。
【０００４】
この従来の同期制御装置では、テーブル１２に螺合されたボールねじ１０、１１をサーボモータ５、８によってそれぞれ所定の方向に同期回転させることにより、テーブル１２の動作の制御を行っている。
【０００５】
また、サーボコントローラ３２は、位置制御器２４と、速度制御器２８と、電流制御器２９と、電圧増幅器３０と、差分演算器３７と、減算器４８〜５０とから構成されている。また、サーボコントローラ３３は、速度制御器３４と、電流制御器３５と、電圧増幅器３６と、差分演算器３８と、減算器５３、５４とから構成されている。
【０００６】
サーボコントローラ３２における減算器４９、速度制御器２８、減算器５０、電流制御器２９、電圧増幅器３０、差分演算器３７によりサーボモータ５を駆動する方法は、サーボコントローラ３３でサーボモータ８を駆動する方法と同じため、サーボコントローラ３２の説明のみ行う。
【０００７】
サーボコントローラ３２では、エンコーダ４は、サーボモータ５のモータ位置を検出してモータ位置情報として出力する。差分演算器３７は、エンコーダ４により検出されたモータ位置情報からモータ速度を検出し、モータ速度情報として出力する。減算器４８は位置指令１からエンコーダ４により検出されたモータ位置情報を減算して出力する。位置制御器２４は、減算器４８の出力に位置ゲインを乗算して速度指令を算出して出力する。減算器４９は、位置制御器２４により算出された速度指令から差分演算器３７により求められたモータ速度情報を減算して速度偏差を求める。速度制御器２８は、減算器４９により求められた速度偏差に比例、積分制御等の速度ループ処理を行ってトルク指令を算出する。減算器５０は、速度制御器２８からのトルク指令に、電圧増幅器３０からの電流フィードバック値を減算する。電流制御器２９は、減算器５０からの値を電流指令に変換する処理を行っている。電圧増幅器３０は、電流制御器２９からの電流指令から各相の電圧値を算出してサーボモータ５の制御を行うとともに、減算器５０に電流フィードバック値を出力している。
【０００８】
減算器５１は、サーボコントローラ３２におけるモータ位置情報と、サーボコントローラ３３におけるモータ位置情報との差を求めている。位置補正ゲイン乗算器３１は、減算器５１の出力に位置補正ゲインを乗算して補正値として出力する。加算器５２は、位置制御器２４からの速度指令に位置補正ゲイン乗算器３１からの補正値を加算した指令信号を、サーボコントローラ３３に対する速度指令として出力する。
【０００９】
図６に示した従来の同期制御装置では、サーボモータ５側の速度指令を、サーボモータ５とサーボモータ８の位置偏差に基づいて位置補償したものをサーボモータ８に対する速度指令として用いるようにしているので、２つのサーボモータ５、８の同期制御を実現することができる。
【００１０】
具体的には、サーボモータ５とサーボモータ８の位置に差が生じた場合には、サーボコントローラ３３への速度指令はその差を補償するような値に修正されるためサーボモータ５、８は同期制御されることとなる。
【００１１】
このような従来の同期制御装置を構成しようとした場合、サーボモータ５、８を制御するための２つのサーボコントローラ３２、３３だけでなく、モータ位置の補償を行うために、位置補正ゲイン乗算器３１、加算器５２、減算器５１等の構成が必要となる。上記のような補償演算を行わない場合でも、サーボコントローラ３２からサーボコントローラ３３へ速度指令を入力する必要はあるが、サーボモータ５側のサーボコントローラ３２で上記の補償演算を行う場合、サーボモータ８のモータ位置をサーボコントローラ３２に入力するための回路の追加がさらに必要となる。また、逆に、サーボコントローラ３３で補償演算を行う場合も同様に、サーボモータ５のモータ位置をサーボコントローラ３３に入力するための回路を追加する必要がある。
【００１２】
サーボコントローラ内部で演算して補償データを作成する場合には、払い出しのタイミングをソフトデバッグ時に考慮することができ、調整が容易であるが、サーボコントローラ外部において補償データを作成する場合には、調整が困難である。そのため、サーボコントローラ間のネットワークを通して、データの授受を行う場合、補償データを払い出すタイミングがうまく合わずに同期制御の性能が劣化するという問題がある。また、サーボコントローラ３２による制御は位置制御であり、サーボコントローラ３３による制御は速度制御であるため、両方のサーボモータ５、８をとも位置制御により制御する構成に比べて、定常状態及び過渡状態での位置偏差が発生するという問題もある。さらに、ボールねじ１０を第１軸とし、ボールねじ１１を第２軸とした場合、この２軸間の干渉が負荷外乱となり発振が起こってしまう場合もある。
【００１３】
【発明が解決しようとする課題】
上述した従来の同期制御装置では、下記のような問題点があった。
（１）サーボモータを制御するためのサーボコントローラ以外にも、位置補償を行うための回路が必要となる。
（２）同期制御性能の劣化、位置偏差の発生、発振等の可能性があり安定した制御を実現することができない。
【００１４】
本発明の目的は、サーボコントローラ以外の回路を必要とすることなく安定した制御を実現することができる同期制御装置を提供することである。
【００１５】
【課題を解決するための手段】
上記目的を達成するために、本発明の同期制御装置は、同一の位置指令に基づいて複数のサーボモータを同期駆動して１つの可動部の動作を制御するための同期制御装置であって、
前記複数のサーボモータのそれぞれに対応して設けられ、入力された位置指令に基づいて各サーボモータの制御をそれぞれ行うサーボコントローラと、
前記サーボコントローラに対応して設けられ、前記位置指令に基づいて、モデルトルク情報、モデル速度情報、モデル位置情報を生成し、生成した前記モデルトルク情報と、対応して設けられたサーボコントローラにおけるモータトルク情報との差に一定のゲインを乗算して位相補償をした信号を該サーボコントローラにおけるトルク指令に帰還し、生成した前記モデル速度情報と、対応して設けられた前記サーボコントローラにおけるモータ速度情報との差に一定のゲインを乗算して位相補償をした信号を該サーボコントローラにおける速度指令に帰還し、生成した前記モデル位置情報と、対応して設けられたサーボコントローラにおけるモータ位置情報との差に一定のゲインを乗算した信号を該サーボコントローラに入力された前記位置指令に加算するモータ制御装置モデルと、
を備えている。
【００１６】
本発明によれば、サーボコントローラを対応するモータ制御装置モデル通りに動作させていることにより、外乱抑制を行うことができる。そのため、発振状態となることを防ぐことができ、安定した制御を実現することができる。
【００１７】
また、本発明によれば、２軸間の干渉をそれぞれの軸の外乱とみなし、この外乱を抑制するような構成にしているため、両軸間の位置補正を行わずにそれぞれ独立して制御しても同期制御を実現することができる。そのため、位置補償を行うための回路をサーボコントローラ以外に必要とすることなく、１軸用のサーボコントローラを複数組み合わせるのみで同期制御装置を容易に実現することができる。
【００１８】
また、前記モータ制御装置モデルを、
入力された前記位置指令からモデル位置情報を減算して出力する第１の減算器と、
前記第１の減算器からの出力に位置ゲインを乗算してモデル速度指令として出力するモデル乗算器と、
前記モデル乗算器からのモデル速度指令から前記モデル速度情報を減算して出力する第２の減算器と、
前記第２の減算器からの出力を積分することにより得られたモデルトルク情報を出力する第１のモデル積分器と、
前記第１のモデル積分器からのモデルトルク情報に、サーボモータ、負荷および速度ゲインを表した伝達関数を乗算することにより得られたモデル速度情報を出力するモデル速度制御部と、
前記モデル速度制御部からのモデル速度情報に対して積分演算を行うことにより得られたモデル位置情報を出力する第２のモデル積分器と、
前記第２のモデル積分器からのモデル位置情報から、対応するサーボコントローラにより制御されるサーボモータのモータ位置情報を減算して出力する第３の減算器と、
前記第３の減算器の出力に一定のゲインを乗算した信号を、対応するサーボコントローラに入力された前記位置指令に加算するための信号として出力する第１の乗算器と、
前記モデル速度制御部からのモデル速度情報から、対応するサーボコントローラからのモータ速度情報を減算して出力する第４の減算器と、
前記４の減算器の出力に一定のゲインを乗算した信号を、対応するサーボコントローラにおける速度指令に帰還するための信号として出力する第２の乗算器と、
前記第１のモデル積分器からのモデルトルク情報から、対応するサーボコントローラからのモータトルク情報を減算して出力する第５の減算器と、
前記第５の減算器の出力に一定のゲインを乗算した信号を、対応するサーボコントローラにおけるトルク指令に帰還するための信号として出力する第３の乗算器と
から構成するようにしてもよい。
【００１９】
さらに、前記サーボコントローラを、
制御を行っているサーボモータのモータ位置情報からモータ速度を検出しモータ速度情報として出力する差分演算器と、
入力された前記位置指令から、制御を行っているサーボモータのモータ位置情報を減算するとともに、対応するモータ制御装置モデルにおける第１の乗算器からの出力を加算して出力する第１の演算器と、
前記第１の演算器からの出力に位置ゲインを乗算して速度指令として出力する第４の乗算器と、
前記第４の乗算器から出力された速度指令から、前記差分演算器から出力されたモータ速度情報を減算するとともに、対応するモータ制御装置モデルにおける第２の乗算器からの出力を加算して出力する第２の演算器と、
前記第２の演算器からの出力を積分することにより得られたトルク指令を出力する積分器と、
前記積分器から出力されたトルク指令から、前記差分演算器から出力されたモータ速度情報を減算するとともに、対応するモータ制御装置モデルにおける第３の乗算器からの出力を加算してモータトルク情報として出力する第３の演算器と、
前記第３の演算器から出力されたモータトルク情報に速度ゲインを乗算することにより、サーボモータを制御するための電圧を生成する第５の乗算器と
から構成するようにしてもよい。
【００２０】
【発明の実施の形態】
次に、本発明の実施の形態について図面を参照して詳細に説明する。
【００２１】
図１は本発明の一実施形態の同期制御装置の構成を示すブロック図である。図１において、図６中の構成要素と同一の構成要素には同一の符号を付し、説明を省略するものとする。
【００２２】
本実施形態の同期制御装置は、サーボモータ５、８のそれぞれに対応して設けられているサーボコントローラ３、７と、サーボコントローラ３、７に対応してそれぞれ設けられているモータ制御装置モデル２、６と、エンコーダ４、９と、ボールねじ１０、１１と、テーブル１２とから構成されている。
【００２３】
本実施形態による同期制御装置では、図６に示した従来の同期制御装置と同様に、テーブル１２に螺合されたボールねじ１０、１１をサーボモータ５、８によってそれぞれ所定の方向に同期回転させることにより、可動部であるテーブル１２の動作の制御を行っている。
【００２４】
本実施形態の同期制御装置では、モータ制御装置モデル２、サーボコントローラ３、サーボモータ５、エンコーダ４、ボールねじ１０からなる制御系と、モータ制御装置モデル６、サーボコントローラ７、サーボモータ８、エンコーダ９、ボールねじ１１からなる制御系とは全く同様な構成となっているため、１軸分の制御系の構成および動作のみを説明する。図２に、１軸分の制御系であるモータ制御装置モデル２、サーボコントローラ３の構成を示す。
【００２５】
エンコーダ４は、モータ５の位置を検出し、検出されたモータ位置情報をモータ制御装置モデル２およびサーボコントローラ３に出力している。
【００２６】
モータ装置モデル２は、サーボコントローラをモデル化したものであり、位置指令１に基づいて、モデルトルク情報、モデル速度情報、モデル位置情報を生成し、生成したモデルトルク情報と、対応して設けられたサーボコントローラ３におけるモータトルク情報との差に一定のゲインを乗算して位相補償をした信号をサーボコントローラ３におけるトルク指令に帰還し、生成したモデル速度情報と、対応して設けられたサーボコントローラ３におけるモータ速度情報との差に一定のゲインを乗算して位相補償をした信号をサーボコントローラ３における速度指令に帰還し、生成したモデル位置情報と、対応して設けられたサーボコントローラ３におけるモータ位置情報との差に一定のゲインを乗算した信号をサーボコントローラ３に入力された位置指令１に加算する処理を行っている。
【００２７】
このような動作を行うモータ制御装置モデル２の具体的な構成を図２を参照して説明する。モータ制御装置モデル２は、図２に示されるように、スイッチ１３と、モデル乗算器１４と、モデル積分器１５と、モデル速度制御部１６と、モデル積分器１７と、位相進み遅れフィルタ１８、２０、２２と、乗算器１９、２１、２３と、減算器４０〜４４とから構成されている。
【００２８】
スイッチ１３は位置指令１を減算器４０に出力するか否かを決定する機能を備えていて、このスイッチ１３のオン／オフにより本実施形態による機能の有効／無効が決定される。
【００２９】
減算器４０は、スイッチ１３を介して入力された位置指令１からモデル積分器１７からのモデル位置情報を減算してモデル乗算器１４に出力する。モデル乗算器１４は、減算器４０からの出力に位置ゲインＫｐを乗算してモデル速度指令として出力する。減算器４１は、モデル乗算器１４からのモデル速度指令から、モデル速度制御部１６からのモデル速度情報を減算してモデル積分器１５に出力する。モデル積分器１５は、減算器４１からの出力を積分することにより得られたモデルトルク情報を出力している。
【００３０】
モデル速度制御部１６は、モデル積分器１５からのモデルトルク情報に、サーボモータ、負荷および速度ゲインを表した伝達関数Ｋｖ／（ｓ＋Ｋｖ）を乗算することにより得られたモデル速度情報を出力している。モデル積分器１７は、モデル速度制御部１６からのモデル速度情報に対して積分演算を行うことにより得られたモデル位置情報を減算器４２に出力している。
【００３１】
減算器４２は、モデル積分器１７からのモデル位置情報から、対応するサーボコントローラ３により制御されるサーボモータ５のモータ位置情報である、エンコーダ４により検出されたモータ位置情報を減算して位相進み遅れフィルタ１８に出力している。乗算器１９は、位相進み遅れフィルタ１８を介して入力された、モデル位置情報とモータ位置情報との差にゲインαを乗算している。乗算器１９の出力は、サーボコントローラ３に入力される位置指令１に加算される。
【００３２】
減算器４３は、モデル速度制御部１６からのモデル速度情報から、サーボコントローラ３からのモータ速度情報を減算して位相進み遅れフィルタ２０に出力している。乗算器２１は、位相進み遅れフィルタ２０を介して入力された、モデル速度情報とモータ速度情報との差にゲインβを乗算している。乗算器２１の出力は、乗算器２４からの出力である速度指令に加算される。
【００３３】
減算器４４は、モデル積分器１５からのモデルトルク情報から、サーボコントローラ３からのモータトルク情報を減算して位相進み遅れフィルタ２２に出力している。乗算器２３は、位相進み遅れフィルタ２２を介して入力された、モデルトルク情報とモータトルク情報との差にゲインγを乗算している。乗算器２３の出力は、積分器２５からの出力であるトルク指令に加算される。
【００３４】
また、サーボコントローラ３は、乗算器２４〜２６と、差分演算器２７と、演算器４５〜４７とから構成されている。
【００３５】
差分演算器２７は、エンコーダ４により検出されたモータ位置情報からモータ速度を検出し、モータ速度情報として出力する。演算器４５は、位置指令１からエンコーダ４により検出されたモータ位置情報を減算するとともに、モータ制御装置モデル２における乗算器１９からの出力を加算して乗算器２４に入力する。
【００３６】
乗算器２４は、演算器４５からの出力に位置ゲインＫｐを乗算して速度指令として出力する。演算器４６は、乗算器２４から出力された速度指令から、差分演算器２７から出力されたモータ速度情報を減算するとともに、乗算器２１からの出力を加算して積分器２５に入力する。
【００３７】
積分器２５は、演算器４６からの出力を積分することにより得られたトルク指令を演算器４７に出力している。演算器４７は、積分器２５から出力されたトルク指令から、差分演算器２７から出力されたモータ速度情報を減算するとともに、乗算器２３からの出力を加算してモータトルク情報として乗算器２６に入力している。乗算器２６は、演算器４７から出力されたモータトルク情報に速度ゲインＫｖを乗算することにより、サーボモータ５を制御するためのトルク指令を生成している。
【００３８】
次に、本実施形態の同期制御装置と従来の同期制御装置とを用いたシミュレーションの結果を図３、図４、図５に示す。
【００３９】
図３は、２つのサーボモータ５、８により、ボールねじ１０、１１を駆動して１つのテーブル１２の動作を制御することを模擬したシミュレーションモデルを示す図である。図３中の番号は、図１の番号に対応し、図１中のサーボモータ５、８、ボールねじ１０、１１、テーブル１２のモデルをそれぞれ伝達関数により表している。ボールねじ１０、１１のモデルを表した伝達関数は、ボールねじのバネ特性を含んだものととなっている。また、サーボモータ５、ボールねじ１０、テーブル１２およびモータ８、ボールねじ１１、テーブル１２はそれぞれ２慣性モデルである。それぞれの共振周波数が異なる場合において、従来の同期制御装置では振動が発生する。送り速度を６０ｍ／ｍｉｎとする速度指令を積算したものを位置指令データとするシミュレーションを実行した。
【００４０】
従来の同期制御装置を用いたシミュレーション結果を図４に示し、本実施形態の同期制御装置を用いたシミュレーション結果を図５に示す。
【００４１】
図４（ａ）、図５（ａ）は速度の応答波形を表し、図４（ｂ）、図５（ｂ）は２軸間のトルク応答の差を表している。また、図４（ｃ）、図５（ｃ）は２軸間の速度応答の差を表し、図４（ｄ）、図５（ｄ）は２軸間の位置の差を表している。
【００４２】
図４に示されるように従来の同期制御装置は発振しているが、本実施形態の同期制御装置では、図５を参照すると、トルク差（図５（ｂ））、速度差（図５（ｃ））、パルス偏差（図５（ｄ））のピーク値が図４と比較して１／１０〜１／１００程度となり振動が抑制されていることがわかる。
【００４３】
ここで、トルク差、速度差、パルス偏差とは、サーボコントローラ３とサーボコントローラ７における、それぞれのトルク、モータ速度、パルスの差を取ったものである。
【００４４】
次に、本実施形態の同期制御装置によれば、発振が抑制される理由について以下に説明する。
【００４５】
従来の同期制御装置では、２軸間の干渉があるため、高速送りを行うと同期誤差が多くなるという問題と、２軸それぞれの動特性が一致しない場合には図４に示すように発振状態となるという問題があった。これに対して、本実施形態の同期制御装置では、サーボコントローラ３、７をモータ制御装置モデル２、６通りに動作させている。そして、モータ制御装置モデル２、６は、発振するような要素を含んでいないため、指令系での発振はあり得ない。また、モータ制御装置モデル２、６には負荷外乱は発生しないため、サーボコントローラ３、７をそれぞれモータ制御装置モデル２、６通りに動作させることにより、外乱抑制ができる。そのため、発振状態となることを防ぐことができる。
【００４６】
また、本実施形態の同期制御装置では、２軸間の干渉をそれぞれの軸の外乱とみなし、この外乱を抑制するような構成にしているため、両軸間の位置補正を行わずにそれぞれ独立して制御しても同期制御を実現することができる。そのため、本実施形態の同期制御装置によれば、ボールねじ１０、１１の各軸毎にそれぞれ独立してモータ制御装置モデルおよびサーボコントローラからなる制御装置を構成することができるので、１軸で使っていたサーボコントローラを新たに同期制御装置用のコントローラに置き換えることが容易に行える。また、一方の制御装置から他方の制御装置に対して信号を引き出す必要がないため、信号線が少なくてすみ、同期制御のための部品点数が少なくてすむ。また、モータ制御装置モデルのパラメータは、２軸とも同じであるため、調整は１軸分ですむという利点もある。
【００４７】
本実施形態の同期制御装置では、可動部であるテーブル１２を２つのサーボモータ５、８により駆動制御する場合を用いて説明したが、本発明はこれに限定されるものではなく、３つ以上のサーボモータにより可動部を同期駆動するような場合にも同様に本発明を適用することができるものである。
【００４８】
【発明の効果】
以上説明したように、本発明によれば、下記のような効果を得ることができる。
（１）位置補償を行うための回路をサーボコントローラ以外に必要とすることなく複数のサーボモータの同期制御を行うことができる。
（２）同期制御性能の劣化、位置偏差の発生、発振状態の発生等を不正で安定した同期制御を実現することができる。
【図面の簡単な説明】
【図１】本発明の一実施形態の同期制御装置の構成を示すブロック図である。
【図２】図１に示した同期制御装置における１軸分の制御系であるモータ制御装置モデル２、サーボコントローラ３の構成を示した図である。
【図３】２つのサーボモータ５、８により、ボールねじ１０、１１を駆動して１つのテーブル１２の動作を制御することを模擬したシミュレーションモデルを示す図である。
【図４】従来の同期制御装置を用いたシミュレーション結果を示す図である。
【図５】本実施形態の同期制御装置を用いたシミュレーション結果を示す図である。
【図６】従来の同期制御装置の構成を示すブロック図である。
【符号の説明】
１    位置指令
２    モータ制御装置モデル
３    サーボコントローラ
４    エンコーダ（Ｅ）
５    モータ（Ｍ）
６    モータ制御装置モデル
７    サーボコントローラ
８    モータ（Ｍ）
９    エンコーダ（Ｅ）
１０、１１    ボールねじ
１２    テーブル
１３    スイッチ
１４    モデル乗算器
１５    モデル積分器
１６    モデル速度制御部
１７    モデル積分器
１８    位相進み遅れフィルタ
１９    乗算器（α）
２０    位相進み遅れフィルタ
２１    乗算器（β）
２２    位相進み遅れフィルタ
２３    乗算器（γ）
２４    乗算器（Ｋｐ）
２５    積分器
２６    乗算器（Ｋｖ）
２７    差分演算器
２８    速度制御器
２９    電流制御器
３０    電圧増幅器
３１    位置補正ゲイン乗算器
３２、３３    サーボコントローラ
３４    速度制御器
３５    電流制御器
３６    電圧増幅器
３７、３８    差分演算器
４０〜４４    減算器
４５〜４７    演算器
４８〜５１    減算器
５２    加算器
５３、５４    減算器
【図１】
0004134599.tif 000002
【図２】
0004134599.tif 000003
【図３】
0004134599.tif 000004
【図４】
0004134599.tif 000005
【図５】
0004134599.tif 000006
【図６】
0004134599.tif 000007