# Patent

## Title
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 ωr1 of a structure composed of a table, a rotor of a drive motor, and an object and a second resonance frequency ω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 ωr1 and setting a frequency band to be removed for a second damping filter based on the second resonance frequency ωr2.

## Background
BACKGROUND
Field of the Disclosure
The present disclosure relates to a setting method and a setting apparatus for setting a frequency band to be removed for a damping filter provided in a positioning apparatus that controls a drive motor of a rotary table device including a base, a table which is rotatably held by the base and on which an object is to be placed, and the drive motor which rotates the table with respect to the base, as well as a positioning apparatus provided with the setting apparatus.
Background of the Disclosure
For example, in the field of machine tool, the above-described positioning apparatus has been generally used for positioning control of a feed device or a rotary table. A known example of such a positioning apparatus is the one disclosed in Japanese Unexamined Patent Application Publication No. 2009-101444, which controls a biaxial unit having a trunnion structure, which is provided on a machine tool such as a 5-axis control vertical machining center. The positioning apparatus includes a function generator, a position controller, a speed controller, and a torque/current controller, and controls a motor rotating the trunnion in accordance with a signal output from the torque/current controller.
Specifically, in this positioning apparatus, a position command is generated based on an NC command output from an NC device by the function generator, a speed command is generated based on the generated position command and a position gain by the position controller, a torque command is generated based on the generated speed command and a speed gain by the speed controller, a drive torque signal is generated based on the generated torque command and a torque gain by the torque/current controller, and a current corresponding to the signal is supplied to the motor, whereby the motor is driven.
Further, the positioning apparatus has an angle error estimator provided therein which calculates an angle error caused by elastic deformation of the trunnion and compensates for the angle error; the angle error estimator calculates the angle error Δθ by the following equation:

Δθ=(Tm−Jm·α)/KθR, 

where Jm is an inertia of the turning shaft portion or the bearing, Tm is a torque command output from the speed controller, α is a rotational angular acceleration, and KθR is a torsional rigidity coefficient.

SUMMARY OF THE DISCLOSURE
By the way, in the above-described conventional positioning apparatus, when a position command is generated in the function generator, a rapid feed time constant is used in the case of rapid feed movement. Further, a position gain, a speed gain, and a torque gain are used in the position controller, the speed controller, and the torque/current controller, respectively. In order to achieve stable control, the control parameters such as the rapid feed time constant, the position gain, the speed gain, and the torque gain have to be set properly.
Further, although not disclosed in Japanese Unexamined Patent Application Publication No. 2009-101444, generally, a damping filter is provided between the speed controller and the torque/current controller, and the torque command output from the speed controller passes through the damping filter and thereby a vibration component in a specific frequency band is removed, and then the torque command is input into the torque/current controller. The frequency band to be removed that is set for the damping filter is also a control parameter, and this has to be set properly in order to achieve stable control.
Accordingly, the above-mentioned control parameters are hitherto determined in advance in accordance with machining specifications set for the machine tool, such as maximum size and maximum weight of workpiece, maximum machining load, etc., by the machine tool manufacturer so that appropriate machining is achieved.
However, in recent years, users have handled various workpieces having various materials and shapes, and this causes problems in the above-described positioning control. For example, when a user machines a workpiece having a very thin thickness, a problem occurs that the workpiece vibrates when being moved and this vibration (external disturbance vibration) vibrates the positioning control system.
In order to solve this problem, the frequency band to be removed by the damping filter, which is a parameter for removing external disturbance vibration, of the above-described control parameters has to be reset to a proper value corresponding to the handled workpiece. However, conventionally, when the frequency band to be removed by the damping filter is reset, there is no choice but to relying on a trail-and-error method, that is, a method in which the frequency band to be removed is changed little by little and the operation is tested. Therefore, there is a problem that the above-described problem cannot be solved quickly.
The present disclosure has been achieved in view of the above-described circumstances, and an object thereof is to provide a parameter setting method and a parameter setting apparatus for a positioning apparatus which allow the frequency band to be removed by the damping filter to be reset to a proper value corresponding to a handled object quickly without using a trial-and-error method, as well as a positioning apparatus provided with the parameter setting apparatus.
The present method disclosure, for solving the above-described problems, relates to 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 including:
calculating a first resonance frequency ωr1 [rad/s] of a structure composed of the table, a rotor of the drive motor, and the object and a second resonance frequency ωr2 [rad/s] of a structure composed of a stator of the drive motor and the base using equations:

ωr1=(Kj((1/Jr+Jt))+(1/Jj)))1⁄2, and

ωr2=(Ks((1/Jb)+(1/Js)))1⁄2; 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 ω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 ωr2.
Further, the present apparatus relates to 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 including:
a calculator calculating a first resonance frequency ωr1 of a structure composed of the table, a rotor of the drive motor, and the object and a second resonance frequency ωr2 of a structure composed of a stator of the drive motor and the base using the above equations; 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 ω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 ωr2 calculated by the calculator.
Note that, in the above equations, Jr is an inertia [kg·m2] of the rotor of the drive motor, Jt is an inertia [kg·m2] of the table, Jj is an inertia [kg·m2] of the object, Jb is an inertia [kg·m2] of the base, Js is an inertia [kg·m2] of the stator of the drive motor, Kj is a torsional rigidity [N·m/rad] of the object, and Ks is a torsional rigidity [N·m/rad] of the stator of the drive motor.
Further, this control parameter setting apparatus can carry out the control parameter setting method of the present disclosure appropriately. Specifically, in the control parameter setting apparatus, first, a first resonance frequency ωr1 of a structure composed of the table, the rotor of the drive motor, and the object and a second resonance frequency ωr2 of a structure composed of the stator of the drive motor and the base are calculated using the above equations by the calculator.
Although details will be described later, as for the rotary table device having the above-described structure, the first resonance frequency ωr1 and the second resonance frequency ωr2 can be derived using the above equations. The inertia Jr of the rotor and the inertia Js of the stator of the drive motor, the inertia Jt of the table, the inertia Jj of the object, the inertia h of the base, the torsional rigidity Kj of the object, and the torsional rigidity Ks of the stator of the drive motor can be calculated in advance based on design data. Therefore, the first resonance frequency ωr1 and the second resonance frequency ωr2 can be theoretically calculated without relying on the trial-and-error method.
Subsequently, in the setter, the frequency band to be removed by a first damping filter provided in the positioning apparatus is set based on the first resonance frequency ωr1 calculated by the calculator, that is, the frequency band to be removed by the first damping filter is set to have a predetermined width with the first resonance frequency ωr1 at the middle thereof and, similarly, the frequency band to be removed by a second damping filter provided in the positioning apparatus is set based on the second resonance frequency ωr2 calculated by the calculator, that is, the frequency band to be removed by the second damping filter is set to have a predetermined width with the second resonance frequency ωr2 at the middle thereof.
Thus, according to the present disclosure, the frequency band to be removed by the first damping filter for removing, from the control signal of the positioning apparatus, the first resonance (frequency ωr1) that occurs on the structure composed of the table, the rotor of the drive motor, and the object and the frequency band to be removed by the second damping filter for removing, from the control signal of the positioning apparatus, the second resonance (frequency ωr2) that occurs on the structure composed of the stator of the drive motor and the base can be theoretically set without relying on the conventional trial-and-error method. Therefore, the frequency bands to be removed can be set to proper values corresponding to the handled object quickly.
Further, according to the positioning apparatus provided with the above-described control parameter setting apparatus, the frequency bands to be removed by the damping filters thereof can be theoretically set without relying on the conventional trial-and-error method and can be set to proper values corresponding to the handled object quickly. Therefore, the rotary table device can be controlled properly corresponding to the handled object.
As described above, according to the present disclosure, the frequency band to be removed by the first damping filter for removing, from control signal of the positioning apparatus, the first resonance (frequency ωr1) that occurs on the structure composed of the table, the rotor of the drive motor, and the object and the frequency band to be removed by the second damping filter for removing, from the control signal of the positioning apparatus, the second resonance (frequency ωr2) that occurs on the structure composed of the stator of the drive motor and the base can be theoretically set without relying on the conventional trial-and-error method. Therefore, the frequency bands to be removed can be set to proper values corresponding to the handled object quickly.
Further, when this control parameter setting apparatus is provided in a positioning apparatus, the frequency bands to be removed by the damping filters of the positioning apparatus can be theoretically set without relying on the conventional trial-and-error method and can be set to proper values corresponding to the handled object quickly. Therefore, the rotary table device as the control target can be controlled properly corresponding to the handled object.



