Академический Документы
Профессиональный Документы
Культура Документы
Abstract: This paper presents a fractional system perspective in the study of signals
captured during impacts and vibrations of mechanical manipulators. In order to acquire
and study the signals an experimental setup was developed. The system acquires data
from the sensors, in real time, and, in a second phase, processes it through an analysis
package. The experimental study provides useful information that can assist in the design
of a control system to be used in eliminating or reducing the effect of vibrations.
Copyright 2006 IFAC
study presented here can assist in the design of the Force/Torque Adapter
Circuit rr
r
Low Pass rFilter
control system to be used. r
& Level Adjust
rr
rr
Hall-Effect
r
Current Sensor
3. EXPERIMENTAL PLATFORM
Power & Signal Connector
The developed experimental platform has two main Force/Torque
Sensor
parts: the hardware and the software components. In External
Axis
From
Accelerometers
the following sub-sections these components are Accelerometers
From Position
briefly described (Lima, 2005). Sensors To Motors
Flexible Beam
Robot Controller
The hardware architecture is shown in Fig. 1. Fig. 1. Block diagram of hardware architecture.
Essentially it is made up of a robot manipulator, a
Personal Computer (PC) and an interface electronic
The robot used is an anthropomorphic type with five
system. The interface box is inserted between the
degrees of freedom (dof), model Scorbot ERVII from
robot arm and the robot controller, in order to acquire
Eshed Robotec. To measure the electrical current
the internal robot signals; nevertheless, the interface
supplied to each motor a Hall-effect sensor is
captures also external signals, such as those arising
inserted to avoid interfere with robot electronics. A
from accelerometers and force/torque sensors, and
circuit board was developed to handle the signal from
controls the external micro-arm. The modules are
the sensor up to the A/D converter. The power
made up of electronic cards specifically designed for
supplied to the motors is based on a pulse width
modulation (PWM) driver with a frequency of 20 was developed in C based on a standard Windows
kHz. The motors rotate according with the DC NT/2000 development tool (MS Visual Studio) and
component of electrical current and, in order to the robot controller software was implemented in the
measure it, a low-pass filter was implemented for ACL proprietary language. The Windows NT/2000
each measurement channel. Thus, a first function of Software is made up of the GUI module of the
the interface circuit is to filter the high frequency acquisition system and Analysis Package. The
components of the signal and a second function is to acquisition system software was developed in C++
galvanically isolate the electrical circuit from the with MS Visual Studio.
robot electronics.
The Analysis Package, running off-line, reads the
The robot system and the external axis servomotor data recorded by the acquisition system and
have position sensing by means of optical examines it. The Analysis Package allows several
incremental encoders. Those position signals are also signal processing algorithms such as, Fourier
captured by the data acquisition system presented transform, correlation, time synchronization, etc.
here. In order to isolate the robot feedback circuit With this software platform both the Hyperkernel
from the PC card, for each encoder it is inserted a and the Analysis Package tasks can be executed on
buffer (in the interface box) before connecting the the same PC.
signals to the corresponding high speed counter (in
Card 3). This PC card is a high-speed counter/timer,
PCI-6602 model from National Instruments and was 4. EXPERIMENTAL RESULTS
programmed to read the signals from the encoders.
In the experiment a steel rod flexible link is used. To
The transmitting and receiving of data between the test impacts, the link consists of a long, thin, round,
computer and robot is carried out through a serial flexible steel rod clamped to the end-effector of the
port RS 232C. manipulator. The robot motion is programmed in a
way that the rod moves against a rigid surface. Fig. 3
depicts the robot with the flexible link and the impact
3.2 The Software Components surface. The physical properties of the flexible beam
are shown in Table 1.
The Software runs in a Pentium 4, 3.0 GHz PC. The
software architecture is shown in Fig. 2.
User
PC platform
Windows NT/2000
Task 1
Task
Management
Fig. 3. Steel rod impact against a rigid surface
External
Characteristic Steel Rod
Robot Sensors Axis motor Density [kg m3] 7.86 103
Elasticity Modulus [N m2] 200 109
Fig. 2. Block diagram of software architecture. Mass [kg] 0.107
Length [m] 0.475
The software package developed, from the users Thickness/diameter [m] 5.75 103
point of view, consists of two applications. One, the
acquisition application, is a program made up of two During the motion of the manipulator the clamped
parts: The Graphical User Interface module and the rod is moved by the robot against a rigid surface. An
real time module. The other application is an impact occurs and several signals are recorded with a
Analysis Package program that analyses the data sampling frequency of fs = 500 Hz. The signals come
obtained and recorded by the acquisition application. from different sensors, such as accelerometers, force
The real time software, running in the Hyperkernel, and torque sensor, position encoders and current
sensors. The time evolution of the variables is shown the rod clamped-end (accelerometer 2). The
in the figures 48 corresponding to: (i) the impact of amplitudes of the accelerometers signals are higher
the rod on a rigid surface and (ii) without impact. near the rod impact side. The two signals are super
imposed in Fig. 8. The first acceleration peak
(accelerometer 1), due to the impact, corresponds to
2
the rigid surface (i) while the second peak
Motor 1 (A)
-2 20
0 1 2 3 4 5 6 7 8
Fx (N)
2 0
Motor 2 (A)
0 -20
-2 0 1 2 3 4 5 6 7 8
0 1 2 3 4 5 6 7 8 20
Fy (N)
Motor 3 (A)
0
0
-20
-2
0 1 2 3 4 5 6 7 8
0 1 2 3 4 5 6 7 8
20
2
Motor 4 (A)
Fz (N)
0 0
(i) w ith impact
-2 -20 (ii) w ithout impact
(i) w ith impa ct
0 1 2 3 4 5 6 7 8 0 1 2 3 4 5 6 7 8
(ii) w ithout impa ct
2 t (s)
Motor 5 (A)
5
Fig. 4. Electrical currents of robot axis motors
Mx (N.m )
-5
4
x 10 0 1 2 3 4 5 6 7 8
1
Axis 1 (pulses)
5
My (N.m)
0
0
-1 -5
0 4 1 2 3 4 5 6 7 8 0 1 2 3 4 5 6 7 8
x 10
1
Axis 2 (pulses)
-1 -5
0 4 1 2 3 4 5 6 7 8 0 1 2 3 4 5 6 7 8
x 10
1 t (s)
Axis 3 (pulses)
0
Fig. 7. Moments at the gripper sensor
-1
0 4 1 2 3 4 5 6 7 8 100
x 10
Accelerometer 1 (m/s2 )
1
Axis 4 (pulses)
50
0 0
-1 -50
0 4 1 2 3 4 5 6 7 8
x 10
1 -100
Axis 5 (pulses)
0 1 2 3 4 5 6 7 8
0 100
Accelerometer 2 (m/s2 )
-50
F(f(t ))
1
5 10
F(f(t ))
10
slope = -0.99
0
fs = 500 Hz 10
slope = -1.58
fc = 100 Hz
4
fs = 500 Hz
10 -1 fc = 100 Hz
10
-2
10
0 1 2
3 10 10 10
10 Frequency (Hz)
0 1 2
10 10 10
Frequency (Hz) 4
10
(i) without impact
2
4 10
10
F(f(t ))
0
2 10
10 slope = -1.64
fs = 500 Hz
F(f(t ))
1 10
-1 fc = 100 Hz
10
-2
0 10
10 0 1 2
slope = -1.52 10 10 10
fs = 500 Hz Frequency (Hz)
10
-1 fc = 100 Hz
1 2
10 10
F(f(t ))
0
10 1
slope = -1.51 10
fs = 500 Hz fs = 500 Hz
-1 fc = 100 Hz 0
fc = 100 Hz
10 10
-2 -1
10 10
0 1 2
10 10 10
Frequency (Hz)
-2
10
0 1 2
10 10 10
Fig. 10. Spectrum of the axis 3 motor current Frequency (Hz)
Figure 11 depicts the amplitude of the FFT of the Fig. 12. Fz force spectrum with impact
electrical current for the axis 4 motor. Here the trend
lines present slopes that vary slightly (slope = -1.58 This spectrum is not so well defined in a large
with impact and slope = -1.64 without impact) but, in frequency range. From this point of view all
both cases, continues to reveal a fractional order force/moments spectra present identical behaviour.
behaviour. Therefore, it is difficult to define accurately the
behaviour of signals in terms of integer or fractional on Micro/Macro Manipulator Vibration Control.
system. Proc. IEEE Int. Conf. on Robotics and
Finally, Fig. 13 depicts the spectrum of the signal Automation. Minneapolis, Minnesota, April.
captured from the accelerometer 1 located at the rod Lew, J.Y., Trudnowski, D. J., Evans, M. S., and
free-end of the beam. Bennett, D. W. (1995). Micro-Manipulator
Motion Control to Suppress Macro-Manipulator
4
10
Structural Vibrations. Proc. IEEE Int. Conf. on
(ii) without impact Robotics and Automation, Vol. 3, pp. 3116-
3120.
3
10 Lima, Miguel F. M., J.A. Tenreiro Machado, Manuel
Crisstomo (2005). Experimental Set-Up for
Vibration and Impact Analysis in Robotics,
F(f(t ))
2
10
WSEAS Trans. on Systems, Issue 5, vol. 4, May,
1
pp. 569-576.
10
Machado, J. A. Tenreiro (1997). Analysis and Design
fs = 500 Hz
fc = 100 Hz of Fractional-Order Digital Control Systems,
0
10 Journal Systems Analysis-Modelling-Simulation,
Gordon & Breach Science Publishers, vol. 27,
0
10 10
1
10
2
pp. 107-122, 1997.
Frequency (Hz)
Machado, J. A. Tenreiro (2003). A Probabilistic
Interpretation of the Fractional-Order
Fig. 13. Acceleration spectrum of the rod free-end
Differentiation, Journal of Fractional Calculus
without impact
& Applied Analysis, vol. 6, No 1, pp. 73-80.
Magee, David P. and Wayne J. Book (1995).
Like the spectrum from the other accelerometer, this
Filtering Micro-Manipulator Wrist Commands to
spectrum is spread and complicated. Therefore is
Prevent Flexible Base Motion. Proc. American
difficult to define accurately the slope of the signal
Control Conf., Seatle, Washington, June
and consequently its behaviour in terms of integer or
Oustaloup, Alain, Xavier Moreau and Michel
fractional system.
Nouillant (1997). From fractal robustness to non
integer approach in vibration insulation : the
CRONE suspension, Proceedings of the 36th
5. CONCLUSIONS
Conference on Decision & Control, San Diego,
California, USA, December.
In this paper an experimental study was conducted to
Podlubny, I. (2002). Geometrical and physical
investigate several robot signals, in a fractional
interpretation of fractional integration and
system perspective. This study provides useful
fractional differentiation. Journal of Fractional
information that can assist in the design of a control
Calculus & Applied Analysis, vol. 5, No 4, pp.
system to be used in eliminating or reducing the
357-366.
effect of vibrations.
Singer, N. C. and W. P. Seering (1988). Using
Acausal Shaping Techniques to Reduce Robot
The next stage of development of the software and
Vibration. Proc. IEEE Int. Conf. on Robotics
hardware apparatus is to reduce the vibrations and its
and Automation. Philadelphia PA., April 25-29
effect upon the robot structure. In this line of
Yoshikawa, T., K. Hosoda, T. Doi and H. Murakami
thought, is under development a micromanipulator,
(1993). Quasi-static Trajectory Tracking
with a higher frequency response than the main
Control of Flexible Manipulator by Macro-micro
manipulator, mounted at the end-effector and
Manipulator System, Proc. IEEE Int. Conf. on
actively counter-acting the undesirable dynamics.
Robotics and Automation, pp. 210-215
REFERENCES