SERVO CONTROLLER

Abstract

An object is to provide a servo controller which constantly optimizes parameters according to the state of a machine. A servo controller for controlling an electric motor which drives the axis of an industrial machine includes: a state value derivation unit which derives, from an operation program and/or operation plan information of the industrial machine, the chronological or event-sequential data of the state value of the electric motor or a driven member that is operated with the electric motor; and a parameter change unit which changes at least one parameter of a velocity gain, a position gain, a feedforward gain, a filter frequency and an acceleration/deceleration time constant after interpolation based on the chronological or event-sequential data derived in the state value derivation unit either chronologically or event-sequentially.

Claims

1. A servo controller for controlling an electric motor which drives an axis of an industrial machine, the servo controller comprising: a state value derivation unit which derives, from an operation program and/or operation plan information of the industrial machine, chronological or event-sequential data of a state value of the electric motor or a driven member that is operated with the electric motor; and a parameter change unit which changes at least one parameter of a velocity gain, a position gain, a feedforward gain, a filter frequency and an acceleration/deceleration time constant after interpolation based on the chronological or event-sequential data derived in the state value derivation unit either chronologically or event-sequentially.

2. The servo controller according to claim 1, wherein the state value derivation unit derives the chronological or event-sequential data of inertia of the driven member.

3. The servo controller according to claim 1, wherein the state value derivation unit derives the chronological or event-sequential data of a position of the axis.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0016] FIG. 1 is a diagram showing a control system and a servo controller of a machine tool in a first aspect;

[0017] FIG. 2 is a block diagram showing the servo controller in the aspect;

[0018] FIG. 3 is a diagram used for illustrating the production of the event-sequential or chronological schedule of the optimal parameter with the servo controller in the aspect;

[0019] FIG. 4 is a diagram used for illustrating the production of the event-sequential or chronological schedule of the optimal parameter with the servo controller in the aspect;

[0020] FIG. 5 is a diagram used for illustrating the production of the event-sequential or chronological schedule of the optimal parameter with the servo controller in the aspect;

[0021] FIG. 6 is a diagram used for illustrating the production of the event-sequential or chronological schedule of the optimal parameter with the servo controller in the aspect; and

[0022] FIG. 7 is a diagram used for illustrating the production of the event-sequential or chronological schedule of the optimal parameter with the servo controller in the aspect.

DETAILED DESCRIPTION OF THE INVENTION

[0023] A servo controller according to an embodiment will be described below with reference to FIGS. 1 to 7.

[0024] In the present embodiment, a description will first be given with the assumption that an industrial machine is a machine tool and that an electric motor is a servo motor which drives the spindle (axis, driven member) or the like of the machine tool. However, the industrial machine according to the present invention may be naturally another industrial machine such as a robot, a transport device, a measurement device, a test device, a press machine, a press-fitting device, a printing machine, a die casting machine, an injection molding machine, a food machine, a packaging machine, a welding machine, a washing machine, a coating machine, an assembly device, a mounter, a woodworking machine, a sealing device or a cutting machine.

[0025] As shown in FIGS. 1 and 2, the control system 1 of the machine tool of the present embodiment first includes: a CAD 2 for performing design, drafting and the like of a product; a machining program production unit (operation program production unit) 3 which produces a machining program (operation program) from machining shape data (product data) produced with the CAD 2; a CAM 5 which includes a machining simulator unit (operation simulator unit) 4 that performs machining simulation (operation simulation); a CNC 6 of a command unit which issues a command signal based on machining plan information (G code, operation plan information) 9 that is fed from the CAM 5; and a motor control unit 8 which controls the drive of the servo motor (drive unit) 7 of the machine tool based on the command of the CNC 6.

[0026] The servo motor 7 of the drive unit is, for example, a servo motor (electric motor) for driving a spindle (axis) to which a feed axis (axis) for moving a table (driven member) that holds a workpiece (driven member), a tool (driven member) or the like is fitted or the like, and the motor control unit 8 is, for example, a servo amplifier.

[0027] On the other hand, the servo controller 10 of the present embodiment includes: the machining program production unit 3 described above; the machining simulator unit 4; a state value derivation unit 11 which acquires the machining plan information produced in the machining program production unit 3 and the machining simulator unit 4 so as to determine, from the machining plan information, chronological or event-sequential data of state values of the driven members such as the workpiece and the table and the servo motor 7; and a parameter change unit 12 which changes at least one parameter of a velocity gain, a position gain, a feedforward gain, a filter frequency and an acceleration/deceleration time constant after interpolation based on the chronological or event-sequential data derived in the state value derivation unit 11 either chronologically or event-sequentially.

[0028] Specifically, as shown in FIG. 1, the machining plan information 9 produced in the CAD 2 and the CAM 5 is acquired in the CNC 6, thereafter the CNC 6 of the command unit issues a position command and an acceleration/deceleration command after interpolation to the motor control unit 8 of the servo amplifier and thus the drive of the servo motor 7 is controlled with the motor control unit 8.

[0029] Here, in the servo controller 10 of the present embodiment, the state value derivation unit 11 acquires the machining plan information 9 from the CAM 5, and determines a relationship 13 of chronology or event sequence of inertia from the machining plan information 9. The event sequence of inertia indicates a time necessary for each machining step (event) continuously and chronologically, and means, for example, the chronology of inertia which reflects, for example, a case where between a certain machining step and the subsequent machining step, a time regardless of the steps is produced such as by a contingency.

