Digital PID control

Abstract: The invention relates to control and, more particularly, to digital control of the relative positioning of an inertia system in translation or rotation. According to the invention, the position of the variable to be adjusted is defined digitally and this information is then processed to obtain the integral, to the first derivative and the second derivative. According to the invention, this second derivative is used to produce an automatic correction of the parameters to be applied to the integral, to the first derivative and to the position data in order to calculate the force or torque to be applied to the inertia system. Use for the adjustment of translation or rotation movements.

Description: The present invention relates to control and more particularly to an improvement to closed loop control systems. The control systems generally used comprise control loops, optionally in cascades, to make it possible to regulate an intermediate quantity on which the influence of the perturbations shows itself more rapidly than on the principal quantity controlled. It is well known that positioning systems having several loops in cascades can be used. Fig 1 shows a device of the prior art making it possible to regulate the movement of a strip 10 wound on a roll 11 driven by a motor 12. The motor 12 drives the roll 11 in the direction of the arrow 13 so as to reel out the strip 10 at a speed dy/dt. The strip 10 supplies a machine (not shown) at a feed speed dx/dt. So as to be able to control the speed of rotation of the motor 12 as a function of the feed speed dx/dt of the strip into the machine (not shown), it is necessary to measure the variation in speed between the feed into the machine and the speed at which the strip is reeled out. In order to do this, three idler rollers 14, 15, 16 are used, enabling the direction of the strip to be changed. The roller 16 is drawn back by a spring 17, a weight, a jack, or any other similar component. The position of the roller 16 is a function of the difference between the feed speed dx/dt and the reeling-out speed dy/dt. Normally the speed of rotation Ω of the motor 12 is measured by means of a tachometer 18. The speed at which the reel should rotate is derived from the position of the roller 16. It is compared at 19 with the signals coming from the tachometer so as to derive from this an error signal which is sent to the motor 12. Advantageously, PID devices with proportional, integral and derivative action well known in the art are used, which make it possible to obtain actions giving good stability whilst diminishing the transitory phases. However, the setting of the parameters of these PID devices is long and tedious since it is carried out by successive approximations and the actions on one of the parameters generally entail modification of the other parameters. These control chains are generally of analog type. However, the arrival on the market of digital PID devices, made possible by the current stage of development of electronics, now allows digital processing by means of analogue/digital converters. US 3,770,946 describes a method for automatic control wherein a digital computer is used as a controller. In said method a control error is produced and sent to three separate circuits for computation of proportional, reset and rate components for applying respective coefficients K₁, K₂, K₃. It is stated that coefficients could be modified. However, the document does not provide any hint how said coefficients are modified and the method only provides means to prevent an immediate proportional and rate response when the set point and/or coefficients are changed. DE-A-3 418 969 describes a device wherein a second derivative control is used. However, said document describes a cascade control device and the second derivative is only to adapt the speed of reaction of the control device. Nowhere an automatic regulation of the coefficients is described. The object of the invention is to provide a control method in which the settings are obtained systematically and without any empirical procedure, whatever the machine, ie independently of any small variations in friction or inertia in the components, either with respect to the theoretical value, or between two identical machines. The object is achieved by means of a method according to claim 1 in which: a) the position of a first component to be regulated, with respect to a second component, said first component moving under the influence of a torque Cm or force F, is defined digitally, b) the data corresponding to said position is processed in order to obtain the first derivative and the integral of said position, and c) the torque Cm or force F to be applied to this first component is determined as a function of the solutions to an equation depending on the first derivative, the integral and the position data, method characterised in that: d) the data is processed to obtain the second derivative of the position measured; e)the equation is Cm or F = - k ( d.i.z' + p.i 2 .z +i 3 ∫ z.dt ) - a z" wherein k is the general gain, (d.i) is the correction factor applied to the first derivative, (p.i²) is the correction factor applied to the proportional reaction, a is the correction factor applied to the second derivative, and i³ is an integral correction factor, and f) an automatic correction of the correction factors to be applied to the integral, the first derivative and the position data is carried out through modifications of i and/or k in order to calculate, respectively, the torque or force to be applied to the first component. In the accompanying drawing, given by way of example: Fig 1 shows diagrammatically a control circuit of the prior art; Fig 2 shows diagrammatically a control circuit according to the invention for the same application; Figs 3A-3D show graphs enabling the conditions required for implementing the invention to be understood better; Figs 4A and 4B show diagrammatically the automatic centring of a width of material by means of a device according to the invention. In order to understand the invention better, the theory will first of all be dealt with. It is well known that when it is desired to regulate a "positioning" system in which a component with inertia is moving, it is possible to act only through a force which produces an action on the second derivative. In the prior art, when it was desired to regulate a mechanical system driven by a motor, the difference in position between the actual position and the theoretical position was measured so as to determine from this a speed of rotation of the motor (the reference) which was compared with the actual speed in order to provide a correction signal. This mechanical system can be studied in the following manner. Let J be the inertia of the mechanical system referred to the motor shaft, Ω the angular velocity of the motor, Cm the torque delivered by the motor and Cf the torque due to parasitic friction. It is well known that: Cm - Cf = JΩ' in which Ω' is the first derivative of the angular velocity of the motor. If the movement of the part of the mechanical system, a movement providing the correction of an error, is termed y, and the ratio between Ω and the speed of this movement is termed α, this gives the relationship αy' = Ω in which y' is the first derivative of y. Replacing Ω' in relationship (1) by its value obtained from relationship (2) gives: Cm - Cf = J Ω' = Jαy" in which y" is the second order derivative of y. If x is the error at the input and z the error measured at the output, the relationship existing between x, y and z is of the type: y = βx + τz in which β and τ are constants. For control purposes, the motor is provided with a torque which depends on the error measured. The control systems of the prior art showed that there was a certain advantage for the torque to depend not only on the value of the measured error u but also on its derivative and its integral (PID): Cm = -k (du' + pu + ∫udt) where u can be the z error measured or more generally, as was mentioned above, the difference between the desired speed (the reference) and the actual speed (cascade control). According to the invention, the velocity difference is no longer measured and the motor torque thus depends on the second derivative of the error z". Cm = -k (diz' + pi 2 z + i 3 ∫zdt) - az" in which: k is the general gain; (d.i) is the correction factor applied to the first derivative; (p.i²) is the correction factor applied to the proportional reaction; a is the correction factor applied to the acceleration; i³ is an integral correction factor. The advantage of i will be seen later. In the prior art this factor was equal to 1 and did not appear in the equations. Differentiating relationship (4) twice gives y" = βx" + τz" Substituting relationships (5) and (6) in relationship (3) gives: (a + Jατ)z" + kdi z' + kpi 2 z + ki 3 ∫zdt = - Cf - Jαβx" Putting K = k/(a + Jατ) and differentiating gives: z"' + Kdi z" + Kpi 2 z' + ki 3 z = (-Jαβ / (a+Jατ)) x"' The solution to equation (7) without the right-hand side, ie z"' + Kdi z" + Kpi 2 z' + Ki 3 z = 0 is of the form: z = Zi e z1t + Z2 e z2t + Z3 e z3t in which z1, z2 and z3 are complex numbers. It is well known that if damping is desired, the real parts of z1, z2 and z3 must be negative. It can easily be demonstrated that this condition is fulfilled when: K > 0, d > 0, p > 0 and i > 0 and (Kdi) (Kpi 2 ) > Ki 3 ,ie Kdp > 1 This condition is already known by the name of Routh's criterion but it is not sufficient to eliminate the transitory phase oscillations completely. The advantages inherent in the invention in having introduced the factor i can already be seen. In fact, this condition is independent of this factor. If it is desired that the solutions to equation (8) should have no oscillation, it is necessary and sufficient for z1, z2 and z3 in equation (9) to be real and negative. If one of the solutions is made equal to e zot , by substituting its values in equation (8) and dividing by e zot , this gives: zo 3 + Kdi zo 2 + Kpi 2 zo + Ki 3 = 0 The real roots of equation (10) are called z1, z2 and z3 where z3 ≤ z2 ≤ z1 ≤ 0. It will be recalled that the factors K, d, p and i are positive. Let us determine the conditions linking the factors so as to have real negative roots. It will be noted that the value of the left-hand side of equation (10) gives a continuous third order curve between -∞ and +∞. Equation (10) therefore permits at least one real root. The value for z = 0 is equal to Ki³ ie positive because of the conditions already mentioned with regard to the factors. If the curve is displaced by the amount -K i³, a curve is obtained similar to the one shown in a double line in Fig 3A, and equation (10) becomes: zo 3 + Kdi zo 2 + Kpi 2 zo = 0 which permits the value 0 as a solution. For this equation to have two other real solutions, it is necessary that: (Kdi) 2 > 4 Kpi 2 ie: Kd 2 > 4p When condition (12) is fulfilled, the z3 solution is real and negative whatever the positive value of Ki³. Let us now consider Fig 3C. The curve provided by equation (10) can be considered to be the sum of a first function z3 and a second function Kdi zo² + Kpi² zo + Ki³. Fig 3C shows in a continuous line (single and double) the two functions and in a broken line their sum which is the left- hand side of equation (10). If we call the roots of the equation Kdi zo 2 + Kpi 2 zo + Ki 3 = 0 z4 and z5 it suffices that z4 should be real for z1 to exist, since z4 > z1 > 0. For equation (13) to have real solutions, it suffices that: (Kpi 2 ) 2 > 4 (Kdi)(Ki 3 ) ie p 2 > 4d When conditions (12) and (14) are satisfied, real negative roots z1 and z3 are obtained and therefore z2, which is between z1 and z3, is also real and negative. If we take K ≥ 1, condition (12) can be written: d 2 > 4p It can be demonstrated that if conditions (14) and (12) exist, they necessarily entail Kpd > 1. Fig 3D shows the curve A of equation p = d²/4 and the curve B of equation d = p²/4, which are the conditions (14) and (15). In order to avoid oscillations, it suffices that the values of p and d should be within the non-hatched area in Fig 3D. It will be noted that these two conditions are independent of the value of the correction factor i. This factor was introduced into equation (5) in such a way that it does not interfere with the stability conditions. It therefore makes it possible to adjust the "reaction" of the system as a function of time and, during the transitory phases, the equilibrium position is achieved more quickly as the value of i becomes greater. In addition, i can be a variable factor, controllable by any external parameters to suit the different requirements which can be conceived. For example, in the case of an umvinding, if it is desired to limit the acceleration of the moving cylinder so as not to create high excess tension in the web, i can be automatically adjusted by writing the condition: if z" > z"max then i = i - δi or, even better, i = qi where q < 1. As indicated previously, K was made equal to k / (a + Jατ) and K ≤ 1, where k is the general gain, α and τ are constants and J the inertia of the system. It is well known that in order to avoid large accelerations which would impair the stability of the system, it is necessary to work with a moderate motor torque and use a low general gain k. When digital systems are used, idle times occur because the signals are sampled. This phenomenon causes errors. It has been found from experience that digital control of these systems could be achieved only if 1 ≤ K ≤ 2. This therefore gives k≈a + Jατ and when Jατ is constant a zero value can be chosen for the factor a, which takes us back to the known art in which equation (5) does not involve the second derivative. However, when the inertia varies during operation, K varies between a minimum value and a maximum value. Jατ varies between (Jατ)min and (Jατ)Max. Putting k = a + (Jατ)Max and a = ao (Jατ)Max gives: K = 1 when Jατ is equal to its maximum value and K = ( ao + 1 ) / ( ao + (Jατ) min / (Jατ) Max ) when Jατ is minimum. If ao is made large, the variation in K can be made small. Putting ao = 2 gives 1 ≤ K < 1.5 and ao = 5 gives 1 ≤ K < 1.2. Equation (7) has, up to now, been considered without the right-hand side. The solutions to equation (7) with the right-hand side are in the form of the solutions of the equation without the right-hand side plus a special solution, ie: z = Z1 e z1t + Z2e z2t + Z3e z3t + h(t) in which h(t) is a function of the type x"'. If x"' is zero, this reintroduces the equation without the right-hand side; if x"' is a constant, h(t) is a constant which becomes smaller as a becomes larger, and if x"' = Xoε³ sin(εt), this gives h(t) = Z5 sin (εt + ), with Z5 becoming smaller as a becomes larger. It can be seen therefore that the introduction of a correction proportional to the second derivative of the difference z 1) attenuates the effect of the variation in the inertia; 2) attenuates the effect of the perturbation due to the input error x; 3) allows an error in the determination of J. The latter effect provides the practical possibility of making an approximate calculation of the value of the inertia and determining an order of magnitude of the factors and parameters for implementing the invention. It will now be seen how the invention can be used for the automatic centring of a width of material. As can be seen from Fig 4B, the movement z of the width of material is given by the relationship: z = x + y in which x represents the movement of the reel with respect to the support and y the movement of the support. Comparing equations (16) and (4) gives τ = 1 and β = -1. To control the centring of the width of material, it is necessary therefore to control the movement of a mass m which is equal to the sum of the mass of the mechanical assembly me supporting the reel and the mass of the reel mb m = mb + me If the density of the reel is ρ, the radius of the reel R and the width of the material l, this gives: m = π R 2 lρ + me Consider the motor torque Cm which has to be controlled in order to move a mass m. In the example shown in Fig 4A, Cm is in the form Cm = Cm1 + Cm2 + Cm3 in which Cm1 represents the torque used to move the mass m; Cm2 represents the motor torque used to rotate the assembly consisting of the screw with pitch s and pulley with radius Rscrew; Cm3 represents the motor torque used to rotate the pulley with radius Rmotor. If the inertia of the motor fitted with the pulley of radius Rmotor is jm, then: Cm3 = jm Ω' If the inertia of the rotating assembly consisting of the screw with pitch s and the associated pulley with radius Rscrew is called je, then: Cm2 = je Ω'/µ 2 in which µ represents the reduction radio µ = Rscrew / Rmotor The torque Cml utilised to move the mass m is calculated as follows. One rotation of the screw moves the mass m by the quantity s. One rotation of the motor moves this mass by the quantity s/µ. If the angular velocity of the motor is called Ω, this gives: y' = Ωs/2πµ Comparing equation (23) with equation (2) gives: α = 2πµ/s The force F used for the movement of the mass is given by the equation: F = my" This therefore gives: F = mΩ' s/2πµ The motor torque Cm1 may then be written as: Cm1 = F s/2πµ = mΩ' (s/2πµ) 2 ie Cm1 = m/α 2 The total motor torque is therefore Cm = ( m / α 2 + je / µ 2 + jm ) Ω' = JΩ' in which J is the inertia referred back to the motor. The value of Jατ is therefore: J ατ = m/α + αje/µ 2 + αjm with m given by equation (18). As indicated above, it can be seen therefore that an approximate value of the inertia referred back to the motor can be calculated and that introducing the second derivative of the difference makes it possible to calculate approximate values which can be used for the subsequent automatic control. The advantages of a and i exist only because the other coefficients k, p and d have been previously determined. (In fact, if the values of p and d are arbitrary or are adjusted empirically during the tests, the settings thus obtained will be suitable only for the values of i and a utilised at the time of these settings and will, therefore, no longer have their independence and the advantages mentioned.) The predetermination of the values of k, d and p is possible only because of the demonstration of the two stability conditions (14) and (15) and the complete digital processing which alone makes it possible to be certain of the values introduced into the system. Consider another application of the invention with reference to Fig 2; the unwinding or winding of a film from or onto a core. As can be seen in Fig 2, the movement z of the idler roller is given by the equation 2 z = y - x Comparing this equation with equation (4) gives: β = 1 and τ= 2 Designating the reduction ratio of the pulley drive system µ, where µ = Rb/Rm, and the angular velocity of the motor Ω, it is possible to write: y' = ΩR/µ Comparing this equation with equation (2) gives α = µ/R. To simplify the mathematics, it is assumed that the idler rollers are identical. Let m be the mass of each roller, jc their respective inertias, r their radius and 2T the restoring force exerted on the intermediate roller used to keep the film under tension. The tension Ty assisting the motor can be written in the form: Ty = T - 3 2 jc r 2 x'' - z'' 2 ( 5 jc r 2 + m) The torque Cd available to drive the reel can be written: Cd = µ (Cm - jm Ω') in which jm represents the inertia of the motor carrying the drive pulley of radius Rm. The torque enabling the film to be moved is represented by Ty R + Cd. This therefore gives: TyR + Cd = y" (jb + je)/R = (jb + je) Ω' / µ If Ty in equation (34) is replaced by its value calculated from equation (33), this gives, as the left-hand side: TR - 3R 2 jc r 2 x'' - z'' R 2 ( 5jc r 2 + m) + µcm - µjm Ω' ie: TR - 3R jc 2 r 2 x'' + µCm = Ω' ( jb µ + je µ + µjm) + z'' 2 R . ( 5jc r 2 + m) Differentiating equation (31) gives: z" = y"/2 - x"/2 We therefore obtain from equation (36) and the differentiated equation (32) y" = (R/µ)Ω' TR µ + x'' R 4µ (m - jc r 2 ) + Cm = Ω' [ jb + je µ 2 + jm + R 2 4µ 2 ( 5jc r 2 + m)] From this, therefore: J = jb + je µ 2 + jm + R 2 4µ 2 ( 5 jc r 2 + m) The value of Jατ becomes Jατ = 2 jb µR + 2 je µR + 2µjm R + R 2µ ( 5jc r 2 + m) where jb = Mr²/2 = π ρlR⁴/2 As indicated above, it can therefore be seen, here again, that it is possible to estimate an approximate value of the inertia, referred back to the motor, which enables the invention to be implemented. Once an approximation of the inertia referred back to the motor has been determined, the invention can be dealt with in a well-known digital manner. It is well known that the transformation of analogue values can be obtained only by means of discreet values. If the sampling frequency in seconds is N: N =1/δt The relationships given above were written in the MKSA standard system of units. When the measured values are transposed by numerical values, the values thus obtained do not represent the distance in metres m, the speed in m/s or rad/s but in other units, and it is therefore necessary to calculate transposition factors. By definition, capital letters will be used to represent the numerical values. For example Z is the numerical value representing the difference (z in metres). Let Zo be the number of positions which can be determined for a given difference of lm. It can be said that z in metres is equal to: z = Z / Zo If z(t) is the measurement of z at time t, this gives the velocity in m/s. z' = [z(t) - z(t - δt)] / [t - (t - δt)] = [z(t)-z(t-δt)] / δt ie: z' = N Zo (Z t - Z t-δt ) = N Zo [Z t - Z t-1/n ] Likewise the acceleration in m/s2. z'' = N 2 Zo δ δZ z" = N 2 Zo [Z(t) - 2Z(t-1/N) + Z(t-2/N)] and the integral If Co is the maximum torque exerted by the motor when the digital/analogue transmitter controlling the motor amplifier is at its maximum, Eo the maximum number of possible points which can be accepted by the transmitter and E the numerical value generated by the calculations and supplied to the transmitter, it is possible to put: Cm = Co 2E - Eo Eo Thus the motor torque Cm takes its maximum positive or negative value for E = 0 or E = Eo and takes a zero value for E = Eo/2. Equation (44) can also be written: E = Eo 2 Co + Cm Co = Eo 2 (1 + Cm Co ) The digital/analogue transmitter controlling the motor can therefore be supplied with a value of E such that: E = Eo 2 - k.Eo 2CoZo [d.i.N δZ + p.i 2 .Z + i 3 N Σ Z + aN 2 k δ δZ ] It will be noted that, because this is carried out digitally, the variations of ∫zdt z, z' and z" take place by successive increments with the respective values 1/NZo, 1/Zo, N/Zo, N²/Zo. None of these increments must generate an excessively large relative variation in the torque. It has been found experimentally that a satisfactory function was obtained when: ki 3 N Co Zo ≦ 0,15 kpi 2 Co Zo ≦ 0,15 kdi N Co Zo ≦ 0,07 and a N 2 Co Zo ≦ 0,01 It is obvious that in order to avoid perturbations due to idle time, the sampling frequency N must be sufficiently large. In practice N ≥ 50. In these circumstances, the first three conditions (47), (48), (49) are generally easily met. However, condition (50) is more difficult to achieve. Where this condition is not achieved, it is nevertheless possible to use the invention by cancelling the value of the factor a and by using the value of the second derivative for automatically adjusting the factor k. For example, when there is any uncertainty about the value of Jατ, the procedure is started with k N Jατ and the ideal gain k is sought by writing the condition with a constant i. When the acceleration is too large the gain is decreased, verifying the following condition: If z" > z"max then δ δZ > Zo N 2 z'' max . When this condition is achieved, the value of k will be modified to take k - δk or, better still, qk with q < 1. It is obvious that this search can be speeded up by writing several conditions of the same type: If z" < 2 z"max then k = k - 2 δk, etc. When Jατ is decreasing, which is the case for example with an unwinding device, it is possible to proceed as indicated above, but each cycle will be started off with a value of k equal to the value (Jατ)max. In these two cases the gain is adjustable automatically, which is easy because of the digital processing. When Jατ is increasing, which is the case for example with a winding machine, and this increase takes place in accordance with a known law, for example the variation in a length of film, k can be made to vary approximately in accordance with the inertia variation law. It is sufficient for this variation to be identical, within 25%, to the variation in inertia. In this case the variation in the factor i will be used, as in the general case described above, to vary the control, and the condition indicated will be used: If z" > z"max then i = i - δi or i = qi with q < 1 The advantage of the invention lies essentially in the fact that stability conditions (14) and (15) were discovered which up until then were unknown and that the use of an additional parameter independent of the stability conditions makes it possible to mitigate the approximations necessary for the calculation of the system.

