SERVO CONTROL DEVICE AND SERVO CONTROL METHOD

• US 20150045940A1
• Filed: 02/05/2013
• Published: 02/12/2015
• Est. Priority Date: 03/05/2012
• Status: Abandoned Application

• Current Assignee: Mitsubishi Heavy Industries, Ltd.
• Original Assignee: Mitsubishi Heavy Industries, Ltd.
• Inventors: Takeuchi, Katsuyoshi, Yamamoto, Hideaki, Kuramoto, Hirohisa
• Application Number:
  US14/379,940
• Publication Number:
  US 20150045940A1
• Time in Patent Office: Days
• US Class Current: 700/159
• CPC Class Codes: G05B 13/0205 not using a model or a simulator of the controlled system
• CPC Class Codes: G05B 19/182 characterised by the machine tool function, e.g. thread cutting, cam making, tool direction control G05B19/21 - G05B19/40 take precedence
• CPC Class Codes: G05B 2219/41004 Selection gain according to selection of speed or positioning mode
• CPC Class Codes: G05B 2219/41427 Feedforward of position
• CPC Class Codes: G05B 2219/49135 Active clamping, use servo to keep in position
• CPC Class Codes: G05B 2219/49381 Raster, line servo, area machining, cutting, facing

Abstract

A servo control device (20) includes a position feedback unit (21) that performs position feedback control for matching the position of a driven unit to the position command for each of X, Y, and Z axes and a speed feed forward unit (22) that performs speed feed forward control, which is for compensating a delay in the position control for the driven unit due to position feedback control, for each axis. The servo control device (20) changes the position loop gain for each axis to the same value set in advance when the speed feed forward control is OFF, and changes the position loop gain based on the position feedback control to the optimal gain corresponding to each axis when the speed feed forward control of the speed feed forward unit (22) is ON.

Claims

1. A servo control device which is applied to a numerical control apparatus including a screw feed unit that is provided for each of a plurality of axes and converts rotational movement of a motor to linear movement, a driven unit that is moved linearly by the screw feed unit, and a support body that supports the screw feed unit and the driven unit and which controls the motor so as to match a position of the driven unit to a position command, the device comprising:

feedback means for performing feedback control, which is for matching the position of the driven unit to the position command, for each of the axes; and

feed forward means for performing feed forward control, which is for compensating a delay in position control for the driven unit due to the feedback control, for each of the axes,

wherein a feedback gain for each of the axes is changed to the same value set in advance when the feed forward control is OFF, and a feedback gain based on the feedback control is changed to a predetermined value corresponding to each of the axes when the feed forward control of the feed forward means is ON.

2. The servo control device according to claim 1,

wherein, as the predetermined value, different values are set when a setting value of a feed forward gain based on the feed forward control is the same for each axis and when the setting value is different for one or more of the axes.

3. The servo control device according to claim 1,

wherein, when the setting value of the feed forward gain based on the feed forward control is the same for each axis, the predetermined value is a value set for each of the axes according to machine stiffness in the axis.

4. The servo control device according to claim 1,

wherein, when a setting value of a feed forward gain based on the feed forward control is different for one or more of the axes, the predetermined value is a value at which a deviation between the position command for the driven unit and an actual position of the driven unit is the same for each axis.

6. The servo control device according to claim 2,

wherein, when the setting value of the feed forward gain based on the feed forward control is the same for each axis, the predetermined value is a value set for each of the axes according to machine stiffness in the axis.

7. The servo control device according to claim 2,

wherein, when a setting value of a feed forward gain based on the feed forward control is different for one or more of the axes, the predetermined value is a value at which a deviation between the position command for the driven unit and an actual position of the driven unit is the same for each axis.

8. The servo control device according to claim 3,

wherein, when a setting value of a feed forward gain based on the feed forward control is different for one or more of the axes, the predetermined value is a value at which a deviation between the position command for the driven unit and an actual position of the driven unit is the same for each axis.

5. A servo control method of a servo control device which is applied to a numerical control apparatus including a screw feed unit that is provided for each of a plurality of axes and converts rotational movement of a motor to linear movement, a driven unit that is moved linearly by the screw feed unit, and a support body that supports the screw feed unit and the driven unit and which includes, in order to control the motor so as to match a position of the driven unit to a position command, feedback means for performing feedback control for matching the position of the driven unit to the position command for each of the axes and feed forward means for performing feed forward control for compensating a delay in position control for the driven unit due to the feedback control for each of the axes, the method comprising:

a first step of performing feedback control by changing the feedback gain for each of the axes to the same value set in advance when the feed forward control is OFF; and

a second step of performing feed forward control by changing a feedback gain based on the feedback control to a predetermined value corresponding to each of the axes when the feed forward control of the feed forward means is ON.