JP4661743B2 - Motor drive device - Google Patents

Motor drive device Download PDF

Info

Publication number
JP4661743B2
JP4661743B2 JP2006242451A JP2006242451A JP4661743B2 JP 4661743 B2 JP4661743 B2 JP 4661743B2 JP 2006242451 A JP2006242451 A JP 2006242451A JP 2006242451 A JP2006242451 A JP 2006242451A JP 4661743 B2 JP4661743 B2 JP 4661743B2
Authority
JP
Japan
Prior art keywords
axis
reception
timer value
host controller
communication
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
Application number
JP2006242451A
Other languages
Japanese (ja)
Other versions
JP2008067487A (en
Inventor
勝 西園
健一 鈴木
覚 土居
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.)
Panasonic Corp
Panasonic Holdings Corp
Original Assignee
Panasonic Corp
Matsushita Electric Industrial Co Ltd
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 Panasonic Corp, Matsushita Electric Industrial Co Ltd filed Critical Panasonic Corp
Priority to JP2006242451A priority Critical patent/JP4661743B2/en
Publication of JP2008067487A publication Critical patent/JP2008067487A/en
Application granted granted Critical
Publication of JP4661743B2 publication Critical patent/JP4661743B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Multiple Motors (AREA)

Description

本発明は、上位コントローラと複数軸のモータ駆動装置とを通信によって接続するモータ駆動システムにおける同期方法に関する。   The present invention relates to a synchronization method in a motor drive system in which a host controller and a multi-axis motor drive device are connected by communication.

複数のモータ駆動装置を持つモータ駆動システムでは、それぞれの軸が別々の動作を独立して行う通常動作に対し、ある特定の軸同士が同期して動作する同期動作が要望される場合がある。その場合、上位コントローラと同期運転を行う複数軸は、ある同じ基準に基づいて同期をとらなければならない。   In a motor drive system having a plurality of motor drive devices, there may be a demand for a synchronous operation in which certain specific axes operate synchronously with respect to a normal operation in which each axis performs a separate operation independently. In that case, the multiple axes that perform synchronous operation with the host controller must be synchronized based on the same standard.

同期の方法としては、高速通信装置を備えた通信システムを用い、通信周期を基準にして同期をとるのが一般的であるが、そのためには高速通信を実現するための特別な装置等が必要になり、コスト高、汎用性の低下、上位コントローラを含めた開発工数の増大といった課題がある。そのため、汎用的は非同期通信を用いた同期手法が求められている。   As a synchronization method, it is common to use a communication system equipped with a high-speed communication device, and to synchronize based on the communication cycle, but for that purpose, a special device or the like for realizing high-speed communication is required. Thus, there are problems such as high cost, low versatility, and increased development man-hours including the host controller. Therefore, a general purpose synchronization method using asynchronous communication is required.

その中で、上位コントローラが持つ時間情報を通信処理で各モータ駆動装置に送信し、モータ駆動装置内でその時間情報に合わせることで汎用的な非同期通信を用いた同期方法が提案されている(例えば、特許文献1参照)。
特開2005−237163号公報
Among them, a synchronization method using general-purpose asynchronous communication has been proposed in which time information possessed by the host controller is transmitted to each motor drive device by communication processing and is matched with the time information in the motor drive device ( For example, see Patent Document 1).
JP 2005-237163 A

しかしながら、上述した技術では、実際には上位コントローラでラッチした時刻情報は通信を介して各モータ駆動装置に伝達されるため、その通信時間分の遅れを補正する処理が必要となる。また、上位コントローラ側のカウンタ精度に依存する部分が大きく、汎用的な通信手段を用いれば、さらに上位コントローラへの依存性が高くなるという問題がある。   However, in the above-described technique, the time information latched by the host controller is actually transmitted to each motor drive device via communication, and thus processing for correcting the delay corresponding to the communication time is required. In addition, there is a large part depending on the counter accuracy on the host controller side, and there is a problem that the dependence on the host controller becomes higher if a general-purpose communication means is used.

本発明は上記従来の課題を解決するものであり、上位コントローラには全く依存せず、通常の通信処理を行うだけで、モータ駆動装置側だけで同期運転と高精度な同時起動を実現できるモータ駆動装置を提供することを目的とする。   The present invention solves the above-described conventional problems, and does not depend on the host controller at all. A motor capable of realizing synchronous operation and high-accuracy simultaneous activation only on the motor drive side only by performing normal communication processing. An object is to provide a drive device.

