Abstract
Abstract
A novel and systematic approach for dynamic modeling and approximate constraint-following servo control of constrained mechanical systems under uncertainty is proposed. Fundamental equation of constrained mechanical systems is first obtained based on Udwadia-Kalaba approach which is applicable to holonomic and nonholonomic constrained systems no matter whether they satisfy the D’Alember’s principle. The uncertainty (possibly fast time-varying) in mechanical systems is bounded and the bound is unknown. Fuzzy set theory is used to describe the unknown bound. The performance requirement is modeled as servo constraints in second-order form. A model-based robust control is presented to approximately follow the servo constraints. The proposed control is deterministic and is not IF-THEN rules-based. The uniform boundedness and uniform ultimate boundedness of the tracking error are guaranteed, regardless of the uncertainty. A performance index (the combined cost, which includes average fuzzy system performance and control effort) is proposed based on the fuzzy information. The optimal design problem associated with the control can then be solved (explicitely or numerically) by minimizing the performance index. The resulting control design is systematic and is able to guarantee the deterministic performance as well as minimizing the cost.
Introduction
In order to control the constrained discrete mechanical system, the dynamic model should first be obtained. Obtaining equations of motion for constrained discrete mechanical systems is one of the central issues in multi-body dynamics. The problem has been energetically and continuously worked on by many scientists, engineers and mathematicians since constrained motion was initially described by Lagrange (1787). He invented the special Lagrange multiplier method to deal with constrained motion. However, the Lagrange multiplier method relies on problem-specific approaches to the determination of the multipliers and it is often very difficult to find the multipliers to obtain the explicit equations of motion for systems which have large numbers of degrees of freedom and a mass of non-integrable constraints. Gauss (1829) introduced a general, new principle of mechanics for handling constrained motion. Gauss’s Principle gives a clear description of the general nature of constrained motion in terms of the minimization of a function of the accelerations of the particles of a system. Formulations of the equations of constrained motion, when the constraints satisfy d’Alember’s principle, were independently offered by Gibbs (1879) and Appell (1899). Pars (1979) in his treatise on the analytical dynamics refers to the Gibbs-Appell equations as ‘probably the most comprehensive equations of motion so far discovered’. But Gibbs-Appell equations require a felicitous choice of problem-specific quasi-coordinates and suffer from similar problems in dealing with systems with a large number of degrees of freedom and many non-integrable constraints. Dirac (1964) developed, using Poisson brackets, a recursive scheme for determining the Lagrange multipliers for singular, Hamiltonian systems where the constraints do not exactly depend on time.
Udwadia & Kalaba (1992, 1996) obtained a concise, explicit set of equations of motion for constrained discrete dynamical systems which lead to a simple and new fundamental view of Lagrangian mechanics. They derived the fundamental equation of motion that describes the dynamics of constrained systems from Gauss’s principle which seems somewhat less popular than the principles of Lagrange, Hamilton, Gibbs and Appell. The equations can deal with holonomic and also non-holonomic constraints. Udwadia & Kalaba (2001, 2005) observed that all the above researches have used D’Alember’s principle as their starting point which indicates that the forces of constraints are considered to be ideal and the total work done by the forces of constraints under virtual displacement is always zero. This assumption works well in many situations and is regarded as the core of classical analytical dynamics, but it is not applicable when the constraints are nonideal. Thus, Udwadia & Kalaba generalized their previous equations to constrained mechanical systems that may not satisfy D’Alember’s principle.
In this paper, we use fundamental equation of constrained system proposed by Udwadia and Kalaba to get the dynamic equations of motion of the constrained mechanical system. According to this approach, the unconstrained system is first considered whose equations of motion can be obtained by Lagrangian mechanics in terms of the generalized coordinates. Then constraint equations is written in the form of second order. The dynamic equations can be obtained by imposing the additional generalized forces of constraint obtained from the second order constraint equations upon the unconstrained system. Based on the obtained dynamic model, robust approximate constraint-following servo control is used to realize the performance requirement modeled as servo constraints (also called active constraints, program constraints, prescribed constraints). That is to use a set of servo controls to generate the appropriate constraint force for the system to approximately obey the constraints.
For a mechanical system confined to a set of constraints, constraint forces are needed for the system to obey the constraints. In Lagrangean mechanics, the constraint forces are governed by d’Alembert’s principle. This is what Lagrange asserted the Nature would do (Papastavridis 2002). Over the past century and a half, key developments in Lagrangian mechanics include the Maggi equation (Maggi, 1901; Neimark & Fufaev, 1972), the Boltzmann and Hamel equation (Hamel, 1904, 1949; Neimark and Fufaev, 1972), the Gibbs and Appell equation (Appell, 1899; Gibbs, 1879; Hamel, 1949; Pars, 1979), and the Udwadia and Kalaba equation (Udwadia and Kalaba, 1996). However, the emphasis of all these developments mainly falls into the passive constraint (also called material constraint) problem in which the constraint is followed in a passive manner. That is, as the constraint is determined, the environment (such as the structure of the machine) can generate the required constraint force automatically. Taking a particle constrained to move on a table surface as an example, the table surface can automatically generate the constraint force to support the particle. One is not necessary to consider generating the constraint force. So, the generation of constraint force is often considered to be a design task: design the machine structure to generate the constraint force automatically.
We consider the issue of generation of constraint forces as a control task (that is servo constraint problem), rather than a design task. The servo constraint problem has rarely been studied in analytical mechanics. Perhaps because the concept of servos is relatively new in analytical mechanics. In the servo constraint problem, a set of servo controls are equipped to provide the required constraint force for the system to obey a set of required constraints. The servo constraint problem focuses on what the engineer should do, so that the constraints are followed. Earlier work of the servo constraint problem are mainly on precise model-based control design (Kirgetov 1967, Chen 2008). The engineer, however, is always limited to a rather confined domain of knowledge. As a result, uncertainty tends to be inevitable. Prominent efforts dealing with uncertainty can be found in (Song, et al . 2005, Tseng & Chen 2003, Wang, et al . 2004, Wang, et al . 2006).
Optimal robust approximate constraint-following servo control of constrained mechanical systems under uncertainty is proposed. The uncertainty (possibly fast time-varying) in mechanical systems is assumed to be bounded, but the bound is unknown. Fuzzy set theory is used to describe the unknown bound. The performance requirement is modeled as servo constraints in second-order form. With the uncertainty in presence and no restrictions on the initial condition, it is only reasonable to expect the system to follow the prescribed constraints approximately. The proposed control is deterministic and is not IF-THEN rules-based. The uniform boundedness and uniform ultimate boundedness of the tracking error are guaranteed, regardless of the uncertainty. From a different angle, we employ the fuzzy theory to describe the uncertainty in the mechanical system and then propose optimal robust control design of fuzzy mechanical systems.
The main contributions of the article are fourfold. First, Udwadia-Kalaba approach is described in detail. The procedure of obtaining fundamental equation of constrained motion is shown. Second, robust approximate constraint-following servo control of constrained mechanical systems under uncertainty is proposed. Third, a performance index (the combined cost, which includes average fuzzy system performance and control effort) is proposed based on the fuzzy information. The optimal design problem associated with the control can then be solved by minimizing the performance index. In the end, the resulting control design is systematic and is able to guarantee the deterministic performance as well as minimizing the cost.
Fundamental equation of constrained systems
According to Udwadia-Kalaba approach, first we should consider an unconstrained mechanical system whose configuration is described by the n generalized coordinates q : = [q
1, q
2, …, q
n
]
T
. Its equation of motion can be obtained, using Newtonian or Lagrangian mechanics, by the relation
Second, constraints present in the system should be considered. We shall assume that the system is subjected to h holonomic constraints of the form
The final step is to form the explicit equations of motion with constraints. Due to the presence of constraints, additional ‘generalized forces of constraints’ should be imposed on the system. So, the actual explicit equation of motion of the constrained system could be assumed to take the form:
Udwadia and Kalaba generalize D’Alember’s Principle to include forces of constraint that may do positive, negative, or zero work under virtual displacement at any instant time during the motion of the constrained system, that is to say, they extend the Lagrange’s form of D’Alember’s Principle to include nonideal constraints. Now, we denote the specified constraint force as (Udwadia & Kalaba 2001,2005). The constraint force does the work W = v
T
c (the same as the work done by ) in any displacement v which subjects to . So we write it down in the form of (we will omit arguments of functions where no confusions may arise from now on)
Udwadia and Kalaba have proved that the ideal constraint force takes the form
From (6), (7), (11) and (12), the explicit equation of motion that governs the evolution of the constrained system (including both ideal and nonideal constraints) is
When c is always zero, (13) reduces to the D’Alember’s Principle, which means the total work done under virtual displacement is zero, the constraints are ideal, the constraint force is
Consider the following constrained mechanical system under uncertainty whose fundamental equation can be obtained by Udwadia-Kalaba approach:
Here t ∈
The required performance is modeled as servo constraints (i.e. the control input serves as the constraint force to follow the constraint). We model the required performance as the following constraints:
Now the constraints are converted into second order form. Differentiating constraint equation (17) with respect to t yields
The servo constraint problem can now be stated as follows: Determine the servo control τ such that the resulting controlled system observes the constraint (18) approximately.
We first show the constraint force when there is no uncertainty in the mechanical system (16). Thus, σ is known.
The consistency is a necessary but not a sufficient condition to the servo constraint problem. That is, if the constraint equation (23) is not consistent, then there is no solution τ to the servo constraint problem.
We now consider the uncertainty of the mechanical system while designing the control τ. Suppose the matrices/vector M, Q, Q c can be decomposed asfollows:
We now consider the approximate constraint following problem. That is, it is possible that or (let , hence β ≠ 0). This may be due to modeling uncertainty. In addition, the system may not start with the constraint manifold in the beginning (i.e., β ≠ 0 as t = t 0). Consider the following robust control design:
uniformly bounded: For any r > 0, there is a d (r)< ∞ such that if , then for all t ≥ t
0. uniformly ultimately bounded: For any r > 0 with , there exists a such that for any as , where . Furthermore, as ɛ → 0.
We have shown that a system performance can be guaranteed by a deterministic robust control scheme. By the analysis, the size of the uniform ultimate boundedness region decreases as κ increases. As κ approaches to infinity, the size approaches to 0. This rather strong performance is accompanied by a (possibly) large control effort, which is reflected by κ. From the practical design point of view, the designer may be interested in seeking an optimal choice of κ for a compromise among various conflicting criteria. This is associated with the minimization of a performance index.
We use the fuzzy theory to describe the uncertainty quantitatively via membership function of uncertainty and this provides a possibility for the optimization of robust control.
We first explore more on the deterministic performance of the uncertain mechanical system. We know
Instead of exploring the solution of the differential inequality, which is often non-unique and not available, the above theorems suggests that it may be feasible to study the upper bound of the solution. The reason is, however, based on that the solution of (57) is unique.
We consider the differential equation
We know, , the right-hand side of (64) provides an upper bound of . This in turn leads to an upper bound of . For each τ ≥ t
s
, let
One may relate η (κ, t, t 0) to the transient performance and η ∞ (κ) the steady state performance. Since there is no knowledge of the exact value of uncertainty, it is only realistic to refer to η (κ, t, t 0) and η ∞ (κ) while analyzing the system performance. We also notice that both η (κ, t, t 0) and η ∞ (κ) are dependent on θ. The value of θ is not known except that it is characterized by a membership function.
We now propose the following performance index: For any t
s
, let
The optimal design problem is then equivalent to the following constrained optimization problem: For any t
s
,
For any t s , taking the first order derivative of J with respect to κ
A mechanical system under uncertainty subject to a class of (possibly nonholonomic) constraints is considered. Fundamental equation of constrained mechanical systems is obtained based on Udwadia-Kalaba approach which is applicable to holonomic and nonholonomic constrained systems no matter whether they satisfy the D’Alembert’s principle. The proposed robust control is motivated by the perfect constraint following control design which is based on the D’Alembert’s principle (the Nature’s action). It is proved that the robust control can render the system to follow the performance constraint sufficiently close (or approximately), even in the presence of uncertainty. Fuzzy description of uncertainties in mechanical systems is employed. The control is deterministic and is not if-then rules-based. The uniform boundedness and uniform ultimate boundedness of the tracking error β are assured. A performance index is proposed and by minimizing the performance index, the optimal design problem associated with the control can be solved. The resulting control design is systematic and is able to guarantee the deterministic performance as well as minimizing the cost.
Acknowledgments
The research is supported by “the Fundamental Research Funds for the Central Universities” (No. JZ2014HGBZ0336).
