Nonlinear backstepping design for the underactuated TORA system
Diantong Liu^{1} , Weiping Guo^{2}
^{1, 2}Institute of Computer Science and Technology, Yantai University, Yantai City, People’s Republic of China
^{1}Corresponding author
Journal of Vibroengineering, Vol. 16, Issue 2, 2014, p. 552-559.
Received 29 January 2013; received in revised form 23 November 2013; accepted 30 November 2013; published 31 March 2014
JVE Conferences
The nonlinear feedback cascade model of the underactuated translational oscillators with rotating actuator is obtained through a collocated partial feedback linearization and a global change of coordinates. A nonlinear controller is designed with the backsteping technology, which treats the state variables as virtual control inputs to design the virtual controllers step by step. The system stability is proved with the Lyapunov stability theorem. The simulation results show the system under any initial states can be asymptotically stabilized to the origin and the controller has a good control performance.
Keywords: underactuated mechanical systems, TORA, backstepping, vibration control.
1. Introduction
The TORA (translational oscillators with rotating actuator) is a classical underactuated mechanical system, which is composed of a non-actuated translational oscillators and an actuated pendulum. It was developed as a simplified model of a dual spin spacecraft [1]. One research motivation to control the TORA comes from the possible use to suppress the translational vibration with a rotational actuation. The other is an independent interest to control the TORA as a benchmark problem in the nonlinear control design.
The control problem on the TORA has attracted a considerable amount of attentions from many researchers. Some focus on the intelligent design methods [2-4] and some focus on the nonlinear design methods [5-11]. Among the intelligent design methods, a self-tuning fuzzy sliding mode control is proposed [2-3] and there are some fuzzy rules and parameters to be preset. A neural network controller is proposed with SPSA Algorithm [4] and a time-consuming learning process is needed. Among the nonlinear design methods, the energy-based design [5-7], the backstepping design [8-9] and sliding mode based design [10], the design processes and the obtained controllers are relatively cumbersome. A comparison study of nonlinear control techniques for the TORA is performed [5].
In this paper, the TORA system is transformed into a nonlinear feedback cascade system through a collocated partial feedback linearization and a global change of coordinates. Then a nonlinear backstepping design method is proposed. The design procedure treats the state variables as virtual control inputs to design the virtual controllers step by step, and the system stability is proved via the Lyapunov stability theorem.
2. The TORA system model
The TORA is shown schematically in Fig. 1. The oscillator consists of a cart of mass ${m}_{1}$ connected to a fixed wall by a linear spring of stiffness $k$. The cart is constrained to have one-dimensional travel and its position is ${q}_{1}$. The rotational actuator with the output torque is attached to the cart and it has a pendulum with the equivalent mass ${m}_{2}$, the rotate radius $r$, the moment of inertia $I$ and the rotate angle ${q}_{2}$. Since the rotating torque can not drive the cart directly, it is a benchmark example of the underactuated mechanical system, which has one control input $\tau $ and two configuration variables (${q}_{1}$, ${q}_{2}$), and its Euler-Lagrange equations of motion can be obtained as:
Fig. 1. TORA system configuration
Since the partial feedback linearization technology proposed by Spong [12] can simplify the system dynamics. The following collocated partial feedback linearization is adopted:
and it can simplify the dynamics of the shape variable ${q}_{2}$ as:
Olfati-Saber proposed a global change of coordinates [13] such as:
It can transform the system dynamics into a nonlinear system as:
Therefore, the system model of TORA can be described with a nonlinear feedback cascade model [14] as:
3. The nonlinear controller design through backstepping
Since the model of TORA can be transformed into a cascade nonlinear system through the collocated partial feedback linearization (2) and the global change of coordinates (3), a nonlinear controller can be designed with the backstepping technology [14]. The design process is:
Step 1.
From the dynamic equation of state ${x}_{1}$ in the TORA system model (5):
It can be seen that only ${x}_{2}$ is in the dynamic equation (6) of state ${x}_{1}$. So ${x}_{2}$ can be looked as the virtual control input to Equation (6) to control the system state ${x}_{1}$ and ${\dot{x}}_{1}$. A reference trajectory ${x}_{2r}$ is defined for ${x}_{2}$ to track as:
which leads to an error ${e}_{2}$ defined as:
where, ${k}_{1}$ and ${k}_{2}$ are positive constants that are chosen such that:
is asymptotically stable at $({x}_{1},{\dot{x}}_{1})=\left(\mathrm{0,0}\right)$.
The dynamic Equation (6) of state ${x}_{1}$ can be described as:
Define ${X}_{1}=\left[\begin{array}{c}{x}_{1}\\ {\dot{x}}_{1}\end{array}\right]$, $A=\left[\begin{array}{c}0\text{}\text{}\text{}\text{}\text{}\text{}\text{}\text{}\text{}\text{1}\\ -{k}_{1}-{k}_{2}\end{array}\right]$, $B=\left[\begin{array}{c}0\\ 1\end{array}\right]$. So the Equation (8) is written as:
According to the control theory for the linear time-invariant system [15], the choose of ${k}_{1}$ and ${k}_{2}$ can implies the existence of a positive definite symmetry matrix $P$ and $Q$ so that:
Consider a scalar positive definite Lyapunov function given by:
Its time derivative ${\dot{V}}_{1}$ is given by:
We note that the variable ${\dot{x}}_{2}$ enters the right hand side of Equation (9). We now proceed to look ${\dot{x}}_{2}$ as the control variable and design a reference trajectory ${\dot{x}}_{2r}$ for it to make the second term of right hand in Equation (9) be non-positive.
Step 2.
In step 1, the time derivative of the Lyapunov function ${V}_{1}$ is obtained in Equation (9). In order to make the ${\dot{V}}_{1}$ be negative definite, the state ${\dot{x}}_{2}$ is looked as the virtual control input in Equation (9). A reference trajectory ${\dot{x}}_{2r}$ is defined as:
The tracking error ${\widehat{e}}_{2}$ for ${\dot{x}}_{2}$ can be defined as:
So:
We modify the scalar positive Lyapunov function ${V}_{1}\ge 0$ as:
Differentiating ${V}_{2}$:
$+{\widehat{e}}_{2}\left({e}_{2}-\frac{k}{{m}_{1}+{m}_{2}}{\ddot{x}}_{1}+\frac{k{m}_{2}r{\ddot{x}}_{2}}{{\left({m}_{1}+{m}_{2}\right)}^{2}}\mathrm{c}\mathrm{o}\mathrm{s}{x}_{2}-\frac{k{m}_{2}r{\dot{x}}_{2}^{2}}{{\left({m}_{1}+{m}_{2}\right)}^{2}}\mathrm{s}\mathrm{i}\mathrm{n}{x}_{2}+{k}_{1}{\ddot{x}}_{1}-\frac{k{k}_{2}}{{m}_{1}+{m}_{2}}{\dot{x}}_{1}+\frac{{k}_{2}k{m}_{2}r{\dot{x}}_{2}}{{\left({m}_{1}+{m}_{2}\right)}^{2}}\mathrm{c}\mathrm{o}\mathrm{s}{x}_{2}+{X}_{1}^{T}PB+{k}_{3}{\dot{e}}_{2}\right).$
Step 3.
The system control variable $u={\ddot{x}}_{2}$ enters in the right hand of the Equation (11). So, In order to make the ${\dot{V}}_{2}$ be negative definite, we can make the following equation hold:
Such that:
Therefore, the control law can be obtained from (12) as:
Theorem 1: The TORA system described by Equation (1) is asymptotically stable under the control input (2) and the nonlinear controller (14) with the feedback cascade model (5) and the global change of coordinates (3).
Proof:
The backstepping design process has proved: the time derivative of the chosen positive definite Lyapunov function ${V}_{2}$ is negative definite. That is to say, the three terms of the right hand in Equation (13) is asymptotically approach to 0. Since that the first term $-\frac{1}{2}{\stackrel{-}{x}}^{T}Q\stackrel{-}{x}$ approaches to 0, $({x}_{1},{\dot{x}}_{1})$ must asymptotically approach to (0,0). From the second term $-{k}_{3}{e}_{2}^{2}$ approaches to 0, it is known from Equation (7) that ${x}_{2}$ must asymptotically approach to 0. The third term $-{k}_{4}{\widehat{e}}_{2}^{2}$ approaches to 0 implies that ${\dot{x}}_{2}$ asymptotically approach to 0. Therefore, the system states $({x}_{1},{\dot{x}}_{1},{x}_{2},{\dot{x}}_{2})$ of the TORA described by Equation (5) asymptotically approach to (0,0,0,0).
The global change of coordinates (3) is an invertible transformation, which is:
It can be seen from Equation (15) that $({x}_{1},{\dot{x}}_{1},{x}_{2},{\dot{x}}_{2})$ asymptotically approach to (0,0,0,0) implies that $({q}_{1},{\dot{q}}_{1},{q}_{2},{\dot{q}}_{2})$ approach to (0,0,0,0). That is to say, the control input $\tau $ that is calculated with Equation (2), (14) and (4) can asymptotically stabilize the TORA system.
Remark 1: There is a singularity when ${x}_{2}=\pi /2$ in the controller (14). The method to deal with the singularity is: a linear controller is designed through the LQR method [15] with the linearized system around ${x}_{2}\in (\mathrm{\pi}/2-\mathrm{\Delta},\mathrm{\pi}/2+\mathrm{\Delta})$ for the TORA system:
The controller switch between the nonlinear controller (14) and the linear controller (16) according to the system state ${x}_{2}$.
Remark 2: Only three steps are needed to obtain the nonlinear controller with the backstepping technology. The first step is designed for a one-input and two-state system, the second step is designed for a one-input and on state system, and the third step is to obtain the controller. The design process and the proposed controller are simple compared with some the literature [5-6].
4. Simulation studies
In order to test the proposed nonlinear control algorithm, the following system parameters [16] are used: ${m}_{1}=$10, ${m}_{2}=$1, $k=$1, $r=$1, $I=$1. The parameters of the nonlinear controller are chosen as $P=\text{[6.51;10.3]}\text{,}$$Q=\text{[100;01]}\text{,}$$K=\left[\begin{array}{cccc}\text{\u20132}& \text{\u20132}& \text{8}& \text{4}\end{array}\right]\text{,}$${k}_{1}=$5, ${k}_{2}=\text{5}\text{,}$${k}_{3}=\text{0.5}$, ${k}_{4}=\text{0.5}$.
The simulation results are shown in Fig. 2-4, where the position unit and angle unit respectively are meter and radian to calculate the ${V}_{2}$. The Fig. 2 is obtained under the initial state $\left({x}_{1},{\dot{x}}_{1},{x}_{2},{\dot{x}}_{2}\right)=\left(\text{100,0,0,0}\right)$ i.e. $\left({q}_{1},{\dot{q}}_{1},{q}_{2},{\dot{q}}_{2}\right)=\left(\text{100,0,0,0}\right)$, Fig. 3 is obtained under the initial state $\left({x}_{1},{\dot{x}}_{1},{x}_{2},{\dot{x}}_{2}\right)=\left(\text{0,0,90\xb0,0}\right)$ i.e. $\left({q}_{1},{\dot{q}}_{1},{q}_{2},{\dot{q}}_{2}\right)=\text{(}\u2013\text{90.9,0,90\xb0,0)}$ and Fig. 4 are obtained under the initial state $\left({x}_{1},{\dot{x}}_{1},{x}_{2},{\dot{x}}_{2}\right)=\text{(100,0,90\xb0,0)}$ i.e. $\left({q}_{1},{\dot{q}}_{1},{q}_{2},{\dot{q}}_{2}\right)=\text{(9.09,90\xb0,0,0)}$.
Fig. 2. Simulation results under system state $\left({q}_{1},{\dot{q}}_{1},{q}_{2},{\dot{q}}_{2}\right)=\text{(100,0,0,0)}$ i.e. $\left({x}_{1},{\dot{x}}_{1},{x}_{2},{\dot{x}}_{2}\right)=\text{(100,0,0,0)}$
a) Position and velocity of the cart
b) Angle and angle velocity of the pendulum
c) Control torque $\tau $
d) The Lyapunov function ${V}_{\text{2}}$
It can be seen form the simulation results that the TORA system is asymptotically stable under any initial states with the proposed control algorithm. At the same time, it is shown that it is possible to suppress the translational vibration with a rotational actuation. On the other hand, the control performance can be improved through adjusting the parameters of the proposed controller.
From Fig. 3(d), the Lyapunov function is not a monotonically decreasing function. The reason is the controller switches between the nonlinear controller (14) and the linear controller (16). When the linear controller is in use, the Lyapunov function may be not a monotonically decreasing function. Lots of simulation experiments show that the parameters ${k}_{1}$, ${k}_{2}$, ${k}_{3}$, ${k}_{4}$ respectively correspond to the system states ${x}_{1}$, ${\dot{x}}_{1}$, ${x}_{2}$, ${\dot{x}}_{2}$ therefore it is easy to adjust the parameters for a improved system performance.
Fig. 3. Simulation results under system state $\left({q}_{1},{\dot{q}}_{1},{q}_{2},{\dot{q}}_{2}\right)=\text{(}\text{\u2013}\text{90.9,90\xb0,0,0)}$ i.e. $\left({x}_{1},{\dot{x}}_{1},{x}_{2},{\dot{x}}_{2}\right)=\text{(0,0,90\xb0,0)}$
a) Position and velocity of the cart
b) Angle and angle velocity of the pendulum
c) Control torque $\tau $
d) The Lyapunov function ${V}_{2}$
Fig. 4. Simulation results under system state $\left({q}_{1},{\dot{q}}_{1},{q}_{2},{\dot{q}}_{2}\right)=\text{(9}\text{.}\text{09,90\xb0,0,0)}$ i.e. $\left({x}_{1},{\dot{x}}_{1},{x}_{2},{\dot{x}}_{2}\right)=\text{(}\text{10}\text{0,0,90\xb0,0}$)
a) Position and velocity of the cart
b) Angle and angle velocity of the pendulum
c) Control torque $\tau $
d) The Lyapunov function ${V}_{2}$
5. Conclusions
The underactuated TORA is transformed to a nonlinear feedback cascade system with a collocated partial feedback linearization and a global change of coordinates. A nonlinear control algorithm is proposed from the backstepping technology. The design procedure treats the state variables as virtual control inputs to design the virtual controllers step by step. The first step is designed for a one-input and two-state system, the second step is designed for a one-input and one-state system, and the third step is to obtain the nonlinear controller. The system stability and the control performance are proved via the Lyapunov stability theorem or simulation results.
Acknowledgements
This work is supported by the National Natural Science Foundation of China (No. 61175086) and a Project of Shandong Province Higher Educational Science and Technology Program (No. J13LN25).
References
- Robert T. B., Bernstein D. S., Coppola V. T. A benchmark problem for nonlinear control design. International Journal of Robust and Nonlinear Control, Vol. 8, Issue 4-5, 1998, p. 307-310. [Search CrossRef]
- Hung L. C., Lin H. P., Chung H. Y. Design of self-tuning fuzzy sliding mode control for TORA system. Expert Systems with Applications, Vol. 32, Issue 1, 2007, p. 201-212. [Search CrossRef]
- Li C. D., Yi J. Q., Zhao D. B. Control of the TORA system using SIRMs based type-2 fuzzy logic. Proceedings of IEEE International Conference on Fuzzy System, 2009, p. 694-699. [Search CrossRef]
- Lee C. H., Yu T. M., Chien J. C. Adaptive neural network controller design for a class of nonlinear systems using SPSA algorithm. Proceedings of the International Multi Conference on Engineers and Computer Scientists, Vol. 2, 2011, p. 967-974. [Search CrossRef]
- Avis J. M., Nersesov S. G., Nathanb R., et al. A comparison study of nonlinear control techniques for the RTAC system. Nonlinear Analysis: Real World Applications, Vol. 11, Issue 4, 2010, p. 2647-2658. [Search CrossRef]
- Jankovic M., Fontaine D., Kokotovic P. V. TORA example: cascade and passivity based control designs. IEEE Trans. Control Syst. Technol., Vol. 4, Issue 3, 1996, p. 292-297. [Search CrossRef]
- Gao B. T., Zhang X. H., Chen H. J., et al. Energy-based control design of an underactuated 2-dimensional TORA system. Proceeding of IROS'09 Proceedings of the 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2009, p. 1296-1301. [Search CrossRef]
- Bupp R., Bernstein D. S., Coppola V. T. Experimental implementation of integrator backstepping and passive nonlinear controllers on the RTAC testbed. International Journal of Robust and Nonlinear Control, Vol. 8, Issue 4-5, 1998, p. 435-457. [Search CrossRef]
- Wang Y. Q., Li S., Chen Q. W. A Recursive design method of controller for the stabilization of the translational oscillator with a rotational actuator system. Proceedings of the 2011 IEEE International Conference on Computer Science and Automation Engineering, Shanghai, USA, p. 558-561. [Search CrossRef]
- Chen Y. F., Huang A. C. Controller design for a class of underactuated mechanical systems. IET Control Theory Application, Vol. 6, Issue 1, 2012, p. 103-110. [Search CrossRef]
- Celani F. Output regulation for the TORA benchmark via rotational position feedback. Automatica, Vol. 47, Issue 3, 2011, p. 584-590. [Search CrossRef]
- Spong M. W. Underactuated mechanical systems. Control Problems in Robotics and Automation, Springer Verlag, London, UK, 1997. [Search CrossRef]
- Olfati-Saber R. Normal forms for underactuated mechanical systems with symmetry. IEEE Transactions on Atomatic Control, Vol. 47, Issue 2, 2002, p. 305-308. [Search CrossRef]
- Khalil H. K. Nonlinear systems. 3rd Edition. Prentise Hall, USA, 2002. [Search CrossRef]
- Katsuhiko Ogata Modern control engineering. Prentice Hall, 2009. [Search CrossRef]
- Olfati-Saber R. Nonlinear control of underactuated mechanical systems with application to robotics and aerospace vehicles. Ph. D. thesis, Massachusetts Institute of Technology, 2001. [Search CrossRef]