# Virtual Constraints Based Control Design of an Inclined Translational Oscillator with Rotational Actuator System

Authors: Bingtuan Gao; Chuande Liu; Hongtai Cheng
Journal: Shock and Vibration
 (2015)

---

## Abstract

Translational oscillator with rotational actuator (TORA) system, whose translational and
rotational movements occur in horizontal planes, is a benchmark of underactuated mechanical
systems for studying of control techniques. Currently, the research work of the benchmark
mainly focuses on stabilizing control of equilibrium points of the dynamical system. The
problem of steering TORA to arbitrary points in its state space is rarely studied. In this
paper, the movements of the TORA system are extended to inclined planes and dynamics of
the inclined TORA system is presented firstly. Following that, a trajectory tracking control
method based on virtual constraints is proposed to steer the oscillations of the inclined TORA
system. A virtual constraints based method is presented to generate periodic trajectories which
pass through desired point; and a Lyapunov based control design is proposed to track the
generated trajectories. Finally, the performance and feasibility of the proposed control design
methodology are illustrated and analyzed according to numerical simulations.


---

## Body

## 1. Introduction

The translational oscillator with rotational actuator (TORA) system consists of an unactuated translational oscillation cart and an actuated eccentric rotor attached to the cart, which is a benchmark of underactuated mechanical systems [1]. Underactuated mechanical systems were defined as a class of systems having fewer control inputs than the number of configuration variables [2–4]. It is interesting and challenging to analyze and control design underactuated mechanical systems. Currently, the control objectives of TORA system are to employ the control input torque acting or the rotor to stabilize both the translational position of the unactuated oscillating cart and the rotational position of the actuated eccentric rotor.Before several interesting and effective control design methods [5, 6] presented in the special issue [1] entitled “International Journal of Robust and Nonlinear Control” in 1998, Jankovic et al. [7] have already presented several cascade-based effective controllers for the TORA system in 1996. Lee and Chang [8] combined an adaptive backstepping control scheme based on a wavelet-based neural network and a compensated controller to improve the closed-loop control performance of TORA system. Petres et al. [9] studied approximation and complexity trade-off by tensor production model transformation in control design with TORA system. In [10], an equivalent-input-disturbance method was proposed for TORA system with two steps. Moreover, several control design techniques resulting in controllers with only rotor angle feedback were presented in [11–13], which could be easier to be implemented in practice.In the literature, the studied TORA system lies on horizontal planes, and there are infinite equilibriums of the rotor. In [14], dynamics and control design of a TORA system with rotating motion in a vertical plane were studied. Due to the gravity effect in the dynamics, there are only two equilibriums of the rotor, and a simple PD (proportional derivative) controller was designed to stabilize the cart oscillation while bringing the rotor angle to its downward equilibrium. Avis et al. [15] compared energy-based controller and sliding mode based controller designed for TORA system with rotating motion in a vertical plane. Since there does not exist absolute horizontal or vertical plane in practical implementations, the movements of TORA system will be in inclined planes. Generalized dynamics and controllability analysis of inclined TORA systems have been presented in detail in [16]. The same group has also extended translational oscillation of the TORA system to two-dimensional perpendicular translational movements, and passivity-based control design [17] was employed to stabilize the 2-dimensional TORA system to its controllable equilibriums.In all the above-mentioned papers, the research work of underactuated TORA has been focused on stabilizing control of equilibrium points of the dynamical system. How about, inversely, forcing the oscillation to some points or tracking a trajectory in state space of the underactuated TORA system? Although forcing stable oscillations via feedback and analysis of such oscillations in fully actuated mechanical systems is an old area of research, the problem of forcing oscillations via feedback in underactuated mechanical systems has just attracted some attention [18]. Tracking control of periodic trajectory has been studied for underactuated pendulum-like systems due to its internal simplicity as early as in 1995 [19]. In the paper, a group of periodic trajectories for pendulum-like systems were generated by regulating the energy after studying the relationship between the state variables and the system energy. Aiming at mechanical systems with the number of independent actuators smaller than the number of degrees of freedom by one, Shiriaev et al. [18] proposed a systematic constructive tool for generation and orbital stabilization of periodic trajectories. The main idea is to impose virtual holonomic constraints [20] to the original system by using control inputs so that the original complicated dynamics can be reduced to the so-called virtual limit system, which is easier to analyze and control. This technique was applied into several underactuated systems, such as cart-pole system [18, 20] and Furuta pendulum [21, 22]. In [23], the virtual constraints based algorithm was improved to generate periodic trajectories passing through arbitrary points in its state space. The method was then implemented successfully to the underactuated Acrobot.In this paper, following our previous work [23], virtual constraints based method will be employed to generate periodic trajectories of the inclined TORA system, and a Lyapunov based control scheme is proposed to track the generated trajectories. As a result, the closed-loop underactuated TORA system will be able to oscillate through the starting points and the desired points in state space. Comparing with our previous work [16, 17] on TORA system which is on stabilizing control of equilibrium points of the nonlinear dynamical system, this paper presents a virtual constraint based control scheme for the inclined TORA system to steer the system oscillating according to desired trajectories passing through desired points. To the best of our knowledge, it is the first study on oscillating trajectory tracking control for TORA system and especially for the general inclined case.The rest of the paper is organized as follows. Dynamics of the inclined TORA is presented in Section2. Based on the dynamics, virtual constraints based method is employed to generate periodic trajectories for inclined TORA system in Section 3. After that, a Lyapunov based control scheme is adopted to design the trajectory tracking controller for the system in Section 4. Simulation results and discussions will be elaborated in Section 5. And conclusions are presented in the last section.