[0030] An example will be more specifically described.

[0031] As shown in FIG. 3, in a state where the workpiece is not held (placed) on a stage (table) 6 which is moved by the forward/reverse rotation of a feed axis (ball screw) 15 around an axis line by the drive of the servo motor 7, inertia J=J.sub.0. J.sub.0 is the total of inertia values of the rotor of the motor, the feed axis 15 and the stage 16.

[0032] As shown in FIG. 4, when the workpiece 17 of mass M is held on the stage 6, inertia J.sub.LOAD=J.sub.0+MR.sup.2. R is a conversion coefficient of rotation-linear motion for a lead (movement distance) L (m), and R=L/2 (m/rad).

[0033] In this way, a velocity FB gain and a velocity FF gain are scheduled to be J.sub.LOAD/J=1+(MR.sup.2/J.sub.0) times. For example, when J.sub.0=0.01 kgm.sup.2, M=500 kg and L=0.02 m, the gain is set to be 1.5 times J.sub.LOAD/J=1+(MR.sup.2/J.sub.0).

[0034] On the other hand, when a transmission characteristic from the torque of the servo motor 7 to the position (machine end) of the stage 16 is illustrated, the transmission characteristic is, for example, as shown in FIG. 5. When as shown in FIG. 6, the position of the stage 16 is changed, the rigidity Kt of the machine in an axial direction is changed, and thus a resonance frequency (natural frequency) is also changed. In particular, in the case of a large machine or a long ball screw (such as a stroke), the rigidity is significantly changed according to the position thereof.

[0035] Hence, as shown in FIG. 7, the attenuation center frequency (resulting from the change of the resonance frequency) of a filter 18, a time constant (since vibration is likely to occur when the rigidity is lowered, the time constant is increased) and the like are scheduled so as to correspond to the position.

[0036] Then, as shown in FIG. 1, the state value derivation unit 11 acquires the machining plan information 9 from the CAM 5 so as to determine the relationship 13 of chronology or event sequence of inertia from the machining plan information 9, and thereafter the state value derivation unit 11 determines a gain schedule (the velocity gain, the position gain, the feedforward gain and the like which are chronological) 14 from the relationship 13 of chronology or event sequence of inertia so as to synchronize the gain schedule and the command of the CNC 6.

[0037] Then, the parameter change unit 12 changes the parameter of the velocity loop (and/or the position loop) of the motor control unit 8 based on the gain schedule (chronological or event-sequential data) 14 derived in the state value derivation unit 11 either chronologically or event-sequentially. For example, as shown in FIG. 1, the parameters R (coefficient) and Kv (gain) of the velocity loop are changed so as to correspond to the gain schedule. Here, s in the velocity loop or the position loop of FIG. 1 is a derivative value.

[0038] Then, based on the velocity FF (or the position FF: feedforward) which is changed so as to correspond to the gain schedule, the command such as the torque command is issued from the motor control unit 8, and thus the servo motor 7 is controlled for driving.

[0039] In this way, in the servo controller 10 of the present embodiment, based on the event-sequential or chronological data of the machine which is predicted, the event-sequential or chronological schedule 14 of the optimal parameter as described above is determined, the parameter is changed according to the schedule 14 and thus it is possible to constantly optimize the parameter according to the state of the machine such as the driven members, the axis and the like. It is not necessary to perform control with the FB.

[0040] Hence, in the servo controller 10 of the present embodiment, it is possible to enhance the accuracy of machining of the machine tool (enhance the accuracy of operation of the industrial machine) and to perform time reduction (enhance yields).

[0041] Here, preferably, the state value derivation unit 11 derives the chronological or event-sequential data of inertia of the driven member or derives the chronological or event-sequential data of the position of the axis of the machine tool or the like. Although in FIG. 1, the parameters (coefficient) and K (gain) of the velocity loop (velocity gain) are changed so as to correspond to the gain schedule, the parameter of the position loop (position gain) may be changed, and the parameters of the feedforward gain, the filter frequency and the acceleration/deceleration time constant after interpolation may be changed based on the result of the derivation of the state value derivation unit 11. When the chronological or event-sequential data of inertia of the driven member is derived, a schedule for changing the velocity gain of the parameter can be produced whereas when the chronological or event-sequential data of the position of the axis is derived, a schedule for changing the filter frequency and the time constant can be produced. Then, even in the cases described above, it is possible to obtain the same operational effects as described above.

[0042] Although the embodiment of the servo controller has been described above, the present invention is not limited to the embodiment described above, and can be changed as necessary without departing from the spirit thereof.

EXPLANATION OF REFERENCE NUMERALS

[0043] 1: control system of machine tool (industrial machine) [0044] 2: CAD [0045] 3: machining program production unit (operation program production unit) [0046] 4: machining simulator unit (operation simulator unit) [0047] 5: CAM [0048] 6: CNC [0049] 7: servo motor (drive unit) [0050] 8: motor control unit [0051] 9: machining plan information (operation plan information) [0052] 10: servo controller [0053] 11: state value derivation unit [0054] 12: parameter change unit