# Patent

## Title
Numerical control device having function of calculating frequency characteristic of control loop

## Abstract

A numerical control device wherein a sinusoidal signal generated by a sine wave generation part is input by a control loop excitation part to a control loop of the control object, the input signal input to the control loop and the output signal from the control object are sampled by the data acquisition part periodically, and the sampling data is used by the frequency characteristic calculation part to calculate the frequency characteristic of the control loop to control the control object, wherein the frequency characteristic calculation part uses data obtained by inputting a sinusoidal signal obtained by shifting an initial phase of the sinusoidal signal by a phase shift part provided at a sine wave generation part by exactly a certain amount to the control loop a plurality of times to calculate the frequency characteristic of the control loop to thereby improve the measurement precision regardless of the sampling frequency.

## Background
RELATED APPLICATIONS
The present application claims priority to Japanese Application Number 2014-032121, filed Feb. 21, 2014, the disclosure of which is hereby incorporated by reference herein in its entirety.
BACKGROUND OF THE INVENTION
1. Field of the Invention
The present invention relates to a numerical control device which has the function of inputting a sinusoidal signal to a control loop of a numerical control device which controls a control object so as to calculate a frequency characteristic of the control loop of the numerical control device.
2. Description of the Related Art
In the past, a numerical control device which uses numerical values to control a machine tool which machines a workpiece has been known. A machine tool, for example, cuts, planes, drills, mills, grinds, or otherwise machines a workpiece and usually has built-in motors. Therefore, a motor control device which controls a motor of a machine tool by numerical values is a numerical control device in which the control object is a motor.
In a machine tool which uses a motor, the practice has been to measure the frequency characteristic (frequency response) of the motor which is connected to a load for the purpose of analysis of machine resonance as an inhibitory factor for improvement of characteristics and analysis of the response and stability of control. When measuring the frequency characteristic of a motor, the servo analyzer inputs a speed command of a sine wave into the numerical control device of the motor to which the load is connected while gradually raising the frequency. Further, a servo analyzer compares a motor speed which is obtained from a speed detector of the motor with a speed command and analyzes an amplitude ratio and phase difference. The results of measurement obtained by analysis of this servo analyzer is generally displayed as a Bode plot.
In this regard, with the method of inputting a sinusoidal signal to a speed loop of a numerical control device and calculating the frequency characteristic of the speed loop from the relationship of the input and the output, it is necessary to make the frequency gradually rise in the measurement band while performing the measurement, so there was the problem of a long measurement time. Therefore, a control device of a motor which excites the speed loop by white noise which includes the entire frequency of the speed loop and thereby eliminates the trouble of changing the frequency and enables measurement of the frequency characteristic in a short time is disclosed in Japanese Patent Publication No. 2000-278990A.
However, the control device of the motor which is disclosed in PLT 1 uses white noise as the signal which is input to the speed loop. Waveform changes in white noise depending on the generating pattern, so there is the issue that it is difficult to improve the measurement precision in the high frequency region.
SUMMARY OF INVENTION
In one aspect, the present invention has as its object the provision of a numerical control device which has the function of calculating the frequency characteristic of a control loop and which can improve the measurement precision in a high frequency region.
According to one aspect of the present invention, there is provided a numerical control device which controls at least one control object which comprises a sine wave generation part which generates a sinusoidal signal, a control loop excitation part which inputs a sinusoidal signal which is output from the sine wave generation part to a control loop of the control object, a data acquisition part which samples an input signal which is input to the control loop and an output signal which the control object outputs at a certain period, a frequency characteristic calculation part which uses sampling data of the input signal and output signal to calculate the frequency characteristic of the control loop, and a phase shift part which shifts the phase of the sinusoidal signal, wherein the numerical control device uses data obtained by inputting a sinusoidal signal having a predetermined phase as an initial phase and a sinusoidal signal having the initial phase shifted by exactly a certain amount to the control loop a plurality of times to enable the frequency characteristic calculation part to calculate the frequency characteristic of the control loop.
According to a numerical control device of one aspect of the present invention, it is possible to input a signal of the same frequency but having a phase shifted from the initial phase a plurality of times and use sampling data of the same to secure two points or more of sampling data in 1 period and improve the measurement precision in the high frequency region.



