METHOD OF CONTROLLING THE FORCE OF A PNEUMATIC ACTUATING DEVICE

Abstract

A method is for controlling an actuation force exerted by an actuating device having a first working chamber and a second working chamber supplied with pressurized air from a source of pressurized air by a first pressure regulator and a second pressure regulator. The method includes calculating, by an optimization algorithm based on a dynamic model of the actuating device and of the first and second pressure regulators, desired values for control signals for the first and second pressure regulators to generate an actuation force equal to a desired value for the actuation force. An estimated value for the actuation force, estimated values for pressures inside the first and second working chambers and for first derivatives of the pressures, are determined by a state observer based on a measured value for the actuation force and on measured values for the pressures in the first and second working chambers.

Claims

1. A method for controlling an actuation force exerted by a pneumatic actuating device, wherein the pneumatic actuating device comprises a first working chamber and a second working chamber configured to be supplied with pressurized air by a source of pressurized air through a first pressure adjuster and a second pressure adjuster, respectively, and wherein said first pressure adjuster and second pressure adjuster are configured to adjust pressure of air inside the first and second working chambers, respectively, depending on a control signal, the method comprising iterative real-time implementation of steps of: a) calculating, by an optimization algorithm based on a dynamic model of the pneumatic actuating device and of said first and second pressure adjusters, desired values for control signals for said first and second pressure adjusters in order to generate, by the pneumatic actuating device, an actuation force equal to a desired value for the actuation force, calculation being carried out by a closed-loop proportional-integral-derivative controller based on the desired value for the actuation force, on an estimated value for the actuation force and on estimated values for pressures in said first and second working chambers and for first derivatives of said pressures, and b) establishing, by a state observer, the estimated value for the actuation force, the estimated values for the pressures in said first and second working chambers and for the first derivatives of said pressures, based on a measured value for the actuation force and on measured values for the pressures in said first and second working chambers.

2. The method of claim 1, wherein, in step b) the estimated value for the actuation force, the estimated values for the pressures in said first and second working chambers and for the first derivatives of said pressures, are established by also taking into account the desired values for the control signals calculated in step a).

3. The method of claim 1, wherein the desired values for the control signals for said first and second pressure adjusters calculated in step a) are established to minimize the norm of vector of the control signals for said first and second pressure adjusters.

4. A pneumatic actuating system, comprising: a pneumatic actuating device configured to apply an actuation force, the pneumatic actuating device comprising at least one movable actuating member, a first working chamber and a second working chamber configured to be supplied with pressurized air to control movement of said at least one movable actuating member, a source of pressurized air, a first pressure adjuster interposed between said source of pressurized air and said first working chamber to supply said first working chamber with pressurized air at a given adjustable pressure, a second pressure adjuster interposed between said source of pressurized air and said second working chamber to supply said second working chamber with pressurized air at a given adjustable pressure, pressure sensors configured to provide signals indicative of the actuation force exerted by the pneumatic actuating device by said at least one movable actuating member, and signals indicative of pressures in said first and second working chambers, and an electronic control unit configured to control said first and second pressure adjusters by performing the method of claim 1.

Description

[0017] FIG. 1 is a schematic view of a pneumatic actuating system to which the control method of the present invention may be applied; and

[0018] FIG. 2 is a block diagram of the pneumatic actuating system in FIG. 1.

[0019] Referring initially to FIG. 1, a pneumatic actuating system first of all comprises an actuating device 10 (which is designed as a gripping device in the present case, but which—as mentioned—could be designed as an actuating cylinder), having at least one actuating member 12 intended for generating an output actuation force. The actuating device 10 comprises a first working chamber 14 and a second working chamber 16 that may be supplied with pressurized air in order to control the movement of the actuating member (or members) 12 with a given actuation force that is dependent on the pressures in the working chambers.

[0020] In the specific case of an actuating device 10 designed as a gripping device, the device comprises two actuating members 12 acting as gripping fingers (and therefore indicated as “gripping fingers” from here onwards for the sake of simplicity), which may alternately be moved towards one another in order to tighten an object to be grasped with a given force (indicated as the “gripping force” from here onwards) or moved away from one another in order to release the grasped object. By supplying pressurized air to the first working chamber 14, the movement of the gripping fingers 12 towards one another, and therefore the grasping of the object, is controlled, while, by supplying pressurized air to the second working chamber 16, the movement of the gripping fingers 12 away from one another, and therefore the release of the object, is controlled. Therefore, the first and the second working chamber 14 and 16 will also be indicated in the present description as the closing chamber and as the opening chamber, respectively, and the relative variables (for example the pressure) will be indicated by the subscript “c” and by the subscript “o,” respectively. By modulating the pressures in the first working chamber 14 (closure chamber) and in the second working chamber 16 (opening chamber), it is therefore possible to open/close the gripping fingers 12 of the actuating device 10 and to change the gripping force.

