JP2006262636A - Multi-axial servo driver - Google Patents

Multi-axial servo driver Download PDF

Info

Publication number
JP2006262636A
JP2006262636A JP2005077047A JP2005077047A JP2006262636A JP 2006262636 A JP2006262636 A JP 2006262636A JP 2005077047 A JP2005077047 A JP 2005077047A JP 2005077047 A JP2005077047 A JP 2005077047A JP 2006262636 A JP2006262636 A JP 2006262636A
Authority
JP
Japan
Prior art keywords
control
axis
speed
cpu
cycle
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2005077047A
Other languages
Japanese (ja)
Other versions
JP2006262636A5 (en
JP4683325B2 (en
Inventor
Mitsunori Kuzushima
光則 葛島
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yaskawa Electric Corp
Original Assignee
Yaskawa Electric Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Yaskawa Electric Corp filed Critical Yaskawa Electric Corp
Priority to JP2005077047A priority Critical patent/JP4683325B2/en
Publication of JP2006262636A publication Critical patent/JP2006262636A/en
Publication of JP2006262636A5 publication Critical patent/JP2006262636A5/ja
Application granted granted Critical
Publication of JP4683325B2 publication Critical patent/JP4683325B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To provide a cost-effective, small-sized, and multi-axial servo driver that controls a plurality of servomotors. <P>SOLUTION: In the multiple-axial servo driver that controls a plurality of the servomotors, a plurality of servo amplifiers are provided, that are made up of a CPU 4 that carries out the processing of at least the position control or the speed control; a number-of-control-axes setting means 11 that stores the number of servomotors to be controlled as the number of control axes; a control-period setting means that stores the control period that carries out the position control or speed control; a control-period generating circuit 8 that outputs control-period signal, based on the control period set to the control-period setting means; a current control means 23; and a motor drive power portion 9. When the control-period signal is inputted into the CPU, a position control unit or a speed control unit controls the position or the speed with the CPU by the number of control axes set by the number-of-control-axes setting means sequentially for first-axial position control, first-axial speed control, second-axial position control, and second-axial speed control. Based on the output from the speed control unit, the current is controlled by the current control means at an independent timing from the CPU. <P>COPYRIGHT: (C)2006,JPO&NCIPI

Description

本発明は、複数のサーボモータを制御する多軸サーボドライバに関する。   The present invention relates to a multi-axis servo driver that controls a plurality of servo motors.

従来の多軸サーボドライバは、一つの機器に複数のサーボモータを設置し、一つのサーボモータの制御を行うコントロールユニットを複数装備し、このコントロールユニットは一つのサーボモータを制御するＣＰＵを個々のコントロールユニットに備えている。図３に従来の多軸サーボドライバの構成図を示す。１は多軸サーボドライバであり、１つのサーボモータを制御するコントロールユニット２を複数装備している。各コントロールユニット２は、一つのサーボモータを制御するためにＣＰＵ４およびモータ駆動パワー部９から構成され、サーボモータ１０およびエンコーダ７が接続される。１０はサーボモータであり、フィードバック制御を行うためのエンコーダ７が連結されている。   A conventional multi-axis servo driver has a plurality of servo motors installed in one device and is equipped with a plurality of control units for controlling one servo motor. This control unit has an individual CPU for controlling one servo motor. Provided in the control unit. FIG. 3 shows a configuration diagram of a conventional multi-axis servo driver. A multi-axis servo driver 1 is equipped with a plurality of control units 2 that control one servo motor. Each control unit 2 includes a CPU 4 and a motor drive power unit 9 to control one servo motor, and a servo motor 10 and an encoder 7 are connected thereto. A servo motor 10 is connected to an encoder 7 for performing feedback control.

図４は図３のコントロールユニット２のブロック図である。図４において、コントロールユニット２は、位置制御部２１、速度制御部２２、電流制御部２３、およびモータ駆動パワー部９から構成されている。位置制御部２１は、上位装置、外部パルス列信号等により入力された位置指令値およびエンコーダ７からのフィードバック信号（位置フィードバック信号）をもとに位置制御を行い、速度指令値を速度制御部２２に出力する。速度制御部２２は、位置制御部２１から入力された速度指令値およびエンコーダ７からのフィードバック信号（速度フィードバック信号）をもとに速度制御を行い、トルク指令値を電流制御部２３に出力する。電流制御部２３は、速度制御部２２から入力されたトルク指令値およびＡＤ変換器等の電流フィードバック信号をもとに電流制御を行い、ＰＷＭ指令をモータ駆動パワー部９に出力する。モータ駆動パワー部９は、サーボモータ１０に電流を流し、サーボモータ１０を回転動作させる。   FIG. 4 is a block diagram of the control unit 2 of FIG. In FIG. 4, the control unit 2 includes a position control unit 21, a speed control unit 22, a current control unit 23, and a motor drive power unit 9. The position control unit 21 performs position control based on the position command value input by the host device, the external pulse train signal, and the like and the feedback signal (position feedback signal) from the encoder 7, and sends the speed command value to the speed control unit 22. Output. The speed control unit 22 performs speed control based on the speed command value input from the position control unit 21 and the feedback signal (speed feedback signal) from the encoder 7, and outputs the torque command value to the current control unit 23. The current control unit 23 performs current control based on the torque command value input from the speed control unit 22 and a current feedback signal such as an AD converter, and outputs a PWM command to the motor drive power unit 9. The motor drive power unit 9 causes a current to flow through the servo motor 10 to rotate the servo motor 10.

このように、従来の多軸サーボドライバは、一つの機器に複数のサーボモータを設置し、各サーボモータを制御するためにＣＰＵおよびモ−タ駆動パワー部から構成されるコントロールユニットを複数装備している（例えば、特許文献１参照）。
通常、ＮＣ工作機械やロボット等は少なくとも２〜３軸以上のサーボモータが必要であり、多いものでは６軸以上のものもある。また、人型ロボットに代表されるように、ロボット内部に設置できるようにサーボドライバは小形化の傾向にある。
特開２０００−６０１８１号公報（図１） In this way, the conventional multi-axis servo driver has a plurality of servo motors installed in one device, and is equipped with a plurality of control units composed of a CPU and a motor drive power unit to control each servo motor. (For example, refer to Patent Document 1).
Normally, NC machine tools, robots, and the like require at least 2 to 3 servo motors, and many have 6 or more servo motors. Further, as represented by humanoid robots, servo drivers tend to be miniaturized so that they can be installed inside the robot.
Japanese Unexamined Patent Publication No. 2000-60181 (FIG. 1)

しかしながら、一般的にＣＰＵが付加されると、ＲＡＭやＲＯＭ等の周辺ＩＣやその周辺ＩＣと接続するデータバスなどの回路が必要であり、ＣＰＵが多いほどそのスペースおよびコストは大きくなる。上述のコントロールユニットではＣＰＵが必要であり、１つのコントロールユニットのコストおよびスペースが大きくなる。従って、上述のコントロールユニット複数から構成される従来の多軸サーボドライバは、安価とはいえない。また、多軸サーボドライバが大形になるという問題もあった。
本発明はこのような問題点に鑑みてなされたものであり、安価で小形な多軸サーボドライバを提供することを目的とする。 However, generally, when a CPU is added, a peripheral IC such as a RAM or a ROM and a circuit such as a data bus connected to the peripheral IC are required. As the number of CPUs increases, the space and cost increase. The control unit described above requires a CPU, which increases the cost and space of one control unit. Therefore, it cannot be said that a conventional multi-axis servo driver composed of a plurality of control units described above is inexpensive. There is also a problem that the multi-axis servo driver becomes large.
The present invention has been made in view of such problems, and an object thereof is to provide an inexpensive and small-sized multi-axis servo driver.

上記問題を解決するため、請求項１に記載の発明は、複数のサーボモータを制御する多軸サーボドライバにおいて、少なくとも位置制御または速度制御の処理を実行する一つのＣＰＵと、制御する前記複数のサーボモータの数を制御軸数として格納する制御軸数設定手段と、位置制御または速度制御を実行する制御周期を格納する制御周期設定手段と、前記制御周期設定手段に設定された制御周期にしたがって制御周期信号を出力する制御周期発生回路と、位置制御を行う位置制御部と、速度制御を行う速度制御部と、一つのサーボモータを制御するために前記ＣＰＵとは独立したタイミングで電流制御を行う機能を有する電流制御手段とサーボモータに電流を流すモータ駆動パワー部とから構成される複数のサーボアンプとを備え、前記制御周期信号が前記ＣＰＵに入力されたときに、前記位置制御部または前記速度制御部は１軸目の位置制御、１軸目の速度制御、２軸目の位置制御、２軸目の速度制御と順に前記制御軸数設定手段に設定された制御軸数分だけ位置制御または速度制御を前記ＣＰＵで実行し、前記速度制御部からの出力に基づいて前記電流制御手段で前記ＣＰＵとは独立したタイミングで電流制御を行うものである。
また、請求項２に記載の発明は、請求項１において前記制御軸数および前記制御周期は、パラメータ設定装置から通信を介して設定され、設定された前記制御軸数および前記制御周期は前記制御軸数設定手段および前記制御周期設定手段へ格納されるものである。
また、請求項３に記載の発明は、請求項１において前記制御周期は、前記制御軸数と位置制御、速度制御処理時間に基づいて計算され、前記制御周期設定手段へ格納されるものである。
また、請求項４に記載の発明は、請求項１において前記電流制御手段を電流制御ＬＳＩとしたものである。 In order to solve the above problem, the invention according to claim 1 is a multi-axis servo driver that controls a plurality of servo motors, and at least one CPU that executes processing of position control or speed control, and the plurality of control. Control axis number setting means for storing the number of servo motors as the number of control axes, control cycle setting means for storing a control cycle for executing position control or speed control, and a control cycle set in the control cycle setting means A control cycle generating circuit that outputs a control cycle signal, a position control unit that performs position control, a speed control unit that performs speed control, and current control at a timing independent of the CPU to control one servo motor. A plurality of servo amplifiers each including a current control means having a function to perform and a motor drive power unit for supplying a current to the servo motor. When a periodic signal is input to the CPU, the position control unit or the speed control unit performs the first axis position control, the first axis speed control, the second axis position control, the second axis speed control, The position control or speed control is executed by the CPU for the number of control axes set in the control axis number setting means in order, and the current control means is independent of the CPU based on the output from the speed control unit. The current control is performed by
According to a second aspect of the present invention, in the first aspect, the number of control axes and the control cycle are set via communication from a parameter setting device, and the set number of control axes and the control cycle are the control values. It is stored in the number-of-axis setting means and the control cycle setting means.
According to a third aspect of the present invention, in the first aspect, the control cycle is calculated based on the number of control axes, position control, and speed control processing time, and is stored in the control cycle setting means. .
According to a fourth aspect of the present invention, in the first aspect, the current control means is a current control LSI.

請求項１に記載の発明によると、位置制御および速度制御を１つのＣＰＵで実行し、トータルとして低価格化、小形化が実現できる。
また、請求項２に記載の発明によると、一般的に位置制御および速度制御の制御周期は短いほど制御精度は向上するため、多軸サーボドライブを適用する機械システム、すなわち接続するサーボモータの数に合わせて位置制御および速度制御の制御周期を設定することにより、ＣＰＵ性能を最大限に活用でき、その結果として機械システムに合わせて最大限の制御精度を得ることができる。
また、請求項３に記載の発明によると、制御軸数設定値に設定された制御軸数にしたがって自動的に制御周期設定値に制御周期が設定されるので、制御周期を設定する手間を省くことができ、結果的に多軸サーボドライバの使い勝手を向上させることができる。
また、請求項４に記載の発明によると、電流制御手段を電流制御ＬＳＩとしたので、多軸サーボドライバを小形化することができる。 According to the first aspect of the present invention, the position control and the speed control are executed by one CPU, so that the total price can be reduced and the size can be reduced.
Further, according to the invention described in claim 2, since the control accuracy generally improves as the control cycle of position control and speed control is shorter, the number of mechanical systems to which the multi-axis servo drive is applied, that is, the number of servo motors to be connected. By setting the control cycle of the position control and the speed control according to the CPU performance can be utilized to the maximum, and as a result, the maximum control accuracy can be obtained according to the mechanical system.
According to the invention described in claim 3, since the control cycle is automatically set to the control cycle set value according to the number of control axes set to the control axis number set value, the labor for setting the control cycle is saved. As a result, the usability of the multi-axis servo driver can be improved.
According to the invention described in claim 4, since the current control means is a current control LSI, the multi-axis servo driver can be miniaturized.

以下、本発明の実施の形態について図を参照して説明する。   Hereinafter, embodiments of the present invention will be described with reference to the drawings.

図１は、本発明の多軸サーボドライバの構成図である。図において、１は多軸サーボドライバであり、位置制御、速度制御などの処理を実行するＣＰＵ４と、制御するサーボモータの数、すなわち制御軸数を格納する制御軸数設定値１１と、位置制御および速度制御を実行する制御周期を格納する制御周期設定値１２と、前記制御周期設定値１２に設定された制御周期にしたがって制御周期信号Ｓ１を出力する制御周期発生回路８と、位置制御を行う位置制御部２１と、速度制御を行う速度制御部２２と、一つのサーボモータを制御するために電流制御部２３を内蔵しＣＰＵ４とは独立したタイミングでインテリジェントに電流制御を行う機能を有する電流制御ＬＳＩ６とサーボモータ１０に電流を流し回転動作させるモータ駆動パワー部９から構成されるサーボアンプ５複数とから構成される。３はパラメータ設定装置であり、制御するサーボモータの数（制御軸数）および位置制御および速度制御を実行する制御周期を設定する。設定された制御軸数は制御軸数設定値１１に格納され、設定された制御周期は制御周期設定値１２に格納される。なお、制御軸数設定値１１および制御周期設定値１２は書き換え可能な不揮発メモリに記憶されるようになっている。１０はサーボモータであり、フィードバック制御を行うためのエンコーダ７が連結されている。   FIG. 1 is a configuration diagram of a multi-axis servo driver of the present invention. In the figure, reference numeral 1 denotes a multi-axis servo driver, which is a CPU 4 that executes processing such as position control and speed control, the number of servo motors to be controlled, that is, a control axis number setting value 11 that stores the number of control axes, and position control. And a control cycle setting value 12 that stores a control cycle for executing speed control, a control cycle generation circuit 8 that outputs a control cycle signal S1 according to the control cycle set in the control cycle setting value 12, and performs position control A position control unit 21, a speed control unit 22 for performing speed control, and a current control unit 23 for controlling one servo motor, and having a function of performing current control intelligently at a timing independent of the CPU 4 The servo amplifier 5 includes a plurality of servo amplifiers 5 each of which includes a motor driving power unit 9 that rotates by causing a current to flow through the LSI 6 and the servo motor 10. Reference numeral 3 denotes a parameter setting device that sets the number of servo motors to be controlled (the number of control axes) and a control cycle for executing position control and speed control. The set number of control axes is stored in the control axis number set value 11, and the set control cycle is stored in the control cycle set value 12. The control axis number setting value 11 and the control cycle setting value 12 are stored in a rewritable nonvolatile memory. A servo motor 10 is connected to an encoder 7 for performing feedback control.

本発明が特許文献１と異なる部分は、制御するサーボモータの数を格納する制御軸数設定値１１と、位置制御および速度制御を実行する周期を格納する制御周期設定値１２と、前記制御周期設定値１２に設定された周期にしたがって制御周期信号Ｓ１を出力する制御周期発生回路８と、複数のサーボモータを制御するための位置制御部２１と速度制御部２２を実行する一つのＣＰＵ４と、一つのサーボモータを制御するための電流制御部２３をインテリジェントに実行する電流制御ＬＳＩ６と一つのサーボモータに電流を流し回転動作させるモータ駆動パワー部９とからなる複数のサーボアンプ５とを備えた部分である。   The present invention is different from Patent Document 1 in that the control axis number setting value 11 for storing the number of servo motors to be controlled, the control period setting value 12 for storing the period for executing position control and speed control, and the control period A control cycle generation circuit 8 that outputs a control cycle signal S1 according to a cycle set to the set value 12, a position control unit 21 for controlling a plurality of servo motors, and a CPU 4 that executes a speed control unit 22, A plurality of servo amplifiers 5 each including a current control LSI 6 that intelligently executes a current control unit 23 for controlling one servo motor and a motor driving power unit 9 that causes a current to flow through the one servo motor to rotate the servo motor are provided. Part.

図２は、本発明の多軸サーボドライバによって実行される動作を示すタイミング図である。図２において、制御周期信号Ｓ１がＣＰＵ４に入力されると、位置制御部がＣＰＵより起動され、１軸目の位置制御が実行される。具体的には、１軸目の位置指令として、上位装置、外部パルス列信号等により入力された位置指令値および１軸目のサーボモータに連結されているエンコーダ７からのフィードバック信号（位置フィードバック信号）をもとに位置制御を行い、１軸目の速度指令値を速度制御部２２に出力する。次いで、速度制御部２２がＣＰＵ４より起動され、１軸目の速度制御が実行される。具体的には、位置制御部２１から入力された１軸目の速度指令値および１軸目のサーボモータに連結されているエンコーダ７からのフィードバック信号（速度フィードバック信号）をもとに速度制御を行い、１軸目のトルク指令値を電流制御ＬＳＩ６の電流制御部２３に出力する。次いで、２軸目の位置制御、速度制御、３軸目の位置制御、速度制御、・・・とパラメータ設定装置３よりあらかじめ制御軸数設定値１１に設定された制御軸数分くりかえす。   FIG. 2 is a timing diagram showing operations performed by the multi-axis servo driver of the present invention. In FIG. 2, when the control cycle signal S1 is input to the CPU 4, the position control unit is activated by the CPU and the position control of the first axis is executed. Specifically, as the position command for the first axis, the position command value input by the host device, the external pulse train signal, and the like, and the feedback signal (position feedback signal) from the encoder 7 connected to the servo motor for the first axis Position control is performed based on the above, and the speed command value for the first axis is output to the speed control unit 22. Next, the speed control unit 22 is activated by the CPU 4 and the speed control for the first axis is executed. Specifically, the speed control is performed based on the speed command value for the first axis input from the position control unit 21 and the feedback signal (speed feedback signal) from the encoder 7 connected to the servo motor for the first axis. Then, the torque command value for the first axis is output to the current control unit 23 of the current control LSI 6. Next, position control for the second axis, speed control, position control for the third axis, speed control,..., And the number of control axes set to the control axis number setting value 11 in advance by the parameter setting device 3 are repeated.

また、制御周期信号Ｓ１の周期、すなわち位置制御および速度制御を実行する制御周期は、制御軸数設定値１１に設定された全制御軸数分の位置制御および速度制御の実行に必要な時間分以上の値がパラメータ設定装置３よりあらかじめ制御周期設定値１２に設定されている。具体的には、制御軸数を３、１軸あたりの位置制御および速度制御に７０μｓの処理時間が必要であると仮定すると、制御周期は３×７０＝２１０μｓ以上必要であり、例えば３００μｓを設定しておく。また、制御軸数設定値１１に設定された制御軸数にしたがって自動的に制御周期設定値１２を設定してもよい。具体的には、１軸あたりの位置制御および速度制御に７０μｓの処理時間が必要であると仮定すると、自己診断、アラーム検出処理などその他の処理を行う時間（例えば３０μｓ）の余裕を考慮して、１軸あたりの位置制御および速度制御の処理時間を１００μｓとし、制御軸数が３の場合の制御周期は３×１００＝３００μｓを制御周期設定値１２に自動的に設定する。   Further, the cycle of the control cycle signal S1, that is, the control cycle for executing the position control and the speed control is the time required for executing the position control and the speed control for the total number of control axes set in the control axis number setting value 11. The above values are set in advance as the control cycle setting value 12 by the parameter setting device 3. Specifically, assuming that the number of control axes is 3, and processing time of 70 μs is required for position control and speed control per one axis, the control cycle needs to be 3 × 70 = 210 μs or more, for example, 300 μs is set. Keep it. Further, the control cycle setting value 12 may be automatically set according to the control axis number set to the control axis number setting value 11. Specifically, assuming that a processing time of 70 μs is required for the position control and speed control per axis, allowance for a time for performing other processing such as self-diagnosis and alarm detection processing (for example, 30 μs) is considered. When the processing time for position control and speed control per axis is 100 μs and the number of control axes is 3, the control cycle is automatically set to the control cycle set value 12 of 3 × 100 = 300 μs.

一方、電流制御は、電流制御部２３を内蔵しＣＰＵ４とは独立したタイミングでインテリジェントに電流制御を行う機能を有する電流制御ＬＳＩ６により各軸ごとに実行される。すなわち、各軸の電流制御ＬＳＩ６は、速度制御部２２から入力されたトルク指令値およびＡＤ変換器等の電流フィードバック信号をもとに電流制御周期ごとに電流制御をＣＰＵ４とは独立したタイミングでインテリジェントに実行する。例えば、電流制御周期を３０μｓになるようにあらかじめ電流制御ＬＳＩ６を設計しておく。   On the other hand, the current control is executed for each axis by a current control LSI 6 that has a function of performing current control intelligently at a timing independent of the CPU 4 with a built-in current control unit 23. That is, the current control LSI 6 for each axis intelligently controls current control for each current control period based on the torque command value input from the speed control unit 22 and the current feedback signal from the AD converter at a timing independent of the CPU 4. To run. For example, the current control LSI 6 is designed in advance so that the current control period is 30 μs.

このように、位置制御および速度制御を１つのＣＰＵで実行し、電流制御はＬＳＩ化し各サーボモータごとに複数のＬＳＩで実行することにより、トータルとして低価格化、小形化が実現できる。また、一般的に位置制御および速度制御の制御周期は短いほど制御精度は向上するため、多軸サーボドライブを適用する機械システム、すなわち接続するサーボモータの数に合わせて位置制御および速度制御の制御周期を設定することにより、ＣＰＵ性能を最大限に活用でき、その結果として機械システムに合わせて最大限の制御精度を得ることができる。例えば、６軸用として製作された多軸サーボドライバを実際には４軸しかサーボモータを使用しない機械システムに適用した場合には、そのサーボモータの数に合わせて制御軸数、および制御周期を設定することで、位置制御および速度制御の制御周期を短く設定することができ、機械システムに合わせて最大限の制御精度を得ることができる。   As described above, the position control and the speed control are executed by one CPU, and the current control is converted to an LSI, and is executed by a plurality of LSIs for each servo motor, thereby realizing a reduction in price and size as a whole. In general, the shorter the control cycle of position control and speed control, the better the control accuracy. Therefore, control of position control and speed control according to the number of servo systems connected to the multi-axis servo drive, that is, the number of servo motors to be connected. By setting the cycle, the CPU performance can be utilized to the maximum, and as a result, the maximum control accuracy can be obtained in accordance with the mechanical system. For example, when a multi-axis servo driver manufactured for 6 axes is applied to a mechanical system that actually uses only 4 axes of servo motors, the number of control axes and the control cycle are set according to the number of servo motors. By setting, the control cycle of the position control and the speed control can be set short, and the maximum control accuracy can be obtained according to the mechanical system.

複数のサーボモータの位置制御、速度制御、電流制御を１つのＣＰＵと複数のＬＳＩで実行することによって、多軸サーボドライバをコンパクトにかつ低価格に構成できるので、複数のサーボモータを使用するＮＣ工作機械やロボットなどの機械システムのサーボドライバ、特に狭小な場所や安価な機械システムで使用されるサーボドライバに適用できる。   By executing position control, speed control, and current control of multiple servo motors with a single CPU and multiple LSIs, a multi-axis servo driver can be configured compactly and at a low price, so an NC that uses multiple servo motors The present invention can be applied to servo drivers for machine systems such as machine tools and robots, especially servo drivers used in narrow spaces and inexpensive machine systems.

本発明の多軸サーボドライバの構成を示すブロック図The block diagram which shows the structure of the multi-axis servo driver of this invention 本発明の多軸サーボドライバの動作を示すタイミング図Timing chart showing the operation of the multi-axis servo driver of the present invention 従来の多軸サーボドライバの構成を示すブロック図Block diagram showing the configuration of a conventional multi-axis servo driver 従来の多軸サーボドライバにおけるコントロールユニットの構成を示すブロック図Block diagram showing the configuration of the control unit in the conventional multi-axis servo driver

符号の説明Explanation of symbols

１ 多軸サーボドライバ
２ コントロールユニット
３ パラメータ設定装置
４ ＣＰＵ
５ サーボアンプ
６ 電流制御ＬＳＩ
７ エンコーダ
８ 制御周期発生回路
９ モータ駆動パワー部
１０ サーボモータ
１１ 制御軸数設定値
１２ 制御周期設定値
２１ 位置制御部
２２ 速度制御部
２３ 電流制御部 1 Multi-axis servo driver 2 Control unit 3 Parameter setting device 4 CPU
5 Servo amplifier 6 Current control LSI
7 Encoder 8 Control cycle generation circuit 9 Motor drive power unit 10 Servo motor 11 Control axis number set value 12 Control cycle set value 21 Position control unit 22 Speed control unit 23 Current control unit

Claims (4)

複数のサーボモータを制御する多軸サーボドライバにおいて、少なくとも位置制御または速度制御の処理を実行する一つのＣＰＵと、制御する前記複数のサーボモータの数を制御軸数として格納する制御軸数設定手段と、位置制御または速度制御を実行する制御周期を格納する制御周期設定手段と、前記制御周期設定手段に設定された制御周期にしたがって制御周期信号を出力する制御周期発生回路と、位置制御を行う位置制御部と、速度制御を行う速度制御部と、一つのサーボモータを制御するために前記ＣＰＵとは独立したタイミングで電流制御を行う機能を有する電流制御手段とサーボモータに電流を流すモータ駆動パワー部とから構成される複数のサーボアンプとを備え、前記制御周期信号が前記ＣＰＵに入力されたときに、前記位置制御部または前記速度制御部は１軸目の位置制御、１軸目の速度制御、２軸目の位置制御、２軸目の速度制御と順に前記制御軸数設定手段に設定された制御軸数分だけ位置制御または速度制御を前記ＣＰＵで実行し、前記速度制御部からの出力に基づいて前記電流制御手段で前記ＣＰＵとは独立したタイミングで電流制御を行うことを特徴とする多軸サーボドライバ。   In a multi-axis servo driver for controlling a plurality of servo motors, at least one CPU for executing position control or speed control processing, and a control axis number setting means for storing the number of the plurality of servo motors to be controlled as the number of control axes Control cycle setting means for storing a control cycle for executing position control or speed control, a control cycle generation circuit for outputting a control cycle signal according to the control cycle set in the control cycle setting means, and position control A position control unit, a speed control unit for performing speed control, a current control unit having a function of performing current control at a timing independent of the CPU to control one servo motor, and a motor drive for supplying current to the servo motor A plurality of servo amplifiers configured with a power unit, and when the control cycle signal is input to the CPU, The control unit or the speed control unit includes the first axis position control, the first axis speed control, the second axis position control, the second axis speed control, and the control axis number set in the control axis number setting means in this order. A multi-axis servo driver characterized in that position control or speed control is executed by the CPU by the amount, and current control is performed at a timing independent of the CPU by the current control means based on an output from the speed control unit. . 前記制御軸数および前記制御周期は、パラメータ設定装置から通信を介して設定され、設定された前記制御軸数および前記制御周期は前記制御軸数設定手段および前記制御周期設定手段へ格納されることを特徴とする請求項１記載の多軸サーボドライバ。   The number of control axes and the control cycle are set via communication from a parameter setting device, and the set number of control axes and the control cycle are stored in the control axis number setting means and the control cycle setting means. The multi-axis servo driver according to claim 1. 前記制御周期は、前記制御軸数と位置制御、速度制御処理時間に基づいて計算され、前記制御周期設定手段へ格納されることを特徴とする請求項１記載の多軸サーボドライバ。   The multi-axis servo driver according to claim 1, wherein the control cycle is calculated based on the number of control axes, position control, and speed control processing time, and is stored in the control cycle setting means. 前記電流制御手段が電流制御ＬＳＩである請求項１記載の多軸サーボドライバ。   The multi-axis servo driver according to claim 1, wherein the current control means is a current control LSI.
JP2005077047A 2005-03-17 2005-03-17 Multi-axis motor control system Expired - Fee Related JP4683325B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2005077047A JP4683325B2 (en) 2005-03-17 2005-03-17 Multi-axis motor control system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2005077047A JP4683325B2 (en) 2005-03-17 2005-03-17 Multi-axis motor control system

Publications (3)

Publication Number Publication Date
JP2006262636A true JP2006262636A (en) 2006-09-28
JP2006262636A5 JP2006262636A5 (en) 2010-06-17
JP4683325B2 JP4683325B2 (en) 2011-05-18

Family

ID=37101249

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2005077047A Expired - Fee Related JP4683325B2 (en) 2005-03-17 2005-03-17 Multi-axis motor control system

Country Status (1)

Country Link
JP (1) JP4683325B2 (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009268218A (en) * 2008-04-24 2009-11-12 Juki Corp Multi-shaft motor control system
CN102130640A (en) * 2011-01-25 2011-07-20 南京雪曼机电科技有限公司 Multishaft synchronous servo driving system and synchronous control method thereof
EP2447035A1 (en) 2010-11-01 2012-05-02 Sumitomo Heavy Industries, LTD. Injection molding machine
KR101938190B1 (en) * 2016-11-11 2019-01-14 주식회사 주원테크놀러지 Method and Apparatus for Controlling Programmable, Multi Shaft Motor
CN111699399A (en) * 2018-08-22 2020-09-22 深圳配天智能技术研究院有限公司 Performance test system and method of multi-axis driver and multi-axis driver for test

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106169899A (en) * 2016-09-23 2016-11-30 江西洪都航空工业集团有限责任公司 A kind of compatibility has the two-way servo-control system that brush is brushless

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07222479A (en) * 1994-01-26 1995-08-18 Toyota Motor Corp Driving apparatus
JPH07334217A (en) * 1994-06-13 1995-12-22 Okuma Mach Works Ltd Axial position controller
JP2002186288A (en) * 2000-12-11 2002-06-28 Yamaha Motor Co Ltd Controlling method and device for a plurality of servo motors

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07222479A (en) * 1994-01-26 1995-08-18 Toyota Motor Corp Driving apparatus
JPH07334217A (en) * 1994-06-13 1995-12-22 Okuma Mach Works Ltd Axial position controller
JP2002186288A (en) * 2000-12-11 2002-06-28 Yamaha Motor Co Ltd Controlling method and device for a plurality of servo motors

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009268218A (en) * 2008-04-24 2009-11-12 Juki Corp Multi-shaft motor control system
EP2447035A1 (en) 2010-11-01 2012-05-02 Sumitomo Heavy Industries, LTD. Injection molding machine
CN102130640A (en) * 2011-01-25 2011-07-20 南京雪曼机电科技有限公司 Multishaft synchronous servo driving system and synchronous control method thereof
KR101938190B1 (en) * 2016-11-11 2019-01-14 주식회사 주원테크놀러지 Method and Apparatus for Controlling Programmable, Multi Shaft Motor
CN111699399A (en) * 2018-08-22 2020-09-22 深圳配天智能技术研究院有限公司 Performance test system and method of multi-axis driver and multi-axis driver for test

Also Published As

Publication number Publication date
JP4683325B2 (en) 2011-05-18

Similar Documents

Publication Publication Date Title
JP4182132B2 (en) Motor control system
JP4683325B2 (en) Multi-axis motor control system
US8901870B2 (en) Synchronous control apparatus
JP2009025879A (en) Communication system for robot device
JP6696465B2 (en) Control system, controller and control method
JP2018153881A (en) Control system, controller, and control method
WO1988008559A1 (en) Numerical control device
JP2004246498A (en) Position control device
JP2005229668A (en) Machine controller
JP2007267480A (en) Servo control device and servo system using it
TWI426695B (en) Motor driver control device
JP6205206B2 (en) Multi-axis control system
KR101379430B1 (en) Robot actuator module having an independent function
JP2009095165A (en) Multi-axis motor controller and its control method
CN105227041A (en) The control method of motor driver and motor driven systems
JP3929828B2 (en) Servo control device
US9905264B2 (en) Servo control system having function of switching learning memory
JP2007073071A (en) Servo controller
JP2007236145A (en) Motor control system
JP2000339036A (en) Positioning controller
JP2006171878A (en) Servo drive system and method for setting servo constant of servo drive system
JP2006187088A (en) Apparatus and method of controlling motor
WO2021193549A1 (en) Control device, data transfer system for control device, and data transfer method
JP2006314159A (en) Motor control device
JP2008052619A (en) Power supply system comprising plurality of power supply units for robot control device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20080219

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20100427

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20100929

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20101004

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20101108

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: 20110114

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20110127

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140218

Year of fee payment: 3

R150 Certificate of patent (=grant) or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (prs date is renewal date of database)

Free format text: PAYMENT UNTIL: 20150218

Year of fee payment: 4

LAPS Cancellation because of no payment of annual fees