Parameter setting method and parameter setting apparatus for positioning apparatus, and positioning apparatus provided with the parameter setting apparatus

Abstract

A parameter setting apparatus includes a calculator calculating a first resonance frequency .sub.r1 of a structure composed of a table, a rotor of a drive motor, and an object and a second resonance frequency .sub.r2 of a structure composed of a stator of the drive motor and a base using equations given below, and a setter setting a frequency band to be removed for a first damping filter based on the calculated first resonance frequency .sub.r1 and setting a frequency band to be removed for a second damping filter based on the second resonance frequency .sub.r2.

Claims

1. A control parameter setting method for setting a frequency band to be removed for a damping filter provided in a positioning apparatus controlling a drive motor of a rotary table device, the rotary table device including a base, a table for placing an object thereon, the table being rotatably held by the base, and the drive motor rotating the table with respect to the base, the control parameter setting method comprising: calculating a first resonance frequency .sub.r1 of a structure composed of the table, a rotor of the drive motor, and the object and a second resonance frequency .sub.r2 of a structure composed of a stator of the drive motor and the base using equations:
.sub.r1=(K.sub.j((1/J.sub.r+J.sub.t))+(1/J.sub.j))).sup.1/2, and
.sub.r2=(K.sub.s((1/J.sub.b)+(1/J.sub.s))).sup.1/2, where J.sub.r is an inertia of the rotor of the drive motor, J.sub.t is an inertia of the table, J.sub.j is an inertia of the object, h is an inertia of the base, J.sub.s is an inertia of the stator of the drive motor, K.sub.j is a torsional rigidity of the object, and K.sub.s is a torsional rigidity of the stator of the drive motor; and setting the frequency band to be removed for a first damping filter provided in the positioning apparatus based on the calculated first resonance frequency .sub.r1 and setting the frequency band to be removed for a second damping filter provided in the positioning apparatus based on the calculated second resonance frequency .sub.r2.

2. A control parameter setting apparatus for setting a frequency band to be removed for a damping filter provided in a positioning apparatus controlling a drive motor of a rotary table device, the rotary table device including a base, a table for placing an object thereon, the table being rotatably held by the base, and the drive motor rotating the table with respect to the base, the control parameter setting apparatus comprising: a calculator calculating a first resonance frequency .sub.r1 of a structure composed of the table, a rotor of the drive motor, and the object and a second resonance frequency .sub.r2 of a structure composed of a stator of the drive motor and the base using equations:
.sub.r1=(K.sub.j((1/J.sub.r+J.sub.t))+(1/J.sub.j))).sup.1/2, and
.sub.r2=(K.sub.s((1/J.sub.b)+(1/J.sub.s))).sup.1/2, where J.sub.r is an inertia of the rotor of the drive motor, J.sub.t is an inertia of the table, J.sub.j is an inertia of the object, J.sub.b is an inertia of the base, J.sub.s is an inertia of the stator of the drive motor, K.sub.j is a torsional rigidity of the object, and K.sub.s is a torsional rigidity of the stator of the drive motor; and a setter setting the frequency band to be removed for a first damping filter provided in the positioning apparatus based on the first resonance frequency .sub.r1 calculated by the calculator and setting the frequency to be removed for a second damping filter provided in the positioning apparatus based on the second resonance frequency .sub.r2 calculated by the calculator.

3. The positioning apparatus controlling the drive motor, comprising: the first and second damping filters, and the control parameter setting apparatus of claim 2.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) For a more complete understanding of the disclosed methods and apparatus, reference should be made to the embodiment illustrated in greater detail on the accompanying drawings, wherein:

(2) FIG. 1 is a block diagram showing a schematic configuration of a positioning apparatus according to an embodiment of the present disclosure;

(3) FIG. 2 is a block diagram showing a parameter storage and a damping filter unit in the embodiment;

(4) FIG. 3 is a schematic diagram showing a rotary table device to be controlled by the positioning apparatus in the embodiment;

(5) FIG. 4 is a control block diagram of the rotary table device in the embodiment;

(6) FIG. 5 is an explanatory illustration showing a vibration model of a two-inertia system;

(7) FIG. 6 is a control block diagram of the vibration model of the two-inertia system; and

(8) FIG. 7 is a control block diagram of the vibration model of the two-inertia system.

DETAILED DESCRIPTION

(9) Specific embodiments of the present disclosure will be described below with reference to the drawings.

(10) Hereinafter, a specific embodiment of the present disclosure will be described with reference to the drawings. FIG. 1 is a block diagram showing a positioning apparatus according to an embodiment of the present disclosure, and FIG. 3 is a schematic diagram showing a model of a rotary table device to be controlled by the positioning apparatus. Note that FIG. 3 is a mere abstract conceptual diagram and does not show a specific structure of the rotary table device.