[0021] The pneumatic actuating system also comprises a pressurized air supply (or an air compressor) 18 and a pair of pressure regulators 20 and 22 each arranged between the pressurized air supply 18 and a particular working chamber 14 and 16 of the actuating device 10, and specifically a first pressure regulator 20 arranged between the pressurized air supply 18 and the first working chamber 14 in order to supply this chamber with pressurized air at a given regulatable pressure, and a second pressure regulator 22 arranged between the pressurized air supply 18 and the second working chamber 16 in order to supply this chamber with pressurized air that is at a given regulatable pressure. Each pressure regulator 20 and 22 receives an input control signal, for example a voltage signal (but which could also be a different type of signal, such as a current signal), and, on the basis of this control signal, determines the pressure of the air in the particular working chamber (first working chamber 14 for the first pressure regulator 20 and second working chamber 16 for the second pressure regulator 22) of the actuating device 10.

[0022] The pneumatic actuating system further comprises an electronic control unit 24 designed to suitably control the pressure regulators 20 and 22 on the basis of information received from respective pressure sensors 26 and 26′ regarding the values for the pressures in the working chambers 14 and 16 of the actuating device 10 and from a force sensor 28 (for example a load cell) regarding the force applied by the actuating device 10 (in the present case, the gripping force generated by the gripping fingers 12), in order to ensure the application of a given actuation force.

[0023] Although in the schematic view in FIG. 1, the pressure regulators 20 and 22, the pressure sensors 26, 26′ and the electronic control unit 24 are shown as separate components with respect to the actuating device 10, an embodiment that provides the integration of the above-mentioned components inside the actuating device 10 should also be understood to be covered by the scope of the present invention.

[0024] FIG. 2 is a block diagram of the actuating system, which shows that the electronic control unit 24 comprises a controller 30 and a state observer 32 and that the controller 30 is a closed-loop proportional-integral-derivative (PID) controller associated with an optimizer implementing an optimization algorithm. In this figure: [0025] F.sub.d, F.sub.m and F.sub.est respectively indicate the desired actuation force(gripping force) value, the actuation force value measured by the force sensor 28 and the actuation force value estimated by the state observer 32; [0026] P.sub.c, P.sub.o, P.sub.c_est and P.sub.o_est respectively indicate the value for the pressure in the first working chamber 14 measured by the pressure sensor 26, the value for the pressure in the second working chamberl6 measured by the pressure sensor 26′, the value for the pressure in the first working chamber 14 estimated by the state observer 32 and the value for the pressure in the second working chamber 16 estimated by the state observer 32; and u.sub.c_d and u.sub.o_d respectively indicate the desired values for the control voltages (assuming that the control signals for the pressure regulators 20 and 22 are voltage signals), as calculated by the controller 30, which values are to be sent to the first pressure regulator 20 and to the second pressure regulator 22.

[0027] On the basis of the desired actuation force value F.sub.d supplied as it enters the system, of the estimated actuation force value F.sub.est supplied by the state observer 32 and of the estimated values P.sub.c_est est and P.sub.o_est for the pressures in the working chambers 14 and 16, as well as for the relative first derivatives, supplied by the state observer 32, the controller 30 determines the desired values u.sub.c_d and u.sub.o_d for the control voltages to be supplied to the first pressure regulator 20 and to the second pressure regulator 22, respectively.

[0028] The state observer 32 determines the above-mentioned estimated values F.sub.est, P.sub.c_est and P.sub.o_est for the actuation force and the pressures in the working chambers 14 and 16, and for the first derivatives {dot over (P)}.sub.c_est est and {dot over (P)}.sub.o_est of the second two estimated values, on the basis of the values F.sub.m, P.sub.c and P.sub.o measured for the actuation force and for the pressures in the working chambers 14 and 16, as well as for the desired values u.sub.c_d and u.sub.o_d for the control voltages.

[0029] The controller 30 and the state observer 32 integrate a dynamic model of the actuating device 10 and of the pressure regulators 20 and 22 associated therewith.

[0030] More specifically, the mathematical model of the pressure regulators 20 and 22 is given by the following equation, which describes the dynamic behavior of the i-th pressure regulator, where i=c for the first pressure regulator 20 and i=o for the second pressure regulator 22:

{umlaut over (P)}.sub.i=K.sub.P.sub.iP.sub.i.sup.2+K.sub.PP.sub.iP.sub.i.sup.2+K.sub.D.sub.i{dot over (P)}.sub.I.sup.2+K.sub.DD.sub.i{dot over (P)}.sub.i.sup.2+K.sub.PD.sub.iP.sub.i{dot over (P)}.sub.I+(B.sub.U.sub.i+B.sub.PP.sub.iP.sub.i+B.sub.D.sub.i{dot over (P)}.sub.I)u.sub.ic.sub.i   (1)