BRIEF DESCRIPTION OF DRAWINGS
The present invention will be understood more clearly by referring to the following attached drawings.
FIG. 1A is a block diagram of a numerical control device of the comparative art which controls a control object.
FIG. 1B is a waveform diagram of a sinusoidal signal which a sine wave generation part of the numerical control device which is shown in FIG. 1A generates.
FIG. 2A is an explanatory view which shows a routine by which the numerical control device which is shown in FIG. 1A calculates a frequency response of a control loop.
FIG. 2B is a waveform diagram which explains the problem in the numerical control device which is shown in FIG. 1A.
FIG. 3 is a block diagram of an embodiment of a numerical control device of the present invention.
FIG. 4A is an explanatory view which shows a routine by which the numerical control device of the present invention calculates a frequency response of a control loop.
FIG. 4B is a view which shows an equation which shows an input signal which is shown in FIG. 4A.
FIG. 4C is a view which shows an equation which shows an output signal which is shown in FIG. 4A.
FIG. 5A is a waveform diagram which shows a sinusoidal signal which has the initial phase which is output from the sine wave generation part which is shown in FIG. 3 as an initial phase and sampling points.
FIG. 5B is a waveform diagram which shows a sinusoidal signal which is shifted by 2⁄3π from the initial phase which is output from the sine wave generation part which is shown in FIG. 3 and sampling points.
FIG. 5C is a waveform diagram which shows a sinusoidal signal which is shifted by −2⁄3π from the initial phase which is output from the sine wave generation part which is shown in FIG. 3 and sampling points.
FIG. 5D is a waveform diagram which shows sampling points in a sine wave of the same frequency which is acquired by the data acquisition part which is shown in FIG. 3.
FIG. 6 is a flow chart which shows an operation of the numerical control device which is shown in FIG. 3.
FIG. 7A is a waveform diagram which shows the frequency characteristic when the numerical control device which is shown in FIG. 3 inputs a sinusoidal signal having a predetermined phase as the initial phase to the control loop just once without shifting.
FIG. 7B is a waveform diagram which shows the frequency characteristic when the numerical control device which is shown in FIG. 3 inputs a sinusoidal signal having a predetermined phase as the initial phase and a sinusoidal signal which shifts the initial phase two times by 2⁄3π each to the control loop.



