JP4321428B2 - Servo system abnormality detection device - Google Patents

Description

  The present invention relates to abnormality detection of a servo system that performs positioning control.

A servo motor control device that performs positioning control generally generates a servo motor drive signal from a position command pulse given from a host device and a feedback pulse output from a position detector attached to the servo motor. is there. In such a servo system, various measures for detecting the runaway are implemented in order to prevent the controlled object driven by the servomotor from running out of control and colliding with the end of the apparatus and damaging the apparatus.

Among them, set the upper and lower limits of the error that is allowed for the theoretical ideal error calculated from the position command pulse from the host device, and compare the error signal obtained from the position command pulse and the servo motor feedback pulse. Thus, a method for detecting runaway is known (for example, see Patent Document 1).
JP 63-163905 A

  Generally, a servo motor control device drives a servo motor by calculating a torque command based on an error signal between a position command pulse and a feedback pulse. The relationship between the error signal and the torque command varies depending on the rigidity of the control target, the operation pattern, and the required responsiveness.

  In a system that detects runaway by comparing the error signal with the upper and lower limits of the allowable error obtained by the calculation based on the position command pulse, the error signal that calculates the torque command required to drive the servo motor is the normal operation. However, it may fall outside the allowable range and be erroneously detected.

  For this reason, it is necessary to set a tolerance range that allows erroneous detection and early detection of the occurrence of runaway. The optimum tolerance setting value is the rigidity, operation pattern, and requirements of the control target. It is difficult to set because it varies depending on the response.

  The present invention solves the above-described conventional problems, and provides an abnormality detection device for a servo system that can detect in advance that a controlled object moves out of a moving range due to runaway without erroneous detection even in normal operation. With the goal.

In order to solve the above problems, the present invention determines a control amount by a control calculation means from a position command pulse input from a host device and a feedback pulse output from a position detection means provided in a servo motor, and motor drive means In the servo system for controlling the rotation amount of the servo motor by the position command pulse integrated value calculation means for calculating the integrated value of the position command pulse, and the allowable pulse as the allowable range in the integrated value of the position command pulse in the driving direction Depending on the value, the positive direction is added or the negative direction is subtracted to calculate the movement amount, and the maximum movement amount that maintains the maximum movement range by updating when the maximum positive movement amount and negative maximum movement amount are maintained. maximum and amount calculating means, and the integrated value calculating means for calculating an integrated value of the feedback pulse, said maximum movement amount calculating means holds Comparing means for comparing the dynamic range and the integrated value of the feedback pulses, and a failure detecting means for detecting the runaway of the control object as a result of the comparing means, the abnormality detecting means, the comparison of the comparing means regarded as abnormal can the integrated value of the feedback pulses exceeds the maximum moving range that holds the maximum movement amount calculating means, in the abnormality detecting apparatus of a servo system characterized that you perform the abnormality detection time process is there.

According to the abnormality detection device of the servo system of the present invention, the movement amount is calculated by adding the allowable pulse to the integrated value of the position command pulse input from the host device in the positive direction or subtracting the negative direction according to the driving direction. , Because the runaway detection is performed while maintaining the maximum movement range by updating when the maximum movement amount in the positive direction and the maximum movement amount in the negative direction are exceeded, it is possible to control without misdetecting that it is out of the allowable range even in normal operation. It is possible to detect in advance that the object moves out of the movement range due to runaway.

Servo that determines the control amount by the control calculation means from the position command pulse input from the host device and the feedback pulse output from the position detection means provided in the servo motor, and controls the rotation amount of the servo motor by the motor drive means In the system, position command pulse integrated value calculation means for calculating the integrated value of the position command pulse, and an allowable pulse as an allowable range is added to the integrated value of the position command pulse depending on the driving direction or in the negative direction The maximum movement amount calculation means for calculating the movement amount by subtraction , updating the maximum movement amount in the positive direction and the maximum movement amount in the negative direction and holding the maximum movement range, and the integrated value of the feedback pulse and integrated value calculating means for calculating a, the feedback pulse maximum movement range in which the maximum movement amount calculating means holds Comparison means for comparing the integrated value, and a failure detecting means for detecting the runaway of the control object as a result of the comparing means, the abnormality detecting means, the integrated value of the feedback pulse in the comparison processing in the comparison means wherein the maximum moving amount calculation means holding regarded as abnormal can to exceed the maximum movement range has a abnormality detecting device of a servo system characterized that you perform the abnormality detection time process.

  In FIG. 1, a servo motor control device 1 in a servo system calculates a position command pulse input from a host device 12 and a feedback pulse input from a position detection means 3 provided in the servo motor 2 by a control calculation means 10. However, the positioning control of the controlled object 4 is performed by driving the servo motor 2 by the motor driving means 11 based on the control amount, which is the same as in the prior art. Further, other configurations similar to those of the prior art are omitted.

  Here, the abnormality detection device provided in the servo motor control device 1 will be described, but it is assumed that the position command pulse from the host device is within the movement range of the control target.

  The abnormality detection device of the present invention comprises a position command pulse integrated value calculation means 5 for calculating an integrated value of position command pulses, a maximum movement amount calculation means 6 for calculating a maximum movement amount from the position command pulse integrated value and an allowable pulse, The feedback pulse integrated value calculating means 7 for calculating the integrated value of the feedback pulse output from the position detecting means 3 provided in the servo motor 2, the comparing means 8 for comparing the maximum movement amount and the feedback pulse integrated value, and the feedback pulse The abnormality detection means 9 detects an abnormality when the integrated value deviates from the maximum movement amount.

  Here, the determination sequence of the abnormality detection apparatus will be described with reference to the flowchart and FIG. FIG. 2 shows a main sequence of abnormality detection.

  In FIG. 2, when the drive of the servo motor 2 is started, the sequence is started. First, the initialization process 13 and the setting of the allowable pulse P are executed. The allowable pulse P is set to an arbitrary value in advance. The initialization process 13 is a process for maintaining a new positive maximum movement amount and negative maximum movement amount by clearing a maximum movement amount that was previously set, such as when a set value is changed.

  Next, the position command integrated value Scmd is obtained from the position command pulse input from the host device 12 by the position command integrated value calculation 15 as the position command pulse integrated value calculation means 5. The maximum movement amount update processing 16 as the maximum movement amount calculation means 6 from the position command integrated value will be described in detail later, but the positive direction maximum movement amount Mp and the negative direction maximum movement amount Mn are updated to hold the maximum movement amount. To do.

