JP5250964B2 - Motor control device - Google Patents

Description

  The present invention relates to a motor control device that controls a motor such as a servo motor, and more particularly to a motor control device that detects the position of another motor and outputs a position command value corresponding thereto.

  When the motor is controlled by the motor control device, there is a case where control of synchronous tracking is performed in which the position of another motor is detected and a position command value corresponding to the movement of the motor is output.

FIG. 4 is a block diagram for explaining synchronous tracking by a conventional motor control device.
A case where the follow-up shaft motor 2 is caused to follow the movement of the main shaft motor 1 synchronously will be described. The amount of rotation of the spindle motor 1 is extracted as a pulse train by the encoder 3, and this pulse train is captured by the spindle current position detector 11 of the motor control device 10 to detect the current position of the spindle motor 1. A position command value from the current position of the spindle motor 1 to the follow-up shaft motor 2 is calculated and output to the driver 4 as a pulse train. At this time, if necessary, the number of pulses of the spindle motor 1 and the number of pulses of the follow-up shaft motor 2 are subjected to pulse number conversion processing (electronic gear calculation) to obtain a position command value. As a result, the follow-up shaft motor 2 such as a pulse motor or a servo motor is controlled.
Further, in order to avoid sudden acceleration of the follow-up shaft motor 2, the position command value is not output as it is, and the acceleration immediately after the start of synchronous follow-up is suppressed by the speed limit unit 12.

5 and 6 are diagrams for explaining the operation of the conventional synchronization tracking.
For example, a case will be described in which a robot that performs an operation on an object flowing on a conveyor is controlled.
FIG. 5A shows the speed of the motor serving as the spindle, and the motor moving the conveyor corresponds to the spindle motor 1. The spindle motor 1 accelerates at a constant value, and operates at a constant speed after reaching a set speed.

FIG. 5 (b) shows the speed of the motor that becomes the follow-up axis, and FIG. 5 (c) shows the speed of the motor that becomes the follow-up axis when there is speed limit processing. A motor that follows the robot corresponds to the follow-up shaft motor 2.
As shown in FIG. 5B, if the speed limit process is not performed, the follow-up axis motor 2 is accelerated rapidly, an overload is applied to the follow-up axis motor 2, and unnecessary vibration is applied to the robot to be controlled. There is a problem such as giving. Therefore, in order to avoid this, speed limit processing and acceleration limit processing are performed on the position command value to the follow-up axis motor 2 by the speed limit unit 12.

  As shown in FIG. 5C, when the tracking shaft motor 2 starts synchronous tracking at time T1, the speed limit value is gradually increased, and when the original upper limit speed limit value is reached at time T2, the speed limit is reached. The value is peaked. When the follow-up shaft motor 2 follows the main shaft motor 1 synchronously at time T3, the speed limit process is not applied and the follow-up shaft motor 2 is controlled by a position command value equivalent to that of the main shaft motor 1.

FIG. 6A shows the speed of the motor serving as the main shaft, which is an operation when the main shaft motor 1 is accompanied by rapid acceleration after the tracking shaft motor 2 performs synchronous tracking. The speed of the spindle motor 1 decelerates from time T4 to time T5, accelerates rapidly from time T6 to time T7, and then operates at a constant speed.
FIG. 6B shows the speed of the motor serving as the follow-up axis when there is a speed limit process. The follow-up shaft motor 2 operates in the same manner as in FIG. 5C until time T4, and is decelerated by being controlled by a position command value equivalent to that of the spindle motor 1 from time T4 to time T5. After that, when the main shaft motor 1 accelerates rapidly from time T6 to time T7, the speed limit value of the follow-up shaft motor 2 reaches a peak after time T2, and thus the speed limit is not applied. For this reason, a position command value for rapid acceleration is output to the tracking shaft motor 2 in an attempt to follow the rapid acceleration of the spindle motor 1.

  For example, Patent Document 1 discloses a conventional motor control device.

