(57)【要約】【課題】一つの対象物を複数台のモータで駆動し同期制御する際、モータ間に発生するストレスを低減すること。【解決手段】  各モータからの位置フィードバック値が位置指令と一致するように位置制御することに代えて、モータ間に働く力を求め、このモータ間に働く力が減少するように制御することにより、同期制御においてモータ間に発生するストレスを低減させる。同期制御装置１は、位置指令と位置検出器からの位置フィードバックとの位置偏差に基づいて所定周期毎に速度指令を出力する位置制御部２と、速度指令と速度検出器からの速度フィードバックとに基づいて所定周期毎にトルク指令を出力する速度制御部３によりサーボモータを駆動制御する制御装置であって、同じ制御対象を駆動する２つのサーボモータ５を同期制御し、この２つのサーボモータ間に働く力に基づいて２つのサーボモータ間に働く力を減少させる同期補正処理部１０を備える。【選択図】  図１
2004288164.tif 000002
【特許請求の範囲】
【請求項１】
上位制御装置あるいは上位制御部から所定サンプリング周期で送られる位置指令と位置検出器からの位置フィードバックとの位置偏差に基づいて所定周期毎に速度指令を出力する位置制御部と、
前記速度指令と速度検出器からの速度フィードバックに基づいて所定周期毎にトルク指令を出力する速度制御部により、サーボモータを駆動制御する制御装置において、
前記制御装置は、同じ制御対象を駆動する２つのサーボモータを同期制御し、当該２つのサーボモータ間に働く力に基づいて２つのサーボモータ間に働く力を減少させる手段を備えることを特徴とするサーボモータの同期制御装置。
【請求項２】
前記位置制御部は、
前記２つのサーボモータに働く力に基づいて前記位置偏差のオフセット量を計算する位置偏差オフセット計算処理部と、
前記位置偏差オフセット計算処理部で計算された前記位置偏差オフセット量を前記位置偏差に加算する手段とを備えることを特徴とする、請求項１に記載の同期制御装置。
【請求項３】
前記位置偏差オフセット計算処理部は、
前記２つのサーボモータに働く力を２つのサーボモータに指令されるトルク指令の差分から求め、当該差分に変換係数を乗ずることにより位置偏差オフセット量を計算することを特徴とする、請求項２に記載の同期制御装置。
【請求項４】
前記位置偏差オフセット計算処理部は、
前記２つのサーボモータに働く力を２つのサーボモータに流れる実電流のトルク成分の差分から求め、当該差分に変換係数を乗ずることにより位置偏差オフセット量を計算することを特徴とする、請求項２に記載の同期制御装置。
【請求項５】
前記位置制御部は、前記２つのサーボモータに働く力の差分が一定値を超えた場合に前記位置偏差のオフセット量を計算する位置偏差オフセット計算処理部と、
前記位置偏差オフセット計算処理部で計算された位置偏差オフセット量を前記位置偏差に加算する手段とを備えることを特徴とする、請求項１に記載の同期制御装置。
【請求項６】
前記位置偏差オフセット計算処理部は、
前記２つのサーボモータに働く力を２つのサーボモータに指令されるトルク指令の差分から求め、当該差分が一定値を超えた分又は当該差分に対して変換係数を乗ずることにより位置偏差オフセット量を計算することを特徴とする、請求項５に記載の同期制御装置。
【請求項７】
前記位置偏差オフセット計算処理部は、
前記２つのサーボモータに働く力を２つのサーボモータに流れる実電流のトルク成分の差分から求め、当該差分が一定値を超えた分又は当該差分に対して変換係数を乗ずることにより位置偏差オフセット量を計算することを特徴とする、請求項５に記載の同期制御装置。
【請求項８】
前記位置偏差オフセット計算処理部は、
位置偏差オフセット量が前記位置制御部の周波数帯域より十分に低い周波数で変化させるための調整手段を備えることを特徴とする、請求項２乃至７のいずれかに記載の同期制御装置。
【請求項９】
前記位置制御部は、
前記２つのサーボモータに働く力に基づいて前記位置指令のオフセット量を計算する位置指令オフセット計算処理部と、
前記位置指令オフセット計算処理部で計算された前記位置指令オフセット量を前記位置指令に加算する手段とを備えることを特徴とする、請求項１に記載の同期制御装置。
【請求項１０】
前記位置指令オフセット計算処理部は、
前記２つのサーボモータに働く力を２つのサーボモータに指令されるトルク指令の差分から求め、当該差分に変換係数を乗ずることにより位置指令オフセット量を計算することを特徴とする、請求項９に記載の同期制御装置。
【請求項１１】
前記位置指令オフセット計算処理部は、
前記２つのサーボモータに働く力を２つのサーボモータに流れる実電流のトルク成分の差分から求め、当該差分に変換係数を乗ずることにより位置指令オフセット量を計算することを特徴とする、請求項９に記載の同期制御装置。
【請求項１２】
前記位置制御部は、前記２つのサーボモータに働く力の差分が一定値を超えた場合に前記位置指令のオフセット量を計算する位置指令オフセット計算処理部と、
前記位置指令オフセット計算処理部で計算された位置指令オフセット量を前記位置指令に加算する手段とを備えることを特徴とする、請求項１に記載の同期制御装置。
【請求項１３】
前記位置指令オフセット計算処理部は、
前記２つのサーボモータに働く力を２つのサーボモータに指令されるトルク指令の差分から求め、当該差分が一定値を超えた分又は当該差分に対して変換係数を乗ずることにより位置指令オフセット量を計算することを特徴とする、請求項１２に記載の同期制御装置。
【請求項１４】
前記位置指令オフセット計算処理部は、
前記２つのサーボモータに働く力を２つのサーボモータに流れる実電流のトルク成分の差分から求め、当該差分が一定値を超えた分又は当該差分に対して変換係数を乗ずることにより位置指令オフセット量を計算することを特徴とする、請求項１２に記載の同期制御装置。
【請求項１５】
前記位置指令オフセット計算処理部は、
位置指令オフセット量が前記位置制御部の周波数帯域より十分に低い周波数で変化させるための調整手段を備えることを特徴とする、請求項９乃至１４のいずれかに記載の同期制御装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、数値制御装置（ＮＣ装置）で制御される工作機器、産業用機械、ロボット等の駆動源として使用されるサーボモータの駆動制御に関する。
【背景技術】
【０００２】
工作機械において、一つの対象物を複数台のモータで駆動する同期制御を行う場合がある。
例えば、クランク研削盤のＣ軸のように、大型のワークを１つのサーボモータで駆動するとき、加工外乱によってワークにねじれが生じる場合がある。このようなワークのねじれは、加工精度に影響を与えることになる。このワークのねじれに対して、ワークに２つのサーボモータを配置し、両サーボモータの同期が保たれるように同期制御して、ワークのねじれを低減させている。
【０００３】
この同期制御では、ワークに連結される２軸にそれぞれサーボモータを設け、各サーボモータをそれぞれのサーボ回路により制御している。各サーボ回路は、位置制御部、速度制御部、電流制御部を備え、数値制御装置側から同じ位置指令が与えられる。２つのサーボモータは、同期ずれを補正するために、各位置のフィードバック値を用いて補正量を求め、この補正量を一方のサーボ回路の位置指令に加える補正を行っている。このような従来技術として、例えば特許文献１がある。
【０００４】
【特許文献１】特開平１１−３０５８３９号（段落番号０００２〜０００５）
【発明の開示】
【発明が解決しようとする課題】
【０００５】
一つの対象物を複数台のモータで駆動する同期制御では、各モータが上位制御装置から同じ位置指令を受けて動作し、各モータはそれぞれの位置検出器からの位置フィードバック値が位置指令と一致するように位置制御を行っている。
この同期制御において、各モータが位置指令の位置に移動したとしても、検出器の精度が不十分であったり、機械の熱膨張の影響を受けると実位置が正しい位置に到達しない場合がある。例えば、熱膨張により位置基準となるスケール自体も変位する場合があるため、基準位置自体が不明確となる。
【０００６】
このような場合に、モータ間の剛性が高いと、モータ同士が引っ張り合う現象が生じ、モータ間にストレスが生じ、モータやアンプの発熱や加工精度の低下といった問題となる。  
そこで、本発明は上記した従来の課題を解決して、一つの対象物を複数台のモータで駆動し同期制御する際、モータ間に発生するストレスを低減することを目的とする。
【課題を解決するための手段】
【０００７】
本発明による同期制御装置は、各モータからの位置フィードバック値と位置指令とが一致するように位置制御することに代えて、モータ間に働く力を求め、このモータ間に働く力が減少するように制御することにより、同期制御においてモータ間に発生するストレスを低減させる。
【０００８】
このために、本発明の同期制御装置は、上位制御装置あるいは上位制御部から所定サンプリング周期で送られる位置指令と位置検出器からの位置フィードバックとの位置偏差に基づいて所定周期毎に速度指令を出力する位置制御部と、速度指令と速度検出器からの速度フィードバックに基づいて所定周期毎にトルク指令を出力する速度制御部によりサーボモータを駆動制御する制御装置において、制御装置は、同じ制御対象を駆動する２つのサーボモータを同期制御し、この２つのサーボモータ間に働く力に基づいて２つのサーボモータ間に働く力を減少させる手段を備える構成とする。
【０００９】
本発明の同期制御装置において、サーボモータ間に働く力を減少させる手段は、位置偏差に対して補正を施すことによりサーボモータ間に働く力を減少させる態様、あるいは位置指令に対して補正を施すことによりサーボモータ間に働く力を減少させる態様とすることができる。
【００１０】
位置偏差に対して補正を施す態様において、位置制御部は、２つのサーボモータに働く力に基づいて位置偏差のオフセット量を計算する位置偏差オフセット計算処理部と、位置偏差オフセット計算処理部で計算された位置偏差オフセット量を位置偏差に加算する手段とを備える。
【００１１】
位置偏差オフセット計算処理部は、種々の形態により構成することができる。第１の形態では、サーボモータ間に働く力をトルク指令の差分から求める。位置偏差オフセット計算処理部は、２つのサーボモータに指令されるトルク指令の差分を求め、求めた差分に第１の変換係数を乗ずることにより位置偏差オフセット量を得る。トルク指令の差分は２つのサーボモータに働く力に対応し、第１の変換係数はトルク指令の偏差を位置の偏差補正に変換する係数である。したがって、トルク指令の差分に第１の変換係数を乗ずることにより、２つのサーボモータに働く力に基づいた位置偏差オフセット量が得られる。この位置偏差オフセット量を位置偏差に加算することにより、サーボモータ間に働く力に基づいて位置制御を行うことができる。
【００１２】
第２の形態では、サーボモータ間に働く力をサーボモータに流れる実電流のトルク成分の差分から求める。位置偏差オフセット計算処理部は、２つのサーボモータに流れる実電流のトルク成分の差分を求め、求めた差分に第２の変換係数を乗ずることにより位置偏差オフセット量を得る。サーボモータに流れる実電流の差分は２つのサーボモータに働く力に対応し、第２の変換係数は実電流の偏差を位置の偏差補正に変換する係数である。したがって、実電流の差分に第２の変換係数を乗ずることにより、２つのサーボモータに働く力に基づいた位置偏差オフセット量が得られる。この位置偏差オフセット量を位置偏差に加算することにより、サーボモータ間に働く力に基づいた位置制御を行うことができる。
【００１３】
また、他の形態では、トルク指令の差分に対する位置偏差オフセット量、あるいは実電流の差分に対する位置偏差オフセット量を予め求めておき、トルク指令の差分又は実電流の差分から対応する位置偏差オフセット量を読み出し、この位置偏差オフセット量を位置偏差に加算することにより、サーボモータ間に働く力に基づいた位置制御を行う。トルク指令の差分又は実電流の差分に対する位置偏差オフセット量は、例えばテーブルの形態で設定することができる。
【００１４】
力の差が小さい場合には発熱等の問題が少なく位置偏差の補正が不要であり、また、偏差補正によってスレーブ側に位置偏差が生じるという副作用が発生する場合がある。そこで、モータ間に働く力の差が小さい場合には位置偏差の補正を行わず、モータ間に働く力の差が所定値を超えた場合に位置偏差の補正を行う形態とすることもできる。
この形態では、位置制御部は、２つのサーボモータに働く力の差分が一定値を超えた場合に位置偏差のオフセット量を計算する位置偏差オフセット計算処理部と、位置偏差オフセット計算処理部で計算された位置偏差オフセット量を位置偏差に加算する手段とを備える。
【００１５】
位置偏差オフセット計算処理部の第１の形態は、２つのサーボモータに働く力を２つのサーボモータに指令されるトルク指令の差分から求め、差分が一定値を超えた分又は当該差分に対して変換係数を乗ずることにより位置偏差オフセット量を計算する。
また、位置偏差オフセット計算処理部の第２の形態は、２つのサーボモータに働く力を２つのサーボモータに流れる実電流のトルク成分の差分から求め、当該差分が一定値を超えた分又は当該差分に対して変換係数を乗ずることにより位置偏差オフセット量を計算する。
【００１６】
また、位置偏差オフセット計算処理部は、位置偏差オフセットが位置制御部の周波数帯域より十分に低い周波数で変化させるための調整手段を備える。この調整手段により、位置制御を安定化させることができる。
【００１７】
次に、位置指令に対して補正を施す態様において、位置制御部は、２つのサーボモータに働く力に基づいて前記位置指令のオフセット量を計算する位置指令オフセット計算処理部と、位置指令オフセット計算処理部で計算された位置指令オフセット量を位置指令に加算する手段とを備える。
【００１８】
位置指令オフセット計算処理部は、種々の形態により構成することができる。第１の形態では、サーボモータ間に働く力をトルク指令の差分から求める。位置指令オフセット計算処理部は、２つのサーボモータに指令されるトルク指令の差分を求め、求めた差分に第３の変換係数を乗ずることにより位置指令オフセット量を得る。トルク指令の差分は２つのサーボモータに働く力に対応し、第３の変換係数はトルク指令の偏差を指令の偏差補正に変換する係数である。したがって、トルク指令の差分に第３の変換係数を乗ずることにより、２つのサーボモータに働く力に基づいた位置指令オフセット量が得られる。この位置指令オフセットを位置指令に加算することにより、サーボモータ間に働く力に基づいて位置制御を行うことができる。
【００１９】
第２の形態では、サーボモータ間に働く力をサーボモータに流れる実電流のトルク成分の差分から求める。位置指令オフセット計算処理部は、２つのサーボモータに流れる実電流のトルク成分の差分を求め、求めた差分に第４の変換係数を乗ずることにより位置指令オフセットを得る。サーボモータに流れる実電流の差分は２つのサーボモータに働く力に対応し、第４の変換係数は実電流の偏差を指令の偏差補正に変換する係数である。したがって、実電流の差分に第４の変換係数を乗ずることにより、２つのサーボモータに働く力に基づいた位置指令オフセット量が得られる。この位置指令オフセット量を指令偏差に加算することにより、サーボモータ間に働く力に基づいた位置制御を行うことができる。
【００２０】
また、位置指令に対して補正を施す態様においても、トルク指令の差分に対する位置指令オフセット量、あるいは実電流の差分に対する位置指令オフセット量を予め求めておき、トルク指令の差分又は実電流の差分から対応する位置指令オフセット量を読み出し、この位置指令オフセットを位置指令に加算することにより、サーボモータ間に働く力に基づいた位置制御を行う。トルク指令の差分又は実電流の差分に対する位置指令オフセット量は、例えばテーブルの形態で設定することができる。
【００２１】
また、位置指令に対して補正においても、モータ間に働く力の差が小さい場合には位置偏差の補正を行わず、モータ間に働く力の差が所定値を超えた場合に位置偏差の補正を行う形態とすることもできる。
位置制御部は、２つのサーボモータに働く力の差分が一定値を超えた場合に位置指令のオフセット量を計算する位置指令オフセット計算処理部と、位置指令オフセット計算処理部で計算された位置指令オフセット量を位置指令に加算する手段とを備える。
【００２２】
位置指令オフセット計算処理部の第１の形態は、２つのサーボモータに働く力を２つのサーボモータに指令されるトルク指令の差分から求め、当該差分が一定値を超えた分又は当該差分に対して変換係数を乗ずることにより位置指令オフセット量を計算する。  
位置指令オフセット計算処理部の第２の形態は、２つのサーボモータに働く力を２つのサーボモータに流れる実電流のトルク成分の差分から求め、当該差分が一定値を超えた分又は当該差分に対して変換係数を乗ずることにより位置指令オフセット量を計算する。
【００２３】
また、位置指令オフセット計算処理部は、位置指令オフセット量が位置制御部の周波数帯域より十分に低い周波数で変化させるための調整手段を備える。この調整手段により、位置制御を安定化させることができる。
この同期制御装置によれば、送り軸に適用した場合、２つのモータが引っ張り合う現象が改善され、両者の電流指令が小さくなり、位置偏差も小さくなる。また、円弧補間時において、モータ間の干渉が緩和され、補間精度が向上する。
モータ間に働く力が小さい場合には補正を行わず、所定値を超えた場合に補正を行う場合には、偏差補正によってスレーブ側に位置偏差が生じるという副作用を防ぐことができる。
【発明の効果】
【００２４】
本発明の同期制御装置によれば、一つの対象物を複数台のモータで駆動し同期制御する際、モータ間に発生するストレスを低減することができる。
【発明を実施するための最良の形態】
【００２５】
以下、図面を参照して本発明の実施形態を説明する。  
複数のサーボモータの制御は、例えば、数値制御装置等の上位制御装置や上位制御部、共有ＲＡＭ、デジタルサーボ回路、電力増幅器、及び複数のモータから構成され、これらのモータは対象物（ワーク）に連結され、一つの駆動系を構成する。
【００２６】
デジタルサーボ回路のプロセッサは、上位制御装置や上位制御部から指令された位置指令を共有ＲＡＭを介して読みとり、位置ループ処理、速度ループ処理、及び電流ループ処理を行う。位置指令から位置フィードバック値を減じて位置偏差を求め、この位置偏差にポジションゲインを乗じて位置ループ制御を行って速度指令を求め、この速度指令から速度フィードバック値を減じて速度偏差を求め、比例，積分制御等の速度ループ処理を行ってトルク指令（電流指令）を求める。さらにこのトルク指令から電流フィードバック値を減じて電流ループ処理を行い、各相の電圧指令を求めてＰＷＭ制御等を行ってサーボモータの駆動制御を行う。
【００２７】
図１は本発明の同期制御装置の概略を説明するための概略ブロック図である。図１において、サーボモータ５Ａ，５Ｂは対象物６を共有して結合され、同期制御装置１と共に駆動系を構成する。同期制御装置１は、サーボモータ５Ａを制御するサーボ回路部Ａ（位置制御部２Ａ，速度制御部３Ａ，電流制御部４Ａ）と、サーボモータ５Ｂを制御するサーボ回路部Ｂ（位置制御部２Ｂ，速度制御部３Ｂ，電流制御部４Ｂ）と、サーボモータ５Ａ，５Ｂ間に働く力に基づいて同期制御を行う同期補正処理部１０を備える。同期補正処理部１０は、位置制御部２Ａ，２Ｂの位置偏差あるいは位置指令を補正する。なお、同期補正処理部１０は、位置制御部２Ａ，２Ｂのいずれか一方を補正することも、あるいは両方を補正することもできる。
【００２８】
サーボ回路部Ａは、通常のサーボ回路と同様に、位置制御部２Ａ，速度制御部３Ａ，電流制御部４Ａを備え、位置制御部２Ａは上位制御装置あるいは上位制御部から位置指令を受け取って速度指令を速度制御部３Ａに送り、速度制御部３Ａは速度指令を受け取ってトルク指令（電流指令）を電流制御部４Ａに送り、電流制御部４Ａはトルク指令を受け取って電圧指令を電力増幅器（図示していない）に送る。電力増幅器は電圧指令に基づいてサーボモータ５Ａを駆動する。
【００２９】
また、サーボ回路部Ｂは、通常のサーボ回路と同様に、位置制御部２Ｂ，速度制御部３Ｂ，電流制御部４Ｂを備え、位置制御部２Ｂは上位制御装置あるいは上位制御部から位置指令を受け取って速度指令を速度制御部３Ｂに送り、速度制御部３Ｂは速度指令を受け取ってトルク指令（電流指令）を電流制御部４Ｂに送り、電流制御部４Ｂはトルク指令を受け取って電圧指令を電力増幅器（図示していない）に送る。電力増幅器は電圧指令に基づいてサーボモータ５Ｂを駆動する。
【００３０】
同期補正処理部１０は、サーボモータ５Ａとサーボモータ５Ｂとの間に働く力をサーボ回路部Ａとサーボ回路部Ｂから求め、このモータ間に働く力に変換係数を乗じて得た値を、位置制御部２Ａ及び／又は位置制御部２Ｂに入力する。同期補正処理部１０は、サーボモータ５Ａ，５Ｂ間に働くストレスを緩和し、両モータの同期を合わせる働きをする。
【００３１】
同期補正処理部１０は、２つのサーボモータに指令されるトルク指令の差分、又は２つのサーボモータに流れる実電流の差分からモータ間に働く力を求めることができ、また、モータ間に働く力から求めた位置偏差オフセットによる位置偏差補正、又はモータ間に働く力から求めた位置指令オフセットによる位置指令補正を行うことができる。
以下、図２〜図６を用いて位置偏差を補正する態様について説明し、図７〜図１１を用いて位置指令を補正する態様について説明する。
【００３２】
また、各態様において、図２，図７は２つのサーボモータに指令されるトルク指令の差分からモータ間に働く力から求める形態を示し、図４，図９は２つのサーボモータに流れる実電流の差分からモータ間に働く力から求める形態を示し、図５，図１０は、モータ間に働く力とオフセット量との関係を定めたテーブルを用いる形態を示し、図６，図１１は、２つのサーボモータに補正をかける形態を示している。なお、図３は位置偏差を補正する態様のフローチャートであり、図８は位置指令を補正する態様のフローチャートである。
【００３３】
はじめに、位置偏差を補正する態様について説明する。  
第１の例は、トルク指令の差分から得た位置偏差オフセット量により位置偏差を補正する例である。図２は、位置偏差を補正する態様において、２つのサーボモータに指令されるトルク指令の差分からモータ間に働く力を求める形態の構成例を示す図である。
【００３４】
サーボ回路部Ａは、通常のサーボ回路と同様に、位置制御部２Ａ，速度制御部３Ａ，電流制御部４Ａを備える。位置制御部２Ａは上位制御装置あるいは上位制御部から位置指令を受け取り、位置指令から位置フィードバックを減算して位置偏差を求め、ポジションゲインを乗じて得た速度指令を速度制御部３Ａに送る。
【００３５】
速度制御部３Ａは速度指令を受け取り、速度指令から速度フィードバックを減じて得たトルク指令（電流指令）を電流制御部４Ａに送る。電流制御部４Ａはトルク指令を受け取って電圧指令を電力増幅器（図示していない）に送り、電力増幅器は電圧指令に基づいてサーボモータ５Ａを駆動する。
【００３６】
サーボモータ５Ａは、図示しないエンコーダ等により速度を検出し、速度制御部３Ａに速度フィードバックする。なお、位置フィードバックは、速度フィードバックを積分して求めることも、あるいは、サーボモータ５Ａに設けたエンコーダにより位置を検出して得ることもできる。
【００３７】
また、サーボ回路部Ｂは、通常のサーボ回路と同様に、位置制御部２Ｂ，速度制御部３Ｂ，電流制御部４Ｂを備える。位置制御部２Ｂは上位制御装置あるいは上位制御部から位置指令を受け取り、位置指令から位置フィードバックを減算して位置偏差を求め、ポジションゲインを乗じて得た速度指令を速度制御部３Ｂに送る。
【００３８】
速度制御部３Ｂは速度指令を受け取り、速度指令から速度フィードバックを減じて得たトルク指令（電流指令）を電流制御部４Ｂに送る。電流制御部４Ｂはトルク指令を受け取って電圧指令を電力増幅器（図示していない）に送り、電力増幅器は電圧指令に基づいてサーボモータ５Ｂを駆動する。
【００３９】
サーボモータ５Ｂは、図示しないエンコーダ等により速度を検出し、速度制御部３Ｂに速度フィードバックする。なお、位置フィードバックは、速度フィードバックを積分して求めることも、あるいは、サーボモータ５Ｂに設けたエンコーダにより位置を検出して得ることもできる。
【００４０】
同期補正処理部１０は、フィルタ１０ａと位置偏差オフセット量を計算する手段１０ｂと、位置偏差オフセット量を制限するリミット手段１０ｃを備え、２つのサーボモータに指令されるトルク指令の差分からモータ間に働く力を求め、位置偏差オフセット量を求め、サーボ回路部Ｂの位置偏差に加えて位置偏差を補正する。同期補正処理部１０には、速度制御部３Ａからのトルク指令と、速度制御部３Ｂからのトルク指令との差分を入力する。
【００４１】
フィルタ１０ａは、位置制御部２Ａの周波数帯域よりも低い周波数で補正を行うために、入力したトルク指令の差分の低周波数成分を抽出する。フィルタ１０ａは、例えばローパスフィルタで構成することができる。
【００４２】
位置偏差オフセット量を計算する手段１０ｂは、トルク指令の偏差（差分）に第１の変換係数Ｋ１を乗じることにより位置偏差オフセット量を求める。第１の変換係数Ｋ１は、トルク指令の偏差（差分）を位置の偏差補正に変換する係数である。
【００４３】
位置偏差オフセット量を制限するリミット手段１０ｃは、位置偏差オフセット量を計算する手段１０ｂで求めた位置偏差オフセット量が大きくなりすぎないように制限を加える。リミット値は、予め設定しておく。
【００４４】
同期補正処理部１０で得られた位置偏差オフセット量は、サーボ回路部Ｂの位置制御部２Ｂの位置偏差に加えられる。なお、位置偏差オフセット量は、サーボ回路部Ｂの位置制御部２Ｂの位置偏差に限らず、サーボ回路部Ａの位置制御部２Ａの位置偏差に加えるようにしてもよい。
【００４５】
サーボモータ５Ａとサーボモータ５Ｂとの間に生じる物理的な干渉は、同期補正処理部１０による位置偏差の補正により減少される。
図３に示すフローチャートは、同期補正処理部が行う位置偏差オフセットの計算処理を示しており、図２に示すトルク指令の差分から位置偏差オフセットを求める例について示している。
【００４６】
同期補正処理部において、補正機能が有効である場合には（ステップＳ１）、モータ回路Ａのトルク指令（ＴＣＭＤ１）とモータ回路Ｂのトルク指令（ＴＣＭＤ２）を取り込み、その偏差ΔＴ（＝ＴＣＭＤ１−ＴＣＭＤ２）を計算する（ステップＳ２）。
【００４７】
フィルタ１０ａは、フィルタ処理によって求めた偏差ΔＴから低周波成分Ｆout（＝ＦＩＬＴＥＲ（ΔＴ））を抽出する。なお、ＦＩＬＴＥＲ（ΔＴ）はフィルタ処理を表しており、所望のフィルタ特性を設定することができる（ステップＳ３）。
位置偏差オフセット量を計算する手段１０ｂは、フィルタ処理したトルク指令の偏差出力Ｆoutに第１の変換係数Ｋ１を乗じて、位置偏差オフセット量Ｅoffsetを計算する。
【００４８】
トルク指令の差分に第１の変換係数Ｋ１を乗ずることにより、２つのサーボモータに働く力に基づいた位置偏差オフセットが得られる（ステップＳ４）。求めた位置偏差オフセット量Ｅoffsetが制限値を越えないようにリミットをかける。リミット値は、モータの駆動系に応じて設定することができる（ステップＳ５）。
【００４９】
求めた位置偏差オフセット量を位置制御部の位置偏差に加算し、位置偏差Ｅｒ（＝Ｅｒ＋Ｅoffset）を求める。この位置偏差オフセットを位置偏差に加算することにより、サーボモータ間に働く力に基づいて位置制御を行うことができる（ステップＳ６）。
位置制御部２Ｂは、補正された位置偏差ＥｒにポジションゲインＫｐを乗じて速度指令ＶＣＭＤ（＝Ｋｐ×Ｅｒ）を計算し、速度制御部３Ｂに送る（ステップＳ７）。
【００５０】
第２の例は、実電流の差分から得た位置偏差オフセット量により位置偏差を補正する例である。図４は、位置偏差を補正する態様において、２つのサーボモータに流れる実電流の差分からモータ間に働く力を求める形態の構成例を示す図である。
サーボ回路部Ａ及びサーボ回路部Ｂの構成は、図２と同様とすることができるため、ここでの説明は省略する。
【００５１】
同期補正処理部１０は、フィルタ１０ａと位置偏差オフセット量を計算する手段１０ｂと、位置偏差オフセット量を制限するリミット手段１０ｃを備え、２つのサーボモータに流れる実電流の差分からモータ間に働く力を求め、位置偏差オフセット量を求め、サーボ回路部Ｂの位置偏差に加えて位置偏差を補正する。同期補正処理部１０には、電流制御部４Ａからの実電流と、電流制御部４Ｂからの実電流との差分を入力する。
【００５２】
フィルタ１０ａは、位置制御部２Ａの周波数帯域よりも低い周波数で補正を行うために、入力したトルク指令の差分の低周波数成分を抽出する。フィルタ１０ａは、例えばローパスフィルタで構成することができる。
【００５３】
位置偏差オフセット量を計算する手段１０ｂは、実電流の偏差（差分）に第２の変換係数Ｋ２を乗じることにより位置偏差オフセット量を求める。第２の変換係数Ｋ２は、実電流の偏差（差分）を位置の偏差補正に変換する係数である。
【００５４】
位置偏差オフセット量を制限するリミット手段１０ｃは、位置偏差オフセット量を計算する手段１０ｂで求めた位置偏差オフセット量が大きくなりすぎないように制限を加える。リミット値は予め設定しておく。
【００５５】
同期補正処理部１０で得られた位置偏差オフセット量は、サーボ回路部Ｂの位置制御部２Ｂの位置偏差に加えられる。なお、位置偏差オフセット量は、サーボ回路部Ｂの位置制御部２Ｂの位置偏差に限らず、サーボ回路部Ｂの位置制御部２Ｂの位置偏差に加えるようにしてもよい。
【００５６】
サーボモータ５Ａとサーボモータ５Ｂとの間に生じる物理的な干渉は、同期補正処理部１０による位置偏差の補正により減少される。
なお、図４に示す構成の同期補正処理部が行う位置偏差オフセットの計算処理は、図３のフローチャートにおいて、トルク指令を実電流とし、変換係数Ｋを第２の変換係数Ｋ２とすることにより、ほぼ同様に行うことができる。
【００５７】
第３の例は、トルク偏差と位置偏差オフセットのテーブルを用いて位置偏差を補正する例である。図５は、位置偏差を補正する態様において、モータ間に働く力とオフセット量との関係を定めたテーブル１０ｄを用いる形態の構成例を示す図である。
サーボ回路部Ａ及びサーボ回路部Ｂの構成は、図２，４と同様とすることができるため、ここでの説明は省略する。
【００５８】
同期補正処理部１０は、トルク偏差と位置偏差オフセット量との関係をテーブル等により保存しておき、トルク指令の差分（偏差）を入力し、対応する位置偏差オフセット量を出力する。トルク偏差と位置偏差オフセット量との関係は、図２の構成等により予め求めて記録手段に記録しておく。記録手段は、入力したトルク偏差に対応する位置偏差オフセット量を出力する。
【００５９】
同期補正処理部１０で得られた位置偏差オフセット量は、サーボ回路部Ｂの位置制御部２Ｂの位置偏差に加えられる。なお、位置偏差オフセット量は、サーボ回路部Ｂの位置制御部２Ｂの位置偏差に限らず、サーボ回路部Ａの位置制御部２Ａの位置偏差に加えるようにしてもよい。
また、図５に示す例ではトルク偏差と位置偏差オフセット量との関係を格納しているが、実電流偏差と位置偏差オフセット量との関係を格納しておき、実電流の差分を入力して位置偏差オフセット量を出力する構成とすることもできる。
【００６０】
また、図２〜図５で示した構成例では、同期補正処理部１０から出力される位置偏差オフセット量を、一方のサーボ回路の位置制御部の位置偏差に加えているが、両方のサーボ回路の位置制御部の位置偏差に加えるようにしてもよい。図６は、第４の例であり、両方のサーボ回路の位置制御部の位置偏差に位置偏差オフセット量を加える構成例を示している。
【００６１】
なお、サーボ回路部Ａ及びサーボ回路部Ｂの位置制御部２Ａ，２Ｂの位置偏差に位置偏差オフセット量を加える構成以外は、図２に示した構成と同様であるので、ここでの説明は省略する。
【００６２】
次に、位置指令を補正する態様について説明する。  
第５の例は、トルク指令の差分から得た位置処理オフセット量により位置指令を補正する例である。図７は、位置指令を補正する態様において、２つのサーボモータに指令されるトルク指令の差分からモータ間に働く力を求める形態の構成例を示す図である。
サーボ回路部Ａ、サーボ回路部Ｂ、及び同期補正処理部１０の構成は、図２と同様とすることができるため、ここでの説明は省略する。
【００６３】
同期補正処理部１０は、フィルタと位置指令オフセット量を計算する手段と、位置指令オフセット量を制限するリミット手段を備え、２つのサーボモータに指令されるトルク指令の差分からモータ間に働く力を求め、位置指令オフセット量を求め、サーボ回路部Ｂの位置指令に加えて位置指令を補正する。同期補正処理部１０には、速度制御部３Ａからのトルク指令と、速度制御部３Ｂからのトルク指令との差分を入力する。
【００６４】
フィルタは、位置制御部２Ａの周波数帯域よりも低い周波数で補正を行うために、入力したトルク指令の差分の低周波数成分を抽出する。フィルタは、例えばローパスフィルタで構成することができる。
【００６５】
位置指令オフセット量を計算する手段は、トルク指令の偏差（差分）に第３の変換係数Ｋ３を乗じることにより位置指令オフセット量を求める。第３の変換係数Ｋ３は、トルク指令の偏差（差分）を指令の偏差補正に変換する係数である。
【００６６】
位置指令オフセット量を制限するリミット手段は、位置指令オフセット量を計算する手段で求めた位置指令オフセット量が大きくなりすぎないように制限を加える。リミット値は、予め設定しておく。
【００６７】
同期補正処理部１０で得られた位置指令オフセット量は、サーボ回路部Ｂの位置制御部２Ｂの位置指令に加えられる。なお、位置指令オフセット量は、サーボ回路部Ｂの位置制御部２Ｂの位置指令に限らず、サーボ回路部Ａの位置制御部２Ａの位置指令に加えるようにしてもよい。
サーボモータ５Ａとサーボモータ５Ｂとの間に生じる物理的な干渉は、同期補正処理部１０による位置指令の補正により減少される。
【００６８】
図８に示すフローチャートは、同期補正処理部が行う位置指令オフセットの計算処理を示しており、図７に示すトルク指令の差分から位置指令オフセットを求める例について示している。
【００６９】
同期補正処理部において、補正機能が有効である場合には（ステップＳ１１）、モータ回路Ａのトルク指令（ＴＣＭＤ１）とモータ回路Ｂのトルク指令（ＴＣＭＤ２）を取り込み、その偏差ΔＴ（＝ＴＣＭＤ１−ＴＣＭＤ２）を計算する（ステップＳ１２）。
【００７０】
フィルタは、フィルタ処理によって求めた偏差ΔＴから低周波成分Ｆout（＝ＦＩＬＴＥＲ（ΔＴ））を抽出する。なお、ＦＩＬＴＥＲ（ΔＴ）はフィルタ処理を表しており、所望のフィルタ特性を設定することができる（ステップＳ１３）。
【００７１】
位置指令オフセット量を計算する手段は、フィルタ処理したトルク指令の偏差出力Ｆoutに第３の変換係数Ｋ３を乗じて、位置指令オフセット量Ｐoffsetを計算する。
【００７２】
トルク指令の差分に第３の変換係数Ｋ３を乗ずることにより、２つのサーボモータに働く力に基づいた位置指令オフセットが得られる（ステップＳ１４）。求めた位置指令オフセット量Ｐoffsetが制限値を越えないようにリミットをかける。リミット値は、モータの駆動系に応じて設定することができる（ステップＳ１５）。
【００７３】
求めた位置指令オフセット量を位置制御部の位置指令に加算し、位置指令ＭＣＭＤ（＝ＭＣＭＤ＋Ｐoffset）を求める。この位置指令オフセットＰoffsetを位置指令ＭＣＭＤに加算することにより、サーボモータ間に働く力に基づいて位置制御を行うことができる（ステップＳ１６）。
【００７４】
位置制御部２Ｂは、補正された位置指令ＭＣＭＤから位置フィードバックを減算して得た位置偏差ＥｒにポジションゲインＫｐを乗じて速度指令ＶＣＭＤ（＝Ｋｐ×Ｅｒ）を計算し、速度制御部３Ｂに送る。
【００７５】
第６の例は、実電流の差分から得た位置指令オフセット量により位置指令を補正する例である。図９は、位置指令を補正する態様において、２つのサーボモータに流れる実電流の差分からモータ間に働く力を求める形態の構成例を示す図である。
【００７６】
サーボ回路部Ａ、サーボ回路部Ｂ、及び同期補正処理部１０の構成は、図２，４と同様とすることができるため、ここでの説明は省略する。
同期補正処理部１０は、フィルタと位置指令オフセット量を計算する手段と、位置指令オフセット量を制限するリミット手段を備え、２つのサーボモータに流れる実電流の差分からモータ間に働く力を求め、位置指令オフセット量を求め、サーボ回路部Ｂの位置指令に加えて位置指令を補正する。同期補正処理部１０には、電流制御部４Ａからの実電流と、電流制御部４Ｂからの実電流との差分を入力する。
【００７７】
フィルタは、位置制御部２Ａの周波数帯域よりも低い周波数で補正を行うために、入力した実電流の差分の低周波数成分を抽出する。フィルタは、例えばローパスフィルタで構成することができる。
【００７８】
位置指令オフセット量を計算する手段は、実電流の偏差（差分）に第４の変換係数Ｋ４を乗じることにより位置指令オフセット量を求める。第４の変換係数Ｋ４は、実電流の偏差（差分）を指令の偏差補正に変換する係数である。
【００７９】
位置指令オフセット量を制限するリミット手段は、位置指令オフセット量を計算する手段で求めた位置指令オフセット量が大きくなりすぎないように制限を加える。リミット値は、予め設定しておく。
【００８０】
同期補正処理部１０で得られた位置指令オフセット量は、サーボ回路部Ｂの位置制御部２Ｂの位置指令に加えられる。なお、位置指令オフセット量は、サーボ回路部Ｂの位置制御部２Ｂの位置指令に限らず、サーボ回路部Ａの位置制御部２Ａの位置指令に加えるようにしてもよい。
サーボモータ５Ａとサーボモータ５Ｂとの間に生じる物理的な干渉は、同期補正処理部１０による位置指令の補正により減少される。
【００８１】
第７の例は、トルク偏差と位置指令オフセットのテーブルを用いて位置指令を補正する例である。図１０は、位置指令を補正する態様において、モータ間に働く力とオフセット量との関係を定めたテーブルを用いる形態の構成例を示す図である。
サーボ回路部Ａ及びサーボ回路部Ｂの構成は、図５と同様とすることができるため、ここでの説明は省略する。
【００８２】
同期補正処理部１０は、トルク偏差と位置指令オフセット量との関係をテーブル等により保存しておき、トルク指令の差分（偏差）を入力し、対応する位置指令オフセット量を出力する。トルク偏差と位置指令オフセット量との関係は、図９の構成等により予め求めて記録手段に記録しておく。記録手段は、入力したトルク偏差に対応する位置指令オフセット量を出力する。
【００８３】
同期補正処理部１０で得られた位置指令オフセット量は、サーボ回路部Ｂの位置制御部２Ｂの位置指令に加えられる。なお、位置指令オフセット量は、サーボ回路部Ｂの位置制御部２Ｂの位置偏差に限らず、サーボ回路部Ａの位置制御部２Ａの位置偏差に加えるようにしてもよい。
【００８４】
また、図１０に示す例ではトルク偏差と位置指令オフセット量との関係を格納しているが、実電流偏差と位置指令オフセット量との関係を格納しておき、実電流の差分を入力して位置指令オフセット量を出力する構成とすることもできる。また、図７〜図１０で示した構成例では、同期補正処理部１０から出力される位置指令オフセット量を、一方のサーボ回路の位置制御部に位置指令に加えているが、両方のサーボ回路の位置制御部の位置指令に加えるようにしてもよい。図１１は第８の例であり、両方のサーボ回路の位置制御部の位置指令に位置指令オフセット量を加える構成例を示している。
【００８５】
なお、サーボ回路部Ａ及びサーボ回路部Ｂの位置制御部２Ａ，２Ｂの位置指令に位置指令オフセット量を加える構成以外は、図７に示した構成と同様であるので、ここでの説明は省略する。
【００８６】
図１２は、本発明による同期制御と従来の同期制御とを比較する図である。従来の同期制御では、位置指令と位置検出器で検出した位置フィードバックとを一致させる制御を行う。この制御は各モータ毎に行うため、両モータの位置に位置検出器の誤差や熱膨張によってずれが生じた場合には、この位置ずれにより、一方のモータ１には引く方向に力が発生し、他方のモータ２には押す方向の力が発生する。この反対方向の力により、両モータにはストレスが加わることになる。
【００８７】
これに対して、本発明の同期制御では、各モータからの位置フィードバック値が位置指令と一致するように位置制御することに代えて、モータ間に働く力を求め、このモータ間に働く力が減少するように制御する。この制御によれば、両モータの位置に位置検出器の誤差や熱膨張によってずれが生じた場合にも、両モータに働く力を低減させるように制御するため、両モータに加わるストレスを低減させることができる。
【００８８】
図１３はモータ送り時における位置偏差と電流指令との関係を示している。図１３（ａ）は本発明の同期制御の適用前の状態を示し、図１３（ｂ）は本発明の同期制御の適用後の状態を示している。
【００８９】
図１３（ａ）によれば、２つのモータが引っ張りあうため、両モータの電流指令が大きくなる。一方、図１３（ｂ）によれば、２つのモータが引っ張りあう現象が改善され、両モータの電流指令が小さくなる。また、位置偏差も小さくなる。なお、図１３では、モータによる移動中の状態と停止中の状態を示している。
【００９０】
図１４は円弧補正時における位置偏差を示している。図１４（ａ）は本発明の同期制御の適用前の状態を示し、図１４（ｂ）は本発明の同期制御の適用後の状態を示している。
図１４（ａ）によれば、２つのモータが干渉しながら動くため、精度が低下する。一方、図１４（ｂ）によれば、２つのモータが干渉が緩和されるため、精度が向上される。
【００９１】
次に、モータ間に働く力が小さい場合には補正を行わず、所定値を超えた場合に補正を行う形態について、図１５〜図１８を用いて位置偏差を補正する形態について説明し、図１９，図２０を用いて位置指令を補正する形態について説明する。
【００９２】
なお、以下では、位置偏差を補正する形態において、トルク指令の差分から位置偏差オフセット量を計算する例について説明し、実電流の差分から位置偏差オフセット量を計算する例、トルク値−位置偏差オフセット量のテーブルを使用する例、２つのモータに補正をかける例等については同様であるため省略する。
【００９３】
また、位置指令を補正する形態においても、トルク指令の差分から位置指令オフセット量を計算する例について説明し、実電流の差分から位置指令オフセット量を計算する例、トルク値−位置指令オフセット量のテーブルを使用する例、２つのモータに補正をかける例等については同様であるため省略する。
【００９４】
はじめに、位置偏差を補正する形態について図１５を用いて説明する。図１５はトルク指令の差分から位置偏差オフセット量を計算する例であり、前記図２とほぼ同様の構成とすることができる。この形態は、図２に示す形態において、２つのサーボモータに働く力の差分が一定値を超えた場合に位置偏差のオフセット量を計算する位置偏差オフセット計算処理部１０ｅと、位置偏差オフセット計算処理部で計算された位置偏差オフセット量を位置偏差に加算する手段とを備える。
【００９５】
位置偏差オフセット計算処理部１０ｅは、２つのサーボモータに働く力の差分にベースを設け、この差分がベース以下である場合には「０」を出力し、差分がベースを超える場合には差分からベース分を差し引いた量又は差分量を出力する。
【００９６】
図１７、図１８は位置偏差オフセット計算処理部１０ｅの出力例であり、横軸に２つのサーボモータに働く力の差分（TCMD1−TCMD2）を示し、縦軸に出力ΔＴを示している。
図１７に示す出力例は、差分がベース以下である場合には「０」を出力し、差分がベース（Base）を超える場合には差分からベース分を差し引いた量（TCMD1−TCMD2−Base）を出力する。また、図１８に示す出力例は、差分がベース以下である場合には「０」を出力し、差分がベース（Base）を超える場合には差分量（TCMD1−TCMD2）を出力する。
【００９７】
同期補正処理部１０は、２つのサーボモータに指令されるトルク指令の差分について、位置偏差オフセット計算処理部１０ｅにより、２つのサーボモータに働く力の差分（TCMD1−TCMD2）がベース（Base）以下である場合には、サーボモータに働く力の差はないものとし、位置偏差オフセット量は算出せず、２つのサーボモータに働く力の差分（TCMD1−TCMD2）がベース（Base）を超えた場合に、サーボモータに働く力の差を出力して位置偏差オフセット量は算出する。
【００９８】
図１６に示すフローチャートは、同期補正処理部が行う位置偏差オフセットの計算処理を示しており、図１５に示すトルク指令の差分から位置偏差オフセットを求める例について示している。また、位置偏差オフセット計算処理部１０ｅは図１７に示す出力特性を備えるものとする。
【００９９】
図１６に示すフローチャートは図３に示すフローチャートとほぼ同様であり、ステップＳ２２の差分の算出工程における算出出力の点で相違し、その他の工程は共通している。そこで、ここではステップＳ２２の工程についてのみ説明する。ステップＳ２２の差分の算出工程において、位置偏差オフセット計算処理部１０ｅの出力である偏差ΔＴは、図１７に示すように、モータ１のトルク指令TCMD1がモータ２のトルク指令TCMD2よりも大きい場合には（TCMD1−TCMD2−Base）と０の大きい方を出力し、モータ１のトルク指令TCMD1がモータ２のトルク指令TCMD2よりも小さい場合には（TCMD1−TCMD2＋Base）と０の大きい方を出力する。
【０１００】
ステップＳ２２の工程において偏差ΔＴを算出した後は、ステップＳ２３〜ステップＳ２７において、図３のフローチャートのステップＳ３〜ステップＳ７と同様の処理により速度指令を計算する。
【０１０１】
次に、位置指令を補正する形態について図１９を用いて説明する。図１９はトルク指令の差分から位置指令オフセット量を計算する例であり、前記図７とほぼ同様の構成とすることができる。この形態は、図７に示す形態において、２つのサーボモータに働く力の差分が一定値を超えた場合に位置偏差のオフセット量を計算する位置偏差オフセット計算処理部１０ｅと、位置偏差オフセット計算処理部で計算された位置偏差オフセット量を位置偏差に加算する手段とを備える。
【０１０２】
位置偏差オフセット計算処理部１０ｅは、前記したと同様に、２つのサーボモータに働く力の差分にベースを設け、この差分がベース以下である場合には「０」を出力し、差分がベースを超える場合には差分からベース分を差し引いた量又は差分量を出力する。
位置偏差オフセット計算処理部１０ｅの出力特性は、前記した図１７，１８と同様とすることができる。
【０１０３】
同期補正処理部１０は、２つのサーボモータに指令されるトルク指令の差分について、位置偏差オフセット計算処理部１０ｅにより、２つのサーボモータに働く力の差分（TCMD1−TCMD2）がベース（Base）以下である場合には、サーボモータに働く力の差はないものとし、位置偏差オフセット量は算出せず、２つのサーボモータに働く力の差分（TCMD1−TCMD2）がベース（Base）を超えた場合に、サーボモータに働く力の差を出力して位置偏差オフセット量は算出する。
【０１０４】
図２０に示すフローチャートは、同期補正処理部が行う位置指令オフセットの計算処理を示しており、図１５に示すトルク指令の差分から位置指令オフセットを求める例について示している。また、位置偏差オフセット計算処理部１０ｅは図１７又は図１８に示す出力特性を備えるものとする。
【０１０５】
図１６に示すフローチャートは図３に示すフローチャートとほぼ同様であり、ステップＳ３２の差分の算出工程における算出出力の点で相違し、その他の工程は共通している。そこで、ここではステップＳ３２の工程についてのみ説明する。ステップＳ３２のトルク指令の偏差の算出工程において、位置偏差オフセット計算処理部１０ｅの出力である偏差ΔＴは、図１７又は図１８に示すように、モータ１のトルク指令TCMD1がモータ２のトルク指令TCMD2よりも大きい場合には（TCMD1−TCMD2−Base）と０の大きい方を出力し、モータ１のトルク指令TCMD1がモータ２のトルク指令TCMD2よりも小さい場合には（TCMD1−TCMD2＋Base）と０の大きい方を出力する。
【０１０６】
ステップＳ３２の工程において偏差ΔＴを算出した後は、ステップＳ３３〜ステップＳ３６において、図８のフローチャートのステップＳ１３〜ステップＳ１６と同様の処理により位置指令オフセット量を計算し位置指令に加算する。
【０１０７】
上記したように、モータ間に働く力にベース分を設け、このベース分よりも力の差が大きくなった場合にのみ補正を行うことによりスレーブ側に発生する位置偏差を防ぐことができる。
【図面の簡単な説明】
【０１０８】
【図１】本発明の同期制御装置の概略を説明するための概略ブロック図である。
【図２】トルク指令の差分から得られる位置偏差オフセットにより位置偏差を補正する構成例を示す図である。
【図３】本発明の位置偏差を補正する態様のフローチャートである。
【図４】実電流の差分から得られる位置偏差オフセットにより位置偏差を補正する構成例を示す図である。
【図５】トルク偏差と位置偏差オフセットのテーブルにより位置偏差を補正する構成例を示す図である。
【図６】２つのモータに対して位置偏差補正を行う構成例を示す図である。
【図７】トルク指令の差分から得られる位置指令オフセットにより位置指令を補正する構成例を示す図である。
【図８】本発明の位置指令を補正する態様のフローチャートである。
【図９】実電流の差分から得られる位置指令オフセットにより位置指令を補正する構成例を示す図である。
【図１０】トルク偏差と位置指令差オフセットのテーブルにより位置指令を補正する構成例を示す図である。
【図１１】２つのモータに対して位置指令補正を行う構成例を示す図である。
【図１２】本発明による同期制御と従来の同期制御とを比較する図である。
【図１３】モータ送り時における位置偏差と電流指令との関係を示す図である。
【図１４】円弧補正時における位置偏差を示す図である。
【図１５】トルク指令の差分から得られる位置偏差オフセットにより位置偏差を補正する他の構成例を示す図である。
【図１６】本発明の位置偏差を補正する他の態様のフローチャートである。
【図１７】位置偏差オフセット計算処理部の出力例である。
【図１８】位置偏差オフセット計算処理部の他の出力例である。
【図１９】トルク指令の差分から得られる位置指令オフセットにより位置指令を補正する別の構成例を示す図である。
【図２０】本発明の位置偏差を補正する別の態様のフローチャートである。
【符号の説明】
【０１０９】
１  同期制御装置
２Ａ，２Ｂ  位置制御部
３Ａ，３Ｂ  速度制御部
４Ａ，４Ｂ  電流制御部
５Ａ，５Ｂ  サーボモータ
６  対象物（ワーク）
Ａ，Ｂ  サーボ回路部
１０  同期補正処理部
１０ａ  フィルタ
１０ｂ  位置偏差オフセット量を計算する手段
１０ｃ  位置偏差オフセット量を制限するリミット手段
１０ｄ  テーブル
１０ｅ  位置偏差オフセット計算処理部
【図１】
2004288164.tif 000003
【図２】
2004288164.tif 000004
【図３】
2004288164.tif 000005
【図４】
2004288164.tif 000006
【図５】
2004288164.tif 000007
【図６】
2004288164.tif 000008
【図７】
2004288164.tif 000009
【図８】
2004288164.tif 000010
【図９】
2004288164.tif 000011
【図１０】
2004288164.tif 000012
【図１１】
2004288164.tif 000013
【図１２】
2004288164.tif 000014
【図１３】
2004288164.tif 000015
【図１４】
2004288164.tif 000016
【図１５】
2004288164.tif 000017
【図１６】
2004288164.tif 000018
【図１７】
2004288164.tif 000019
【図１８】
2004288164.tif 000020
【図１９】
2004288164.tif 000021
【図２０】
2004288164.tif 000022