1. Introduction
With the rapid development of computation and communication techniques, information science is increasingly becoming the research focus [
1,
2,
3]. As an application of information science, robotics and intelligent systems are frequently utilized in industrial fields that require high safety, reliability and accuracy. Examples can be found in the advanced automated production and inspection line, mining, disposal of hazardous materials. However, robotics systems are always plagued by failures for many reasons such as incorrect operation and mechanical failure. Accurate fault detection and health assessment of robotics systems are significant, especially for robot manipulators [
4,
5,
6].
For the past two decades, intensively investigations have been involved in fault detection of robot manipulators with different system models, see [
7,
8,
9,
10,
11,
12,
13] and the references therein. So far, the fault detection for robot manipulators is still a key issue due to its great application potentials in both commercial and military areas [
14,
15,
16,
17].
Among the existing works related to fault detection for robot manipulators, the parameter estimation and the state observer are also two commonly used techniques. In [
18], a model-based diagnostic scheme for actuator and sensor faults that may occur on a robot manipulator was present. The fault detection was achieved by a generalized observer scheme based on second-order sliding-mode approaches. However, the model-based detection scheme may suffer from modeling uncertainties due to various factors, such as aging equipments and internal system noise. To address it, Ma and Yang formulated a model-based actuator and sensor fault detection and isolation scheme for robot manipulators. They presented a nonlinear function to estimate the fault parameters with a pre-specified estimation error bound [
19]. The parameter-variance model of a fault-tolerant multi-sensor switching strategy for robot manipulators was considered in some recent studies [
20,
21,
22]. A novel detection approach for multi-joint robots was proposed and a collision observer was designed iteratively through order reduction and re-selection of observer variables to improve computation efficiency [
23]. Compared with the generalized state observers, the adaptive state observer shows a better performance in dealing with the disturbance [
24]. By designing some adaptive nonlinear observers, a multiple fault detection scheme for robot manipulators was proposed in [
25].
Despite the above mentioned literatures involved in fault detection with modeling uncertainties, the works addressing both internal and output measurement disturbances in robot manipulators diagnostics are rare. The various disturbances in the system make it a challenging work to accurately detect the fault manipulator. Motived by this, we consider the fault detection for robot manipulators with both internal and output measurement disturbances. A novel fault detection and health assessment approach is proposed to better reflect the possibility of robot manipulator failure. We design an adaptive observer to reconstruct the robot manipulator system, and the health degree of the manipulator is determined by comparing the real system with the original system. The feasibility of the proposed fault detection algorithm and the health assessment approach are verified by numerical simulations.
The remainder of this paper is organized as follows. We describe the kinetic model in
Section 2. In
Section 3, a fault detection approach for robot manipulators in disturbance condition is presented. The health assessment approach is given in
Section 4, while the simulation results are provided in
Section 5 for testifying the performance of our proposed approaches. Finally, the concluding remarks are provided in
Section 6.
2. Kinetic Model
The dynamic model of an n-degree-of-freedom (n-DoF) robot manipulator [
26] can be written in joint space as the following form
where
represent joint angular position, velocity and acceleration, respectively.
denotes the positive definite symmetric inertia matrix.
and
denote the Centripetal-Coriolis [
27] and gravitational effect respectively.
is the external disturbance torque that obeys a Gaussian distribution with zero mean.
is the actual output torque generated by robot joint actuators.
Denote
as the expected output torque, then we have
in the fault-free case. When the fault occurs, there is an error between the expected output torque and the actual output torque, which can be described as
. Let
be the state vector and
be the ratio between the actual output torque and the expected output torque, we can establish a state-space model as
where
,
,
, , . are the system noise and output noise signals that follow a Gaussian distribution with zero mean.
3. Fault Detection Algorithm
The objective of the fault detection algorithm is detecting relative errors between the expected output torque and the actual output torque by limited measurable output data [
28]. With the increment of relative errors, the fault possibility of the robot manipulator increases. In this context, we can transform the fault detection to an identification problem of parameter
. The relative errors between the expected output torque and the actual output torque can be represented as
. Therefore, regarding
as the unknown parameter, we apply the idea of adaptive state observer (ASO) [
29] to identify the value of
. Before giving the fault detection algorithm, some assumptions are given below.
Assumption 1. The state , the control and the unknown parameters θ are bounded, i.e., , , and with compact sets , and .
Assumption 2. The function and are Lipschitz with respect to x uniformly in u, where . Let the Lipschitz constants be and , it can be obtained that In order to identify the true value of θ, we design an ASO aswhere are two auxiliary matrices, the symmetric positive definite matrix S is the unique solution of with a constant k, is the Hurwitz matrix, U is bounded and has an upper bound. Assumption 3. The input U is such that for any trajectory of system starting from , the matrix is persistently exciting in the following sense: Theorem 1. When the observation algorithm satisfies the Assumptions 1–3, there exists a constant , such that for any and initial value , the mean of the estimated errors and converge to 0.
Proof. Denote the errors between the true values of
and the observed values of
be
and
, we can get the derivation of errors as
where
and
. Denote
, one can derive
Firstly, we discuss the convergence of the system without noise signals, i.e.,
,
. To avoid confusion, the variables
x,
,
in the noise-free system are denoted by
,
,
, respectively. Then, we can obtain
Let
,
, where
S and
are given by Equation (
5), we define the Lyapunov function
. Based on Equation (
8), it is derived that
From the definition of
, it is clear that
with
. Based on Assumptions 1–3, it can be deduced that
where
. Further, we set
,
, then one can get
Obviously, we can find
, such that
when
. Thus,
converges to zero asymptotically, which implies that
are asymptotically stable. From
, it is known that
is also asymptotically stable. Therefore, we can get that the system is asymptotically stable. Since
it can be readily deduced that
and
are bounded under the bounded noise signals
and
. Thus,
and
are also bounded. That is to say,
,
.
Besides, taking noise signals
and
into account, we can get
where
E is an operator for calculating the mean value. As
and
are Gaussian distribution signals with zero mean, it can be derived that
Then we have when . The proof is completed. □
According to Theorem 1, it is known that the mean value of observed parameters can converge to the true value of . Therefore, the proposed detection algorithm is available for the fault detection of n-DoF robot manipulator.
4. Health Degree Assessment
Based on the fault detection algorithm proposed above, the observed parameters can be obtained. Here, we take the mean value of over a period of time as a criterion for health assessment.
For the n-link (n-joint) robot manipulator, a weight vector
is given according to the importance of each joint. We define a nonlinear function
with a convex function
, then the health degree of the robot manipulator is evaluated by
, where
is the upper bound of the health degree,
is the nonlinear dead zone threshold.
Once the health degree drops below a certain threshold that can be set in accordance with the specific situation, relevant alarm and emergency measures should be implemented timely. Therefore, the health assessment index can be used to evaluate the failure risk of the robot manipulator.
5. Simulation
In the simulations, we consider a 2-DoF robot manipulator moving in the vertical plane with gravity. The robot links are assumed to be a rod of length 1 m and 0.8 m with concentrated mass at the rod end of 1 kg and 1.5 kg, respectively. The dynamics of the 2-DoF robot manipulator can be described as
where
,
,
,
,
are white Gaussian noise signals with mean 0 and variance 0.01.
We set
,
,
,
,
,
and
. The simulation results are presented in
Figure 1.
As discussed in
Section 3, the actual dynamic robotic system can be regarded as a drive system, and our proposed ASO is treated as the response system. The errors between estimated state values and true values can be seen in
Figure 1. The four states eventually converge to the real values, and the errors approach zero. This demonstrates the convergence of the proposed algorithm.
In
Figure 2, we testify the performance of our algorithm for the observation of unknown parameters. For comparison, we introduce the extended state observer (ESO) proposed in [
23]. Before 10th second, the real system runs at the expected state, i.e.,
. At 10th second, the fault occurs due to several unpredictable external or internal disturbances, and
. From
Figure 2, it can be seen that due to the random fluctuations in the system, the estimated parameters based on both ASO and ESO will eventually converge to a value near the true value. However, the proposed ASO shows a faster convergence rate than the ESO. This also verifies the effectiveness of our fault detection algorithm.
Choose
, we can obtain
,
based on the health assessment approach proposed in
Section 4. Compared with
Figure 2, the mean value of the estimated parameters over a period of time is closer to the true value as shown in
Figure 3. This is consistent with our theorem. In addition, this also shows that a health assessment
based on the mean estimation over a period of time is more effective than that based on only one estimation.
Finally, we select
,
and
to quantify the health degree. Given a nonlinear function
as a quadratic function
, the evolution curve of the health degree of the 2-DoF robot manipulator over time is shown in
Figure 4. As the fault occurs, the health degree drops sharply to around 60, which verifies the rapidity of our fault detection algorithm and the applicability of our health degree assessment index.
It is noted that the 2-DoF robot manipulator in the simulations is used only as an illustrative example for testifying the performance of the proposed fault detection algorithm and health degree assessment index. Since our theoretical analysis in
Section 3 and
Section 4 is based on the dynamic model of an n-DoF robot manipulator (
Section 1), the results of
Figure 1,
Figure 2,
Figure 3 and
Figure 4 can be generalized to robot manipulators with arbitrary DoF.
6. Conclusions
In this paper, a state-space model of the n-link manipulator is formulated based on the physical characteristics of manipulators. The internal system disturbance and the output measurement disturbance are further considered. A novel fault detection algorithm for the robot manipulator is proposed. The algorithm employs an adaptive observer to reconstruct the real robot manipulator system, and compares the real system with the original system to judge the fault possibility. Furthermore, we propose a health assessment approach based on the proposed fault detection algorithm, which can better reflect the possibility of robot manipulator failure. The validity of our fault detection algorithm and the rationality of our health assessment index are verified through experimental data with a 2-degree-of-freedom robot manipulator. Due to the high penetration of robot equipments in the current industrial field, it is envisioned that our work will provide an effective method for the risk management in real systems. In the future, we will apply the proposed method to the automated production and inspection lines in the electrical industry.
References