Claims: Method for controling the relative positioning of a first component with respect to a second component, said first component moving under the influence of a torque Cm or force F, and wherein : a) the position to be regulated is defined digitally, b) the data corresponding to the position error z is processed in order to obtain the first derivative z' and the integral ∫zdt of said position error, and c) the torque Cm or force F to be applied to this first component is determined as a function of the solutions to an equation depending on the first derivative z', the integral ∫zdt and the position error data, method characterised in that: d) the data is processed to obtain the second derivative z" of the position error measured; e) the equation is Cm or F = - k ( d.i.z' + p.i².z +i³ ∫ z.dt ) - a z" wherein k is the general gain, (d.i) is the correction factor applied to the first derivative, (p.i²) is the correction factor applied to the proportional reaction, a is the correction factor applied to the second derivative, and i³ is an integral correction factor, and f) an automatic correction of the correction factors to be applied to the integral, the first derivative and the position error data is carried out through modifications of i and/or k in order to calculate, respectively, the torque or force to be applied to the first component. Method according to claim 1, wherein the first component is rotating, driven by a motor, and Kdp is greater than 1 with K, d and p positive, K being equal to k/(a+Jατ) in which J is the inertia referred back to the motor, α the ratio between Ω the speed of rotation of the motor and y' the first derivative of the movement of the first component providing the correction of the position, and τ a constant, method characterised in that factors K, d and p are used satisfying the relationships: Kd 2 > 4p and p 2 > 4d Method according to claim 2, in which K > 1, characterised in that factors d and p are used satisfying the relationships: d 2 > 4p and p 2 > 4d Method of control according to one of claims 2 or 3, characterised in that the torque is obtained by the solutions to the equation: Cm = -k (d.i.z' + p.i 2 .z + i 3 ∫zdt) - az" in which a represents the correction factor applied to the second derivative z" of the position error measured and i is a factor whose value does not influence the stability conditions. Method according to one of claims 2 or 3, in which k is automatically adjusted in accordance with the second derivative z". Method according to one of claims 2 or 3, in which i is automatically adjusted in accordance with the second derivative z".

Inventors: GAUDILLAT JACQUES FERNAND, GAUDILLAT, JACQUES FERNAND, Gaudillat, Jacques Fernand, c/o KODAK-PATHE
Applicants: EASTMAN KODAK CO, KODAK PATHE, EASTMAN KODAK COMPANY, KODAK-PATHE
Application year: 1992
Main classification: G05B11
IPC codes: G05D3, B65H23, G05B11, G05D15