![MathJax Logo](/templates/jsp/_style2/_tandf/pb2/images/math-jax.gif)
Abstract
This paper studies the energy-based approach for controller design of
-degree of freedom mechanical systems. In this approach, the Hamiltonian function, which is the sum of kinetic and potential energies of the system, is considered as the Lyapunov function for stability analysis. The stability analysis is done based on the port-controlled Hamiltonian (PCH) model. In this regard, two theorems are given and proved that the proposed controllers lead to
disturbance attenuation for both absolutely known system model and unknown ones with parametric uncertainties. In the case of parametric uncertainties, the energy-based controller has an adaptive approach. Performance of proposed controllers is illustrated through simulations taken on a 2-link robot manipulator system, which validate the theoretical achievements of this paper.
1. Introduction
Control of mechanical systems has been an important topic that attracts the attention of researchers due to their vast application areas, such as industrial, medical, space and marine (Shafiei & Binazadeh, Citation2014, Citation2015). Mechanical systems require high precision control in order to achieve their desired performance (Hakimi & Binazadeh, Citation2017). Even though, several items cause a complicated controller design procedure, including the nonlinear dynamic feature of mechanical systems, unavoidable risk of being exposed to external disturbances and parametric uncertainties, which stem from environmental factors and system identification failures.
Different robust methods have been proposed in Literature (Wang, Yang, & Yan, Citation2019; Wu & Lu, Citation2018; Wu, Lu, Shi, Su, & Wu, Citation2018). Among them, the controller is not only known in attenuating the effects of matched and unmatched disturbances, but it also is capable to attenuate the impacts of model uncertainties (Acho, Orlov, & Solis, Citation2001; Erol & Delibaşı, Citation2018; Orlov & Aguilar, Citation2014; van der Schaft, Citation2001). While, general solutions have been presented for
controllers (Gholami & Binazadeh, Citation2019a, Citation2019b; Li & Liao, Citation2018; Orlov & Aguilar, Citation2014; van der Schaft, Citation2001), the major drawback is the difficulty of solving HJI inequalities where in the design procedure leads to an infinite dimension problem (Krstic & Deng, Citation1998; Subbotin, Citation1995). This fact causes local solutions for many problems (Orlov & Aguilar, Citation2004). While global stability has been proved by means of other control methods (Chung, Fu, & Hsu, Citation2008; Kelly, Santibanez, & Loria, Citation2005).
Mechanical systems are highly nonlinear systems which are dynamically coupled (Binazadeh & Shafiei, Citation2016). Some parameter approximations in the modelling of these systems result in parametric uncertainty. Furthermore, some dynamics of the system may not be considered due to model simplification. In addition, the effect of external disturbances on mechanical systems is unavoidable. Authors of (Chavez Guzmán, Aguilar Bustos, & Mérida Rubio, Citation2015) have designed adaptive controller for
-degree of freedom robot manipulator system in spite of external disturbances. This goal is achieved by exploiting compensators or pre-compensators of gravitational forces. Furthermore, the design of adaptive tracking
controller for the mobile robot has been studied in (Sato, Yanagi, & Tsuruta, Citation2011) based on inverse optimal control strategy.
One of the important approaches in controller design for mechanical systems is energy-based control (Valentinis, Donaire, & Perez, Citation2015; Yang & Xian, Citation2019). Energy-based control laws are based on the stored energy in the system. The stored energy acts as the Lyapunov function and the nonlinear control methods which are based on the Lyapunov function may be applied in the energy-based control.
The essential step in exploiting the energy-based Hamiltonian approach is to transform the system into a PCH model. This issue firstly was introduced in (Maschke & Schaft, Citation1992). Generally, this technique uses properties of the internal structure of the actual system in designing controllers and gives a relatively simpler controller with better performance.
In this regard, this paper considers the design of controller based on the energy concept for
-degree of freedom mechanical systems to attenuate the effects of external disturbances and parametric uncertainties via an adaptive approach. The equations of the foresaid systems are considered in two cases. First, all parameters of the system are assumed to be known. In the second case, parametric uncertainties are considered in the system model. In both, disturbance inputs with bounded energies are considered. As the first step, system equations are transformed into PCH structure. Then, by utilizing the energy concept,
controllers are designed. The key contributions of this paper are summarized below.
This paper studies the energy-based
control design for disturbance attenuation which is applicable to a broad class of mechanical systems.
The proposed approach has also a robust manner in the face of parametric uncertainties.
The adaptive control is combined with the energy-based control to improve the robust performance in the presence of parametric uncertainties.
The proposed approach leads to relatively simpler controllers with better performance over the other robust control strategies.
Furthermore, the validity of the proposed approach is verified by using the simulation of a 2-link robot manipulator system.
2. Preliminaries
In this section, some necessary definitions are briefly reviewed.
Definition 2.1
PCH system
(Ortega, van der Schaft, Maschke, & Escobar, Citation2002): If dynamic equations of a system could be written in the following structure, then it is called a PCH system:
(1)
(1) where
is the state vector of the system and
is a skew-symmetric matrix (
), called the interconnection matrix. Moreover,
is the Hamiltonian function which is the sum of kinetic and potential energies of the system,
is a symmetric matrix known as damping matrix and
is the input matrix. One of the main benefits of the PCH system is that its Hamiltonian function
can be used as the Lyapunov function for the stability analysis of the systems.
Definition 2.2
Finite-gain ![](//:0)
stability
(Khalil, Citation2014): A dynamic system with the input signal and the output signal
is
stable with a finite-gain, if there exist a positive constant
and a nonnegative constant
such that the following inequality holds:
(2)
(2) the constant
is the
gain and
where
is the ith component of vector
. For
, the above inequality represents the
stability between the input
and the output
of the dynamical system and,
is called the
gain of the system.
3. Problem statement
In general, the motion equation of -degree of freedom mechanical systems is considered as below (Ortega, Loria, Nicklasson, & Sira-Ramirez, Citation1998):
(3)
(3) in which
is the position vector,
is the velocity vector,
is the inertia matrix,
is the coriolis and centripental forces vector,
is the potential forces vector,
is the input coupling matrix and
is the applied torque vector.
In fact, there exist a variety of systems with the structure of Equation (3) such as quadrotor (Zheng, Zhu, Zuo, & Yan, Citation2015), wheeled inverted pendulum (Delgado & Kotyczka, Citation2016) and many other mechanical systems.
In the presence of the time-varying external disturbances , the dynamical Equations (3) can be written as
(4)
(4) In this paper, the goal is to design an appropriate control law such that
and
converge to the desired values in spite of unknown energy-bounded disturbances. A tool to achieve this, is using the energy-based Hamiltonian concept. In this regard, it is necessary to transform the dynamical Equations (3) into the PCH structure, firstly.
4. Construction of PCH form for the nominal system
In this section, it is aimed to transform the nominal system (3) into the PCH form. The Hamiltonian function of the system (3) is
(5)
(5) where
is the inertia vector of the system and
. Moreover,
and
are kinetic and potential energies of the system, respectively and
(6)
(6)
(7)
(7) where
and
are introduced in (3).
The following lemma is employed in the procedure of constructing the PCH form.
Lemma 4.1
Wang & Ge, Citation2008
Assume that is a matrix function and
are constant vectors, then:
(8)
(8) in which
and
is defined as
(9)
(9) where
is the so-called row-swap matrix operator and is obtained by swapping the
th row with the
th row of the identity matrix
.
Based on Lemma 4.1, the following equation is obtained:
(10)
(10) Furthermore, taking the derivative of the Hamiltonian function with respect to
and considering
, one has
(11)
(11)
It is concluded that:
(12)
(12) Taking the time derivative of (12) and considering the nominal system (3) gives the following equation:
(13)
(13) according to (7),
. Replacing this relation in (13) results in:
(14)
(14) with regard to (10), (11), the above relation can be rewritten as bellow
(15)
(15) where
(16)
(16) Considering (11) and (15), one may write:
(17)
(17) by using properties of Kronecker product it is proved that
(the details is given by Wang and Ge (Citation2008))
If we define:
(18)
(18) then, relation (17) has the PCH form as follows:
(19)
(19) where
it is obvious that
and
.
5. Design of nonlinear ![](//:0)
controller for the nominal system
In this section, by using the PCH structure obtained in the previous section, an energy-based controller is designed to attenuate the impact of disturbances on the output of the system. In other word, a control law is designed such that, if
be an unknown disturbance input with finite
norm, then
norm of the output
stays bounded and there exists an attenuation ratio
between
norm of the disturbance input and output (refer to Definition 2.2). In this regard the following assumption is given:
Assumption 5.1:
The external time-varying disturbance vector belongs to
space. It means that
This is a common assumption for disturbance attenuation in the dynamical systems which states the external disturbance vector is energy bounded for all
.
By considering the output of the system as
(20)
(20) where
and
is a weighting matrix with full coloumn rank, then according to the PCH structure of the system (3), equations of system (4) can be written in the following PCH form:
(21)
(21) where
and
.
Definition 5.1
Asadinia & Binazadeh, Citation20192019
The dynamical system (21) is supposed to have disturbance attenuation property if the following condition holds for a positive constant
,
(22)
(22) where
and in what follows the notation
is assumed. The above relation is also called as
performance index. The task is the design of control law
for the system (21) such that the
disturbance attenuation property is satisfied for the closed-loop system. In this regard, the following theorem is given and proved.
Theorem 5.1:
For a defined disturbance attenuation ratio , if the following inequality holds:
(23)
(23) in which
is a positive-definite matrix, then if
be invertible the following control law satisfies the
performance index for the system (21):
(24)
(24) where
is a positive-definite matrix. Moreover,
is the pseudo-inverse of
.
Proof:
Substituting control law (24) into the system Equations (21) and taking into account that , the closed-loop system equations become:
(25)
(25) furthermore, since
it is concluded that
Thus:
(26)
(26) Considering the Hamiltonian function as the Lyapunov function candidate and taking its derivative along the trajectories of the closed-loop system (26), results in:
(27)
(27) whereas
is a skew-symmetric matrix (
), then
. Therefore,
(28)
(28) as
is assumed to be positive-definite,
and Equation (28) leads to the following inequality:
(29)
(29) According to the predefined output for the system (25), the relation (29) can be rewritten as
(30)
(30) Considering that
and by adding and subtracting
and
to the right-hand side of (30), one gets
(31)
(31) The right-hand side expressions of inequality (31) can be grouped as
(32)
(32) On the other hand, one has
(33)
(33) Considering (32) and (33), one may write:
(34)
(34) According to (23), the relation
holds. Since the first and the second expressions of the right-hand side of inequality (34) is non-positive, thus:
(35)
(35) Taking an integral on inequality (34) over the time-interval
leads to:
(36)
(36) Since
is a positive function and by assuming
, the following inequality is obtained:
(37)
(37) Therefore, the
performance index (22) is satisfied for the closed-loop system. This completes the proof.
Remark 5.1:
The convergence speed of the proposed control algorithm can be controlled by appropriate selection of the design matrices and
.
In what follows, the designed controller (24) is applied to a practical system and the simulation results are presented.
6. Design of nonlinear ![](//:0)
controller for 2-link robot manipulator
In this section, the effective performance of the proposed controller is evaluated by applying on a 2-link robot manipulator. The schematic of this system is shown in Figure .
Considering (4), is the vector of angular positions which are shown in Figure .
is the control torque and
is the external disturbance. Furtheremore, other parameteres of system motion equation is given as bellow (see Ge and Harris (Citation1998) for more details):
(38)
(38) where
is the mass of load,
and
are the mass of the first and second links, and
are the length of the first and second links,
(
) are the distance from the first (second) node to the first (second) link center of mass which is illustrated in Figure .
Moreover, it is assumed that . If
, then condition (23) of Theorem 5.1 is satisfied.
Simulation results are given by considering ,
,
,
,
and
. Furtheremore,
and
are initial conditions and the desired value of the angular positions of the system, respectively. The applied external disturbance vector
are illustrated in Figure .
The time-responses of angular positions are shown in Figure . As seen, the proposed controller has a robust manner in the face of external disturbances and the angular positions move toward their desired values. The time responses of the applied control vector are also illustrated in Figure where
7. Construction of PCH form in the presence of parametric uncertainties
In this section, it is intended to design a control law such that in addition to disturbance attenuation be robust against parametric uncertainties of the system. For this purpose, it is necessary to transform equations of the system with parametric uncertainty to PCH structure. Dynamic equations of a system with uncertainty is similar to (3). In this case, it is assumed that matrix contains unknown parameters.
Assumption 7.1:
The unknown part of is linearly dependent to the unknown vector
. In the other word, the matrix
exists such that:
(39)
(39) where
is the known separable part.
In this case, the Hamiltonian function of the system is considered as follows:
(40)
(40) in which
is the estimated value of
which will be obtained through the appropriate adaptation law. Moreover,
and
represent the kinetic energy (defined in (6)) and the virtual potential energy of the system where
is defined as
(41)
(41)
Furthermore,
and
are positive-definite matrixes. The following pre-feedback law transforms system equations to the desired PCH structure:
(42)
(42) with the following adaptation law:
(43)
(43) where
is a positive-definit matrix and must be determined. Moreover,
is an additive control term and is designed in the following such that guarantees the satisfaction of the
performance index.
According to (40) and (41) and by applying Lemma 4.1:
(44)
(44) Furthermore,
, thus
. Therefore, according to system Equations (3) and the relation (38), it is concluded that:
(45)
(45) By substituting the control law (42) into (45), the following relation is obtained:
(46)
(46) Since
the above relation can be rewritten as follows:
(47)
(47) Considering the relation (47) beside the relation
and the adaptation law (47), one may write
(48)
(48) in which:
(49)
(49) and similar to the previous discussion
. By defining:
(50)
(50) equations of system (48) by considering the parametric uncertainties in the model are obtained as
(51)
(51) where
(52)
(52) It is obvious that
and
.
8. Design of the energy-based adaptive ![](//:0)
controller
In this section, by means of the achieved PCH structure in the previous section, a control law is designed for the system to attenuate the disturbances. The obtained PCH structure (51) by considering disturbance in the system changes to:
(53)
(53) in which
.
The task is the design of control law for the system (53) such that
disturbance attenuation property is satisfied for the closed-loop system. In this regard, the following theorem is given and proved.
Theorem 8.1:
For a defined disturbance attenuation ratio , if the following inequality holds:
(54)
(54) Then, control law (55) leads to
disturbance attenuation for the system (53):
(55)
(55) where
is a positive-definite matrix.
Proof:
Applying the control law (55) to the system (53) gives the following closed-loop equations:
(56)
(56) Choosing the Hamiltonian function of the system as the Lyapunov function candidate and taking its derivative along trajectories of system (56) yields to:
(57)
(57) Since
is a skew symmetric matrix, then
. therefore:
(58)
(58) For
then
. Therefore (58) results in:
(59)
(59) according to the output defined for the system (56):
(60)
(60) since
and by adding and subtracting expressions
and
:
(61)
(61) grouping the right-hand side expressions of (61) yield to:
(62)
(62) Since,
The inequality (62) can be represented as
(63)
(63) According to relation (54),
. Since the first and the second expressions of the right-hand side of (63) are non-positive, thus, the following inequality is obtained:
(64)
(64) Taking an integral on both sides of (64) gives:
(65)
(65) since
is positive-definite and by assuming that
, the relation (65) leads to:
(66)
(66) Therefore, it is inferred that:
(67)
(67) which means that the
performance index is satisfied for the closed-loop system. This completes the proof.
In what follows, the effectiveness of the proposed adaptive controller in attenuation of external disturbances is shown through simulations.
9. Design of nonlinear adaptive ![](//:0)
controller for 2-link robot manipulator
In order to investigate the performance of the proposed adaptive controller, simulations are taken on the previous 2-link robot manipulator. In this case, is considered as an unknown parameter and one has
(68)
(68) and
where
. Simulations are done by similar parameters and disturbance inputs (refer to Figure ) as those considered in Section 6. The demanded performance of the proposed adaptive controller in moving the system to the desired angular position despite disturbance inputs and parametric uncertainty. Figure shows the time-responses of the angular positions. As seen the proposed energy-based control has a robust manner and the control goal is achieved in the presence of parametric uncertainty and external disturbances. The time-responses of control inputs are also illustrated in Figure .
10. Conclusion
This paper studied the energy-based controller for
-degree of freedom mechanical systems. Two different cases were considered and two theorems were given to guarantee the disturbance attenuation and satisfication of the
performance index based on the Hamiltonian function. In the case of parametric uncertainties, the adaptive approach was also used to obtain a robust manner. Moreover, simulation results on a 2-link robot manipulator were provided to evaluate the performance of proposed controllers in attenuation of applied
disturbances. Studying the proposed method based on output feedback or observer-based control are suggested for future works.
Disclosure statement
No potential conflict of interest was reported by the authors.
References
- Acho, L., Orlov, Y., & Solis, V. (2001). Non-linear measurement feedback H∞-control of time-periodic systems with application to tracking control of robot manipulators. International Journal of Control, 74(2), 190–198. doi: 10.1080/00207170150203516
- Asadinia, M. S., & Binazadeh, T. (2019). Finite-time stabilization of descriptor time-delay systems with one-sided Lipschitz nonlinearities: Application to partial element equivalent circuit. Circuits, Systems, and Signal Processing. doi: 10.1007/s00034-019-01129-7
- Binazadeh, T., & Shafiei, M. H. (2016). Novel approach in nonlinear autopilot design. Journal of Aerospace Engineering, 29(1), 04015017. doi: 10.1061/(ASCE)AS.1943-5525.0000500
- Chavez Guzmán, C. A., Aguilar Bustos, L. T., & Mérida Rubio, J. O. (2015). Analysis and synthesis of global nonlinear controller for robot manipulators. Mathematical Problems in Engineering, 2015, 410873. doi: 10.1155/2015/410873
- Chung, W., Fu, L. C., & Hsu, S. H. (2008). Motion control. London: Springer.
- Delgado, S., & Kotyczka, P. (2016). Energy shaping for position and speed control of a wheeled inverted pendulum in reduced space. Automatica, 74, 222–229. doi: 10.1016/j.automatica.2016.07.045
- Erol, B., & Delibaşı, A. (2018). Fixed-order H∞ controller design for MIMO systems via polynomial approach. Transactions of the Institute of Measurement and Control, 41(7), 1985–1992. doi: 10.1177/0142331218792411
- Ge, S. S., & Harris, C. J. (1998). Adaptive neural network control of robotic manipulators. Singapore: World Scientific.
- Gholami, H., & Binazadeh, T. (2019a). Observer-based H∞ finite-time controller for time-delay nonlinear one-sided Lipschitz systems with exogenous disturbances. Journal of Vibration and Control, 25(4), 806–819. doi: 10.1177/1077546318802422
- Gholami, H., & Binazadeh, T. (2019b). Robust finite-time H∞ controller design for uncertain one-sided lipschitz systems with time-delay and input amplitude constraints. Circuits, Systems, and Signal Processing, 38(7), 3020–3040. doi: 10.1007/s00034-018-01018-5
- Hakimi, A. R., & Binazadeh, T. (2017). Robust generation of limit cycles in nonlinear systems: Application on two mechanical systems. Journal of Computational and Nonlinear Dynamics, 12(4), 041013. doi: 10.1115/1.4035190
- Kelly, R., Santibanez, V., & Loria, A. (2005). Control of robot manipulators in joint space. London: Springer.
- Khalil, H. K. (2014). Nonlinear control. Upper Saddle River, NJ: Prentice Hall.
- Krstic, M., & Deng, H. (1998). Stabilization of nonlinear uncertain systems. London: Springer.
- Li, L., & Liao, F. (2018). Design of a robust H∞ preview controller for a class of uncertain discrete-time systems. Transactions of the Institute of Measurement and Control, 40(8), 2639–2650. doi: 10.1177/0142331217708239
- Maschke, B., & Schaft, A. V. (1992). Port-controlled Hamiltonian systems: Modeling origins and system theoretic properties. IFAC Symposium on NOLCOS, 25(13), 359–365.
- Orlov, Y. V., & Aguilar, L. T. (2004). Non-smooth H∞-position control of mechanical manipulators with frictional joints. International Journal of Control, 77(11), 1062–1069. doi: 10.1080/0020717042000273087
- Orlov, Y. V., & Aguilar, L. T. (2014). Advanced H∞ control: Towards nonsmooth theory and applications. New York, NY: Birkhäuser.
- Ortega, R., Loria, A., Nicklasson, J., & Sira-Ramirez, H. (1998). Passivity-based control of Euler-lagrange systems. London: Springer.
- Ortega, R., van der Schaft, A., Maschke, B., & Escobar, G. (2002). Interconnection and damping assignment passivity-based control of port controlled Hamiltonian systems. Automatica, 38(4), 585–596. doi: 10.1016/S0005-1098(01)00278-3
- Sato, K., Yanagi, M., & Tsuruta, K. (2011). Adaptive H∞ trajectory control of nonholonomic mobile robot with compensation of input uncertainty. IEEE international Conference on Control Applications (CCA), Denver, CO (pp. 699–705).
- Shafiei, M. H., & Binazadeh, T. (2014). Movement control of a variable mass underwater vehicle based on multiple-modeling approach. Systems Science & Control Engineering: An Open Access Journal, 2(1), 335–341. doi: 10.1080/21642583.2014.901929
- Shafiei, M. H., & Binazadeh, T. (2015). Application of neural network and genetic algorithm in identification of a model of a variable mass underwater vehicle. Ocean Engineering, 96, 173–180. doi: 10.1016/j.oceaneng.2014.12.021
- Subbotin, A. I. (1995). Generalized solutions of first-order PDE’s—The dynamical optimization perspective. Boston, MA: Birkhäuser.
- Valentinis, F., Donaire, A., & Perez, T. (2015). Energy-based motion control of a slender hull unmanned underwater vehicle. Ocean Engineering, 104, 604–616. doi: 10.1016/j.oceaneng.2015.05.014
- van der Schaft, A. J. (2001). L2-gain analysis of nonlinear systems and nonlinear state feedback H∞ control. IEEE Transactions on Automatic Control, 37(6), 770–784. doi: 10.1109/9.256331
- Wang, Y., & Ge, S. S. (2008). Augmented Hamiltonian formulation and energy-based control design of uncertain mechanical systems. IEEE Transactions on Control Systems Technology, 16(2), 202–213. doi: 10.1109/TCST.2007.903367
- Wang, Y., Yang, X., & Yan, H. (2019). Reliable fuzzy tracking control of near-space hypersonic vehicle using aperiodic measurement information. IEEE Transactions on Industrial Electronics. doi: 10.1109/TIE.2019.2892696
- Wu, Y., & Lu, R. (2018). Event-based control for network systems via integral quadratic constraints. IEEE Transactions on Circuits and Systems I: Regular Papers, 65(4), 1386–1394. doi: 10.1109/TCSI.2017.2748971
- Wu, Y., Lu, R., Shi, P., Su, H., & Wu, Z. G. (2018). Analysis and design of synchronization for heterogeneous network. IEEE Transactions on Cybernetics, 48(4), 1253–1262. doi: 10.1109/TCYB.2017.2688407
- Yang, S., & Xian, B. (2019). Energy-based nonlinear adaptive control design for the quadrotor UAV system with a suspended payload. IEEE Transactions on Industrial Electronics. doi: 10.1109/TIE.2019.2902834
- Zheng, Z., Zhu, M., Zuo, Z., & Yan, K. (2015). Controlled Lagrangians control for a quadrotor helicopter. 27th Chinese Control and Decision Conference (CCDC), Qingdao, China (pp. 6097–6102).