Abstract

This paper presents the method of synthesis of faults identification systems for electric servo actuators of multilink manipulators. These actuators are described by nonlinear equations with significantly changing coefficients. The proposed method is based on logic-dynamic approach for design of diagnostic observers for fault detection and isolation. An advantage of this approach is that it allows studying systems with nonsmooth nonlinearities by linear methods only. For solving the task of faults identification, a residual signal feedback was proposed to be used for observers. The efficiency of the proposed fault identification system was confirmed by results of simulation.

1. Introduction

At present, the use of multilink manipulators (MM) has considerably extended and the operations which are carried out by them become more complicated [14]. The occurrence of any faults in actuators of MM may lead to significant aggravation of quality of performance of the MM operations and reduction of accuracy. Therefore, the reliability and safety of such complex equipment at operating in autonomous mode have the significant importance. Today the most typical actuators of MM are electric servo actuators. One way to improve the reliability of electric servo actuators of MM is using real-time fault diagnosis and fault tolerant control [1]. Fault tolerant control is based on forming special control, providing automatic stabilization of the main parameters of actuators when faults occur [2]. For providing such control, all possible faults should be timely detected and their values should be estimated.

The problem of fault detection and isolation (FDI) was extensively investigated for the past 20 years; see, for example, the surveys [2, 58] and the books [9, 10]. Many problems have been studied and solved: different methods of residual generation and relationships including robustness and adaptive threshold test, -approach, and fuzzy logic; many types of systems have been considered: linear, descriptor, and different classes of nonlinear systems. Many practical examples were considered; in particular, special book was devoted to robotic systems [11].

As a rule, the electric servo actuators of MM are nonlinear essentially with such types of no differentiable nonlinearities as saturation, Coulomb friction, backlash, and hysteresis [12]. Therefore, one has to use nonlinear methods of the FDI. However, most of papers dealing with the FDI problem consider the nonlinear systems with differential nonlinearities [1316]; therefore they cannot be used in our case.

At present, there are several approaches for designing diagnostic observers allowing fault diagnosis for systems with no differentiable nonlinearities. Among them there are methods using the algebra of functions [17], the logic-dynamic approach (LDA) [1820], and others [2124]. Whereas the algebra of functions demands complex analytical calculations using symbolic mathematical packages, the LDA allows using the methods of linear algebra for nonlinear systems and provides relatively simple procedure for synthesis of diagnostic observers. The LDA includes three steps: replacing the original nonlinear system with appropriate linear system, constructing the set of linear diagnostic observers, and adding to these observes the nonlinear parts. But LDA can solve only FDI problem without fault identification. To estimate the value of the faults, one uses in [19, 20] a feedback in diagnostic observers. These methods provide the faults identification for only first-order diagnostic observers. But at case when electric servo actuators of MM have partially measured state vector, then there are no guarantees that observers will have first order.

The present paper suggests a solution to the problem of developing the method of synthesis of fault identification (FI) system for electric servo actuators of MM which are described by mathematical model including differential equations with nonlinearities and partially measured state vector. The proposed method assumes the use of the diagnostic observers based on LDA with special feedback signal dependent on the residual for real-time identification of fault value.

The paper is organized as follows. Section 2 describes the model of electric servo actuators of MM. Section 3 is devoted to the synthesis of diagnostic observers for FDI using logic-dynamic approach. Firstly, the main steps of this approach are given and then the observers are described in detail. In Section 4, the methods of synthesis of FI system for created observers are presented. First, the analysis of mismatch of states of electric servo actuator and the observer is given and then the synthesis of residual signal feedback is shown. An example is considered in Section 5. Section 6 concludes the paper.

2. Description of Dynamics of Electric Servo Actuators of MM

In this paper, the MM with PUMA type kinematic scheme with 6 degrees of freedom is considered (see Figure 1). Today, the MM with such kinematic scheme are mostly used in industry. Each degree has an electric servo actuator that includes DC motor, reducing gear and sensors measuring the electric current, angular speed of DC motor rotor, and angle of rotation of output shaft of reducing gear.

It is expedient to use the second form Lagrange equation or other methods to obtain the moment torques in each degree of freedom of the MM (see Figure 1) while moving its gripper along the complex spatial trajectory, if laws of change of generalized coordinates () of the MM are known.