(11) As shown in FIG. 1, the positioning apparatus 1 in this embodiment includes a position controller 2, a speed controller 3, a damping filter unit 4, a torque controller 5, a differentiator 6, a parameter setter 7, and a parameter storage 8.

(12) The position controller 2 receives input of a position command *, which is, for example, generated in an NC processor and output therefrom, and executes a processing of generating a speed command * based on a deviation between the position command * and a present position signal output from a position detector 15 of the rotary table device 10, which will be described later, as well as a position gain and outputting the generated speed command *.

(13) The speed controller 3 executes a processing of generating a torque command T.sub.m* based on a deviation between the speed command *, which is input from the position controller 2 into the speed controller 3, and a present speed signal that is output from the position detector 15, differentiated by the differentiator 6, and then output from the differentiator 6, as well as a speed gain and outputting the generated torque command T.sub.m*.

(14) As shown in FIG. 2, the damping filter unit 4 includes n filters including at least two filters: a first filter F.sub.1 and a second filter F.sub.2; each filter is composed of a notch filter. The damping filter unit 4 receives input of the torque command T.sub.m* output from the speed controller 3 and executes a processing of removing a frequency component in a frequency band to be removed, which is set for each of the filters, from the input torque command T.sub.m* and outputting the torque command after removal T.sub.mf*. Note that the number of the notch filters is only required to be two or more and there is no limit to the number of the provided filters.

(15) The torque controller 5 receives input of the filtered torque command T.sub.mf* output from the damping filter unit 4 and executes a processing of generating a drive torque signal T.sub.m for a motor 12 of the rotary table device 10 based on the input torque command T.sub.mf* as well as a torque gain and outputting the generated signal.

(16) Further, the parameter storage 8 is a functional unit storing therein control parameters used in the positioning apparatus 1. The position gain, the speed gain, the frequency bands to be removed by the filters F.sub.n, and the torque gain are stored as control parameters in the parameter storage 8, and these control parameters are read out and used by the corresponding position controller 2, speed controller 3, filters F.sub.n, and torque controller 5, respectively. Note that these control parameters can be stored into the parameter storage 8 from the outside and the frequency bands to be removed are updated by the parameter setter 7. A specific processing in the parameter setter 7 will be described later.

(17) As shown in FIG. 3, the rotary table device 10 in this embodiment includes a table base 11 as the base, a table 18 disposed on the table base 11 and provided to be rotatable about a vertical axis of rotation, and the motor 12 that rotates the table 18 about the axis of rotation. The motor 12 is composed of a stator 13 fixed to the table base 11 and a rotor 14 arranged in the stator 13 in a state of being fixed to the table 18. Further, a rotational position of the rotor 14 with respect to the axis of rotation is detected by the position detector 15 that is composed of a part 17 provided on the lower surface of the rotor 14 and a part 16 provided on the stator 13 to face the part 17. Note that a jig or workpiece (hereinafter, simply referred to as workpiece) 19 as the object is attached to the table 18.

(18) Thus, according to this positioning apparatus 1, first, a speed command * is generated based on a deviation between the position command * input into the position controller 2 as appropriate and the present position signal as well as the position gain in the position controller 2, and then a torque command T.sub.m* is generated based on a deviation of the speed command * and the present speed signal as well as the speed gain in the speed controller 3.

(19) Subsequently, the generated torque command T.sub.m* passes through the damping filter unit 4, and thereby vibration components in the frequency bands to be removed set for the filters are removed from the torque command T.sub.m* and then the torque command after removal T.sub.mf* is input into the torque controller 5. Subsequently, a drive torque signal T.sub.m for the motor 12 is generated based on the torque command T.sub.mf* and the torque gain in the torque controller 5, and a current corresponding to the drive torque signal T.sub.m is supplied to the motor 12 and thereby the motor 12 is driven. Consequently, the table 18 is rotationally moved by the thus-controlled motor 12.

(20) The parameter setter 7 includes a calculator 7a calculating a first resonance frequency r1 of a structure composed of the table 18, the rotor 14 of the motor 12, and the workpiece 19 (hereinafter, referred to as upper structure) and a second resonance frequency r2 of a structure composed of the stator 13 of the motor 12 and the table base 11 (hereinafter, referred to as lower structure) using equations given below, and a setter 7b setting the frequency band to be removed for the first filter F1 based on the first resonance frequency r1 calculated by the calculator 7a and setting the frequency band to be removed for the second filter F2 based on the second resonance frequency r2 calculated by the calculator 7a.
r1=(Kj((1/Jr+Jt))+(1/Jj)))
r2=(Ks((1/Jb)+(1/Js)))

