Professional Documents
Culture Documents
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
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.
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
IBij(s)1 Robo! I
max max -.- - , max
[ ij ,. ()r;ax ij ,3
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 )
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.
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. )
931