The expressions for moments acting in each degree of freedom of MM can be represented in the form [3]where is the diagonal element of matrix of inertia of MM; is the element of the vector of Coriolis and centrifugal forces; and is the torque which represents interactions acting to ith degree of freedom from other MM’s links and also action of the gravitational forces. These values with the help of second Lagrange equation are defined. Further for simplicity we will not write the index i.

It is assumed that the following typical faults are possible in each electric servo actuator of the MM:(i)The fault caused by change of value of Coulomb friction moment in reducing gear(ii)The fault caused by change of value of Coulomb friction moment in DC motor(iii)The fault caused by change of value of electrical resistance .

Considering (1) and these faults, model of electric servo actuator of the MM can be presented by the following differential equations: where and are speed and angle of output shaft of reducing gear; and are speed and angle of DC motor shaft; , , and are resistance, inductance, and current of electric motor rotor circuits, accordingly; is a coefficient of counter-EMF; is a coefficient of motor moment; J is a rotational inertia of rotating parts of reduction drive and DC motor; is rigidity of mechanical transmission; is a coefficient of the reducing gear; is control signal; is an amplifier gain; and are coefficients of Coulomb friction of DC motor and reducing gear; and the variables () represent the effects of faults on the system and are of the form

Equation (2) has nonlinearities and significantly changing coefficients because of changes in parameters , , and .

3. Synthesis of Diagnostic Observers for FDI Using LDI

System (2) can be represented by the differential equation in a matrix form as follows: where is a vector corresponding to the system nonlinearities, , , , , ,

If faults occur during the work of MM, they should be promptly detected and identified. Then the fault tolerant control can be used. The traditional methods of diagnosis that focus on systems described by linear models cannot provide the solution to the problem of synthesis of FI systems for electric servo actuators of the MM described by model with the parameters , , and that are significantly variable and under the presence of the nonlinear component .

In this paper, another synthesis method of FI systems is proposed. This method includes two basic steps [25]: using LDA to construct the diagnostic observer [17, 18] which can detect occurrence of specific faults; introducing the specific feedback in observers for identification of the fault values [19]. Below these stages are considered in more detail.

The LDA to solve the FDI problem for system (4) includes the following steps [18]: replacing the initial nonlinear system (4) by linear system; solving the FDI problem for the linear system with some additional restrictions and obtaining the bank of linear observers; transforming the linear observers into the nonlinear ones. Thus, the nonlinear diagnostic observers detecting the faults are of the following general form:where is the state vector of the observer, is the output vector, , , , , and are constant matrices, and k is dimension of the observer; it is assumed that the matrices and can be represented in a canonical form

The observer (6) generates the residual for certain row matrix which has to be determined. If there are no faults and , then ; if a fault occurs, . It is well-known from the linear FDI theory [2, 9, 26] that, for the observer design, the matrix where in the unfaulty case after the response to unlike conditions has died out plays the main role. In the absence of faults, the following well-known set of equations holds [2, 9, 26]:

For each fault , the diagnostic observer should be constructed. Matrices and vectors , , , , , and describing the observer can be found in (8) [17]. As a result, the observers , , and for the faults d1, d2, and d3 were obtained::::

As a result, the synthesized observers , , and provide solving the FDI problem for electric servo actuators of MM. Clearly, the observers and have order more than one. This is caused by the fact that the electric servo actuator (2) has the partially measured state vector. Therefore, the known methods [19, 20] for FI cannot be used. Below the new synthesis method of FI systems for observers constructed by using LDA is proposed.

4. Synthesis of FI System for Observers Created by Using LDA

To solve the problem of FI for synthesized observers, consider how residual r(t) changes when the faults occur. After differentiating the equation for residual and taking into account (4), (6), and (8), the following can be obtained:

The vector is introduced which is a mismatch of states of electric servo actuator and the observer:

Taking into account the vector , the residual is a first element of mismatch vector . Therefore, (12) can be rewritten as

Analysis of (14) shows that if order of the obtained observer is one (i.e., ), then if faults occur, the following conditions are true: ,  , and . In this case, the feedback is proportional to the residual signal as Tr(t) ( is the feedback coefficient) and allows identifying the faults value [19, 20]. However, in case when order of the observer is more than one, due to . Moreover, in (6) the components and are unknown. As a result, it is impossible to make fault identification. To solve this problem, one proposes a feedback of residual signal which provides . In this case the value of this feedback is proportional to the value of fault. This provides a possibility of identifying the fault value.