上位コントローラと複数軸のモータ駆動装置とを通信によって接続するモータ駆動システムにおいて、通信の送受信部と、一定のクロックでカウントを行い前記送受信部の受信完了割込み信号で受信時タイマー値を出力するタイマー部と、自軸と他軸との受信時タイマー値のずれを補正する同期処理部とを備え、前記送受信部は、上位コントローラから自軸への命令の場合は受信時タイマー値を上位コントローラへ返信し、他軸への命令の場合は他軸が上位コントローラに返信したデータから他軸の受信時タイマー値を取得して同期処理部へ出力し、前記タイマー部は自軸の受信時タイマー値を前記送受信部と同期処理部に出力し、前記同期処理部は、自軸と他軸の受信時タイマー値の誤差をなくすよう同期処理を行うことで、通信に接続された複数軸間で同期運転を実現する。   In a motor drive system in which a host controller and a multi-axis motor drive device are connected by communication, a communication transmission / reception unit and a timer that counts at a constant clock and outputs a reception timer value by a reception completion interrupt signal of the transmission / reception unit And a synchronization processing unit that corrects the deviation of the timer value at the time of reception between the own axis and the other axis, and the transmission / reception unit transmits the timer value at the time of reception to the host controller in the case of a command from the host controller In the case of a command to the other axis, the other axis acquires the timer value at the time of reception of the other axis from the data returned to the host controller and outputs it to the synchronization processing unit. Is output to the transmission / reception unit and the synchronization processing unit, and the synchronization processing unit is connected to communication by performing synchronization processing so as to eliminate an error in the reception timer value of the own axis and the other axis. To achieve synchronous operation across multiple axes.

また、通信の送受信部と、一定のクロックでカウントを行い前記送受信部の受信完了割込み信号で受信時タイマー値を出力するタイマー部と、通信を受信してから動作を開始するまでの時間を設定する起動開始時間設定部とを備え、前記送受信部は、複数軸のうち自軸がマスタ軸の場合には上位コントローラへ受信時タイマー値を返信し、マスタ軸でない
場合にはマスタ軸が上位コントローラに返信したデータから受信時タイマー値を取得して起動開始時間設定部へ出力し、前記タイマー部は受信時タイマー値を、自軸がマスタ軸の場合には送受信部に出力し、マスタ軸でない場合には起動開始時間設定部に出力し、マスタ軸でない起動開始時間設定部は、自軸とマスタ軸の受信時タイマー値の誤差に応じて動作開始信号の出力タイミングをずらすことで、マスタ軸との同時起動を実現する。
Also, it sets the time to start the operation after receiving the communication, the timer unit that counts with a certain clock and outputs the timer value at the time of reception with the reception completion interrupt signal of the transceiver unit The transmission / reception unit returns a timer value upon reception to the host controller when the own axis is the master axis among the plurality of axes, and the master axis is the host controller when the master axis is not the master axis. The timer value at the time of reception is acquired from the data returned to, and is output to the start time setting unit. The timer unit outputs the timer value at the time of reception to the transmission / reception unit when the own axis is the master axis, and is not the master axis. Output to the start start time setting unit, and the start start time setting unit that is not the master axis sets the output timing of the operation start signal according to the error in the timer value at the time of reception of the own axis and the master axis. By Russ, to realize the simultaneous start-up of the master axis.

また、上位からの通信を受信後に受信完了割込みを発生するステップ1と、その受信完了割込み時にタイマー値をラッチするステップ2と、上位コントローラからの命令が自軸か他軸かを判定するステップにおいて自軸の場合に上位へ受信時タイマー値を返信するステップ3と、他軸の場合に他軸が上位へ返信するデータを受信するステップ4と、自軸の受信時タイマー値と他軸の受信時タイマー値から内部同期タイマーを補正するステップ5とを備え、上位コントローラが他軸に対して通信を行うたびにステップ5にて自軸の受信時タイマー値を他軸の受信時タイマー値にあわせこむ処理を行うことで、通信に接続された複数軸間の同期運転を可能にするモータ駆動システムの同期方法である。   In step 1 for generating a reception completion interrupt after receiving communication from the host, in step 2 for latching the timer value at the time of the reception completion interrupt, and in determining whether the command from the host controller is the own axis or another axis Step 3 for returning the reception timer value to the host in the case of the own axis, Step 4 for receiving data for the other axis to return to the host in the case of the other axis, and reception of the timer value and the other axis for the own axis. Step 5 for correcting the internal synchronization timer from the hour timer value, and every time the host controller communicates with the other axis, the reception timer value of the own axis is adjusted to the reception timer value of the other axis in Step 5. This is a motor drive system synchronization method that enables synchronous operation between a plurality of axes connected to communication by performing this process.

さらに、上位コントローラからの通信を受信後に受信完了割込みを発生するステップ11と、その受信完了割込み時にタイマー値をラッチするステップ12と、上位コントローラからの命令が自軸か他軸かを判定するステップにおいて自軸の場合に上位へ受信時タイマー値を返信するステップ13と、他軸の場合に他軸が上位へ返信するデータを受信するステップ14と、自軸とマスタ軸の受信時タイマー値から動作開始信号の出力タイミングを調整するステップ15とを備え、ステップ15において、マスタ軸以外の軸の動作開始タイミングをマスタ軸の動作開始タイミングにあわせることで、マスタ軸との同時起動を実現するモータ駆動システムの同期方法である。   Further, a step 11 for generating a reception completion interrupt after receiving communication from the host controller, a step 12 for latching the timer value at the time of the reception completion interrupt, and a step for determining whether the command from the host controller is the own axis or another axis In step 13 for returning the reception timer value to the host in the case of the own axis, in step 14 for receiving data returned from the other axis to the host in the case of another axis, and from the timer value at the time of reception of the own axis and the master axis. A motor for realizing simultaneous activation with the master axis by adjusting the operation start timing of the axes other than the master axis to the operation start timing of the master axis in step 15. A drive system synchronization method.