## 2. Dynamics of Inclined TORA System

The system shown in Figure1 represents a comparison of the benchmark system TORA on the horizontal plane [1] and inclined TORA system [16]. For the TORA system on the horizontal plane, a coordinate frame oxyz is attached to the TORA system, with the origin at the center of the cart when the spring is with free status. The x-axis is along the translational motion of the cart, and the z-axis is perpendicular to the plane of the TORA system. Let g be the gravity constant, and its direction is the negative z. For the inclined TORA system, another world frame OXYZ is defined for the slope according to the definition of oxyz. The movements of TORA system occur in the inclined plane oxy having an angle β with respect to the horizontal plane OXY; and inclining direction of the TORA system is denoted with γ. The inclined angle β of the slope could be caused by tilted installation plane or assembly process, which can be defined as β∈[0∘,90∘]. The inclining direction angle γ of the inclined TORA system could be selected arbitrarily in γ∈[0∘,360∘).Figure 1
The configuration of TORA system: (a) TORA system in a horizontal plane and (b) TORA system on a slope.
(a)
(b)Parameters of the TORA system are defined according to the coordinate frameoxyz similarly as in previous literatures [1, 16]. The cart of mass M is connected to a fixed base by a linear spring with stiffness k. The cart is constrained to have one-dimensional translational movement with x denoting the travel distance. The actuated rotor attached to the cart has mass m and moment of inertia I about its center of mass; and the eccentric distance of the rotor is r. Control input torque applied to the rotor is denoted as τ. Let x and x˙ denote the translational position and velocity of the cart, respectively; and let θ and θ˙ denote angular position and the angular velocity of the rotor, respectively.The total kinetic energyT and potential energy P of the inclined TORA system can be calculated as(1)T=12M+mx˙2+mrcos⁡θx˙θ˙+12mr2+Iθ˙2,P=12kx2+M+mgxcos⁡γsin⁡β+mgrsin⁡γ+θsin⁡β.Therefore, the Lagrangian L can be calculated as(2)L=T-P.By choosing x and θ as the generalized coordinates and τ as the generalized force, based on Lagrange equations, dynamics of motion for the inclined TORA system can be derived as(3)M+mx¨+mrcos⁡θθ¨-mrsin⁡θθ˙2+kx+M+mgcos⁡γsin⁡β+Nx=0,mrcos⁡θx¨+mr2+Iθ¨+mgrcos⁡γ+θsin⁡β+Nr=τ,where Nx and Nr denote the disturbance inputs acting on the translational moving cart and rotating rotor, respectively.In compact matrix form, the above two equations can be rewritten as(4)Mqq¨+Cq,q˙q˙+Gq+N=U,where q=q1,q2T=x,θT is the variable vector and M(q), C(q,q˙), G(q), N, and U represent inertia matrix, Coriolis and centrifugal force matrix, potential matrix, disturbance force vector, and control input vector of the inclined TORA system, respectively:(5)Mq=m11m12m21m22=M+mmrcos⁡θmrcos⁡θmr2+I,Cq,q˙=0-mrθ˙sin⁡θ00,Gq=kx+M+mgcos⁡γsin⁡βmgrcos⁡γ+θsin⁡β,N=NxNr,U=0τ.From dynamics (4), one can see straightforwardly that θ is the actuated variable and x is the unactuated variable. The configuration variables x and θ of the underactuated inclined TORA system have to be controlled by its only control input torque τ. Another observation is that when β=0, that is, the TORA system on a horizontal plane, the inclined TORA system dynamics (4) will be deduced as(6)M+mx¨+mrcos⁡θθ¨-mrsin⁡θθ˙2+kx+Nx=0,mrcos⁡θx¨+mr2+Iθ¨+Nr=τwhich is the dynamics of the benchmark TORA system.By neglecting the disturbance force MatrixN and letting τ=0 in the inclined TORA system dynamics (4), the equilibriums of the system can be derived as(7)xe=M+mgcos⁡γsin⁡βk,(8)θe=2n+12π-γ,n=0,±1,±2,…,where we can see that the inclined TORA system has two types of equilibriums, that is, up equilibriums with high potential energy of gravity and down equilibriums with low potential energy of gravity.


