Interval Type-2 Fuzzy PD Tracking Control of Flexible-Joint Robots ()
1. Introduction
Fuzzy control as a model-free approach is simply designed to control complicated systems. In recent years, there has been an increasing attention to type 2 fuzzy logic system (FLS) in order to overcome the uncertainties. Type-1 FLS has difficulties in modeling and minimizing the effect of uncertainties [1] - [6] . This is because type-1 fuzzy set is certain in the sense that the membership grade for a particular input is a crisp value [7] . Type-2 fuzzy sets are characterized by membership functions (MF) that are themselves fuzzy [1] - [6] . The type-2 FLS (T2FLS) can be used when circumstances are too uncertain to determine exact membership grades such as when training data is corrupted by noise. The most frequently used T2FLS is interval T2FLS (IT2FLS) for their reduced computational cost [4] . Though the T1FLS is the most widely used application of fuzzy set theory, the T2FLS have been used in a few control applications such as nonlinear control and mobile robot navigation [1] , decision making [6] , sliding mode control design [2] and chaotic control [8] . The direct and indirect adaptive interval type-2 fuzzy control has been proposed for nonlinear systems [5] [7] . However, an analytical proof should be given to guarantee stability and provide a desired performance.
Control of a flexible-joint robot as a complex system can highlight the capabilities of the T2FLS. In order to improve industrial productivity, it is required to reduce the weight of the arms and/or to increase their speed of operation. However, as a bad effect, the flexibility in joints and links may occur. On the other hand, compared to the conventional heavy and bulky robots, flexible manipulators have the potential advantage of lower cost, larger work volume, higher operational speed, greater payload-to-manipulator-weight ratio, smaller actuators, lower energy consumption, better maneuverability and better transportability due to reduced inertia [9] [10] . As a result, several applications such as space manipulators [10] [11] necessitate using flexible joint robots.
The most important reason of joint flexibility is the essential use of power transmission systems which show the flexibility [12] . The control schemes proposed for the rigid manipulators are limited in their applicability to real robots [13] . Compared with rigid robots, number of degrees of freedom in the flexible-joint robots becomes twice as number of control actions while the matching property between nonlinearities and inputs is lost [10] [12] . As a result, to improve the performance and avoid unwanted oscillations for practical applications, joint flexibility must be taken into account in both modeling and control [10] . During the past two decades, trajectory tracking control study of robotic manipulators with joint flexibilities has attracted considerable attention including singular perturbation theory [14] , feedback linearization [15] , adaptive control [16] , sliding mode control [17] , fuzzy control [18] and neural control [19] . The principal limitation existing in the aforementioned control schemes is that these schemes assume that torques can be directly applied to the robot links. In the other words, the control is designed at dynamic level with torque as input namely, torque control strategy while the actuator dynamics is excluded. However, the actuator dynamics represents an important component of complete electromechanical systems, especially in the case of high-velocity movement and highly varying loads [20] [21] . Furthermore, the additional sensing requirements, actuator saturation, and long processing time should be considered to implement the torque control strategy [12] [22] . As an example of torque control strategy [23] , one can consider the complexity of the robust control of flexible-join robots. In some papers such as [20] the actuator dynamics is considered. However, the control problem may become more complicated due to considering the actuator dynamics.
To solve these problems, voltage control strategy has been devoted to the electrically driven robot manipulators [24] . In this strategy, the electric motors of the robot are controlled while the robot manipulator behaves as a load on the motors. Thus, a nominal model of the motor is required to design the controller with an advantage that the used model is simpler than the robot model. Recently, robust control [22] and nonlinear adaptive control [12] of flexible-joint robots have been developed using the voltage control strategy.
A model of robot may face uncertainties such as unmodelled dynamics, parametric uncertainty and external disturbances. In [25] , the set-point regulation control design for an electrically driven flexible-joint robot with model uncertainty was proposed. In [16] , an adaptive controller was developed to solve the tracking problem for electrically driven flexible-joint robot with time-varying uncertainty.
The contribution of this paper is to present an interval type-2 fuzzy PD (IT2PD) control approach for electrically driven flexible-joint robots. The proposed voltage control law has a simpler structure in the form of decentralized control yet more efficient than the torque control that is multivariable coupled control. As a result, the proposed control approach is free of many effects caused by manipulator dynamics. This is an important advantage of the proposed control approach over the torque based control approaches. Compared to the previous controllers reported in the literature for the flexible-joint robots which use two control loops, it has a simpler structure using only one control loop. This is the main novelty of this paper. Stability analysis is presented and the effectiveness of the proposed control approach is demonstrated by simulations.
The rest of the paper is organized as follows: Section 2 presents modeling of the flexible-joint robots. Section 3 introduces Interval type-2 fuzzy logic. Section 4 develops the proposed method. Section 5 presents the simulation results and finally, Section 6 concludes the paper.
2. Electrically Driven Flexible-Joint Robot Dynamics
In a simplified model of the flexible-joint robot [23] , the manipulator links are assumed rigid and motors are elastically coupled to the links. The motor torqueses are assumed as inputs of the robotic system. In this paper, the simplified model is applied for an electrically driven robot with some modifications to obtain them motor voltages as the inputs. Consider an electrical robot with revolute joints driven by the geared permanent magnet dc motors. If the joint flexibility is modeled by a linear torsional spring, the dynamic equation of motion can be expressed as [12] [22]
(1)
(2)
where
is a vector of joint angles,
is a vector of rotor angles. Thus, this system possesses 2n coordinates as
. The matrix
is a
matrix of manipulator inertia,
is the vector of centrifugal and Coriolis forces,
is a vector of gravitational forces and
is a torque vector of motors. The diagonal matrices
and
represent coefficients of the motor inertia, motor damping and reduction gear, respectively. The diagonal matrix
represents the lumped flexibility provided by the joint and reduction gear. To simplify the model, both the joint stiffness and gear coefficients are assumed constant. The vector of gravitational forces
is assumed function of only the joint positions as used in the simplified model [24] . Note that the vector and matrix are represented in bold form for clarity.
System (1)-(2) is highly nonlinear, extensively computational, heavily coupled and multi-input/multi-output system with the 2n coordinates. Complexity of the model has been a serious challenge in robot modeling and control in literature. It is expected to face a higher complexity if the proposed model includes the actuator dynamics. In order to obtain the motor voltages as inputs, consider electrical equation of the geared permanent magnet dc motors in the matrix form
(3)
where
is a vector of motor voltages,
is a vector of motor currents and
is a vector of rotor velocities. The diagonal matrices
and
represent the coefficients of armature resistance, armature inductance and back-emf constant, respectively. The motor torques
as input for dynamic Equation (2) is produced by the motor currents as
(4)
where
is a diagonal matrix of the torque constants. Equations (1)-(4) form the robotic system such that the voltage vector
is the input vector and the joint angle vector
is the output vector.
The dynamics of the electrical robot (1)-(4) in the state space is formed as
(5)
where
,
,
3. Interval Type-2 Fuzzy Logic System
A fuzzy logic system that uses at least one type-2 fuzzy set is called a type-2 fuzzy logic system. It is very useful in circumstances where determination of an exact membership grade for a fuzzy set is difficult [4] . As illustrated in Figure 1, a type-2 fuzzy membership function (MF) can be obtained by starting with a type-1 MF and blurring it. The extra mathematical dimension provided by the blurred area, referred to as the footprint of uncertainty (FOU), and represents the uncertainties in the shape and position of the type-1 fuzzy set. The FOU is bounded by upper and lower MF, and points within the “blurred area” have membership grades given by type-1 MF. The most frequently used type-2 fuzzy sets are interval fuzzy sets where each point in the FOU has unity secondary membership grade [3] .
An interval type-2 fuzzy set
in X is defined as [4] :
(6)
where x is the primary variable with domain X; u is the secondary variable, which has domain
;
is called the primary membership of x. Uncertainty about
is conveyed by the union of all of the primary memberships called the footprint of uncertainty (FOU) of
; i.e.
(7)
The structure of a typical type-2 fuzzy logic system is shown in Figure 2 It is similar to its type-1 counterpart, the major difference being that at least one of the fuzzy sets is type-2 and a type-reducer is needed to convert the type-2 fuzzy output sets into type-1 sets so that they can be processed by the defuzzifier to give a crisp output. General type-2 FLSs are computationally intensive because type-reduction is very intensive [4] . Therefore, we will use in this work the interval type-2 fuzzy logic systems for their simplicity and efficiency.
In the following subsections the operations in an interval singleton type-2 FLS are described in details.
Figure 1. Type-2 fuzzy logic membership function.
Figure 2. Scheme of a type-2 fuzzy logic system.
3.1. Fuzzification
In practice the computations in an IT2FLS can be consisting of
rules assuming the following form:
(8)
where
is the input vector,
are linguistic variables,
is an interval type-2 fuzzy set and
, which can be understood as the simplest Takagi-Sugeno-Kang (TSK) model. The fuzzifier maps a crisp point
into a type-2 fuzzy set
[26] .
3.2. Inference
The inference engine matches the fuzzy singletons with the fuzzy rules in the rule base. To compute unions and intersections of type-2 sets, compositions of type-2 relations are needed [9] . The first step in the extended sup-star operation
is to obtain the firing set
by performing the input and ante-
cedent operations. As only interval type-2 sets are used and the meet operation is implemented by the product t-norm, the firing set is the following type-1 interval set [26] :
(9)
where
and
the terms
and
are the lower and upper membership grades of
, respectively.
3.3. Type-Reduction
The type-2 fuzzy inference engine produces an aggregated output type-2 fuzzy set. The type reduction block operates on this set to generate a centroid type-1 fuzzy set known as the “type-reduced set” of the aggregate type-2 fuzzy set. Several type-reduction methods have been suggested in the literature, such as the center-of-sums, the height, the modified height and the center-of-sets, for example [4] [5] [26] . In this article, we consider the center-of-sets type reduction technique due to its computational efficiency. That may be expressed as [3]
(10)
where
is the interval set determined by two end points
and
, and firing strengths
.
and
can be expressed as [27] :
(11)
(12)
Two end points
and
can be computed efficiently using the Karnik-Mendel (KM) algorithms [28] . For example The EKM algorithm for computing
is given as:
1) Sort
in increasing order
2) Initialize
by setting
and then compute
3) Find switch point k (
) such that
4) Set
and
then compute
5) Check if
. If yes, stop, set
, and call k, L. If no go to step 6
6) set
and go to step 3
3.4. Defuzzification
Since the type-reduced set is an interval type-1 set, the defuzzified output is [27] :
(13)
4. Proposed Control Law
To control such a complicated system a novel simple controller is proposed using voltage control strategy. Electrical equation of a permanent magnet dc motor is written as
(14)
where
,
and
denote the armature resistance, inductance, and back emf constant, respectively.
is the motor voltage,
motor current, and
the rotor position.
represents the external disturbance.
The motor angle
as an output can be controlled via the voltage
as an input. It is very interesting to note that (7) is a single-input/single-output (SISO) system while the robot manipulator is a multivariable multi-input system. The motor current
contains effects of coupling between the motor and the manipulator.
From (2), we have
(15)
In addition, Equation (3) can be rewritten as
(16)
where
include unmodeled dynamics. Substituting (16) into (15) and using (5) yields
(17)
Taking the time derivative of the above equation yields
(18)
Substituting (18) into (14) gives
(19)
where
and
The current of the motor can be directly controlled using a PI controller as follows:
(20)
where
and
are positive constant gains.
is tracking error expressed by
. In the meantime,
is the actual joint angle and
is the desired joint.
Substituting (20) into (19) yields
(21)
Using (21) a control law is proposed as
(22)
where
is a positive constant and
is the estimation of
. After some manipulation, one can obtain
(23)
where
and
.
Equation (23) includes three terms. The first term is
and the second term can be considered as a PD controller. The third term is the estimation of uncertainty. As a result, we can conclude from (23) that a flexible joint robot can be controlled directly using a simple PD controller plus uncertainty estimation with an extra term expressed by
. It should be stated that the IT2FLC can be used instead of the PD control plus uncertainty estimation. This is why the IT2FLC can handle the uncertainty. Compared to the previous controllers reported for the flexible-joint robots which use two control loops, it has a simpler structure and more efficiency using only one control loop.
Suppose that
is the output of an IT2PD in the normalized form with the inputs of
and
. If three fuzzy sets are given to each fuzzy input, the whole control space will be covered by nine fuzzy rules. The linguistic fuzzy rules are proposed as
(24)
where
denotes the ith fuzzy rule for
. In the ith rule,
and
are type-2 fuzzy membership functions belonging to the fuzzy variables
and
, respectively.
,
and
are the gain in consequent part and
is the crisp output. The proposed interval type-2 fuzzy controller is for the case when antecedents are interval type-2 fuzzy sets (A2) and consequents are crisp numbers (C0). Three Gaussian membership functions with uncertain mean,
, named as Positive (P), Zero (Z), and Negative (N) are defined for input
in the operating range of manipulator as shown in Figure 3. Three Gaussian membership functions with uncertain mean,
, named as P, Z, and N in the same shape as Figure 3, are used for input
. As shown in Figure 3 all universes of discourses are normalized and arranged in [-1 1] with scaling factors external to the FLC used to give appropriate values to the variables. The role of input scaling factors becomes more important for using the Gaussian MFs for inputs. The input scaling factors are employed to take the input into the operating range covered by MFs otherwise the controller will not respond to the input. Input variables and output variable have scaling factors
,
and
for joint 1,
,
and
for joint 2,
,
and
for joint 3,respetively. The IT2PD controllers should be designed in such a way that the stability of control system is guaranteed.
5. Stability Analysis of the Control System
In other words,
in (11) can be rewritten as
(25)
where
and
. In the meantime, we have
.
In the similar manner,
in (12) can be rewritten as
(26)
where
and
. In the meantime, we have
.
From (13) after some manipulation, one can obtain
(27)
where
(28)
(29)
(30)
Figure 3. Membership function of the input e.
The obtained analytical structure of the fuzzy controller improves our study to develop the analysis and design. Using the scaling factors the input vector is formed as
(31)
where for the ith joint
and
are defined as
(31)
(32)
(33)
where
and
are the desired and actual joint position, respectively. From (32) and (33) we have
.
Using
and
, one can obtain
(34)
where
.
Fuzzy controller by the use of scaling factors is formed as
(35)
This general structure shows a nonlinear variable gain controller that finds many applications in control. The nonlinear gain
covers the nonlinearity of controller by parameters in hand. The control purposes are simply described by linguistic rules in fuzzy controller transformed to a nonlinear function as stated by (35).
Substituting (35) into (3) forms the closed loop system as follows
(36)
Assume that the motor voltage
expressed by (3) is limited such that
(37)
where
is a maximum permitted voltage for the motor. This assumption is a technical regard to protect motor against over voltages. The complexity of design and analysis has been changed to simplicity for using the model of motor in place of model of manipulator. Here, we should know only the upper limits for the motor voltages as inputs of robotic system. Because electrical motors drive the electrical manipulator, the motor voltages are the system inputs. The desired trajectory should be planned with regarding the maximum permitted voltages for motors somehow each motor is so strong such that can track the desired trajectory under the permitted voltage. Moreover, the desired trajectory should be smooth such that its derivatives up to the required order are available and limited. To find a control law for the convergence of error, a positive definite function is proposed as
(38)
where
is a positive definite function of
if
is positive. To satisfy
it is sufficient that
.
Proof: Assume that
where
is a positive constant. Thus,
(39)
we have
. Hence,
. Thus (39) implies that
for
. Since
and
is limited,
if
. Thus,
is a positive definite function of
.
The time derivative of
is calculated as
(40)
From (36) we can write
(41)
Substituting (41) into (40) yields
(42)
Since
for
, to satisfy
for stability, it is required that
(43)
Using the Cauchy-Schwartz inequality, one can obtain
(44)
Suppose that
where
is a positive constant. To satisfy (44), it is sufficient that
(45)
Since
, to guarantee stability
. This means that
must be designed with the same sign as
. This condition is simply satisfied if
is selected with the same sign as
.
From (45) and
, we obtain
(46)
From (30), one can obtain
(47)
where
and
are to constant. To select a constant value, we should select a value for
that satisfies (46) in all cases. The maximum permitted value for
is then selected as
(48)
Therefore, stability is guaranteed under assumptions
,
,
and
.
In the
rule,
is selected with the same sign as
to satisfy
. We can select
and
in all subsections but
that
and
to satisfy
,
, respectively.
Fuzzy rules in the 9 subsections for
are designed where the following cases occur:
Case 1 Assume that
resulting in asymptotic stability by
in (40). Thus, a small control effort is given to
.
Case 2 Assume that
or
resulting in Lyapunov stability by
in (40). Thus, a medium control effort is given to
.
Case 3 Assume that
and
both are positive or negative resulting in instability by
in (40). Thus, a very high effort is given to
.
The fuzzy rules for the first and second controllers are then given as:
Therefore, using the above analysis the
are bounded. Then one can imply the boundedness of
because of boundedness
and
.
Proof: From (28),
,
and
are bounded as
(49)
(50)
(51)
where
(52)
(53)
(54)
where
,
and
are constant.
Considering (9) we have
(55)
(56)
Thus, one can imply that
,
and
,
are bounded. The coefficient
is a constant parameter. As a result, the inequality (52) is verified.
Similarly, the inequality (53) and (54) are proven. Therefore,
is bounded using (35) as
(57)
According to the proof given by [22] , since the input
is bounded variable
is bounded.
Since the desired joint angle
and its time derivative
are bounded. The bound variables
and
imply that
and
are bounded.
Since
is bounded, (4) implies that
is bounded. From (2) we have
(58)
System (58) is a second order linear system with positive gains
, and a limited input
.This system is stable based on the Routh-Hurwitz criterion and implies that
,
and
are bounded.
Since all states associated with each joint i.e.
,
,
,
, and
are bounded, vectors
,
,
,
and
are bounded. As a conclusion, based on the stability analysis, all required signals are bounded.
6. Simulation
The proposed type-2 PD fuzzy controller is simulated using an electrical flexible-joint articulated robot manipulator. The articulated manipulator is a serial link manipulator with three revolute joints as shown in Figure 4. The Denavit Hartenberg parameters of the articulated robot are given in Table 1, where the parameters
and
are called the joint angle, link offset, link length and link twist, respectively. The dynamic parameters of manipulator are given in Table 2, where for the ith link,
is the mass,
is the center of mass of the ith frame and
is the inertia tensor in the center of mass frame with the details as
Figure 4. Symbolic representation of the articulated robot.
(59)
The parameters of motors are given in Table 2. The desired joint trajectories are smooth as given by
. The maximum voltage of each motor is set to
. To consider the parametric uncertainties,
and
are assumed to be 80% of their real values. Moreover,
,
and
are set to.01,200 and 30,
,
and
are set to 0.09, 400 and 200,
,
and
are set to 0.07, 200 and 100, respectively.
Simulation 1: In This simulation, the proposed IT2PD controller is simulated. The performance of control system is shown in Figure 5 while the joint tracking error is reduced well. The external disturbance is zero by given
in system (14). The control system overcomes disturbances very well. The control efforts are shown in Figure 6. The motor voltages behave well under the maximum permitted value of 50 V as shown in Figure 6. In other words, both two figures indicate the fact that the tracking performance can be guaranteed. The simulation results confirm the effectiveness of the proposed method.
Table 1. The Denavit-Hartenberg parameters.
Figure 5. Performance of the interval type-2 fuzzy PD controller.
Simulation 2: in this case a comparison between type-1 PD (T1PD) controller and T2PD controller is presented. In order to consider the robustness evaluation of the controllers, external disturbances are added to the robot system. The disturbance is inserted to the input of each motor as a periodic pulse function with a period of 2 S, amplitude
V, time delay of 0.7 S, and pulse width 30% of period. This form of disturbance is an example of any form that can be applied but it includes jumps to cover the complex cases. To better assess the performance of both types of controllers in the face of external disturbance and unmodeled dynamics, the integral of squared errors (ISE) and the integral of absolute control input (ISU) are considered as a criterion
(60)
(61)
where
and
are the tracking error of first, second and third link, respectively. In the meantime,
and
are the voltage of first, second and third motor, respectively.
The responses of control system using T1PD controller and IT2PD controller in the presence of disturbance are shown in Figure 7 and Figure 8, respectively. The tracking performance is shown in Figure 9 and it shows that the tracking error of T1PD controller is larger than the IT2PD controller. The ISU criterion for both controllers is shown in Figure 10, as well. From above simulation results, we obviously see that the T2PD controller can handle external disturbance very well. From Figure 9, the tracking performance of the IT2PD controller is much better than the tracking performance of the T1PD controller and in order to deal with external disturbance, as shown in Figure 10 the T1PD controller must spend more control effort. As a result, the simulation results confirm that IT2PD can outperform T1PD in controlling the flexible joint robot.
Figure 6. Control effort of the interval type-2 fuzzy PD controller.
Figure 7. The response of control system using T1PD controller in the presence of noise.
Figure 8. The response of control system using IT2PD controller in the presence of noise.
Figure 9. The tracking performance (ISE) of T1PD controller and T2PD controlle.
Figure 10. The ISU criterion for both controllers.
7. Conclusion
A novel interval type-2 fuzzy PD control was developed for tracking control of a flexible-joint robot using the voltage control strategy. The proposed method is free from manipulator dynamics and very simple in the form of a decentralized control. In addition, there are no restrictions on the joint stiffness gains. The stability analysis has verified the control method and the simulation results have confirmed its effectiveness. Compared to the previous controllers reported for the flexible-joint robots which use two control loops, it has a simpler structure using only one control loop. A comparison between interval type-2 fuzzy PD and type-1 fuzzy PD controller has been done and simulation results confirmed that type-2 fuzzy PD controller can handle external disturbance better than the type-1 fuzzy PD controller. In addition, it spends less control effort than the type-1 in order to deal with disturbance. Note that in the present paper a novel control approach has been proposed whereas in [29] type-2 fuzzy system has been directly used as a controller and Particle Swarm Optimization (PSO) used to optimize the control structure.
Acknowledgements
The authors gratefully appreciate the support of the Behbahan Khatam Alanbia University of Technology.