DETAILED DESCRIPTION
Below, referring to the drawings, a numerical control device which has the function of calculating a frequency characteristic of a control loop will be explained. However, it will be understood that the present invention is not limited to the drawings or the embodiments explained below. In the figures, the same component elements are assigned the same reference notations.
Here, before explaining embodiments of the present invention, the method of calculating the frequency characteristic in a numerical control device up to now will be explained using FIG. 1A to FIG. 2B.
FIG. 1A is a block diagram which shows one example of a numerical control device 1 of the comparative art which controls a control object 3. The numerical control device 1 of this example controls a single control object 3, but there may also be a plurality of control objects 3. The numerical control device 1 is provided with a control loop 2. A control loop 2 outputs a signal from an output signal line 20 to control the control object 3 and returns an output signal of the control object 3 as a feedback signal through a feedback signal line 21 to the control loop 2.
Further, the numerical control device 1 is provided with parts for calculating the frequency characteristic of control object 3 such as a sine wave generation part 11, control loop excitation part 12, data acquisition part 13, and frequency characteristic calculation part 14. The sine wave generation part 11 can generate a sine wave of different frequencies. The control loop excitation part 12 is provided in the middle of the feedback signal line 21. It inputs a sinusoidal signal which is sent from the sine wave generation part 11 through the circuit 22 to the feedback signal line 21 to excite the control loop 2. The data acquisition part 13 receives as input a sinusoidal signal from the sine wave generation part 11 through a branch circuit 23 of the circuit 22 and receives as input the output signal of the control object 3 through a branch signal line 24 of the feedback signal line 21. The data acquisition part 13 is connected by an output circuit 25 to the frequency characteristic calculation part 14.
Here, a routine for calculating the frequency response (frequency characteristic) of the control loop 2 in the numerical control device 1 which is shown in FIG. 1A and expressing it as a Bode plot will be explained using FIG. 2A. The routine for calculating the frequency characteristic of the control loop 2 and expressing it as a Bode plot is provided with the following steps (1) to (5).
(1) First, an input signal U(t) of the frequency f(ω=2πf) which was generated by the sine wave generation part is input to the control loop 2.
(2) Next, the input signal U(t) and an output signal Y(t) which is output from the control object 3 when this input signal U(t) is input to the control loop 2 are sampled every sampling period Δt by the data acquisition part and input to the frequency characteristic calculation part 14.
(3) In the frequency characteristic calculation part 14, the inputted input signal U(kΔt) and output signal Y(kΔt) are transformed by a Fourier transform to the functions U(ω) and Y(ω) of the frequency region ω.
(4) After this, the frequency characteristic calculation part 14 calculates an amplitude ratio |Y(ω)/U(ω)| and a phase difference ψ from the input signal U(ω) and the output signal Y(ω).
(5) In the numerical control device 1, the processing from (1) to (4) is repeated while changing the frequency f(ω=2πf) of the input signal U(t) which is input from the sine wave generation part to the control loop 2. The frequency characteristic calculation part 14 prepares a Bode plot from the amplitude ratio |Y(ω)/U(ω)| and the phase difference ψ for each frequency.
In this way, if inputting a sinusoidal signal to the control loop 2 and exciting the control loop 2 while gradually changing the frequency of the input signal from the minimum frequency to maximum frequency in the measurement region, a Bode plot can be prepared from the relationship of the input signal U(t) of the control loop 2 and the output signal Y(t) of the control object 3. Further, it is possible to analyze the frequency response of the control loop 2 based on the Bode plot and to adjust the parameters (integral gain, proportional gain, etc.) of the control loop 2 based on the results of analysis to give the desired frequency response.
Note that, when inputting a sinusoidal signal to the control loop 2 to excite it, as shown in FIG. 1B, the frequency “f” (ω=2πf) of the input signal is gradually increased for measurement. The frequency of the sine wave constituted by the input signal, as shown in FIG. 1B by the step-like solid line, is made to increase by a predetermined frequency every predetermined period of the sine wave. In the example which is shown in FIG. 1B, the frequency is made to increase 5 Hz at a time every 3 periods and 3 periods worth of data is acquired every frequency. The acquired 3 periods worth of data (input signal and output signal) is as explained above transformed by a Fourier transform. The absolute value of the amplitude ratio and phase delay at a predetermined frequency f(ω=2πf) are calculated.
FIG. 2B shows the sampling points when sampling the input signal of a sine wave of a frequency “f”=2000 Hz at a sampling frequency fs=4000 Hz (Δt=250 μs). When calculating the frequency characteristic of the control loop 2 in the numerical control device 1 which is shown in FIG. 1A, the input frequency “f” to the control loop 2 matches with the Nyquist frequency (fs/2). When the initial phase of the input signal is 0 deg, the sampled data always becomes 0, so the frequency characteristic at 2000 Hz cannot be evaluated.
Further, when the input signal includes a frequency component of the Nyquist frequency (fs/2) or more, sampling of two or more points per period is not possible, so it is not possible to reproduce an analog signal from a digital signal. For this reason, in the method of calculation of the frequency characteristic of the control loop 2 in numerical control device of the comparative art, it was not possible to precisely evaluate the frequency characteristic of the Nyquist frequency (fs/2) or higher high frequency region.
The present invention solves the problem of the method of calculation of the frequency characteristic of the control loop in the numerical control device of the comparative art. FIG. 3 shows one embodiment of the numerical control device 1A of the present invention by a block diagram. The numerical control device 1A of the present embodiment is provided with parts for calculating the frequency characteristic of the control loop 2 such as a sine wave generation part 11, control loop excitation part 12, data acquisition part 13, and frequency characteristic calculation part 14. The configurations and connections of these are the same as the numerical control device 1 of the comparative art explained in FIG. 1A except for the configuration of the sine wave generation part 11. The same component members are assigned the same reference notations and explanations thereof will be omitted. In this embodiment as well, the numerical control device 1A controls a single control object 3, but there may also be a plurality of control objects 3.
The numerical control device 1A of the present invention which is shown in FIG. 3 is provided with a phase shift part 10 at the sine wave generation part 11. This point differs from the numerical control device 1 of the comparative art which is shown in FIG. 1A. The phase shift part 10 can shift the phase of a sinusoidal signal of the same frequency from the initial phase by exactly a certain amount. For example, it can shift the sinusoidal signal from the initial phase by exactly 2π/n (“n” is an integer) at a time. The value of “n” can be made for example 3. Note that, in the present embodiment, the phase shift part 10 is built into the sine wave generation part 11, but the phase shift part 10 can also be provided outside of the sine wave generation part 11.
Further, by inputting a sinusoidal signal shifted from the initial phase by exactly a certain amount (for example, 2π/n at a time) to the control loop 2 “k” number of times, it is possible to sample at least “k” number of points per 1 period, so it is possible to precisely calculate the frequency characteristic even with a high frequency or short time measurement. Here, the series of steps of the flow until calculation of the amplitude ratio |Y(jω)/U(jω)| and the phase difference ψ from the input signal when inputting a sinusoidal signal of the amplitude A and frequency f(ω=2πf) shifted from the initial phase by 2π/3 each to the control loop 2 three times and the output signals which are output from the control object 3 will be explained using FIG. 4A. Further, the calculation formulas of the real component Rω and the imaginary component Iω are shown in formula 1 and formula 2.
FIG. 4A shows the routine for the numerical control device 1A of the present invention to calculate the frequency response of the control loop 2. In the numerical control device 1A, first, the input signal U(t) which has the frequency f(ω=2πf) and a predetermined phase as the initial phase and which was generated at the sine wave generation part 11 is input to the control loop 2. Further, the sampled input signal U(kΔt) and output signal Y(kΔt) of the input signal U(t) and the output signal Y(t) which is output from the control object 3 when the input signal U(t) is input to the control loop 2 are input to the frequency characteristic calculation part 14.
Next, an input signal U(t−2⁄3×π/ω) of the same frequency “f” but shifted in phase from the initial phase by 2⁄3π is input to the control loop 2. Further, the sampled input signal U(kΔt−2⁄3×π/ω) and output signal Y(kΔt−2⁄3×π/ω) of the input signal U(t−2⁄3×π/ω) and the output signal Y(t−2⁄3×π/ω) which is output from the control object 3 when the input signal U(t−2⁄3×π/ω) is input to the control loop 2 are input to the frequency characteristic calculation part 14.
Furthermore, an input signal U(t+2⁄3×π/ω) which has the same frequency “f” but has a phase which is shifted from the initial phase by −2⁄3π is input to the control loop 2. Further, the sampled input signal U(kΔt+2⁄3×π/ω) and output signal Y(kΔt+2⁄3×π/ω) of the input signal U(t+2⁄3×π/ω) and the output signal Y(t+2⁄3×π/ω) which is output from the control object 3 when the input signal U(t+2⁄3×π/ω) is input to the control loop 2 are input to the frequency characteristic calculation part 14.
The detailed calculation formulas of the input signals U(kΔt), U(kΔt−2⁄3×π/ω), and U(kΔt+2⁄3×π/ω) which are input to the frequency characteristic calculation part 14 and the output signals Y(kΔt), Y(kΔt−2⁄3×π/ω), and Y(kΔt+2⁄3×π/ω) are shown in FIG. 4B and FIG. 4C.
The sampled input signals U(kΔt), U(kΔt−2⁄3×π/ω), and U(kΔt+2⁄3×π/ω) and output signals Y(kΔt), Y(kΔt−2⁄3×π/ω), and Y(kΔt+2⁄3×π/ω) are transformed at the frequency characteristic calculation part 14 by Fourier transforms.
Here, if making the input signal U(s) and making the output signal Y(s), the transfer function G(s) is expressed by formula 1.