## 3. Virtual Constraints Based Trajectory Generation

According to equilibrium (8) of the inclined TORA system, the up equilibriums are self-unstable which are not interesting. In this paper, we will extend the down equilibriums to arbitrary configuration space points. To do that, we identify the form of desired point [q1,q2,q˙1,q˙2]=[q1d,q2d,0,0]. And because of the simplicity and stability of the periodic orbits, periodic trajectories will be focused on. The objective of virtual constraints based method for the inclined TORA system is to generate periodic trajectories which pass through desired point [q1d,q2d,0,0] firstly. The meaning of virtual constraints is defined contrary to physical constraints which exist practically, while the function of virtual constraints for TORA system is to realize that trajectory of the dynamical system begins from the starting point and stabilizes to the designed periodic trajectory passing through the desired point.


### 3.1. Virtual Constraints Design

The trajectories of the cart and the rotor of the inclined TORA system can be written as(9)q1=φ1t,q2=φ2t.For the fully actuated mechanical system, the above trajectories can be tracked by decoupling the coordinates and the control inputs. However, for the underacutated TORA system, the method fails because the control inputs are fewer than the configuration variables. By eliminating time t and choosing a coordinate q2, the two trajectory functions (9) can be transformed into the following single function:(10)q1=φq2.Single equation (10) cannot fully define a trajectory. The missing equation could be an explicit/implicit function with respect to time, such as(11)φ2q2,q˙2=0.Now, together with (11), function (10) is equivalent to the two time functions (9). It is easy to verify that function (10) can be seen as holonomic constraint. If it is imposed on the original system using the control inputs, the original system becomes a one-dimensional inclined dynamic system. Additionally, if time function (11) is compatible with the dynamic system, the corresponding trajectory is able to be tracked. Since the holonomic constraint does not physically exist, it is called virtual constraint.To find out the simplest virtual constraint of the two points, that is, starting point and desired point of the period orbit, it comes to an imaginary line constrained by the two points straightforwardly, which can be expressed as(12)a1q1+a2q2+a3=0,where a1≠0 or a2≠0. For given starting and desired points [xe,θe] and [xd,θd], without loss of generality, line constraint (12) can be rewritten as(13)q1=aq2+b,where(14)a=xd-xeθd-θe,b=xeθd-xdθeθd-θe.


### 3.2. Trajectory Calculation