本発明のモータ駆動装置によれば、上位コントローラが他軸に対して通信を行うたびに同期処理部において自軸と他軸の受信時タイマー値の誤差をなくすよう同期処理を行うことで、通信に接続された複数軸の同期運転を行うことができる。   According to the motor drive device of the present invention, each time the host controller communicates with the other axis, the synchronization processing unit performs the synchronization process so as to eliminate the error in the timer value at the time of reception of the own axis and the other axis, thereby enabling communication. Synchronous operation of multiple axes connected to can be performed.

また、マスタ軸でない起動開始時間設定部は、自軸とマスタ軸の受信時タイマー値の誤差に応じて動作開始信号の出力タイミングを調整してマスタ軸に合わせることで、マスタ軸との同時起動を実現することができる。   In addition, the start start time setting unit that is not the master axis adjusts the output timing of the operation start signal according to the error in the timer value at the time of reception of the own axis and the master axis, and matches the master axis, thereby simultaneously starting with the master axis. Can be realized.

このように、汎用的な非同期通信を用いた通信システムでも、高精度な同期運転と同時起動を行うことができる。   Thus, even in a communication system using general-purpose asynchronous communication, high-accuracy synchronous operation and simultaneous activation can be performed.

通信の送受信部と、一定のクロックでカウントを行い前記送受信部の受信完了割込み信号で受信時タイマー値を出力するタイマー部と、自軸の受信時タイマー値と他軸の受信時タイマー値とのずれを補正する同期処理部とを備え、上位からの通信において、自軸への命令の場合は受信時タイマー値を上位へ返信し、他軸への命令の場合は受信時タイマー値を同期処理部へ出力し、他軸から上位への返信データから他軸の受信時タイマー値を取得し、同期処理部においてその2つの受信時タイマー値の誤差をなくすよう同期処理を行うことで、通信に接続された複数軸の同期を行うようにしている。   A transmission / reception unit for communication, a timer unit that counts at a constant clock and outputs a timer value at reception by the reception completion interrupt signal of the transmission / reception unit, a reception timer value of the own axis and a reception timer value of another axis It has a synchronization processing unit that corrects the deviation, and in communication from the host, if the command is to the own axis, the timer value at the time of reception is returned to the host, and if the command is to another axis, the timer value at the time of reception is synchronized. To the communication unit by acquiring the timer value at the time of reception of the other axis from the return data from the other axis to the host, and performing synchronization processing to eliminate the error between the two timer values at the time of reception in the synchronization processing unit. The connected multiple axes are synchronized.

以下、本発明の実施例1について図を参照して説明する。   Embodiment 1 of the present invention will be described below with reference to the drawings.

図1は、モータ駆動システムにおけるモータ駆動装置の要部ブロック図であり、複数軸のモータ駆動装置は、上位コントローラからの通信処理を行う送受信部1と、一定のクロ
ックでカウントアップし受信完了割込み信号が入力されたときのタイマー値を出力するタイマー部2と、タイマー部2からの受信時タイマー値12と、送受信部1からの他軸の受信時タイマー値13とが入力され、2つのタイマー値の誤差をなくすよう内部同期タイマーを調整する同期処理部3を備えている。
FIG. 1 is a block diagram of a main part of a motor driving device in a motor driving system. A multi-axis motor driving device includes a transmission / reception unit 1 that performs communication processing from a host controller, and counts up with a constant clock and completes a reception completion interrupt. A timer unit 2 that outputs a timer value when a signal is input, a reception timer value 12 from the timer unit 2, and a reception timer value 13 of the other axis from the transmission / reception unit 1 are input, and two timers A synchronization processing unit 3 is provided for adjusting an internal synchronization timer so as to eliminate an error in value.

図2の動作フローチャートについて、図1を併用して説明する。まず、上位コントローラから通信を受信すると、送受信部1は受信完了割込み信号11をタイマー部2に出力する(ステップ1)。タイマー部2は、受信完了割込み信号11が入力されたときのタイマー値をラッチする(ステップ2)。   The operation flowchart of FIG. 2 will be described with reference to FIG. First, when communication is received from the host controller, the transmission / reception unit 1 outputs a reception completion interrupt signal 11 to the timer unit 2 (step 1). The timer unit 2 latches the timer value when the reception completion interrupt signal 11 is input (step 2).