JP 2002-325474 A

  Since the current position of the spindle motor 1 is sampled at a constant cycle such as 1 ms, for example, the position can be accurately detected with an integer value. However, when the current speed is 1 ms cycle sampling, only a resolution of 1 kpps can be secured. Therefore, it was difficult to accurately detect the current speed.

  If the main shaft motor 1 is operating at a constant speed, the initial acceleration is suppressed by speed limit processing immediately after the start of synchronous tracking, so that the tracking shaft motor 2 is not given a large acceleration thereafter, but the speed limit value is When the spindle motor 1 operates with sudden acceleration in a state where the head is flattened, the follow-up axis motor 2 also tries to follow the spindle motor 1 and outputs a position command value that causes rapid acceleration. There was a point.

  The present invention was made to solve the above-described problems, and limits the speed of the follow-up axis motor not only immediately after the start of synchronous follow-up but also against rapid acceleration of the spindle motor in the synchronous follow-up state, An object of the present invention is to realize a motor control device that smoothes the acceleration of the tracking axis.

In order to achieve such an object, the present invention has the following configuration.
(1) A motor control device that controls a position command value output to a driver that drives a follow-up axis motor so that the follow-up axis motor follows the main shaft motor,
A spindle current position detector for detecting a current position of the spindle motor;
The output of the spindle current position detection unit is input, a position command value is calculated from this input value, a speed limit value for limiting the acceleration of the follow-up axis motor is set, and a speed with respect to the calculated position command value is set. A speed limit unit that transmits a limit OFF signal only when the limit process is performed and the speed limit process is not performed.
A position command value calculated by the speed limit unit, a filter processing unit that performs a filter process to prevent a sudden change in the position command value and outputs the result;
When the limit OFF signal is received , the speed limit set by the speed limit unit to set the current speed of the tracking axis motor calculated from the position command value filtered by the filter processing unit as a speed limit value A speed limit conversion unit that rewrites the value to the current speed of the following axis motor ;
A motor control device comprising:

(2) The spindle current position detector detects the current position of the spindle motor by counting pulses output from an encoder that rotates in accordance with the rotation of the spindle motor. Motor control device.

( 3 ) The motor control device according to (1) or (2) , wherein the filter processing unit performs a first-order lag filtering process of the position command value by a low-pass filter.

( 4 ) The motor control device according to (1) or (2) , wherein the filter processing unit performs a moving average process of the position command value.

The present invention has the following effects.
When speed limit processing is not performed, the speed limit value is lowered according to the current speed, so not only immediately after the start of synchronous tracking, but also for rapid acceleration after the speed of the spindle motor decreases in synchronous tracking status. By limiting the speed of the follow-up axis motor, the follow-up axis motor can be smoothly accelerated.

Hereinafter, the present invention will be described in detail with reference to the drawings.
FIG. 1 is a block diagram showing an embodiment of the present invention. The same parts as those in the previous figure are given the same reference numerals.
A case where the follow-up shaft motor 2 is caused to follow the movement of the main shaft motor 1 synchronously will be described. The amount of rotation of the spindle motor 1 is extracted by a pulse train by the encoder 3. The spindle current position detector 21 of the motor control device 20 captures this pulse train and counts the number of pulses to detect the current position of the spindle motor 1. A position command value from the current position of the spindle motor 1 to the follow-up shaft motor 2 is calculated and output to the driver 4 as a pulse train. At this time, if necessary, the number of pulses of the spindle motor 1 and the number of pulses of the follow-up shaft motor 2 are subjected to pulse number conversion processing (electronic gear calculation) to obtain a position command value. As a result, the follow-up shaft motor 2 such as a pulse motor or a servo motor is controlled.

  Based on the current position of the spindle motor 1 detected by the spindle current position detection unit 21, the speed limit unit 22 calculates a position command value for the follow-up shaft motor 2. At this time, in order to avoid abrupt acceleration of the follow-up axis motor 2, the position command value is not output as it is, and the speed limit process for limiting the acceleration of the follow-up axis motor 2 by the speed limit unit 22 is performed.

  The position command value calculated by the speed limit unit 22 is not output to the driver 4 as it is, and the filter processing unit 23 performs first-order lag low-pass filter processing and moving average filter processing, and performs filter processing to prevent sudden change of the position command value. It is output to the driver 4 later. Further, the speed limit conversion unit 24 detects the current speed of the follow-up shaft motor 2 from the position command value after the filter processing.