[0031] Equation (1) herein above approximates the second derivative of the pressure P.sub.i regulated by the i-th pressure regulator with a great degree of precision on the basis of the control voltage u.sub.i supplied to this pressure regulator. The parameters K.sub.P.sub.I, K.sub.PP.sub.I, K.sub.D.sub.I, K.sub.DD.sub.I, B.sub.U.sub.I B.sub.PP.sub.I, B.sub.D.sub.I, and c.sub.I may be determined empirically by means of an iterative process.

[0032] With regard to the actuating device 10, the actuation force (gripping force) F applied thereby is given by the equation

F=AP+b,

where A=[−a.sub.1 a.sub.2] (calibration coefficient), P=[P.sub.cP.sub.o].sup.T and b is a parameter that may be estimated empirically.

[0033] The second derivative of the actuation force F is given by the following equation:

{umlaut over (F)}=γ+Cu,  (3)

where

γ=δ(K.sub.PP.sub.c+K.sub.PPP.sub.c.sup.2+K.sub.D{dot over (P)}.sub.c+K.sub.DD{dot over (P)}.sub.c.sup.2+K.sub.PDP.sub.c{dot over (P)}.sub.c+c+α(K.sub.PP.sub.o+K.sub.PPP.sub.o.sup.2+K.sub.D{dot over (P)}.sub.o+K.sub.DDP.sub.o.sup.2K.sub.PDP.sub.o{dot over (P)}.sub.o+c, and  (4)

C=δ[B.sub.U+B.sub.PPP.sub.c+B.sub.D{dot over (P)}.sub.c,α(B.sub.U+B.sub.PPP.sub.o+B.sub.D{dot over (P)}.sub.o)].  (5)

[0034] In equations (4) and (5) given above, the 6 factor coincides with the above-mentioned A vector.

[0035] Equation (4) given above is based on the assumption that the above-mentioned parameters K.sub.P.sub.i, K.sub.PP.sub.i, K.sub.D.sub.i, K.sub.DD.sub.i, B.sub.U.sub.i, B.sub.PP.sub.i, B.sub.D.sub.i and c.sub.i of Equation (1) are the same for the two pressure regulators 20 and 22 used to control the actuating device 10. However, this assumption is not binding, since the control method of the present invention may also function with different values for these parameters for the two pressure regulators 20 and 22.

[0036] The law of control used by the controller 30, which is a closed-loop PID controller as mentioned, is given by the following equation:

{umlaut over (F)}*={umlaut over (F)}.sub.d−K.sub.p.sup.1(F−F.sub.d)−K.sub.i.sup.1∫(F−F.sub.d)dt−K.sub.d.sup.1({dot over (F)}−{dot over (F)}.sub.d).  (6)

[0037] The controller 30 is designed to minimize the norm of the u vector=[u.sub.c_du.sub.o_d], taking into consideration that the second derivative of the actuation force expressed by Equation (3) has to be equal to the termon the right of Equation (6). As a result, at each iteration, the controller 30 provides the desired output values u.sub.c_d and u.sub.o_d for the control voltages for the pressure regulators 20 and 22 calculated by implementing the above-mentioned optimization algorithm, which is based precisely on minimizing the norm of the above-mentioned u vector.

[0038] Experiments have proven that the control method described above makes it possible to control the force applied by the actuating device with great precision, with an error between the desired force and the force actually applied of less than 1 N (with respect to forces in the tens of N).

[0039] As mentioned previously, in addition to the advantage of ensuring a very low error risk, the control method according to the invention offers the advantage of minimizing the energy consumption on account of carrying out an optimization calculation that makes it possible to determine the minimum pressures to be imposed in the working chambers of the actuating device in order to generate the desired force.

[0040] Furthermore, the control method according to the invention makes it possible to obtain better performance with respect to a classic PID controller, as well as with respect to the known control methods cited above, in particular when tracking time-variable signals and managing the transistors.

[0041] Without prejudice to the principle of the invention, the embodiments may be extensively modified with respect to that which has been described and illustrated purely by way of non-limiting example, without thereby departing from the scope of the invention, as defined in the attached claims.

[0042] For example, as already mentioned previously, although the control method has been described and illustrated here with specific reference to the application thereof to a gripping device, such as a pneumatic actuating device, it is equally applicable to a pneumatic cylinder. In fact, in a pneumatic cylinder, too, there will be two working chambers, the pressures of which are regulated by respective pressure regulators in order to determine the extension or retraction of a rod acting as an actuation member and the control method will make it possible to control the compressive or tensile force exerted by the rod in this case.