Abstract

This paper concerns the tracking control of a robot manipulator with unknown uncertainties and disturbances. It presents a new control method that uses only joint position measurements to design a tracking controller. The controller has two parts. One is based on a feedback linearization technique; it makes the nominal model of a manipulator asymptotically track a desired trajectory. The other is based on the idea of equivalent input disturbance (EID); it compensates for uncertainties and disturbances. Together they enable a robot manipulator to precisely track the desired trajectory. The new control algorithm is applied to a two-link robot manipulator, and simulation results demonstrate the validity of this method.

1. Introduction

Robot manipulators are widely used in many fields. They are especially useful in areas where it is impractical or undesirable for a human to go, for example, undersea exploration, radioactive environments, and defusing explosive devices. Interest in the control of robot manipulators has been increasing over the past few years [13], and it is now a central issue in robotics.

If an exact dynamic model of a robot manipulator is known, the motion control problem is easy to solve by the computed-torque-control (CTC) method [4]. It uses nonlinear state feedback to cancel the nonlinear terms and a simple PD controller for motion control. Although this method is simple and effective, the requirement of an exact model limits its practicality because it is usually impossible to obtain an exact, or even reasonably accurate, dynamic model in practical applications. For example, an actual plant inevitably contains structured and unstructured uncertainties, and a robot manipulator may be influenced by unpredictable external disturbances when the operating environment changes. Since these uncertainties and disturbances may greatly affect control performance, it is necessary to consider their effects in the study of the motion control of robot manipulators.

A number of strategies have been developed to solve the problem of controlling the motion of a robot manipulator with uncertainties and disturbances. They include a Lyapunov-based method [5], a neural-network-based method [6, 7], an adaptive neural network strategy [8], an adaptive switching learning PD (ASL-PD) method [9], a parameter-dependent nonlinear observer approach [10], and a variable-structure PID control method [11]. However, all of them require measurement of both the displacement and velocity of joints.

Generally speaking, joint displacement can be accurately measured with an encoder. However, velocity is typically measured with a tachometer, and the results usually contain noise, which can affect the control precision and performance of a closed-loop system. So, both practically and theoretically, it is meaningful to devise a motion control method for robot manipulators which relies only on the measurement of joint position. Various strategies have been developed to solve this challenging problem. One is a controller-observer combination strategy. It has a two-step design procedure: construct an observer for a robot manipulator based on joint information and use joint displacement and the state of the observer to design a state feedback controller. Many control methods based on this strategy have been reported [1214]. The problem with it is that the stability of both the observer and the controller is of a local nature. Another strategy [1517] involves using a linear or nonlinear compensator to obtain substitutes for the velocity variables. It enables the global tracking control of a robot manipulator, but the addition of external state variables complicates the design of the control system. A third is an adaptive tracking control strategy that includes an output feedback scheme (OFS) [18] and an iterative learning scheme (ILS) [19], but the OFS-based controller only locally ensures the asymptotic stability of the joint position error, and the ILS-based controller makes the system only track the same task iteratively.

This paper presents a new tracking control approach for a robot manipulator with unknown uncertainties and disturbances. Its advantage is that the design of the tracking controller relies only on the measurements of joint position, not velocity, and the tracking control is global. It is based on the concept of an equivalent input disturbance (EID), which was first presented in [20] to deal with disturbance rejection in a linear servo system. The EID approach has been validated through application to several mechatronic systems [2022]. In this study, it was used to design a global robust tracking controller for a robot manipulator. The controller has two parts: one makes the nominal model of a manipulator asymptotically track a desired trajectory and the other compensates for uncertainties and disturbances. Together they enable a robot manipulator with unknown uncertainties and disturbances to precisely track the desired trajectory.

The rest of this paper is organized as follows. Section 2 describes the model and formulates the problem. Section 3 explains the design of an EID-based tracking controller. Section 4 discusses a numerical example for a two-link robot manipulator. Finally, Section 5 presents some concluding remarks.