By combining inclined TORA dynamics (4) and virtual constraint (13), the system zero dynamics can be calculated as [18](15)ηq2q¨2+σq2q˙22+ωq2=0,where(16)ηq2=aM+m+mrcos⁡q2,σq2=-mrsin⁡q2,ωq2=kaq2+b+M+mgcos⁡γsin⁡β.One can see straightforwardly that, in the role of virtual constraints, the inclined TORA system will become a single-dimensional dynamic system, which is described by a second order differential equation. Therefore, corresponding to every initial state(q0,q˙0), there always exist determined integral curves, which can be written as ψ(q2,q˙2,q0,q˙0). If the initial state (q0,q˙0) is chosen as the desired state (qd,q˙d), the integral curve of the single-dimensional dynamic system is the desired trajectory.In differential equation (15), different initial states are corresponding to different integration curves. To ensure the uniqueness of the trajectory, parameters describing the curve are needed. Let Y(q2)=q˙22; (15) can be converted to(17)dYdq2+σ0q2Y-ω0q2=0,where(18)σ0=2σq2ηq2,ω0=-2ωq2ηq2.By introducing the integration factor(19)I=e∫q0q2σ0xdx,the solution of the Y(q2) is derived as(20)
Y
q
2
=
I
-
1
∫
q
0
q
2
I
ω
0
x
d
x
+
Y
0
I
-
1
=
-
a
M
+
m
η
2
q
2
q
2
-
q
0
ω
q
2
+
ω
q
0
+
η
2
q
0
η
2
q
2
q
˙
0
2
+
2
η
2
q
2
b
k
+
M
+
m
g
cos
⁡
γ
sin
⁡
β
·
σ
q
2
-
σ
q
0
+
2
a
k
η
2
q
2
σ
˙
q
2
-
σ
˙
q
0
+
2
η
2
q
2
ω
q
2
σ
q
2
-
ω
q
0
σ
q
0
.Consequently, the trajectory functionψ can be denoted as(21)ψq2,q˙2,q0,q˙0=q˙22-Yq2.


## 3.1. Virtual Constraints Design

The trajectories of the cart and the rotor of the inclined TORA system can be written as(9)q1=φ1t,q2=φ2t.For the fully actuated mechanical system, the above trajectories can be tracked by decoupling the coordinates and the control inputs. However, for the underacutated TORA system, the method fails because the control inputs are fewer than the configuration variables. By eliminating time t and choosing a coordinate q2, the two trajectory functions (9) can be transformed into the following single function:(10)q1=φq2.Single equation (10) cannot fully define a trajectory. The missing equation could be an explicit/implicit function with respect to time, such as(11)φ2q2,q˙2=0.Now, together with (11), function (10) is equivalent to the two time functions (9). It is easy to verify that function (10) can be seen as holonomic constraint. If it is imposed on the original system using the control inputs, the original system becomes a one-dimensional inclined dynamic system. Additionally, if time function (11) is compatible with the dynamic system, the corresponding trajectory is able to be tracked. Since the holonomic constraint does not physically exist, it is called virtual constraint.To find out the simplest virtual constraint of the two points, that is, starting point and desired point of the period orbit, it comes to an imaginary line constrained by the two points straightforwardly, which can be expressed as(12)a1q1+a2q2+a3=0,where a1≠0 or a2≠0. For given starting and desired points [xe,θe] and [xd,θd], without loss of generality, line constraint (12) can be rewritten as(13)q1=aq2+b,where(14)a=xd-xeθd-θe,b=xeθd-xdθeθd-θe.


## 3.2. Trajectory Calculation

By combining inclined TORA dynamics (4) and virtual constraint (13), the system zero dynamics can be calculated as [18](15)ηq2q¨2+σq2q˙22+ωq2=0,where(16)ηq2=aM+m+mrcos⁡q2,σq2=-mrsin⁡q2,ωq2=kaq2+b+M+mgcos⁡γsin⁡β.One can see straightforwardly that, in the role of virtual constraints, the inclined TORA system will become a single-dimensional dynamic system, which is described by a second order differential equation. Therefore, corresponding to every initial state(q0,q˙0), there always exist determined integral curves, which can be written as ψ(q2,q˙2,q0,q˙0). If the initial state (q0,q˙0) is chosen as the desired state (qd,q˙d), the integral curve of the single-dimensional dynamic system is the desired trajectory.In differential equation (15), different initial states are corresponding to different integration curves. To ensure the uniqueness of the trajectory, parameters describing the curve are needed. Let Y(q2)=q˙22; (15) can be converted to(17)dYdq2+σ0q2Y-ω0q2=0,where(18)σ0=2σq2ηq2,ω0=-2ωq2ηq2.By introducing the integration factor(19)I=e∫q0q2σ0xdx,the solution of the Y(q2) is derived as(20)
Y
q
2
=
I
-
1
∫
q
0
q
2
I
ω
0
x
d
x
+
Y
0
I
-
1
=
-
a
M
+
m
η
2
q
2
q
2
-
q
0
ω
q
2
+
ω
q
0
+
η
2
q
0
η
2
q
2
q
˙
0
2
+
2
η
2
q
2
b
k
+
M
+
m
g
cos
⁡
γ
sin
⁡
β
·
σ
q
2
-
σ
q
0
+
2
a
k
η
2
q
2
σ
˙
q
2
-
σ
˙
q
0
+
2
η
2
q
2
ω
q
2
σ
q
2
-
ω
q
0
σ
q
0
.Consequently, the trajectory functionψ can be denoted as(21)ψq2,q˙2,q0,q˙0=q˙22-Yq2.