上位コントローラからの命令が自軸のモータ駆動装置への命令であった場合には、通常の通信処理を行い、タイマー部2は自軸の受信時タイマー値12を送受信部1と同期処理部3に出力すると、送受信部1は上位コントローラに受信時タイマー値12を返信する(ステップ3)。一方、他軸のモータ駆動装置への命令の場合には、送受信部1は他軸が受信時タイマー値13を上位コントローラへ返信するのを待つ。   When the command from the host controller is a command to the own-axis motor driving device, normal communication processing is performed, and the timer unit 2 receives the own-axis reception timer value 12 from the transmission / reception unit 1 and the synchronization processing unit 3. The transmission / reception unit 1 returns a reception timer value 12 to the host controller (step 3). On the other hand, in the case of a command to the motor drive device of the other axis, the transmission / reception unit 1 waits for the other axis to return the reception timer value 13 to the host controller.

上位コントローラからの命令は、どの軸に対する命令であっても同じ通信線を通るため、すべての軸で一旦は受信する。通常は、受信後、自軸への命令かどうかを判断し、自軸であれば返信を行い、それ以外であればそのまま受信データを破棄し、受信待ち状態となる。その返信データも同じ通信線を通るため、上位コントローラ以外の接続されているモータ駆動装置全てで受信することができる。   The command from the host controller is received once for all axes because the command for any axis passes through the same communication line. Normally, after receiving, it is determined whether or not it is a command to the own axis, and if it is the own axis, a reply is made. Otherwise, the received data is discarded as it is, and a reception waiting state is entered. Since the reply data also passes through the same communication line, it can be received by all connected motor driving devices other than the host controller.

このように、他軸が上位コントローラへ返信するデータ(他軸の受信時タイマー値13)は自軸でも受信することができるため、自軸の送受信部1は受信データから他軸の受信時タイマー値13を抽出し、同期処理部3に出力する(ステップ4)。   Thus, since the data returned from the other axis to the host controller (other axis reception timer value 13) can also be received by the own axis, the own axis transmission / reception unit 1 determines the other axis reception timer from the received data. The value 13 is extracted and output to the synchronization processing unit 3 (step 4).

同期処理部3は、上位コントローラが他軸に対して通信を行うたびに、自軸の受信時タイマー値12と他軸の受信時タイマー値13の誤差をなくすよう内部同期タイマーを調整する(ステップ5)。   The synchronization processing unit 3 adjusts the internal synchronization timer so as to eliminate the error between the reception timer value 12 of the own axis and the reception timer value 13 of the other axis every time the host controller communicates with the other axis (Step S1). 5).

本発明のモータ駆動装置は、上位コントローラからの命令を受信したときの受信時タイマー値を、命令の宛先に関わらず、すべての軸で保存する。そして、命令の宛先の受信時タイマー値だけは上位コントローラに返信するため、すべての軸で他軸の受信時タイマー値に自軸の受信時タイマー値をあわせるように内部同期タイマーの値を調整する。   The motor drive device of the present invention stores the reception timer value when receiving a command from the host controller for all axes regardless of the destination of the command. Since only the reception timer value at the destination of the command is returned to the host controller, the value of the internal synchronization timer is adjusted so that the reception timer value of the own axis matches the reception timer value of the other axis in all axes. .

これを繰り返すことで、上位コントローラと各モータ駆動装置が通常の通信を行うだけで、すべてのモータ駆動装置において、受信時タイマー値12および受信時タイマー値13が同じ値をとるようになり、同期運転が実現できる。   By repeating this, only the normal communication between the host controller and each motor drive device allows the reception timer value 12 and the reception timer value 13 to have the same value in all motor drive devices. Driving can be realized.

次に、コントローラとモータ駆動装置2台の具体例において、モータ駆動装置同士を同期させることについて、図3を用いて説明する。   Next, in the specific example of the controller and the two motor drive devices, the synchronization of the motor drive devices will be described with reference to FIG.

まず、上位コントローラからアドレス0に対して通信を行う。受信時タイマー値をアドレス0とアドレス1でそれぞれラッチする。アドレス0は上位コントローラに対して受信時タイマー値を返信する。アドレス1では、その返信データを受信し、アドレス0の受信時タイマー値と自軸の受信時タイマー値とを比較し、誤差を小さくするよう自軸の内部同期タイマー値を調整する。これにより、補正前の同期誤差に対し、補正後の同期誤差は小さくなる。これを繰り返すことで同期誤差を0に近づけることができる。   First, the host controller communicates with address 0. The reception timer value is latched at address 0 and address 1, respectively. Address 0 returns a timer value upon reception to the host controller. At address 1, the reply data is received, the reception timer value at address 0 is compared with the reception timer value of the own axis, and the internal synchronization timer value of the own axis is adjusted so as to reduce the error. As a result, the post-correction synchronization error becomes smaller than the pre-correction synchronization error. By repeating this, the synchronization error can be brought close to zero.

