You are on page 1of 7

Preprints 01 the Fourth IFAC

Symposium on Robot Control


September 19-21, 1994, Capri, Italy

ANALYSIS AND SOLUTION OF THE TRAJECTORY


PLANNING PROBLEM FOR RECONFIGURABLE TWO-
ARM ROBOTS

V. TAUSSAC·, E. TABARAH·; E. DOMBRE· and B. BENHABIB··

·Laboratoire d'Informatique de Robotique et de Microelectronique de Montpel/ier, UM II - CNRS


9228, 161 rue Ada, 34392 Montpellier Ceder 5, France
··Computer Integrated Manufacturing Laboratory, Department of Mechanical Engineering, Univer-
$ity of Toronto , 5 King '$ Col/ege Road, Toronto, Ontario, Canada, M5S 1A4

Abstract. Two-arm systems configured with modular robots are used to perform tasks in coordi-
nated manner. The synthesis problem, in this context, would address issues such as , distribution of
degrees of freedom (dof) between the two-arms , determination of geometries , and relative placement
of their bases. This paper addresses the first task in the process of solving the synthesis problem,
namely the development of an "analysis" module used to evaluate and compare different robot confi-
gurations for a desired operation. An optim.ization procedure, based on a trajectory-approximation,
is presented herein for determining best continuous path end-effector trajectories for planar systems.

Key Words. Modular robots; two-arm robots ; optimal coordination; workspace ; trajectory reso-
lution

1. INTRODUCTION the two robots are coordinated to move so as the


tool performs its required motion relative to the
Reconfigurable modular robots are defined as sys- workpiece , Fig. 1. The advantages of maneu-
tems that consist of standard modular devices , vering the workpiece , while it is being operated
such as actuators, links , and connectors , utilized on, include the fact that the trajectory can be
to configure "special- purpose" robotic arms (Co- made more accessible to the tool , thus facilitating
hen et al. , 1992). The industrial application of the task and reducing the required workspace , as
such systems would relieve the heavy financial well as allowing certain complex operations, that
burden of acquiring sophisticated and general- would otherwise be infeasible for a fixed work-
purpose robots. Modular robots, by definition , piece, to be performed in a single run . It has
offer the possibility of easily and inexpensively re- been shown , for instance, that coordinated two-
configuring the workcell to suit new tasks. There robot systems can perform certain manufacturing
exists an abundance of literature on the subject of operations faster , requiring less power , than us-
modular robots , which has started over a decade ing a single robot . These operations include con-
ago, with an aim at industrial as well as space tact operations, such as deburring, which require
applications. Reference (Tesar and Butler, 1989) that the tool maintains contact with the work-
provides an excellent review of the pertinent lit- piece as it moves , or non-contact operations , such
erature . as arc-welding, which require no contact between
the tool and the workpiece.
There also exists a wealth of literature dealing
with cooperative two-robot systems. The empha- The objective of our work is to demonstrate that
sis has usually been on the use of existing robots modular robots can be utilized effectively in for-
in order to form closed-chain systems (Zheng and ming two-arm systems, where each arm may have
Luh, 1988 ; Craigan and Akin , 1989) . Such sys- a number of degrees of freedom (dof) between one
tems have been shown to offer a significantly im- and six (Tabarah et al., 1993). The selection of
proved load-carrying capability and force /torque the type and exact number of dof for the system,
output , as well as an improved rigidity (Tarn et for a given task , the selection of the number of dof
al .. 1988). However , a novel method has recently between the two arms (the dof-distribution prob-
been proposed (Tabarah et al., 1992 ; Jouaneh et lem), as well as the relative placement of their
aI. , 1990) which advocates the coordination of two bases is a synthesis problem. We have developped
robots where, instead of the two robots forming an "analysis" module to be used for the evalua-
a closed-chain system and operating on a fixed tion and comparison of different solutions to this
workpiece, the workpiece is gripped by one robot problem. It implements an optimization proce-
while the tool is mounted on the second robot:

925
dure for determining best continuous path end- 3. TRAJECTORY RESOLUTION
effector trajectories.
Trajectory resolution can be classified as either
"exact" or "approximate".
Exact trajectory resolution requires full mobility
for both arms. Once a trajectory has been arbi-
trarily guessed for arm-1 it could be sampled into
K points, where K is very large, as dictated by
the robot controller, and defined as functions of
time. In turn, the tool-trajectory on the object is
also sampled into K points. Since both arms have
full mobility, once a point on arm- 1's trajectory is
specified, arm-2 can meet this point by bringing
the corresponding specific point on the object to
Fig. 1. General configuration of a two-robot coordi- arm- 1's trajectory. It is important to note how-
nated system ever that, if arm-2 does not have full mobility , the
above "rendez- vous" procedure would only work
partially. Namely, once a point is chosen on arm-
2. PROBLEM STATEMENT l's trajectory we would have to solve a pseudo-
synthesis problem in order to determine the cor-
This paper addresses the coordination pro-
responding contact point on the object. Thus, it
blem between two robots performing a common
could not be arbitrarily (and optimally) chosen
manufacturing-type task, such as welding or de-
as in the case of arm- 2 having full mobility. In
burring , on a workpiece . In order to clarify the
both cases, the collection of "rendez- vous" points
trajectory resolution issue, let us consider a two-
forms the conjugate trajectory for arm- 2.
arm planar system. Arm-1 manipulates a tool
Approximate trajectory resolution does not re-
that tracks a desired tool- trajectory prescribed
quire full mobility. It is based on the assump-
relative to a workpiece held and maneuvered by
tion that even when K is very large the obtained
arm-2, Fig. 1. If the two- arm system is a non-
conjugate trajectories are never exact. This as-
redundant one, this trajectory is resolved into a
sumption is further strengthened by the following
simple pair of new trajectories for the two robots.
fact: when we do not have full mobility, even if we
These new trajectories, termed here as conjugate
satisfy the K positional constraints , due to their
trajectories, are specified in task space for the two
unknown placement on the object , we would still
robots' end effectors. In the case where the system
have large deviations from desired relative veloci-
has redundant dof, there exists an infinite number ties between the tool and the object.
of pairs of conjugate trajectories for a given tool
trajectory. Thus , the problem at hand can be de- Based on this assumption, a trajectory appro-
fined as the optimal determination of conjugate ximation procedure, defined in the literature in
trajectories for two-arm systems with redundant other contexts , will be proposed here for two-arm
dof. robotic systems. The procedure , in its conceptual
form, is as follows:
In this paper , we are encouraging the use of recon-
figurable modular robots where the two arms may (a) Approximate the tool-trajectory, defined on
be configured to have less than six dof each. The the object, by K points.
number of redundant dof, depending on the task , (b) Based on a desired relative velocity that the
may thus vary between zero and six for a gen- tool has to follow , describe the K locations
eral three-dimensional task. Our analysis shows on the tool- trajectory as a function of time ,
that the trajectory-resolution problem must then [.c(t)) i i = 1, I<.
be addressed individually for each of the differ- (c) Solve the inverse kinematics of both arms in-
ent numbers of dof- redundancy cases. The dif- dividually at [.c)i , where the tool is in con-
ferent solutions would be based on a generalized tact with the object. It must be noted that
workspace-analysis procedure , where the search in order to solve the inverse kinematics , the
space for the optimal trajectories (i.e., the sys- locations [.c)i have to be defined in a "world"
tem 's operational workspace) is governed by the reference-frame coordinates Fw:
geometry of the two arms as well as the designated (i) If the two arms , forming a closed-chain
task. loop at [.c(t))i , have no redundant dof,
then [.c(t))i is uniquely defined with re-
The next two sections will discuss this trajectory spect to Fw. The inverse kinematics yield
resolution problem and introduce an optimization unique arm configurations (O l )i for arm- 1
procedure for selecting one solution based on cer- and (02)i for arm-2.
tain optimality criteria. (ii) If the two arms have some redundant dof,

926
then [C(t)]i can be located anywhere in arm system, the contact point under consideration
the workspace subject to some constraints. thus can be placed anywhere on an arc, referred
Thus, one concludes that there exists infi- to here as the "iso-pos" curve ("pos" standing for
nite arm configurations corresponding to a position). Generalizing this case, one notes that
single relative [C(t)k In other words, the every contact point chosen would have a corres-
problem at hand is the absolute placement ponding iso-pos curve. The combination of these
of [C(t)]i with respect to Fw . It is very im- iso-pos curves forms the search space for the opti-
portant to remember that solving this opti- mization problem, Fig. 2. The proposed solution
mization for the [C(t)]i individually would
only yield a local optimal. In order to ob-
tain a global optimal, all [C(t)]i have to
be optimally determined in a simultaneous
matter.
(d) Fit cubic splines to arm configurations, de-
fined by the optimal (Ol)i and (02)i, i = 1, 1<.
As was shown in (Tabarah et al. , 1993) , the
time intervals set earlier in step (b) in a nor-
malized fashion can be expanded or shrunk
here to satisfy joint velocity and acceleration Fig. 2. The task
constraints, thus yielding an optimal overall
motion-time for example. for the optimal placement of [C]i for the two-arm
(e) Determine both conjugate trajectories for the system considered in Fig. 2 is as follows:
end effectors of the two arms.
(f) Based on the (simulated) actual (relative) (i) Determine the iso- pos curves corresponding
tool trajectory calculated in step (e), deter- to [C]i , i = 1, J< contact points.
mine the position , orientation and velocity er- (ii) Consider a straight line defined with respect
rors as functions of time, or locations on the to Fw by y = ax + b; and, arbitrarily choose
desired tool trajectory. a set of (a, b) coefficients so that the straight
(g) If errors determined in step (f) exceed pre- line intersects all the iso- pos curves.
defined tolerances , the number of points K (iii) Determine all intersection points in Fw co-
has to be increased and the optimization pro- ordinates and execute the inverse kinemat-
cedure returns to step (b). ics solution procedure for both arms. (Since
both arms are individually non- redundant ,
there exist unique solutions for (O l )i and
4. OPTIMAL PLACEMENT OF £(t) (0 2 ); i = 1, J<).
(iv) Execute steps (d) to (g) of the trajectory-
In this section, an optimization procedure will be resolution procedure described in Section 3.
presented for the optimal placement of [C(t)]; , * If all constraints are satisfied, it implies
i = 1, J< , in the feasible search space. The pro- that the solution is a feasible one, but not
posed technique yields a approximation of the true necessarily the global optimal one. In or-
globally optimal solution. The result is a sequence der to obtain a global solution, the opti-
of locations with respect to Fw. First , we will con- mization repeats steps (i) to (iv) described
sider the simplest of the cases and then generalize above , by attempting to determine the op-
it to the most general two-arm system. timal set of (a,b) coefficients . Thus , no
matter how large K is , the optimization is
always two- dimensional , searching for op-
4.1. Optimization Procedure timal (a, bt. (However, as it will be de-
cri bed later and shown by an example this
Let us consider a two-arm planar system consis-
solution procedure is only an approxima-
ting of rotary joints only. Arm-1 carries the tool
tion of the global solution for the placement
and has two dof. Arm- 2 carries the work piece and
of [C]i , i = 1, J<) .
has one dof. If the orientational constraint is ne-
glected at the contact point, then we note that
* If anyone of the constraints (described in
Section 3) is not satisfied, K is increased
the system has one degree of redundancy. The
and the procedure described above, (i) to
tool is required to track a trajectory on the object
(iv), is repeated for the new K locations
bounded by the points A and B, (i.e., the specific
(i.e ., for a new set of iso-pos curves).
edge of the work piece shown in Fig. 2). When
the tool is in contact with the object at any ar- The above procedure can be further improved by
bitrary point, [C(tO)] = (x(tO), y(tO)), the closed- increasing the order of the curve selected to in-
loop chain can be seen as a four-bar mechanism tersect the iso-pos curves (i.e., using an nth order
with a mobility of one dof. For this specific two- polynomial , where n > 1) . The number of dimen-

927
sions of the optimization is however only n + 1 and can be viewed when plotting the iso-Ioc curves,
remains independent of the number of locations one has to note that every point on the curve is
chosen on the tool trajectory, K. For example, if defined by a two-axis frame Ft expressed with re-
one chooses a third-order polynomial for the inter- spect to Fw by (x, y, a). It can be noticed that
secting curve, instead of a simple straight line, the the search space in this case is a subset included
optimization determines the global optimal set of in the search space obtained when orientational
four coefficients. This solution, however, is once constraint is neglected , (namely limited segments
again an approximate one, where the true global of the iso-pos curves in Section 4-1) .
solution for the placement of [C]i can be achieved
only when n = I< - 1. The flowchart shown in Using the iso-Ioc curve definition above, the opti-
Fig. 3 summarizes the optimization technique mization procedure can be carried out for this case
presented above. as well without any modification . Cubic-spline
curves would be fitted to four joint variables, as a
~;~~itl:~ ~~~~~~:J~~~~~ function of time, for K nodes. The treatment of
K. ' constraints other than the orientation is the same
as before.

Position Constraint for Spatial Systems. The


two-arm robotic system must have a total of four
dof. These dof can be distributed as 2-2 and 3-
1. The search space for the optimization would
consist of K iso-pos curves, which are spatial in
nature. In this case, one could use an "intersec-
ting surface" , as opposed to an intersecting curve
used in the case of planar systems, in order to
K=K+ I 1----<. intersect the spatial iso-pos curves. Accordingly,
the number of variables, (i.e., the coefficients of
the polynomial equation describing the spatial in-
tersecting surface), defines the complexity of the
Set up a search to detennine
best coefficient values to
minimize the motion-time
optimization .
y"
Exit Once the intersection points have been deter-
mined , the fitting of the cubic splines to the four
Fig. 3. Optimization flowchart joint variables , and thereafter determination of
the optimal motion time for a feasible K- node
In this paper, we suggest that a low-order poly- approximation of the tool trajectory continues as
nomial intersection-curve (n ~ 3) would be quite described for the planar case.
sufficient , since the trajectory for Arm-l carrying
the tool defined by the intersection points would Position and Orientation Constraints for Spatial
be a smooth one and can be viewed as being very Systems . The two-arm robotic system must have
close to a 3rd order polynomial. Though it should a total of seven dof. Moreover , the dof have to be
be remembered that the actual trajectory is de- properly distributed (numerically) and organized
fined by the cubic-splines fitted to the joints vari- (geometrically) to give an overall desired redun-
ables . dancy of 1. These dof can be distributed as 4-3 ,
5-2 and 6-1 . This case is a combination of cases
(4.2 .1) and (4.2 .2) described above , specially in
4 .2. Generalisation for i-dof Redundancy regards to the definition of iso-loc curves and the
intersecting surfaces. (In the spatial case , the ori-
Position and Orientation Constraints for Planar
entation of Ft with respect to Fw is decribed by
Systems. The two-arm robotic system must have
three angles , as opposed to only one, a, needed in
a total offour dof. We assume that the robots can-
the case of planar systems).
not individually be redundant. These dof can be
distributed as 2-2 or 3-1. The latter is achieved
by adding 1 more dof to the 2-dof arm in the 4.3. Generalisation for 2-dof Redundancy
previous system , where the former is achieved by
adding 1 extra dof to Arm- 2 which carries the In this case , the optimization procedure devel-
object. In both cases , however , the search space oped for I-dof redundancy case has to be mod-
for the optimization consists of K "iso- Ioc" curves ified. Also , the optimization may rely on input
corresponding to K locations, ( "loc" standing for from the (human) planner in regards to the def-
location: position and orientation) on the tool tra- inition of the search space and starting point of
jectory. Although only two-dimensional curves the optimization.

928
Position and Orientation Constraints for Planar
Systems. The two-arm robotic system must have
a total of five dof, which must be distributed as
3-2. The 4-1 dof distribution, though a valid one,
will not be considered herein since the 4-dof arm
is (individually) a redundant one. As can be visu-
alized from Fig. 4, any contact point on the work-
piece can be placed within an "iso-loc region" (as
opposed to an iso-loc curve). For a K-node ap- Fig. 5. Locations of mid-points

,. ,"'. . .
proximation, there would be K iso-pos reglOns,
which might be partially overlapping. Position Constraint for Spatial Systems . In this
paper, for spatial systems with more than I-dof

J!!!-
redundancy, only the position constraint will be
considered . As might have been already noted in
I ~-Ioc r~on (
the I-dof redundancy case, the consideration of
l ~ lOC r'99l on e
orientation constraints only complicates the def-
inition of the search space used during the opti-
mization, but not the nature of the optimization.
Thus, as in the case of planar systems, increasing
Fig. 4. Iso-loc regions the number of redundant dof will increase the di-
mensions of the iso-pos regions first to two and
The objective of the optimization is to determine then to three .
the optimal set of K points . When we consider the
earlier proposed technique of using a (polynomial) Let us consider the 3- 2 dof distribution case as
intersecting curve, we ncte that the intersections an example. The K contact points on the tool
are specific individual segments of the polynomial trajectory could be placed anywhere within the
curve , as opposed to being individual (intersec- K iso-pos regions, which are 2 dimensional and
tion) points . A possible solution to this moder- spatial in nature. Thus, by simply extending the
ately complex optimization problem is to conduct earlier concepts, one can propose first the use of
a K -dimensional search for the location of the K "polynomial surfaces" intersecting the iso-pos re-
nodes for every "guessed" polynomial. The equiv- gions, and second the use of mid-point selection
alent problem is searching freely for the K-node process, for finding K optimal points on the indi-
locations directly within their 2-dimensional iso- vidual segments.
pos regions. As can be noted, however, in both
cases the optimization is directly coupled to the
number of nodes , which is an undesirable scenario. 4.4 . Generalization for 3-dof Redundancy
The following approximation is proposed herein to
significantly simplify the optimization procedure : Position and Orientation Constraints for Planar
Systems. In this case, both arms have full mo-
(1) Determine the iso-loc regions for K nodes (or bility (i .e., 3 dof each). The only difference with
simply their boundaries) . the 3- 2 dof distribution case is the definition of
(2) Guess a polynomial curve and let it pass the iso-loc regions. Herein , these regions would
through all the iso- loc regions . be more expanded due to the extra dof.
(3) Consider each region individually, by first
determining the segment of the polynomial
Position Constraint for Spatial Systems . As in
curve within it and then simply finding the
the case of the planar systems, both arms have
mid-point of the segment , Fig. 5.
full positional mobility (i.e. , 3 dof each) . The only
(4) Solve inverse kinematics at the K mid- points.
difference herein is that the iso-pos regions now
(5) Fit cubic- splines . Check for constraints and
are 3-dimensional. In this case , the solution of the
find the best objective function value attain-
optimization problem would require the construc-
able. Return to step (2) for guessing a differ-
tion of a hierarchy. In the upper level, the opti-
ent polynomial , and repeat optimization until
mization would guess a polynomial surface that
"best" intersecting polynomial is determined .
would intersect the "iso-pos volumes" yielding a
The above procedure 's dimensionality is indepen- set of pseudo iso-pos surfaces . The best set of K
dent of K. It is only dependent on the order of node positions on these surfaces can be found as
the polynomial. The accuracy of the optimization explained before within the second level of the hi-
can be further improved without a significant in- erarchy. The procedure would then return to the
crease on the computational time by shifting the upper level to determine the best polynomial (in-
"constant" overall "string" along the polynomial tersecting) surface and its corresponding optimal
curve, Fig. 5. set of K node locations.

929
4.5. Discussion the motion. As shown in Fig. 7, f{ = 5 nodes
were necessary to satisfy the position and speed
The complexity of our proposed method increases errors. Once K was set at 5, the motion-time
significantly as the "dof of redundancy" increases. was minimized, by reducing the constant-time in-
However, in the case of modular robots , there is no tervals between the nodes, to as low as 0.59 sec-
need for "high" number of redundant dof, where ondes. The "flexible polyhedron" search method
one redundant dof is sufficient . Thus, for high of Nelder and Mead (Nelder and Mead, 1964) for
numbers of redundant dof, one may choose to use non-linear optimization problems, was succesfully
an "exact" technique as in (Tabarah et al. , 1992) used for determining the two optimal coefficients
(one trajectory is arbitrarily chosen for the arm of the first-order polynomial used to intersect the
carrying the tool and the conjugate trajectory is iso-pos curves. When the order of the polynomial
solved for the second arm) , and not an approxi- was increased to first n = 2 and then n = 3 the
mation technique as discussed in this paper. (reduced) optimal motion times were determined
as 0.50 sec and 0.44 sec respectively. Figures 8
and 9 show that both position and speed errors
5. EXAMPLE remain within their specified tolerances for K 2:
5. The optimization results , in regards to posi-
In order to illustrate the proposed algorithm , the
tional and speed errors, are summarized in Table
two-arm planar robot shown in Fig. 2 was consid-
2. The motion simulation for the 3rd order inter-
ered . The tool trajectory was approximated by K section polynomial is shown in Fig. 6.
points. Positional errors were calculated by deter-
mining indi vid ual points on the (simulated) actual Table 1 Robots' parameters
tool trajectory and finding their shortest distances
to the designated tool trajectory. Similarly, the
velocity vectors were determined at those "paired" Arm 1 1 2
points , and errors in relative speed were calcu- Joint 1 2 1
lated as a percentage of the desired pre-set con- qmax(rad/s) 0.5 l.0 0.5
stant speed that the tool had to follow along the qmax(rad/s 2 ) 10.0 20 .0 10.0
desired tool trajectory on the object. Link Length (m) 0.8 0.8 0.5

Motion- time was considered as the objective func-


System's toAotTon
tion for the optimization. This motion time can
be calculated from the robot 's kinematics as fol-
lows:

IBij(s)1 Robo! I
max max -.- - , max
[ ij ,. ()r;ax ij ,3

O:Ss:S 1;i= 1, 2;j= 1, 2 (1)

where s is a time scale, Bij(S) and Bij(S) are the


first and second derivatives of the joint displace-
ment obtained from the cubic- spline interpola-
tl'on , and Brn
'J
ax and Brn ax are the velocity and ac-
'J
0 . 0
celeration limits on the ith joint of the jth arm. X (m)

The overall optimization , which contained total Fig. 6. System 's layout and optimal motion: K = 5,
motion simulation, was first run using a first- yd order intersecting polynomial
order polynomial for the intersection curve. The
data used during the simulations are given in Ta- Table 2 Maximum position and speed errors
ble 1 where the base locations of the two arms and motion times for first , second and third
were 's et as .c.~ = (0 , 0) and .c.~ = (l.7m, 0) , Fig. order polynomials as a function of K
6. The object held by Arm-2 was rectangular in
shape (0.5rn x 0.2m), whose longer edge consti-
tuted the desired tool trajectory. The position- Number 01 Nodu (K )

error limits were set as ± 0.5 mm and the speed-


error limits were set as ± 1 % of the desired "con- ;;:''7''_1 ~'I Tinx ~'7"mm) ~I'"
't ) Tunt it ) ~':...I ~( .., TIIT'Ie It )
\01 0.'3 O.9!I O~7 0 41 O.6t 0..59 030 O.~2 060
stant" tool speed. Since the motion- time was
DlS ua 0. 44 091 0-X1 OJl 079 0..51
minimized , the desired relative tool velocity was
3'" 0.17 1 60 0 43 0 "9 100 0.4-4 0 42 0.99 0 45
also minimized, but maintained constant during

930
It should be remembered that the time intervals was discussed for higher numbers of dof redun-
between the nodes were reduced during the opti- dancy. An optimization procedure minimizing a
mization while considering the limits on joint ve- given cost function (the robot motion time in our
locities and accelerations. case) for this pair of trajectories was described.

For the overall synthesis problem, it will be nec-


essary to consider other variables during the op-
timization, for example, relative distance between
the two bases or the link lengths. The use of the
dynamics model of the system is also necessary to
take into account the dynamics constraints .
• •• • o.
ft_
.o.c.) 0 ...... o. ... ...
TI_
...
Co )
• o. .o. o •

7. REFERENCES
Fig. 7. Position and speed errors - first order polyno-
mial Cohen, R ., M.G. Lipton , M.Q. Dai and B. Ben-
habib (1992). Conceptual design of a modular
robot. ASME, Journal of Mechanical Design
114, 117-125.
Craigan, C.R. and D.L. Akin (1989). Optimal
force distribution for payload positioning us-
ing a planar dual-arm robot. ASME, Journal
of Dynamical System, Measurement and Con-
trol 111 , 205- 210 .
•• o •• o • •
Jouaneh, M.K., Z. Wang and D.A. Dornfeld
0 .0 ••• • .0 0 .0 •• O '
, . .... c. ) Tl .. , c. )

(1990). Trajectory planning for coordinated


Fig. 8. Position and speed errors - second order poly- motion of a robot and a positioning table:
nomial part 1 - path specification. IEEE Journal on
Robotics and Automation 6 , 735- 745.
Nelder , J. A. and R . Mead (1964). A simple
method for function minimization. The Com-
puter Journal 7 , 308-313.
Tabarah , E. , B. Benhabib, R.G. Fenton and
G. Hexner (1992). Optimal trajectory resolu-
tion for the coordination of two robots in con-
. '. 0.. ._ tact operations. Proc . ASME 22nd Biennial
to ... c. )
Mechanisms Conference 45 , 455-46 0.
Tabarah , E., V. Taussac , E. Dombre and B.
Fig. 9. Position and speed errors - third order poly-
nomial
Benhabib (1993). Optimal trajectory planning
for coordinated two-arm modular robotic sys-
tems. Proc. International Conference on Ad-
It is clear from the simulations that higher-order vanced Robotics pp. 617-622.
polynomial intersecting curves yield a set of K Tarn, T.J., A.K. Bejczy and Z.F. Li (1988). Dy-
locations which better approximate the nominal namic workspace analysis of two cooperating
task-space tool trajectory in terms of minimum robot arms. Proc. A merican Control Confer-
task-execution times. The only disadvantage ence 1 , 489- 498.
to higher-order functions is obviously the larger Tesar , D. and M.S. Butler (1989). A genera-
number of coefficients that have to be optimized. lized modular architecture for robot struc-
tures . ASME, Journal of Manufacturing Re-
view 2 , 91-117.
6. SUMMARY Zheng, Y.F. and J.Y.S. Luh (1988). Optimal load
distribution for two industrial robots handling
The concept of using modular systems to con- a single object. Proc. IEEE International Con-
figure two-arm robots was introduced. The two ference on Robotics and Automation pp . 344-
arms are coordinated to move relative to each 349.
other in order to perform a common task in an
optimal manner. A novel method was presented
for the planning of the coordinated motion for a
1-dof redundancy case. This method allows to
determine a pair of conjugate trajectories for the
two end effectors. An extension of this method

931

You might also like