Conventionally, since the current position of the follow-up axis motor 2 is sampled with an integer value, the resolution of 1 / (sampling period) can be secured for the current speed. However, the follow-up axis motor 2 can be obtained by performing filter processing. Sufficient resolution can be obtained even for the current speed. At this time, the filter time constant is set according to the relationship between the time delay and ensuring the resolution.
Also, the filtering process is effective for suppressing acceleration during deceleration and rapid changes in acceleration.

  When the speed limit unit 22 does not perform the speed limit process, the speed limit unit 22 transmits a limit OFF signal to the speed limit conversion unit 24. Upon receiving this limit OFF signal, the speed limit conversion unit 24 tracks the speed limit value of the speed limit unit 22 in order to use the current speed of the tracking axis motor 2 calculated from the position command value after the filter processing as the speed limit value. The current speed of the shaft motor 2 is rewritten.

FIG. 2 is a diagram for explaining the operation of synchronization tracking according to the present invention.
For example, a case will be described in which a robot that performs an operation on an object flowing on a conveyor is controlled.
FIG. 2A shows the speed of the motor serving as the main shaft, and the motor that moves the conveyor corresponds to the main shaft motor 1. FIG. 2B shows the speed of the motor that becomes the follow-up axis when there is the speed limit process of the present invention, and the follow-up axis motor 2 corresponds to the motor that causes the robot that performs the work to the object flowing on the conveyor. .

The spindle motor 1 accelerates at a constant value, and operates at a constant speed after reaching a set speed. When synchronous tracking of the follow-up axis motor 2 is started at time T1, a speed limit process is performed by the speed limit unit 22 in order to suppress rapid acceleration of the follow-up axis motor 2.
At time T1, the speed limit value is “0”. The speed limit unit 22 is set with an acceleration limit value (speed value to be added to the current set speed for each speed setting period) to suppress rapid acceleration, and the acceleration limit value is added to the speed limit value. By using this as a new speed limit value, the speed limit value gradually increases from time T1 to time T2. When the original speed limit value is reached at time T2, the speed limit value reaches a peak.

When the follow-up shaft motor 2 follows the main shaft motor 1 synchronously at time T3, the speed limit process is not applied and the control is performed with a position command value equivalent to that of the main shaft motor 1.
When the speed of the spindle motor 1 is decelerated from time T4 to time T5, the follow-up axis motor 2 is controlled by the position command value equivalent to that of the spindle motor 1 from time T4 to time T5 and decelerates.

  In the section from time T3 to time T5, the speed limit process is not applied, and the speed limit unit 22 transmits a limit OFF signal to the speed limit conversion unit 24. When the speed limit conversion unit 24 receives this limit OFF signal, the speed limit conversion unit 24 sets the current speed of the follow-up shaft motor 2 calculated from the position command value after the filter processing by the filter processing unit 23 as the speed limit value. The speed limit value is rewritten to the current speed of the tracking axis motor 2. As a result, the speed limit value follows the same trajectory as the speed of the motor serving as the tracking axis from time T3 to time T5 in FIG. 2B, and gradually decreases from time T4 to time T5. The limit value is “0”.

A case where the speed of the spindle motor 1 changes suddenly after the tracking shaft motor 2 starts synchronous tracking will be described. From time T6 to time T7, the speed of the spindle motor 1 suddenly accelerates again and then operates at a constant speed.
At time T6, the speed limit value is “0”. The speed limit unit 22 is set with an acceleration limit value (speed value to be added to the current set speed for each speed setting period) to suppress rapid acceleration, and the acceleration limit value is added to the speed limit value. By using this as a new speed limit value, the speed limit value gradually increases from time T6 to time T8. When the original speed limit value is reached at time T8, the speed limit value reaches its peak.