上位コントローラとの通信相手がアドレス1の場合は、同期誤差に対する補正処理を行
うのがアドレス0になるだけで同じ効果を得ることができる。もちろん、常に一つのアドレスに対して通信を行う場合でも、アドレス0、アドレス1と交互に通信を行う場合でも、全く同じ効果を得ることができる。通信相手を限定する必要がなく、いずれかの軸に対して通信さえ行えば同じ効果を得ることができるのも特徴の一つである。
When the communication partner with the host controller is the address 1, the same effect can be obtained only by performing the correction process for the synchronization error at the address 0. Of course, the same effect can be obtained regardless of whether communication is always performed for one address or when communication is performed alternately with address 0 and address 1. One of the features is that it is not necessary to limit communication partners, and the same effect can be obtained as long as communication is performed with respect to any axis.

なお、同期させるタイマー値を内部のすべての割込みの基準タイマーとすることにより、内部のすべての割り込みを同期させることができ、高精度な同期運転が可能となる。   By using the timer value to be synchronized as a reference timer for all internal interrupts, all internal interrupts can be synchronized, and high-accuracy synchronous operation is possible.

また、軸数が増えた場合でも、各軸で同様の処理を行うことで、軸数の制限を受けることなく、高精度な複数軸の同期運転を実現できる。   Further, even when the number of axes increases, by performing the same processing for each axis, it is possible to realize a highly accurate synchronous operation of a plurality of axes without being limited by the number of axes.

以下、本発明の実施例2について図を参照して説明する。   Embodiment 2 of the present invention will be described below with reference to the drawings.

図4は、モータ駆動装置の要部ブロック図であり、上位コントローラからの通信処理を行う送受信部1と、一定のクロックでカウントアップし受信完了割込み信号が入力されたときのタイマー値を出力するタイマー部2と、その受信時タイマー値12と他軸の受信時タイマー値13から自軸の動作開始信号を出力する起動開始時間設定部4を備えている。   FIG. 4 is a block diagram of a main part of the motor drive device, and outputs the timer value when the reception completion interrupt signal is input after counting up with a constant clock and the transmission / reception unit 1 that performs communication processing from the host controller. A timer unit 2 and an activation start time setting unit 4 for outputting an operation start signal of the own axis from the reception timer value 12 and the reception timer value 13 of the other axis are provided.

同時起動を行うには、まず上位コントローラからブロードキャスト命令で動作開始命令を送信する。これにより、基本的には全軸同時に命令を受信することが可能だが、実際に動作が開始するのは、内部制御周期分誤差が生じてしまう。   In order to perform simultaneous activation, first, an operation start command is transmitted from the host controller by a broadcast command. As a result, it is basically possible to receive commands simultaneously for all axes, but an actual start of operation results in an error corresponding to the internal control period.

本手法では、接続されたモータ駆動装置のうち1軸をマスタ軸とし、そのマスタ軸にそれ以外の軸の起動タイミングを合わせることでより高精度な同時起動を実現することができる。   In this method, one axis of the connected motor driving devices is used as a master axis, and the activation timing of the other axes is matched with the master axis, so that more accurate simultaneous activation can be realized.

図5の動作フローチャートについて、図4を併用して説明する。上位コントローラからの同時起動用の通信を受信すると、送受信部1から受信完了割込み信号11が出力される(ステップ11)。タイマー部2は受信完了割込み信号11が入力されたときのタイマー値をラッチ(ステップ12)する。あらかじめ返信を行う1軸をマスタ軸と決めておき、自軸がマスタ軸であった場合は、上位コントローラへ受信時タイマー値12を返信する(ステップ13)。マスタ軸でない場合は、マスタ軸が上位コントローラへ返信するマスタ軸の受信時タイマー値15を受信する(ステップ14)。起動開始時間設定部4は、マスタ軸の受信時タイマー値15と自軸の受信時タイマー値12との差から動作開始信号を出力するタイミングを調整する(ステップ15)。   The operation flowchart of FIG. 5 will be described with reference to FIG. When the communication for simultaneous activation from the host controller is received, the reception completion interrupt signal 11 is output from the transmission / reception unit 1 (step 11). The timer unit 2 latches the timer value when the reception completion interrupt signal 11 is input (step 12). One axis to be replied in advance is determined as the master axis, and if the own axis is the master axis, the reception timer value 12 is returned to the host controller (step 13). If it is not the master axis, the master axis receiving timer value 15 is sent back from the master axis to the host controller (step 14). The activation start time setting unit 4 adjusts the timing of outputting the operation start signal from the difference between the reception timer value 15 of the master axis and the reception timer value 12 of the own axis (step 15).

これにより、マスタ軸との動作開始誤差を小さくすることができる。特にモータ駆動装置同士で同期がとれている場合は起動誤差を同期誤差のレベルまで小さくすることができる。   Thereby, the operation start error with the master axis can be reduced. In particular, when the motor drive devices are synchronized, the starting error can be reduced to the level of the synchronization error.

次に、上位コントローラとモータ駆動装置2台の具体例において、モータ駆動装置同士を同時起動させることについて、図6を用いて説明する。   Next, in the specific example of the host controller and the two motor drive devices, the simultaneous activation of the motor drive devices will be described with reference to FIG.

図6に示すように、アドレス0とアドレス1の同期誤差が小さい場合でも、図中のタイミングで同時起動命令を受信するとアドレス0の動作開始タイミングはA点、アドレス1はB点となり、内部タイマー周期分だけ起動誤差が生じる。   As shown in FIG. 6, even when the synchronization error between address 0 and address 1 is small, when a simultaneous activation command is received at the timing shown in the figure, the operation start timing of address 0 is point A and address 1 is point B, and the internal timer Start-up error occurs for the period.

そこで提案手法では、まずマスタ軸、ここではアドレス0の動作開始タイミングを強制的に1周期分だけずらし、C点とする。アドレス1ではマスタ軸から上位への返信データ
からマスタ軸の受信時タイマー値を読出し、その値と自軸の受信時タイマー値とを比較して、制御周期をまたぐ場合は動作開始タイミングを調整する。図6の場合は、動作開始タイミングを2周期分ずらし、D点とする。これにより、起動誤差を同期誤差と同等レベルまで小さくすることができる。
Therefore, in the proposed method, first, the operation start timing of the master axis, here address 0, is forcibly shifted by one cycle to obtain point C. At address 1, the master axis reception timer value is read from the master axis return data, the value is compared with the own axis reception timer value, and the operation start timing is adjusted when the control period is exceeded. . In the case of FIG. 6, the operation start timing is shifted by two cycles to obtain point D. As a result, the startup error can be reduced to the same level as the synchronization error.

動作開始タイミングの調整は、基本的に図7に示す3パターンがあり、それぞれマスタ軸に対して1制御周期進める、遅らせる、同じの3通りの処理を行うことで高性能な同時起動を実現できる。   The adjustment of the operation start timing basically has the three patterns shown in FIG. 7, and high-performance simultaneous activation can be realized by performing the same three types of processing, each of which advances or delays one control cycle for each master axis. .

なお、動作開始タイミングの調整(ずらす量)は、マスタ軸に対してそれ以外の軸を進ませるか、遅らせるかによって調整するため、マスタ軸の遅れを任意に決めたい場合は、その遅れに対して+1、0、−1とすればよい。   Note that the adjustment (shift amount) of the operation start timing is adjusted depending on whether the other axes are advanced or delayed with respect to the master axis. If you want to determine the master axis delay arbitrarily, +1, 0, −1.

また、軸数が増えた場合もすべてマスタ軸を基準に考えて各軸で同様の処理を行うことで軸数の制限を受けることなく、高精度な複数軸の同時起動を行うことができる。   Further, even when the number of axes is increased, it is possible to simultaneously start a plurality of highly accurate axes without being restricted by the number of axes by performing the same processing on each axis in consideration of the master axis.

本発明のモータ駆動装置は、専用のハードウェアを持つことなく、さらにはスレーブ側だけで高精度な同期処理、同時起動を実現するものであり、一般的に高速リアルタイム性を有しないパーソナルコンピュータなどの上位システムや、インターネット、無線通信等の不安定な通信路を経由したモータの同期制御などにも有用である。   The motor drive device of the present invention realizes high-precision synchronization processing and simultaneous activation only on the slave side without having dedicated hardware, and generally has a high-speed real-time property, such as a personal computer It is also useful for the synchronous control of a motor via an unstable communication path such as the Internet system, wireless communication, etc.

本発明の実施例1におけるモータ駆動装置の要部ブロック図1 is a block diagram of the main part of a motor drive device according to a first embodiment of the present invention. 本発明の実施例1における動作フローチャートOperation flowchart in Embodiment 1 of the present invention 本発明の実施例1における同期処理の説明図Explanatory drawing of the synchronous process in Example 1 of this invention 本発明の実施例2におけるモータ駆動装置の要部ブロック図The principal part block diagram of the motor drive device in Example 2 of this invention 本発明の実施例2における動作フローチャートOperation flowchart according to the second embodiment of the present invention 本発明の実施例2における同時起動処理の説明図Explanatory drawing of the simultaneous starting process in Example 2 of this invention 本発明の実施例2における起動時間調整処理の説明図Explanatory drawing of the starting time adjustment process in Example 2 of this invention

符号の説明Explanation of symbols

1 送受信部
2 タイマー部
3 同期処理部
4 起動開始時間設定部
11 受信完了割込み信号
12 受信時タイマー値
13 他軸の受信時タイマー値
14 マスタ軸の受信時タイマー値
15 動作開始信号
DESCRIPTION OF SYMBOLS 1 Transmission / reception part 2 Timer part 3 Synchronization processing part 4 Startup start time setting part 11 Reception completion interruption signal 12 Timer value at the time of reception 13 Timer value at the time of reception of other axes 14 Timer value at the time of reception of master axis 15 Operation start signal

Claims (4)

