Abstract
This paper addresses the design of exponential tracking control using backstepping approach for voltage-based control of a flexible joint electrically driven robot (EFJR), to cope with the difficulty introduced by the cascade structure in EFJR dynamic model, to deal with flexibility in joints, and to ensure fast tracking performance. Backstepping approach is used to ensure global asymptotic stability and its common algorithm is modified such that the link position and velocity errors converge to zero exponentially fast. In contrast with the other backstepping controller for electrically driven flexible joint robot manipulators control problem, the proposed controller is robust with respect to stiffness uncertainty and allows tracking fast motions. Simulation results are presented for both single link flexible joint electrically driven manipulator and 2-DOF flexible joint electrically driven robot manipulator. These simulations show very satisfactory tracking performances and the superiority of the proposed controller to those performed in the literature using simple backstepping methodology.
1. Introduction
As demonstrated in [1], actuator dynamics constitute an important component of the complete robot dynamics. If actuator dynamics is ignored, the designed controller may not yield good system overall performance. In recent years, controls for robot manipulators, including the actuator dynamics, have received considerable attention and several control schemes have been developed [2–10]. In the early works Tarn et al. [2] proposed a nonlinear feedback robot controller that incorporates the robot manipulator dynamics as well as the robot joint motor dynamics. This study shows that the proposed controller gives better performance than nonlinear feedback robot controller based on the manipulator dynamics only. Carroll et al. [3] introduce a robust corrective tracking controller for rigid link electrically driven (RLED) robot manipulators operating under motion constraints, to overcome consideration of actuators dynamics and task space control problem. The controllers proposed in [2, 3] required full knowledge of system dynamics. If there are uncertainties in the dynamics, these controllers proposed may give a poor performance and may even cause instability. To overcome the uncertainties in the dynamics, robust controllers have been proposed in [4–10].
Stepanenko and Su [4] presented a simple robust nonlinear control law that incorporates the manipulator dynamics as well as dynamics of actuators. In contrast to the known methods, the presented design procedure is based on less restrictive assumptions regarding the characteristic of uncertainties. Lotfazar et al. [5] presented a hybrid adaptive controller for rigid link electrically driven robot manipulators. Integrator backstepping and passivity based method in the presence of parameters uncertainty and disturbance is suggested as a technique providing a framework for recursive design of nonlinear systems by achieving system stability in each step [6, 7]. In [8] voltage-based control strategy is presented as a novel approach for controlling electrically driven robot manipulators. In that study, the feedback linearization is applied on the electrical equations of the DC motors to cancel the current terms which transfer all manipulator dynamics to the electrical circuit of motor, and then the control design becomes simple.
All aforementioned studies are related to a control of rigid link electrically driven robots manipulators without considering joint flexibility. There are very few contributions in the literature about electrical flexible joint robots (EFJR) in which both of motor dynamics and joint flexibility are taken into account. Good et al. [11] showed that ignoring joint flexibility in manipulator dynamics and controller design causes degradation in performance of robots.
A simple adaptive robust control structure is designed for an EFJR manipulator under both structured and unstructured uncertainty by Fateh [9], but simulations results show poor tracking performance in tracking trajectory because the tracking error converges to 0.1 after a long time (6 s). The backstepping method is applied to cope with cascade structure and to find the control law to accomplish stabilization and tracking of a desired trajectory in [1]. In this study, a simulation result shows that the proposed controller is not robust in presence of external disturbances and is not fast in tracking trajectory. In [10], a robust decentralized controller for flexible joint electrically driven robots under imperfect transformation of control space, from task space to joint space, is presented.
The performance of all control strategies mentioned before is degraded for tracking purposes at high velocities. This is because of the dynamical terms such as Coriolis and centrifugal and the coupling effects which are related to the velocities of joints. These control systems are also dependent on the selected trajectory and the disturbances during the tracking operation. One solution is to compensate the dynamic term but this strategy can increase tracking error as seen in [9].
To cope with the problem of tracking trajectory at high velocity and variable joint stiffness, in this paper we proposed exponential tracking control using backstepping approach and we consider motor voltages as control input. The main idea is to modify the common backstepping algorithm such that the link position and velocity errors converge to zero exponentially fast. Backstepping approach ensures the global stability and global asymptotic stability of the close loop system.
This paper is organized as follows. In Section 2, the dynamic model of EFJR is presented in addition to its fundamental properties. In Section 3, exponential tracking control using backstepping approach is presented. Section 4 is devoted to the simulation results of the proposed control law. We achieve our task by a conclusion in Section 5.
2. EFJR Dynamic’s Model
Consider the link part of EFJR as a flexible joint robot manipulator with known system parameters: where and represent, respectively, the vectors of link positions and motor angles, is the diagonal matrix representing joint stiffness, is the link inertia matrix, represents the Coriolis and centrifugal terms, represents the gravitational terms, is the vector of motor torques, and is the diagonal matrix representing actuator inertia.
The dynamic equation (1) has been introduced in Spong [12], where the joint stiffness terms are assumed to be dominant relative to other parameters in the system. These equations are usually complicated nonlinear equations but they have several fundamental properties which can be exploited to facilitate control system design. These properties are as follows [12].(1)The link inertia matrix is symmetric and positive definite and both and are uniformly bounded.(2)If is suitably chosen, the matrix is skew symmetric and is uniformly bounded.(3)The gravitational term is uniformly bounded.(4)For rigid joint manipulator, the system parameters appear linearly in the equation as coefficients of known functions of , , and . By defining each coefficient as a separate parameter, we can represent the robot dynamics as where is an -dimensional vector of parameters and is an matrix of known function called regressor.
In order to obtain the motor voltages as the inputs of system, consider the electrical equation of geared permanent magnet DC motors in the matrix form as where is a vector of motor voltages, is a vector of motor currents, and is a vector of motor velocities. , , and represent a diagonal matrices for the coefficients of armature resistance, armature inductance, and back-emf constant, respectively. The motor torque vector as the input for dynamic equation (1) is produced by the motor current vector as where is a diagonal matrix of the torque constants.
In order to derive the control law with backstepping approach we choose , , and . The dynamic system of (1), (3), and (4) is described as In deriving the control law, the overall system is regarded as the cascade of three parts: the robot link dynamics, the motor dynamics, and the electrical part of the motor. The link dynamics is actuated by the motor angles through the flexible joints, the motor dynamics is actuated by the motor torques , and the electrical part is actuated by the motor voltage .
3. Controller Design
Backstepping is a recursive design methodology for constructing of both feedback control laws and associated Lyapunov functions in a systematic manner, whose significance for nonlinear control can be compared to root locus or Nyquist’s method for linear systems. The key idea in backstepping is to let certain states act as “virtual controls” of others [2]. For the used backstepping methodology, the system must be in strict-feedback form. Since the nonlinear equation of dynamic model presented in (5) is strict-feedback, backstepping controller design is proper choice to accomplish our control purposes.
In order to cope with flexibility of the joints and the loss of velocity due to this flexibility, we compute the desire control law of the link dynamics such that the link position and velocity errors converge to zero exponentially fast.
Step 1. Assume that is the control input. Then, the first equation of the system (5) is just the system with rigid joint robot dynamics and a good control law for would be
where is a diagonal matrix with positive elements, , , , and is a positive diagonal matrix.
Define ; substituting this new variable in the first equation of system (5) we obtain
Now, let us choose a Lyapunov function candidate . In order to investigate the stability of system (6), we compute its derivative. Then, we have
where the matrix is skew symmetric and implies that . Then, we obtain
If , then and as . Moreover, since and the transfer function is stable and is a minimum phase, it follows that and exponentially as .
Step 2. Now assume that is the control input of the second equation of system (5). In order to compute the control law for this equation, we first differentiate .
Consider ; defining , then
where .
Then the good control law for would be
where is diagonal matrix with positive elements.
Define . From (10) and (11) we have that
Choosing a Lyapunov function candidate
and computing its derivative, we have
If , then and , as . Moreover since , it follows that as .
Step 3. Also we assume that is control input for the third equation of system (5). Before computing the control input, we first differentiate .
Consider ; defining , then
where and is the fourth differentiate of the desire link angle . is computed by differentiating the following equation:
Choosing a Lyapunov function candidate
and computing its derivative, we have
Define . Substituting this expression into (18), we obtain
In order to satisfy Lyapunov stability condition, we choose
Then,
Step 4. In this step, the motor voltage is computing in order to ensure global asymptotical stability of system. We first differentiate .
Consider ; defining , then
where and is the fourth differentiate of the link angle . is computed by differentiating twist (16).
Let us define the Lyapunov function candidate as , and computing its derivative, we have
In order to stabilize the fourth equation of system (5), the control law is chosen as
where is diagonal matrix with positive elements.
Then it follows that
According to the Lyapunov stability analysis, the developed control law (24) guarantees that the equilibrium points , , , and are exponentially asymptotically stable. Moreover, the control law (6) ensures that and exponentially as . Exponential function property ensures that the tracking errors and converge quickly to zero. This quickness can deal with the looseness of velocity due to the flexibility of joint and its variable stiffness; therefore, control law (24) allows tracking trajectory in high velocity.
Combining (12), (15) and (20), and (22) and (24), the dynamical equation below is derived:
where is a zeros matrix and is a identity matrix; then exponential tracking control structure method is given by Figure 1.
4. The Cases Studies and Simulation Results
Two cases were studied in this section. In the first case, we will apply the proposed controller design in control of single flexible link electrically driven robot, in order to compare the exponential tracking controller performance to the simple backstepping controller performed in [1]. We will use the same model and the same parameter as those used in [1].
In order to show that the proposed controller can be applied in manipulators that contain more degrees of freedom, we consider, in the second case, the problem of control of two-degree-of-freedom flexible joint robot manipulators driven by brushed DC motor (Figure 2), with parameters given in Table 1.
The dynamic model of this manipulator can be described in the form of (26): where and are, respectively, the link center of mass of links 1 and 2.
4.1. Comparative Study
In this case, we compare the performances in tracking trajectory of the proposed controller with the simple backstepping controller performed in [1], in the control of single flexible link manipulator driven by brushed DC motor modeled in [1].
The exponential tracking controller gains are set as ; ; ; .
We consider the desired trajectory of the link angular position as follows: . The state initial conditions are selected as .
The simulation results are presented in Figure 3.
Figure 3 shows that the performance of the proposed controller is superior in tracking trajectory to the one performed in [1] (N°1 and N°2), with the same motor voltage (N°3).
To compare robust performances with respect to joint stiffness uncertainties, we simulate the system control for joint stiffness variables 100, 500, and 1000 using the same controllers.
Figure 4 shows that, with the same motor voltage, the proposed controller gives better robust performance with respect to uncertain stiffness than the controller computed in [1], because the tracking error for the proposed controller is the same in presence of joint stiffness as shown in Figure 4.
4.2. Evaluating Performances of Controller in Manipulator with More Degrees of Freedom
In order to show that the proposed control strategy is applicable to manipulator with more degrees of freedom and more flexible joint, the simulation results are presented for two-degree-of-freedom flexible joint manipulator presented previously. For this purpose, the exponential tracking controller gains are set as ; ; ; ; .
The controller (24) is used to track the desire trajectory: The state initial conditions are the same as those used in Section 4.1.
The simulation results are given by Figures 4 and 5.
Figure 5 shows the performance of the proposed controller on tracking trajectory. As seen in Figure 5, in less than 1 sec, our control goal is satisfied.
Figure 6 showed that the goal is satisfied with a small voltage and current, because after 1 sec, the motor voltages remain between −20 volts and 20 volts.
A comparison of the tracking performance of joint stiffness is shown in Figure 7. The control system has been simulated for joint stiffness 400, 500, and 1000 using the same controller’s gains.
The tracking control showed similar behaviors in different values of joint stiffness. This result showed the robustness of our proposed controller with respect to joint stiffness uncertainties.
As shown in Figure 8, the motor voltages respond fast with high value in the beginning. But after a small time (less than 1 sec), the values remain under 20 volts.
5. Conclusion
Exponential tracking control using backstepping approach was proposed in this paper to cope with the difficulty introduced by the cascade structure in EFJR’s dynamic model, to deal with flexibility in joints, and to ensure fast tracking performance. The controller design was performed by modifying common backstepping algorithm such that the link position and velocity errors converge to zero exponentially fast. The suggested controller required feedback information of position and velocity on the links and motors and armature current of each motor. The simulation results indicated that the proposed controller is superior to the simple backstepping controller performed in the literature for the control problem of EFJR and that it is robust with respect to joint stiffness uncertainties.
Conflict of Interests
The authors declare that there is no conflict of interests regarding the publication of this paper.