G(s)=Y(s)/U(s)=L[Y(t)]/L[U(t)]  (1)

Further, if entering s=jω into formula 1, the denominator and numerator are expressed by complex numbers as shown in formula 2.

G(s)=Y(jω)/U(jω)=(x2+j·y2)/(x1+j·y1)  (2)

The numerator and the denominator become values at the time of transformation of the input signal U(t) and the output signal Y(t) by Fourier transforms at f=ω/2π, so it will be understood that the following formula 3, formula 4, formula 5, and formula 6 correspond to x1, y1, x2, and y2.




  
    
      
        
          x
          1
        
        =
        
          
            1
            N
          
          ⁢
          
            
              ∑
              
                k
                =
                0
              
              
                N
                -
                1
              
            
            ⁢
            
              
            
            ⁢
            
              (
              
                
                  
                    
                      
                        
                          U
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              +
                              φ
                            
                            )
                          
                        
                        ·
                        
                          cos
                          ⁡
                          
                            (
                            
                              ω
                              ⁢
                              
                                
                              
                              ⁢
                              k
                              ⁢
                              
                                
                              
                              ⁢
                              Δ
                              ⁢
                              
                                
                              
                              ⁢
                              t
                            
                            )
                          
                        
                      
                      +
                      
                        
                          U
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              -
                              
                                
                                  2
                                  3
                                
                                ⁢
                                
                                  π
                                  ·
                                  
                                    1
                                    ω
                                  
                                
                              
                              +
                              φ
                            
                            )
                          
                        
                        ·
                      
                    
                  
                
                
                  
                    
                      
                        cos
                        ⁢
                        
                          
                        
                        ⁢
                        
                          ω
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              -
                              
                                
                                  2
                                  3
                                
                                ⁢
                                
                                  π
                                  ·
                                  
                                    1
                                    ω
                                  
                                
                              
                            
                            )
                          
                        
                      
                      +
                      
                        
                          U
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              +
                              
                                
                                  2
                                  3
                                
                                ⁢
                                
                                  π
                                  ·
                                  
                                    1
                                    ω
                                  
                                
                              
                              +
                              φ
                            
                            )
                          
                        
                        ·
                      
                    
                  
                
                
                  
                    
                      cos
                      ⁢
                      
                        
                      
                      ⁢
                      
                        ω
                        ⁡
                        
                          (
                          
                            
                              k
                              ⁢
                              
                                
                              
                              ⁢
                              Δ
                              ⁢
                              
                                
                              
                              ⁢
                              t
                            
                            +
                            
                              
                                2
                                3
                              
                              ⁢
                              
                                π
                                ·
                                
                                  1
                                  ω
                                
                              
                            
                          
                          )
                        
                      
                    
                  
                
              
              )
            
          
        
      
    
    
      
        (
        3
        )
      
    
  
  
    
      
        
          y
          1
        
        =
        
          
            1
            N
          
          ⁢
          
            
              ∑
              
                k
                =
                0
              
              
                N
                -
                1
              
            
            ⁢
            
              
            
            ⁢
            
              (
              
                
                  
                    
                      
                        
                          U
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              +
                              φ
                            
                            )
                          
                        
                        ·
                        
                          sin
                          ⁡
                          
                            (
                            
                              ω
                              ⁢
                              
                                
                              
                              ⁢
                              k
                              ⁢
                              
                                
                              
                              ⁢
                              Δ
                              ⁢
                              
                                
                              
                              ⁢
                              t
                            
                            )
                          
                        
                      
                      +
                      
                        
                          U
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              -
                              
                                
                                  2
                                  3
                                
                                ⁢
                                
                                  π
                                  ·
                                  
                                    1
                                    ω
                                  
                                
                              
                              +
                              φ
                            
                            )
                          
                        
                        ·
                      
                    
                  
                
                
                  
                    
                      
                        sin
                        ⁢
                        
                          
                        
                        ⁢
                        
                          ω
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              -
                              
                                
                                  2
                                  3
                                
                                ⁢
                                
                                  π
                                  ·
                                  
                                    1
                                    ω
                                  
                                
                              
                            
                            )
                          
                        
                      
                      +
                      
                        
                          U
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              +
                              
                                
                                  2
                                  3
                                
                                ⁢
                                
                                  π
                                  ·
                                  
                                    1
                                    ω
                                  
                                
                              
                              +
                              φ
                            
                            )
                          
                        
                        ·
                      
                    
                  
                
                
                  
                    
                      sin
                      ⁢
                      
                        
                      
                      ⁢
                      
                        ω
                        ⁡
                        
                          (
                          
                            
                              k
                              ⁢
                              
                                
                              
                              ⁢
                              Δ
                              ⁢
                              
                                
                              
                              ⁢
                              t
                            
                            +
                            
                              
                                2
                                3
                              
                              ⁢
                              
                                π
                                ·
                                
                                  1
                                  ω
                                
                              
                            
                          
                          )
                        
                      
                    
                  
                
              
              )
            
          
        
      
    
    
      
        (
        4
        )
      
    
  
  
    
      
        
          x
          2
        
        =
        
          
            1
            N
          
          ⁢
          
            
              ∑
              
                k
                =
                0
              
              
                N
                -
                1
              
            
            ⁢
            
              
            
            ⁢
            
              (
              
                
                  
                    
                      
                        
                          Y
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              +
                              φ
                            
                            )
                          
                        
                        ·
                        
                          cos
                          ⁡
                          
                            (
                            
                              ω
                              ⁢
                              
                                
                              
                              ⁢
                              k
                              ⁢
                              
                                
                              
                              ⁢
                              Δ
                              ⁢
                              
                                
                              
                              ⁢
                              t
                            
                            )
                          
                        
                      
                      +
                      
                        
                          Y
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              -
                              
                                
                                  2
                                  3
                                
                                ⁢
                                
                                  π
                                  ·
                                  
                                    1
                                    ω
                                  
                                
                              
                              +
                              φ
                            
                            )
                          
                        
                        ·
                      
                    
                  
                
                
                  
                    
                      
                        cos
                        ⁢
                        
                          
                        
                        ⁢
                        
                          ω
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              -
                              
                                
                                  2
                                  3
                                
                                ⁢
                                
                                  π
                                  ·
                                  
                                    1
                                    ω
                                  
                                
                              
                            
                            )
                          
                        
                      
                      +
                      
                        
                          Y
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              +
                              
                                
                                  2
                                  3
                                
                                ⁢
                                
                                  π
                                  ·
                                  
                                    1
                                    ω
                                  
                                
                              
                              +
                              φ
                            
                            )
                          
                        
                        ·
                      
                    
                  
                
                
                  
                    
                      cos
                      ⁢
                      
                        
                      
                      ⁢
                      
                        ω
                        ⁡
                        
                          (
                          
                            
                              k
                              ⁢
                              
                                
                              
                              ⁢
                              Δ
                              ⁢
                              
                                
                              
                              ⁢
                              t
                            
                            +
                            
                              
                                2
                                3
                              
                              ⁢
                              
                                π
                                ·
                                
                                  1
                                  ω
                                
                              
                            
                          
                          )
                        
                      
                    
                  
                
              
              )
            
          
        
      
    
    
      
        (
        5
        )
      
    
  
  
    
      
        
          y
          2
        
        =
        
          
            1
            N
          
          ⁢
          
            
              ∑
              
                k
                =
                0
              
              
                N
                -
                1
              
            
            ⁢
            
              
            
            ⁢
            
              (
              
                
                  
                    
                      
                        
                          Y
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              +
                              φ
                            
                            )
                          
                        
                        ·
                        
                          sin
                          ⁡
                          
                            (
                            
                              ω
                              ⁢
                              
                                
                              
                              ⁢
                              k
                              ⁢
                              
                                
                              
                              ⁢
                              Δ
                              ⁢
                              
                                
                              
                              ⁢
                              t
                            
                            )
                          
                        
                      
                      +
                      
                        
                          Y
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              -
                              
                                
                                  2
                                  3
                                
                                ⁢
                                
                                  π
                                  ·
                                  
                                    1
                                    ω
                                  
                                
                              
                              +
                              φ
                            
                            )
                          
                        
                        ·
                      
                    
                  
                
                
                  
                    
                      
                        sin
                        ⁢
                        
                          
                        
                        ⁢
                        
                          ω
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              -
                              
                                
                                  2
                                  3
                                
                                ⁢
                                
                                  π
                                  ·
                                  
                                    1
                                    ω
                                  
                                
                              
                            
                            )
                          
                        
                      
                      +
                      
                        
                          Y
                          ⁡
                          
                            (
                            
                              
                                k
                                ⁢
                                
                                  
                                
                                ⁢
                                Δ
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                              +
                              
                                
                                  2
                                  3
                                
                                ⁢
                                
                                  π
                                  ·
                                  
                                    1
                                    ω
                                  
                                
                              
                              +
                              φ
                            
                            )
                          
                        
                        ·
                      
                    
                  
                
                
                  
                    
                      sin
                      ⁢
                      
                        
                      
                      ⁢
                      
                        ω
                        ⁡
                        
                          (
                          
                            
                              k
                              ⁢
                              
                                
                              
                              ⁢
                              Δ
                              ⁢
                              
                                
                              
                              ⁢
                              t
                            
                            +
                            
                              
                                2
                                3
                              
                              ⁢
                              
                                π
                                ·
                                
                                  1
                                  ω
                                
                              
                            
                          
                          )
                        
                      
                    
                  
                
              
              )
            
          
        
      
    
    
      
        (
        6
        )
      
    
  




