JP5429576B2 - Synchronous control device - Google Patents
Synchronous control device Download PDFInfo
- Publication number
- JP5429576B2 JP5429576B2 JP2011191023A JP2011191023A JP5429576B2 JP 5429576 B2 JP5429576 B2 JP 5429576B2 JP 2011191023 A JP2011191023 A JP 2011191023A JP 2011191023 A JP2011191023 A JP 2011191023A JP 5429576 B2 JP5429576 B2 JP 5429576B2
- Authority
- JP
- Japan
- Prior art keywords
- command
- axis
- position information
- control
- control device
- 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.)
- Active
Links
Description
本発明は、機械的に結合された複数のモータを同期して駆動する同期制御装置に関する。 The present invention relates to a synchronous control device that drives a plurality of mechanically coupled motors in synchronization.
第１の従来技術の同期制御装置は、スピンドルモータに対する上位制御装置からの指令及びスピンドルモータに設けられた検出器からフィードバックされたスピンドルモータの検出値の差である位置偏差と、送り側モータの上位制御装置からの指令及び送り側モータに設けられた検出器からフィードバックされた送り側モータの検出値の差である位置偏差との差分である同期誤差に基づいて送り側モータの位置偏差を補正する補正データを算出する補正データ算出手段を備え、補正データを送り側モータの位置偏差に加算し、同期誤差をゼロに近づける制御をすることが記載されている（例えば、特許文献１参照）。 The first conventional synchronous control device includes a positional deviation which is a difference between a command from a host controller for a spindle motor and a detected value of the spindle motor fed back from a detector provided in the spindle motor, The position deviation of the feed motor is corrected based on the synchronization error that is the difference between the command from the host controller and the position deviation that is the difference between the detected values of the feed motor fed back from the detector provided in the feed motor. It is described that a correction data calculation means for calculating correction data to be calculated is provided, and the correction data is added to the position deviation of the feed motor to control the synchronization error close to zero (for example, refer to Patent Document 1).
第２の従来技術の同期制御装置は、位置指令と位置検出器からの位置フィードバックとの位置偏差に基づいて所定周期毎に速度指令を出力する位置制御部と、速度指令と速度検出器からの速度フィードバックとに基づいて所定周期毎にトルク指令を出力する速度制御部によりサーボモータを駆動制御する制御装置であって、同じ制御対象を駆動する２つのサーボモータを同期制御し、この２つのサーボモータ間に働く力に基づいて２つのサーボモータ間に働く力を減少させる同期補正処理部を備えることが記載されている（例えば、特許文献２参照）。 The second conventional synchronous control device includes a position control unit that outputs a speed command at predetermined intervals based on a position deviation between a position command and a position feedback from the position detector, and a speed command and a speed detector. A control device that drives and controls a servo motor by a speed control unit that outputs a torque command at predetermined intervals based on speed feedback, and controls the two servo motors that drive the same controlled object synchronously. It describes that a synchronization correction processing unit is provided that reduces the force acting between two servo motors based on the force acting between the motors (see, for example, Patent Document 2).
第３の従来技術の同期制御装置は、マスタ軸およびスレーブ軸の現在位置をそれぞれ検出し、検出されたマスタ軸の位置に基づいて、マスタ軸の位置に対応する理論的位置をスレーブ軸ごとに算出し、各スレーブ軸について、算出された理論的位置と検出された実際の位置との同期誤差を算出し、算出された同期誤差に基づいて、スレーブ軸の利得を変化させることが記載されている（例えば、特許文献３参照）。 The third prior art synchronous control device detects the current position of each of the master axis and the slave axis, and based on the detected position of the master axis, sets the theoretical position corresponding to the position of the master axis for each slave axis. It is described that, for each slave axis, the synchronization error between the calculated theoretical position and the detected actual position is calculated, and the gain of the slave axis is changed based on the calculated synchronization error. (For example, see Patent Document 3).
第１乃至３の従来技術の同期制御装置が駆動する同期機構を用いて、その課題を説明する。図６は、同期制御装置が駆動する第１の同期機構（ガントリ構造）を示す図である。この第１の同期機構（ガントリ構造）は、基板に半導体部品をマウントするマウンタ、基板に半導体部品をはんだ付けするボンディングマシン、塗布装置などの産業機械、半導体または液晶製造装置に用いられる構成である。
第１乃至３の従来技術の同期制御装置は、このような第１の同期機構（ガントリ構造）を駆動する場合、同一の位置制御構成であるサーボアンプ１５，１６に対して指令器１４から同一の位置指令を位置情報伝送路１２６を介して送信して２軸（Ｘ１軸、Ｘ２軸）を同期制御する。
The problem will be described using a synchronization mechanism driven by the first to third conventional synchronization control devices. FIG. 6 is a diagram showing a first synchronization mechanism (gantry structure) driven by the synchronization control device. The first synchronization mechanism (gantry structure) is a configuration used for a mounter for mounting a semiconductor component on a substrate, a bonding machine for soldering the semiconductor component to the substrate, an industrial machine such as a coating apparatus, a semiconductor or a liquid crystal manufacturing apparatus. .
The first to third conventional synchronous control devices, when driving such a first synchronous mechanism (gantry structure), are identical from the commander 14 to the servo amplifiers 15 and 16 having the same position control configuration. Are transmitted via the position information transmission path 126 to synchronously control the two axes (X1 axis, X2 axis).
しかしながら、互いの軸を機械結合部９で締結するような第１の同期機構（ガントリ構造）では、この機械結合部９の剛性が高いほど、一方の軸が他方の軸へ、他方の軸から一方の軸へ、互いに加えるねじり反力（以下、無効反力という）が大きくなる。
この無効反力は、リニアスケール１２の製造のばらつきや機構への取り付け誤差、機構自体の組み付け精度等に起因するものであって、サーボアンプ１５，１６に対する外乱として双方の位置制御系に影響を与えるものである。すなわち、この無効反力は、サーボアンプ１５，１６の推力指令値に対して逆符号の推力となり、サーボアンプ１５，１６ではこの無効反力を打ち消すために、更に推力指令値を増加させる必要があるため（負荷率の増加のため）、エネルギー効率が著しく悪化するという問題があった。また、この無効反力が大きい場合、サーボアンプ１５，１６が出力できる推力上限値を超える恐れがあり、越えた場合は正常な位置制御動作および同期制御も出来ないという問題もあった。
However, in the first synchronization mechanism (gantry structure) in which the shafts are fastened by the mechanical coupling portion 9, as the rigidity of the mechanical coupling portion 9 increases, one shaft moves to the other shaft and from the other shaft. A torsional reaction force (hereinafter referred to as an ineffective reaction force) applied to one shaft increases.
This reactive reaction force is caused by variations in the production of the linear scale 12, an error in attachment to the mechanism, the assembly accuracy of the mechanism itself, and the like, and it affects both position control systems as a disturbance to the servo amplifiers 15 and 16. To give. That is, this reactive reaction force becomes a thrust having an opposite sign to the thrust command value of the servo amplifiers 15 and 16, and the servo amplifiers 15 and 16 need to further increase the thrust command value in order to cancel this invalid reaction force. As a result (due to an increase in the load factor), there was a problem that the energy efficiency was remarkably deteriorated. Further, when this reactive reaction force is large, there is a possibility that the upper limit value of the thrust that can be output by the servo amplifiers 15 and 16 may be exceeded, and when it exceeds, there is a problem that normal position control operation and synchronous control cannot be performed.
また、第１乃至３の従来技術の同期制御装置は、サーボアンプ軸間に位置情報伝送路以外の伝送路が必要である。すなわち、第１の従来技術の同期制御装置は位置偏差伝送路、第２，３の従来技術の同期制御装置はトルク指令伝送路が、サーボアンプ軸間に必要である。これら新たな伝送路は、通常、サーボアンプの汎用製品には存在しないものであるため、第１乃至３の従来技術の同期制御装置は専用品で構成せざるを得ず、コスト面や保守性、納期等の問題もあった。 The first to third conventional synchronous control devices require a transmission line other than the position information transmission line between the servo amplifier shafts. That is, the first conventional synchronous control device requires a position deviation transmission line, and the second and third conventional synchronous control devices require a torque command transmission line between the servo amplifier shafts. Since these new transmission lines do not normally exist in general-purpose products of servo amplifiers, the first to third prior art synchronous control devices must be configured as dedicated products, and cost and maintainability are reduced. There were also problems such as delivery time.
更に、Ｎ軸同期制御（Ｎは軸数であり、Ｎ＞１の自然数）において、１つの検出位置をマスタ位置とし残りの（Ｎ−１）軸の位置はスレーブ位置とする場合がある。例えば、図６においては、Ｘ１軸の検出位置がマスタ位置、Ｘ２軸の検出位置がスレーブ位置となる。図６のような同期機構（ガントリ構造）の場合、Ｘ１およびＸ２軸と直交するＹ軸が存在し、これらＸＹ軸座標系上に作業位置（作業中心）が存在することが多い。Ｙ軸座標は、Ｘ１軸とＸ２軸との軸間を移動する座標であるため、作業位置は必ずしもマスタ位置上（Ｘ１軸上）に存在するとは限らず、作業位置に対する同期制御ができないという問題もあった。 Further, in N-axis synchronous control (N is the number of axes and N> 1 is a natural number), one detection position may be a master position and the remaining (N-1) -axis positions may be slave positions. For example, in FIG. 6, the detected position of the X1 axis is the master position, and the detected position of the X2 axis is the slave position. In the case of a synchronization mechanism (gantry structure) as shown in FIG. 6, there are Y axes orthogonal to the X1 and X2 axes, and a work position (work center) often exists on these XY axis coordinate systems. Since the Y-axis coordinate is a coordinate that moves between the X1 axis and the X2 axis, the work position does not necessarily exist on the master position (on the X1 axis), and synchronization control with respect to the work position cannot be performed. There was also.
本発明はこのような問題点に鑑みてなされたものであり、複数のモータで同一方向の座標軸を駆動する機械に対して、汎用的な電機品（モータ、サーボアンプ、指令器など）を用いて各軸間相互に加わる無効反力を抑制すると共に、作業位置に対する同期制御を高精度に行なう同期制御装置を提供する。 The present invention has been made in view of such problems, and uses a general-purpose electrical product (motor, servo amplifier, commander, etc.) for a machine that drives coordinate axes in the same direction by a plurality of motors. A synchronous control device that suppresses the reactive reaction force applied between the axes and performs the synchronous control on the work position with high accuracy is provided.
上記問題を解決するため、本願の代表的な発明は、次のように構成したのである。
同期制御装置は、Ｎ個（Ｎ＞１の自然数）のモータと、前記Ｎ個のモータの位置情報をそれぞれ検出するＮ個の位置検出器と、前記Ｎ個のモータの可動部分を互いに締結する機械結合部を含む機械と、を有する制御対象に対して、前記Ｎ個のモータを同期制御する同期制御装置であって、前記Ｎ個の位置検出器に対応してＮ個設けられたモータ制御装置であって、各モータ制御装置が、対応する１つの前記位置検出器からの１つの前記モータに係わる前記位置情報に基づき当該１つのモータに対し位置・速度制御を行う１つの位置制御系をそれぞれ構成する、前記Ｎ個のモータ制御装置と、前記Ｎ個のモータ制御装置それぞれによる前記Ｎ個の位置制御系とは別に、前記Ｎ個の位置検出器からの前記Ｎ個の位置情報すべてに基づき位置制御を行う１つの位置制御系を構成し、前記Ｎ個のモータ制御装置すべてに対し共通の駆動位置指令を出力すると共に、前記Ｎ個の位置検出器からの前記Ｎ個の位置情報すべてに基づき前記機械における作業中心である作業位置の軸座標系位置を算出する指令装置と、を有し、前記指令装置は、前記作業位置の軸座標系位置と作業位置指令との差を、位置比例積分もしくは位置積分制御して前記共通の駆動位置指令を出力する位置制御部を有する。
In order to solve the above problems, the representative invention of the present application is configured as follows.
The synchronous control device fastens N motors (N> 1 natural number), N position detectors that respectively detect position information of the N motors, and movable parts of the N motors to each other. A synchronous control device for synchronously controlling the N motors with respect to a control target including a machine coupling unit, wherein N motor controls are provided corresponding to the N position detectors. A position control system in which each motor control device performs position / speed control on the one motor based on the position information related to the one motor from the corresponding one of the position detectors. In addition to the N motor control devices and the N position control systems respectively configured by the N motor control devices, all the N position information from the N position detectors is included. Based on position control Another position control system is configured to output a common drive position command to all the N motor control devices, and based on all the N position information from the N position detectors, the machine have a, a command device for calculating the axial coordinate system position of the work position is a work center in the command device, the difference between the working position command axis coordinate system position of the working position, the position proportional-integral or position A position control unit that performs integration control and outputs the common drive position command ;
本願の代表的な発明によると、複数のモータで同一方向の座標軸を駆動する機械に対して、汎用的な電機品（モータ、サーボアンプ、指令器など）を用いて各軸間相互に加わる無効反力を抑制すると共に、作業位置に対する同期制御を高精度に行なうことができる。すなわち、同期すべき複数のモータの推力（トルク）がほぼ同程度とすることができ、位置データの授受を行う位置情報伝送路（汎用のシリアル通信等を利用する）だけで、位置決め動作時や位置決め完了後の無効反力が少ない同期動作を実現することができる。
また、機械結合部の剛性や粘性摩擦の影響によるずれを小さくすることができ、指令器内の作業位置情報を位置決め完了時点で位置指令に厳密に一致させることができる。
According to the representative invention of the present application, a general-purpose electrical product (motor, servo amplifier, command unit, etc.) is used for each machine to drive the coordinate axes in the same direction with multiple motors. While suppressing the reaction force, the synchronous control with respect to the work position can be performed with high accuracy. That is, the thrusts (torques) of a plurality of motors to be synchronized can be made substantially the same, and only during a positioning operation or a position information transmission path (using general-purpose serial communication, etc.) for exchanging position data, Synchronous operation with less reactive reaction force after completion of positioning can be realized.
Further, the deviation due to the rigidity of the mechanical coupling portion and the influence of viscous friction can be reduced, and the work position information in the command device can be made to exactly match the position command at the time of completion of positioning.
以下、本発明の実施の形態について図を参照して説明する。 Hereinafter, embodiments of the present invention will be described with reference to the drawings.
先ず、本発明の第１の実施形態について図を参照して説明する。
図１は、本発明の第１の実施形態に係る同期制御装置のブロック図である。図において、同期制御装置１は、指令器２、サーボアンプ３，４を備える。
指令器２は、位置指令生成部２１、位置制御部２２、位置情報演算部２３で構成しており、位置指令生成部２１は、モータ５，６を駆動するための内部位置指令１２１を生成して位置制御部２２へ出力する。位置情報演算部２３は、サーボアンプ３，４から位置情報伝送路１２６を介して、エンコーダ７，８で検出された検出位置情報１３１，１４１を入力し、後述する演算により作業位置情報１２２を出力する。位置制御部２２は、内部位置指令１２１と作業位置情報１２２との偏差を入力して比例積分制御演算し、新たな位置指令信号１２５を位置情報伝送路１２６を介してサーボアンプ３，４に出力する。なお、位置情報伝送路１２６は、例えば高速のシリアル通信路等であればよく、各サーボアンプ３，４へ同期して位置情報を双方向で通信ができるものである。
また、作業位置情報１２２は、例えば、同期制御装置１が駆動する機構系がＸＹ軸座標系であって、内部位置指令１２１がＸＹ軸座標系での位置指令の場合、そのＸＹ軸座標系上に存在する作業位置（作業中心）の座標である。
First, a first embodiment of the present invention will be described with reference to the drawings.
FIG. 1 is a block diagram of a synchronous control device according to the first embodiment of the present invention. In the figure, the synchronous control device 1 includes a command device 2 and servo amplifiers 3 and 4.
The command device 2 includes a position command generation unit 21, a position control unit 22, and a position information calculation unit 23. The position command generation unit 21 generates an internal position command 121 for driving the motors 5 and 6. Output to the position controller 22. The position information calculation unit 23 inputs the detected position information 131 and 141 detected by the encoders 7 and 8 from the servo amplifiers 3 and 4 through the position information transmission path 126, and outputs the work position information 122 by calculation described later. To do. The position control unit 22 inputs a deviation between the internal position command 121 and the work position information 122 to perform proportional integral control calculation, and outputs a new position command signal 125 to the servo amplifiers 3 and 4 via the position information transmission path 126. To do. The position information transmission path 126 may be a high-speed serial communication path, for example, and can communicate position information bidirectionally in synchronization with the servo amplifiers 3 and 4.
The work position information 122 is, for example, on the XY axis coordinate system when the mechanism system driven by the synchronous control device 1 is an XY axis coordinate system and the internal position command 121 is a position command in the XY axis coordinate system. Is the coordinates of the work position (work center) existing in.
サーボアンプ３は、位置制御部３１、速度制御部３２、速度演算部３３、電流制御部３４で構成しており、サーボアンプ４も同一の構成（位置制御部４１、速度制御部４２、速度演算部４３、電流制御部４４）のものである。
位置制御部３１，４１は、新たな位置指令信号１２５と検出位置情報１３１，１４１との偏差を入力して比例制御演算し、速度指令を出力する。速度演算部３３，３４は、検出位置情報１３１，１４１を入力して微分演算し、速度フィードバック信号を出力する。速度制御部３２，４２は、速度指令と速度フィードバック信号との偏差を入力して比例制御演算し、モータを駆動する指令を出力する。モータ巻き線に電圧を加え、電流を流すことでモータへ電力を供給するので、モータを駆動する指令としては、電圧または電流指令となる。通常は電流指令とすることが多い。すなわち、電流制御部３４，４４は、電流指令相当の電流を制御演算してモータ５，６に供給する。モータは、供給された電流に比例した力を発生する。例えば、同期回転型モータならばトルク、リニアモータならば推力を発生する。
The servo amplifier 3 includes a position control unit 31, a speed control unit 32, a speed calculation unit 33, and a current control unit 34. The servo amplifier 4 also has the same configuration (position control unit 41, speed control unit 42, speed calculation). Part 43 and current control part 44).
The position controllers 31 and 41 input a deviation between the new position command signal 125 and the detected position information 131 and 141, perform proportional control calculation, and output a speed command. The speed calculation units 33 and 34 receive the detected position information 131 and 141, perform differential calculation, and output a speed feedback signal. The speed control units 32 and 42 input a deviation between the speed command and the speed feedback signal, perform proportional control calculation, and output a command for driving the motor. Since electric power is supplied to the motor by applying a voltage to the motor winding and flowing a current, the command for driving the motor is a voltage or current command. Usually, current command is often used. That is, the current control units 34 and 44 control and calculate a current corresponding to the current command and supply it to the motors 5 and 6. The motor generates a force proportional to the supplied current. For example, torque is generated for a synchronous rotary motor, and thrust is generated for a linear motor.
なお、モータ５，６、エンコーダ７，８、機械結合部９の構成は、図６で説明した第１の同期機構（ガントリ構造）の構成を簡単に表したものである。また、外乱トルク（反力）１９１は無効反力を意味するものであり、この無効反力は、例えばサーボアンプ３に対しては負の推力相当、サーボアンプ４に対しては正の推力相当となるものである。更に、図６における指令器１４、サーボアンプ１５，１６は、図１における指令器２、サーボアンプ３，４に相当するものである。
このように、本発明の第１の実施形態に係る同期制御装置は、サーボアンプ３，４内に構成した位置制御系とは別に、指令器２で他の位置制御系を備えるものである。指令器２内の位置制御部２２は積分演算を含むため、位置指令生成部２１が出力する内部位置指令１２１に対して作業位置情報１２２が位置ずれなく追従または位置決め動作を行うことができる。
なお、位置制御２２は積分制御のみでも同様の動作を行うことができる。
Note that the configurations of the motors 5 and 6, the encoders 7 and 8, and the mechanical coupling unit 9 simply represent the configuration of the first synchronization mechanism (gantry structure) described in FIG. 6. Disturbance torque (reaction force) 191 means an invalid reaction force, and this invalid reaction force corresponds to a negative thrust for the servo amplifier 3, for example, and a positive thrust for the servo amplifier 4. It will be. Further, the command device 14 and the servo amplifiers 15 and 16 in FIG. 6 correspond to the command device 2 and the servo amplifiers 3 and 4 in FIG.
As described above, the synchronous control device according to the first embodiment of the present invention includes the command device 2 and another position control system separately from the position control system configured in the servo amplifiers 3 and 4. Since the position control unit 22 in the command device 2 includes an integral operation, the work position information 122 can follow or position the internal position command 121 output from the position command generation unit 21 without any positional deviation.
The position control 22 can perform the same operation only by integral control.
次に、位置情報演算部２３が、検出位置情報１３１，１４１から作業位置情報１２２を演算する方法を説明する。
位置情報演算部２３は、式（１）で作業位置情報１２２のＸ座標を演算する。なお、ｍは０≦ｍ≦１であり、予め任意に指定される作業位置から決定されるものである（ｍの計算方法は後述の通りである）。
（作業位置情報１２２のＸ座標）
＝ ｍ×（検出位置情報１３１）＋（１−ｍ）×（検出位置情報１４１） ・・・ （１）
Next, a method in which the position information calculation unit 23 calculates the work position information 122 from the detected position information 131 and 141 will be described.
The position information calculation unit 23 calculates the X coordinate of the work position information 122 using Expression (1). Note that m is 0 ≦ m ≦ 1, and is determined from a work position arbitrarily designated in advance (a method for calculating m is as described later).
(X coordinate of the work position information 122)
= M × (detection position information 131) + (1−m) × (detection position information 141) (1)
図６（図１同様）に示す第１の同期機構（ガントリ構造）の構成であって、Ｘ１軸とＸ２軸との軸間の任意の位置に作業位置がある場合、式（１）により、Ｘ１軸の位置（検出位置情報１３１）とＸ２軸の位置（検出位置情報１４１）との間の任意の位置の作業位置情報１２２をＸ座標として算出することができ、エンコーダを取付けていない位置を位置指令に対して追従または位置決めすることができる。
例えば、式（１）におけるｍを０．５とすれば、Ｘ１軸とＸ２軸との軸間の中央位置を作業位置情報１２２のＸ座標として算出することができる。
このように、Ｘ１軸とＸ２軸との軸間距離をＬとした場合、ｍＬのＸ軸方向の作業位置情報が算出できる。
In the configuration of the first synchronization mechanism (gantry structure) shown in FIG. 6 (similar to FIG. 1) and the work position is at an arbitrary position between the X1 axis and the X2 axis, The work position information 122 at an arbitrary position between the position of the X1 axis (detected position information 131) and the position of the X2 axis (detected position information 141) can be calculated as an X coordinate. It is possible to follow or position the position command.
For example, if m in Equation (1) is 0.5, the center position between the X1 axis and the X2 axis can be calculated as the X coordinate of the work position information 122.
Thus, when the distance between the axes of the X1 axis and the X2 axis is L, the work position information in the X axis direction of mL can be calculated.
また、図６（図１同様）に示す第１の同期機構（ガントリ構造）の構成の場合、Ｘ１軸とＸ２軸に直交するＹ軸を構成し、Ｘ１軸、Ｘ２軸、Ｙ軸の各座標で決定される位置、すなわち作業位置で物の加工等の作業が行なわれる産業機械、半導体または液晶製造装置が多い。
なお、Ｙ軸もＸ１軸とＸ２軸と同様に他の（Ｙ軸用の）サーボアンプを備えて位置制御系を構成し、指令器２からの他の（Ｙ軸用の）位置指令に基づいて、他の（Ｙ軸用の）モータを駆動するように構成するものである。この場合、後述するようにＸ１軸、Ｘ２軸の座標に対し、これらに直交するＹ軸の座標にもとづいてｍの値が計算できる。すなわち、Ｙ軸の位置が作業位置情報１２２のＹ座標となり、ｍを用いた（１）式で計算した位置が作業位置情報１２２のＸ座標となる。
Further, in the case of the configuration of the first synchronization mechanism (gantry structure) shown in FIG. 6 (similar to FIG. 1), the Y axis orthogonal to the X1 axis and the X2 axis is configured, and the coordinates of the X1, X2, and Y axes There are many industrial machines, semiconductors, or liquid crystal manufacturing apparatuses in which work such as processing of objects is performed at the position determined by the above, that is, the work position.
Similarly to the X1 axis and the X2 axis, the Y axis includes another servo amplifier (for the Y axis) to form a position control system, and is based on another position command (for the Y axis) from the commander 2. The other motor (for the Y axis) is configured to be driven. In this case, as will be described later, the value of m can be calculated based on the coordinates of the Y axis orthogonal to the coordinates of the X1 axis and the X2 axis. That is, the position of the Y axis becomes the Y coordinate of the work position information 122, and the position calculated by the expression (1) using m becomes the X coordinate of the work position information 122.
以下、ｍの計算式を説明する。
図１６は、図６における第１の同期機構（ガントリ構造）を模式的に表した図である。図において、Ｘ１軸とＸ２軸はともにリニアスケールの位置であり、リニアスケールヘッドは検出位置１３１と１４１に位置している。Ｙ軸は、ストロークＬｙである。Ｙ軸のストロークエンドからＸ１軸エンコーダヘッドまでのオフセット距離をｄＹ１とし、Ｙ軸の原点（０位置）からＸ２軸までのオフセット距離をｄＹ２とする。
Ｙ軸の原点（０位置）をＹ座標（作業座標）の原点（０位置）にとり、Ｘ１軸、Ｘ２軸の原点（０位置）をＸ座標（作業座標）の原点（０位置）にとり、作業位置を（Ｐｘ、Ｐｙ）とする。
この場合、ｍは式（２）で計算できる。
ｍ＝（Ｐｙ＋ｄＹ２)／（ｄＹ１＋Ｌｙ＋ｄＹ２） ・・・ （２）
なお、図１６ではＹ軸の傾きを誇張しているが、実際の機械では、１ｍ前後のＹ軸ストロークに対して検出位置１３１と検出位置１４１の差は数十μｍ程度であるため、Ｙ軸の傾きはごくわずかな量である。Ｙ軸方向はＹ座標（作業座標）とほぼ平行と考えても計算上問題ないため、（２）式のｍを上述の（１）式に適用して検出位置１２２のＸ座標（Ｐｘ）を計算できる。
Hereinafter, the calculation formula of m will be described.
FIG. 16 is a diagram schematically showing the first synchronization mechanism (gantry structure) in FIG. In the figure, both the X1 axis and the X2 axis are the positions of the linear scale, and the linear scale head is located at the detection positions 131 and 141. The Y axis is the stroke Ly. The offset distance from the Y-axis stroke end to the X1-axis encoder head is dY1, and the offset distance from the Y-axis origin (0 position) to the X2-axis is dY2.
The origin (0 position) of the Y axis is taken as the origin (0 position) of the Y coordinate (work coordinate), and the origin (0 position) of the X1 axis and X2 axis is taken as the origin (0 position) of the X coordinate (work coordinate). Let the position be (Px, Py).
In this case, m can be calculated by equation (2).
m = (Py + dY2) / (dY1 + Ly + dY2) (2)
In FIG. 16, although the Y-axis inclination is exaggerated, the difference between the detection position 131 and the detection position 141 is about several tens of μm with respect to the Y-axis stroke of about 1 m in an actual machine. The slope of is a negligible amount. Even if it is considered that the Y-axis direction is almost parallel to the Y-coordinate (working coordinate), there is no problem in calculation. Can be calculated.
このように、Ｙ軸の位置からＸ軸方向の作業位置情報を算出することができる。また、図６に示す機械結合部９にＹ軸を移動する作業用ヘッド１３を取り付けた場合、Ｘ１軸とＸ２軸間の機械結合部９に歪みがあると、Ｙ軸の作業用ヘッド１３の位置によっては作業用ヘッド１３のＸ座標位置が、位置指令に対して機械的誤差が生じる問題があったが、前述した位置情報演算部２３の演算によれば、Ｙ軸が移動しても作業用ヘッド１３のＸ軸方向の位置を位置指令通りに位置決めすることができる。 Thus, the work position information in the X-axis direction can be calculated from the position of the Y-axis. In addition, when the working head 13 that moves the Y axis is attached to the mechanical coupling portion 9 shown in FIG. 6, if the mechanical coupling portion 9 between the X1 axis and the X2 axis is distorted, Depending on the position, there is a problem that the X coordinate position of the working head 13 causes a mechanical error with respect to the position command. The position of the head 13 in the X-axis direction can be positioned according to the position command.
図２は、第１の実施形態における速度およびトルクのシミュレーション波形を示す図である。図において、図１における作業位置情報１２２＝検出位置情報１３１とした場合であり、上段は速度波形、下段はトルク波形、縦軸は各振幅、横軸は時間軸である。
この場合、位置決め動作後の停止時(時間軸１６以降)の無効反力に相当する推力は約０．０５［ｐ−ｐ］程度であり、加減速時（時間軸０から３）の最大推力振幅（０．５程度）の約１０％程度である。
FIG. 2 is a diagram illustrating simulation waveforms of speed and torque in the first embodiment. In the figure, this is a case where the work position information 122 = detected position information 131 in FIG. 1, wherein the upper stage is a speed waveform, the lower stage is a torque waveform, the vertical axis is each amplitude, and the horizontal axis is a time axis.
In this case, the thrust corresponding to the reactive reaction force when stopped after the positioning operation (after time axis 16) is about 0.05 [pp], and the maximum thrust during acceleration / deceleration (time axes 0 to 3). It is about 10% of the amplitude (about 0.5).
ここで、第１乃至３の従来技術の同期制御装置における無効反力について説明する。
図１０は第１の従来技術の同期制御装置のブロック図、図１２は第２の従来技術の同期制御装置のブロック図、図１４は第３の従来技術の同期制御装置のブロック図である。また、図１１は第１の従来技術の同期制御装置における速度およびトルクのシミュレーション波形を示す図、図１３は第２の従来技術の同期制御装置における速度およびトルクのシミュレーション波形を示す図、図１５は第３の従来技術の同期制御装置における速度およびトルクのシミュレーション波形を示す図である。図１１，１３，１５において、図シミュレーション条件は図２と同様であり、上段は速度波形、下段はトルク波形、縦軸は各振幅、横軸は時間軸である。
Here, the reactive reaction force in the first to third conventional synchronous control devices will be described.
FIG. 10 is a block diagram of the first prior art synchronization control device, FIG. 12 is a block diagram of the second prior art synchronization control device, and FIG. 14 is a block diagram of the third prior art synchronization control device. FIG. 11 is a diagram showing simulation waveforms of speed and torque in the first conventional synchronous control device, FIG. 13 is a diagram showing simulation waveforms of speed and torque in the second conventional synchronous control device, and FIG. These are figures which show the simulation waveform of the speed and torque in the synchronous control apparatus of the 3rd prior art. 11, 13, and 15, the simulation conditions are the same as those in FIG. 2, the upper stage is the speed waveform, the lower stage is the torque waveform, the vertical axis is the amplitude, and the horizontal axis is the time axis.
それぞれの位置決め動作後の停止時(時間軸１６以降)の無効反力に相当する推力は、第１の従来技術の同期制御装置が約０．１［ｐ−ｐ］（図１１）、第２の従来技術の同期制御装置が約０．１５［ｐ−ｐ］（図１３）、第３の従来技術の同期制御装置が約０．３［ｐ−ｐ］（図１５）である。これらは、加減速時（時間軸０から３）の最大推力振幅（０．５程度）の約２０％、約３０％、約６０％に相当するものである。 The thrust corresponding to the reactive reaction force at the time of stopping after each positioning operation (after time axis 16) is about 0.1 [pp] (FIG. 11) by the first prior art synchronous control device. The conventional synchronous control device of the present invention is about 0.15 [pp] (FIG. 13), and the third prior art synchronous control device is about 0.3 [pp] (FIG. 15). These correspond to about 20%, about 30%, and about 60% of the maximum thrust amplitude (about 0.5) during acceleration / deceleration (time axis 0 to 3).
このように、第１乃至３の従来技術の同期制御装置は、同一の位置指令に対して、各サーボアンプが位置指令に検出位置を完全に追従させようとするが、エンコーダ自身の誤差や取り付け誤差や機械の誤差（軸間でのズレ）により、特に位置決め停止後では各サーボアンプに無効反力が生じてしまう。この軸間でのズレを位置偏差やトルク指令等で検出して軸間で補正処理を行なっているが、本発明の実施形態と比べ無効反力を低減させるに至っていない。 As described above, in the first to third conventional synchronous control devices, each servo amplifier tries to make the detected position follow the position command completely with respect to the same position command. Due to errors and machine errors (deviation between axes), an invalid reaction force is generated in each servo amplifier, especially after positioning stops. Although the misalignment between the axes is detected by a position deviation, a torque command, or the like and correction processing is performed between the axes, the reactive reaction force has not been reduced as compared with the embodiment of the present invention.
本発明の実施形態（第１の実施形態および後述する第２，３，４の実施形態）に係る同期制御装置は、Ｎ軸同期制御（Ｎは軸数であり、Ｎ＞１の自然数）において、軸数分のエンコーダ位置と実際の同期機構における機械位置は厳密には一致しないこと、軸数分のモータの可動軸を互いに締結する結合部材の剛性により無効反力が発生すること、軸数分のエンコーダ位置の軸間でのズレと無効反力は相反すること、に着眼したものである。
すなわち、本発明の実施形態（第１の実施形態および後述する第２，３，４の実施形態）に係る同期制御装置は、Ｎ軸同期制御（Ｎは軸数であり、Ｎ＞１の自然数）において、位置指令に一致させる検出位置は複数ではなく１つに限定すること、各サーボアンプでの位置制御系を備えると共に位置指令に対して１つの検出位置を用いた位置制御系が必要であること、に基づき構成したものである。
The synchronous control device according to the embodiment of the present invention (the first embodiment and the second, third and fourth embodiments described later) is N-axis synchronous control (N is the number of axes and N> 1 is a natural number). The encoder position for the number of axes and the mechanical position in the actual synchronization mechanism do not exactly match, the reactive reaction force is generated due to the rigidity of the coupling members that fasten the movable shafts of the motor for the number of axes, the number of axes The focus is on the fact that the displacement of the encoder position between the axes of the minute and the reactive reaction force conflict.
That is, the synchronous control device according to the embodiment of the present invention (the first embodiment and the second, third, and fourth embodiments described later) performs N-axis synchronous control (N is the number of axes and N> 1 is a natural number). ), The detection position to be matched with the position command is limited to one, not a plurality, and a position control system with a position control system for each servo amplifier and using one detection position for the position command is required. It is based on what is.
本願の代表的な発明は、Ｎ軸同期制御（Ｎは軸数であり、Ｎ＞１の自然数）において、複数のエンコーダ位置から作業位置を算出してこの作業位置を位置指令に追従させる構成、各サーボアンプ内の積分演算をなくす構成（積分演算は動きが低周波になる程にゲインが大きくなるため、位置決め完了の停止時点で無効反力が増大する。この積分演算をなくすことで無効反力の増加を抑える）、サーボアンプのさらに外側に新たに位置制御系を１つ追加し、この位置制御系だけに積分演算を備える構成、とするものである。
このように、本願の代表的な発明は、制御対象の機械の精度なども総合的・本質的に考察したものである。
A typical invention of the present application is a configuration in which a work position is calculated from a plurality of encoder positions and the work position follows a position command in N-axis synchronous control (N is the number of axes and N> 1 is a natural number), Configuration that eliminates the integral calculation in each servo amplifier (The gain increases with the movement of the integral calculation at a lower frequency, so the reactive reaction force increases at the stop of positioning completion. In this configuration, one position control system is newly added to the outside of the servo amplifier, and an integral operation is provided only in this position control system.
As described above, the representative invention of the present application considers the accuracy of the machine to be controlled comprehensively and essentially.
なお、検出位置情報が各請求項記載の位置情報に、内部位置指令が位置指令に、作業位置情報が作業位置に、指令器が指令装置に、サーボアンプがモータ制御装置に相当する。 The detected position information corresponds to the position information described in each claim, the internal position command corresponds to the position command, the work position information corresponds to the work position, the command device corresponds to the command device, and the servo amplifier corresponds to the motor control device.
以下、様々な同期機構に対して、本発明の実施形態に係る同期制御装置の適用例を順に説明する。
次に、本発明の第２の実施形態について図を参照して説明する。
図７は、同期制御装置が駆動する第２の同期機構（他のガントリ構造）を示す図である。図において、作業位置近傍のＸ方向位置を正確に計測するために、レーザ干渉計１０１を用いた位置計測装置を取付けている。
レーザ干渉計１０１は、反射ミラーを機械結合部９上に設置し、レーザ干渉計からのレーザ光線の干渉により非接触で位置を計測する。このため、リニアスケール１２を設置できない場所で、機械結合部９の作業位置がＸ軸方向に直接計測できる。
Hereinafter, application examples of the synchronization control device according to the embodiment of the present invention will be sequentially described with respect to various synchronization mechanisms.
Next, a second embodiment of the present invention will be described with reference to the drawings.
FIG. 7 is a diagram showing a second synchronization mechanism (another gantry structure) driven by the synchronization control device. In the figure, a position measuring device using a laser interferometer 101 is attached in order to accurately measure the position in the X direction near the work position.
The laser interferometer 101 installs a reflection mirror on the mechanical coupling unit 9 and measures the position in a non-contact manner by the interference of the laser beam from the laser interferometer. For this reason, the work position of the mechanical coupling part 9 can be directly measured in the X-axis direction at a place where the linear scale 12 cannot be installed.
図３は、本発明の第２の実施形態に係る同期制御装置のブロック図である。図において、同期制御装置１０は、指令器２、サーボアンプ３，４、１７を備える。
第２の実施形態が第１の実施形態と異なる点は、同期制御装置１０が、レーザ干渉計１０１の検出位置情報をサーボアンプ１７に入力し、検出位置情報１７１として位置情報伝送路１２６を介して指令器２内の位置情報演算部２３に入力する点、位置情報演算部２３は、レーザ干渉計１０１だけの検出位置情報１７１を用い、サーボアンプ３，４からの検出位置情報１３１と検出位置情報１４１は用いない点である。このため、同期制御装置１０は、サーボアンプ１７にはモータは接続せず、レーザ干渉計１０１の検出位置情報１７１のみを位置情報伝送路１２６に伝送するデータ変換器としてサーボアンプ１７使用している。このように構成することで汎用製品のみで構成できる。
なお、エンコーダ（リニアスケール）７とエンコーダ８の検出分解能（１パルスあたりの長さ：例０．１μｍ／１パルスなど）と、レーザ干渉計１０１の検出位置分解能が異なる場合は、位置情報演算部２３内で電子ギア演算を行い、分解能をあわせておけばよい。
FIG. 3 is a block diagram of a synchronous control device according to the second embodiment of the present invention. In the figure, the synchronous control device 10 includes a command device 2 and servo amplifiers 3, 4, and 17.
The second embodiment is different from the first embodiment in that the synchronization control device 10 inputs the detected position information of the laser interferometer 101 to the servo amplifier 17 and detects the detected position information 171 via the position information transmission path 126. The position information calculation unit 23 uses the detection position information 171 of only the laser interferometer 101 and the detection position information 131 and the detection position from the servo amplifiers 3 and 4. The information 141 is not used. Therefore, the synchronous control device 10 uses the servo amplifier 17 as a data converter that transmits only the detected position information 171 of the laser interferometer 101 to the position information transmission path 126 without connecting a motor to the servo amplifier 17. . With this configuration, it can be configured with only general-purpose products.
If the detection resolution of the encoder (linear scale) 7 and the encoder 8 (length per pulse: eg 0.1 μm / 1 pulse) differs from the detection position resolution of the laser interferometer 101, the position information calculation unit It is only necessary to perform electronic gear calculation within 23 and match the resolution.
第２の実施形態では、作業位置近傍の位置をレーザ干渉計１０１で検出し、指令器２内の作業位置情報１２２として指令器２内の位置制御系へフィードバックしているため、Ｘ方向の作業位置を指令位置に対して第１の実施形態よりも正確に追従させることができる。 In the second embodiment, since the position in the vicinity of the work position is detected by the laser interferometer 101 and fed back to the position control system in the commander 2 as work position information 122 in the commander 2, work in the X direction is performed. The position can be made to follow the command position more accurately than in the first embodiment.
なお、レーザ干渉計が各請求項記載の位置計測装置に相当する。 The laser interferometer corresponds to the position measuring device described in each claim.
次に、本発明の第３の実施形態について図を参照して説明する。
図８は、同期制御装置が駆動する第３の同期機構（円弧リニア）を示す図である。図４は、本発明の第３の実施形態に係る同期制御装置のブロック図である。図４において、同期制御装置１１は、指令器２、サーボアンプ３，４、１７を備える。なお、サーボアンプ４，１７の制御構成は、サーボアンプ３と同一のため詳細な記載を省略している。
本発明の第３の実施形態に係る同期制御装置は、図８における円弧形状のリニアモータ５，６，１８に電力を供給して複数のリニアモータ可動子（例えば、リニアモータ可動子５３）を同期制御するものである。各リニアモータ可動子にリニアスケールの位置読み取りヘッドを取付けており、テープ式のリニアスケールなどを用いることで円弧状にスケールを貼り付けることができ、１本のリニアスケールを３個のヘッドで位置検出もしくは各ヘッドに対してそれぞれにリニアスケールを取付けてもよい。
第３の実施形態が第１の実施形態と異なる点は、同期制御装置１１が、３軸で構成される同期機構（例えば、図８）を同期制御する点である。なお、第１の実施形態の代表図である図１と同一の符号を付した構成要素は、その作用効果が同一のため詳細な説明を省略する。
Next, a third embodiment of the present invention will be described with reference to the drawings.
FIG. 8 is a diagram showing a third synchronization mechanism (circular linear) driven by the synchronization control device. FIG. 4 is a block diagram of a synchronous control device according to the third embodiment of the present invention. In FIG. 4, the synchronous control device 11 includes a command device 2 and servo amplifiers 3, 4, and 17. Since the control configuration of the servo amplifiers 4 and 17 is the same as that of the servo amplifier 3, detailed description thereof is omitted.
The synchronous control device according to the third embodiment of the present invention supplies electric power to the arc-shaped linear motors 5, 6, and 18 in FIG. 8 to provide a plurality of linear motor movable elements (for example, linear motor movable elements 53). Synchronous control is performed. A linear scale position reading head is attached to each linear motor mover. By using a tape-type linear scale, the scale can be attached in an arc shape, and one linear scale can be positioned with three heads. A linear scale may be attached to each detection or each head.
The third embodiment is different from the first embodiment in that the synchronization control device 11 synchronously controls a synchronization mechanism (for example, FIG. 8) configured with three axes. In addition, since the effect which the component which attached | subjected the code | symbol same as FIG. 1 which is a typical figure of 1st Embodiment has the same effect, it abbreviate | omits detailed description.
図４におけるモータ５，６，１８、エンコーダ７，８、１９、機械結合部９，１０５，１０６の構成は、図８で説明した第３の同期機構（円弧リニア）の構成を簡単に表したものである。なお、図８におけるターンテーブル（９，１０５，１０６）は、モータ５，６，１８がこのターンテーブル（９，１０５，１０６）を介して機械的に結合されているため、図４では機械結合部９，１０５，１０６で表記している。また、第１の実施例同様、各軸は機械結合部９，１０５，１０６により機械的に結合されているため、無効反力(外乱トルク１９１)が各軸に加わることになる。
指令器２における位置情報演算部２３は、サーボアンプ３，４、１７からの検出位置情報１３１，１４１，１７１に基づいて作業位置情報１２２を算出する。例えば、第１の実施例で説明した式（１）を用いた２軸の算出方法を３軸に展開すればよい（式（３），（４）参照）。
The configuration of the motors 5, 6, 18, encoders 7, 8, 19 and mechanical coupling units 9, 105, 106 in FIG. 4 simply represents the configuration of the third synchronization mechanism (circular linear) described in FIG. 8. Is. The turntable (9, 105, 106) in FIG. 8 is mechanically coupled in FIG. 4 because the motors 5, 6, 18 are mechanically coupled via the turntable (9, 105, 106). Parts 9, 105, and 106. Further, since each shaft is mechanically coupled by the mechanical coupling portions 9, 105, 106 as in the first embodiment, an invalid reaction force (disturbance torque 191) is applied to each shaft.
The position information calculation unit 23 in the command device 2 calculates work position information 122 based on the detected position information 131, 141, 171 from the servo amplifiers 3, 4, 17. For example, the biaxial calculation method using the equation (1) described in the first embodiment may be expanded to three axes (see equations (3) and (4)).
また、図８において、リニアスケールの取り付け誤差により１回転でＮ周期の誤差が発生（Ｎは自然数）する場合がある。例えば、図８中では、薄い厚みの円筒形状の部材にリニアスケールを貼っているが、直径が２ｍ程にもなる大型の円弧形状のターンテーブルの場合、円筒形状の部材が加工誤差や取り付け時の誤差により直径方向に歪む場合がある。この場合、機械結合部であるターンテーブル１回転でＮ周期の誤差が発生（Ｎは自然数）する。この誤差は、ターンテーブルが１回転すると元に戻るのでＮ周期の誤差となる。 Further, in FIG. 8, there may be an N-cycle error (N is a natural number) in one rotation due to a linear scale attachment error. For example, in FIG. 8, a linear scale is attached to a thin cylindrical member, but in the case of a large arc-shaped turntable having a diameter of about 2 m, the cylindrical member may be damaged due to machining errors or attachment. May cause distortion in the diameter direction. In this case, an N-cycle error occurs (N is a natural number) in one turn of the turntable, which is a mechanical coupling unit. This error becomes an error of N cycles because it returns to the original when the turntable rotates once.
例えば、１本のリニアスケールに３個のリニアスケールヘッドを取り付けて位置を検出する場合、サーボアンプ３経由でリニアスケールから検出する検出位置情報Ｘ１の真値をθ［ｒａｄ］、誤差に相当する微小値をδとし、リニアスケールに１周期の誤差が出るとすると、Ｘ１＝θ＋δｓｉｎ（θ）となる。
また、このリニアスケール円周上に１２０度（２π／３）毎にそれぞれリニアスケールヘッドを配置すれば、サーボアンプ４の検出位置情報Ｘ２、サーボアンプ１７の検出位置情報Ｘ３は、Ｘ２＝θ＋δｓｉｎ（θ―２π／３）、Ｘ３＝θ＋δｓｉｎ（θ―４π／３）となる。ここで、３個のリニアスケールヘッドは１２０度ずつ配置がずれているが、３つのモータで原点位置を共通の１つにすれば、真値θの値は同じにできるため、１周期の誤差は物理的な位置に依存し、θから１２０度、２４０度ずれた値となる。
For example, when three linear scale heads are attached to one linear scale to detect the position, the true value of the detected position information X1 detected from the linear scale via the servo amplifier 3 is θ [rad], which corresponds to an error. Assuming that a minute value is δ and an error of one cycle appears in the linear scale, X1 = θ + δsin (θ).
Further, if linear scale heads are arranged on the circumference of the linear scale every 120 degrees (2π / 3), the detected position information X2 of the servo amplifier 4 and the detected position information X3 of the servo amplifier 17 are X2 = θ + δsin ( θ−2π / 3) and X3 = θ + δsin (θ−4π / 3). Here, the three linear scale heads are misaligned by 120 degrees, but if the origin position is made common to the three motors, the true value θ can be made the same, so that there is an error of one cycle. Depends on the physical position, and is a value shifted by 120 degrees and 240 degrees from θ.
本発明の第３の実施形態に係る同期制御装置における位置情報演算部２３は、式（３）で作業位置情報１２２を平均化演算する。
（作業位置情報１２２）
＝（（検出位置情報１３１）＋（検出位置情報１４１）＋（検出位置情報１７１））／３ ・・・ （３）
また、式（３）は式（４）で表される。
（作業位置情報１２２）
＝θ＋δ（ｓｉｎ（θ）＋ｓｉｎ（θ―２π／３）＋ｓｉｎ（θ―４π／３）） ・・・ （４）
ここで、ｓｉｎ（θ）＋ｓｉｎ（θ―２π／３）＋ｓｉｎ（θ―４π／３）＝０であるから、（作業位置情報１２２）＝θとなり、作業位置情報１２２は誤差のない真値として求められる。
円弧状のリニアモータの個数がｍ個の場合は、３６０／ｍ度＝２π／ｍ毎にリニアスケールヘッドを配置すればよく、位置情報演算部２３ではｍ個の平均化演算を行えばよい。
The position information calculation unit 23 in the synchronous control device according to the third embodiment of the present invention averages the work position information 122 using Expression (3).
(Working position information 122)
= ((Detection position information 131) + (Detection position information 141) + (Detection position information 171)) / 3 (3)
Moreover, Formula (3) is represented by Formula (4).
(Working position information 122)
= Θ + δ (sin (θ) + sin (θ−2π / 3) + sin (θ−4π / 3)) (4)
Here, since sin (θ) + sin (θ−2π / 3) + sin (θ−4π / 3) = 0, (work position information 122) = θ, and the work position information 122 is a true value without error. Desired.
When the number of arc-shaped linear motors is m, a linear scale head may be arranged every 360 / m degrees = 2π / m, and the position information calculation unit 23 may perform m averaging calculations.
このように、本発明の第３の実施形態に係る同期制御装置は、サーボアンプ３，４，１７内に構成した位置制御系とは別に、指令器２で他の位置制御系を備えるものである。指令器２内の位置制御部２２は積分演算を含むため、位置指令生成部２１が出力する内部位置指令１２１に対して作業位置情報１２２が位置ずれなく追従または位置決め動作を行うことができる。また、位置情報演算部２３の平均化演算により、リニアスケールの取付け誤差により発生する１回転でＮ周期（Ｎは自然数）の誤差を低減することができる。 As described above, the synchronous control device according to the third embodiment of the present invention is provided with another position control system in the command unit 2 separately from the position control system configured in the servo amplifiers 3, 4, and 17. is there. Since the position control unit 22 in the command device 2 includes an integral operation, the work position information 122 can follow or position the internal position command 121 output from the position command generation unit 21 without any positional deviation. In addition, the averaging calculation of the position information calculation unit 23 can reduce an error of N cycles (N is a natural number) in one rotation generated due to a mounting error of the linear scale.
図５は、第３の実施形態における速度およびトルクのシミュレーション波形を示す図である。図において、上段は速度波形、下段はトルク波形、縦軸は各振幅、横軸は時間軸である。この場合、位置決め動作後の停止時(時間軸１６以降)の無効反力に相当する推力は約０．１［ｐ−ｐ］程度であり、加減速時（時間軸０から３）の最大推力振幅（０．５程度）の約２０％程度である。３軸の場合においても無効反力が少ないことが分かる。 FIG. 5 is a diagram showing simulation waveforms of speed and torque in the third embodiment. In the figure, the upper stage is a speed waveform, the lower stage is a torque waveform, the vertical axis is each amplitude, and the horizontal axis is a time axis. In this case, the thrust corresponding to the reactive reaction force when stopped after the positioning operation (after time axis 16) is about 0.1 [pp], and the maximum thrust during acceleration / deceleration (time axis 0 to 3). It is about 20% of the amplitude (about 0.5). It can be seen that the reactive reaction force is small even in the case of three axes.
このように、第３の実施形態によれば、同期制御する軸を容易に増やすことができ、各軸の無効反力も少なく抑えることができる。第１乃至３の従来の同期制御装置では、同期制御する軸数が増えるにつれて、軸間の制御構成が複雑となり、制御ゲイン等の調整も複雑であった。一方、第３の実施形態によれば、Ｎ軸（ＮはＮ＞１の自然数）に対する同期制御系を構成する際、Ｎ軸分の同一制御系のサーボアンプ（例えば、汎用のサーボアンプ）を準備すればよい。 Thus, according to the third embodiment, the number of axes to be synchronously controlled can be easily increased, and the reactive reaction force of each axis can be reduced. In the first to third conventional synchronous control devices, as the number of axes to be synchronously controlled increases, the control configuration between the axes becomes complicated, and the adjustment of the control gain and the like becomes complicated. On the other hand, according to the third embodiment, when configuring a synchronous control system for the N-axis (N is a natural number of N> 1), servo amplifiers (for example, general-purpose servo amplifiers) of the same control system for the N-axis are used. Just prepare.
Ｎ軸を同期制御する本発明の第３の実施形態に係る同期制御装置（２軸の場合は本発明の第１の実施形態に係る同期制御装置）は、例えば、プレス機械や射出成型機等の産業機械に適用可能である。
２台のモータと１枚の駆動歯車とをカップリング結合させた機構のプレス機械や射出成型機等の産業機械の場合、このカップリングが剛体の場合、一方の軸のモータのみを位置制御して他方のモータを連れ回しても、双方のモータのエンコーダ回転角度は一致するため、本発明の第１または３の実施形態に係る同期制御装置を適用できる。
一方、このカップリングの剛性が低い場合、駆動歯車の回転角度と２軸のモータ回転角度と必ずしも一致しないため、指令器内の位置情報演算部で式（５）の演算を行なう。
駆動歯車の回転角度＝１軸目モータ回転角度＋（ねじりモーメント÷ねじり剛性×１軸目エンコーダから駆動歯車までの距離） ・・・ （５）
このようにして駆動歯車の回転角度を作業位置情報とすれば、駆動歯車の回転角度を指令位置に追従させることができるため、本発明の第１または３の実施形態に係る同期制御装置を適用できる。
なお、ねじりモーメントは１軸目モータのトルクによって与えられ、ねじり剛性はカップリングの材質や形状によって与えられる。また、１軸目エンコーダから駆動歯車までの距離はモータを機械に組み付けた時点で幾何的に決定される。
The synchronous control device according to the third embodiment of the present invention that synchronously controls the N-axis (in the case of two axes, the synchronous control device according to the first embodiment of the present invention) is, for example, a press machine or an injection molding machine. It can be applied to other industrial machines.
In the case of an industrial machine such as a press machine or an injection molding machine with a mechanism in which two motors and one drive gear are coupled, if this coupling is a rigid body, only the motor on one shaft is controlled. Even if the other motor is rotated, the encoder rotation angles of both motors coincide with each other. Therefore, the synchronous control device according to the first or third embodiment of the present invention can be applied.
On the other hand, when the rigidity of the coupling is low, the rotation angle of the drive gear does not necessarily match the rotation angle of the two-axis motor, so the position information calculation unit in the command unit performs the calculation of Expression (5).
Drive gear rotation angle = 1st axis motor rotation angle + (torsion moment ÷ torsional rigidity x 1st axis encoder to drive gear) (5)
If the rotation angle of the drive gear is used as the work position information in this way, the rotation angle of the drive gear can be made to follow the command position. Therefore, the synchronous control device according to the first or third embodiment of the present invention is applied. it can.
The torsional moment is given by the torque of the first axis motor, and the torsional rigidity is given by the material and shape of the coupling. The distance from the first axis encoder to the drive gear is geometrically determined when the motor is assembled to the machine.
また、Ｎ軸を同期制御する本発明の第３の実施形態に係る同期制御装置（２軸の場合は本発明の第１の実施形態に係る同期制御装置）は、例えば、ワイヤソー送り出し軸とワイヤソー巻き取り軸の同期制御（ワイヤソーの基準位置からの送り出し量を外部センサによって計測し、この計測値を指令器へのフィードバック位置とする）、フィルム送り出し軸とフィルム巻き取り軸の同期制御（フィルムの基準位置からの送り出し量を外部センサによって計測し、この計測値を指令器へのフィードバック位置とする）にも適用可能である。 Further, the synchronous control device according to the third embodiment of the present invention for synchronously controlling the N-axis (in the case of two axes, the synchronous control device according to the first embodiment of the present invention) includes, for example, a wire saw delivery shaft and a wire saw Synchronous control of the take-up shaft (Measure the feed amount from the reference position of the wire saw with an external sensor, and use this measured value as the feedback position to the commander), Synchronous control of the film feed shaft and the film take-up shaft (film The present invention is also applicable to a method in which the amount of feed from the reference position is measured by an external sensor, and this measured value is used as a feedback position to the command device.
次に、本発明の第４の実施形態について図を参照して説明する。
本発明の第１の実施形態に係る同期制御装置は、サーボアンプ３，４における速度制御部３２，４２が比例制御のみであるため、サーボアンプ３、４の検出位置情報１３１,１３２は、位置決め完了時点で新たな位置指令１２５との差が出る場合がある。
本発明第１の実施形態では、作業位置情報１２２を位置決めする、すなわち内部位置指令１２１と作業位置情報１２２とを一致させることが目的のため、サーボアンプ３、４の検出位置情報１３１,１３２と位置決め完了時点の新たな位置指令１２５との差は問題ない。しかしながら、機械結合部９の剛性が低い場合や粘性摩擦が大きい場合等には、この差が大きくなる。この場合、サーボアンプ３，４における速度制御部３２，４２の制御系を不完全積分に変更することで、この差を少なくすることができる。
Next, a fourth embodiment of the present invention will be described with reference to the drawings.
In the synchronous control device according to the first embodiment of the present invention, since the speed control units 32 and 42 in the servo amplifiers 3 and 4 are only in proportional control, the detected position information 131 and 132 of the servo amplifiers 3 and 4 are positioned. There may be a difference from the new position command 125 at the time of completion.
In the first embodiment of the present invention, for the purpose of positioning the work position information 122, that is, to make the internal position command 121 and the work position information 122 coincide with each other, the detected position information 131, 132 of the servo amplifiers 3, 4 There is no problem with the difference from the new position command 125 when the positioning is completed. However, this difference becomes large when the rigidity of the mechanical coupling portion 9 is low or when the viscous friction is large. In this case, this difference can be reduced by changing the control system of the speed control units 32 and 42 in the servo amplifiers 3 and 4 to incomplete integration.
図９は、本発明の第４の実施形態に係る同期制御装置における速度制御部（比例＋不完全積分）のブロック図である。本発明の第４の実施形態に係る同期制御装置は、本発明の第１の実施形態に係る同期制御装置における各サーボアンプ３，４内の速度制御部３２，４２を、図９の速度制御部に置き換えるものである。
不完全積分の場合、不完全積分率を大きくすると比例制御に近づき、小さくすると積分制御に近づく。そのため、機械剛性が低い場合などは、モータトルクや推力での無効反力成分が小さいので、許容範囲内で不完全積分率を小さく調整すればよい（不完全積分率を小さくすると、この差は小さくなるが、無効反力が大きくなる。不完全積分率を大きくすると逆の動作となる）。
FIG. 9 is a block diagram of the speed control unit (proportional + incomplete integration) in the synchronous control device according to the fourth embodiment of the present invention. The synchronous control device according to the fourth embodiment of the present invention includes the speed control units 32 and 42 in the servo amplifiers 3 and 4 in the synchronous control device according to the first embodiment of the present invention. It replaces the part.
In the case of incomplete integration, increasing the incomplete integration rate approaches proportional control, and decreasing it approaches the integration control. For this reason, when the mechanical rigidity is low, the reactive reaction component in the motor torque and thrust is small. Therefore, the incomplete integration rate should be adjusted within the allowable range. (The reaction force decreases, but the reactive reaction force increases. Increasing the incomplete integration rate reverses the operation.)
更に、本発明の第１乃至３の実施形態に係る同期制御装置は、前述した構成にすることにより、Ｎ軸同期制御（Ｎは軸数であり、Ｎ＞１の自然数）において、加減速時における各軸のトルク（推力）をバランスさせることができる。このことは、図２，５（第１，３の実施形態における速度およびトルクのシミュレーション波形）と、図１０、１２，１４（第１乃至３の従来技術の同期制御装置における速度およびトルクのシミュレーション波形）とを比較すれば分かる。
また、本発明の第１乃至３の実施形態に係る同期制御装置は、前述した構成にすることにより、機械の実際の作業位置を位置指令に追従させることができる。
Furthermore, the synchronous control device according to the first to third embodiments of the present invention has the above-described configuration, so that the N-axis synchronous control (N is the number of axes and N> 1 is a natural number) during acceleration / deceleration. The torque (thrust) of each axis in can be balanced. 2 and 5 (speed and torque simulation waveforms in the first and third embodiments) and FIGS. 10, 12, and 14 (speed and torque simulations in the first to third conventional synchronous control devices). Comparing with (waveform).
Moreover, the synchronous control apparatus which concerns on the 1st thru | or 3rd embodiment of this invention can make an actual working position of a machine follow a position command by setting it as the structure mentioned above.
なお、本発明の第１乃至４の実施形態に係る同期制御装置は、指令器、サーボアンプそれぞれに位置制御系を有する構成を例として挙げたが、指令器およびサーボアンプが一体となる装置であっても、同様な作用効果を奏するものである。
また、外部からの位置指令を入力する装置であって、同様な２つの位置制御系を有する装置であってもよい。
In addition, although the synchronous control device according to the first to fourth embodiments of the present invention has exemplified the configuration having the position control system in each of the command device and the servo amplifier, it is a device in which the command device and the servo amplifier are integrated. Even if it exists, there exists the same effect.
Moreover, it is an apparatus which inputs the position command from the outside, Comprising: The apparatus which has the same two position control systems may be sufficient.
次に、本発明の第５の実施形態について図を参照して説明する。
図６のようなガントリ機構を備えた工作機械などでは、Ｘ, Ｙ方向への単独の位置決め動作だけではなく、Ｘ軸とＹ軸を円弧補間動作して軌跡を制御することもできる。例えば、Ｘ軸を正弦波形でＹ軸を余弦波形とすることで円弧補間動作ができる。
工作機械用途における同期制御装置の制御系は、位置比例・速度積分比例制御系とすることが多い。ここで、図６のＹ軸は単軸駆動であるから、この制御系（位置比例・速度積分比例制御）とし、Ｘ軸はツイン駆動であるから、本発明の第１の実施形態と同様に図１のブロック図に示す同期制御装置を適用すればよい。ただし、制御系のバランスをとる意味で、ツイン駆動のＸ軸において図１における位置制御部２２は、内部位置指令１２１と作業位置情報１２２との偏差を入力して積分制御演算し、新たな位置指令信号１２５を位置情報伝送路１２６を介してサーボアンプ３，４に出力する構成とすることで位置積分比例・速度比例制御系とする。
Next, a fifth embodiment of the present invention will be described with reference to the drawings.
In a machine tool or the like equipped with a gantry mechanism as shown in FIG. 6, not only a single positioning operation in the X and Y directions but also a trajectory can be controlled by circular interpolation between the X and Y axes. For example, circular interpolation can be performed by setting the X axis to a sine waveform and the Y axis to a cosine waveform.
In many cases, the control system of the synchronous control device for machine tool applications is a position proportional / speed integral proportional control system. Here, since the Y-axis in FIG. 6 is single-axis drive, this control system (position proportional / velocity integral proportional control) is used, and the X-axis is twin drive, so that it is the same as in the first embodiment of the present invention. The synchronization control device shown in the block diagram of FIG. 1 may be applied. However, in order to balance the control system, the position control unit 22 in FIG. 1 on the twin drive X-axis inputs the deviation between the internal position command 121 and the work position information 122 and performs integral control calculation to obtain a new position. By adopting a configuration in which the command signal 125 is output to the servo amplifiers 3 and 4 via the position information transmission path 126, a position integral proportional / velocity proportional control system is obtained.
図１７は本発明の第５の実施の形態における通常ゲイン設定時の円弧補間動作波形図、図１８は本発明の第５の実施の形態に係るゲイン設定時の円弧補間動作波形図である。図において、Ｘ軸方向にｓｉｎ関数の位置指令を入力し、Ｙ軸方向にｃｏｓ関数の位置指令を入力したときの位置指令と検出位置情報をプロットしたものであって、横軸がＸ軸、縦軸がＹ軸、実線が検出位置情報、一点鎖線が位置指令である。
円弧補間動作を行う場合、通常通りにＸ軸とＹ軸の制御系の対応するゲイン設定を同じにした場合、図１７に示すように軌跡が歪み、Ｘ軸方向に長い楕円となる問題がある。すなわち、位置指令に対して検出位置情報が追従しない。
FIG. 17 is a circular interpolation operation waveform diagram at the time of normal gain setting according to the fifth embodiment of the present invention, and FIG. 18 is a circular interpolation operation waveform diagram at the time of gain setting according to the fifth embodiment of the present invention. In the figure, the position command and the detected position information are plotted when the position command of the sin function is input in the X-axis direction and the position command of the cos function is input in the Y-axis direction. The vertical axis is the Y axis, the solid line is the detected position information, and the alternate long and short dash line is the position command.
When performing circular interpolation operation, if the corresponding gain settings of the X-axis and Y-axis control systems are made the same as usual, there is a problem that the trajectory is distorted and becomes an ellipse that is long in the X-axis direction as shown in FIG. . That is, the detected position information does not follow the position command.
この問題を解決するために、ゲイン設定式を導く必要がある。
ツイン駆動のＸ軸において、位置積分比例・速度比例制御系の位置指令から検出位置情報までの伝達関数をまとめると式（６）で表される。
In order to solve this problem, it is necessary to derive a gain setting equation.
For the twin drive X-axis, the transfer function from the position command of the position integral proportional / velocity proportional control system to the detected position information is expressed by the following equation (6).
一方、単軸駆動のＹ軸において、位置比例・速度積分比例制御系の位置指令から検出位置情報までの伝達関数をまとめると式（７）で表される。 On the other hand, the transfer function from the position command of the position proportional / velocity integral proportional control system to the detected position information on the Y axis of the single axis drive is expressed by Expression (7).
ここで、式（６）と式（７）が一致すれば、円弧補間動作における位置指令に対して検出位置情報は一致する。特に、伝達関数の応答特性を決定するのは特性多項式と呼ばれる伝達関数の分母であるので、式（６）と式（７）の分母における各係数が一致するようにゲイン設定値を決定すればよく、式（８）および（９）を満足すればよい。
Ｋｐ１Ｋｖ＝Ｋｖ／Ｔｉ ・・・ （８）
Ｋｐ１Ｋｖ／Ｔｉｒ＝ＫｐＫｖ／Ｔｉ ・・・ （９）
If the equations (6) and (7) coincide with each other, the detected position information coincides with the position command in the circular interpolation operation. In particular, since the response characteristic of the transfer function is determined by a denominator of the transfer function called a characteristic polynomial, if the gain setting value is determined so that the coefficients in the denominators of Expression (6) and Expression (7) match. It is only necessary to satisfy the expressions (8) and (9).
Kp1Kv = Kv / Ti (8)
Kp1Kv / Tir = KpKv / Ti (9)
すなわち、式（８）より
Ｋｐ１＝１／Ｔｉ ・・・ （１０）
であり、式（１０）を式（９）に代入して、
Ｔｉｒ＝１／Ｋｐ ・・・ （１１）
である。このとき、式（６）と式（７）の分子も一致する。
That is, from equation (8), Kp1 = 1 / Ti (10)
And substituting equation (10) into equation (9),
Tir = 1 / Kp (11)
It is. At this time, the numerators of the formulas (6) and (7) also coincide.
このように式（１０）と式（１１）から求められるゲイン設定値を使用した場合、図１８を見れば、図１７に示した軌跡の歪みは改善されて位置指令に対して検出位置情報が追従していることがわかる。 In this way, when the gain setting values obtained from the equations (10) and (11) are used, as shown in FIG. 18, the distortion of the trajectory shown in FIG. You can see that it is following.
次に、本発明の第６の実施形態について図を参照して説明する。
第５の実施形態では、ツイン駆動のＸ軸において図１における位置制御部２２は位置積分比例・速度比例制御系としたが、位置比例積分・速度比例制御系であっても同様の効果を得ることは可能である。その場合、式（１０）および式（１１）とは異なるゲイン設定式を使用する必要がある。
Next, a sixth embodiment of the present invention will be described with reference to the drawings.
In the fifth embodiment, the position control unit 22 in FIG. 1 is a position integral proportional / velocity proportional control system in the X axis of twin drive, but the same effect can be obtained even in a position proportional integral / velocity proportional control system. It is possible. In that case, it is necessary to use a gain setting expression different from Expression (10) and Expression (11).
ツイン駆動のＸ軸において、位置比例積分・速度比例制御系の位置指令から検出位置情報までの伝達関数をまとめると式（１２）で表される。 The transfer function from the position command of the position proportional integration / speed proportional control system to the detected position information on the X axis of twin drive is expressed by Expression (12).
一方、単軸駆動のＹ軸において、位置比例・速度比例積分制御系の位置指令から検出位置情報までの伝達関数をまとめると式（１３）で表される。 On the other hand, the transfer function from the position command of the position proportional / velocity proportional integral control system to the detected position information on the Y axis of the single axis drive is expressed by Expression (13).
ここで、式（１２）と式（１３）が一致すれば、円弧補間動作における位置指令に対して検出位置情報は一致する。特に、伝達関数の応答特性を決定するのは特性多項式と呼ばれる伝達関数の分母であるので、式（１２）と式（１３）の分母における各係数が一致するようにゲイン設定値を決定すればよく、式（１４）および（１５）を満足すればよい。
２Ｋｐ１Ｋｖ＝Ｋｖ／Ｔｉ＋ＫｐＫｖ ・・・ （１４）
Ｋｐ１Ｋｖ／Ｔｉｒ＝ＫｐＫｖ／Ｔｉ ・・・ （１５）
If the expressions (12) and (13) match, the detected position information matches the position command in the circular interpolation operation. In particular, since the response characteristic of the transfer function is determined by a denominator of a transfer function called a characteristic polynomial, if the gain setting value is determined so that the coefficients in the denominators of Expression (12) and Expression (13) match. It is sufficient that the expressions (14) and (15) are satisfied.
2Kp1Kv = Kv / Ti + KpKv (14)
Kp1Kv / Tir = KpKv / Ti (15)
すなわち、式（１４）より
Ｋｐ１＝１／（２Ｔｉ）＋Ｋｐ／２ ・・・ （１６）
であり、式（１６）を式（１５）に代入して、
Ｔｉｒ＝１／（２Ｋｐ）＋Ｔｉ／２ ・・・ （１７）
である。
That is, from the equation (14), Kp1 = 1 / (2Ti) + Kp / 2 (16)
Substituting equation (16) into equation (15),
Tir = 1 / (2Kp) + Ti / 2 (17)
It is.
しかし、第５の実施形態とは異なり、式（１６）および式（１７）を満足するだけでは、式（１２）と式（１３）の分子は一致せず、若干ではあるがＸ, Ｙ軸の位置指令に対する検出位置情報も一致しない。分子も含めて伝達関数を一致させるためには、式（１６）および式（１７）に加えて次式（１８）を満足する必要がある。
Ｔｉ＝１／Ｋｐ ・・・ （１８）
However, unlike the fifth embodiment, the numerators of the formula (12) and the formula (13) do not match only by satisfying the formula (16) and the formula (17), and the X and Y axes are slightly. The detected position information for the position command does not match. In order to match the transfer function including the numerator, it is necessary to satisfy the following equation (18) in addition to the equations (16) and (17).
Ti = 1 / Kp (18)
図１９は本発明の第６の実施の形態における通常ゲイン設定時の円弧補間動作波形図、図２０は本発明の第６の実施の形態に係るゲイン設定時の円弧補間動作波形図である。図において、Ｘ軸方向にｓｉｎ関数の位置指令を入力し、Ｙ軸方向にｃｏｓ関数の位置指令を入力したときの位置指令と検出位置情報をプロットしたものであって、横軸がＸ軸、縦軸がＹ軸、実線が検出位置情報、一点鎖線が位置指令である。
このように式（１０）と式（１１）から求められるゲイン設定値を使用した場合、図１８を見れば、図１７に示した軌跡の歪みは改善されて位置指令に対して検出位置情報が追従していることがわかる。
このように式（１６）〜式（１８）から求められるゲイン設定値を使用した場合、図２０を見れば、図１９に示した軌跡の歪み（Ｘ軸方向へ長い楕円）は改善されて位置指令に対して検出位置情報が追従していることがわかる。
19 is a circular interpolation operation waveform diagram at the time of normal gain setting according to the sixth embodiment of the present invention, and FIG. 20 is a circular interpolation operation waveform diagram at the time of gain setting according to the sixth embodiment of the present invention. In the figure, the position command and the detected position information are plotted when the position command of the sin function is input in the X-axis direction and the position command of the cos function is input in the Y-axis direction. The vertical axis is the Y axis, the solid line is the detected position information, and the alternate long and short dash line is the position command.
In this way, when the gain setting values obtained from the equations (10) and (11) are used, as shown in FIG. 18, the distortion of the trajectory shown in FIG. You can see that it is following.
In this way, when the gain setting values obtained from the equations (16) to (18) are used, the distortion of the locus shown in FIG. 19 (the ellipse long in the X-axis direction) shown in FIG. It can be seen that the detected position information follows the command.
次に、本発明の第７の実施形態について図を参照して説明する。
図１における新たな位置指令１２５に対する検出位置情報１３１，１４１の検出遅れが数ｍｓ程度の小さい場合、第５の実施形態の図１８に示したように、式（１０）と式（１１）から求められるゲイン設定値を使用すれば、図１７に示した軌跡の歪みは改善されて位置指令に対して検出位置情報が追従する。
Next, a seventh embodiment of the present invention will be described with reference to the drawings.
When the detection delays of the detected position information 131 and 141 with respect to the new position command 125 in FIG. 1 are as small as several ms, as shown in FIG. 18 of the fifth embodiment, from the expressions (10) and (11) If the gain setting value obtained is used, the distortion of the locus shown in FIG. 17 is improved and the detected position information follows the position command.
しかし、図１における新たな位置指令１２５に対する検出位置情報１３１，１４１の検出遅れが十数ｍｓ程度に大きい場合、検出位置情報は大きく歪む。第５の実施形態の単軸駆動のＹ軸における位置比例・速度積分比例制御系の場合、この検出位置情報の検出遅れが位置指令のみに入るのに対して、ツイン駆動のＸ軸における位置積分比例・速度比例制御系の場合、位置指令１２５および検出位置情報１３１，１４１に入ることになるため、この検出位置情報の検出遅れが大きくなり、制御ループ中の伝達関数の誤差が顕著になってくるためである。 However, when the detection delay of the detected position information 131 and 141 with respect to the new position command 125 in FIG. 1 is as large as about several tens of ms, the detected position information is greatly distorted. In the case of the position proportional / velocity integral proportional control system in the Y-axis of the single-axis drive of the fifth embodiment, the detection delay of this detected position information enters only the position command, whereas the position integral in the X-axis of twin drive In the case of the proportional / velocity proportional control system, the position command 125 and the detected position information 131 and 141 are entered, so that the detection delay of the detected position information becomes large, and the error of the transfer function in the control loop becomes remarkable. This is because
図２１は遅れが大きい場合の本発明の第５の実施の形態に係るゲイン設定時の円弧補間動作波形図、図２２は本発明の第７の実施の形態に係る円弧補間動作波形図である。
また、図２３は本発明の第７の実施形態に係る同期制御装置のブロック図、図２４は本発明の第７の実施形態に係る位置オブザーバの制御ブロック図、図２５は本発明の第７の実施形態に係る位置オブザーバの他の制御ブロック図である。
図２３における同期制御装置１２の構成において、図１における同期制御装置１と異なる部分は、ツイン駆動のＸ軸のサーボアンプ３，４に対して更に単軸駆動のＹ軸のサーボアンプ２００およびモータ２１１、エンコーダ２１２の構成を追加した部分、指令器２内における位置オブザーバ２４の構成を追加した部分である。なお、図１と同一の符号を付した構成要素は、その作用効果が同一のため詳細な説明を省略する。
FIG. 21 is a waveform diagram of circular interpolation operation when gain is set according to the fifth embodiment of the present invention when the delay is large, and FIG. 22 is a waveform diagram of circular interpolation operation according to the seventh embodiment of the present invention. .
FIG. 23 is a block diagram of a synchronous control device according to a seventh embodiment of the present invention, FIG. 24 is a control block diagram of a position observer according to the seventh embodiment of the present invention, and FIG. 25 is a seventh block diagram of the present invention. It is another control block diagram of the position observer according to the embodiment.
23 differs from the synchronous control device 1 in FIG. 1 in that the twin-drive X-axis servo amplifiers 3 and 4 are further single-axis drive Y-axis servo amplifiers 200 and motors. 211, the part to which the configuration of the encoder 212 is added, and the part to which the configuration of the position observer 24 in the command device 2 is added. In addition, since the effect which the component which attached | subjected the code | symbol same as FIG. 1 is the same, detailed description is abbreviate | omitted.
上記した検出位置情報の検出遅れが大きくなる問題は、位置偏差１２４と作業位置情報１２２を入力し、遅れを補償した新たな検出位置情報１２３を出力する位置オブザーバ２４を作成することで回避でき、この位置オブザーバ２４は、例えば図２４や図２５のように構成できる。この場合の円弧補間動作波形図が図２２であり、第５の実施の形態と同様、図２１に示した軌跡の歪みは改善されて位置指令に対して検出位置情報が追従していることがわかる。 The problem that the detection delay of the detection position information becomes large can be avoided by inputting the position deviation 124 and the work position information 122, and creating the position observer 24 that outputs the new detection position information 123 that compensates for the delay, The position observer 24 can be configured as shown in FIGS. 24 and 25, for example. FIG. 22 shows a circular interpolation operation waveform diagram in this case. As in the fifth embodiment, the locus distortion shown in FIG. 21 is improved and the detected position information follows the position command. Recognize.
なお、位置オブザーバ２４は、第６の実施の形態であっても同様に作用効果を発揮する。
また、第５乃至７の実施の形態では、Ｘ軸をツイン駆動とするガントリ機構を備えた工作機械として説明しているが、可動テーブルが幅広な超大型機械のようにＸ軸を３軸以上の複数軸駆動としても、同様に作用効果を発揮する。
特に、第７の実施の形態における位置オブザーバ２４は、位置情報演算部２３で複数軸の検出位置情報を演算した作業位置情報１２２と位置偏差１２４とを位置オブザーバ２４に入力して作業位置情報１２２を演算して出力しているため、ツイン軸から複数軸となっても設計変更が不要という効果もある。さらに、本発明の第２の実施形態（図３）に示したレーザ干渉計を使用してフィードバックを行なう場合も同様に作用効果を発揮する。
It should be noted that the position observer 24 exhibits the same effect even in the sixth embodiment.
In the fifth to seventh embodiments, the machine tool is described as having a gantry mechanism in which the X axis is twin-driven. However, the X axis has three or more axes as in a very large machine having a wide movable table. The same effects can be achieved with the multi-axis drive.
In particular, the position observer 24 in the seventh embodiment inputs the work position information 122 and the position deviation 124 obtained by calculating the detected position information of a plurality of axes by the position information calculation unit 23 to the position observer 24 and inputs the work position information 122. As a result, the design change is unnecessary even if the twin axis is changed to multiple axes. Furthermore, the same effects can be obtained when feedback is performed using the laser interferometer shown in the second embodiment (FIG. 3) of the present invention.
・ １０，１１，１２ 同期制御装置
２，１４ 指令器
２１ 位置指令生成部
２２ 位置制御部
２３ 位置情報演算部
２４ 位置オブザーバ
３，４，１５，１６，１７，２００ サーボアンプ
３１，４１，２０１ 位置制御部
３２，４２，２０２ 速度制御部
３３，４３，２０３ 速度演算部
３４，４４，２０４ 電流制御部
５，６，１８，２１１ モータ
７，８，１９，２１２ エンコーダ
９，１０５，１０６ 機械結合部
１２１ 内部位置指令
１２２ 作業位置情報
１２３ 新たな作業位置情報
１２４ 位置偏差
１２５ 新たな位置指令
１２６ 位置情報伝送路
１３１，１４１，１７１，２５１ 検出位置情報
１９１ 外乱トルク（反力）
１０，１１ ガイド
１２ リニアスケール
１３ ヘッド
５１，５２ モータ固定子（磁石）
５３，５４ モータ可動子
１０１ レーザ干渉計
１０２ シリアル変換器
１０３ ＳＩＮ／ＣＯＳ信号
１０４ シリアル通信
10, 11, 12 Synchronous control device 2, 14 Command device 21 Position command generation unit 22 Position control unit 23 Position information calculation unit 24 Position observer 3, 4, 15, 16, 17, 200 Servo amplifiers 31, 41, 201 Position Control unit 32, 42, 202 Speed control unit 33, 43, 203 Speed calculation unit 34, 44, 204 Current control unit 5, 6, 18, 211 Motor 7, 8, 19, 212 Encoder 9, 105, 106 Mechanical coupling unit 121 Internal position command 122 Work position information 123 New work position information 124 Position deviation 125 New position command 126 Position information transmission path 131, 141, 171, 251 Detected position information 191 Disturbance torque (reaction force)
10, 11 Guide 12 Linear scale 13 Head 51, 52 Motor stator (magnet)
53, 54 Motor movable element 101 Laser interferometer 102 Serial converter 103 SIN / COS signal 104 Serial communication
Claims (5)
前記Ｎ個の位置検出器に対応してＮ個設けられたモータ制御装置であって、各モータ制御装置が、対応する１つの前記位置検出器からの１つの前記モータに係わる前記位置情報に基づき当該１つのモータに対し位置・速度制御を行う１つの位置制御系をそれぞれ構成する、前記Ｎ個のモータ制御装置と、
前記Ｎ個のモータ制御装置それぞれによる前記Ｎ個の位置制御系とは別に、前記Ｎ個の位置検出器からの前記Ｎ個の位置情報すべてに基づき位置制御を行う１つの位置制御系を構成し、前記Ｎ個のモータ制御装置すべてに対し共通の駆動位置指令を出力すると共に、前記Ｎ個の位置検出器からの前記Ｎ個の位置情報すべてに基づき前記機械における作業中心である作業位置の軸座標系位置を算出する指令装置と、
を有し、
前記指令装置は、
前記作業位置の軸座標系位置と作業位置指令との差を、位置比例積分もしくは位置積分制御して前記共通の駆動位置指令を出力する位置制御部を有する
ことを特徴とする同期制御装置。 N motors (natural number of N> 1), N position detectors that respectively detect position information of the N motors, and a mechanical coupling unit that fastens movable parts of the N motors to each other. A synchronous control device that synchronously controls the N motors with respect to a control target having a machine,
N motor control devices provided corresponding to the N position detectors, wherein each motor control device is based on the position information relating to one motor from one corresponding position detector. The N motor control devices, each constituting one position control system for performing position / speed control for the one motor;
In addition to the N position control systems by the N motor control devices, a single position control system that performs position control based on all the N position information from the N position detectors is configured. A common drive position command is output to all of the N motor control devices, and an axis of a work position which is a work center in the machine based on all of the N position information from the N position detectors. A command device for calculating a coordinate system position;
I have a,
The command device is:
A synchronization unit comprising: a position control unit that outputs a common drive position command by performing position proportional integration or position integration control on a difference between an axial coordinate system position of the work position and a work position command. Control device.
前記指令装置が、
Ｎ＝２である２台の前記モータの軸間距離を１とした際、前記軸間距離範囲内のある割合ｍに２つの前記位置検出器のうち一方の前記位置検出器からの前記位置情報を乗じた値と、残りの割合（１−ｍ）に２つの前記位置検出器のうち他方の前記位置検出器からの前記位置情報を乗じた値と、を加算して前記作業位置における第１の軸座標系位置を算出する位置情報演算部を有し、
前記位置制御部は、
第１の軸座標系位置と前記作業位置指令との差を、位置比例積分もしくは位置積分制御して前記共通の駆動位置指令を出力する
ことを特徴とする請求項１に記載の同期制御装置。 When the control object has the machine that is a gantry mechanism,
The command device is
When the distance between the axes of the two motors with N = 2 is 1, the position information from one of the two position detectors at a certain ratio m within the range of the distance between the axes. And a value obtained by multiplying the remaining ratio (1-m) by the position information from the other position detector of the two position detectors, and adding the first ratio at the working position. A position information calculation unit that calculates the position of the axis coordinate system of
The position controller is
The difference between the working position command to the first axis coordinate system position, it outputs the common driving position command position proportional integral or position integral control to
Synchronous control device according to claim 1, wherein the this.
前記指令装置が、
Ｎ個全ての前記位置検出器からの前記位置情報を平均化演算して前記作業位置における第２の軸座標系位置を算出する位置情報演算部を有し、
前記位置制御部は、
第２の軸座標系位置と前記作業位置指令との差を、位置比例積分もしくは位置積分制御して前記共通の駆動位置指令を出力する
ことを特徴とする請求項１に記載の同期制御装置。 When the control object has the machine that is a circular orbit mechanism,
The command device is
A position information calculation unit that calculates the second axis coordinate system position at the work position by averaging the position information from all N position detectors ;
The position controller is
The difference between the working position command and a second-axis coordinate system position, it outputs the common driving position command position proportional integral or position integral control to
Synchronous control device according to claim 1, wherein the this.
前記Ｎ個のモータ制御装置と同一構成であって、前記第３の軸座標系位置を入力して前記指令装置に出力する単数の他のモータ制御装置と、
を更に備え、
前記指令装置が、
前記作業位置における第３の軸座標系位置を算出する位置情報演算部を有し、
前記位置制御部は、
第３の軸座標系位置と前記作業位置指令との差を、位置比例積分もしくは位置積分制御して前記共通の駆動位置指令を出力する
ことを特徴とする請求項１に記載の同期制御装置。 A position measuring device for measuring a position near the work position;
A single other motor control device that has the same configuration as the N motor control devices and that inputs the third axis coordinate system position and outputs it to the command device;
Further comprising
The command device is
A position information calculation unit that calculates a third axis coordinate system position at the work position;
The position controller is
The difference between the working position command and the three-axis coordinate system position of, it outputs the common driving position command position proportional integral or position integral control to
Synchronous control device according to claim 1, wherein the this.
それぞれに対応する前記位置検出器からの前記位置情報に基づいてそれぞれに対応する前記モータの速度情報を算出する速度演算部と、
前記共通の駆動位置指令と前記位置情報との差を比例制御して速度指令を算出する位置制御部と、
前記速度指令と前記速度情報との差を比例制御する速度制御部と、
を有することを特徴とする請求項１乃至４のいずれか１項に記載の同期制御装置。 The N motor control devices are
A speed calculator that calculates speed information of the motor corresponding to each based on the position information from the position detector corresponding to each;
A position controller that proportionally controls the difference between the common drive position command and the position information to calculate a speed command;
A speed control unit that proportionally controls the difference between the speed command and the speed information;
Synchronous control device according to any one of claims 1 to 4, characterized in that it has a.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2011191023A JP5429576B2 (en) | 2010-01-12 | 2011-09-01 | Synchronous control device |
Applications Claiming Priority (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2010004380 | 2010-01-12 | ||
| JP2010004380 | 2010-01-12 | ||
| JP2011191023A JP5429576B2 (en) | 2010-01-12 | 2011-09-01 | Synchronous control device |
Related Parent Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2010167089A Division JP4853842B2 (en) | 2010-01-12 | 2010-07-26 | Synchronous control device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2012014719A JP2012014719A (en) | 2012-01-19 |
| JP5429576B2 true JP5429576B2 (en) | 2014-02-26 |
Family
ID=45600988
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2011191023A Active JP5429576B2 (en) | 2010-01-12 | 2011-09-01 | Synchronous control device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5429576B2 (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US10250170B2 (en) | 2016-08-24 | 2019-04-02 | Mitsubishi Electric Corporation | Motor control device |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP6295070B2 (en) * | 2013-12-05 | 2018-03-14 | オークマ株式会社 | Geometric error identification method for multi-axis machine tools and multi-axis machine tools |
| JP5897648B2 (en) * | 2014-06-17 | 2016-03-30 | ファナック株式会社 | Numerical control device having function of switching gain of position control during synchronous control |
| CN104678889B (en) * | 2014-12-25 | 2017-07-07 | 中国科学院长春光学精密机械与物理研究所 | A kind of laser interference control method of grating mechanical scratching machine |
| CN112994530A (en) * | 2019-12-18 | 2021-06-18 | 施耐德电器工业公司 | Two-axis synchronous adjustment method of servo drive system |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS62226206A (en) * | 1986-03-27 | 1987-10-05 | Toshiba Mach Co Ltd | Control system for synchronous position |
| JPH0994735A (en) * | 1995-10-03 | 1997-04-08 | Toshiba Mach Co Ltd | Balance controller for cross rail |
| JP5174356B2 (en) * | 2007-02-13 | 2013-04-03 | Ｊｕｋｉ株式会社 | Mounter tandem drive |
-
2011
- 2011-09-01 JP JP2011191023A patent/JP5429576B2/en active Active
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US10250170B2 (en) | 2016-08-24 | 2019-04-02 | Mitsubishi Electric Corporation | Motor control device |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2012014719A (en) | 2012-01-19 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4853842B2 (en) | Synchronous control device | |
| JP5429576B2 (en) | Synchronous control device | |
| JP5111031B2 (en) | Displacement detection method and motor control device | |
| JP4980453B2 (en) | Servo control system for high-precision machining | |
| US9302388B2 (en) | Robot | |
| EP1693728B1 (en) | Servo control device and method of adjusting servo system | |
| US10429815B2 (en) | Motor control device, position control system, and motor control method | |
| JPS59188517A (en) | Detection system for absolute position of servocontrol system | |
| CN107992109A (en) | Closed-loop positioning control system and method | |
| JP6068779B2 (en) | Control devices for linear and rotary robots | |
| JP2015033277A (en) | Servo device, and control method of servo device | |
| Sato et al. | Motion control techniques for synchronous motions of translational and rotary axes | |
| CN105871262B (en) | Motor control device | |
| Jung et al. | Disturbance observer based decoupling control to suppress rotational motion of cross-coupled gantry stage | |
| JPH04322988A (en) | Articulated mechanism of robot | |
| WO2021261025A1 (en) | Robot control system, control program, and control method | |
| KR102500439B1 (en) | Gantry robot with extended precision | |
| WO2021261023A1 (en) | Robot control system, control program, and control method | |
| WO2021261024A1 (en) | Robot control system, control program and control method | |
| JP2023038747A (en) | Controller system and control method thereof | |
| Weihua et al. | Analysis on servo control of high-quality servo system | |
| JP5383887B2 (en) | Displacement detection device, control device, machine tool device, irradiation device, and displacement detection method | |
| SATO et al. | Motion control techniques of Rotary table for 5-axis machining centers | |
| JPS63200980A (en) | Feeding drive for beam-shaped structure | |
| Error et al. | 1.2 Loading |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20120326 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20121031 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20121122 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130121 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20130521 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130701 |
|
| RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20130710 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20131107 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20131120 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 5429576 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |