Real-Time Capable Control Strategy for Hydraulic Systems While Systematically Taking into Consideration Control (Rate) and State Variable Constraints
20190377371 ยท 2019-12-12
Inventors
- Steffen Joos (Walheim, DE)
- Matthias Bitzer (Stuttgart, DE)
- Knut Graichen (Heroldsberg, DE)
- Michael Hilsch (Gaertringen, DE)
- Adrian Trachte (Stuttgart, DE)
- Steffen Mutschler (Neu-Ulm, DE)
Cpc classification
F15B2211/6656
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B2211/634
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B2211/7052
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
G05B13/042
PHYSICS
F15B9/12
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B2211/665
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B9/09
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B2211/7051
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B13/044
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B2211/7656
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B2211/6336
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
International classification
Abstract
The invention relates to a method for generating a control variable trajectory for an actuator so as to influence an input variable of a system, wherein a set point is supplied to the output variable of the system of a trajectory planning procedure, which from the set point generates a trajectory of constrained input values for a filter integrator chain and a trajectory of flat desired states, wherein the trajectory of constrained input values and the trajectory of flat desired states are supplied to a flatness-based feedforward control procedure that generates therefrom the control variable trajectory for the actuator, wherein in the trajectory planning procedure so as to generate the trajectory of constrained input values at least one constraint is applied in dependence upon the trajectory of flat desired states.
Claims
1. A method for generating a control variable trajectory for an actuator so as to influence an input variable of a system, the method comprising: supplying a set point to an output variable of the system of a trajectory planning procedure that generates, from the set point, a trajectory of constrained input values for a filter integrator chain and a trajectory of flat desired states; and supplying the trajectory of constrained input values and the trajectory of flat desired states to a flatness-based feedforward control procedure that generates, from the trajectory of constrained input values and the trajectory of flat desired states, the control variable trajectory for the actuator, wherein at least one constraint is used in the trajectory planning procedure to generate the trajectory of constrained input values, the least one constraint being dependent on the trajectory of flat desired states.
2. The method according to claim 1, wherein the at least one constraint includes a control variable constraint.
3. The method according to claim 1, wherein the at least one constraint includes a constraint that is dependent on a control range of the actuator.
4. The method according to claim 1 further comprising: applying, initially, an output variable constraint to the set point.
5. The method according to claim 1, wherein the system is a hydraulic adjustment cylinder having a movable piston and the output variable is a position of the movable piston.
6. The method according to claim 1, wherein the actuator is an electrically controllable valve.
7. The method according to claim 6, wherein the at least one constraint includes a control variable constraint that is one of (i) a magnetic force constraint and (ii) a control current constraint to a value between a minimum value and a maximum value.
8. The method according to claim 6, wherein the at least one constraint includes a constraint of a valve spool position that is dependent on a control range of the actuator.
9. A computer for generating a control variable trajectory for an actuator so as to influence an input variable of a system, the computer configured to: supply a set point to an output variable of the system of a trajectory planning procedure that generates, from the set point, a trajectory of constrained input values for a filter integrator chain and a trajectory of flat desired states; and supply the trajectory of constrained input values and the trajectory of flat desired states to a flatness-based feedforward control procedure that generates, from the trajectory of constrained input values and the trajectory of flat desired states, the control variable trajectory for the actuator, wherein at least one constraint is used in the trajectory planning procedure to generate the trajectory of constrained input values, the least one constraint being dependent on the trajectory of flat desired states.
10. The computer according to claim 9, wherein the computer is configured to execute a computer program.
11. A non-transitory machine-readable storage medium configured to store a computer program for generating a control variable trajectory for an actuator so as to influence an input variable of a system, the computer program being configured to, when executed on a computer, cause the computer to: supply a set point to an output variable of the system of a trajectory planning procedure that generates, from the set point, a trajectory of constrained input values for a filter integrator chain and a trajectory of flat desired states; and supply the trajectory of constrained input values and the trajectory of flat desired states to a flatness-based feedforward control procedure that generates, from the trajectory of constrained input values and the trajectory of flat desired states, the control variable trajectory for the actuator, wherein at least one constraint is used in the trajectory planning procedure to generate the trajectory of constrained input values, the least one constraint being dependent on the trajectory of flat desired states.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0013] The invention is illustrated schematically in the drawing with reference to an exemplary embodiment and is described in detail below with the aid of the drawing.
[0014] In the drawings:
[0015]
[0016]
[0017]
DETAILED DESCRIPTION
[0018] The invention describes a general approach for the real-time trajectory planning procedure while taking into consideration control and state variable constraints for non-linear single-variable systems of any order. The new approach is suitable in particular for hydraulic systems and is used in an exemplary manner to control an inclined disc axial piston machine (AKM), such as for example in accordance with the invention DE102015224650A1.
[0019]
[0020] The pivot angle may be adjusted using the adjusting unit 130. The adjusting unit 130 includes in this case an adjustment cylinder 131 that engages with its piston 133 by way of example at a pivot cradle 101 of the axial piston machine 100. A position of the piston is identified by x.sub.K. The piston is subjected to a pressure difference p.sub.x=|p.sub.rp.sub.x| that may be adjusted using an electro proportional valve 132. The position x.sub.K of the piston 133 in the adjustment cylinder 131 represents the output variable of the system.
[0021] The adjusting unit 130 includes furthermore the electro proportional valve 132 having a coil or rather an electro magnet that is supplied with a current i.sub.Mag and a return spring 134 that is used to change a valve spool position x.sub.v. A coupling spring 135 produces a return movement of the piston position to the valve spool position.
[0022] For an axial piston machine, an electronic pivot angle feedback control unit that is superimposed with a mechanical control loop for the EP adjustment is configured as illustrated in principle by way of example in
[0023] A model-based feedback control unit design is used in a structure of two degrees of freedom for the superimposed pivot angle feedback control procedure. A flat-based feedforward control procedure 220 takes into consideration the EP adjustment and the superimposed mechanical control loop. An additional (optional) error feedback control unit (not illustrated) compensates for interferences and parameter irregularities.
[0024] The essential dynamics of the AKM is the piston position x.sub.k that is controllable via the control current l=i.sub.Mag and can be described in a simplified manner via a non-linear model with the flat state
z.sup.n
where n=2
in accordance with
c.sub.F represents the spring stiffness of the return spring, l.sub.0 the spring pretension converted in the adjustment path, l.sub.01 represents the spring pretension of the coupling spring converted into the adjustment path.
[0025] In this case, the system dynamics (1b) of the opening area A.sub.v(|x.sub.v|) of the valve in dependence upon the value of the valve tappet position |x.sub.v| and dependent upon its temporal change, which as the flow forces F.sub.jet, which subsequently act on the valve, may be applied by way of example across non-linear functional relationships or characteristic fields.
[0026] In particular, a characteristic field may be stretched across the opening area A.sub.v of the valve [in mm.sup.2] and the piston position x.sub.k [in mm], wherein the relationship may be by way of example measured or calculated across the opening geometry.
[0027] The flow force F.sub.jet may be calculated by way of example via the equation F.sub.jet(x.sub.V,p.sub.x)=2.sub.Vk.sub.jet cos(.sub.jet)A.sub.V(x.sub.V)p.sub.x with the orifice coefficient .sub.V, the correction factor k.sub.jet and the inflow angle .sub.jet (depending upon the construction).
[0028] Furthermore, in addition to the constants .sub.const, .sub.const and .sub.const the coupling spring and return spring and also the pressure difference p.sub.x have a direct influence on (1b) via the valve.
C.sub.F1 represents the spring stiffness of the coupling spring, A.sub.kA represents the pressure-effective piston surface in the adjustment cylinder, p.sub.x represents the oil density and d.sub.v represents the damping and accordingly the viscose friction coefficient.
[0029] In precise system theory terms, the pivot angle is the actual output y and the piston position x.sub.k is the flat output z. However in a good approximation, the pivot angle corresponds to the piston position. Since consequently the actual output y=z=z.sub.1=x.sub.k is identical to the flat output z, there is no zero dynamics in the model. However, it is also possible to use the invention if there is a stable zero dynamics. In this case, it is necessary to solve a stable differential equation in order to re-plan the command variable from y to z.
[0030] The control variable u of the reduced model (1) represents the magnetic force F.sub.mag in the valve which may be expressed for example with the aid of a function or via a characteristic field in dependence upon the actual control variable, the control current I and accordingly the control voltage U.
[0031] The position x.sub.v of the valve spool may be calculated by way of example by virtue of solving the non-linear equation
=.sub.const.Math.A.sub.v(|x.sub.v|).Math.sign(p.sub.rp.sub.x).Math.{square root over (|p.sub.rp.sub.x|)}.(2)
in dependence upon the flat state z.
[0032] A dynamic feedforward control procedure for the AKM may be indicated by way of example directly from the inversion of (1b). The trajectories that are required so as to achieve this feedforward control procedure may be generated with the aid of a state variable filter (ZVF) and accordingly a trajectory planner 210 that may be implemented by way of example as a delay element of the n.sup.th order. The dynamics of the ZVF may be predetermined by way of example via a filter time constant. The ZVF is considered in the controllable canonical form for the subsequent considerations. In order to be able to maintain constraints by virtue of controlling the AKM, it is necessary to take these constraints into consideration in the planned trajectories. For this purpose, the ZVF is structurally expanded (in the controllable canonical form). To be more precise, the input of the filter integrator chain 215 is dynamically constrained (cf.
[0033] The integrator chain 215 comprises a number n of integrators in order to obtain the flat output z* (cf. also 9a) from the constrained (n)-derivative .sub.Lim*(t) (n being the order of the system) by virtue of n-times upward integration. In this case, it is the set point for the flat output (and its time derivatives) that are required for realizing the flat feedforward control procedure (8).
[0034] Typically, control variable constraints are awarded the highest priority (in other words the corresponding constraint characteristic curve element 214 is placed at the last position) in order to guarantee that it is possible to realize the feedforward signal by means of the actuator.
[0035] The limits of the individual constraint characteristic curve elements are formulated below in an exemplary manner for the example of the AKM and may be used in general for any (hydraulic) systems with constraints.
[0036] So as to take into consideration (214) the constraints of the control current I.sub.minII.sub.max, these are initially formulated as constraints of the magnetic force F.sub.mag,min(I.sub.min)F.sub.magF.sub.mag,max(I.sub.max). In order to flatten the control variable u=F.sub.mag into saturation, the trajectory is planned in accordance with the system dynamics (1b) that are suggested with the limit values for the control variable. This results in the dynamic limits
[0037] The geometric constraint of the piston position x.sub.k,minx.sub.kx.sub.k,max, in other words the constraint in dependence upon a control range of the actuator, may be directly incorporated (211) into the trajectory planning procedure as a state constraint via a constraint of the reference in accordance with
y.sub.=x.sub.k,minx.sub.k,refx.sub.k,max=y.sub.(4)
[0038] The position constraint of the valve spool x.sub.v,minx.sub.vx.sub.v,max is taken into consideration (213) in the trajectory planning procedure as a state constraint in such a manner that the trajectory for x.sub.v is planned into saturation. For this purpose, the dynamic limits are configured as a closed-loop control rule for =z.sub.2 so as to ensure the constraint is maintained
[0039] The (time variant) set points z.sub.2,,ref or z.sub.2,,ref are produced in this case with the aid of the non-linear equation (2) and the corresponding state constraint. It is possible using the tuning parameter r.sub.,x.sub.
[0040] The qualitative progression of the constrained control procedure and the associated behavior of the controlled hydraulic system (AKM) in comparison to its behavior in the case of an unconstrained control procedure is illustrated in
Transferability to Constrained Trajectory Planning Problems for Non-Linear Input-Affine Single Variable Systems
[0041] A non-linear minimal-phase input-affine single variable system is considered below
{dot over (x)}=f(x)+g(x).Math.u,t>0,x(0)=x.sub.0(6a)
y=h(x),t0(6b)
with the state x.sup.n, the control variable u, and also the system output y. It is assumed that for the system (6) a flat output z(t)=p(x) and a diffeomorphism exist
z=(x)=[(x),.sub.f(x), . . . ,
.sub.f.sup.r-1(x)].sup.T,(7)
so that it is possible to design a flatness-based feedforward control procedure
by means of model inversion of (6). In so doing defines the Lie derivative.
[0042] In order to plan continuously differentiable desired trajectories for the feedforward control procedure, a state variable filter is used
the dynamics of which may be set for example using
with reference to the filter time constant T.
[0043] In the presence of (stable) zero dynamics, the reference for the output y must be re-planned to a reference for the flat output z by virtue of solving the differential equation
[0044] It is possible in the trajectory planning procedure for the flatness-based feedforward control procedure to take into consideration in principle polytopic constraints of the flat state
c.sub.z,k(z):=f.sub.z,k.sup.T.Math.zg.sub.z,k0,k=1, . . . ,n.sub.c,(11)
control variable constraints
and control rate constraints
[0045] The control rate may be described using an actuator model, for example via
with the actuator time constant .sub.Act. So as to take into consideration the constraints in the planning procedure, the input of the filter integrator chain (9a) is dynamically constrained (cf. also (212, 213, 214) in
[0046] For this purpose, a constraint characteristic curve element is implemented for each constraint type (for example control rate constraint, control variable constraint, constraint of the state with relative degree r), the serial sequence of which determines the prioritization. The following applies: the closer the constraint characteristic curve element is placed to the integrator chain input, the higher is its priority.
[0047] The individual dynamic limits of the constraints may be described as above using the example of the axial piston machine. In detail, the following limits apply for control variable constraints
and for the control rate constraints the following limits apply
[0048] In this case, the limits (16) are not designed solely with reference to the distance model (6) but rather with reference to the distance model (6) that is expanded by the actuator model (14). The following dynamic limits may be designed for state constraints
.sub.,k.sub.
.sub.,k.sub.
[0049] In order to maintain the k.sup.th state constraint (11) a feedback control unit
r.sub.k=[0, . . . ,0,r.sub.k(.sub.k), . . . ,r.sub.k(n)].sup.T.(18)
is designed so as to stabilize the flat states z.sub.i with i=.sub.k . . . n. In this case .sub.k is the index i precisely of this state z.sub.i that occurs in the k.sup.th constraint and has a minimal relative degree.
may be calculated in accordance with
under the condition r.sub.i=n+1i, f.sub.z,k(i)0, 1in,
[0050] Moreover, the following variables are produced
in dependence upon the polytopic state constraint (11), for which the corresponding limit is designed.
[0051] Finally, the sign (f.sub.z,k(.sub.k)){1,1} decides whether the k.sup.th state constraint is taken into consideration via an upper or lower limit (17).
[0052] For a detailed description reference is made to Joos, S.; Bitzer, M.; Karrelmeyer, R.; Graichen, K.: Prioritization-based switched feedback control for linear SISO systems with time-varying state and input constraints. Proc. European Control Conference, p. 2935-2940, 2018.
[0053] The invention renders it possible to plan a realizable trajectory that is close to (or rather at) the constraint. In accordance with the invention, compatible constraints are control variable and control rate constraints and also state constraints that may be formulated (at least approximately) as polytopic constraints of the flat state. The invention has real-time capability as a result of the continuous filter design and does not require any outlay with regard to numerical optimization. In accordance with the invention, it is possible via state constraints to form and maintain systematically safety limits. The invention renders it possible to influence how hard or soft the trajectory is planned into the state constraints. It is thus possible to avoid hard stops which depending upon the application may considerably reduce component wear (for example of valves). The trajectories that are planned using the invention produce (in the case of a sufficiently precise feedforward control procedure) realistic information regarding the prevailing system state as long as it is ensured that the controlled system is functioning in an error-free manner. This information may be used by way of example for (higher ranking) diagnostic functions.