上位コントローラと複数軸のモータ駆動装置とを通信によって接続するモータ駆動システムにおいて、通信の送受信部と、一定のクロックでカウントを行い前記送受信部の受信完了割込み信号で受信時タイマー値を出力するタイマー部と、自軸と他軸との受信時タイマー値のずれを補正する同期処理部とを備え、前記送受信部は、上位コントローラから自軸への命令の場合は受信時タイマー値を上位コントローラへ返信し、他軸への命令の場合は他軸が上位コントローラに返信したデータから他軸の受信時タイマー値を取得して同期処理部へ出力し、前記タイマー部は自軸の受信時タイマー値を前記送受信部と同期処理部に出力し、前記同期処理部は、自軸と他軸の受信時タイマー値の誤差をなくすよう同期処理を行うことで、通信に接続された複数軸間で同期運転を実現することを特徴としたモータ駆動装置。 In a motor drive system in which a host controller and a multi-axis motor drive device are connected by communication, a communication transmission / reception unit and a timer that counts at a constant clock and outputs a reception timer value by a reception completion interrupt signal of the transmission / reception unit And a synchronization processing unit that corrects the deviation of the timer value at the time of reception between the own axis and the other axis, and the transmission / reception unit transmits the timer value at the time of reception to the host controller in the case of a command from the host controller to the host axis. In the case of a command to the other axis, the other axis acquires the timer value at the time of reception of the other axis from the data returned to the host controller and outputs it to the synchronization processing unit. Is output to the transmission / reception unit and the synchronization processing unit, and the synchronization processing unit is connected to communication by performing synchronization processing so as to eliminate an error in the reception timer value of the own axis and the other axis. Motor driving apparatus characterized by realizing a synchronous operation across multiple axes were. 上位コントローラと複数軸のモータ駆動装置とを通信によって接続するモータ駆動システムにおいて、通信の送受信部と、一定のクロックでカウントを行い前記送受信部の受信完了割込み信号で受信時タイマー値を出力するタイマー部と、通信を受信してから動作を開始するまでの時間を設定する起動開始時間設定部とを備え、前記送受信部は、複数軸のうち自軸がマスタ軸の場合には上位コントローラへ受信時タイマー値を返信し、マスタ軸でない場合にはマスタ軸が上位コントローラに返信したデータから受信時タイマー値を取得して起動開始時間設定部へ出力し、前記タイマー部は受信時タイマー値を、自軸がマスタ軸の場合には送受信部に出力し、マスタ軸でない場合には起動開始時間設定部に出力し、マスタ軸でない起動開始時間設定部は、自軸とマスタ軸の受信時タイマー値の誤差に応じて動作開始信号の出力タイミングをずらすことで、マスタ軸との同時起動を実現することを特徴としたモータ駆動装置。 In a motor drive system in which a host controller and a multi-axis motor drive device are connected by communication, a communication transmission / reception unit and a timer that counts at a constant clock and outputs a reception timer value by a reception completion interrupt signal of the transmission / reception unit And a start start time setting unit for setting a time from when communication is received until operation is started. When the own axis is a master axis among a plurality of axes, the transmission / reception unit receives the master axis. If the master axis is not the master axis, the master axis obtains the reception timer value from the data returned to the host controller and outputs it to the start time setting unit. When the own axis is the master axis, it is output to the transmitter / receiver. When it is not the master axis, it is output to the start start time setting section, and the start start time is not the master axis. Tough, by shifting the output timing of the operation start signal in response to an error during reception timer value of its own axis and master axis, a motor drive apparatus, characterized in that to realize the simultaneous activation of the master axis. 上位コントローラと複数軸のモータ駆動装置とを通信によって接続するモータ駆動システムにおいて、上位からの通信を受信後に受信完了割込みを発生するステップ1と、その受信完了割込み時にタイマー値をラッチするステップ2と、上位コントローラからの命令が自軸か他軸かを判定するステップにおいて自軸の場合に上位へ受信時タイマー値を返信するステップ3と、他軸の場合に他軸が上位へ返信するデータを受信するステップ4と、自軸の受信時タイマー値と他軸の受信時タイマー値から内部同期タイマーを補正するステップ5とを備え、上位コントローラが他軸に対して通信を行うたびにステップ5にて自軸の受信時タイマー値を他軸の受信時タイマー値にあわせこむ処理を行うことで、通信に接続された複数軸間の同期運転を可能にするモータ駆動システムの同期方法。 In a motor drive system in which a host controller and a multi-axis motor drive device are connected by communication, step 1 for generating a reception completion interrupt after receiving communication from the host, and step 2 for latching a timer value at the time of the reception completion interrupt In the step of determining whether the command from the host controller is the own axis or the other axis, in the case of the own axis, in step 3, the timer value at the time of reception is returned to the host, and in the case of another axis, the data that the other axis returns to the upper level Step 4 for receiving, and Step 5 for correcting the internal synchronization timer from the receiving timer value of the own axis and the receiving timer value of the other axis, each time the host controller communicates with the other axis. By synchronizing the reception timer value of the own axis with the reception timer value of the other axis, synchronous operation between multiple axes connected to communication is possible. The method of the synchronous motor driving system that ability. 上位コントローラと複数軸のモータ駆動装置とを通信によって接続するモータ駆動システムにおいて、上位コントローラからの通信を受信後に受信完了割込みを発生するステップ11と、その受信完了割込み時にタイマー値をラッチするステップ12と、上位コントローラからの命令が自軸か他軸かを判定するステップにおいて自軸の場合に上位へ受信時タイマー値を返信するステップ13と、他軸の場合に他軸が上位へ返信するデータを受信するステップ14と、自軸とマスタ軸の受信時タイマー値から動作開始信号の出力タイミングを調整するステップ15とを備え、ステップ15において、マスタ軸以外の軸の動作開始タイミングをマスタ軸の動作開始タイミングにあわせることで、マスタ軸との同時起動を実現するモータ駆動システムの同期方法。 In a motor drive system in which a host controller and a multi-axis motor drive device are connected by communication, a step 11 for generating a reception completion interrupt after receiving communication from the host controller, and a step 12 for latching a timer value at the time of the reception completion interrupt In the step of determining whether the command from the host controller is the own axis or the other axis, in the case of the own axis, in step 13, the timer value at the time of reception is returned to the host, and in the case of another axis, the data in which the other axis returns to the upper level. , And step 15 for adjusting the output timing of the operation start signal from the reception timer values of the own axis and the master axis. In step 15, the operation start timing of the axes other than the master axis is set to the master axis. A motor drive system that realizes simultaneous activation with the master axis by matching the operation start timing. Method of synchronization.
JP2006242451A 2006-09-07 2006-09-07 Motor drive device Active JP4661743B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2006242451A JP4661743B2 (en) 2006-09-07 2006-09-07 Motor drive device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2006242451A JP4661743B2 (en) 2006-09-07 2006-09-07 Motor drive device