## 4. Trajectory Tracking Control

The generated trajectory is determined by both virtual constraint (13) and orbit function (21). To ensure that the inclined TORA system converges to the target trajectory, the trajectory tracking control can be converted to an output stabilization issue. And virtual constraint equation (13) can be denoted as(22)ρ=φq2-q1.In this section, cascade control method will be employed to realize stabilization of system (21) and (22). The virtual constraint is regarded as the inner loop of the closed-loop system, while the orbit trajectory is taken as the outer loop.


### 4.1. The Stabilization Controller Design of Virtual Constraint

For the inclined TORA system, by neglecting the disturbance force MatrixN, compact matrix form (4) can be rewritten as(23)m11q¨1+m12q¨2+h1=0,(24)m21q¨1+m22q¨2+h2=τ,where(25)h1=-mrsin⁡q2q˙22+kq1+M+mgcos⁡γsin⁡β,h2=mgrcos⁡γ+q2sin⁡β.Consequently, q¨1 and q¨2 can be calculated as(26)q¨1=-m12τ-m22h1+m12h2m11m22-m12m21≜g1τ+f1,(27)q¨2=m11τ+m21h1-m11h2m11m22-m12m21≜g2τ+f2.Combining selected virtual constraint (13) and subsystem (22) and by differentiating both sides of the equation, the output function of the virtual constraint can be expressed as(28)ρ=aq2+b-q1,ρ˙=aq˙2-q˙1,ρ¨=aq¨2-q¨1.To construct the relationship among each equation in (28), a virtual control input ν is designed and introduced as(29)ν=af2+ag2τ-f1-g1τ+k1ρ˙+k2ρ,where k1 and k2 are positive constants needed to be decided. Combining inclined TORA system (26) and (29), the inner-loop subsystem can be written as(30)ρ¨+k1ρ˙+k2ρ=ν.According to Laplace transformation, the transfer function of the subsystem can be rewritten as(31)Gs=ρsνs=1s2+k1s+k2.Therefore, by appropriate selecting of parameters k1 and k2, the input and output stabilization of the subsystem can be achieved.


### 4.2. The Stabilization Controller Design of Periodic Trajectory

For virtual constraint (13), assuming that the target rate for the state is 0, that is, Y0=0, the orbit equation can be written as(32)ψq2,q˙2,q0,q˙0=q˙22-I-1∫q0q2Iω0dx.A simple control Lyapunov function (CLF) can be selected as(33)V=12ψ2.By differentiating the CLF, one can obtain(34)V˙=ψq˙22q¨2+I-1σ0∫q0q2Iω0dx-ω0.Combining (23), (28), and (30), q¨2 can be expressed as(35)q¨2=m11ν-m11k1ρ˙+k2ρ-h1am11+m12.Substituting (35) into (34), we have(36)V˙=ψq˙2g·ν+f·,where(37)f·=-2m11k1ρ˙+k2ρ+h1am11+m12+I-1σ0∫q0q2Iω0dx-ω0,g·=2m11am11+m12.By selecting the following control input torque τ(38)ν=-k3ψsgn⁡ψq˙2+f·g·,where k3 is a positive constant and sgn⁡(·) is a signal function, we have(39)V˙=-k3ψψq˙2sgn⁡ψq˙2≤0.Therefore, according to second stability theorem of Lyapunov [4], the trajectory tracking control of the system can be realized asymptotically.Combing (29) and (38), the physical control input τ can be calculated as(40)τ=-k3ψsgn⁡ψq˙2+f·/g·ag2-g1-k1ρ˙+k2ρ+af2-f1ag2-g1.


## 4.1. The Stabilization Controller Design of Virtual Constraint