2. Model Description and Problem Formulation

For a robot manipulator with serial links, we take to be the acceleration, velocity, and position vectors, respectively, of the joints. Choose the Lagrangian of the robot system to be where is a positive-definite symmetric inertia matrix and is the potential energy of the system. The equation of motion of the manipulator is obtained from the Euler-Lagrange equation: where is the vector of control torques, is the vector of friction torques, and is the vector of the external disturbances imposed on the joints. We rewrite (2) in the general form where is the vector of Coriolis and centrifugal forces and is the gravity vector.

Due to the unmodeled dynamics, measurement error, and changes in environment, it is difficult to obtain precise values for the masses and lengths of the links, the moments of inertia of the links, and other physical parameters. The measured values of these parameters are usually not very accurate. Thus, the values of the matrices ,  , and in (3) are where , , and are the nominal values of , , and , respectively, and , , and are the corresponding additive uncertain terms. Consequently, (3) becomes where

We assume that there is no prior information about , , , , or . Thus, is an unknown disturbance of the nonlinear system (5).

Let be the desired trajectory of the manipulator, and let be the tracking error of the trajectory. If we take the control law, , in (5) to be where and are two given positive-definite diagonal matrices, then (5) and (7) give

Assume that , , , , and are all zero, which means that there are no parameter perturbations and external disturbances acting on the manipulator. Then, combining (6) and (8) yields

It is easy to obtain and for (9). So, the state variables of the system, , asymptotically approach the desired trajectory, , for this case.

However, in practice it is difficult to acquire exact knowledge of a robot manipulator; uncertainties and disturbances can greatly reduce the tracking precision. So, we need to consider the tracking control problem for the perturbed robot system (5). This paper presents an EID-based tracking controller for (5) that relies only on measured joint position, .

3. Design of EID-Based Tracking Controller

For the nonlinear system (5), we take where is defined in (7); , () are constants; and is a new input that is used to compensate for the disturbance, . Combining (5) and (10) yields

Let ; the state space form of (11) is where where is the identity matrix and is an zero matrix for positive integers and .

Since only the measured is available, we take the output of (12) to be

It is easy to verify that is observable. If we denote then Equation (16) tells us that has no zeros on the imaginary axis because where (), and and are the diagonal elements of the matrices and , respectively.

In addition, we choose in such that is controllable. Then, as shown in [20], there always exists an EID, , on the control input channel. It produces the same effect on the output, , as the disturbance, , does. The perturbed plant (12) and (14) can be considered to be an EID-based plant:

In the configuration of the EID-based control system (see Figure 1), is the feedback gain; is the observer gain; is an estimate of the EID, ; and is a low-pass filter that limits the angular frequency band of the disturbance estimate. Their design is discussed below.

3.1. Estimation of Equivalent Input Disturbance

First, we construct a full-order Luenberger observer for (18): where . Letting and substituting that into (18) yield where

Note that (21) has the same form as (18). We take to be an estimate of the actual EID, . From (18), (21), and (22), it is clear that the difference between the state of the plant and that of the observer is equivalent to the difference between and . Combining (19) and (21) yields

We solve (23) for and obtain a least-squares solution: where

To ensure the estimation accuracy, the low-pass filter is used to select the angular frequency band for disturbance estimation, where is the time constant. The filtered disturbance estimate, , is given by where and are the Laplace transforms of and , respectively.

We take control law to be where is a feedback gain that makes stable. Assume that the observer (19) is stable. Then, control law (29) makes the output of plant (18) asymptotically converge to zero. According to the definition of EID, control law (28) asymptotically stabilizes the output of (12), which is , at the origin. Thus, the tracking control objective of system (12) is achieved.

Remark 1. From (7) and (10), the velocity, , is needed to calculate the control input, . Since we assume that the measured value of is unavailable, we use information of the observer (19) to obtain a substitute for in (7): where , is the state vector of the observer (19), and .

