A partial summary is provided below, preceding the claims.
The inventions disclosed herein will be understood with regard to the following description, appended claims and accompanying drawings, where:
The following symbols and notations are used herein.
M: mass matrix;
C: damping matrix;
K: stiffness matrix;
BV: a matrix taking into account the effect of actuator locations;
v: vector of control force;
fd: vector of disturbance force;
z, ż, and {umlaut over (z)}: vector of displacement, velocity, and acceleration. zi: ith component of z;
z0: displacement vector of ground/base motion;
V: matrix of mode shapes;
W: matrix of mode participations;
ωi: ith nature frequency of the system;
{circumflex over (ω)}i: estimate of ωi;
ω: frequency;
ζi: ith mode damping ratio;
{circumflex over (ζ)}i: estimate of ζi;
Λ: a diagonal matrix composed of ωi2;
x, {dot over (x)}, and {umlaut over (x)}: vector of displacement, velocity, and acceleration in modal coordinates;
x0: displacement vector of ground/base motion in modal coordinates;
xi: ith component of x;
xi0: ith component of x0;
d: disturbance force vector in modal coordinates;
εir: the irth entry of V−1M−1CV;
{circumflex over (ε)}ir: estimate of εir;
u: control force vector in modal coordinates;
H(jω): frequency response function matrix;
σi: the ith sliding surface;
σ: a vector of dynamic manifold, which in some cases may be a sliding surface;
s: Laplace operator;
λi: a constant scalar;
Li(s), Gi(s), Q(s): dynamic linear operators;
a0, b0, b1: constant scalars;
ωs: natural frequency of a skyhook system;
ζs: modal damping ratio of a skyhook system;
ωg: resonant frequency of a geophone sensor;
ζg: modal damping ratio of a geophone sensor;
ηi: a constant scalar;
[\ \]: represents a diagonal matrix;
{circumflex over (ω)}i, {circumflex over (ζ)}i, {circumflex over (ε)}ir: estimation of ωi, ζi, εir;
Φm: boundary layer thickness;
{dot over ({circumflex over (x)}i: geophone measurement of velocity {circumflex over (x)}i;
Txi/xi0(s): transmission from xi0−xi;
ei: equals xi0−xi;
x(n−1): n−1th derivative (with respect to time);
P: a positive matrix;
kd: a positive definite matrix;
Y: a matrix for parameterization;
a: a vector of unknown parameters;
â,{circumflex over ({dot over (a)}: on line estimation of a and its time derivative;
ã,{tilde over ({dot over (a)}: error in on line estimation and its time derivative;
V(σ,ã), {dot over (V)}(σ,ã), {umlaut over (V)}(σ,ã): Lyapunov function and its time derivatives;
The following discusses many configurations, methods for designing control systems, and control methods. It is expressly stated herein that the inclusion of any of these items here is not an admission that any of these items are prior art, or that any of these references are from related or appropriate arts, or that it would have been appropriate or obvious to one of ordinary skill in the art to consider them either alone or in combination in connection with the inventions at the time the inventions were made. They have been identified and are presented here for explanatory purposes, gathered by hindsight knowledge of the inventions herein after the inventions were made. This is not a Background section. This is simply one part of this disclosure, designed to help readers understand the inventions that are disclosed herein.
Vibration isolation has been of great interest in the academic and industrial areas of precision machine tools, optical instruments, automobiles, aerospace, and civil structures. Passive isolators are often sufficient for high frequency isolation in many applications. But damping tradeoffs exist between the isolation performance at high frequency and that at low frequency. Soft mounting is preferred for seismic vibration, but it causes static misalignment and dynamic instability under payload disturbances. To improve the performance (especially at low frequencies), active isolators are suggested.
Many configurations and control methods have been developed for the active isolation. LQG/H2 control has been extensively used in suspension and isolation to suppress random excitations, see the survey by Hrovat (D. Hrovat) and the items therein. (All bibliographic items are cited herein by author(s) names, with full citations listed below, before the claims.) Karnopp (D. Karnopp, M. J. Crosby, and R. A. Harwood), (D. Karnopp) proposes the concept of skyhook damping, involving absolute velocity feedback.
By skyhook damping, it is meant, a configuration such a shown in
Feedforward control has been combined with feedback to improve the isolation performance and to reduce closed-loop bandwidth (T. E. Pare and J. P. How), (H. Yoshioka, Y. Takahashi, K. Katayama, T. Imazawa, and N. Murai).
In practice, since actual systems have many sources of uncertainty, robust controllers are required. H∞ and μ-synthesis are also used experimentally in active isolation (M. R. Bai and W. Liu). Alleyne and Hedrick (A. Alleyne and J. K. Hedrick) and Kim and Ro (C. Kim and P. I. Ro) use the skyhook model as reference, and employ adaptive control and sliding control to track a given skyhook force or states. An adaptive sliding control algorithm has also been developed by Wang and Sinha (Y. P. Wang and A. Sinha) for multi-degree-of-freedom microgravity isolation, where the reference model is defined as the ideal transfer matrix.
To further enhance the isolation performance, multi-stage isolation may become necessary, combining passive and active stages (K. Mizutani, Y. Fujita, and H. Ohmori), (S. J. Richman, J. A. Giame, D. B. Newell, R. T. Stebbins, P. L. Bender, and J. E. Faller). Further uncertainties exist in such systems. For instance, the mass, location, and dynamics of upper stages or the payload might be unknown or be time-varying. The structured mathematical modelling required in H2 or H∞ synthesis is hard to obtain in this context. Similarly, adaptive control (A. Alleyne and J. K. Hedrick), (Y. P. Wang and A. Sinha) can achieve some robustness, but non-parametric uncertainties and unmodelled dynamics could remain a problem. For example it might be desired to design an active isolation table and use it in different experiments, where the payload dynamics on the isolation table might not be easily parameterized.
A purpose of an invention hereof is to provide a robust controller for multi-degree-of-freedom isolation with uncertainties in payload dynamics and disturbances. In some cases herein, frequency-shaped sliding surfaces are exploited. They were proposed (in K. D. Young and U. Ozguner) for chattering attenuation. It has been determined by inventors hereof that such a specification is appropriate for shaping system performance directly in the frequency domain such as a skyhook dynamics target of vibration isolation. The controller can be synthesized based on the data of experimental modal analysis or a mathematical model.
Modal analysis and decomposition is introduced below. Multi-input multi-output (MIMO) control of the isolation system can be handled with single input single output (SISO) systems in modal coordinates, with coupling from other modes and payload dynamics taken as disturbances. Frequency-shaped sliding control is used to achieve skyhook isolation under modal uncertainties and payload disturbances, as well as coupling due to decomposition errors. Smooth boundary layer implementation of the controller is examined and quantified for the given isolation requirement. The effect of geophone dynamics and mode combination are also explored. Simulation results that verify the design are also presented below. The experiment verification of a disclosed routine of frequency-shaped manifold for vibration isolation is also presented below. The experiment verification is briefly presented following simulation results. Also disclosed is generalized design of frequency-shaped sliding surfaces from the point of view of linear compensator design and of contraction theory. This allows linear or nonlinear target dynamics of the same order as the nominal plant to be systematically specified. As used herein, the term sliding surface is a type of dynamic manifold.
Modal Decomposition
The mass, stiffness and damping properties of the isolation system can be obtained from mechanical design, and an analytical or finite-element model can theoretically be constructed. However, in practice it is hard to model the dynamics of the system accurately (even for the first stage) because of the uncertainties on the joints, contacts, damping, flexural modes, and payload. It is well-known that a mathematical model often doesn't match experimental measurements and can't be used in MIMO controller design with confidence. Bode/Nyquist-based approaches have been extended to MIMO system in part (see Hung and MacFarlane (Y. S. Hung and A. G. J. MacFarlane), but the results are not convenient for use in controller synthesis. A great deal of efforts has been invested in model development, such as system identification from experimental observation (L. Ljung), and model updating (J. E. Mottershead and M. I. Friswell) which tries to correct the finite element models using the test data. After the 1960's, experimental modal analysis (D. J. Ewins) has been developed as an important and powerful tool in structural dynamics. In the following, modal testing techniques are used to identify the modal frequency, damping, and mode shapes for the isolation system, which are then used in the control design.
The governing expression of the n-DOF isolation table with n force actuators takes the form
M{umlaut over (z)}+C(ż−ż0)+K(z−z0)=Bυυ+fd (1)
where M, C and K are, respectively, the mass, damping, and stiffness matrices of dimension n×n, BV is an n×n matrix taking into account the effect of actuator locations, fd is the vector of disturbance forces acting on the isolation table 110, such as external forces or dynamics of the upper stages and payload 120, and z0 is the vector of floor displacements. v is a vector of control force, generated by the actuators.
Since the mass matrix M is non-singular, the expression (1) is equivalent to:
{umlaut over (z)}+M−1C(ż−ż0)+M−1K(z−z0)=M−1Bυυ+M−1fd (2)
The matrix M−1K usually can be written in the diagonalized form:
M−1K=VΛV−1 (3)
where Λ is a diagonal matrix composed of ωi2, i=1, 2, . . . n, ωi, is the undamped modal frequency, and the matrix V is composed of the mode shape vectors.
If the following transformation, shown in Eq. 4, is applied to Eq. 2:
x=V−1z and u=V−1M−1Bυυ=W−1υ (4)
then, with control force vector u in modal coordinates, we have
{umlaut over (x)}+V−1M−1CV({dot over (i)}−{dot over (x)}0)+Λ(x−x0)=u+V−1M−1fd (5)
where V−1M−1CV is diagonal in the case of proportional damping C=αM+βK. The ith diagonal item of V−1M−1CV is 2ζiωi, where ζi is called the modal damping ratio. The irth off-diagonal entry is designated as εir, and ith element of vector V−1M−1fd as di. W−1 is the inverse of the mode participation matrix W. Then, Eq. 5 can be rewritten as:
The matrices V and W can be determined by modal testing, and need not be known a priori.
Experimental Modal Analysis
By using the modal transformation of Eq. 4, the governing Eq. 1 of 2n order has been decomposed into n second-order systems in modal coordinates. There are two advantages of such a modal decomposition. The first is that a MIMO control of high order system has been changed into lower order SISO problems, which can be handled more easily. These lower-order SISO problems also have clear physical meanings: one can design each loop to control the individual mode. Another advantage is that the mode shape and participation matrices V and W, respectively, used in the decomposition, and the parameters ζi and ωi can be obtained from experimental modal testing. In modal testing (D. J. Ewins) the matrix Bv is usually taken as identity. The idea for a general case of Bv is similar.
It is an invention hereof to use data acquired from modal testing to establish matrices V and W as above and then to modally decompose the system using matrices V and W having known entries, rather than trying to analyze the normal coordinate system and determine entries of the C, M and K matrices.
First, proportional damping is assumed. From Eq. 1 and Eq. 4, one obtains the forced response from v(jω) to z(jω) (without z0 and fd) as
where [\·\] indicates a diagonal matrix. That is, the frequency response function (FRF) matrix v(jω) to z(jω), takes the form
where Vi is the ith mode shape (ith column of V), and Wi is the ith column of W−1, which represents the contribution of input vi to the responses. (Therefore, W is called the mode participation matrix.)
Eq. 9 is a central relationship upon which modal testing techniques are based. Using modal testing devices, or directly using the actuators and sensors of the isolation system, one can measure the FRF matrix H(jw). Then, one can use curve fitting to extract the mode shape vectors Vi, modal participation vectors Wi, modal frequencies ωi, and modal damping ζi. From Eq. 9 one sees that the residue matrix ViWiT at each mode is a rank-one matrix. Therefore, theoretically all the modal parameters can be extracted from any column and any row of the FRF matrix. Specifically, if all the actuators and sensors are of collocated pairs, the FRF matrix will be symmetric, and W can be taken as V. (Because of scaling effects, W−1 V might not be the identity matrix, but W−1 V is diagonal). Multi-input multi-output modal analysis has also been proposed for large-scale structures in case some mode cannot be excited or observed. Between 1980 and 2004, different time-domain and frequency domain fitting methods have been developed, and software packages are also available, such as MODENT Suite™ available from ICATS Company of London, UK and STAR System™ available from Spectral Dynamics, Inc. of San Jose, Calif. Any appropriate time-domain or frequency domain fitting methods may be used as part of inventions hereof.
Proportional damping is a good approximation for most engineering structures which are lightly damped. For nonproportional damping, similar relationships as Eq. 9 exist, but the mode shapes are generally complex-value vectors. The undamped eigenvectors are not the damped eigenvector, since the nonproportionally-damped modes are not simply in the pattern of in-phase and out-of-phase.
In the foregoing analysis, it is assumed that number of actuators and number of measurements is equal to the number of degrees of freedom of the system. This is what is known as a complete modal model, which is convenient for theoretical study. In structure control, one might only be concerned with the first m modes by using m actuators and sensors. For an incomplete modal model, the foregoing procedure is still valid, by replacing the inverse of modal shape matrix V and modal participation matrix W in the transformation of Eq. 4, with the pseudo-inverse of size m×n. But some attention should be paid to the effect of performance-reducing control spillover and destabilizing observation spillover (see, e.g., (D. Inman), (M. Balas).
Other than by experimental modal analysis, the decomposition matrices may also be obtained by any other appropriate means, such as from the measured frequency response function matrix by using an optimal decoupling procedure developed in (D. Vaes, W. Souverijns, J. DeCupyper, J. Swevers, and P. Sas) based on Owens' theory of dyadic systems (D. Owens).
With the modal transformation of Eq. 4 discussed above, one can transform a MIMO high-order isolation problem into second-order SISO control, and all the parameters ωi, ζi, V, and W used in the modelling and decomposition can be obtained from experimental or theoretical modal analysis.
The governing Eq. 9 can be rewritten in modal coordinates as follows:
One may find, however, that the modes are not completely decoupled, because of the coupling by non-proportional damping. Another concern is that there are uncertainties in the natural frequencies ωi and damping ζi, due to the modal testing error or time-varying of structures. Third, the system is subjected to payload disturbance or upper stage dynamics other than unknown base excitation. Sliding control is an important robust control techniques established for dealing with model uncertainties and external disturbance (J. J. E. Slotine and W. Li), (J. Y. Hung, W. Gao, and J. C. Hung), (K. D. Young, V. I. Utkin, and U. Ozguner).
Sliding control is based on an idea of transforming an original control problem into one of using actuators to drive system trajectories onto a specific manifold in a state space. In essence, it replaces a possibly high-order problem by a 1st order problem, that of controlling the distance from the system state to the manifold, so that the distance is zero, or as close thereto as the actuators can achieve. As a nonlinear control method, sliding control has been mainly used in tracking control problems (see e.g., (J. J. E. Slotine and W. Li)). For vibration isolation/suspension, however, the main concern is frequency domain performance. In this context, an idea (A. Alleyne and J. K. Hedrick), (C. Kim and P. I. Ro), (Y. P. Wang and A. Sinha) is to choose a so-called reference plant according to the performance requirement, then control the real plant to track the states or certain outputs of the reference plant. This, however, has three shortcomings.
One shortcoming is that it usually requires the measurement of ground vibration, which is not practical in many cases, such as vehicle suspension systems. Another shortcoming is the tradeoff of bandwidth: wide bandwidth decreases tracking error, but can increase control activity or chattering. The third shortcoming is that the performance during the transient stage can not be guaranteed.
In the following, rather than defining and tracking a reference model, the sliding surface is directly designed to meet the requirement of frequency-domain performance. This approach does not have the foregoing shortcomings of a reference-tracking schedule.
For the ith mode of the isolation system in second-order form (Eq. 10), the measured variables are often the states xi−xi0 and {dot over (x)}i. (Actually, in the present example, xi−xi0 and {dot over (x)}i are in modal coordinates. Measurements are taken in normal non-modal coordinates, and then transformed to modal coordinates.) The conventional sliding variable σi can be defined as a static intersection in the state space:
σi=λi(xi−xi0)+{dot over (x)}i (11)
where λi is a constant. Then on the sliding surface σi=0, the system dynamics are
where s is the Laplace operator. That is, the floor vibration is attenuated at −20 dB/Dec above the frequency λi. However, for the second-order plant expressed above in Eq. 10, such vibration attenuation −20 dB/Dec as a first order system, attained by using a conventional sliding control, might not be fast enough.
The inventors hereof have realized that, using a dynamic linear operator, Li(s) rather than a constant λi, provides unexpected advantages. Li(s) is a dynamic linear operator that is a function of s, the Laplace operator. (Below, a related novel technique is discussed where a dynamic non-linear operator is used.)
A dynamic sliding surface (which is a type of dynamic manifold), σi, can be defined, in general, as:
σi=Li(s)(xi−xi0)+{dot over (x)}i (13)
If the system states (xi−xi0) and {dot over (x)}i are driven by actuators to the particular sliding surface, σi=0, then the dynamics become
Li(s) can be chosen to achieve most, possibly any, dynamics that are desired. For example, one can take Li(s)=(b1s+b0)/(s+a0). Then Eq. 13 can be rewritten as
On this sliding surface, if the states are driven to σi=0, the dynamics of Eq. 14 become
Thus, the second-order dynamics for the second-order plant described by Eq. 10 can be achieved by using the sliding surface described by Eq. 15 and driving the states to the surface at zero.
In fact, it is an aspect of an invention hereof that a sliding surface can be used to achieve nth order dynamics for a plant of order n or higher (and actually, also lower).
The idea of taking a sliding surface as a manifold defined by linear operators was proposed by Young and Ozguner (K. D. Young and U. Ozguner) but for the limited application of reducing the effect of unmodeled high-frequency dynamics in flexible manipulators. Therein, it has been interpreted as a low-pass filter and given the name frequency-shaped sliding surface. A similar strategy, called dynamic sliding mode, has also been proposed by Chan and Gao (S. Chan and W. Gao) and Yao and Tomizuka (B. Yao and M. Tomizuka) but for the limited application of robot manipulator control.
In the following, a physical interpretation of the frequency-shaped sliding surface is provided, as applied to vibration isolation.
Physical Interpretation: Skyhook
Assuming b1=0 in the frequency-shaped sliding surface expressed by Eq. 16, then the ideal dynamics (on the sliding surface) are
The mechanical system corresponding to this transmission is shown in
As shown in
To highlight the advantage of skyhook damping yielded by the frequency-shaped sliding surface,
The choice of Li(s)=b0/(s+a0) yields an ideal skyhook effect, which is desireable for vibration isolation. Similarly, the frequency-shaped sliding surface can also be designed to achieve faster vibration attenuation in the frequency domain at the cost of high control authority (energy expenditure). Further, and significantly, virtually any desired system response
can be achieved by choosing an appropriate form of dynamic linear operator L(s). In general, inventions herein use any of a wide variety of dynamic linear operators.
A more general approach for selection of Li(s) is given below.
Switching Control for Vibration Isolation
It is demonstrated above that ideal vibration (or disturbance) isolation performance is achievable once the dynamics of the system is driven to the sliding surface σi=0. Below, a corresponding switching control law is derived, in a manner similar to as shown in J. J. E. Slotine (J. J. E. Slotine).
From the choice of sliding surface shown in Eq. 13, repeated here for convenience as Eq. 19
σi=Li(s)(xi−xi0)+{dot over (x)}i (19)
one obtains, by differentiating
{dot over (σ)}i=sLi(s)(xi−xi0)+{umlaut over (x)}i (20)
Setting {dot over (σ)}i=0, and combining with a plant model such as described by Eq. 10, by solving for and eliminating the second derivative {umlaut over (x)}i, one can obtain the best approximation ûi of the continuous control law that achieves {dot over (σ)}i=0. That approximation is
where {circumflex over (ω)}i, {circumflex over (ζ)}i, {circumflex over (ε)}ir and {circumflex over (d)}i are respectively the estimations (nominal values) of the ith modal frequency, ith modal damping, irth entry of the damping matrix, and the external disturbance on ith mode. Note that {circumflex over (ω)}i and {circumflex over (ζ)}i can be obtained from experimental modal analysis, {circumflex over (ε)}ir and {circumflex over (d)}i can be taken as zero.
To ensure the plant dynamics reach the sliding C surface in finite time despite the model uncertainties and external force, a discontinuous term is added to control force ui:
ui=ûi−kisgn(σi) (22)
(To be clear, sgn(σi) is used here to represent the sgn function, which is: +1 if σi>0; 0 if σi=0; and −1 if σi<0.) The sliding condition is the same as that in the standard sliding control (J. J. E. Slotine and W. Li)
where ηi is a constant scalar. To guarantee this condition, ki must be selected as large enough:
where the maximum of ωi and ζi can be obtained practically, and {circumflex over (ε)}i
d=V−1M−1fd=V−1M−1VV−1fd=[\1/mi
where the modal mass mi can be obtained from experimental modal analysis. The maximum fd depends on the intensity of ground excitation and the properties of payloads or upper stages. An assumption is:
|fdi|=|fdi(t,ż,z,ż,ż0,z0)|≦Ψ0i(t)+Ψ1i(t)∥[żT,(z−z0)T]T∥ (26)
where ψ0i and ψ1i are constants and i=1, 2, . . . n. Since usually there is some a priori knowledge about the intensity of ground excitation and the upper payloads, one can often estimate a constant upper bound as ψ0i and take ψ1i=0. This requirement of a priori knowledge of disturbance upper bounds in sliding control may be relaxed by using disturbance observers (see, e.g., (N. Luo, J. Rodellar, D. De la Sen, and J. Vehi), (X. Chen, T. Fukuda, and K. Young)).
In isolation systems, the variables available are z−z0, ż and ż0, which may be measured with displacement sensors and geophones. Hence x−x0 and {dot over (x)}−{dot over (x)}0 can be obtained for switching control and use in Eq. 13, Eq. 21, Eq. 22, and Eq. 24. And the controller force v can be constructed as v=Wu. In some cases, it is difficult to measure ż0. In fact, it is only necessary to measure ż and z−z0. In cases where (for economic consideration) geophone sensors are not set on the ground, one can use
as an estimation of {dot over (x)}−{dot over (x)}0. Such an estimation will not create trouble in practice because the spectrum density of floor excitation is concentrated in low-frequency bandwidth (E. I. Rivin).
Many steps of the above derivation of the control force laws are somewhat specific for the plant described by Eq. 10. The steps shown are meant to be by example only, and not meant to be limiting.
Boundary Layer Analysis and Continuous Control
In sliding control, chattering is a main concern. Although frequency-shaped sliding control has the advantage of reducing the excitation of high-frequency, unmodeled dynamics, the robustness to chattering has only been implicitly addressed (K. D. Young, V. I. Utkin, and U. Ozguner). In the following, a smooth approximation of the switching control law is made, by choosing the proper boundary layer for σ around 0, in a manner similar to earlier work of an inventor (Slotine) hereof (J. J. E. Slotine).
A constant boundary layer thickness of φm can be considered. Outside the boundary layer the system dynamics are the same as for the switching control above. Inside the boundary layer
σi(t)=Li(s)(xi−xi0)+{dot over (x)}i=Φi(t)≦Φm (27)
Then
Hence, after transients, the displacement error due to the boundary layer interpolation is bounded by
where h(t) is the impulse response of
The notation ∥ ∥1 indicates the 1 norm of the system. (For a SISO, it is integration of the absolute value of the impulse response of the system.)
In particular, choosing Li(s)=bo/(s+a0) for the skyhook effect, inside the boundary layer, we have
In the immediately foregoing, it has been assumed that the absolute velocity of the platform (either modal or normal) can be measured perfectly. But in practice, the velocity measurement is only valid above some frequency. For a geophone sensor, the relation of measured signal {dot over ({circumflex over (x)}i and the velocity {dot over (x)}i generally takes the form
where ωg and ζg are the resonance frequency and damping ratio of the geophone sensor. Usually the damping ratio ζg of geophone sensor is close to the critical value 0.7. With the measurement {dot over ({circumflex over (x)}i, the actual sliding surface for Li(s)=b0/(s+a0) becomes
and the achieved dynamics from xi0 to xi on the sliding surface {circumflex over (σ)}i=0 becomes
Using the Routh-Hurwitz criterion, the stability of Eq. 33 is ensured if
where ωs and ζs are the resonance frequency and damping ratio of the ideal skyhook isolator. (ωs=√{square root over (b0)}, and ζs=a0/2√{square root over (b0)}.) If the damping ratio ζs of the ideal skyhook isolator is chosen as the critical value 0.7, close to ζg, then the geophone resonance frequency should be smaller than half of the resonance frequency of the ideal skyhook isolator. If the geophone resonance is very low (ωg/ωs<<1), then the ideal skyhook effect can be closely attained.
By designing dynamic sliding surfaces, the skyhook effect can be directly achieved for each mode of vibration. The entire performance of a multi-mode system is a combination of the individual modes. Suppose that the target dynamics (for example, a skyhook) of the ith mode is xi(s)/xi0(s)=Tx
z(s)=V[\Tx
Specifically as an example, if the target of each mode is chosen to be identical, Tx
In practice, identification errors also exist in the mode shape matrix V and participation matrix W. This yields mode coupling even in proportionally-damped systems. To explicitly take the effect of V and W errors into account in the framework of sliding control is challenging. Practically, one may check that the WH(jω)V−1 is diagonally dominant before using matrices V and W in controller design. In addition, the effect of some modal coupling can be reduced implicitly by encompassing it as part of disturbance di. Successful applications of experiment-based modal control have been reported, e.g., (H. Yoshioka, Y. Takahashi, K. Katayama, T. Imazawa, and N. Murai), (U. Stobener and L. Gaul), (MIT/Caltech LIGO Laboratory), yet the accurate identification of the modal shape matrix V and participation matrix W is still an important research topic.
The foregoing discussion has focused on using a single dynamic linear operator L(s) to define the frequency shaped sliding surface σi. However, it is also possible to introduce a second dynamic linear operator Qi(s), and to apply it to operate on the state of displacement {dot over (x)}i, as for instance
σi=Li(s)(xi−x0)+Qi(s){dot over (x)}i (35A)
Further, although it is not necessary to measure ground velocity {dot over (x)}0, if such measurement is made, a third dynamic linear operator Gi(s) can be applied, as for instance
σi=Li(s)(xi−x0)+Qi(s){dot over (x)}i+Gi(s){dot over (x)}0i, (35B)
to provide even more flexibility in designing σi.
Further, the foregoing has used as states the parameters xi−xi0 and {dot over (x)}i. The dynamic manifold σi is a function of the states of the system and one or more dynamic linear operators, which operate on at least one of the states. The parameters chosen for states are but an example. As is well known, the state of a system can be defined by more than one set of parameters, any one of which sets can properly constitute the states of the system. As used herein, states means this general definition, and is not limited to the states of xi−xi0 (relative displacement) and {dot over (x)}i (velocity).
A general process for designing a robust controller using a frequency shaped sliding surface will be discussed with reference to
The method is also applicable to any multi-DOF plant that can be decomposed into a plurality of modal plants, each defined by a second order equation. For such a method, Eq. 10 represents a single mode, which has been derived from decomposing a multi-modal system.
Further, the method is equally applicable to a single DOF plant.
The process begins 2100. Two somewhat independent pathways are followed initially and are thus shown in parallel. Along one pathway, the initial substantive step is to determine 2102 the governing equations for the plant, for example, as Eq. 1 above. A multi-DOF plant is discussed first, because that is more general. The steps for designing a controller for a single mode plant are a subset of those for designing a controller for a multi-DOF plant, and will be discussed below. The multi-DOF plant has n actuators and n DOF. The matrices V and W are pre-determined 2104, as discussed above. This can be done using either modal testing, theoretical modal analysis, or any other appropriate means. The multi-DOF plant is decomposed 2104, using any appropriate technique, into a plurality n of modal plants, of which an ith plant will be considered as representative. Analogous steps are carried out for the 1st, 2nd, . . . nth modal plants. A result of modal decomposition is determination of modal frequencies ω and damping ζ.
Using the matrices V and W, one can identify 2108 a SISO plant in modal coordinates, for instance as represented by Eq. 10 above.
Turning now to the other parallel pathway, performance requirements exist 2110, such as vibration isolation from specific frequencies, or from certain frequency ranges (e.g. high or low) or some other performance. Typically, the performance requirements are specified by a user, or dictates of a larger system of which the plant is a part. They may be described in words, or by other means. Target dynamics that correspond to the performance requirements are determined 2112, by the designer to match as closely as possible the performance requirements. For instance, as represented by mathematical equations or a curve on a graph such as is shown at
Step 2114 is to design a sliding surface σi in terms of at least one dynamic linear operator Li(s), that is a function of s, which operates upon at least one of: the difference between the output and the excitation; and the derivative of the output, such as shown at Eq. 13 above, σi=Li(s)(x−x0)+{dot over (x)}. (If the plant is not a modal plant, but is complete in itself, then all of these steps are performed, but the modal aspect is not present.) The sliding surface is chosen such that if σi=0, the plant will behave according to the target dynamics, as explained above.
This pathway is not fully independent of the other pathway, because it is necessary to know some minimal information about the plant to design σ. For instance, the order of the plant must be known.
The step of designing the sliding surface can be conducted according to any one of several different techniques 2114a–2114e. Some possible techniques for designing an appropriate sliding surface include, but are not limited to: pole/zero assignment 2114a; feedback/feedforward analysis 2114b (
A modal control force ui is determined 2116 by combining the modal plant in modal coordinates from the step 2108 of the first described pathway and σi from step 2114 of the second described pathway. The combination can be any appropriate set of steps that results in a control force law, such as at Eq. 21), that relates the force, ui to the states, x1−x0i, {dot over (x)}i.
This results in a modal force law for each of n modes. These modal force laws are combined 2118 to form an actuator force vector v having n entries, one for each actuator. The process ends 2120, as the non-modal control force controller has been successfully designed.
As has been mentioned, the process shown in
Eq. 21 is a reasonable control law. Thus, the process of designing a control law using a dynamic manifold is complete 2120. The designer can continue and refine the law, with a discontinuous term, as discussed above.
The steps of the process have been shown in the flowchart in a particular order. However, the order is not required. Some steps may be performed in a different order. Others may be combined, or eliminated in favor of equivalent sets of steps. Further, the step of designing a sliding surface σi may also include additional dynamic linear operators such as G(s) and Q(s), applied to {dot over (x)}1 and {dot over (x)}0i, as discussed above.
For a multi DOF plant, it is not necessary to control every mode according to an invention hereof, or, even, at all. It may be beneficial to control one or more modes using a controller designed as disclosed herein, and to control another using a conventional controller, for instance a P-I-D controller. Further, it may be reasonable to have another mode uncontrolled, for instance one whose natural frequency is much higher than any expected excitation frequencies.
In this section a 2DOF vibration isolator is taken as an example and demonstrates that a skyhook effect can be robustly achieved using modal decomposition and frequency-shaped sliding control.
As shown in
The maximum of off-diagonal damping in modal coordinates is taken as (2{circumflex over (ζ)}1{circumflex over (ω)}1,2{circumflex over (ζ)}2{circumflex over (ω)}2)=0.7.
The dynamics of upper stages/payload may be unknown or changeable. As discussed above, their effect can be considered as a disturbance force vector fd. It is reasonable to assume that the bound of |fd| could be obtained as
In this simulation, the upper stage/payload 120 is taken as a 2DOF system supported symmetrically on the isolation table 110 with a pair of spring-dashpots k3, c3; k4, c4, of 1500 N/m and 8 N s/m. Its mass is 125 kg (25% of the isolation table), and rotational inertia is 10 kg m2. The distance e3-4 between the spring-dashpot connections is 1.0 m, and the mass center mp of the upper stage is located directly above the geometric center gc of the isolation table 110.
The target dynamics zl/z0 and z2/z0 are chosen as a skyhook of frequency 0.1 Hz and damping ratio 0.7.
The controller can be designed using modal decomposition and a frequency-shaped sliding surface in which η1=η2=0.2.
From these figures, it can be seen that the ideal skyhook effect is attained under the uncertainties and disturbance. The control forces v1 and v2 of switching control are shown in
To reduce the chattering of control forces, the continuous control can be designed using the boundary layer as discussed above. The boundary thickness Φm can be taken as 5×10−6/∥h(t)∥1 (see Eq. 29) and replace sgn(σi) in Eq. 22 with a saturation interpolation sat(σi/Φm).
The peak error due to a boundary layer is less than Φm∥h(t)∥1=5 μm. The continuous control forces v1 and v2 are shown in
In
Experimental simulation results depicted in
Sliding Surface and Input-Output System
Simulation results in the previous section show that the ideal skyhook effect of isolation can be robustly attained with the frequency-shaped sliding control and modal decomposition. The procedure of designing the sliding surface, or equivalently the choice of Li(s), may be essentially one of pole and zero assignment. In other words, the designer would know the desired system performance in the frequency domain. The designer can use known pole and zero assignment techniques to design Li(s) to achieve the desired response. For example, b1=0 in Eq. 15, to put the zero at infinity, and a0 and b0 are chosen for the desired damping ratio and natural frequency of skyhook isolation. Though the SISO system is determined uniquely by pole, zero and gain, it is more general (e.g., an extension to MIMO sliding) and more convenient, to examine the input-output relation therein.
Eq. 28 shows the system dynamics of xi(t) under the inputs xi0(t) and Φi(t) (inside boundary layer Φi(t)=σi(t)). Eq. 28 can be rewritten as
The block-diagram of the system described by the above equation is shown in
It can be seen that the sliding surface in fact defines a control system: plant
controller Li(s), inputs xi0(t) and Φi(t). This system is familiar to control engineers, and thus, the sliding surface Li(s) can be designed using the classical Linear Time Invariant (LTI) control methodologies, according to the performance specifications. The system dynamics of xi(t) under the inputs xi0(t) and Φi(t) can also be written in the form of linear fractional transformation, as shown in
Thus, state-space LTI control techniques can also be used, such as H2/LQG, H∞ or 1 to design the sliding surface. These techniques are known to those skilled in the art of control design, as described in K. Zhou, J. Doyle and K. Glover, Robust and Optimal Control, Prentiss Hall, N.J. (1995). In addition, the spectrum of the ground noise can also be taken into account if one includes a shape filter of xi0 in the generalized plant. For a practical isolator, position alignment at low-frequencies is also required. This can be done by replacing xi0(t) in
The previous discussion does not include the term {dot over (x)}i0 in the design of sliding surface, but it can be included. If a geophone sensor is available on the ground, the frequency-shaped sliding surface described by Eq. 13 can be defined more generally as
σi=Li(s)(xi−xi0)+Gi(s){dot over (x)}i0+{dot over (x)}i (37)
where Gi(s) is another linear operator. In general, at least one of Li(s) and Gi(s) is a dynamic linear operator. The other can also be a dynamic linear operator, or may be a constant, including 0.
On the sliding surface σi=0, as shown schematically by
This system is a hybrid feedback and feedforward control. This is consistent with the fact that ground signals in vibration isolation are often used for feedforward.
Much of the foregoing has addressed controlling a plant to isolate it from vibration. A sliding surface defined in part by a dynamic linear operator has been examined which, when the system states are driven such that the sliding surface σi=0, achieves a desired system performance that constitutes a skyhook performance. The system performance is illustrated schematically with reference to
Furthermore, the foregoing has focused on isolating a mechanical plant from vibration. This also is just for explanatory purposes. The plant to be controlled might be subject to other types of disturbances that are not properly considered to be vibration, due, for instance more general type of motion, or vibration of position, or velocity, or acceleration.
Additionally, the inventions described herein of how to design a controller to control a modal plant or a multi-DOF plant by modal decomposition to a plurality of modal plants, are not limited to applications for mechanical plants. Any plant subject to inputs, having states and outputs, that can be characterized by differential equations that are both stabilizable and detectable can be controlled. Such applicable plants include but are not limited to any of the following, either pure, or combinations thereof: electrical, thermal, fluid, or any combinations, such as just to name one, electro-mechanical. They can also be used for chemical plants. They can be used to control natural systems, such as populations of living things (bacteria, pests, plants, animals for agriculture) whose populations grow and contract under the influence of external forces, such as food supply, and hazard disturbances, such as predation, pollution, etc. Of course, it would be necessary to identify what components are analogous to mass, stiffness, damping, etc. But this is within the skill of system dynamics engineers.
Nonlinear Target Dynamics
The foregoing has shown that a frequency-shaped sliding surface can directly achieve linear target dynamics (such as skyhook dynamics) of the same order as the nominal plant, and also that the design of such sliding surface may be thought of as a LTI control problem of feedback or feedback-feedforward.
In fact, the target dynamics can also be chosen to be nonlinear, and the sliding surface can be synthesized using contraction theory such as described in (W. Lohmiller and J. J. E. Slotine), (“Control system design for mechanical systems using contraction theory”). The following discusses generalizations of a method to design frequency-shaped sliding surfaces from the point of view of linear compensator design and of contraction theory. This allows linear or nonlinear target dynamics of the same order as the nominal plant to be systematically specified.
A single-input system is taken as an example. The system to be controlled is
x(n)=f(x, {dot over (x)}, . . . , x(n−1),t)+b(x, {dot over (x)}, . . . , x(n−1),t)u (39)
and the target dynamics can be taken as any contracting system
x(n)=g(x, {dot over (x)}, . . . , {dot over (x)}(n−1),t) (40)
To achieve this target one can define the sliding surface as
σ=x(n−1)+
where
{dot over (
where a(t) is a time varying, or invariant gain, or an operator, such that {dot over (σ)}−a(t)σ is contracting.
In this way a hierarchy of two nominally contracting systems is constructed,
{dot over (σ)}−a(t)σ=x(n)−g(x, {dot over (x)}, . . . , x(n−1),t) (42)
and one can design the control u to make a tend to zero under the plant uncertainty or disturbance.
The initial condition of {circumflex over (σ)} can be chosen as −x(n−1), such that σ is initially zero.
Furthermore, the target dynamics have been chosen to be of the same order as the system to be controlled. This may be natural, e.g., when the system is best controlled intermittently, or when it must follow a desired dynamic behavior, rather than desired trajectory, as in some robotic locomotion applications.
Adaptive Control Based on Frequency-Shaped Manifold
The frequency-shaped sliding control of vibration isolation can also be extended to adaptive control. For instance, continuing with a vibration isolation example, one can attain a desired multi-DOF skyhook isolation without identifying the modal parameters. Non-skyhook targets are also achievable, but a skyhook target is used here as an example. The following will summarize the adaptive control based on frequency-shaped manifold with fd=0. For the case fd is not zero (but is bounded), similar expression can be derived, with some slight revision.
The matrix B in the plant dynamics Eq. (1) is determined by the geometric location of the actuators and sensors, which is straight forward to obtain. Thus, typically the B matrix can be obtained off-line, and the matrices M, C and K are unknown. Now the designer would like to achieve target n DOF skyhook isolation in the form
{umlaut over (z)}+
where
A frequency-shaped or dynamic manifold vector σ with n entries in the state space can be defined:
σ=ż+(sI+
Frequency shaped manifold and dynamic manifold are used interchangeably herein. In this system, (sI+
σ=ż+L(s)(z−z0) (45A)
(Similar to the single mode case above, one sees that n DOF target skyhook effect of Eq. 44 is achieved once the system is driven to this manifold σ=0.)
By rearranging the unknown parameters from the matrices K, C, and M, into a column vector a, one can define a matrix Y as follows:
K(z−z0)+C(ż−ż0)−M(sI+
where Y has proper dimension composed of z−z0, and ż−ż0. In Eq. 46, the unknown parameters from the matrices K, C, and M show up linearly in vector a. Eq. 46 can be rewritten as
K(z−z0)+C(ż−ż0)−MLs(z−z0)=Ya (46A)
A positive-definite Lyapunov function may be chosen as
where the vector σ(t) is defined by Eq. 45, M is the mass matrix of the system (symmetric positive definite), P is a pre-selected (constant) symmetric positive definite matrix, and the vector of ã(t) is the error vector of on-line estimates of the parameters a: ã(t)=â−a.
Using Eq. 1 and Eq. 45, one obtains the time derivative of V(σ,ã):
Substituting the expression 46 for Ya into this Eq. 48, one obtains:
{dot over (V)}(σ,ã)=σ(t)T(Bv−Ya)+{tilde over ({dot over (a)}(t)TP−1ã(t) (49)
Therefore, the control-force vector can be
v=B−1[Yâ(t)−kdσ(t)] (50)
and the parameter adaptation law can be
{circumflex over ({dot over (a)}(t)={tilde over ({dot over (a)}=−PYTσ(t) (51)
such that {dot over (V)}(σ,ã)=−σ(t)Tkdσ(t) is negative semi-definite for some selected positive definite matrix kd of size n×n, and {umlaut over (V)}(σ,ã) is bounded. Thus, according to the Lyapunov theorems and Barbalet's lemma (J. J. E. Slotine and W. Li), one can conclude that σ(t) approaches zero as t approaches infinity, and hence the target dynamics of skyhook isolation Eq. 44 is achieved. The values for a can initially be assigned any reasonable value.
Thus, it is possible to control a plant to achieve a desired performance, without knowing all or even any of the entries of the M, C or K matrices. Further, it is not even necessary to have a nominal value for those parameters. If the Lyapunov and Barbalet conditions set out above are satisfied, then it is guaranteed that σ can be driven to 0, and to control the plant as desired. A point of contrast to the controller and method of designing a controller using a sliding surface, discussed above, is that with the sliding surface controller, it is beneficial that there be at least a nominal estimate for the parameters, as represented by the parameters having a ^ indicator, such as {circumflex over (ω)}i, discussed in connection with Eq. 21.
The expressions 50 and 51 represent the adaptive control of vibration isolation based on a frequency-shaped dynamic manifold. In contrast with the well-known model reference adaptive control, the adaptive algorithm of expressions 50 and 51 does not use any reference model, and there is no requirement to measure ground vibration. In addition, since there are additional states in the manifold σ (Eq. 45), the initial states can be chosen to ensure that σ(t=0)=0 and guarantee the transient performance. It is also possible to include a friction term in the governing Eq. 1, which will then turn up in the other equations, as would be understood.
The foregoing discussion regarding adaptive control has explained method steps of inventions hereof with respect to vibration isolation and achieving system performance in accord with a skyhook configuration. As with the techniques discussed above regarding a modal system, particularly one that represents a modal aspect of a multi-DOF system, the adaptive control methods discussed herein can be used to achieve many, virtually any desired performance requirements, without identifying modal parameters by choosing different L(s).
Further, the foregoing example has used a mechanical system as the plant to be controlled. Similar to the point made above regarding modal systems, the adaptive control methods discussed herein can be used to design a control law for any plant that can be described by differential equations that are both stabilizable and detectable. For instance, the plant can be any of those discussed above, such as electrical, thermal, fluid, combinations thereof, etc. And, it is not necessary to know the modal parameters that would correspond to the entries in the matrices M, C, and K, in the analogous, non-mechanical plant.
A general process for designing a controller using a dynamic manifold with adaptive control will be discussed with reference to
The process begins 2200. As with the robust method described above in connection with
Turning now to the beginning of the other parallel pathway, these steps are also very similar in general concept to those outlined above for the sliding surface method, and thus will not be discussed in as much detail. Performance requirements exist 2210 such as have been mandated by a customer, etc. Target dynamics corresponding to the performance requirements are then determined 2212, for instance as represented by a curve of a graph such as is shown at
Step 2214 is to design a frequency shaped dynamic manifold vector σ in terms of at least one dynamic linear operator L(s), that is a function of s (and perhaps two, including also G(s) or three, including Q(s), analogous to those described above for a modal case). The operator operates upon at least one of: the difference between the output and the excitation input; and the derivative of the output, such as shown at Eq. 45A above, σ=L(s)(z−z0)+ż. The dynamic manifold is chosen such that if the vector σ=0, then the plant behaves according to the desired target performance, as explained above.
The same possible techniques discussed above for designing an appropriate sliding surface may be used and are shown as 2214a–2214e for designing a dynamic manifold (except that the goal of the design is called a dynamic manifold, rather than a sliding surface, because there is no sliding phenomena occurring in the adaptive control case). A sub-step of designing 2214 a frequency shaped dynamic manifold according to one of the techniques shown (2214a–2214e) is designing a dynamic linear operator L(s) (and perhaps a second and third dynamic linear operator), also chosen so that if σ=0, the desired target performance is obtained.
Again, as mentioned regarding the modal case discussed above, the pathways are not wholly independent. Very basic facts about the plants must be used to design σ, such as the order of the plant.
The parallel streams of steps rejoin at parameter rearrangement step 2218.
The unknown parameters of the matrices M, C, and K are arranged in a column a. A matrix Y of proper dimension is defined so that the basic plant equation Eq. 1 can be rewritten 2218 in terms of Y and a, as at Eq. 46 and 46A. Initial values for the column a are assigned, which values need not be accurate.
Using the Lyapunov theorem and the Barbalet lemma, the control force vector v and the parameter adaptation law for {circumflex over ({dot over (σ)} are established 2230 and the process of designing a controller ends 2234.
Thus a controller has been designed without knowing the parameters of the K, M and C matrices. Steps of mathematical manipulation for establishing a control law using a dynamic manifold and driving it to zero are typically somewhat specific for the actual case under examination. A representative method has been discussed above. Others can be chosen that also result in a suitable control law.
Turning now to a brief discussion of a general method of controlling a plant to achieve a target performance that isolates the plant from vibration, reference to
The step of controlling the actuators to drive σ to 0 may be conducted in one of several ways. For instance, according to a sliding control method, the method can generate a force signal to drive the relevant actuator or actuators. The force signal may be based, in part on the sgn function of σ, such as at Eq. 22 above. If σ is greater than zero, this results in a force that drives the states to reduce σ, toward zero. If σ, is less than zero, this results in a force that drives the states to increase σ. The force may be a switching control force, as discussed above in connection with Eq. 22. Or, the force may vary continuously within a boundary layer of σ, also as discussed above at Eq. 27.
As is discussed above, it is also possible to use a method of adaptive control, where on-line adaptation of parameters is conducted. In that case, for example, some terms in the M, C and K matrices are unknown. An expression for a force vector can be developed in terms of σ, and the unknown terms, such as Eq. 50. Further, a parameter adaptation law, such as at Eq. 51, can be developed in terms of σ. While σ does not equal zero, the parameters are adapted, and the force rule changes. When σ reaches zero, the adaptation ceases, and the force rule remains stable.
Returning now briefly to a discussion of the general apparatus shown in
Experimental Verification of Frequency-Shaped Sliding and Adaptive Control of Isolation
The frequency-shaped sliding control and adaptive control for vibration isolation have been verified.
The frequency response controlled with the frequency shaped sliding surface is shown in
In
The chassis 2410 supports a payload 2420, such as a passenger compartment, for a driver. Typically, the payload 2420 is coupled to the chassis by a suspension 2403, which may be conventional, passive, or could also include aspects of inventions hereof.
As shown, z1 indicates displacement of the chassis at one suspension, and z2 indicated displacement of the chassis at the other suspension. One only will be discussed here. The wheel 2401 is coupled to the suspension through some appropriate couple 2408, such as a hub-bearing and axle. The point of the wheel that contacts the travel surface experiences a displacement z001, which is transmitted to the axle, itself having displacement z0. Typically, z0 does not equal z001, due to the transmission properties of the wheel and bearing coupling themselves, such as with a flexible tire, etc. In actual practice, those unsprung stiffness, mass and damping properties could be analyzed and combined with the dynamics of those above the wheels, so they are not shown separately here. However, they should be considered by a designer. Thus, for purposes of discussion here, z0 will be considered to be equal to z00.
As discussed above, sensors measure the relative displacement z1−z0, between the chassis end z, and travel surface displacement z0, and the derivative of absolute displacement z1. The sensors can be a gap sensor 2432 for measuring relative displacement, and a geophone sensor 2434 for measuring derivative of displacement. A geophone sensor could also be placed on the bearing couple or wheels axis 2408 to measure its displacement derivative but that is not necessary.
These sensors are coupled to a signal processor 2430, in which the controller software (or firmware or hardware) instructions resides. The controller takes as inputs the relative displacements and the vertical velocities, and generates as an output a signal to the actuators 2441, 2442, which generate a force as determined by the force law, to achieve the desired frequency response, for instance for a vehicle, isolation from vibration and motion of the bearing coupling due to variations in height of the road surface.
In the case of a vehicle, appropriate sensors at each actuator sense conditions, and send them to the signal processor 2430. The signal processor 2430 may follow steps discussed above that modally decompose the measured states, analyze them modally for single modes, generate modal force signals, which are then combined to a non-modal form before they are transmitted to the actuators. Or, the signal processor may analyze the signals in their non-modal form, using the techniques of adaptive frequency shaped dynamic manifold control discussed above, depending on the availability of modal parameters, model quality, processing capacity, etc., as a designer may choose.
The inventions disclosed herein can be used in the design of controllers for vibration isolation, as well as many other control problems. In the realm of vibration isolation, specific applications include support for precision instrumentation, vehicle suspensions, camera isolation from vehicles, such as helicopters.
The vibrating excitation can be a displacement, a velocity, an acceleration, or even other types of motion.
Inventions disclosed herein include methods of designing controllers and the control laws that define such controllers, as well as methods of controlling a plant, and controllers themselves that embody such control laws, and apparatus systems that include such controller to control hardware, or to control processes that can be defined by analogous equations and methods of controlling a plant. Thus, as an example, an invention hereof is a method to design a controller, and the control law that defines such a controller, to isolate a vehicle passenger compartment from vibration due to movement along the travel surface. A controller that accomplishes the isolation, as is a signal processor that accomplishes the isolation, is also an invention hereof, as is a larger system of sensors, actuators and a signal processor that manages input and output among the sensors and actuators, governed by the controller. Furthermore, the vibration isolated vehicle or instrument itself that embodies such a system of sensors, actuators and a controller, is also an aspect of an invention hereof. Inventions hereof also include instructions stored on a media capable of being read by a computer or signal processor or an appropriate peripheral device coupled to a signal processor, that comprise instructions for causing a signal processor or computer to perform the steps and functions of the methods described herein. Such media includes, but is not limited to: magnetic tapes, disc, optical disc, CD, DVD, tape, and any media developed in the future.
A robust control schedule is shown for multi-DOF vibration isolation. Modal decomposition handles the MIMO vibration control using SISO control method in modal coordinates. The system can be modeled from measured transfer functions via experimental modal analysis. Therefore the disclosed control schedule is applicable to controller synthesis based on measurement data or analytical modelling. Frequency-shaped sliding control, originally proposed in the literature for chatter reduction, is exploited instead to achieve performance requirements in the frequency-domain under plant uncertainty and payload/upper stage disturbances. The effect of boundary layer thickness on performance is quantified. Simulation results illustrate that the ideal skyhook effect of vibration isolation can be robustly achieved. Also disclosed is that the design of frequency-shaped sliding surfaces is equivalent to a control problem of feedback or feedback-feedforward, and that linear or nonlinear target dynamics of the same order as the system to be controlled can be also attained. Experiments also demonstrate that the sliding and adaptive control based on frequency-shaped sliding surface are very effective for vibration isolation. Control can be achieved without measuring the excitation, such as ground motion. Further, performance during the transient stage can be guaranteed. Also, control can be achieved even without knowing the values of entries for mass, stiffness and damping matrices. The methods of controller design can be used to design control for plants subject to disturbances other than only vibration. The plant can be mechanical, electrical, thermal, or any that can be described by system equations that are mathematically of the same character as are those that describe mechanical dynamic systems. The target dynamics need not be skyhook dynamics, but can be any dynamics desired, even non-linear.
A preferred embodiment of an invention hereof is an apparatus comprising an interface, configured to be coupled to an input of at least one actuator that is coupled to a plant that is subject to a vibration excitation, and that is to be controlled to achieve a target performance that isolates the plant from the vibration excitation. Coupled to the interface, is a controller, configured to generate signals to control the at least one actuator so that the states of the plant are such that, a dynamic manifold σ defined as follows, equals 0, where σ is defined: by a function of the states and a dynamic linear operator L(s), which is a function of the Laplace operator, s, and which operates on at least one of the states; and such that, if σ=0, then the target performance is achieved.
The controller can be for use with a plant that is subject to a vibration excitation x0 and operates with a performance x, the function that defines the dynamic manifold σ being of: first derivative of performance {dot over (x)}; and a difference between performance and vibration excitation, x−x0. The excitation may be a position vibration and the performance a position performance. Or, the excitation may be a velocity vibration and the performance is a velocity performance. Or, both the excitation and performance may be acceleration, or any other motion.
The linear operator L(s) may operate upon the state of difference between performance and vibration excitation, x−x0 or upon first derivative {dot over (x)} of performance or both, or different linear operators may operate upon each. A further linear operator can operate upon the excitation itself, or its first derivative, also in combination with one or two other linear operators, as above.
According to a useful embodiment, an invention is an apparatus wherein: the target performance is a skyhook supported performance; the dynamic manifold σ=L(s)(x−x0)+{dot over (x)}; and L(s)=(b0)/(s+a0), where b0 represents a spring coefficient and a0 represents a damping coefficient.
It is possible that the controller be configured to generate signals to control the at least one actuator, which signals are a function of the dynamic linear operator L(s). They may also be a function of the dynamic manifold σ.
According to yet another embodiment, the controller may be configured to generate signals to control the at least one actuator, which signals are a function of the Sgn function of the dynamic manifold σ, or the signals may be a continuous approximation of the Sgn function, within a boundary layer of sigma.
For most of the preceding embodiments, the plant may be a single input and single output plant, the states may be in normal coordinates, and the controller may be configured to generate a signal to control a single actuator.
The controller may be further configured to drive σ to equal 0 using sliding control, and, optionally, with a boundary layer.
With any embodiment, the plant may be of order n, and the target performance may have dynamics of order less than n, equal to n or greater than n. The plant may be multi DOF, and can be defined by one or more modes. A controller of the invention can be used to control one or more modes, any or all or only some of which are so controlled, for instance to achieve target performance of a damped skyhook.
The plant may advantageously be a vehicle, such as a passenger automobile, truck, train car, etc., or an instrument isolation table or other support. Embodiments of the invention may be very advantageously used for vibration isolation, for instance isolating a camera carried by a helicopter from vibration thereof.
With respect to quite a few preferred embodiments of inventions hereof, the plant is a multiple degree of freedom (DOF) plant having a plurality of actuators, and defined by a plurality of modes, each to be controlled to achieve a target modal performance. Further, the dynamic manifold σ is a set of modal dynamic manifolds σi, each corresponding to one of the plurality of modes; wherein: the controller is configured to generate, for each of the plurality of actuators, a signal that drives the actuator, so that the states of the multi DOF plant are such that, for each mode, a modal dynamic manifold σi equals 0. σi is defined: by a function of the states in modal coordinates and a modal dynamic linear operator Li(s), which is a function of the Laplace operator, s, and which operates on at least one of the states in modal coordinates; and such that, if σi=0, then the target performance is achieved.
Alternatively, another preferred embodiment is an apparatus, wherein the plant is one mode of a multi DOF plant, that has at least one actuator, the modal plant having states in modal coordinates and to be controlled to achieve a target modal performance. The dynamic manifold σ is a modal dynamic manifold σi. The controller is configured to generate, for the modal plant, a force signal ui in modal coordinates, to be a component of a force signal that is supplied to a modal combination module, configured to combine modal force signals corresponding to other modes and to generate signals to drive the at least one actuators so that the states of the modal plant are such that the modal dynamic manifold σi equals zero. σi is defined: by a function of the states of the modal plant and a modal dynamic linear operator Li(s), which is a function of the Laplace operator s, and which modal dynamic linear operator operates on at least one of the states of the modal plant; and such that, if σi equals zero, then the target modal performance is achieved.
According to a related preferred embodiment, the force signal ui is defined by a function of a predetermined estimation of a modal parameter, such as modal frequency, or a modal damping parameter, or mode participation or mode shape vectors.
With many of the mentioned embodiments, controller further comprises a modal combination module, configured to combine the corresponding force signals ui for at least two modes and generate for each of the plurality of actuators, a signal vi to drive the actuator, so that the states are such that σi=0.
Still another related embodiment sees the controller for use with a plant that is subject to a plurality of modal vibration excitations, a single such excitation being designated x0i, and where the plant exhibits a plurality of modal performances, a single such performance in modal coordinates being designated xi. The function that defines the modal dynamic manifold σi is of the states in modal coordinates of: first derivative of performance; and difference between vibration excitation and performance. Other combinations of parameters that constitute states of a system are also possible.
For the modal dynamic manifold σi, a linear operator Li(s) operates on the state of difference between performance and vibration excitation, both in modal coordinates. Or it may operate upon the state of derivative of performance, or both. Or, a different dynamic linear operator may operate on one or more of the states.
According to a particular embodiment, the modal target performance is a skyhook supported performance, and the modal dynamic manifold σi=Li(s)(xi−xi0)+{dot over (x)}i and Li(s)=b0/(s+a0), where b0 represents a modal spring coefficient and a0 represents a modal damping parameter.
With all of these embodiments, the controller may be configured to generate a signal that is a function of the dynamic linear operator L(s).
Still another preferred embodiment, is an apparatus where the controller is further configured to drive sigma a to zero while using adaptive control by updating estimation online of unknown parameters chosen from the group consisting of at least one component of matrices of: mass, damping, stiffness and friction. The controller may be for use with a multi DOF plant that is subject to a vibration excitation vector z0 and operates with a performance vector z, and the dynamic manifold σ is a vector function of the states of the plant. The states may be first derivative of performance ż, and difference between vibration excitation z0 and performance z or any other reasonable set of parameters that constitute states.
For the adaptive control apparatus, the dynamic linear operator L(s) can be a matrix that operates upon the state of difference between vibration excitation z0 and performance z, or of the derivative of performance, or both. Or, there can be more than one dynamic linear operators that operate upon each.
According to one adaptive control apparatus embodiment, the target performance is a skyhook supported damped performance. The dynamic manifold vector σ=L(s)(z−z0)+ż and L(s)=(sI+
For adaptive control apparatus embodiments, the order of the plant may be equal to, greater than, or less than the order of the target performance dynamics.
According to a particularly useful embodiment an invention is an apparatus having a parameter adaptation module, which applies a law {circumflex over ({dot over (a)} that is a function of the dynamic manifold σ. It also has a force rule generator, that generates as an output a force vector signal v, that is a function of σ and an estimation â of unknown parameters a from matrices K, C and M, which represent spring coefficients, damping parameters and mass, respectively, of the plant. If σ=0, the adaptation module retains any present parameter estimate, and if not, it applies the parameter adaptation law.
Another embodiment of an invention hereof is a method comprising the steps of: providing a dynamic manifold σ that is: i. a function of states of a plant that is subject to vibration excitation and is to achieve a target performance that exhibits a desired isolation of the plant from vibration; a function of a dynamic linear operator L(s), which is a function of the Laplace operator, s; and composed such that if the states are such that the dynamic manifold σ equals zero, the target performance is attained. The method further comprises: measuring the states and generating signals that correspond thereto; generating a signal that corresponds to the dynamic manifold σ, based on the state signals; and generating signals to at least one actuator that is coupled to the plant, to drive the at least one actuator so that the states of the plant are such that the dynamic manifold σ equals 0.
The states may be: the difference between a performance of the plant and a vibration excitation; and time derivative of position performance, or any other reasonable set of parameters that constitute states of a plant in a conventional sense. The method may be for use with a plant that is subject to a vibration excitation x0 and operates with a performance x, the function that defines the dynamic manifold being of the states of first derivative of performance {dot over (x)}, and a difference between performance and vibration excitation x−x0. The excitation may be a position vibration and the performance may be a position; or the excitation may be a velocity vibration, and the performance a velocity, or the excitation and performance may be any corresponding motions.
The variations mentioned above with respect to apparatus embodiments of inventions hereof also may be enjoyed with method embodiments. The dynamic manifold σ may be further defined by a dynamic linear operator Q(s), which operates upon a first derivative {dot over (x)} of performance.
A method of an invention may have a target performance that is a skyhook supported performance. The dynamic manifold σ=L(s)(x−x0)+{dot over (x)}; and L(s) is a dynamic linear operator equal to (b0)/(s+a0), where b0 represents a spring coefficient and a0 represents a damping coefficient.
Another method may further include the step of generating signals to control the at least one actuator, which signals are a function of the dynamic linear operator L(s). The signals may also be a function of the dynamic manifold σ, a Sgn function of the dynamic manifold σ or a continuous approximation of the Sgn function, within a boundary layer of σ.
Still another method of an invention is a method wherein the plant is a single input and single output plant, the states are in normal coordinates, and a signal is generated to control a single actuator.
Alternatively, a method of an invention is to control a multi DOF plant, having n modes, to achieve target performance having dynamics of order equal to or greater than n, or even less than n.
According to another method of an invention hereof, the disclosed techniques are used to control one or more modes of a multi DOF plant to achieve a skyhook suspended damped performance.
Still another method of an invention hereof is to control any such plant using sliding control, with, or without a boundary layer.
Various methods of inventions hereof are suitable for vibration isolation, for instance with traveling vehicles, such as automobiles or trucks, or isolating laboratory equipment from vibration, or cameras from vibration, such as from a helicopter mount.
A method of an invention hereof may be for where the plant is a multiple degree of freedom (DOF) plant, having a plurality of actuators, and defined by a plurality of modes, the plant to be controlled to achieve, for each mode, a target modal performance. Signals are benerated to actuators comprising the steps of: generating, for each of the plurality of modes, a force signal ui in modal coordinates; combining each signal ui with corresponding modal force signals for each other of the plurality of modes; and generating, for each of the plurality of actuators, a signal vi that drives the actuator so that the states of the multi-DOF plant are such that, for each mode, a modal dynamic manifold σi equals zero. The dynamic manifold σi is defined: by a function of the states in modal coordinates and a modal dynamic linear operator L(s), which is a function of the Laplace operator, s, and which operates on at least one of the states in modal coordinates; and such that, if σi=0, then the target performance is achieved.
A related method of an invention hereof is for use where the plant has states in modal coordinates, and is one mode of a multi degree of freedom (DOF) plant that has at least one actuator, the modal plant having states in modal coordinates and to be controlled to achieve a target modal performance. Signals to actuators are generated by: generating, for the modal plant, a force signal ui in modal coordinates; combining the signal ui with other force signals; and generating, for the at least one actuator, a signal vi that drives the actuator so that the states of the multi DOF plant are such that for the single mode, a modal dynamic manifold σi equals zero. The dynamic manifold σi is defined: by a function of the states in modal coordinates and a modal dynamic linear operator Li(s), which is a function of the Laplace operator, s, and which operates on at least one of the states in modal coordinates; and such that, if σi=0, then the modal target performance is achieved.
According to a related method, the step of generating a force signal ui comprises generating a signal that is based on a function of a predetermined estimation of a modal parameter, such as frequency, damping, or mode shape or mode participation vectors. Modal testing or theoretical analysis may be conducted to predetermine the estimation.
With a related embodiment the method is for use with a plant that is subject to a modal vibration excitation, in modal coordinates, being designated x0i, and where the plant provides a modal performances in modal coordinates being designated xi, further wherein the step of generating, for at least one actuators, a signal, comprises generating a signal that drives the at least one actuator so that a modal dynamic manifold σi=0, which dynamic manifold is defined by a function of the states in modal coordinates. The states may be any reasonable set of parameters, as mentioned above. The excitation may be any excitation, including without limitation a position vibration, a velocity vibration, an acceleration vibration, or vibration of any motion parameter, with corresponding performances.
According to one embodiment of an invention hereof, the method is to achieve, for at least one mode, a skyhook supported target performance. The modal dynamic manifold σi=Li(s)(xi−xi0)+{dot over (x)}i; and Li(s)=b0/(s+a0), where b0 represents a modal spring coefficient and a0 represents a modal damping parameter.
The modal force signal may be a function of the dynamic linear operator Li(s). Similarly may be the actuator signal force, or forces.
Another embodiment of an invention hereof generates signals to drive the actuators by using adaptive control to generate signals to drive σ to equal 0, while updating estimation online of unknown parameters chosen from the group consisting of at least one component of matrices of: mass, damping, stiffness and friction.
With a method embodiment of the inventions hereof, the plant is a multi degree of freedom (DOF) plant that is subject to a vibration excitation vector z0 and operates with a performance vector z, and the dynamic manifold σ is a vector function of the states of the plant. The states may be first derivative of performance ż, and difference between vibration excitation z0 and performance z, or any other set of parameters that constitute states.
According to a particularly useful embodiment, the target performance is a skyhook supported damped performance. The dynamic manifold σ=L(s)(z−z0)+ż; and L(s)=(sI+
With a particularly elegant embodiment of an invention hereof, generating signals to at least one actuator further comprises: applying a parameter adaptation law {circumflex over ({dot over (a)} for adapting unknown parameters â for unknown parameters a from matrices K, C and M, which represent spring coefficients, damping ratios and mass, respectively, of the plant. The adaptation law is a function of σ, composed such that: if σ is not equal to 0 changes values for the parameters; and if σ is equal to 0 retains any present estimate for the parameters. The method also entails generating a force vector signal v, that is a function of the dynamic manifold σ and the estimation â of unknown parameters a.
Various functions and steps have been discussed as being performed by a computer or a signal processor or a signal generator. However, it may be that it is reasonable to combine all processing functions within a single processor, and that is also considered to be included in the description of the individual processors mentioned. Also, conversely, operations that are discussed as being conducted in a single processor may theoretically be performed in more than one processor, whose outputs are combined and directed such that they operate in consort or a properly programmed general purpose computer or network of computers. This also is considered to be included in the description of individual processors with discrete functions. Rather than processors, perse, hardwired, dedicated circuits may be developed to achieve many of the functions described herein, and those too are considered to be included within the rubric of processor.
This disclosure describes and discloses more than one invention. The inventions are set forth in the claims of this and related documents, not only as filed, but also as developed during prosecution of any patent application based on this disclosure. The inventors intend to claim all of the various inventions to the limits permitted by the prior art, as it is subsequently determined to be. No feature described herein is essential to each invention disclosed herein. Thus, the inventors intend that no features described herein, but not claimed in any particular claim of any patent based on this disclosure, should be incorporated into any such claim.
Some assemblies of hardware, or groups of steps, are referred to herein as an invention. However, this is not an admission that any such assemblies or groups are necessarily patentably distinct inventions, particularly as contemplated by laws and regulations regarding the number of inventions that will be examined in one patent application, or unity of invention. It is intended to be a short way of saying an embodiment of an invention.
An abstract is submitted herewith. It is emphasized that this abstract is being provided to comply with the rule requiring an abstract that will allow examiners and other searchers to quickly ascertain the subject matter of the technical disclosure. It is submitted with the understanding that it will not be used to interpret or limit the scope or meaning of the claims, as promised by the Patent Office's rule.
The foregoing discussion should be understood as illustrative and should not be considered to be limiting in any sense. While the inventions have been particularly shown and described with references to preferred embodiments thereof, it will be understood by those skilled in the art that various changes in form and details may be made therein without departing from the spirit and scope of the inventions as defined by the claims.
The corresponding structures, materials, acts and equivalents of all means or step plus function elements in the claims below are intended to include any structure, material, or acts for performing the functions in combination with other claimed elements as specifically claimed.
The following items are referred to herein. To the extent permitted by applicable law, they are incorporated fully herein by reference. Incorporation by reference is not an admission that any listed item is prior art.
Benefit is hereby claimed to U.S. Provisional patent application No. 60/571,137 filed on May 14, 2004, which is hereby fully incorporated by reference herein.
Number | Name | Date | Kind |
---|---|---|---|
6721636 | Gade | Apr 2004 | B1 |
Number | Date | Country | |
---|---|---|---|
20050256613 A1 | Nov 2005 | US |
Number | Date | Country | |
---|---|---|---|
60571137 | May 2004 | US |