For the inclined TORA system, by neglecting the disturbance force MatrixN, compact matrix form (4) can be rewritten as(23)m11q¨1+m12q¨2+h1=0,(24)m21q¨1+m22q¨2+h2=τ,where(25)h1=-mrsin⁡q2q˙22+kq1+M+mgcos⁡γsin⁡β,h2=mgrcos⁡γ+q2sin⁡β.Consequently, q¨1 and q¨2 can be calculated as(26)q¨1=-m12τ-m22h1+m12h2m11m22-m12m21≜g1τ+f1,(27)q¨2=m11τ+m21h1-m11h2m11m22-m12m21≜g2τ+f2.Combining selected virtual constraint (13) and subsystem (22) and by differentiating both sides of the equation, the output function of the virtual constraint can be expressed as(28)ρ=aq2+b-q1,ρ˙=aq˙2-q˙1,ρ¨=aq¨2-q¨1.To construct the relationship among each equation in (28), a virtual control input ν is designed and introduced as(29)ν=af2+ag2τ-f1-g1τ+k1ρ˙+k2ρ,where k1 and k2 are positive constants needed to be decided. Combining inclined TORA system (26) and (29), the inner-loop subsystem can be written as(30)ρ¨+k1ρ˙+k2ρ=ν.According to Laplace transformation, the transfer function of the subsystem can be rewritten as(31)Gs=ρsνs=1s2+k1s+k2.Therefore, by appropriate selecting of parameters k1 and k2, the input and output stabilization of the subsystem can be achieved.


## 4.2. The Stabilization Controller Design of Periodic Trajectory

For virtual constraint (13), assuming that the target rate for the state is 0, that is, Y0=0, the orbit equation can be written as(32)ψq2,q˙2,q0,q˙0=q˙22-I-1∫q0q2Iω0dx.A simple control Lyapunov function (CLF) can be selected as(33)V=12ψ2.By differentiating the CLF, one can obtain(34)V˙=ψq˙22q¨2+I-1σ0∫q0q2Iω0dx-ω0.Combining (23), (28), and (30), q¨2 can be expressed as(35)q¨2=m11ν-m11k1ρ˙+k2ρ-h1am11+m12.Substituting (35) into (34), we have(36)V˙=ψq˙2g·ν+f·,where(37)f·=-2m11k1ρ˙+k2ρ+h1am11+m12+I-1σ0∫q0q2Iω0dx-ω0,g·=2m11am11+m12.By selecting the following control input torque τ(38)ν=-k3ψsgn⁡ψq˙2+f·g·,where k3 is a positive constant and sgn⁡(·) is a signal function, we have(39)V˙=-k3ψψq˙2sgn⁡ψq˙2≤0.Therefore, according to second stability theorem of Lyapunov [4], the trajectory tracking control of the system can be realized asymptotically.Combing (29) and (38), the physical control input τ can be calculated as(40)τ=-k3ψsgn⁡ψq˙2+f·/g·ag2-g1-k1ρ˙+k2ρ+af2-f1ag2-g1.


## 5. Simulations