After the introduction of proposed residual signal feedback, the model of observer will bewhere is the vector specifying feedback dependent on the residual signal.

Considering the feedback (15), equation for the mismatch vector is as follows:

Equation (17) can be rewritten in the form where is the vth element of the vector , , and is the vth element of vector .

When and the initial conditions of the electric servo actuator and the observer are agreed upon, are zero regardless of occurrence of the fault. Taking this into account, it is possible to rewrite (18) in the form of a differential equation:

Making elements of the feedback vector, except the vth element, proportional to the residual () and ( are feedback coefficients), one obtainsFeedback coefficients are chosen to guarantee the stability of observers [25].

Consider as input signal and as output; then (20) can be presented by a transfer function , where s is the symbol of Laplace transformation. Suppose that input can be presented by a polynomial of degree The Laplace transformation of such input is Then the steady value of can be found as Assuming , it is possible to obtain

Thus, the introduction of such a feedback results in a steady value of . This also results in resetting all elements of the vector . For many real systems, value of the fault is constant or slowly changes and it is sufficient to introduce one integral of residual in feedback to achieve the required accuracy of the faults identification: . Thus, after using this kind of feedback, residual tends to zero, after the completion of the transition process, including the event when the faults occur. This ensures the synchronization of state vectors of the electric servo actuator and the observer. Thus, fault dj can be found as

After applying the proposed procedure for observers , , and , we receive the following feedback for fault identification::::

Finally, considering the expression (21), it is possible to identify the faults value for the electric servo actuators of the MM:

Thus, the problem of identification of value of faults has been solved.

5. Simulation of Performance of FI System

Analysis of effectiveness of developed FI system was implemented using PUMA type of the MM. The FI system was synthesized for electric servo actuator of second degree of freedom of MM (see Figure 1). The results for other degrees of freedom of the MM are similar.

The second degree of freedom of MM has the terms , , and as follows:where and are the moments of inertia of link i along its longitudinal and transverse axis passing through its center of mass, accordingly; is the mass of link i; is the mass of the load; is the length of link i; is the length from ith joint to the center of mass of ith link; is the acceleration of gravity; and , , are the angle of rotation of the link i and its derivatives.

The following set of parameters of MM was used for simulation:  m,  m;  m,  kg;  kg,  kg;  kg·m2,  kg·m2,  kg·m2,  kg·m2,  Ω,  H,  V·s,  N·m/A,  kg·m2, ; = 800, N·m, and N·m·s/rad.

The input signals , , and were applied to the electric servo actuator. The parameters of feedback for observers were chosen as follows:

Faults were presented by changing the following values:(i)Coulomb friction coefficient in reducing gear by 50% ( N·m and  N·m) at the time from  s to  s(ii)Coulomb friction coefficient in DC motor by 50% ( N·m and  N·m) at the time from  s to  s(iii)Electrical resistance by 50% ( Ω and  Ω) at the time from  s to  s.

Values of introduced faults (curve 1) and estimated value of fault (curve 2) are shown in Figures 27. It follows from these figures that the constructed FI system provides accurate estimation of occurred fault. The results of simulation confirm the efficiency of the proposed method. Realization of the synthesized FI systems does not present any difficulties. These FI systems can be realized with the help of serial microprocessors.

6. Conclusion

In this paper, the method of synthesis of accurate FI systems for electric servo actuators of the MM, which are described by nonlinear differential equations with variable parameters and partially measured state vector, is suggested. This method consists in applying the logic-dynamic approach for synthesis of diagnostic observers guaranteeing detection and localization of possible faults and introducing of special feedback in diagnostic observers, allowing identifying values of faults. Efficiency of the proposed method was confirmed by the results of simulation. The subject of further research is application of the proposed method for synthesis of the fault tolerant control systems for actuators of the MM.

Conflicts of Interest

The authors declare that they have no conflicts of interest.

Acknowledgments

These researches were supported by projects: Grant of President of Russia (MK-8536.2016.8) and Grants 16-29-04195 and 16-07-00300 of RFBR.