Summary of the invention
The object of the present invention is to provide a kind of Pneumatic Position Servo System backstepping control method, solve prior art to the not high enough problem of the tracing control precision of Pneumatic Position Servo System.
The technical solution used in the present invention is, a kind of Pneumatic Position Servo System backstepping control method, and the method is specifically implemented according to following steps:
Step 1, set up the model of controlled Pneumatic Position Servo System
The mathematical model of proportional valve control Pneumatic Position Servo System is as shown in the formula (1):
Wherein
with
be respectively the gas mass flow flowing into cylinder A side and B side, u is control signal, p
aand p
bbe respectively cylinder A side and B side pressure, A
aand A
bbe respectively cylinder A side and B side piston cross-section to amass, y is piston displacement, y
0for piston-initial-position, M is slide block quality, F
ffor frictional force, f
a() and f
b() is respectively the nonlinear function relevant with B side external and internal pressure with cylinder A side, and K, R and T are dependent constant, and above-mentioned piston displacement y is obtained by displacement detecting instrument;
Negligible friction, and linearization is carried out to the nonlinear function of formula (1), obtain three rank linear models of pneumatic system as shown in the formula (2):
Wherein x
1, x
2, x
3for system mode, u is control inputs, a
1, a
2, a
3, b is unknown model parameters, and control objectives makes the desired output y required by model output y tracking
d;
Step 2, set up the Backstepping Controller model of Pneumatic Position Servo System
Choose Backstepping Controller to the Pneumatic Position Servo System modular form (2) that upper step obtains, the Controlling model of Backstepping Controller is as shown in the formula (3):
Wherein
Be the estimated value of system unknown parameter, y
dfor desired output, the derivative of variable is asked for by Euler's formula, and concrete form is as shown in the formula (4):
Δ T is wherein the sampling time,
represent
in the value of k sampling instant;
Actual export controlled quentity controlled variable carry out amplitude limit such as formula (5):
Step 3, Pneumatic Position Servo System unknown parameters ' value to be estimated
Method of estimation is with reference to following formula (6):
λ > 0, β wherein
i> 0, i=1,2,3 is adaptive gain, and will estimate that the numerical value obtained is used for the parameter of real-time update Backstepping Controller modular form (3), computer is exported by the signal of D/A control amplifier, the displacement amount of the piston of real-time adjustment Rodless cylinder.
The beneficial effect of the inventive method is: 1) do not need to increase Pressure testing hardware or algorithm; 2) do not need the priori of object, just can implement effective control; 3) compared with more existing controlling methods, the control accuracy of better tracking effect and Geng Gao can be obtained.
Embodiment
Below in conjunction with the drawings and specific embodiments, the present invention is described in detail.
Pneumatic Position Servo System backstepping control method of the present invention, specifically implement according to following three steps:
Step 1, set up the model of controlled Pneumatic Position Servo System
With reference to Fig. 1, the structure of the controlled Pneumatic Position Servo System that the inventive method relies on is, the piston 1 of Rodless cylinder 3 is fixedly connected with load 2, and piston 1 also contacts with displacement detecting instrument 4 is corresponding simultaneously, and the output signal of location detector 4 sends into computer 7 by A/D conversion; Proportional valve 5 is five-way valve, the air cavity A side of Rodless cylinder 3 and air cavity B side respectively with two outlet sides (two po hold) the corresponding UNICOM of Proportional valve 5, Proportional valve 5 inlet end (pu end) is by reduction valve 8 and air pump 9 UNICOM, the valve element position of Proportional valve 5 is connected with the controller of amplifier 6, and amplifier 6 is connected by signaling line with computer 7.
Suppose that pneumatic system meets following condition: the working medium (air) that 1) system uses is perfect gas; 2) flowing state of gas flow when valve port or other restriction is constant entropy adiabatic process; 3) in same cavity volume, gas pressure and temperature are equal everywhere; 4) leakage do not considered is ignored; 5), during piston movement, the change procedure of two intracavity gas is adiabatic process; 6) bleed pressure and atmospheric pressure constant; 7) compared with system dynamic characteristic, the inertia of Proportional valve can be ignored.Obtain the mathematical model of proportional valve control Pneumatic Position Servo System of the present invention accordingly as shown in the formula (1):
Wherein
with
be respectively the gas mass flow flowing into cylinder A side (the air cavity A in Fig. 1) and B side (the air cavity B in Fig. 1), u is control signal, p
aand p
bbe respectively cylinder A side and B side pressure, A
aand A
bbe respectively cylinder A side and B side piston cross-section amasss (equal for both the Rodless cylinders in native system), y is piston displacement, y
0for piston-initial-position, M is slide block quality, F
ffor frictional force, f
a() and f
b() is respectively the nonlinear function relevant with B side external and internal pressure with cylinder A side, and K, R and T are dependent constant, and above-mentioned piston displacement y is obtained by displacement detecting instrument 4;
Negligible friction, and linearization is carried out to the nonlinear function of formula (1), obtain three rank linear models of pneumatic system as shown in the formula (2):
Wherein x
1, x
2, x
3for system mode, u is control inputs, a
1, a
2, a
3, b is unknown model parameters, and control objectives makes the desired output y required by model output y tracking
d.
Step 2, set up the Backstepping Controller model of Pneumatic Position Servo System
Choose contragradience (self adaption) controller to the Pneumatic Position Servo System modular form (2) that upper step obtains, the Controlling model of Backstepping Controller is as shown in the formula (3):
Wherein
Be the estimated value of system unknown parameter, y
dfor desired output, the derivative of variable is asked for by Euler's formula, and concrete form is as shown in the formula (4):
Δ T is wherein the sampling time,
represent
in the value of k sampling instant, such as, in formula (3)
then have
Actual export controlled quentity controlled variable carry out amplitude limit such as formula (5):
Step 3, Pneumatic Position Servo System unknown parameters ' value to be estimated
Method of estimation is with reference to following formula (6):
λ > 0, β wherein
i> 0, i=1,2,3 is adaptive gain, and will estimate that the numerical value obtained is used for the parameter of real-time update Backstepping Controller modular form (3), computer is exported by the signal of D/A control amplifier 6, the displacement amount of the piston 1 of real-time adjustment Rodless cylinder 3.
Embodiment
All parts in Pneumatic Position Servo System structure is selected respectively: the Rodless cylinder (model of employing is DGPL-25-450-PPV-A-B-KF-GK-SV) of FESTO company; Five-way Proportional valve (model of employing is MPYE-5-1/8-HF-010-B); Swept resistance formula linear displacement detecting instrument (model of employing is MLO-POT-450-TLF, position detection accuracy 0.15mm after coordinating with capture card); Computer (model of employing is CPU is P21.2GHz); Universal data collection card (model of employing is PCI2306); Other element such as air pump forms Pneumatic Position Servo System.The control software design of built-in computer adopts VB establishment, by the change curve of correlated variables in On Screen Display control procedure.
Control objectives is set to respectively
Reference signal 1:S curve
y
d=-(A/ω
2)sin(ωt)+(A/ω)t, (7)
The value of A is the value of 55.825, w is 0.5 π.
Reference signal 2: single frequency sinusoidal signal
y
d=111.65sin0.5πt, (8)
Reference signal 3: multifrequency sine signal
y
d=167.475sinπt+167.475sin0.5πt+167.475sin(2πt/7), (9)
+167.475sin(πt/6)+167.475sin(2πt/17)
The contragradience adaptive controller of employing formula (3)-Shi (6) carries out Control release, the controling parameters c in formula (3)-Shi (6)
1, c
2, λ, β
1, β
2, β
3value can repeatedly test examination and gather.
Be set to 50,50,1,1,1,1 in the present embodiment, control amplitude limit U
max=1.56V, when following the tracks of expectation target and being respectively formula (7)-Shi (9), steady track curve such as Fig. 2, Fig. 3, Fig. 4 provide.
Fig. 5-Figure 10 gives control effects when two kinds of modes (i.e. sliding moding structure 1 and sliding moding structure 2) tracking equating expections adopting prior art exports, and visible by contrasting, the inventive method tracking accuracy is higher.
Method reference literature [the Gary M.Bone of sliding moding structure 1, Shu Ning.Experimental Comparison of Position Tracking Control Algorithms for Pneumatic Cylinder Actuators [J] .IEEE/ASME Transactions on Mechatronics, 2007,12 (5): 557-561], its variable-structure controller is expressed as form:
u
s=-k
s1sat(S/φ) (12)
u′=u
eq+u
s(13)
Actual control is provided by formula (12), and the amplitude limit controlling to export provides identical with the inventive method such as formula (5), wherein model nominal parameters n
2=29.5544, n
1=218.436, n
0=0, m
0=5531.3305, controller parameter λ=50, k
s1=2.44 × 10
4, φ=0.05, controls result curve with reference to shown in Fig. 5-Fig. 7.
Method reference literature [the T.Nguyen of sliding moding structure 2, J.Leavitt, F.Jabbari, J.E.Bobrow.Accurate Slide-Mode Control of Pneumatic Systems Using Low-Cost Solenoid Valves [J] .IEEE/ASME Transactions on Mechatronics, 2007,12 (2): 216-219], its variable structure control method as shown in the formula:
u=-k
s2sgn(S) (15)
This existing method is for switch valve control cylinder, and actual control is provided by formula (15), k
s2the corresponding valve of=1, u=1 is opened, and the corresponding valve of u=-1 closes.
In the present invention, adoption rate valve, therefore gets k
s2=1.56(lies prostrate) the aperture amplitude of control ratio valve, controller parameter ξ=1, ω=50, realize controlling, and control result curve with reference to shown in Fig. 8-Figure 10.
Table 1 the inventive method and the error of existing controlling method when tracking type (7) outputs signal contrast
Table 2 the inventive method and the error of existing controlling method when tracking type (8) outputs signal contrast
In order to the control effects of the inventive method is described more intuitively, calculate tracking error quantitatively when following the tracks of different expectation target, error is defined as definition root-mean-square error and is:
Wherein N
1for comparing start time, N
2for comparing finish time, e
k=y (k Δ T)-y
d(k Δ T), Δ T is sampling time interval.For avoiding the impact of the different initial value of self adaptive control and random disturbances, having carried out test of many times, provide the experimental result of wherein five times to the tracking of often kind of input signal, its result such as table 1-table 3 provides.
In contrast table, result is visible, and when various expectation target, the average tracking error of the inventive method is all less than existing method.
Table 3 the inventive method and the error of existing controlling method when tracking type (9) outputs signal contrast