For this reason, the real component Rω and the imaginary component Iω can be found by entering formula 3, formula 4, formula 5, and formula 6 into formula 8 and formula 9 of the real part and imaginary part when rationalizing the denominator of formula 2.




  
    
      
        
          G
          ⁡
          
            (
            s
            )
          
        
        =
        
          
            
              Y
              ⁡
              
                (
                
                  j
                  ⁢
                  
                    
                  
                  ⁢
                  ω
                
                )
              
            
            
              U
              ⁡
              
                (
                
                  j
                  ⁢
                  
                    
                  
                  ⁢
                  ω
                
                )
              
            
          
          =
          
            
              
                
                  x
                  2
                
                +
                
                  j
                  ·
                  
                    y
                    2
                  
                
              
              
                
                  x
                  1
                
                +
                
                  j
                  ·
                  
                    y
                    1
                  
                
              
            
            =
            
              
                
                  
                    
                      x
                      1
                    
                    ·
                    
                      x
                      2
                    
                  
                  +
                  
                    
                      y
                      1
                    
                    ·
                    
                      y
                      2
                    
                  
                
                
                  
                    x
                    1
                    2
                  
                  +
                  
                    y
                    1
                    2
                  
                
              
              +
              
                j
                ·
                
                  
                    
                      
                        x
                        1
                      
                      ·
                      
                        y
                        2
                      
                    
                    -
                    
                      
                        x
                        2
                      
                      ·
                      
                        y
                        1
                      
                    
                  
                  
                    
                      x
                      1
                      2
                    
                    +
                    
                      y
                      1
                      2
                    
                  
                
              
            
          
        
      
    
    
      
        (
        7
        )
      
    
  
  
    
      
        
          
        
        ⁢
        
          
            R
            ω
          
          =
          
            
              
                
                  x
                  1
                
                ·
                
                  x
                  2
                
              
              +
              
                
                  y
                  1
                
                ·
                
                  y
                  2
                
              
            
            
              
                x
                1
                2
              
              +
              
                y
                1
                2
              
            
          
        
      
    
    
      
        (
        8
        )
      
    
  
  
    
      
        
          
        
        ⁢
        
          
            I
            ω
          
          =
          
            
              
                
                  x
                  1
                
                ·
                
                  y
                  2
                
              
              -
              
                
                  x
                  2
                
                ·
                
                  y
                  1
                
              
            
            
              
                x
                1
                2
              
              +
              
                y
                1
                2
              
            
          
        
      
    
    
      
        (
        9
        )
      
    
  




