Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
A rigid (micro) robot mounted serially to the tip of a long, flexible (macro)
manipulator is often used to increase reach capability, but flexibility in the ma-
cromanipulator can make it susceptible to vibration. A rigid manipulator attached to
a flexible but unactuated base was used to study a scheme to achieve positioning of the
micromanipulator combined with enhanced vibration damping of the base. . The
interaction forces and torques acting between the robot and its flexible base were
modeled and studied. Simulated and measured interactions generated at the base of a
three degree of freedom rigid robot are compared. Simulated and experimental results
are included that demonstrate with the proper control of these interactions, damping
can be added to the base.
eigenvalues or singular values. This measure not only driven by the joint space configuration of the robot.
provides a measure of how these effects vary through- The nonlinear rigid robot effects (Nf , Nro) may
out the workspace, but also shows regions where full become significant in certain workspace regions.
multi-DOF inertial damping capability is not possibje. However, with the proper choice of vibration control
The goal here is to use this performance measure to feedback gains, the amplitude of the commanded joint
choose robot joint space configurations where the motion can be limited to ensure the inertia effects
inertia effects are large, whenever possible. Alter- remain dominant. Under these conditions, the non-
nately the combined ability of the robot to generate linear and gravitational effects can be linearized
interaction forces and torques may be evaluated by about an operating point. Thus, the most important
assessing: dynamics take the form:
IBT( O)B( 0)1 Mf+Af(O) Bllf(O) BAO)][Xf]
where: Aro(O) J + Bllro(O) Bro(O) Of
[
B(O)=[BAO)] BJ( 0) B:{o( 0) Br( 0) 0
( 4)
100
100
These points were further investigated by left, the robot is essentially unable, to damp vibration
simulating the interactions due to harmonic motion of in the out-of-page direction. Since the CG of the
a three link anthropomorphic robot. As can be seen in robot is along the axis of rotation of joint one, its
Fig. 5, in a workspace region (labeled 3 in Fig. 4) motion will not create inertial forces. This corre-
where the inertia effects are predicted to be large, sponds to a case 2 inertial singularity shown in Fig. 3.
[0·, 70·, 70·J, the ratio of the inertia to nonlinear The configuration on the right shows the robot in a
forces is large (inertia and total force traces are much better configuration corresponding with the
nearly overlaid). However, this ratio becomes poorer peak at the front of the plot.
when the centrifugal forces become larger at [0·, 70·, 2 ) In general, the inertia effects are dominant but
-10·J (labeled 4). In this case, the inertia forces act there are configurations where the nonlinear effects
primarily in the x direction (as defined in Fig. 2) , can become large. The inertia effects are functions of
while the centrifugal forces are all aligned primarily the joint accelerations while the nonlinear effects are
in the y direction. The ratios in the x and z directions functions of the joint velocities. The amplitude of
are large and not shown here. joint motion directly influences the ratio of joint
Some general conclusions can be made about the accelerations to velocities. The relationship between
interaction effects, which will be used to develop the the joint amplitudes and feedback gains will be dis-
, vibration controller discussed later: cussed later and gain limits established to ensure this
1 ) The nonlinear and inertIa effects are driven by ratio remains favorable for inertial damping_
two factors: the configuration of the robot and its
4. Force/Torque Verification Testing
joint accelerations and velocities. The inertia perfor-
mance measure of Eqs. ( 3) and (4) can be used to The ability of the method presented in section 2 to
choose inverse kinematic solution (s) best suited for predict the interaction forces and torques and simula-
inertial damping. As an example, consider the anthro- tion results discussed in the previous section were
pomorphic robot in Fig. 6. This figure represents a verified experimentally. The, testbed consists of a
macromanipulator (first two links) with the three link three degree of freedom anthropomorphic robot
rigid anthropomorphic robot mounted serially to its mounted to the base of a flexible link, as shown in Fig.
tip. The rigid robot in the configuration on the right 7. A six-axis ATJ force/torque sensor was mounted
is much better at inertial damping than it is in the between the robot and its flexible base and it was
configuration on the left. In the configuration on the bracecj to isolate the effects due to only the rigid
robot. Sinusoidal inputs were sent to each joint indi-
Inertia and Nonlinear Forces from [0·,70·,70"]
-Inertia
vidually as well as simultaneously and the interaction
_. Coriolls
~ •• -
Centrifugal
forces and torques recorded. Test results verified
• Tolal
inertia effects dominate the interactions when the
robot is in a configuration with large predicted iner-
macro
manipulator'"""':::::::=-It---_ _ _ ...Jl
jointl - . .
micro
manipulator-~=====4ji~-----·
.
30
20
JI .I .I .I
.j ~ ,~ ,~
~ ft f~
~ ~
10
-10
)1[\ "" .-
i~
1
,
", --
"'" i.
...
3
, ~
~ :,
....
~
.-5
j
~
, .. ~-
7
#<
~ :, "" -
L.
9 io.fl
~
II! :'I
-20
~ Sf V
~ I I
-30
Time (s)
35001.
I
,
1500~·
J.
I
o 1 2 3 4 5 6 7 a 9 10
Frequency (Hz)
Frequency (Hz)
Fig. 9 Frequency content of force data Fig. 10 Frequency content of force data due to joints 1
. and 2 actuating near an inertial singularity
tii:l/nonlinear effect ratios. One representative exam-
ple is shown in Fig. 8. In this test, all three joints are to ensure vibration energy is removed from the sys-
actuating harmonically at 1, 1.5, and 2 Hz, respective· tem. This includes establishing gain limits that con·
ly. The frequency content of this data can be seen in strain the rigid robot joint amplitudes so the interac·
Fig. 9. The fundamental frequencies are largest whIle tions (inertia effects) due to joint accelerations are
some higher harmonics are also noticeable at 2.5 and greater than those due to joint velocities (nonlinear
3 Hz. effects) . The overall control schematic is shown in
However, in other workspace regions nonlinear Fig.n.
effects become much more notable, as can be seen in First, a performance index· was developed to
Fig. 10. In this case, two joints of the robot are predict the effectiveness of the inertial damping can·
actuating at 1 and 1.5 Hz near an inertial singularity' trol scheme. The variation in inertia performance,
region. The coriolis force at 2.5 Hz (combination of discussed in section 3, only varies with the joint
fundamental frequencies) is clearly a problem. More configuration of the robot. Hence, it may be used to
examples may be found iIi Ref. ( 9 ). One important choose the best inverse kinematic solution (s) for
note is that the amplitude of motion (controllable by inertial damping. The discussion included here only
the feedback gains) has not yet been considered. addresses the rigid robot inertia effects. However, the
performance index, discussed in more detail in Ref.
5. Vibration Controller
( 9 ), includes other effects such as the mao
The goal of this section is to describe the vibra- cromanipulator and micromanipulator inertias and
tion controller and establish a range of feedback gains limits on allowable joint accelerations.
Inverse
Kinematics!
PID
Xd Damping
Position en Coupled F/'tIF Xc
Performance Rigid Rigid/Flex Flexible
Index Check Control Robot Dynamics Manipulator
The flexible manipulator is modeled by Eq. ( 1 ) , necessary to pass through the singularity regions and
the coupled rigid/flex dynamics by Eqs. (2.a) and limit the controller output during these transitions.
(2.b), and the rigid robot model by Eq. (2.c). Assum- It is assumed the PID position controller is
ing the robot is not operating about a singularity designed separately for rigid robot control. The
point, the vibration controller prescribes the joint control scheme takes advantage of the fact that the
accelerations out of phase with the base velocity as base vibration is of relatively high frequency compar-
follows: . ed to the rigid robot motion required to perform a
8=-ID(8,8)Kxf (6) task. The separation of bandwidths, or time con-
ID is an inverse dynamics function designed to cancel stants, between the position and vibration control
the significant rigid robot dynamics. It is found by loops allows them tobe considered separately. This is
solving Eq. (2.c) for 8 and substituting the resulting not addressed further here, but more details can be
expression in Eqs. (2.a) and (2.b). The resulting found in Ref.(lO). When this is the case, increasing
expression is lengthy, but with the limits on gains vibration feedback gains, K, results in a direct
discussed later, the inertia effects are most significant increase in macromanipulator damping. However, it
and the interactions may be approximated by : is important to check the validity of this assumption
FIF ~BA8)B~1(8)T: for the specific application.
TJF~Bro(8)B~1(8)r (7) Assuming harmonic base vibration of mode i, the
The inverse dynamics function then inverts these base motion and prescribed joint accelerations and
functions so the applied torque may be commanded to velocities will be harmonic and take the form:
provide the desired interaction forces and torques. K xi=Xisin wd
is a diagonal matrix of gains K, where Ki is the gain 8j = - B- 1( O)KiXiWi cos wd
for the ith vibrational degree of freedom. Thus, the 8j = - B- 1( iJ)KXi sin wd (10)
prescribed joint accelerations will be: It is assumed the inertia matrix, B( 8), can be linear-
8=-B-1(8)Kxf (8) ized and is approximately constant about an operating
1
B- (8) will exist whenever B(8) is non-singular. ,point. The feedback gains will be selected to ensure
When the matrix is singular, the robot loses its ,ability this is a reasonable assumption. The maximum ampli-
to create effective interactions in one or more degrees tude of joint motion, A, will occur during the first few
of freedom. cycles of vibration damping and for each joint can be
However, the joint torques will need to be com- written as:
manded so the final vibration controller takes the KB(O)-lX
[Bj [ A (11) .
form: Wi
r= --- Br( 8)B- 1( 8)Kxf (9) It is clear that an upper limit on the feedback
Br( e) and B( e) were defined in Eqs. ( 2) and (4). gains is necessary. One reason is that there will be
N ow the desired interactions can be controlled out of physical limits on the range of motion of the robot.
phase with the base velocity, providing damping to the Another reason could be that actuators may have
flexible base. It is assumed the rigid joint positions, 8, saturation limits, so some realistic limits on gains will
are measured and available for use in the control have to be established to avoid actuator saturation.
scheme. There should be a minimum value estab- Yet another consideration is the ratio of the inertia
lished for the determinant of the inertia matrix to forces (functions of the joint accelerations), to the
prevent it from being inverted when the robot is nonlinear forces (functions of the joint velocities).
passing through a singularity configuration. Although The centrifugal effects become functions of the square
these regions will be avoided for point-to-point of the joint velocities. Solving Eq. (11) for K and
motion and fixed configuration operations, it may be substituting into 10 yields:
Ie~1 = Aw/ =l (12) freedom of vibration. This yielded the mass and
18/1 A w/ A2
stiffness properties; structural damping estimates
Likewise, the ratio of inertia to coriolis effects takes were determined from modal testing. The resulting
the form: equations of motion take the form of Eq. ( 1) with'
JR-~ (13) constant matrices. The rigid robot was modeled using
I8i8 l -
j Ajwj the Newton-Euler method described previously. The
Notice by relating the feedback gains to the rigid robot and flex/rigid robot dynamic models
amplitude of joint motion, the ratios become inversely include both inertia and nonlinear rigid robot terms
proportional to the amplitude of motion. Thus, A can (Nf, NtO, and Nt) in order to ensure assumptions
be limited to ensure the joint acceleration effects made regarding the dominance of the inertia effects
remain larger than the joint velocity effects. One are valid. The fundamental modes of the x and y
upper limit is A < 1 radian, although there may be directions were chosen at 1.4 Hz (x) and 1.8 Hz (y),
more restrictive limits due to other considerations. approximately those observed on the experimental
The gains should be limited such that: testbed, while the higher modes and torsional modes
K;< wimlnE( 8)m,n A (14) were estimated from beam theory.
Xi max Simulations were developed to verify that, with
The true multi degree-of-freedom case is more com- the proper selection of feedback control gains, the
plex, of course. The selection of A and E m1n will be controller could successfully damp all modes of base
specific to the macro/micromanipulator. tIowever, vibration due to an applied disturbance or robot
the above limit will help reduce the significance of the motion. The simulation results included here focus on
nonlinear effects, even when in workspace locations the use of the performance index to predict damping
where they can become large. Also note this ratio performance. Point-to-point rigid robot motion was
I improves with decreasing amplitude, which increases commanded to simulate the end effector moving to
the effectiveness of the scheme as the vibration is four corners of a square. The performance index was
damped. A rule of thumb that appears to work well used to choose the best inverse kinematics track for
for the anthropomorphic robot considered in simula- inertial damping. The two trajectories are shown in
tion and experiments is A = Em1n = 1. If this is too Table 1.
restrictive, a more exact determination of acceptable The resulting joint motion and base vibrationcan
E m1n and maximum amplitudes may be necessary.
be seen in Figs. 12 and 13. The comparisons are with
Nevertheless, the nonlinear forces will still be vibration control using the inverse kinematics path
commanded along with the damping forces. The preferable for inertial damping (Traj. 2) and using the
lower limit on the control gains was established by alternate path (Traj. 1) with and without vibration
considering a worst-case scenario where the nonlinear
control. Note the other two inverse dynamics solu-
effects directly excite a mode of the flexible system. tions yield identical results since for the anthropomor- .
The goal here is to ensure net energy removal from phic robot the damping performance only varies with
the system. This is not discussed further here, but the configuration of joints 2 and 3. The obvious trade-
details may be found in Ref. ( 9 ). Limiting the gains off is that the joint position is affected when under
to the range: inertial damping control, as can be seen in Fig. 12.
O<Ki < Wi, m,nE(§)m,nA (15) This is especially pronounced at the beginning and end
Xi, max
of each leg, which is expected since the joint accelera-
will ensure effects due to joint accelerations are
tions are largest when the robot starts and stops. The
greater than those due to joint velocities. It will also
motion, however, is used to quickly damp the vibra-
ensure there is enough damping available for higher
tion. The other tradeoff is the increased amplitude of
modes of vibration (if a concern) to remove vibration
energy if they are excited.
Table 1 Simulated trajectory parameters
6. Simulations
End 4 -.2 -.2 .4 .4
Simulations were created in Matlab Simulink for Point (m) .4 .4 -.2 -.2 .4
a three degree of freedom anthropomorphic robot .4 .4 .4 .4 .4
Traj 1 8 1 (rad) .785 2.04 -2.36 -.471 .785
mounted on a flexible base. The configuration is 82 (rad) 1.48 1.57 1.54 1.57 1.48
similar to the Georgia Tech testbed shown in Fig. 7 83 (rad) 1.05 1.45 1.82 1.45 1.05
(without the braces). Two modes of transverse Traj 2 8 1 (rad) .785 2.04 -2.36 -.471 .785
vibration were assumed in each planar direction and 82 (rad) .436 .122 -.297 .122 .436
83 (rad) -1.05 -1.45 -1.83 -1.45 -1.05
one torsional mode to allow up to five degrees of Time (s) 0-1 5-21 25-41 45-61 65-80
2.5,------,---.,------,--.,-----,---.,-----,---
Commanded JoInl Mo~on
Table 2 Active damping controller disturbance rejection
~ Thela 2 TraJ. 1 Disturbance Applied Mode (Hz) Detected Primarily in Direction % Improvement
x 1 x .0239 28.5
x 1.2 .. v.z .0392 485.1
x 2 x,v,z .0231 -----
Thela 3 TraJ. 2 x 4.2 X,z .0164 88.5
v 1 X,z .0499 168.3
y 1.2 V,z .0332 395.5
v 4.2 X,z .0111 27.6
v 7 v.z .0132 157.3
v 9 v.z .0081 188.3
0 -..........- · - - - - z I x .0311 67.2
Theis 2 TraJ.2
z 1.2 v.z .0419 525.3
-0.5 z 4 X,z .0163 87.4
z 7 v,z .0166 224.6
-1
z 9 V:Z .0082 191.8
ela3TraJ.1 General I x .0256 37.6
General 1.2 v,z .0359 435.8
-1.5 4.2 X,z .0120 37.9
General
General 7 v,z .0197 284.0
-2 General 9 v,z .0086 206.0
_2.5L--,',---::'--=::::;=:=:::;::~----'':----:':------'-----.J
o w ~ M • ® M ro M
Tlme(s)
However, once past this limit, the damping improve-
Fig_ 12 Simulated point-to-point joint motion ment is less drastic and the natural frequency of the
coupled system is affected, as seen in the top figure of
Base Vibration x the simulation, When the simulation was reaccom-
0.20!.! !~'..,: ,.{.,.; \ ~,
~
. . ....:'-......:: ..:::.::..:]\,.,. ..,·.f,..,,· .:,.f\,.·,f\.-.:,
.. :~i~::;.i:.~·~~n~OI
.. ~;~i: ;... .. . . ,. . . . . . ·.~·:::"·.·.:·. ·.·:1~.
!'\..··~··V··~" ....·..·..·............ ··..!\.·...../\·
,,!
plished using lower gains, the damping increased
slightly. This indicates a need for a certain amount of
-o.2i~. . . . . . . . . .:..................... JiU ..........:...................:....................:.....................
I.... 1....................: .................... J tuning of the feedback gains once an estimate is
o 10 ~ 30 40 ~ ~ ro 00
determined in order to ensure the maximum damping
is being achieved, This is a current area of research
at Ga Tech,
" ................... 1' ... _ ...............: ........................................ '('.............................................................. ...............•..·1
~
I h
-0.21:...................:.....................:..................:.....................:....................:...................:.................... l. ................ j
i
macromanipulator, allowing multiple degrees of free-
o 10 ~ M ~ ~ ~ ro 00 dom of base flexibility. A disturbance was applied to
Time(s) the macromanipulator in each direction (x, y, and z)
Fig. 13 Simulated base vibration due to rigid as well as a general disturbance. The dominant
robot motion (lowest frequency) free vibration modes of the ma-
cromanipulator are at 1,1.2, 4.2, 7, and 9.5 Hz with
vibration induced by moving into the better joint damping ratios of, 0.0186, 0.006 7, 0.008 7, 0.005 13, and
configurations. Compare the amplitude of the base 0_00281, respectively. Table 2 summarizes the,result-
vibration in the top and third plots in Fig_ 13. The ing modes of vibration and damping ratios with vibra-
amplitude in the top figure is larger because the tion control.
Gonfiguration allows more coupling between the robot The damping of the macromanipulator improved
and its base, thus the motion of the robot creates with the vibration controller in place, although many
J
larger disturbances in the base. However, these implementation issues arose that limited the
configurations also allows more effective coupling to effectiveness of the scheme on the testbed. This is an
damp the vibration more quickly, while the alternate on-going area of research at Georgia Tech.
track is much less effective.
8. Conclusions
Another interesting phenomenon that occurs in
non-linear multi-degree of freedom damping simula- This paper presented research in developing a
tions is that there is a limit on the maximum damping control scheme to provide position control and en-
available. An upper limit on gains was established by hanced vibration damping of a macro/micro-
Eq. (15) simulations and experiments verified that this manipulator. The configuration of a rigid manipula-
limit should be carefully adhered to. However, the tor attached to a flexible base was introduced as a
exact determination of the specific parameters is similar configuration. The system model was de-
challenging. When operating in the range, an increase scribed along with the interaction forces and torques,
in feedback gain K results in an increase in damping. which vary throughout the workspace. This variation
in performance may be used to choose joint configura- terns, Proc. IEEE International Conf. on Robotics
tions better suited for inertial damping. In addition, and Automation, Vol. 1 (1993), pp. 812-817.
guidelines on choosing vibration controller feedback ( 3) Senda, K., Dynamics and Control of Rigid/Flex-
gains were established. Simulation and experimental ible Space Manipulators, Ph.D. Thesis, University
of Osaka Prefecture, Sakai, Osaka, (1993).
results were presented demonstrating the effective-
(4) Singhose, W., Singer, N. and Seering, W., Compar-
ness of the control scheme in damping vibration. ison of Command Shaping Methods for Reducing
More detail on all of this work may be found in Ref. Residual Vibration, Proc. 3rd European Control
e9 ). Conf., Vol. 2 (1995), pp.1l26-1131.
(5) Lew,]. and Moon, S.-M., A Simple Active Damp-
Acknowledgements
ing Control for Compliant Base Manipulators,
Partial funding for this work was provided by the IEEE/AS ME Transactions on Mechatronics, Vol.
Air Force Institute of Technology U.S. Air Force 2 (2001), pp. 707-714.
(6) Sharf, I., Active Damping of a Large Flexible
Academy Faculty Preparation Program and the
Manipulator with a Short-Reach Robot, Proceed-
,HUSCO/Ramirez Endowed Chair for Fluid Power ings of the 1995 American Control Conference,
and Motion Control. Seattle, WA, Vol. 5, June 21-23, (1995), pp. 3329-
3333.
Disclaimer
(7) Book, W., Recursive Lagrangian Dynami~s of
The views expressed in this article are those of Flexible Manipulator Arms, The International
the authors and do not reflect the official policy or Journal of Robotics Research, Vol. 3, No.3
(1993), pp. 87-100.
position of the United States Air Force, Department
(8) Sciavicco, 1. and Siciliano, B., Modeling and
of Defense, or U.S. Government.
Control of Robot Manipulators, (2000), pp. 151-
References 162, McGraw-Hill, New York.
(9) George, 1., Active Vibration Control of a Flexible
( 1 ), Book, W. and Loper, J., Inverse Dynamics for Base Manipulator, Ph.D. Thesis, Georgia Institute
Commanding Micromanipulator Inertial Forces of Technology, Atlanta, GA, (2002).
to Damp Macromanipulator Vibration, Proc. (10) Book, W. and Lee, S.H., Vibration Control of a
IEEE Robot Society of Japan International Conf. Large Flexible Manipulator by a Small Robotic
on Intelligent Robots and Systems, Vol. 2 (1999), Arm, Proc. of the American Control Conf., Vol. 12
pp. 707-714. (1989), pp. 1377-1380.
( 2 ) Torres, M. and Dubowsky, S., Path Planning for
Elastically Constrained Space Manipulator Sys-