BRIEF DESCRIPTION OF THE DRAWINGS
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:
FIG. 1 is a block diagram showing a schematic configuration of a positioning apparatus according to an embodiment of the present disclosure;
FIG. 2 is a block diagram showing a parameter storage and a damping filter unit in the embodiment;
FIG. 3 is a schematic diagram showing a rotary table device to be controlled by the positioning apparatus in the embodiment;
FIG. 4 is a control block diagram of the rotary table device in the embodiment;
FIG. 5 is an explanatory illustration showing a vibration model of a two-inertia system;
FIG. 6 is a control block diagram of the vibration model of the two-inertia system; and
FIG. 7 is a control block diagram of the vibration model of the two-inertia system.



DETAILED DESCRIPTION
Specific embodiments of the present disclosure will be described below with reference to the drawings.
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.
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.
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 ω*.
The speed controller 3 executes a processing of generating a torque command Tm* 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 Tm*.
As shown in FIG. 2, the damping filter unit 4 includes n filters including at least two filters: a first filter F1 and a second filter F2; each filter is composed of a notch filter. The damping filter unit 4 receives input of the torque command Tm* 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 Tm* and outputting the torque command after removal Tmf*. 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.
The torque controller 5 receives input of the filtered torque command Tmf* output from the damping filter unit 4 and executes a processing of generating a drive torque signal Tm for a motor 12 of the rotary table device 10 based on the input torque command Tmf* as well as a torque gain and outputting the generated signal.
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 Fn, 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 Fn, 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.
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.
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 Tm* 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.
Subsequently, the generated torque command Tm* 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 Tm* and then the torque command after removal Tmf* is input into the torque controller 5. Subsequently, a drive torque signal Tm for the motor 12 is generated based on the torque command Tmf* and the torque gain in the torque controller 5, and a current corresponding to the drive torque signal Tm 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.
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)))1⁄2

ωr2=(Ks((1/Jb)+(1/Js)))1⁄2