(Formula 3, formula 4, formula 5, and formula 6 can be entered into x1, y1, x2, and y2 respectively.)
Here, T is the measurement time, Δt is the sampling time, and N=T/Δt.
Further, the real component Rω and the imaginary component Iω can be entered into the following formula 10 and formula 11 to calculate the absolute value of the amplitude ratio and the phase delay.




  
    
      
        
          
          
            
              Y
              ⁡
              
                (
                ω
                )
              
            
            
              U
              ⁡
              
                (
                ω
                )
              
            
          
          
        
        =
        
          
            
              R
              ω
              2
            
            +
            
              I
              ω
              2
            
          
        
      
    
    
      
        (
        10
        )
      
    
  
  
    
      
        ψ
        =
        
          
            tan
            
              -
              1
            
          
          ⁡
          
            (
            
              -
              
                
                  I
                  ω
                
                
                  R
                  ω
                
              
            
            )
          
        
      
    
    
      
        (
        11
        )
      
    
  




FIG. 5A shows the sampling points when inputting a sinusoidal signal of a frequency f=2000 Hz as the input signal U(kΔt) to the control loop 2 and sampling the output signal Y(kΔt) from the control object 3 at fs=4000 Hz (Δt=250 μs). Further, FIG. 5B shows the sampling points when inputting a sinusoidal signal of the same frequency f=2000 Hz but shifted 2⁄3π from the initial phase as the input signal U(kΔt−2⁄3×π/ω) to the control loop 2 and sampling the output signal Y(kΔt−2⁄3×π/ω) from the control object 3 at fs=4000 Hz (Δt=250 μs). Furthermore, FIG. 5C shows the sampling points when inputting a sinusoidal signal of the same frequency f=2000 Hz but shifted −2⁄3π from the initial phase as the input signal U(kΔt+2⁄3×π/ω) to the control loop and sampling the output signal Y(kΔt+2⁄3×π/ω) from the control object 3 at fs=4000 Hz (Δt=250 μs).
If inputting an input signal of a sine wave having a predetermined phase as its initial phase and a plurality input signals of sine waves shifted from the initial phase to the control loop 2, the points of sampling the sine wave shaped output signals from the control object 3 will shift. For this reason, as shown in FIG. 5D, it is possible to sample data of different phases on a sine wave of the same frequency f=2000 Hz. By considering the sampling points after shifting in this way, the result becomes the same as when sampling data in most phases of the sinusoidal signal of the same frequency. As a result, as shown in FIG. 5A, it becomes possible to precisely measure the frequency characteristic when the frequency “f” of the input signal and the Nyquist frequency (fs/2) match or even with an input signal of the Nyquist frequency (fs/2) or more.
Here, the flow chart which is shown in FIG. 6 will be used to explain an embodiment of the operation of the numerical control device 1A which is shown in FIG. 3. At step 601, the sine wave generation part 11 generates a plurality of sinusoidal signals which are shifted from the initial phase by exactly a certain amount. The sinusoidal signals include a sinusoidal signal which has a predetermined phase as the initial phase. Further, a sinusoidal signal which is shifted by exactly a certain amount, as explained above, means a sinusoidal signal which is shifted in phase from the initial phase by 2⁄3π or a sinusoidal signal which is shifted in phase from the initial phase by −2⁄3π.
At the next step 602, the control loop excitation part 12 performs processing to input a sinusoidal signal to the control loop 2 a plurality of times. The “input a plurality of times”, for example, is processing where when the signals which the sine wave generation part 11 generates are the three types of the sinusoidal signal having a predetermined phase as the initial phase and sinusoidal signals having phases shifted from the initial phase by 2⁄3π and −2⁄3π, the three types of sinusoidal signals are respectively input to the control loop 2 a plurality of times of one time each. Note that, the three types of sinusoidal signals may be respectively input a plurality of times of two times or more each.
At the next step 603, the data acquisition part 13 acquires the sinusoidal signal which is input to the control loop 2 (input signal) and the output signal from the control object 3. The data acquisition part 13 acquires the three types of sinusoidal signals which are input to the control loop 2 of the sinusoidal signal having a predetermined phase as the initial phase and sinusoidal signals having phases shifted from the initial phase by 2⁄3π and −2⁄3π and the three types of output signals which are output from the control object 3 for the input signals of these three types of sinusoidal signals.
In the final step 604, the frequency characteristic calculation part 14 uses the input signal and the output signal to calculate the frequency characteristic of the control loop 2. The frequency characteristic calculation part 14 uses the three types of sinusoidal signals which are input to the control loop 2, that is, the sinusoidal signal which has the predetermined phase as an initial phase and the sinusoidal signals which have phases shifted from initial phase by 2⁄3π and −2⁄3π, and the three types of output signals which are output from the control object 3 corresponding to the input signals of the three types of sinusoidal signals to calculate the frequency characteristic of the control loop 2.
In this way, a comparison of the case of using the sinusoidal signal shifted from the initial phase by 2π/3 at a time to calculate the frequency characteristic of the control loop and the case of using only the sinusoidal signal not shifted from the initial phase to calculate the frequency characteristic of the control loop will be explained using FIG. 7A and FIG. 7B.
FIG. 7A is a Bode plot which shows the frequency characteristic when the numerical control device 1A which is shown in FIG. 3 inputs the sinusoidal signal having the predetermined phase as the initial phase to the control loop 2 exactly one time without shifting it. The sampling frequency fs was 4000 Hz, the Nyquist frequency fb (=fs/2) was 2000 Hz, and the frequency “f” of the input sinusoidal signal was made 10 to 3000 Hz. With the frequency characteristic at the time of inputting the sinusoidal signal having the predetermined phase as the initial phase to the control loop 2 just once without shifting, it is learned that the detection precision at the 1000 Hz or more high frequency region is no good.
FIG. 7B is a Bode plot which shows the frequency characteristic when the numerical control device 1A which is shown in FIG. 3 inputs the three types of sinusoidal signals of the sinusoidal signal having the predetermined phase as the initial phase and the two sinusoidal signals which shift the initial phase by 2⁄3π each to the control loop 2. In this case, the sinusoidal signal is input to the control loop 2 three times. The sampling frequency fs is 4000 Hz, the Nyquist frequency fb is 2000 Hz, and the frequency “f” of the input sinusoidal signal is 10 to 3000 Hz. When shifting the initial phase by 2π/3 each and inputting the sinusoidal signal three times, it is learned that the detection precision is improved in the high frequency region.
On the other hand, if comparing the Bode plots which show the frequency characteristics which are shown in FIG. 7A and FIG. 7B, when the frequency of the input signal is lower than 1000 Hz, it is learned that there is almost no difference between the case of inputting a sinusoidal signal one time to the control loop 2 and inputting it three times. That is, in the frequency region lower than the predetermined frequency, even if inputting the initial phase sinusoidal signal just one time, without shifting, to the control loop 2 to calculate the frequency characteristic or inputting the sinusoidal signal shifted in phase three times to calculate the frequency characteristic, it will be understood that similar measurement results can be obtained.
Therefore, when the frequency of the input signal is lower than a predetermined frequency (for example, Nyquist frequency), it is possible to input the initial phase sinusoidal signal just one time while not shifting it to the control loop 2 to calculate the frequency characteristic. Further, if the frequency of the input signal is higher than a predetermined frequency (for example, Nyquist frequency), a sinusoidal signal which is shifted from the initial phase by exactly a certain amount is input “k” number of times to the control loop to calculate the frequency characteristic. According to this method of calculation of the frequency characteristic, compared with the case of inputting a plurality of types of sinusoidal signals shifted in phase without regard as to the frequency of the input signal a plurality of times to the control loop 2, the signals are input a plurality of times for only the frequency required for the number of data points, so it becomes possible to measure the frequency characteristic in a short time.
Note that, in the above obtained embodiment, the case of inputting sinusoidal signals shifted from the initial phase by a certain amount (for example, 2π/n each) to the control loop “k” number of times to enable sampling of at least “k” number of points per 1 period was explained. In this case, if “n”=“k” and shifting the sinusoidal signal “n” number of times, the result becomes 1 period. However, for example, even if inputting a sinusoidal signal shifted by exactly π/2 two times, it is believed that effect of the present invention will be explained. In this case, “n”≠“k”, so the present invention includes the case where “n”≠“k” as well.
Above, the present invention will be explained with reference to preferred embodiments, but a person skilled in the art will understand that it can be modified and changed in various ways without departing from the scope of disclosure of the later explained claims.

