Servo motor controller

Abstract

A servo motor controller capable of eliminating inconvenience that the position of a shaft or the like of a servo motor is detected or set erroneously due to influence of noise or the like is provided. A servo motor controller that detects Z-phase signals of an incremental-type encoder that detects rotation of a servo motor to perform driving control of the servo motor includes: a position detection unit that detects a reference position of a rotating shaft of the servo motor on the basis of the Z-phase signal of the encoder; a signal interval detection unit that measures intervals of a plurality of detected Z-phase signals; and an abnormality determination unit that determines that the Z-phase signal is abnormal when the interval measured by the signal interval detection unit is equal to or larger than a prescribed threshold.

Claims

1. A servo motor controller that detects Z-phase signals of an incremental-type encoder that detects rotation of a servo motor to perform driving control of the servo motor, comprising: a position detection unit that detects a reference position of a rotating shaft of the servo motor on the basis of the Z-phase signal of the encoder; a signal interval detection unit that measures intervals of a plurality of detected Z-phase signals; an abnormality determination unit that determines that the Z-phase signal is abnormal when the interval measured by the signal interval detection unit is equal to or larger than a prescribed threshold; and a speed changing unit that changes a speed of the servo motor, wherein the speed changing unit changes the speed of the servo motor when the abnormality determination unit determines that the Z-phase signal is abnormal.

2. The servo motor controller according to claim 1, wherein the signal interval detection unit performs measurement again after the speed of the servo motor is changed.

3. The servo motor controller according to claim 2, further comprising: an abnormality notifying unit that notifies a host controller of an abnormality when the interval of the Z-phase signals is equal to or larger than a prescribed threshold with respect to a latest detection value or an average value of detection values for a prescribed period at a state where the speed of the servo motor was changed to a prescribed speed.

4. A servo motor controller that detects Z-phase signals of an incremental-type encoder that detects rotation of a servo motor to perform driving control of the servo motor, comprising: a position detection unit that detects a reference position of a rotating shaft of the servo motor on the basis of the Z-phase signal of the encoder; a signal interval detection unit that measures intervals of a plurality of detected Z-phase signals; an abnormality determination unit that determines that the Z-phase signal is abnormal when the interval measured by the signal interval detection unit is equal to or larger than a prescribed threshold; and an abnormality notifying unit that notifies a host controller of an abnormality when the interval of the Z-phase signals is equal to or larger than a prescribed threshold with respect to a latest detection value or an average value of detection values for a prescribed period at a state where a speed of the servo motor was changed to a prescribed speed.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) FIG. 1 is a diagram illustrating a servo motor control system according to an embodiment.

(2) FIG. 2 is a block diagram illustrating a servo motor controller according to an embodiment.

(3) FIG. 3 is a flowchart illustrating a method of determining presence of abnormality in a Z-phase signal using a servo motor controller according to an embodiment.

(4) FIG. 4 is a flowchart illustrating a method of determining presence of abnormality in a Z-phase signal using a servo motor controller according to an embodiment.

(5) FIG. 5 is a flowchart illustrating a method of determining presence of abnormality in a Z-phase signal using a servo motor controller according to an embodiment.

(6) FIG. 6 is a diagram used for describing detection of errors resulting from influence of noise or the like.

DETAILED DESCRIPTION OF THE INVENTION

(7) Hereinafter, a servo motor controller according to an embodiment will be described with reference to FIGS. 1 to 5.

(8) In the present embodiment, description will be given assuming that an industrial machine is a machine tool and driving of a spindle or the like of the machine tool is controlled by a servo motor controller. However, the servo motor controller according to the present invention may naturally be applied to driving control of a servo motor used in other industrial machines such as a robot, a conveyer, a measuring instrument, a testing device, a press, a press-fitting machine, a printing machine, a die casting machine, an injection molding machine, a food machine, a packaging machine, a welding machine, a washing machine, a painting machine, an assembly device, a mounting machine, a woodworking machine, a sealing device, and a cutting machine.

(9) For example, as illustrated in FIG. 1, a machine tool (industrial machine) control system 1 according to the present embodiment includes a computerized numerical control (CNC) 2 which is a host controller, a servo motor controller (a motor controller of a servo amplifier or the like) 4 that controls driving of a servo motor (a driving unit) 3 of a machine tool on the basis of commands of the CNC 2, and an incremental-type encoder (incremental encoder) 5 that detects rotation of the servo motor 3.

(10) As illustrated in FIGS. 1 and 2, the servo motor controller 4 according to the present embodiment includes a position detection unit 6 that detects a reference position of a rotating shaft of the servo motor 3 on the basis of a Z-phase signal of the encoder 5, a signal interval detection unit 7 that measures intervals of a plurality of detected Z-phase signals, and an abnormality determination unit 8 that determines that the Z-phase signal is abnormal when the interval measured by the signal interval detection unit 7 is equal to or larger than a prescribed threshold.