Note that Jr is an inertia [kg·m2] of the rotor 14, Jt is an inertia [kg·m2] of the table 18, Jt is an inertia [kg·m2] of the workpiece 19, Jb is an inertia [kg·m2] of the table base 11, Js is an inertia [kg·m2] of the stator 13, Kj is a torsional rigidity [N·m/rad] of the workpiece 19, and Ks is a torsional rigidity [N·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 Jj and the torsional rigidity Kj of the workpiece 19, i.e., the inertia Jr of the rotor 14, the inertia Jt of the table 18, the inertia Jb of the table base 11, the inertia Js of the stator 13, and the torsional rigidity Ks 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.
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.
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.

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.

Such a two-inertia system model satisfies the equations based on the equation of motion for a rotating system:

J1(d2θ1/dt2)=T−TL, 

J2(d2θ2/dt2)=TL, and

TL=K(θ1−θ2).

When the Laplace transform is applied to these equations, the followings are obtained:

θ1=(T−TL)/(J1s2),

θ2=TL/(J2s2), and

TL=K(θ1−θ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.

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




  
    
      
        
          θ
          1
        
        =
        
          
            
              1
              
                s
                2
              
            
            ·
            
              
                
                  
                    J
                    2
                  
                  ⁢
                  
                    s
                    2
                  
                
                +
                K
              
              
                
                  
                    J
                    1
                  
                  ⁢
                  
                    J
                    2
                  
                  ⁢
                  
                    s
                    2
                  
                
                +
                
                  K
                  ⁡
                  
                    (
                    
                      
                        J
                        1
                      
                      +
                      
                        J
                        2
                      
                    
                    )
                  
                
              
            
          
          ⁢
          T
        
      
    
    
      
        [
        
          Equation
          ⁢
          
            
          
          ⁢
          1
        
        ]
      
    
  




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




  
    
      
        
          
        
        ⁢
        
          
            θ
            1
          
          =
          
            
              
                1
                
                  s
                  2
                
              
              ·
              
                1
                
                  J
                  1
                
              
              ·
              
                
                  
                    s
                    2
                  
                  +
                  
                    K
                    /
                    
                      J
                      2
                    
                  
                
                
                  
                    s
                    2
                  
                  +
                  
                    K
                    ⁡
                    
                      (
                      
                        
                          1
                          /
                          
                            J
                            1
                          
                        
                        +
                        
                          1
                          /
                          
                            J
                            2
                          
                        
                      
                      )
                    
                  
                
              
            
            ⁢
            T
          
        
      
    
    
      
        [
        
          Equation
          ⁢
          
            
          
          ⁢
          2
        
        ]
      
    
  
  
    
      
        
          θ
          1
        
        =
        
          
            
              1
              
                s
                2
              
            
            ·
            
              1
              
                J
                1
              
            
            ·
            
              
                K
                /
                
                  J
                  2
                
              
              
                K
                ⁡
                
                  (
                  
                    
                      1
                      /
                      
                        J
                        1
                      
                    
                    +
                    
                      1
                      /
                      
                        J
                        2
                      
                    
                  
                  )
                
              
            
            ·
            
              
                K
                ⁡
                
                  (
                  
                    
                      1
                      /
                      
                        J
                        1
                      
                    
                    +
                    
                      1
                      /
                      
                        J
                        2
                      
                    
                  
                  )
                
              
              
                
                  s
                  2
                
                +
                
                  K
                  ⁡
                  
                    (
                    
                      
                        1
                        /
                        
                          J
                          1
                        
                      
                      +
                      
                        1
                        /
                        
                          J
                          2
                        
                      
                    
                    )
                  
                
              
            
            ·
            
              
                
                  s
                  2
                
                +
                
                  K
                  /
                  
                    J
                    2
                  
                
              
              
                K
                /
                
                  J
                  2
                
              
            
          
          ⁢
          T
        
      
    
    
      
        [
        
          Equation
          ⁢
          
            
          
          ⁢
          3
        
        ]
      
    
  
  
    
      
        
          θ
          1
        
        =
        
          
            
              1
              
                s
                2
              
            
            ·
            
              1
              
                J
                1
              
            
            ·
            
              1
              
                
                  
                    J
                    2
                  
                  /
                  
                    J
                    1
                  
                
                +
                1
              
            
            ·
            
              
                
                  (
                  
                    
                      (
                      
                        K
                        ⁡
                        
                          (
                          
                            
                              1
                              /
                              
                                J
                                1
                              
                            
                            +
                            
                              1
                              /
                              
                                J
                                2
                              
                            
                          
                          )
                        
                      
                      )
                    
                    
                      1
                      /
                      2
                    
                  
                  )
                
                2
              
              
                
                  s
                  2
                
                +
                
                  
                    (
                    
                      
                        (
                        
                          K
                          ⁡
                          
                            (
                            
                              
                                1
                                /
                                
                                  J
                                  1
                                
                              
                              +
                              
                                1
                                /
                                
                                  J
                                  2
                                
                              
                            
                            )
                          
                        
                        )
                      
                      
                        1
                        /
                        2
                      
                    
                    )
                  
                  2
                
              
            
            ·
            
              
                
                  s
                  2
                
                +
                
                  
                    (
                    
                      
                        (
                        
                          K
                          /
                          
                            J
                            2
                          
                        
                        )
                      
                      
                        1
                        /
                        2
                      
                    
                    )
                  
                  2
                
              
              
                
                  (
                  
                    
                      (
                      
                        K
                        /
                        
                          J
                          2
                        
                      
                      )
                    
                    
                      1
                      /
                      2
                    
                  
                  )
                
                2
              
            
          
          ⁢
          T
        
      
    
    
      
        [
        
          Equation
          ⁢
          
            
          
          ⁢
          4
        
        ]
      
    
  




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.




  
    
      
        
          θ
          1
        
        =
        
          
            
              1
              
                
                  (
                  
                    
                      J
                      1
                    
                    +
                    
                      J
                      2
                    
                  
                  )
                
                ⁢
                
                  s
                  2
                
              
            
            ·
            
              
                ω
                r
                2
              
              
                
                  s
                  2
                
                +
                
                  ω
                  r
                  2
                
              
            
            ·
            
              
                
                  s
                  2
                
                +
                
                  ω
                  a
                  2
                
              
              
                ω
                a
                2
              
            
          
          ⁢
          T
        
      
    
    
      
        [
        
          Equation
          ⁢
          
            
          
          ⁢
          5
        
        ]
      
    
  




In Equation 5, ωr is a resonance frequency [rad/s], ωa is an anti-resonance frequency [rad/s], and these are represented as follows:

ωr=(K((1/J1)+(1/J2)))1/2, and

ωa=(K/J2)1/2.

“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.
Thus, in the vibration model of the two-inertia system, the resonance frequency ωr can be calculated from the above equation.
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)))1⁄2.

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)))1⁄2.

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 ω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 ω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.
Subsequently, in the setter 7b, the frequency band to be removed by the first filter F1 is set based on the first resonance frequency ωr1 calculated by the calculator 7a, that is, the frequency band to be removed by the first filter F1 is set to have a predetermined width with the first resonance frequency ωr1 at the middle thereof, and, similarly, the frequency band to be removed by the second filter F2 is set to have a predetermined width with the second resonance frequency ω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.
Thus, according to the parameter setter 7 in this example, the frequency band to be removed by the first filter F1 for removing the first resonance (frequency ωr1) occurring on the upper structure from the control signal (the torque command Tm* output from the speed controller 3) and the frequency band to be removed by the second filter F2 for removing the second resonance (frequency ωr2) occurring on the lower structure from the control signal (the torque command Tm* 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.
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 F1 and the second filter F2 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 F1 and the second resonance component occurring on the lower structure is removed from the control signal by the second filter F2; 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.
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.

## 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 ωr1 of a structure composed of the table, a rotor of the drive motor, and the object and a second resonance frequency ωr2 of a structure composed of a stator of the drive motor and the base using equations:


ωr1=(Kj((1/Jr+Jt))+(1/Jj)))1/2, and



ωr2=(Ks((1/Jb)+(1/Js)))1/2,



where Jr is an inertia of the rotor of the drive motor, Jt is an inertia of the table, Jj is an inertia of the object, h is an inertia of the base, Js is an inertia of the stator of the drive motor, Kj is a torsional rigidity of the object, and Ks 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 ω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 ω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 ωr1 of a structure composed of the table, a rotor of the drive motor, and the object and a second resonance frequency ωr2 of a structure composed of a stator of the drive motor and the base using equations:


ωr1=(Kj((1/Jr+Jt))+(1/Jj)))1/2, and



ωr2=(Ks((1/Jb)+(1/Js)))1/2,



where Jr is an inertia of the rotor of the drive motor, Jt is an inertia of the table, Jj is an inertia of the object, Jb is an inertia of the base, Js is an inertia of the stator of the drive motor, Kj is a torsional rigidity of the object, and Ks 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 ω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 ω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.