3.2. Design of State Observer

Since the separation theorem holds for an EID-based control system [20], we can separately design the feedback gain and the observer gain . Since is controllable, it is easy to design a by any appropriate method (pole placement, optimal control, etc.). So, here we focus on the design of .

The design of should first ensure the stability of the state observer (19). We take where and are two given positive-definite matrices and is a positive scalar. Since is observable, is controllable. Thus, the observer gain, , designed in (31) makes stable, which means that the state observer (19) is stable.

On the other hand, we tackle the stability issue by first letting . From (19), (21), and (22), we have

Combining (24) and (10) yields

From (32) and (24), we obtain the transfer function from to :

Note that the transfer function from to is (Figure 2). The small-gain theorem [23] tells us that the condition must be satisfied to guarantee the stability of the control system, where and is the maximum singular-value function.

Since the number of inputs of the plant is not less than the number of outputs, and since is stable, according to [24, Theorems 1 and  3], we have

Note that is part of . So, for a given in (26), the observer gain, , designed in (31) makes the condition (35) true provided that is large enough.

4. Numerical Example

We applied the EID-based tracking control strategy to a two-link rigid robot manipulator (Figure 3) to demonstrate its validity.

The simulations employed the parameters (Table 1) of a PUMA 560 manipulator [7]. The matrices for the dynamics of the nominal model are where is the angle of the first link relative to the vertical, is the angle of the second link relative to the first link, is the mass of the th link (), is the length of the th link (), is the distance from the th joint to the center of mass (COM) of the th link (), is the moment of inertia around the COM of the th link (), is the torque applied to the th joint (), and is the gravitational constant (9.80665 m/s2).

Let the desired trajectory be

First, when , we choose for (7) and (9). Figure 4 shows the tracking control results for the initial condition Notice that the actual trajectories converge to the desired trajectories in less than 10 seconds.

Next, we consider the uncertainties in the physical parameters by letting and be larger than their nominal values, letting and be smaller than their nominal values, and letting and be larger than their nominal values. We also added two types of torques to the joints of the manipulator: (a) a viscous friction torque, : and (b) an external disturbance torque, (Figure 5):

The simulation results (Figure 6) for (5), (7), (40), and (41) show that the tracking performance was much worse, and a large steady-state tracking error appeared. That means that control law (7) by itself does not force the robot manipulator to track the desired trajectory when uncertainties and disturbances are present.

Finally, we applied the EID-based control strategy. We chose . It is easy to verify that is controllable. Letting all of the poles of be yields the feedback gain The design parameters for (26) and (31) were chosen to be

That gave

The simulation results (Figure 7) for (5), (10), (28), (40), (41), and (45) show that the tracking performance was much better than that in Figure 6. The EID-based controller (28) almost completely rejects the effect of the uncertainties and disturbances. So, the perturbed manipulator system (3) precisely tracks the desired trajectory. Since measurement noise is very common in actual control engineering applications, we also added white noise (peak value: ) to the measured . The simulation results (Figure 8) show that the robot manipulator precisely tracks the desired trajectory even in this case.

5. Conclusion

This paper presents an EID-based control strategy that solves the tracking control problem for a robot manipulator with unknown uncertainties and disturbances. It uses only joint position measurements in the design of the tracking controller. The controller has two parts: one part uses an exact linearization technique to guarantee the asymptotical stability of the nominal model and the other is based on the idea of EID, which compensates for the effects of parameter uncertainties and exogenous disturbances. The combination makes a robot manipulator precisely track the desired trajectory. Simulation results show the validity of this control strategy.

Acknowledgments

This work was supported in part by the National Science Foundation of China under Grants nos. 61304023, 61273012 and 61074112, by the Project of Shandong Province Higher Educational Science and Technology Program under Grant nos. J12LI58 and J13LI11, and by the Applied Mathematics Enhancement Program of Linyi University. The authors declare that there is no conflict of interests regarding the publication of this paper.