(21) Note that J.sub.r is an inertia [kg.Math.m.sup.2] of the rotor 14, J.sub.t is an inertia [kg.Math.m.sup.2] of the table 18, J.sub.t is an inertia [kg.Math.m.sup.2] of the workpiece 19, J.sub.b is an inertia [kg.Math.m.sup.2] of the table base 11, J.sub.s is an inertia [kg.Math.m.sup.2] of the stator 13, K.sub.j is a torsional rigidity [N.Math.m/rad] of the workpiece 19, and K.sub.s is a torsional rigidity [N.Math.m/rad] of the stator 13. These values can be calculated in advance based on design data and may be input into the calculator 7a from the outside as needed. Alternatively, the values except the inertia J.sub.j and the torsional rigidity K.sub.j of the workpiece 19, i.e., the inertia J.sub.r of the rotor 14, the inertia J.sub.t of the table 18, the inertia J.sub.b of the table base 11, the inertia J.sub.s of the stator 13, and the torsional rigidity K.sub.s of the stator 13 may be stored into the calculator 7a in advance and held in the calculator 7a because these values are specific to the rotary table device 10.

(22) The rotary table device 10 having the typical structure modeled in FIG. 3 has a structure in which the table base 11 and the table 18 are separated from each other, the stator 13 and the rotor 14 of the motor 12 are separated from each other, the table base 11 and the stator 13 are coupled to each other, the rotor 14 is coupled to the table 18, and the workpiece 19 is coupled to the table 18. Therefore, the rotary table device 10 having such a structure is recognized as a device consisting of two structures, i.e., the upper structure composed of the table 18, the rotor 14, and the workpiece 19 and the lower structure composed of the stator 13 and the table base 11. According to the study by the inventors, the control model of the rotary table device 10 can be represented as a block diagram as shown in FIG. 4.

(23) Each of the upper structure and the lower structure can be interpreted as a vibration model of a two-inertia system as shown in FIG. 5. That is, in the upper structure, the table 18 and the rotor 14 correspond to the rigid body 1 and the workpiece 19 corresponds to the rigid body 2. Therefore, the followings hold:
J1=Jr+Jt,
J2=Jj, and
K=Kj.

(24) On the other hand, in the lower structure, the table base 11 corresponds to the rigid body 1 and the stator 13 corresponds to the rigid body 2. Therefore, the followings hold:
J1=Jb,
J2=Js, and
K=Ks.

(25) Such a two-inertia system model satisfies the equations based on the equation of motion for a rotating system:
J1(d21/dt2)=TTL,
J2(d22/dt2)=TL, and
T.sub.L=K(.sub.1.sub.2).
When the Laplace transform is applied to these equations, the followings are obtained:
.sub.1=(TT.sub.L)/(J.sub.1s.sup.2),
.sub.2=T.sub.L/(J.sub.2s.sup.2), and
T.sub.L=K(.sub.1.sub.2).
Therefore, the two-inertia system model shown in FIG. 5 can be represented by a block diagram as shown in FIG. 6; therefore, as described above, the rotary table device 10 consisting of the upper structure and the lower structure can be represented as the block diagram shown in FIG. 4.

(26) When the relationship between 1 and T is derived from the above equations of 1, 2, and TL, Equation 1 below is derived.

(27) $\begin{matrix} _{1} = \frac{1}{s^{2}} .Math. \frac{J_{2} s^{2} + K}{J_{1} J_{2} s^{2} + K (J_{1} + J_{2})} T & [Equation 1] \end{matrix}$

(28) Equation 1 can be sequentially transformed into Equation 2, Equation 3, and Equation 4 below.

(29) $\begin{matrix} _{1} = \frac{1}{s^{2}} .Math. \frac{1}{J_{1}} .Math. \frac{s^{2} + K / J_{2}}{s^{2} + K (1 / J_{1} + 1 / J_{2})} T & [Equation 2] \\ _{1} = \frac{1}{s^{2}} .Math. \frac{1}{J_{1}} .Math. \frac{K / J_{2}}{K (1 / J_{1} + 1 / J_{2})} .Math. \frac{K (1 / J_{1} + 1 / J_{2})}{s^{2} + K (1 / J_{1} + 1 / J_{2})} .Math. \frac{s^{2} + K / J_{2}}{K / J_{2}} T & [Equation 3] \\ _{1} = \frac{1}{s^{2}} .Math. \frac{1}{J_{1}} .Math. \frac{1}{J_{2} / J_{1} + 1} .Math. \frac{{({(K (1 / J_{1} + 1 / J_{2}))}^{1 / 2})}^{2}}{s^{2} + {({(K (1 / J_{1} + 1 / J_{2}))}^{1 / 2})}^{2}} .Math. \frac{s^{2} + {({(K / J_{2})}^{1 / 2})}^{2}}{{({(K / J_{2})}^{1 / 2})}^{2}} T & [Equation 4] \end{matrix}$

