N. A. Aspragathos and S. Foussias: Optimal Location of A Robot Path When Considering Velocity Performance
N. A. Aspragathos and S. Foussias: Optimal Location of A Robot Path When Considering Velocity Performance
SUMMARY In these cases, the shape of the path is known since it has
A method for searching the best location of a path in the been specified in the design of the manufactured part.
robot workspace considering the velocity performance of A lot of research efforts have been devoted to minimise
the robot is presented. After a thorough investigation of the the cycle time of robot tasks and this problem involved a
robot performance indices, a new measure for the velocity variation of formulations. In some cases,1–4 the minimisation
efficiency of a robot moving its end-effector along a path is of the cycle time is presented as a version of the well-known
introduced. This measure is an approximation of the Travelling Salesman Problem (TSP), where the task of the
minimum of the Manipulator Velocity Ratio (MVR) along robot is to visit a number of known fixed points. The end-
the path. The minimum is calculated from a finite set of effector of the robot can visit these points in any order, since
MVRs determined at specified points of the path using an there are tasks where the order is not critical such as the spot
algorithm for an approximate motion of the end effector welding. The TSP problem has been adapted to the
along the path. characteristics of the robots mainly by replacing the
The introduced measure is used as the objective function distance between the points with the time required to move
in an optimisation problem, where an optimal location of between two successive points in the configuration space of
the path is searched. The objective function is procedural the robot. Another characteristic taken into account is that
and non continuous, so a Genetic Algorithm is used to the time required to move from one point to the next is not
search the space for the optimal location of the path. The equal to the time required to move back.
proposed method is tested using a simulated PUMA-like In the design of a robotic workcell, the optimal position
robot, which has to move its end-effector along a straight- of the base of the robot has been studied by a number of
line segment. At the end of the paper, the results obtained in researchers.5,6 Dissanayake and Gal5 proposed a technique
these tests are presented and discussed. to optimise the location of the robot, the sequence of the
tasks and the configuration of the robot at each task in order
to minimise the cycle time. In another approach,6 the
1. INTRODUCTION optimal position of the robot is found by minimising the
The design of the layout of a robot workcell is a very distance between the space effectively reached by the robot
important engineering task, which is performed mostly by and the target space if no overlapping occurs between these
trial-and-error and intuition. Using CAD and/or Robot spaces. In the case of overlapping, the volume of the target
Simulation Systems, the designer can obtain considerable space not reached by the robot is minimised.
support in order to put the jigs and fixtures and locate the In the above two categories of methods for minimising
robot tasks in the workspace of the robot. These systems the cycle time, the capabilities of the robot such as the
offer powerful 3D graphics for a realistic representation of velocity efficiency were not taken into account. In some
the objects, collision detection and off-line programming, methods7–11 for trajectory planning or kinematic control of
but do not provide special tools for the determination of the redundant robots, indices or measures characterising the
optimal or, at least, sub-optimal location for a robot task. efficiency of the robot are taken into account. These
Therefore, the workcell designer moves the fixtures in trial measures are related to the Jacobian matrix, so they are
locations into the workcell and uses off-line programming configuration dependant. In some of these papers, an
searches for the best location, taking into account design integral cost criterion is optimised instead of an instanta-
criteria such as low cycle time, reduced wear and energy neous criterion as it has been used in the well-known
consumption, or avoiding obstacles and/or joint velocity methods based on extended or pseudo-inverse Jacobian. In
limits. It is well known, that the capabilities of the robot these papers, the location of the path in the Cartesian space
depend on the robot configuration; for example, the velocity is pre-specified, while the trajectory in the joint space is
efficiency or the mechanical advantage of the robot varies determined using the proposed methods.
considerably in the robot workspace. Therefore, in applica- The optimisation of the robot task location based on the
tions of trajectory planning and generation such as painting, manipulator efficiency attracted little attention of the robotic
welding, cutting (especially in laser cutting), it is very research community.12–14 An algorithm has been proposed
important to search for the location of the trajectory, where by Nelson and Donath12 for optimising the location of an
the velocity efficiency of the robot would be the maximum. assembly task in a manipulator’s workspace. In their
different units and thus these indices could be meaningless.
Cosellin18 and Angeles19 proposed alternative definitions of tf 1 T –1
the Jacobian matrix to overcome this problem. Another q̇ W q̇ + g(q) dt (9)
t0 2¯ ¯ ¯
approach to resolve this problem is to normalise the
velocities of the joints and of the end-effector, which is
followed in this paper. subject to the constraints of the kinematic equations of the
The mutual orientation of the generalised kinematic robot:
ellipsoid (manipulability ellipsoid), the generalised dynamic x = f (q) (10)
ellipsoid and the generalised stiffness ellipsoid is given by ¯ ¯
the Hybrid Manipulator Measures (HMM) introduced by W is a diagonal matrix whose elements reflect the relative
Ermolov and Podurajev.20 The HMM are frame-invariant cost in terms of energy or time, of utilising each joint axis,
and can be used to optimise the trajectory placement within and g(q) is a function of the robot configuration such as the
¯
manipulability measure or the distance of some obstacle.
the workspace in the case of constrained motions.
Dubey and Luh21 used the Manipulator Velocity Ratio Uchiyama et al.8 proposed the following integral measure
(MVR) in control algorithms of redundant robots as a for optimal trajectory planning:
performance criterion to be maximised along a desired
trajectory. The Manipulator Velocity Ratio is defined as the
ratio of the end-effector velocity norm to the joint velocity
vector norm
P1
P0
ds
det J
(11)
in the Cartesian space, and ds is the differential distance
ẋTv ẋv along the trajectory.
rv = ¯ ¯ (4)
q̇Tv q̇v From the review of the proposed dexterity measures so
¯ ¯ far the following conclusions can be derived:
where ẋ and q̇ are the weighted vectors of the end-effector (i) The manipulability index, the reciprocal of the condi-
¯ velocities,
and joint ¯ respectively. By replacing the well tion number, and the minimum singular value, or any
known equation combination of them can represent the motion ability
of the robot. Using these criteria the ability of the robot
q̇v = Jv+ ẋv (5) to move in a given direction cannot be derived.
¯ ¯ (ii) The MVR is an index of the robot ability to move in a
where Jv+ is the inverse or the pseudo-inverse of the given direction at a specific configuration.
weighted Jacobian Jv for non-redundant or redundant (iii) The Hybrid Manipulator Measures are suitable for
manipulators, respectively, the following relation for the combined tasks, where velocity and applied force are
MVR it can be obtained specified simultaneously.
(iv) These integral measures proved superior compared to
the instantaneous ones, but they are used to determine
ẋTv ẋv a trajectory in the joint space for given boundaries in
rv = ¯ ¯ (6) the Cartesian space. However, even if the manipul-
(Jv+ ẋv )T(Jv+ ẋv )
¯ ¯ ability of the robot is taken into account in these
Vx
a
2
+
Vy
b
2
+
Vz
c
2
=1 (12)
ordinate frame {FS} and the length of the segment define the
position and the orientation of the straight-line segment. As
it is illustrated in Figure 2, the starting frame {FS} coincides
with the staring point of the path, while the x-axis is along
where V = [Vx, Vy, Vz]T is the vector of the translational the path and the z-axis is perpendicular to the straight-line
velocity¯ of the end-effector referenced to the Cartesian segment.
system defined by the axes of the manipulability ellipsoid. The frame {FS} is defined in a parametric form by
Since the elements of the end-effector velocity vector are xs = [x y z ]T,where x, y, z are the Cartesian co-ordinates
equal to the projection of the velocity vector to the principal ¯ the starting point of the segment defined in the universal
of
axes of the ellipsoid, Eq. (12) can be written as: frame {U} and , , are the Euler angles of the frame
1 {FS} referenced to the frame {U}. Alternatively, the location
|V|= (13) of the frame {FS} can be defined through the transforma-
¯ ua T
uTb 2
2 uTc 2
¯ 2¯ + ¯ 2¯ + ¯ 2¯ tion
a b c U
TFS(qs), qs = [q1 . . . qn]T and qLS ≤ qS ≤ qUS (14)
where u is the unit vector along the end-effector velocity. ¯ ¯ ¯ ¯ ¯
¯ direction of the end-effector velocity coincides where qS is the vector of the joint co-ordinates of the
When the ¯
manipulator, when the frame of the tool coincides with the
with the major axis of the ellipsoid, the magnitude of the frame {FS}. For simplicity, it is supposed that the tool is
end-effector velocity is maximum, since the scalar products perpendicular to the segment. The Cartesian or the joint co-
of u with the vectors corresponding to the other two axes ordinates defining the local frame {FS} are the variables of
¯
become equal to zero due to the orthogonality of the the objective function representing the minimum value of
ellipsoid axes. For the same reason, the end-effector
velocity becomes minimum when its direction coincides
with the minor axis.
along the path is an approximation of the real minimum of
i=k2
the MVR along the path, and it depends upon the permitted
maximum position deviation used in Taylor’s algorithm. ra = ((rv)s + (rv)f + (rv)i)/k for i = 1, k 2 (18)
i=1
This dependence is complicated enough so it is difficult to
estimate the error. However, using the proposed approxima-
tion, a considerable amount of computational time is saved. In this paper, two additional velocity efficiency indices
It is well known that the Taylor algorithm converges based on the robot manipulability are investigated and
quickly and a deviation can be obtained as small as it is compared. The index wm presents the minimum manipul-
desired. The relation between the position deviation and the ability along the path and it is defined by
respective deviation of the MVR is very complicated and it wm = min(wi, ws, wf ) for i = 1, k 2 (19)
can be assumed that this function is incremental at least for
small position deviation as it concluded experimentally. where wi, ws, and wf are the manipulability indices at an
However, near a singular point for a small position deviation intermediate point, the starting point, and the final point of
a very large deviation of the corresponding MVRs is the straight-line segment, respectively. The forth measure of
expected. Since the proposed optimisation algorithm pushes the velocity efficiency along the path, which is investigated
the location of the path far from singular points then such in this work, is the path manipulability defined by
problems are avoided. Aspragathos.14 This measure represents the approximate
Every intermediate knot position orientation of the tool average of the manipulability along the path and it is given
on the straight-line segment is given as a function of the by
parameters defining the frame at the starting position i=k2
orientation by
wa = wi + ws + wf k (20)
U i=1
TFi = UTFS(qS)[Li 0 0]T (16)
¯
From the presented analysis of the proposed indices
where Li is the distance of the ith intermediate point from
concerning the performance of the robot along a path, the
the origin of the coordinate system {FS}
following conclusions can be derived:
The Cartesian co-ordinates xS can replace the joint co-
ordinates qS, but in the following¯ the joint coordinates are (i) The definition of the objective function based on the
¯
used. Solving the inverse kinematic problem at every minimum of a local index along the path is better than
intermediate and the final position/orientation of the tool, an objective function representing the mean value,
Genetic Algorithms (GA) are powerful domain independent
search mechanisms, which emulate the process of genetic rm(qS), if qLS ≤ qS ≤ qUS
fitness = ¯ ¯ ¯ ¯ (21)
evolution found in nature as a means of progressing towards 0, if qS ≤ qLS or qUS ≤ qS
the optimum. Combining an artificial survival of the fittest ¯ ¯ ¯ ¯
with special genetic operators, GA provides a robust search The variables of the objective function are the joint
mechanism that is suitable for a variety of search problems. coordinates qS determining the local frame {FS}, which
A Genetic Algorithm works simultaneously from a number ¯
defines the position and the orientation of the path. This set
of points scattered in the search space and examines many of variables is coded as a finite length binary string, which
local optima in parallel, thus the probability to determine represents one chromosome of the population.
the global optimum is high, when it works in a multi-modal In this work, the chromosome selected is an m-bit string
space. Genetic Algorithms require only the objective with the following syntax: the (m/n)-bits correspond to the
function, while in many optimisation methods auxiliary first joint of the robot, the next (m/n)-bits correspond to the
information is necessary. For example, the gradient methods second joint, etc. Therefore the ith joint co-ordinate can be
need the derivatives of the objective function. calculated from the values of the corresponding (m/n)-bit
In the following, a solution to the formulated optimisa- using the following mapping:
tion problem based on a simple Genetic Algorithm is
qi = qLi + [Bitvalue /2m/n]qUi (22)
introduced. There are at least three basic reasons that make
GAs attractive in solving such a problem: First, they are where Bitvalue is the decimal number corresponding to the
proven to provide a robust search in complex spaces by string of the ith joint, and qLi, qUi are the limits of the ith joint
finding nearly global optima. In general, the bisection variable.
recursive method used to define the knot points under It must be underlined that a single m-bit string represents
bounded position deviation provides a non-continuous, one of the 2m alternative solutions to the problem. The value
Table I.
rm q̇max
i Starting point Final point