Publications (2)

Publication Number Publication Date
JP2008067487A JP2008067487A (en) 2008-03-21
JP4661743B2 true JP4661743B2 (en) 2011-03-30

Family

ID=39289686

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2006242451A Active JP4661743B2 (en) 2006-09-07 2006-09-07 Motor drive device

Country Status (1)

Country Link
JP (1) JP4661743B2 (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09205793A (en) * 1995-11-24 1997-08-05 Mitsubishi Heavy Ind Ltd Motor controller
JP2001222308A (en) * 2000-02-09 2001-08-17 Mitsubishi Electric Corp Numerical control system
JP2005237163A (en) * 2004-02-23 2005-09-02 Matsushita Electric Ind Co Ltd Motor drive device

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09205793A (en) * 1995-11-24 1997-08-05 Mitsubishi Heavy Ind Ltd Motor controller
JP2001222308A (en) * 2000-02-09 2001-08-17 Mitsubishi Electric Corp Numerical control system
JP2005237163A (en) * 2004-02-23 2005-09-02 Matsushita Electric Ind Co Ltd Motor drive device

Also Published As

Publication number Publication date
JP2008067487A (en) 2008-03-21

Similar Documents

Publication Publication Date Title
EP1757410B1 (en) Robot coordinated control method and system
KR101044521B1 (en) Apparatus for controlling synchronization between slave devices connected to network
US10284692B2 (en) Control device and communication device
JP2007060400A (en) Method and system for controlling communication timing
WO2019107022A1 (en) Control device and control method
JP2006244264A (en) Control system
US10853288B2 (en) Bus system
US9319237B2 (en) Method and device for controlling a bus system and a corresponding bus system
JP2011130276A (en) Synchronous processing system and semiconductor integrated circuit
JP2001027904A (en) Numerical control system
US20190215231A1 (en) Log information generation apparatus, information processing system, log information generation method, and non-transitory recording medium storing a log information generation program
JP2007050812A (en) Load control system, communication control unit and load control method
JP2014146877A (en) Communication system and time synchronization
JP4661743B2 (en) Motor drive device
US9811486B2 (en) Programmable controller
JP4961589B2 (en) Network system and slave synchronization method
JP2011191874A (en) Data signal transmission and reception method
JP2005094933A (en) Motor driving device
US6885717B2 (en) Device and method for digitally generating equidistant synchronous frequency-multiplied clock pulses
JP5877310B2 (en) Master / slave synchronous communication system
CN113454901A (en) Drive system
JP2005229322A (en) Master slave synchronous communication system
JP5671601B2 (en) Synchronous processing system and semiconductor integrated circuit
JP2006157271A (en) Synchronization method of serial transmission system
TW201536016A (en) Device with synchronization function, communication system, and synchronization method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20080821

RD01 Notification of change of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7421

Effective date: 20091127

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20101129

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

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

R151 Written notification of patent or utility model registration

Ref document number: 4661743

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

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

Free format text: PAYMENT UNTIL: 20140114

Year of fee payment: 3