(30) Equation 4 above can be eventually represented by Equation 5 below, and Equation 5 can be represented by a block diagram shown in FIG. 7.

(31) $\begin{matrix} _{1} = \frac{1}{(J_{1} + J_{2}) s^{2}} .Math. \frac{_{r}^{2}}{s^{2} +_{r}^{2}} .Math. \frac{s^{2} +_{a}^{2}}{_{a}^{2}} T & [Equation 5] \end{matrix}$

(32) In Equation 5, .sub.r is a resonance frequency [rad/s], .sub.a is an anti-resonance frequency [rad/s], and these are represented as follows:
.sub.r=(K((1/J.sub.1)+(1/J.sub.2))).sup.1/2, and
.sub.a=(K/J.sub.2).sup.1/2.

(33) 1/(J1+J2)s2, r2/(s2+r2), and (s2+a2)/a2 in Equation 5 are terms representing the rigid-body part, the resonance part, and the anti-resonance part, respectively.

(34) Thus, in the vibration model of the two-inertia system, the resonance frequency r can be calculated from the above equation.

(35) Accordingly, when the resonance frequency of the above-described upper structure in this embodiment, i.e., the first resonance frequency, is represented by r1, since J1=Jr+Jt, J2=Jj, and K=Kj as described above, this r1 can be calculated by the following equation:
r1=(Kj((1/Jr+Jt))+(1/Jj))).

(36) Similarly, when the resonance frequency of the lower structure, i.e., the second resonance frequency, is represented by r2, since J1=Jb, J2=Js, and K=Ks as described above, this r2 can be calculated by the following equation:
r2=(Ks((1/Jb)+(1/Js))).

(37) Based on this inventors' finding, the parameter setter 7 in this embodiment, as described above, has a configuration in which the calculator 7a calculates the first resonance frequency .sub.r1 of the structure composed of the table 18, the rotor 14 of the motor 12, and the workpiece 19 (i.e., the upper structure) and the second resonance frequency .sub.r2 of the structure composed of the stator 13 of the motor 12 and the table base 11 (i.e., the lower structure) using the above equations.

(38) Subsequently, in the setter 7b, the frequency band to be removed by the first filter F.sub.1 is set based on the first resonance frequency .sub.r1 calculated by the calculator 7a, that is, the frequency band to be removed by the first filter F.sub.1 is set to have a predetermined width with the first resonance frequency .sub.r1 at the middle thereof, and, similarly, the frequency band to be removed by the second filter F.sub.2 is set to have a predetermined width with the second resonance frequency .sub.r2 at the middle thereof. Subsequently, data on the set frequency bands to be removed by the filters is stored into the parameter storage 8, in other words, the existing data stored in the parameter storage 8 is replaced and updated with the data on the set frequency bands to be removed.

(39) Thus, according to the parameter setter 7 in this example, the frequency band to be removed by the first filter F.sub.1 for removing the first resonance (frequency .sub.r1) occurring on the upper structure from the control signal (the torque command T.sub.m* output from the speed controller 3) and the frequency band to be removed by the second filter F.sub.2 for removing the second resonance (frequency .sub.r2) occurring on the lower structure from the control signal (the torque command T.sub.m* output from the speed controller 3) can be theoretically set without relying on the conventional trial-and-error method. Therefore, they can be set to proper values corresponding to a handled object, that is, the workpiece (jig, workpiece, or the like) 19 quickly.

(40) According to the positioning apparatus 1 in this embodiment that includes the parameter setter 7, the frequency bands to be removed by the first filter F.sub.1 and the second filter F.sub.2 can be theoretically set without relying on the conventional trial-and-error method and can be set to proper values corresponding to the handled workpiece 19 quickly. Therefore, the rotary table device 10 as the control target can be controlled properly corresponding to the handled workpiece 19. That is, the first resonance component occurring on the upper structure is removed from the control signal by the first filter F.sub.1 and the second resonance component occurring on the lower structure is removed from the control signal by the second filter F.sub.2; therefore, control in the positioning apparatus 1 can be stabilized. In particular, the first resonance component occurring on the upper structure depends on the handled workpiece 19; it is possible to properly remove the first resonance component corresponding to the workpiece 19 from the control signal.

(41) One embodiment of the present disclosure has been described above; however, the present disclosure is not limited thereto and can be implemented in other modes.

Parameter setting method and parameter setting apparatus for positioning apparatus, and positioning apparatus provided with the parameter setting apparatus

Assignee

Inventors

Cpc classification

Classification Explorer

G05B2219/50047

PHYSICS

Classification Explorer

G05B5/01

PHYSICS

Classification Explorer

G05B19/404

PHYSICS

Classification Explorer

G05B2219/41166

PHYSICS

International classification

Classification Explorer

G05B5/01

PHYSICS

Abstract

Claims

Description