Position control method and apparatus

Abstract: In a position control system having the force as manipulated variable and the position as con­ trolled variable, the negative feedback of the position and the velocity is performed, and the positive feedback of the acceleration is performed through the first order lap circuit or the positive feedback of the velocity through the quasi-­ differential circuit. By the combination of negative feedback and positive feedback, it is possible to stabilize the vibration characteristics of the mechanism, which tends to make the control system stable, and to achieve the position con­ trol with high gain, high response and high accuracy.

Description: The present invention relates to a position control method and apparatus having the force as manipulated variable and the position as controlled variable. In the position control system as shown in Fig. 1, a movable table 12, whose position is to be controlled precisely, is driven by a motor 11 through ball screw 15. The motor 11 is driven by a power amplifier 19, and the force "f" proportional to the force command "u", which is an input of the power amplifier 19, is applied on the movable table 12. On the movable table 12, a corner cube 14 and an accelerometer 13 are fixed. The position "x" of the movable table 12 is measured by the laser measuring machine 16 and corner cube 14, and the velocity "v" is obtained from the position "x", using velocity arithmetic circuit 17. Further, the acceleration "a" is measured by the accelerometer 13. The controller 18 uses the position command "r" and the position "x", the velocity "v" and the acceleration "a" as input and issues the force command "u" so that the position "x" follows the position command "r". In such position control system, the present invention proposes a position control method to define the composition of the controller 18. Suppose that, in the above position control system, the response of the motor 11 and the power amplifier 19 are sufficiently quick and linear. Then, the relation between the force "f" applied on the movable table 12 and the force command "u" outputted by the controller 18 is given by the following equation: f = K f u, where K f is a proportional constant. If the response of the position control system is slow and the mechanism (including the motor 11, ball screw 15 and movable table 12) is rigid body, the relation between the position "x" of the movable table 12 and the applied force "f" is obtained by: where M is the mass of the movable portion. This relation is given as block diagram in Fig. 2. Because this system is a quadratic system, the position "x" and the velocity "v" will suffice to express the quantity of state. It is known that the position control system with adequate characteristics can be composed by negative feedback of the position "x" and the velocity "v" as it is often practiced in the past. The control system is expressed by the following equation: u = Kv {Kp (r - x) - v} where Kp and Kv are the feedback gains. This relation is given in Fig. 3 as block diagram. In general, it is expected that the position control system has higher accuracy and higher response with the increase of the gains Kp and Kv, whereas there is the limitation to this because the behavior of the mechanism cannot be assumed as that of rigid body when the response of the position control system becomes quicker, and vibration characteristics must be taken into consideration. When the vibration characteristics of the mechanism is considered, the relation between the position and the force is given by the block diagram of Fig. 4. Here, ω and ζ are angular natural frequency and damping ratio respectively. In general, the damping ratio of the mechanism is small, and the vibration characteristics become unstable with the increase of gain. Thus, there arises a problem in the conventional control method when vibration characteristics are no more negligible. This will be explained below by an example. Fig. 5 is a block diagram showing a velocity control system by the conventional control method. Fig. 6 shows the root loci of the velocity control system as shown Fig. 5, and v r is the velocity command. The property of the feedback control system is determined by the-pole of closed loop. Fig. 6 shows the locus (root locus) of the pole of closed loop when the gain K v is gradually increased from 0 in this system. Here, it is assumed that ω = 1 and ζ ≒ 0. As it is evident from Fig. 6, the vibration characteristics moves-rightward, i.e. toward unstability with the increase of gain. Because the vibration root on the imaginary axis is non-damping, i.e. in stability limit, the gain must be smaller than the case of this condition. In general, the damping ratio of the mechanism is small, and it reaches the stability limit. This makes it impossible to increase the gain in the control system and to provide sufficient accuracy and response. This result does not vary significantly when negative feed back of the acceleration "a" is added in the system of Fig. 5. In the position control system, response is slower than in the velocity control system, and sufficient characteristics can not be obtained by the conventional control method of the equation (3). The object of the present invention is to stabilize the vibration characteristics in the position control. Another object of this invention is to achieve the position control with quicker response and higher accuracy. This object is solved with the features of the independent claims 1,2,3, and 4. By the above system composition, it is possible to stabilize the vibration characteristics of the mechanism, which tends to make the control system stable and to perform the position control with high gain, high response and high accuracy. Fig. 1 shows a composition example of the position control system according to this invention, Fig. 2 is a block diagram showing the relation between the position and the force in the position control system, Fig. 3 is a block diagram showing the position control system, where negative feedback of the position and the velocity is performed, Fig. 4 is a block diagram showing the position control system giving consideration on the vibration characteristics of mechanism, Fig. 5 is a block diagram showing the conventional velocity control system, Fig. 6 is a diagram to give the root loci of the feedback system, Fig. 7 is a block diagram to explain the principle of the position control system according to this invention, Fig. 8 is a diagram to show the root loci of the positive feedback sytem, Fig. 9 and Fig. 10 are the diagrams to represent the embodiments of the control system according to this invention,Fig. 11 shows a configuration of the first order lag circuit, Fig. 12 gives an example of the quasi-differential circuit, Fig. 13 and Fig. 14 are the block diagrams showing the composition of the controller, Fig. 15 represents the composition of an experimental apparatus, which is built up to confirm the effect of the position control system by this invention, Fig. 16 shows the step response of the velocity control system built up according to the conventional position control system, Fig. 17 shows the vibration data at the step response of velocity, Fig. 18 shows the step response when K v is increased to 200 s⁻¹ under the condition of K A = 35 s⁻¹ of Fig. 17 (b), Fig. 19 is a Bode diagram showing the frequency response characteristics of the same system, and Fig. 20 gives the step response when the position control by this invention shown in Fig. 14 is ultimately achieved. DESCRIPTION OF PREFERRED EMBODIMENTS In the following, the embodiments of the invention will be described in connection with the drawings. The present invention offers a method to perform proportional control of the acceleration of the mechanism having vibration characteristics by positive feedback through the first order lag circuit and to stabilize the vibration. The principle of this invention will be explained according to Fig. 7 and Fig. 8. In Fig. 7, the damping ratio ζ is set to zero, assuming the worst condition as vibration characteristics. For more easier explanation, a block diagram is shown, including the contact K f /M in the gain K. Fig. 8 gives an example of root locus of this positive feedback system. The parameters are: ω = 1 and T = 0.77. To set ω = 1 is to regularize the time axis by angular natural frequency of vibration, and the generality is not lost. The time constant T is a design parameter, whereas there is no substantial difference if 0.5 < T < 1 to ω = 1. It is evident from Fig. 8 that, with the increase of the gain K, the pole of first order lag moves toward right on the real axis and the pole of vibration characteristics toward left. The pole on the real axis is the first order lag having bigger time constant as it approaches the origin on the left half-plane, and it is unstable on the right half-plane. For this reason, the response of the first order element is slowed down with the increase of gain, and it becomes unstable as soon as it passes the origin. This is the reason why the conventional positive feedback has not been used, while it is possible to keep it stable if the gain is limited. The leftward movement of the vibration characteristics means more stableness of the damping, and this is very favorable result. The position marked with the mark of Fig. 8 is the pole of the closed loop when the gain K = 1, and there are the vibration characteristics of ω = 0.77 and ζ = 0.52 and the first order lag of T = 2.0. With the vibration characteristics of non-damping, the damping ratio is 0.52, and this suggests that the stabilization by this method is very effective. There are two methods to set up the principle of Fig. 7. One method is to measure the acceleration "a" as shown in Fig. 9 by accelerometer and to set up the positive feedback loop through the first order lag circuit. The other method is to measure the velocity "v" as shown in Fig. 10 and to set up the positive feedback loop through the quasi-differential circuit. The first order lag circuit and the quasi-differential circuit used here can be easily set up by operational amplifier, and the examples are given by Fig. 11 and Fig. 12. Thus, Fig. 11 can be expressed by: G S = - 1 RCS + 1 and Fig. 12 by: G S = - R 2 CS R 1 CS + 1 RC, R₁C, R₂C: time constants S: Laplace operator Fig. 13 and Fig. 14 are the block diagrams representing the composition of the controller in the position control when these two controls are added. Next, the effect of this invention will be clearly indicated by experimental data. In Fig. 15, 1 refers to a motor, 2 a coil spring, 3 a load inertia, 4 a tachogenerator, 5 a pulse generator, 6 a counter, 7 a controller, and 8 a power amplifier. In this experimental apparatus, the motor 1 and the load inertia 3 are connected by the coil spring, setting up the vibration characteristics. The motor 1 is driven by the force command "u" through the power amplifier 8, and the load inertia 3 is driven through the coil spring 2. Thus, the position of the load inertia 3 is precisely controlled. The quantity to be measured is the position and the velocity of the load inertia 3, and each of these is measured by the pulse generator 5 and the tachogenerator 4. The pulse signal as outputted from the pulse generator 5 is integrated by the counter 6 and becomes the position "x". The position command "r", the position "x" and the velocity "v" are inputted to the controller 7, and the force command "u" is outputted. The composition of the experimental apparatus shown in Fig. 15 is basically the same as in Fig. 1. Fig. 16 shows the step response of the velocity control system as set up by the conventional position control system. The vibration characteristics of open loop are: Natural frequency 60 Hz, and damping ratio 0.01. In Fig. 16, the step response is almost at the stability limit when velocity loop gain K v = 17 s⁻¹, and the vibration does not damp. Accordingly, the control loop of Fig. 14 for positive feedback of velocity through the quasi-differential circuit was added to this system. Fig. 17 represents the vibration data at the step response of velocity. Fig. 17 (a) shows the case of positive feedback gain K A = 35 s⁻¹, and Fig. 17 (b) the case of K A = 350 s⁻¹. Apparently, vibration is damping as the gain increases. Fig. 18 shows the step response when K v is increased to 200 s⁻¹ under the condition of K A = 350 s⁻¹ of Fig. 17 (b). In Fig. 18, vibration is damped enough and response is quick despite the fact the gain is increased. Fig. 19 is a Bode diagram showing the frequency response characteristics of the same system. When gain is -3 dB, the frequency is 45 Hz, and this is 0.75 times as high as natural frequency. Further, the fact that the gain is -2 dB less at the natural frequency suggests that vibration is sufficiently damped. Fig. 20 shows the step response when the position control by this invention as shown in Fig. 14 is ultimately performed. The position control system having quick response with no vibration and with cutoff frequency (-3 dB) at 23 Hz is achieved. This is 0.38 times as high as the natural frequency. Compared with the stable system by the conventional control method, the gain, the response and the accuracy are improved by more than 10 times. As it is evident from the above explanation, it is possible by the method of this invention to stabilize the vibration by positive feedback of the acceleration and to increase the gain of the position and velocity control system far more than the conventional method. Thus, the position control system with quick response and higher accuracy can be achieved. Further, there is no vibration response. It is also advantageous that it is achievable with simple circuit configuration.