When the follow-up shaft motor 2 follows the main shaft motor 1 synchronously at time T9, the speed limit process is not applied and the control is performed with a position command value equivalent to that of the main shaft motor 1.
After time T9, the speed limit process is not performed, and the speed limit unit 22 transmits a limit OFF signal to the speed limit conversion unit 24. When the speed limit conversion unit 24 receives this limit OFF signal, the speed limit conversion unit 24 sets the current speed of the follow-up shaft motor 2 calculated from the position command value after the filter processing by the filter processing unit 23 as the speed limit value. The speed limit value is rewritten to the current speed of the tracking axis motor 2.

  As described above, when the speed limit process is not performed, the speed limit value is lowered in accordance with the current speed, so that the speed of the spindle motor 1 decreases not only immediately after the tracking axis motor 2 starts synchronous tracking but also in the synchronous tracking state. It is possible to limit the acceleration of the follow-up shaft motor 2 even for a rapid acceleration of the main shaft motor 1 after that, and to smooth the acceleration of the follow-up shaft motor 2 so that unnecessary vibrations are not given to the apparatus.

FIG. 3 is a flowchart of the speed limit process of the present invention.
The speed limit unit 22 determines whether or not the speed limit value reaches a peak (S10). If the speed limit value has not reached its peak, add the acceleration limit value (the value of the speed to be added to the current set speed at each speed setting cycle) to the current speed limit value to obtain a new speed limit value ( S20). This process (S20) is not performed when the speed limit value reaches a peak.

  The speed limit unit 22 determines whether or not it is necessary to perform speed limit processing on the position command value from the current position of the spindle motor 1 to the follow-up axis motor 2 (S30). When it is necessary to perform speed limit processing, the speed limit value is added to the previous position command value to obtain the current position command value (S40). When it is not necessary to perform speed limit processing, the position command value calculated by the speed limit unit 22 is output to the filter processing unit 23. Further, the speed limit value of the speed limit unit 22 is changed to the current speed of the follow-up axis motor 2 in order to set the current speed of the follow-up axis motor 2 calculated from the position command value after the filter processing by the filter processing unit 23 as the speed limit value. Rewrite (S50).

  As a result, even though the spindle motor 1 has decelerated, the speed limit value of the follow-up axis motor 2 has reached its peak, so the speed limit is not applied and the follow-up axis motor tries to follow the rapid acceleration of the spindle motor 1. 2 can be prevented from sudden acceleration.

It is a block diagram which shows one Example of this invention. It is operation | movement explanatory drawing of the synchronous tracking of this invention. It is a flowchart of the speed limit process of this invention. It is a block diagram explaining the synchronous tracking by the conventional motor control apparatus. It is operation | movement explanatory drawing of the conventional synchronous tracking. It is operation | movement explanatory drawing of the conventional synchronous tracking.

Explanation of symbols

DESCRIPTION OF SYMBOLS 1 Main shaft motor 2 Following shaft motor 3 Encoder 4 Driver 20 Motor controller 21 Main spindle present position detection part 22 Speed limit part 23 Filter processing part 24 Speed limit conversion part

Claims (4)

A motor control device that controls a position command value output to a driver that drives a follow-up axis motor so that the follow-up axis motor follows the main shaft motor,
A spindle current position detector for detecting a current position of the spindle motor;
The output of the spindle current position detection unit is input, a position command value is calculated from this input value, a speed limit value for limiting the acceleration of the follow-up axis motor is set, and a speed with respect to the calculated position command value is set. A speed limit unit that transmits a limit OFF signal only when the limit process is performed and the speed limit process is not performed.
A position command value calculated by the speed limit unit, a filter processing unit that performs a filter process to prevent a sudden change in the position command value and outputs the result;
When the limit OFF signal is received , the speed limit set by the speed limit unit to set the current speed of the tracking axis motor calculated from the position command value filtered by the filter processing unit as a speed limit value A speed limit conversion unit that rewrites the value to the current speed of the following axis motor ;
A motor control device comprising:   The motor control according to claim 1, wherein the spindle current position detection unit detects a current position of the spindle motor by counting pulses output from an encoder that rotates in accordance with the rotation of the spindle motor. apparatus.   The motor control device according to claim 1, wherein the filter processing unit performs a first-order lag filter process of the position command value by a low-pass filter.   The motor control device according to claim 1, wherein the filter processing unit performs a moving average process of the position command value.

Images