Virtual Constraints Based Control Design of an Inclined Translational Oscillator with Rotational Actuator System
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.
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 . 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  entitled “International Journal of Robust and Nonlinear Control” in 1998, Jankovic et al.  have already presented several cascade-based effective controllers for the TORA system in 1996. Lee and Chang  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.  studied approximation and complexity trade-off by tensor production model transformation in control design with TORA system. In , 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 , 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.  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 . The same group has also extended translational oscillation of the TORA system to two-dimensional perpendicular translational movements, and passivity-based control design  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 . Tracking control of periodic trajectory has been studied for underactuated pendulum-like systems due to its internal simplicity as early as in 1995 . 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.  proposed a systematic constructive tool for generation and orbital stabilization of periodic trajectories. The main idea is to impose virtual holonomic constraints  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 , 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 , 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 Section 2. 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 Figure 1 represents a comparison of the benchmark system TORA on the horizontal plane  and inclined TORA system . For the TORA system on the horizontal plane, a coordinate frame is attached to the TORA system, with the origin at the center of the cart when the spring is with free status. The -axis is along the translational motion of the cart, and the -axis is perpendicular to the plane of the TORA system. Let be the gravity constant, and its direction is the negative . For the inclined TORA system, another world frame is defined for the slope according to the definition of . The movements of TORA system occur in the inclined plane having an angle with respect to the horizontal plane ; 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 . The inclining direction angle of the inclined TORA system could be selected arbitrarily in .
Parameters of the TORA system are defined according to the coordinate frame similarly as in previous literatures [1, 16]. The cart of mass is connected to a fixed base by a linear spring with stiffness . The cart is constrained to have one-dimensional translational movement with denoting the travel distance. The actuated rotor attached to the cart has mass and moment of inertia about its center of mass; and the eccentric distance of the rotor is . Control input torque applied to the rotor is denoted as . Let and 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 energy and potential energy of the inclined TORA system can be calculated asTherefore, the Lagrangian can be calculated asBy choosing 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 aswhere and 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 aswhere is the variable vector and , , , , and represent inertia matrix, Coriolis and centrifugal force matrix, potential matrix, disturbance force vector, and control input vector of the inclined TORA system, respectively:
From dynamics (4), one can see straightforwardly that is the actuated variable and is the unactuated variable. The configuration variables and of the underactuated inclined TORA system have to be controlled by its only control input torque . Another observation is that when , that is, the TORA system on a horizontal plane, the inclined TORA system dynamics (4) will be deduced aswhich is the dynamics of the benchmark TORA system.
By neglecting the disturbance force Matrix and letting in the inclined TORA system dynamics (4), the equilibriums of the system can be derived aswhere 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 . 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 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 asFor 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 and choosing a coordinate , the two trajectory functions (9) can be transformed into the following single function:Single equation (10) cannot fully define a trajectory. The missing equation could be an explicit/implicit function with respect to time, such asNow, 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 aswhere or . For given starting and desired points and , without loss of generality, line constraint (12) can be rewritten aswhere
3.2. Trajectory Calculation
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 , there always exist determined integral curves, which can be written as . If the initial state is chosen as the desired state , 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 ; (15) can be converted towhereBy introducing the integration factorthe solution of the is derived as
Consequently, the trajectory function can be denoted as
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 asIn 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 Matrix , compact matrix form (4) can be rewritten aswhereConsequently, and can be calculated asCombining 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 asTo construct the relationship among each equation in (28), a virtual control input is designed and introduced aswhere and are positive constants needed to be decided. Combining inclined TORA system (26) and (29), the inner-loop subsystem can be written asAccording to Laplace transformation, the transfer function of the subsystem can be rewritten asTherefore, by appropriate selecting of parameters and , 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, , the orbit equation can be written asA simple control Lyapunov function (CLF) can be selected asBy differentiating the CLF, one can obtainCombining (23), (28), and (30), can be expressed as
Substituting (35) into (34), we havewhereBy selecting the following control input torque where is a positive constant and is a signal function, we haveTherefore, according to second stability theorem of Lyapunov , the trajectory tracking control of the system can be realized asymptotically.
To verify the dynamical analysis and control design for the inclined TORA system, simulations were programmed and performed with MATLAB/Simulink. Following , the physical parameters of the inclined TORA system are chosen as shown in Table 1. The controller parameters are selected as follows: , , and . For the inclined TORA system, we choose a typical case to study, which is and ; namely, the TORA system is on representational inclined plane. The desired point is . According to (7) and (8), one can get the equilibriums of the system as . For the given starting and desired points, virtual constraint (13) can be calculated as
To ensure that the rotor can start up easily, we choose the initial point of the system as . 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 and rotor angle oscillating with increasing amplitudes. During the translational position of the cart 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 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 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 is with asymmetric periodic motion as shown in the right bottom subfigure.
Another simulation virtual constraint based control design for the inclined TORA system was done with the same physical parameters and desired trajectory point , while the parameters of the inclined amplitude and direction were selected as and , respectively. The equilibriums of the system are calculated as , and new virtual constraint (13) can be calculated as
The simulation results are shown in Figure 3. 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 and 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 keeps asymmetry as shown in the right bottom subfigure.
For the special case of the benchmark TORA, which is with of the inclined plane, the TORA system is on a horizontal plane. The desired point is also selected as . 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 asThe 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 , and the symmetry trajectories of the rotor are achieved. The reason for the longer stability time is because the initial point of the system 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.
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.
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.
Conflict of Interests
The authors declare that there is no conflict of interests regarding the publication of this paper.
The work is financially supported by National Science Foundation of China (11102039), the Excellent Young Teachers Program of Southeast University (2242015R30024), and Six Talent Peaks Project of Jiangsu Province (2014-ZBZZ-001).
I. Fantoni and R. Lozano, Nonlinear Control for Underactuated Mechanical Systems, Springer, London, UK, 2002.
H. Cheng, H. Chen, X. Zhang, B. Gao, and H. Chen, “Periodic trajectory generation and tracking control for a class of underactuated mechanical systems,” in Proceedings of the IEEE International Conference on Robotics and Biomimetics, pp. 1817–1822, Guangzhou, China, December 2012.View at: Publisher Site | Google Scholar