Claims: A position control method, having a force (f) as manipulated variable and the position (x) as controlled variable, wherein a negative feedback of the position (x) and the velocity (v) is performed, characterized by an additional positive feedback of the acceleration (a) and with a command (U) for the force (f) depending on K v {K p (R-X)-V} wherein said command (u) is given by the equation: U = K A [K v {K p (R - X) - V} ÷ A( 1 TS+1 )] K A , K v , K p : feedback gains of acceleration, velocity and position respectively U: Laplace transformation of command u R: Laplace transformation of position command r X: Laplace transformation of position x V: Laplace transformation of velocity v A: Laplace transformation of acceleration a T: Time constant S: Laplace operator A position control method having a force (f) as manipulated variable and the position (x) as controlled variable, wherein a negative feedback of the position (x) and the velocity (v) is performed, characterized by an additional positive feedback of the velocity (v) and with a command (U) for the force (f) depending on K v {K p (R-X)-V}, wherein said command (u) for the force (f) is given by the equation U = K A [K v {K p (R - X) - V} + V( TS TS+1 )] K A , K v , K p : feedback gains of acceleration, velocity and position respectively U: Laplace transformation of command u R: Laplace transformation of position command r X: Laplace transformation of position x V: Laplace transformation of velocity v T: Time constant S: Laplace operator A position control apparatus, having a force (f) as manipulated variable and the position (x) as controlled variable, wherein a negative feedback of the position (x) and the velocity (v) is performed,. characterized by an additional positive feedback of the acceleration (a) and with a command (U) for the force (f) depending on K v {K p (R-X)-V}, wherein said command (u) is given by the equation. U = K A [K v { K p (R - X) - V} + A ( 1 TS+1 )] K A , K v , K p : feedback gains of acceleration, velocity and position respectively U: Laplace transformation of command u R: Laplace transformation of position command r X: Laplace transformation of position x V: Laplace transformation of velocity v A: Laplace transformation of acceleration a T: Time constant S: Laplace operator A position control apparatus, having a force (f) as manipulated variable and the position (x) as controlled variable, wherein a negative feedback of the position (x) and the velocity (v) is performed, characterized by an additional positive feedback of the velocity (v) and with a command (U) for the force (f) depending on K v {K p (R-X)-V}, wherein said command (u) is given by the equation: U = K A [K v {K p (R - X) - V} + V ( TS TS+1 )] K A , K v , K p : feedback gains of acceleration, velocity and position respectively U: Laplace transformation of command u R: Laplace transformation of position command r X: Laplace transformation of position x V: Laplace transformation of velocity v T: Time constant S: Laplace operator

Inventors: FUTAMI SHIGERU, FUTAMI, SHIGERU
Applicants: JAPAN RES DEV CORP, YASKAWA DENKI SEISAKUSHO KK, KABUSHIKI KAISHA YASKAWA DENKI, RESEARCH DEVELOPMENT CORPORATION OF JAPAN
Application year: 1989
Main classification: G05D3
IPC codes: G05D3, G05B19