## Claims

1. A numerical control device which controls at least one control object, the numerical control device comprising:
a sine wave generation part which generates a sinusoidal signal;
a control loop excitation part which inputs the sinusoidal signal which is output from said sine wave generation part to a control loop of said control object;
a data acquisition part which samples an input signal which is input to said control loop and an output signal which said control object outputs at a certain period;
a frequency characteristic calculation part which uses the sampling data of the input signal and output signal to calculate the frequency characteristic of said control loop; and
a phase shift part which shifts the phase of said sinusoidal signal,
wherein the numerical control device is configured to
perform an analysis of the frequency characteristic of the control loop calculated by the frequency characteristic calculation part, and
adjust parameters of the control loop based on a result of the analysis to control the control object, and

wherein the numerical control device is configured to obtain the sampling data of different phases on the sinusoidal signal by inputting
a base sinusoidal signal having, at a frequency, an initial phase and
at least one phase-shifted sinusoidal signal having, at said frequency, a phase shifted from the initial phase by a certain amount respectively, into said control loop a plurality of times to enable said frequency characteristic calculation part to calculate the frequency characteristic of said control loop.

2. The numerical control device according to claim 1, wherein
said phase shift part is configured to generate a sinusoidal signal which is shifted from the initial phase by exactly 2π/n at a time,
said control loop excitation part is configured to input the sinusoidal signal which is shifted from the initial phase by exactly 2π/n at a time to said control loop, and
said frequency characteristic calculation part is configured to use data which is input “k” number of times to said control loop to calculate the frequency characteristic of said control loop.