(11) Furthermore, the servo motor controller 4 according to the present embodiment includes a speed changing unit 9 that changes the speed of the servo motor 3 when the abnormality determination unit 8 determines that the Z-phase signal is abnormal and an abnormality notifying unit 10 that notifies the CNC 2 or the like of a host controller of an abnormality when the interval of the Z-phase signals is equal to or larger than a prescribed threshold with respect to a latest detection value or an average value of detection values for a prescribed period at a stage where the speed of the servo motor 3 was changed to a prescribed speed, and the abnormality determination unit 8 determines that the Z-phase signal is abnormal.

(12) When position control is performed using the servo motor controller 4 according to the present embodiment having the above-described configuration, as illustrated in FIG. 3 (FIGS. 1 and 2), the encoder 5 starts detecting the rotation position of the shaft of the servo motor 3 with driving of the servo motor 3 and the position detection unit 6 detects the reference position of the rotating shaft of the servo motor 3 on the basis of a Z-phase signal of the encoder 5.

(13) In this case, in the servo motor controller 4 of the present embodiment, the signal interval detection unit 7 receives a plurality of Z-phase signals in a rotating state of the servo motor 3 and starts measuring the time elapsed until a subsequent Z-phase signal (a present Z-phase signal) is detected after a previous Z-phase signal was detected (STEP1).

(14) When the Z-phase signal is detected (STEP2) and the signal interval detection unit 7 measures the interval between the previous Z-phase signal and the subsequent Z-phase signal, the abnormality determination unit 8 checks whether the interval exceeds a threshold (an upper-lower limit range of thresholds) set in advance using a normal value as a reference (STEP3).

(15) When the interval does not exceed the threshold, the abnormality determination unit 8 determines that the present Z-phase signal is normal and performs establishment of a reference position (establishment of an absolute position) (STEP4).

(16) When the interval is equal to or larger than the threshold, the abnormality determination unit 8 determines that the present Z-phase signal is abnormal and does not perform establishment of a reference position (STEP5).

(17) In the present embodiment, it is checked whether the latest detection value of the interval of the Z-phase signals is equal to or larger than a prescribed threshold to determine presence of an abnormality. However, it may be checked whether an average value of the detection values of a plurality of Z-phase signals detected in a prescribed period is equal to or larger than a prescribed threshold to determine presence of an abnormality.

(18) In the servo motor controller 4 of the present embodiment, as illustrated in FIG. 4, when the abnormality determination unit 8 determines that the Z-phase signal is abnormal, it is preferable that the abnormality notifying unit 10 notifies the CNC 2 or the like of a host controller of an abnormality (STEP6).

(19) Furthermore, in the servo motor controller 4 of the present embodiment, as illustrated in FIG. 5 (FIG. 1), when the abnormality determination unit 8 determines that the Z-phase signal is abnormal, the speed of the servo motor 3 is raised or lowered within a prescribed range, and measurement of the interval of Z-phase signals after the speed was changed is performed again (retried) (STEP7, STEP8, and STEP1) and abnormality determination is performed again. A plurality of speed change values is set in advance within a prescribed range, and measurement of the interval of Z-phase signals at the respective speed change values is performed again (retried) repeatedly.

(20) Therefore, in the servo motor controller 4 of the present embodiment, by measuring the interval of a plurality of Z-phase signals detected in a Z-phase signal detection operation and checking whether the interval exceeds a prescribed threshold (a range of thresholds), it is possible to determine presence of abnormalities in the Z-phase signal. In this way, it is possible to eliminate inconvenience that the position of a shaft or the like of the servo motor 3 is detected or set erroneously due to influence of noise or the like, and as a result, it is possible to perform position control with high accuracy and high reliability.

(21) When the abnormality determination unit 8 determines that the Z-phase signal is abnormal, by changing the speed of the servo motor 3 and performing (retrying) measurement of the interval of the Z-phase signals again using the signal interval detection unit 7, it is possible to determine presence of abnormalities in the Z-phase signal with higher accuracy.

(22) Since the servo motor controller 4 includes the abnormality notifying unit 10 that notifies the CNC 2 or the like of a host controller of an abnormality when the abnormality determination unit 8 determines that the Z-phase signal is abnormal, it is possible to inform an operator of the abnormality quickly to stop the servo motor 3 and to generate an alarm and to prevent an unexpected dangerous operation of the machine tool (an industrial machine).

(23) While an embodiment of the servo motor controller has been described, the present invention is not limited to the above-described embodiment but can be changed appropriately without departing from the spirit thereof.

(24) For example, in the present embodiment, when the abnormality determination unit 8 determines that the Z-phase signal is abnormal, the speed changing unit 9 changes the speed of the servo motor 3, the signal interval detection unit 7 measures the interval of the Z-phase signals again in a stage where the speed of the servo motor 3 was changed to a prescribed speed, and the abnormality determination unit 8 and the abnormality notifying unit 10 determines presence of an abnormality and notifies of an abnormality. In contrast, the speed may be maintained constant, the times at which the Z-phase signals are detected may be detected, and the presence of an abnormality may be determined on the basis of the detection times (intervals) of a plurality of Z-phase signals.

EXPLANATION OF REFERENCE NUMERALS

(25) 1: Servo motor control system 2: Host controller (CNC) 3: Servo motor 4: Servo motor controller 5: Encoder 6: Position detection unit 7: Signal interval detection unit 8: Abnormality determination unit 9: Speed changing unit 10: Abnormality notifying unit