To verify the dynamical analysis and control design for the inclined TORA system, simulations were programmed and performed with MATLAB/Simulink. Following [1], the physical parameters of the inclined TORA system are chosen as shown in Table 1. The controller parameters are selected as follows: k1=20, k2=400, and k3=10. For the inclined TORA system, we choose a typical case to study, which is β=45∘ and γ=45∘; namely, the TORA system is on representational inclined plane. The desired point is (x,θ,x˙,θ˙)=(0.1,π/2,0,0). According to (7) and (8), one can get the equilibriums of the system as (0.0383554,π/4,0,0). For the given starting and desired points, virtual constraint (13) can be calculated as(41)x=0.07848834244θ-0.0232892.Table 1
Physical parameters of the TORA system.
Parameter (units)
Value
Description
M (kg)
1.3608
Cart mass of axisx
m (kg)
0.096
Rotor mass
k (N/m)
186.3
Spring stiffness of axisx
r (m)
0.0592
Eccentric distance of rotor
I (kg⋅m2)
0.0002175
Rotor inertiaTo ensure that the rotor can start up easily, we choose the initial point of the system as(0,0.1,0,0). Based on the above conditions, the simulation results are shown in Figure 2. From the simulation results, one can see that the inclined TORA system oscillates to the desired state after about 10 seconds, periodically. At the beginning of the oscillation from the initial point, the control input torque τ drives both the cart position x and rotor angle θ oscillating with increasing amplitudes. During the translational position of the cart x and the angular position of the rotor θ approaching the desired trajectory from 4 seconds to 8 seconds, the amplitude of control input torque τ remains smooth. And the control input torque τ has a small mutation in the oscillation at about 8 seconds as shown in the right top subfigure because the cart position x has reached the desired point while the rotor angle has not until about 2 seconds later. And the maximum control torque is around 0.2 N·m. Once the translational position of the cart x and the angular position of the rotor θ converge to the target trajectory, gradually, the control input torque τ runs periodically to guarantee the trajectory tacking control. Due to the inclined plane, the trajectory of the ball in plane oxyz is with asymmetric periodic motion as shown in the right bottom subfigure.Figure 2
Simulation results of TORA system on the inclined plane,β=45∘, γ=45∘.Another simulation virtual constraint based control design for the inclined TORA system was done with the same physical parameters and desired trajectory point(x,θ,x˙,θ˙)=(0.1,π/2,0,0), while the parameters of the inclined amplitude and direction were selected as β=30∘ and γ=30∘, respectively. The equilibriums of the system are calculated as (0.0332167,π/3,0,0), and new virtual constraint (13) can be calculated as(42)x=0.1275466731θ-0.10034985.The simulation results are shown in Figure3. According to Figure 3, one can see that about 20 seconds is needed for the inclined TORA system to oscillate to the desired state, which is much slower than the case with β=45∘ and γ=45∘ as shown in Figure 2. In other words, the convergence speed of the oscillation is related to the inclined angles of the slope. At the beginning of the oscillation from the initial point, the distortion of the phase trajectory of the rotor is more serious as shown in the left bottom subfigure. The control input torque τ increases over time smoothly at the beginning and achieves periodical stability finally. Although the angles of the inclined plane are changed, since the TORA system is still on an inclined plane, the trajectory of the rotor in plane oxyz keeps asymmetry as shown in the right bottom subfigure.Figure 3
Simulation results of TORA system on the inclined plane,β=30∘, γ=30∘.For the special case of the benchmark TORA, which is withβ=0∘ of the inclined plane, the TORA system is on a horizontal plane. The desired point is also selected as (x,θ,x˙,θ˙)=(0.1,π/2,0,0). However, in this case, angle equilibrium (8) of the TORA system can be arbitrary. Typically, we can choose the equilibriums as (0, 0, 0, 0). For given starting and desired points above, virtual constraint (13) can be calculated as(43)x=0.2πθ.The simulation results are shown in Figure 4. From the simulation results, the system oscillates to the desired state after about 28 seconds, which is slower than those on inclined planes. In this special case, the oscillation of the system will not be influenced by the gravity g, and the symmetry trajectories of the rotor are achieved. The reason for the longer stability time is because the initial point of the system (0,0.1,0,0) is closer to the equilibriums of the TORA system, which leads to smaller control input torque τ at the beginning. It can been seen from Figure 4 that the control input increases very slowly at the beginning and the trajectories of the rotor and the cart stay at around the centers of the phase planes at the beginning of their oscillating motions.Figure 4
Simulation results of TORA system on the horizontal plane,β=0∘, γ=0∘.As a result, the simulation results verified that the proposed virtual constraints based control design can track the trajectories passing through desired points in the state space of the inclined TORA system successfully.


## 6. Conclusions

In this paper, steering an underactuated TORA system on a slop to its arbitrary configuration point is studied. A virtual constraint based trajectory generation scheme is designed to generate periodic trajectories that pass through arbitrary points in the state space. A cascade control method is presented to stabilize trajectory tracking control of the converted dynamic system combing the virtual constraint and periodic trajectory, where the virtual constraint and periodic trajectory are taken as the inner loop and outer loop of the close-loop system, respectively. Simulation results show that the proposed control design can steer the TORA system to the generated trajectories passing through desired points successfully. And for the inclined TORA system, the period trajectories of the rotor in its motion plane will be asymmetric while those are symmetric for horizontal TORA system, which arises from the gravity effect or not. The methods proposed in this paper can also be applied to other underactuated mechanical systems to realize complex tasks and extend their applications.



---

*Source: 769151-2015-08-03.xml*