The controller of the robot was implemented using
the algorithm (2). To calculate the τ
PID
term of the
control algorithm two approaches were tested: a PD
controller with high gain amplification and a PID con-
troller. The disturbance observer was implemented
using the relation (14) with k
d1
= k
d2
= 25 for which
the cutoff frequency of the disturbance observer is
around 10 Hz for both channels. In order to test the
robustness of the proposed fault detection method the
inertial parameters I
1
, I
2
and the parameters l
c1
and
l
c2
were departed (decreased) with 5% from their real
values in the equations of the control algorithm and
the disturbance observer.
In the case of fault, the control errors increases in
both joints even when the fault influences only one
joint. When the linear part of the control is a high
gain PD, the fault increases the tracking errors. When
the linear part of the control is PID type the integral
term in the controller compensates the increased load
value, the tracking error converges to zero again (see
Figures 4 and 6).
In the Figures 5 and 7 it can be seen that in both
cases (with PD and PID type linear control terms) the
estimated loads track quickly and precisely the real
value of the loads, hence the generated signals can
be used for fault detection. In both cases the esti-
mated disturbances have similar evolutions in time,
which shows that the disturbance observer has little
dependence on the chosen linear term in the control
law. The increased load is also isolated precisely at
joint level, hence the location of the overload gener-
ated fault can be determined based on the disturbance
observer generated signal.
5 CONCLUSIONS
A fault detection method was introduced for robot
control systems controlled by computed torque-like
control algorithms. During detector design it was
taken into consideration that the friction in the joints
of the robot depends on the load induced disturbance
forces or torques. The residual is generated based
on the estimated load value, by assuming that the
upper bound of the load is known. The proposed
load observer can be implemented with low compu-
tational costs. Simulation measurements showed that
the proposed disturbance observer can precisely es-
timate and isolate the overload at joint level and it
is robust against modeling errors and high frequency
disturbances.
ACKNOWLEDGEMENTS
The research work of L. M´arton was supported by
Alexander von Humboldt Stiftung/Foundation schol-
arship for post-doctoral researchers and by the Hun-
garian National Research program under grant No.
OTKA K71762.
REFERENCES
Astrom, K. J. and de Wit, C. C. (2008). Revisiting the Lu-
Gre friction model. IEEE Control Systems Magazine,
28(6):101–114.
Bittencourt, A. C., Wernholt, E., Sander-Tavallaey, S., and
Bordardh, T. (2010). An extended friction model
to capture the load and temperature effects in robot
joints. In IEEE/RSJ International Conference on In-
telligent Robots and Systems, Taipei, Taiwan.
Chan, S. P. (1995). A disturbance observer for robot ma-
nipulators with application to electronic components
assembly. IEEE Trans. on Industrial Electronics,
42(5):487–493.
Chen, W.-H., Ballance, D. J., Gawthrop, P. J., and OReilly,
J. (2000). A nonlinear disturbance observer for robotic
manipulators. IEEE Trans. on Industrial Electronics,
7(4):932–938.
Dixon, W. E., Walker, I. D., Dawson, D. M., and Hartranft,
J. P. (2000). Fault detection for robot manipulators
with parametric uncertainty: A prediction-error-based
approach. IEEE Trans. on Robotics and Automation,
16(6):689–699.
Dragan, V. and Stoica, A.-M. (2007). Kalman-type esti-
mation for systems corrupted with additive and mul-
tiplicative white noise. In Proc. of The International
Symposium on System Theory, Automation, Robotics,
Computers, Informatics, Electronics and Instrumenta-
tion, Craiova, Romania.
Dunbar, W. B., de Callafon, R. A., and Kosmatka, J. B.
(2001). Coulomb and viscous friction fault detec-
tion with application to a pneumatic actuator. In
IEEE/ASME International Conference on Advanced
Intelligent Mechatronics, Como, Italy.
Gao, Z. and Wang, H. (2006). Descriptor observer ap-
proaches for multivariable systems with measurement
noises and application in fault detection and diagnosis.
Systems & Control Letters, 55:304 – 313.
Gershon, E., Shacked, U., and Yaesh, I. (2005). H
∞
Control
and Estimation of State-multiplicative Linear systems.
Springer, London, UK.
Haddadin, S., Albu-Schaffer, A., Luca, A. D., and
Hirzinger, G. (2008). Collision detection and reac-
tion: A contribution to safe physical human-robot in-
teraction. In IEEE/RSJ International Conference on
Intelligent Robots and Systems, Nice, France.
Jiang, B. and Chowdhury, F. N. (2005). Parameter fault
detection and estimation of a class of nonlinear sys-
tems using observers. Journal of the Franklin Insti-
tute, 342:725–736.
ICINCO 2011 - 8th International Conference on Informatics in Control, Automation and Robotics
110