Patent Application
20190258229
This application is based on and claims the benefit of priority from Japanese Patent Application No. 2018-027921, filed on 20 Feb. 2018, the content of which is incorporated herein by reference.
The present invention relates to a servo controller that controls a motor in a machine such as a machine tool or an industrial machine.
In a machine such as a machine tool or an industrial machine, an abnormality such as an overload on a motor for driving a movable part may be caused by collision of the movable part with an obstacle (a tool, a workpiece, or on other object, for example). Patent documents 1 to 3 describe techniques relating to detect an abnormality in a machine such as a machine tool or an industrial machine based on a load torque on a motor.
Patent Document 1: Japanese Unexamined Patent Application, Publication No. H01-33605 (Japanese Unexamined Patent Application, Publication No. S64-33605)
Patent Document 2: Japanese Unexamined Patent Application, Publication No. 2001-150287
Patent Document 3: Japanese Unexamined Patent Application, Publication No. 2002-175104
Like the technique described in patent document 1, if an abnormality in a machine tool for machining is to be detected based on a load torque on a motor, for example, it becomes impossible in some cases to distinguish an abnormality due to the collision and machining disturbance during machining, causing difficulty in detecting the abnormality in the machine.
The present invention is intended to provide a servo controller capable of detecting an abnormality in a machine independently of the load state of a motor.
(1) A servo controller according to the present invention (servo controller 1 described later, for example) includes: a servo control unit (servo control unit 10 described later, for example) that controls a motor (motor 3 described later, for example) in a machine based on a position command; a position detection unit (position detection unit 20 described later, for example) that detects the position of the motor; a positional error calculation unit (positional error calculation unit 22 described later, for example) that calculates a positional error between the position command and the position of the motor detected by the position detection unit; a position abnormality detection unit (position abnormality detection unit 24 described later, for example) that detects a position abnormality in the motor when the positional error calculated by the positional error calculation unit is a first threshold or more; a load detection unit (load detection unit 30 described later, for example) that detects a load torque on the motor; a load abnormality detection unit (load abnormality detection unit 32 described later, for example) that detects a load abnormality in the motor when the load torque detected by the load detection unit is a second threshold or more; an abnormality detection unit (abnormality detection unit 50 described later, for example) that detects an abnormality in the machine when the position abnormality detection unit detects the position abnormality in the motor or when the load abnormality detection unit detects the load abnormality in the motor; and a threshold change unit (threshold change unit 40 described later, for example) that changes at least one of the first threshold and the second threshold in response to the load state of the motor.
(2) In the servo controller described in (1), when the load state of the motor is a heavy-load state, the threshold change unit may increase at least the second threshold, compared to the second threshold determined when the load state of the motor is a no-load state or a light-load state.
(3) In the servo controller described in (1) or (2), the threshold change unit may acquire an operation program for the motor from a higher-order controller, and estimate the load state of the motor based on information indicated by the operation program.
(4) In the servo controller described in any one of (1) to (3), when the position abnormality detection unit detects the position abnormality in the motor, the position abnormality detection unit may output a position abnormality level responsive to the magnitude of the positional error, when the load abnormality detection unit detects the load abnormality in the motor, the load abnormality detection unit may output a load abnormality level responsive to the magnitude of the load torque, and the abnormality detection unit may detect the abnormality in the machine based on the position abnormality level output from the position abnormality detection unit and the load abnormality level output from the load abnormality detection unit.
(5) In the servo controller described in (4), the threshold change unit may control the position abnormality detection unit or the load abnormality detection unit so as to invalidate one of output of the position abnormality level and output of the load abnormality level in response to the load state of the motor.
(6) In the servo controller described in (5), the threshold change unit may control the load abnormality detection unit so as to invalidate output of the load abnormality level when the load state of the motor is a heavy load state, and the threshold change unit may control the position abnormality detection unit so as to invalidate the position abnormality level when the load state of the motor is a no-load state or a light-load state.
(7) In the servo controller described in any one of (4) to (6), when the total sum of the position abnormality level and the load abnormality level is a third threshold or more, the abnormality detection unit may issue a notification to stop the operation of the motor.
(8) In the servo controller described in any one of (4) to (7), the position abnormality level may be a difference between the positional error and the first threshold, and the load abnormality level may be a difference between the load torque and the second threshold.
(9) In the servo controller described in any one of (1) to (8), the positional error calculation unit may estimate an estimation position of the motor by taking delay by the servo control unit from the position command into consideration, and calculate an error between the estimation position and the position of the motor detected by the position detection unit as the positional error.
The present invention can provide a servo controller capable of detecting an abnormality in a machine independently of the load state of a motor.
An example of an embodiment of the present invention will be described below by referring to the accompanying drawings. In the drawings, corresponding or similar parts are identified by the same sign.
The servo control unit 10 calculates a driving current for the motor 3 by executing position control, speed control, and current control using PI control, for example, based on a position command from the numerical controller 2. As an example, the servo control unit 10 calculates a speed command based on a positional error between the position command and a position feedback (position FB) detected by an encoder provided at the motor 3 (position control), calculates a torque command for the motor 3 based on the calculated speed command and a speed feedback (speed FB) detected by the encoder (speed control), and calculates a driving current for the motor 3 based on the calculated torque command (current control), for example.
The position detection unit 20 detects the rotation position of the motor 3. The rotation position of the motor 3 corresponds to the position of the movable part in the machine tool. The detected position is used as the position feedback (position FB). The position detection unit 20 is the encoder provided at the motor 3, for example. The encoder further detects the rotation speed of the motor 3. The rotation speed of the motor 3 corresponds to the feed speed of the movable part in the machine tool. The detected speed is used as the foregoing speed feedback (speed FB).
The positional error calculation unit 22 calculates a positional error between a position command from the numerical controller 2 and the position feedback detected by the position detection unit 20.
The position abnormality detection unit 24 compares the positional error calculated by the positional error calculation unit 22 and a first threshold for detecting a position abnormality in the motor 3, and detects a position abnormality in the motor 3. When the positional error is the first threshold or more, the position abnormality detection unit 24 outputs a position abnormality level responsive to the magnitude of the positional error. For example, the position abnormality level is a difference between the positional error and the first threshold (see
The load detection unit 30 detects a load torque on the motor 3. The load detection unit 30 is a servo amplifier to acquire a current feedback from the motor 3, for example.
The load abnormality detection unit 32 compares the load torque detected by the load detection unit 30 and a second threshold for detecting a load abnormality in the motor 3, and detects a load abnormality in the motor 3. When the load torque is the second threshold or more, the load abnormality detection unit 32 outputs a load abnormality level responsive to the magnitude of the load torque. For example, the load abnormality level is a difference between the load torque and the second threshold (see
The threshold change unit 40 acquires a machining program (operation program for the motor 3) from the numerical controller 2, and estimates a machining state (the load state of the motor 3) based on information indicated by the machining program. For example, the machining program indicates information such as a feed speed. The threshold change unit 40 changes at least one of the first threshold and the second threshold in response to the machining state.
When a machining state is a heavy machining state (heavy-load state), for example, the threshold change unit 40 at least increases the second threshold, compared to the second threshold determined when the machining state is a positioning state (no-load state) or a light machining state (light-load state).
The abnormality detection unit 50 detects an abnormality in the machine based on the position abnormality level output from the position abnormality detection unit 24 and the load abnormality level output from the load abnormality detection unit 32. When the total sum of the position abnormality level and the load abnormality level is a third threshold for detecting an abnormality in the machine or more, for example, the abnormality detection unit 50 detects an abnormality in the machine. The abnormality detection unit 50 issues a notification to stop the operation of the motor 3 when an abnormality in the machine is detected.
The servo controller 1 is configured using an operation processor such as a digital signal processor (DSP) or a field-programmable gate array (FPGA), for example. The servo controller 1 has various functions to be fulfilled by execution of predetermined software (program) stored in a storage unit (not shown). The various functions of the servo controller 1 may be fulfilled by cooperative work by hardware and software, or only by hardware (electronic circuit).
Abnormality detecting operation performed by the servo controller 1 of the embodiment will be described next by referring to
(Positioning State or Light Machining State)
In a positioning state or a light machining state, machining disturbance is comparatively small. Thus, as shown in
When the total sum of the position abnormality level output from the position abnormality detection unit 24 and the load abnormality level output from the load abnormality detection unit 32 is the third threshold or more, the abnormality detection unit 50 detects an abnormality in the machine. In this case, the abnormality detection unit 50 issues a notification to stop the operation of the motor 3. In response to this notification, the motor 3 stops its operation.
In a heavy machining state, machining disturbance is comparatively large. Thus, as shown in
When the total sum of the position abnormality level output from the position abnormality detection unit 24 and the load abnormality level output from the load abnormality detection unit 32 is the third threshold or more, the abnormality detection unit 50 detects an abnormality in the machine. In this case, the abnormality detection unit 50 issues a notification to stop the operation to the motor 3. In response to this notification, the motor 3 stops its operation.
As described above, in the servo controller 1 of the embodiment, an abnormality detection method is switched in response to a machining state (the load state of the motor 3). More specifically, in each of a positioning state (no-load state) and a light machining state (light-load state) in which machining disturbance is comparatively small, the servo controller 1 detects an abnormality such as collision of a machine by detecting a load abnormality in the motor 3 based on an actual load torque. Meanwhile, in a heavy machining state (heavy-load state) in which machining disturbance is comparatively large, the servo controller 1 detects an abnormality such as collision of the machine by detecting a position abnormality in the motor 3 based on a positional error between an actual position and a position command. As a result, in any machining state (in any load state of the motor 3) such as a heavy machining state in which machining disturbance is comparatively large, for example, an abnormality such as collision of the machine can be detected.
In the servo controller 1 of the embodiment, the first threshold for detecting a position abnormality in the motor 3 and the second threshold for detecting a load abnormality in the motor 3 are set at arbitrary values. This makes it possible to switch between the position abnormality detection and the load abnormality detection steplessly.
In the servo controller 1 of the embodiment, a notification to stop the motor 3 is issued without being passed through a higher-order device such as the numerical controller 2. This makes it possible to stop the motor 3 more promptly on the occurrence of the machine abnormality.
In the foregoing embodiment, the first threshold for detecting a position abnormality in the motor 3 and the second threshold for detecting a load abnormality in the motor 3 are changed to switch between these two abnormality detection methods. Alternatively, a switch between the two abnormality detection methods for detecting a position abnormality in the motor 3 and for detecting a load abnormality in the motor 3 may be made by invalidating one of output of a position abnormality level about the motor 3 and output of a load abnormality level about the motor 3.
In a first modification, the threshold change unit 40 controls the position abnormality detection unit 24 or the load abnormality detection unit 32 so as to invalidate one of output of a position abnormality level and output of a load abnormality level in response to a machining state. When a machining state is a positioning state or a light machining state, for example, the threshold change unit 40 controls the position abnormality detection unit 24 so as to invalidate a position abnormality level, as shown in
In the foregoing embodiment, a switch is made between the two abnormality detection methods for detecting a position abnormality in the motor 3 and for detecting a load abnormality in the motor 3. Alternatively, the two abnormality detection methods for detecting a position abnormality in the motor 3 and for detecting a load abnormality in the motor 3 may be given different weights. By doing so, these two abnormality detection methods, specifically, a position abnormality level in the motor 3 and a load abnormality level in the motor 3 may be used in combination.
For example, in a second modification, the first threshold and the second threshold are set in such a manner that, independently of whether a machining state is a positioning state or a light machining state, or whether the machining state is a heavy machining state, both a position abnormality level and a load abnormality level are output. In this case, the abnormality detection unit 50 may detect an abnormality in the machine when the total sum of the position abnormality level and the load abnormality level is the third threshold or more.
In the foregoing embodiment, a position abnormality in the motor 3 is detected based on a positional error between a position command and a position detected value. Alternatively, the position command may be replaced by a position estimation value determined by taking control delay by the servo control unit 10 into consideration.
In a third modification, the positional error calculation unit 22 estimates an estimation position of the motor 3 by taking control delay (first-order delay, for example) by the servo control unit 10 from a position command into consideration. The positional error calculation unit 22 calculates an error between the estimation position and the position of the motor 3 detected by the position detection unit 20 as a positional error (dynamic error monitoring).
To detect an abnormality by monitoring a positional error, a detection threshold is generally set using a positional error as a basis that might occur during rapid traverse in a positioning state. Hence, the threshold is set at a large value. The positional error becomes smaller in actual machining. This unfortunately causes detection delay on the occurrence of an abnormality. In this regard, in the third modification, an ideal position is estimated by taking control delay (first-order delay, for example) by the servo control unit 10 into consideration, and the amount of error of a detected position from the estimation position is monitored. This makes it possible to detect a position abnormality in the motor 3 more promptly.
In the third modification, a position abnormality in the motor 3 is determined using a positional error between the ideal estimation position and the detected position, in addition to a load torque. When machining disturbance is large, a load torque assumes a large value even in a normal state. Hence, an abnormality such as collision of the machine cannot be determined. In this regard, in the third modification, a positional error between the ideal estimation position and the detected position is monitored. This makes it possible to detect an abnormality in the machine such as an unexpected collision occurring in a transient state.
In the foregoing embodiment, a position abnormality level and a load abnormality level are calculated to detect an abnormality in the machine. Alternatively, calculation of a position abnormality level and a load abnormality level may be omitted.
In a fourth modification, when a positional error calculated by the positional error calculation unit 22 is the first threshold or more, the position abnormality detection unit 24 detects a position abnormality in the motor 3, and outputs information indicating the position abnormality to the abnormality detection unit 50. When a load torque detected by the load detection unit 30 is the second threshold or more, the load abnormality detection unit 32 detects a load abnormality in the motor 3, and outputs information indicating the load abnormality to the abnormality detection unit 50. The abnormality detection unit 50 detects an abnormality in the machine based on the information indicating the position abnormality output from the position abnormality detection unit 24 and the information indicating the load abnormality output from the load abnormality detection unit 32. In this way, the abnormality detection unit 50 detects an abnormality in the machine when the position abnormality detection unit 24 detects the position abnormality in the motor 3, or when the load abnormality detection unit 32 detects the load abnormality in the motor 3.
The present invention should not be limited to the embodiment described above, but various changes and modifications are applicable to the present invention. In the example described in the foregoing embodiment, the servo controller 1 that controls the motor 3 in a machine tool for machining is shown as an example. However, the features of the present invention should not be limited to this servo controller but the present invention is applicable to servo controllers that control motors in various types of machine in industrial machines, various types of robots, etc.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2018-027921 | Feb 2018 | JP | national |