3. The numerical control device according to claim 1, wherein
said phase shift part is configured to generate “k” number of types of sinusoidal signals which are shifted from the initial phase by exactly 2π/n at a time,
said control loop excitation part is configured to input said “k” number of types of sinusoidal signals which are shifted from the initial phase by exactly 2π/n at a time one time each at said control loop, and
said frequency characteristic calculation part is configured to use the data which was input “k” number of times to said control loop to calculate the frequency characteristic of said control loop.

4. The numerical control device according to claim 3, wherein
said phase shift part is configured to generate a first phase-shifted sinusoidal signal which is shifted from the initial phase by 2π/3 and a second phase-shifted sinusoidal signal which is shifted by −2π/3,
said control loop excitation part is configured to input, into said control loop, three types of sinusoidal signals including
the base sinusoidal signal which has the initial phase,
the first phase-shifted sinusoidal signal where the initial phase is shifted by 2π/3, and
the second phase-shifted sinusoidal signal where the initial phase is shifted by −2π/3, and

said frequency characteristic calculation part is configured to use said three types of sinusoidal signals which are input to said control loop to calculate the frequency characteristic of said control loop.

5. The numerical control device according to claim 1, wherein
when the frequency of the input signal is lower than a predetermined frequency,
said control loop excitation part is configured to input the base sinusoidal signal having the initial phase exactly once to said control loop, and
said frequency characteristic calculation part is configured to use sampling data of the input signal and output signal to calculate the frequency characteristic of said control loop, and

when the frequency of the input signal is said predetermined frequency or more,
said control loop excitation part is configured to input, into said control loop, the base sinusoidal signal having the initial phase and a phase-shifted sinusoidal signal which is shifted from the initial phase a plurality of times, and
said frequency characteristic calculation part is configured to use sampling data of the plurality of input signals and the plurality of output signals corresponding to said plurality of input signals to calculate the frequency characteristic of said control loop.

6. The numerical control device according to claim 5, wherein said predetermined frequency is the Nyquist frequency.