Next, the feedback pulse integrated value calculation 17 as the feedback pulse integrated value calculating means 7 is executed from the feedback pulse input from the position detecting means 3 provided in the servo motor 2 to obtain the feedback pulse integrated value Sfb. The obtained feedback pulse integrated value Sfb is compared with the positive direction maximum movement amount Mp and the negative direction maximum movement amount Mn in the comparison process 18 as the comparison means 8, and is larger than the positive direction maximum movement amount Mp or the negative direction maximum movement. If the amount is smaller than the amount Mn, “Yes” is set. Otherwise, “No” is set.

  In the case of “Yes” in the comparison process 18, it is regarded as an abnormality and the process proceeds to an abnormality detection process 19 as the abnormality detection means 9. In the case of “No”, the process returns to the position command pulse integrated value calculation 15 and the above operations are repeated. In the abnormality detection process, the power supply to the servo motor 2 is cut off, but a warning device such as a buzzer or a lamp may be operated.

  Here, a detailed sequence of the maximum movement amount update processing 16 will be described with reference to the drawings. In FIG. 3, the position command integrated value Scmd obtained by the position command integrated value calculation 15 is compared with 0 by the comparison process 20. If it is greater than 0, it is “Yes”, and if it is equal or smaller, it is “No”. .

  When the result of the comparison process 20 is “Yes”, that is, when the servo motor 2 is driven in the forward direction, the maximum forward movement amount Mp is compared with the value obtained by adding the allowable pulse P to the position command integrated value Scmd (Scmd + P). Compared with the processing 23, if Scmd + P is larger than the maximum positive direction movement amount Mp, “Yes” is set, and if the value is equal or smaller, “No” is set.

  When the result of the comparison process 23 is “Yes”, the maximum forward movement amount Mp is updated with Scmd + P, and when it is “No”, the update is not performed.

  Similarly, when the result of the comparison process 20 is “No”, that is, when the servo motor is stopped or driven in the negative direction, the allowable pulse P is subtracted from the maximum negative direction movement amount Mn and the position command integrated value Scmd. The value (Scmd-P) is compared in the comparison process 21. When the position command integrated value Scmd-P is smaller than the maximum positive direction movement amount Mp, “Yes” is obtained, and when the value is equal or larger, “No” is obtained. To do. When the result of the comparison process 21 is “Yes”, the negative maximum movement amount Mn is updated with the position command integrated value Scmd-P, and when it is “No”, the update is not performed.

  As an example of realizing the sequence flow shown in FIG. 2 and FIG. 3, it is generally realized by a program of a general-purpose arithmetic processing unit represented by a microcomputer as in the first embodiment, but realized by a logic circuit. May be.

  As described above, the abnormality detection device provided in the servo motor control device updates the positive direction maximum movement amount Mp and the negative direction maximum movement amount Mn and maintains the maximum movement amount, so that it is not erroneously detected in normal operation. It is possible to detect in advance that the control object moves out of the movement range due to runaway.

  The abnormality detection device for a servo system according to the present invention is useful for the purpose of positioning control of a workpiece within a limited range.

The block block diagram of the principal part in the motor control apparatus of this invention The flowchart of the main sequence of abnormality detection in Example 1 of this invention Flowchart of maximum movement amount update processing in Embodiment 1 of the present invention

DESCRIPTION OF SYMBOLS 1 Servo motor control apparatus 2 Servo motor 3 Position detection means 4 Control object 5 Position command pulse integration value calculation means 6 Maximum movement amount calculation means 7 Feedback pulse integration calculation means 8 Comparison means 9 Abnormality detection means 10 Control calculation means 11 Motor drive means 12 Host device P Permissible pulse

Claims (1)

Servo that determines the control amount by the control calculation means from the position command pulse input from the host device and the feedback pulse output by the position detection means provided in the servo motor, and controls the rotation amount of the servo motor by the motor drive means In the system, position command pulse integrated value calculation means for calculating the integrated value of the position command pulse, and an allowable pulse as an allowable range is added to the integrated value of the position command pulse depending on the driving direction or in the negative direction The maximum movement amount calculation means for calculating the movement amount by subtraction , updating the maximum movement amount in the positive direction and the maximum movement amount in the negative direction and holding the maximum movement range, and the integrated value of the feedback pulse and integrated value calculating means for calculating a, the feedback pulse maximum movement range in which the maximum movement amount calculating means holds Comparison means for comparing the integrated value, and a failure detecting means for detecting the runaway of the control object as a result of the comparing means, the abnormality detecting means, the integrated value of the feedback pulse in the comparison processing in the comparison means the holding of the maximum movement amount calculating means is deemed to be abnormal can to exceed the maximum movement range is, the abnormality detecting device of a servo system characterized that you perform the abnormality detection time process.

Images