Mub04 Jour Pra PDF
Mub04 Jour Pra PDF
Mub04 Jour Pra PDF
95
1. Introduction
A robot is characterized by its degree of freedom, number of joints, type of joints,
joint placement and their orientation, link lengths and shapes, which influence its
performances, namely, the workspace, manipulability, speed of operation, etc. The
speed of operation significantly depends on the complexities of the kinematic and
dynamic equations and their computations. The robots with different architectures
will have different kinematic and dynamic equations with varying computational
complexities. Hence, in order to select a suitable robot, both aspects i.e. kinematics
as well as dynamics should be looked into. Generally, kinematic characteristics like
workspace [13], manipulability [46], etc. are considered for the selection of a
robot. Dynamics is generally neglected at this stage, even though it is widely used
for control [712] and simulation of robots [1217]. In this paper, simplicity of
dynamic model and its computations are emphasized, particularly, with respect to
the generalized inertia matrix (GIM), which has been proposed as a criterion for
robot architecture selection. The simplicity of the GIM is emphasized here because,
96
for example, if it is diagonal, control becomes decoupled, i.e. each joint motion
servo control is not influenced by the servo gains of the other joints. This improves
overall robot performance, namely, speed and precision. Besides, the simulation,
in which the inversion of the GIM is required, becomes straight forward, as the
inversion of a diagonal matrix is just another diagonal matrix whose non-zero
elements are the reciprocals of the corresponding non-zero elements of the original
matrix.
In order to decide whether the GIM of robot architecture is simple or not, it is
essential to have the expressions of each elements of GIM as descriptive as possible. Thus, the concept of the decoupled natural orthogonal compliment (DeNOC)
introduced in Saha [18] is used here to derive the dynamic equations of motion. The
DeNOC concept allows one not only to write the elements of the GIM in explicit
analytical forms, but also for the elements of the matrix of convective inertia (MCI).
These forms led to the development of recursive dynamics algorithms for both the
inverse and forward dynamics of serial [17, 18], and parallel [19] robotic systems.
Using the analytical expressions, one can estimate the computational complexities
of the GIM and MCI in terms of floating point operations, which will have bearing
on the overall computer CPU time of an algorithm where GIM and MCI appear,
e.g., in the inverse dynamics algorithm.
This paper is organized as follows: Section 2 provides an outline of the dynamic modelling using the decoupled natural orthogonal compliment (DeNOC);
Section 3 introduces the proposed criteria for robot selection; Section 4 illustrates
the selection criterion using 2-link arms; Section 5 considers an example of an arm
selection from RTX and Stanford architectures. Finally, conclusions are given in
Section 6.
2. Dynamic Modelling Using the DeNOC
For an n-degree of freedom open-loop serial-robot, as shown in Figure 1, if mi is
the mass of the ith link and Ii denotes the 3 3 inertia tensor of the ith link about
its origin point, Oi , then the uncoupled NewtonEuler equations (NE) governing
the motion of the ith link can be written as
Mi ti + Wi Mi Ei ti = wi
(1)
where the 6 6 mass matrix, Mi , the 6 6 angular velocity matrix, Wi , and the 6
6 coupling matrix, Ei , for the ith link are given as [19]
Ii
Mi
mi di 1
1 O
Ei
O O
mi di 1
mi 1
i 1
Wi
O
O
i 1
(2)
97
in which Ii Ici di (mi di 1) Ici being the 3 3 inertia tensor about the mass
centre of the ith body, Ci , di 1 and i 1 are the 3 3 cross-product tensors
associated with the vector di shown in Figure 2, and the angular velocity vector,
i respectively. Note that 1 and O in Equation (2) are the 3 3 identity and zero
matrices, respectively. The twist and wrench vectors, ti and wi , are then defined as
i
ni
and wi
(3)
ti
vi
fi
98
where i and vi are the three-dimensional vectors of angular velocity and the linear
velocity of the origin point Oi , of the ith body, where it is coupled with its previous
body in the chain, i.e., the jth body, respectively, Figure 2. Moreover, ni and fi
are the three-dimensional vectors denoting the resultant moment about Oi , and the
resultant forces acting at Oi , respectively. Note that ti of Equation (1) is the time
derivative of the twist vector or twist-rate vector. Equation (1) when written for all
n links, i.e., i = 1, . . . , n, it can be expressed in a compact form as
Mt + WMEt = w
(4)
where M and W are the 6n 6n generalized mass matrix and the generalized
matrix of the angular velocities, respectively, whereas E is the 6n 6n generalized
coupling matrix. They are defined as follows:
M1
O
...
O
O
...
O
W1
..
..
.
.
M2 . . .
W2 . . .
O
O
M .
;
W
..
..
..
..
..
..
..
..
.
.
.
.
.
.
.
O
. . . . . . Mn
O
. . . . . . Wn
O ... O
E1
..
.
O E2 . . .
E .
(5)
..
..
..
..
.
.
.
O . . . . . . En
Moreover, the 6n-dimensional vectors of generalized twist and wrench are defined
as
T
t tT1 , tT2 , . . . , tTn
w wT1 , wT2 , . . . , wTn
(6)
It is pointed out here that the generalized twist, t, can be expressed as a linear
transformation of the n independent joint rates, [ 1 , . . . , n ]T i being the
ith joint displacement shown in Figure 2, i.e.,
t = T,
where T TI Td
(7)
(8)
99
where w is substituted by w wE + wC , wE and wC being the 6n-dimensional vectors of external and constraint wrenches, respectively. The term TT wC in Equation
(8) vanishes, as the constraint wrench produces no work. Substitution of the expression of T Tl Td from Equation (7) and its time derivative, T = Tl T d + T l Td ,
into Equation (8), results in the following form of the dynamic equations of motion:
I + C =
(9)
which is nothing but the EulerLagrange equations of motion [7]. In Equation (9),
d : the n n generalized inertia matrix (GIM);
I TT MT Td T MT
+ M)T
C T (MT + WMET) TTd (TT1 MT l + MW
d : the n n matrix of
convective inertia (MCI);
E : the n-dimensional vector of generalized forces due to
TT wE TTd w
driving forces / torques and those resulting from the gravity and dissipation.
and the 6n-dimensional vector w
M
E are
The 6n 6n matrices, M,
given by
TT MTl
M
l
TT WMET and w
E TTl wE .
M
l
l
GIM
AND
MCI
Using the expressions for the n n GIM, I and, MCI, C, as appearing after Equation
(9), each element of I, ii j , and C, cij , are written as
i Aij pj
i ij pTi M
p
j Wj + ATj+1,i H
j+1,j + ATji M
ci j pTi ATji M
j
j
A )p
i Aij Wj + H
ij + M
ci j pTi (M
i ij j
if i j
(10)
otherwise
where, the 6 6 matrix Aij and the six-dimensional vector, pi , are the block elements
of the DeNOC matrices, Tl and Td , respectively, i.e.,
0 ...
0
1
O
... O
p1
A21
0 p2 . . .
1
. . . O
0
and
T
Tl ..
.
.. (11)
..
.
.
d
.
.
.
.
.
.
.
.
.
.
.
.
.
.
.
An,1 An,2 . . . 1
0
0 . . . pn
100
In Equation (11), O and 0 are the 6 6 zero matrix and six-dimensional zero vector,
ij , in the expression of cij , is given by
whereas the matrix, H
iA
ij M
ij + AT i+1,i H
i+1,i Aij
H
(12)
for i = n, n 1, . . . , 1
(13)
M
n,n1 Mn An,n1
i has a physical interpretation. It represents the mass matrix of the
ii. Matrix M
composite body i, formed by rigidly joining the bodies, i, . . . , n, as indicated
in Figure 1.
3.2.
COMPUTATIONAL COMPLEXITY OF
GIM
AND
MCI
One of the ways to simplify the GIM and MCI is to make some of the elements
vanish, or constant with suitable choice of the link masses and geometries. For
example, if any two successive, say, ith and (i +1)st joints are prismatic, orthogonal
and intersecting, the corresponding off-diagonal inertia element, namely, i i+1,i
i+1 Ai+1,i pi , can be proven to be zero. In case the elements do not vanish,
Pi+1 T M
their computational complexity in terms of the floating point operations, namely,
the number of multiplications/divisions (M) and additions/subtractions (A) are
counted. For the GIM and MCI, the complexities are obtained for the following
input: For i = 1, . . . , n,
i. Constant DenavitHartenberg (D-H) parameters [20] of the system under study,
i.e., i , ai , and bi (for revolute joints) or i (for prismatic joints). They are also
defined in Appendix A.
ii. Time history of variable DH parameter, i.e., i , for a revolute pair, and bi , for
a prismatic joint, and their first and second time derivatives.
iii. Mass of each body, m i .
iv. Vector denoting the distance of the (i + 1)st joint from the ith mass centre, Ci ,
in the (i + 1)st frame, i.e., [r1 ]i+1 , as shown in Figure 2.
v. Inertia tensor of the ith link about its mass centre, Ci , in the (i + 1)st
frame.
101
Note here that []i+1 will represent the argument in the (i + 1)st coordinate
frame which is rigidly attached to the ith link. Thus, the quantities, [Ii ]i+1 and
[ri ]i+1 are constant and supplied as input. Moreover, the complexity count is given
inside { } at the right of each step and substep, which is based on the assumption
that all joints of the robot are revolute with arbitrary orientation.
1. Calculate [ai ]i (Angeles, 1997)21 :
For i = 1, . . . , n,
[ai ]i = [ai cos i ai sin i bi ]T
{2M(n)}
:2M
Note that, for each [ai ]i , 2M computations are required. Hence, for all n links,
2M(n) computations will be required to find [ai ]i , for i = 1, . . . , n, that appears
above within the braces, {2M(n)}.
2. Calculate [ri ]i : {8M 4A(n)}
For i = 1, . . . , n,
[ri ]i = Qi [ri ]i+1 :
8M4A
where Qi is given as
sin i sin i
cos i sin i
cos i
Note above that the multiplication of the 3 3 matrix, Qi or QiT with a threedimensional vector is obtained efficiently with only 8M 4A, instead of 9M 6A
required to multiply a 3 3 matrix with a three-dimensional vector, as shown
in Appendix B.1.
3. Calculate [di ]i : {3A(n)}
For i = 1,. . . , n,
[di ]i = [ai ]i [ri ]i
4. Calculate [mi di ]i :
For i = 1, . . . , n,
:3A
{3M(n)}
[mi di ]i = mi [di ]i
:3M
102
:16M17A
:6M3A
[m i di 1]i
:nil
:6A
M
i+1,i i+1 Ai+1,i
6. a) Calculate i ii :
For i = n, . . . , 1
:18M18A
{nil}
i pi
i ii p Ti M
:nil
eTi
ei
0 i [Mi ]i
0 i
T
Since [ei ]i = [0 0 1]T , the calculation of i ii is simply the 3,3 element of the (1,1)
i ], which do not require any computation.
block matrix of [M
b) Calculate i i j : {22M14A(n 2 n)/2}
For i = n,. . . ,1; j = i 1,. . . ,1
i Aij pj
i i j = pTi M
: 22M14A
(14)
For six revolute jointed robot (n = 6), the complexity for the GIM is 630M
498 A. Note that the complexity of Equation (14) is less than that reported earlier
in [14], which is
(12n 2 + 56n 27)M(7n 2 + 67n 53)A.
(15)
103
Variables
Multiplications
[ai ]i , i = 1, . . . , n
2n
[ri ]i , i = 1, . . . , n
8n
4n
[di ]i , i = 1, . . . , n
3n
[mi di ]i , i = 1, . . . , n
3n
5(a)
22n
26n
5(b)
[Mi]I, i = n, . . . , 1
i ]i , for i = n 1,. . . , 1
[M
18(n 1)
18(n 1)
6(a)
i ii , i = n, . . . , 1
6(b)
i i j , i = n, . . . 1; j = i 1, . . . , 1
22(n 2 n)/2
14(n 2 n)/2
Total
11n 2
+ 42n 18
Additions
7n 2 + 44n 18
(16)
Again, for n = 6 with all revolute joints, the MCI complexity is 640M 753.5A,
which could not be compared due to non-availability of such results.
3.2.1. Planar GIM and MCI Complexity
For planar robots, for example, as shown in Figure 3, the computational complexity counts in Equations (14) and (15) resulting in very high values as many zero
components of the two-dimensional vector and matrix elements will be processed
/ counted. Hence, an alternative simplified algorithm is proposed.
104
{2M(n)}
ai sin i ]T
:2M
{4M 2A(n)}
:4M2A
where Qi is given as
cos i sin i
Qi
sin i
Cos i
3. Calculate 2-dimensional [di ]i :
For i = 1, . . . , n,
[di ]i = [ai ]i [ri ]i
{2A(n)}
:2A
4. Calculate 2-dimensional [m i di ]i :
For i = 1, . . . , n,
[m i di ]i = m i [di ]i
{2M(n)}
: 2M
{nil (n)}
where the scalar, iczz , is the (3,3) element of Iic that only contribute to the planar
motion, which do not require any computation as it is one of the inputs item
(v) of Section 3.2. Moreover, for planar motion m i di 1 can be
shown
to be
equivalent to mi dTi R [22]. The 2 2 matrix R is defined as R 01 1
. Note,
0
m i dTi R is known from the observations. Hence, no computation will be required
for [Mi ]i .
i ]i for i = n 1, . . . , 1 {7M7A(n 1)}
b) The 3 3 matrix [M
i Mi + AT M
M
i+1,i i+1Ai+1,i
6. a) Calculate i ii : {nil}
For i = 1, . . . , n,
i pi
i ii pTi M
: nil
:7M7A
105
Variables
Multiplications
Additions
[ai ]i , i = 1, . . . , n
2n
[ri ]i , i = 1, . . . , n
4n
2n
[di ]i , i = 1, . . . , n
2n
[mi di ]i , i = 1, . . . , n
2n
5(a)
5(b)
[Mi ]i , i = n, . . . , 1
i ]i , i = n 1, . . . , 1
[M
7(n 1)
7(n 1)
6(a)
iii , i = 1, . . . , n
6(b)
ii j , i = n, . . . 1; j = i 1, . . . , 1
7(n 2 n)/2
4(n 2 n)/2
Total
3.5n 2
+ 11.5n 7
2n 2 + 9n 7
: 7M4A
The total computational complexities in the planar case can be obtained by adding
the above values inside and, as given in Table II.
The computation complexity to find GIM for planar robot is
GIM : (3.5n 2 + 11.5n 7)M(2n 2 + 9n 7)A
(17)
(18)
For n = 3 with all revolute joints, 59M 38A computations are required for the
GIM, and 106M 77A are required for the MCI, whereas if the spatial algorithm
of Equations (14) and (16) are used, for n = 3, then 207M 177A, and 196M
222.5A are required for the GIM and MCI, respectively, which are high and not
recommended for planar robots.
3.3.
The computational time is the time taken by the computer of the robot controller
to evaluate or solve the equations of motions, which depends on the computational
complexity of the associated equations. If the computational complexities of the
GIM and MCI vary for different robots, they should reflect in the computational
times of the algorithm where they are used. As a test, inverse dynamics algorithms
based on the GIM and MCI elements obtained in Section 3.1 are developed for
106
different architectures. Computer CPU times are recorded along with the computational complexities of GIM and MCI. Here, the CPU time is basically the time
taken to compute the controlling joint torques/forces from the inverse dynamics
algorithms. The computer CPU will take comparatively less time to solve the inverse dynamics equations if they are simpler. Less computation time implies that
the maximum speed of a robot arm can be high. Thus the manipulator with least
computation time is preferable over others.
Though the CPU time difference for various architectures will look miniscule
here, there will be significant difference when the algorithms run on robot controllers
with processing speeds 30 to 60 times slower than the computer (Pentium III, 1Ghz
with 256 Mb memory) used here.
4. Illustration with Planar 2 -Link Robots
A planar two-degree of freedom (DOF) robot which has two links and two joints, is
suitable for planar positioning purposes. There are three options for such robot arm,
namely, two links are connected by 1) two prismatic joints; 2) two revolute joints;
and 3) one revolute and the other one prismatic joint. On the basis of proposed
criterion, i.e., simplicity, option 1 is best as its GIM can be easily shown to be
the 2 2 diagonal matrix with constant elements, whereas its MCI elements are
zeros. Even though this architecture is simplest from the control point of view, it is
not preferred from the physical realization angle. Prismatic joints can be realized
using nut and lead screw, which are expensive for higher accuracy and difficult to
maintain as dust can accumulate if proper bellows, etc. are not fitted. To overcome
the above drawbacks, revolute joints are used where the rotary actuators can be
coupled directly to the links without any nut, ball screw and bellows. This is option
2 which is economic from physical realization point of view but computationally,
i.e., in terms of the GIM complexity etc., it is most expensive. What left is option 3,
which is a kind of tradeoff between options 1 and 2. The criterion proposed in this
paper is effective for such situation when one has to choose the first joint as revolute
and the second one as prismatic (RP), Figure 3(a), or vice-versa, i.e., PR type,
Figure 3(b).
4.1.
On the basis of the planar computational complexities, Equations (17) and (18),
a planar robot with both revolute joints would require 88M, 63A (with n = 2).
However, if one of the joint is prismatic further simplification is expected. The
degree of the simplification would depend on the location of prismatic joint. The
results are tabulated in Table III.
4.2.
As explained in Section 3.3, inverse dynamics algorithms for RP and PR architectures shown in Figures 3(a), and 3(b), respectively using pre-determined joint
107
CC
GIM
12M 6A
21M 6A
MCI
26M 14A
28M 18A
0.651
0.761
a22 + 2a2 b1
ai = bi = a
(2a1 b2 + b22 )
4 a2
a1 + b2
a2 | cos 2 |
ai = bi = a
Max. a
Max. a
CT (sec)
Workspace
area A
Manipulability
w
( + 2)a2
All
trajectory values, i.e., joint position, velocity, and acceleration, are implemented in
MATLAB. The time taken to compute the joint torques/forces are obtained using
tic and toc commands of MATLAB at the beginning and end of an algorithm,
respectively. The joint trajectories and other parameters for inverse dynamics are
taken as:
For RP type:
1st link length, a1 = 0; 1st link mass, m1 = 12.25 kg;
2nd link mass, m2 = 2.45 kg;
(19)
(20)
108
4.3.
Workspace and manipulability are two kinematics based criteria often used for
robot architecture selection. Here, they are included to show whether an architecture would differ, if proposed dynamics model based selection criterion is used.
Workspace or work envelope is defined as the set of points representing the maximum and minimum extent or reach of the manipulator in all directions. It can
be calculated by visualizing the possible motion of the robot in all directions and
finding the area, in the case of planar, and volume, in the case of spatial [3, 11].
The workspace area for the PR type robot arm can be obtained from the motion
range of the robot, as shown in Figure 4. If no limit on the joints are assumed the
workspace area of PR arm in Figure 4 can be calculated as, A = pa22 + 2a2 b1 .
Similarly, for the RP type the workspace area is, A = (2a1 b2 + b22 ).
The values are tabulated in Table I and compared considering ai = bi = a
for i = 1, 2.
Manipulability is defined as the ease with which a manipulator operates in its
workspace. There are many ways to quantify the manipulability. For example,
condition number of the velocity Jacobian matrix, minimum or maximum singular
value of the Jacobian, etc. The one proposed by Yoshikawa [4] is used here. This
is called manipulability measure, w, and defined as
w = |[det{J()JT ()}]1/2 |
(21)
where J() is the Jacobian matrix, which is a function of joint positions, . For any
robot, w 0. However, the value of w = 0 is undesirable as it implies that the
robot arm is in the singular configuration, i.e., the arm cannot reach the instructed
position. When an arm is in singular configuration, it loses one or more degree of
freedom and becomes difficult to control.
Manipulability measure w for the RP and PR arms are calculated, which are
tabulated in Table III. As an illustration, w for the PR robot is computed as,
109
1
0
a2 sin 2
a2 cos 2
(22)
(23)
110
Table IV. D-H, mass and Inertia parameters of spatial robot arms.
Link
ai
(m)
i
(rad)
bi
(m)
i
(rad)
mi
(kg)
rx
ry
(m)
rz
Ix x
I yy
(kg-m2 )
Izz
b1
0.054
0.1
0.02
0.1
0.432
0.01
0.292
0.5
0.6
0.01
0.2
0.01
0.4
0.4
0.1
0.02
0.1
/2
0.1
0.1
0.1
0.02
0.1
0.1
/2
0.5
0.5
0.6
0.01
b3
0.4
0.4
0.4
0.1
MCI
C T (sec)
Workspace
Volume V
ai = bi = a
Manipulability
w
ai = bi = a
RTX Robot
Stanford Robot
142M; 138A
170M; 154A
389M; 317A
522M; 352A
9.443
11.166
4 b1 a2 a3
4 a33 /3
4 a3
4 a3 /3
a2 a3 | sin 3 |
b23 | cos 2 |
a2
a2
where i (0) = 0 and bi (0) = 0, while T = 10 sec with step size, t = 0.01 sec. Note
here that unlike the planar robot arm motion in horizontal plane, Figures 3(a)(b),
gravity plays an important role, which are taken into account.
For the above spatial arm configurations, proposed dynamics model simplicity
based criterion has been evaluated, along with the kinematics criteria. The results
are tabulated in Table V. Based on the results, RTX robot is found suitable and,
hence, should be selected. The better values are highlighted with underlines in the
table.
6. Conclusions
A robot arm selection methodology based on the simplicity of dynamics model of a
robot arm is proposed. The concept is illustrated with the help of 2-link planar robots.
Then a selection is made from two 3-link spatial robot arms. The proposed criterion
can be used when kinematic criteria are not sufficient or contradict, as explained
111
with respect to the 2-link example, after Equation (22). Also, in Table V, both RTX
and Stanford arms have same maximum manipulability, which is not a clear indication for the selection if the manipulability is the main criterion. The present criterion
is then also provides a way. The proposed criterion also allows to choose the best
physical parameters for good dynamic performances. For example, one can make
the generalized inertia matrix (GIM), Equations (9) and (10), well-conditioned,
as reported in Bhangale et al. [23], by suitably choosing the link masses and
lengths.
The contributions of this paper are highlighted as
1. Introduction of a new selection criterion, namely, the simplicity of the dynamics
model of a robot arm, which are evaluated in terms of computation complexity
of the associated matrices, i.e., GIM and the matrix of convective inertia (MCI)
terms of Equation (10), and the CPU time, of an algorithm, say, the inverse
dynamics algorithm that is essential for control purposes.
2. Computation complexity analysis of GIM and MCI for the all revolute ndegree of freedom robot. For the GIM, the proposed algorithm is efficient,
as indicated after Equation (14), whereas MCI calculation is never reported
earlier.
3. Modular inverse dynamics algorithms development, i.e., GIM and MCI, are
computed separately and the joint torques and forces are computed using Equation (9). This way, any robot architecture can be tested by just replacing the
blocks of GIM and MCI calculations.
4. Evaluation of total four criteria of two planar and two spatial robot arms for
comprehensive understanding and selection of robot arm architecture.
Appendix A: DenavitHartenberg (D-H) Parameters
D-H-parameter is a systematic, general method to define the relative position and
orientation of the consecutive link. This definition helps in computing the coordinate
transformation between them. D-H-parameters can be assigned differently to the
same system, the Figure 7 shows one of the popular method to define the parameters,
where Z i denotes the axis of joints and Oi and X i forms the coordinate
system.
Appendix B: Computational Complexities
B.1
TO FIND
Qi [ri ]i+1
The mass centre location vector ri is known in (i + 1)st frame and to convert it into
ith frame, we need to pre-multiply it with the rotation matrix, Qi , i.e.,
[ri ]i = Qi [ri ]i+1
112
Figure 6. Required torques and force at joints of RTX and Stanford arms.
where Qi is given as
cos i cos i
Qi sin i
0
sin i
rx
sin i sin i
113
Hence
r x cos i rc sin i
[ri ]i r x sin i + rc cos i
r y sin i r z cos i
where rc is given as
rc r y cos i r z sin i
: 6M 3A
: 2M1A
TO FIND
[Mi ]i
The mass matrix Mi is required to be found in the ith frame, i.e., [Mi ]i from
the known elements of [Iic ]i+1 , Qi , [di ]i , [m i di ]i , whose computational steps are
explained below:
Ici di (mi di 1) mi di 1
[Mi ]i
mi di 1
mi 1
Where [Iic ]i Qi [Iic ]i+1 , QiT , and Qi is defined as Equation (A.1). Now,
Qi [Iic ]i+1 , QiT can be computed as
i11 5
2 cos i + 3 sin i
i22 5 8
4 7 cos i
Sym
..
.
8 + i33
: 5M 7A
114
= i 12 cos i
= (i 11 i 12 ) sin i (0 + 0 )
= i 13 cos i + i 23 sin i
= 1 cos i + i 12
= i 13 sin i i 23 cos i
= 1 sin i
= 4 cos i
= [(i 22 i 33 ) + 5 ] sin i + (6 + 6 )
= 7 sin i
: 1M
: 1M3A
: 2M1A
:1M1A
: 2M1A
: 1M
: 1M
: 1M 4A
: 1M
So the total computations required are 16M 17A. Next, note that [mi di 1]i does
not require any computation as mi di is already obtained in item 4 of Section 3.2, i.e.,
[m i di 1]i
: nil
Now to compute [di (m i di 1]i , following steps are followed: Let us define
dx
[di ]i d y
dz
[m i di ]i y ,
z
and
where [di ]i and [m i di ]i are computed in items 3 and 4 of Section 3.2. Then
z dz y dy
Sym
: 6M 3A
x dy
z dz x dx
[di (m i di 1)]i =
x dz
y dz
y d y x dx
which will require only 6M 3A. Finally the 3 3 upper left block matrix of [Mi ]i ,
i.e., [Iic di (m i di 1)]i , can be obtained with additional 6A computations. Thus
total computations required to compute [Mi ]i is now summarized as:
[Ici ]i = Qi [Iic ]i+1 QiT
[mi di 1]i
[di (mi di 1)]i
[Ici di (mi di 1)]i
Total
:16M 17A
:nil
:6M 3A
:6A
:22M 26A
Thus, computation complexity for [Mi ]i is 22M 26A, which is used in item 5(a) in
Section 3.2.
115
References
1. Rivin, E.I., Mechanical Design of Robots, McGraw Hill Book Company, New York, 1988.
2. Dorf, R.C. and Nof, S.Y., (ed.), International Encyclopedia of Robotics, Applications and Automation, John Wiley & Sons, Inc., New York, 1988.
3. Ceccarelli, M. and Vinciguerra, A., On the workspace of general 4R manipulators, International
Journal of Robotics Research 14, 1995, 152160.
4. Yoshikawa, T., Foundations of Robotics Analysis and Control, Prentice-Hall of India Pvt. Ltd.,
New Delhi, 1998.
5. Gravagne, I.A. and Walker, I.D., Manipulability, force and compliance analysis for planar
continuun manipualtors, IEEE Transactions of Robotics and Automation 18, 2002, 263273.
6. Wen, J.T-Y. and Wilfinger, L.S., Kinematic manipulability of general constrained rigid multibody systems, IEEE Transactions on Robotics and Automation 15, 1999, 558567.
7. Angeles, J. and Lee, S.K., The formulation of dynamical equations of holonomic mechanical
systems using a natural orthogonal compliment, ASME Journal of Applied Mechanics 55, 1988,
243244.
8. Armstrong, W.W., Recursive solution to the equations of motion of an n-link manipulator,
Proceeding of 5th World Congress on Theory of Machines and Mechanisms (ASME), Vol. 9,
Montreal, Canada, 1979, 13431346.
9. Asada, H. and YoucefToumi, K., Direct Drive RobotsTheory and Practice, MIT Press,
Cambridge, USA, 1987.
10. Schiehlen, W.O., Multibody System Dynamics: Roots and Perspectives, Multibody System
Dynamics 1, 1997, 149188.
11. Fu, K.S. Gonzales, R.C. and Lee, C.S.G., Robotics: Control, Sensing, Vision, and Intelligence,
McGraw-Hill, Inc., NewYork, 1987.
12. Featherstone, R., Robot Dynamics Algorithms, Kluwer Academic Publishers, Massachusetts,
USA, 1987.
13. Angeles, J. and Ma, O., Dynamic simulation of n-axis serial robotic manipulators using a
natural orthogonal complement, The International Journal of Robotics Research 7, 1988,
3247.
14. Walker, M.W. and Orin, D.E., Efficient dynamic computer simulation of robotic mechanisms,
ASME Journal of Dynamical System, Measurement and Control, 104, 1982, 205211.
15. Wang, L.T. and Ravani, B., Recursive computations of kinematic and dynamic equations for
mechanical manipulators, IEEE Journal of Robotics and Automation RA-1, 1985, 124131.
16. Stokes, A. and Brockett, R., Dynamics of kinematic chains, International Journal of Robotics
Research 15, 1996, 393405.
17. Saha, S.K., Simulation of Industrial manipulators based on UDUT decomposition of inertia
matrix, Multibody System Dynamics 9, 2003, 63851.
18. Saha, S.K., Dynamics of serial multibody systems using the decoupled natural orthogonal
complement matrices, ASME Journal of Applied Mechanics 66, 1999, 986996.
19. Saha, S.K. and Schiehlen, W.O., Recursive kinematics and dynamics for closed loop multibody
systems, International Journal of Mechanics of Structures and Machines 29, 2001, 143175.
20. Denavit, J. and Hartenberg, R.S., A kinematic notation for lower-pair mechanisms based on
matrices, ASME Journal of Applied Mechanics 77, 1955, 215221.
21. Angeles, J., Fundamentals of Robotic Mechanical Systems, Springer-Verlag, Berlin, 1997.
22. Saha S.K. and Angeles, J., The formulation of kinematic constraints in design-oriented machine
dynamics, Advances in Design Automation ASME, Vol. 2, 1991, 115122.
23. Bhangale, P.P., Saha, S.K. and Agrawal, V.P., Concept of decoupled natural orthogonal complement (DeNOC) matrices for robot architecture selection, In Proceedings of National Conference
on Machines and Mechanisms (NACOMM), IIT Kharagpur, India, December 2122, 2001, 177
184.