Escolar Documentos
Profissional Documentos
Cultura Documentos
Abstract Gravity balancing of industrial robots is an impor- 6 DOF robot as an optimization problem [8]. They used the
tant issue because these robots may have massive links in order to link lengths and stiffness of the springs as design variables.
manipulate large payloads. In this paper, we present techniques Simionescu et al. used helical springs for static balancing of
to gravity balance the weight of moving links in industrial robots
with various arrangements of joints. In a typical industrial robot, a spatial rotating link ([9],[10]). The methods presented in
the rst joint axis is parallel to the gravity vector, hence, the these references were limited to a specic architecture of an
weight of the rst moving link does not have any effect on gravity industrial robot. Another approach to reduce the inertia of an
balancing of the robot. Our approach for gravity balancing of industrial robot is to introduce mechanical transmissions to put
industrial robots uses two steps: (i) we locate the center of mass the motors on the base. These transmission systems are gear
of distal segments of the robot using auxiliary parallelograms;
(ii) we connect springs between the center of mass and other trains, cables and pulleys and parallelogram linkages [11]. As
members in the robot such that the total potential energy of the an example, Fanuc S-900W robot has a four-bar linkage to
system is invariant with conguration. In this paper, we present transmit the motion of the third motor mounted on the waist
designs for gravity balancing of classes of industrial robots with to the third joint.
revolute and prismatic joints. In this paper, we present a method to balance classes
of industrial robots with anthropomorphic design, i.e., as a
I. I NTRODUCTION
concatenation of revolute (R), Prismatic (P) or spherical (S)
A machine is said to be gravity balanced if joint actuator joints in series. These robots comprise a trunk, a shoulder, and
inputs are not needed to keep the system in equilibrium at any an elbow. The wrist is considered as a lumped mass at the end
conguration of the machine. Gravity balancing of industrial of the robotic arm. We classify these robots into structures
robots is an important issue because these robots usually have shown in Table 1, while accounting for structures of most
massive links. Gravity balancing would potentially decrease industrial robots. We assume that the gravity vector is parallel
the required actuator efforts during motion. Over the years, a to the trunk axis of rotation. Hence, we characterize the robot
number of methods have been proposed for gravity balancing using the structure of second and higher joints. For example,
of machines and serial robots ([1], [2]) through clever designs the structures of Fanuc, Puma, Kuka, and Scorbot are of the
using counterweights, springs, and auxiliary parallelograms. Type (i). Research Robot has two legs, each with 7 DOF,
Some mathematical descriptions of gravity balanced machines and consists of a spherical joint at the shoulder, a revolute
are: (i) system center of mass remains inertially xed during joint at the elbow and a spherical joint at the wrist. As a
motion; (ii) potential energy remains invariant with congura- result, each leg of this robot can be considered as of Type
tion of the system; (iii) system has counter masses that balance (iii). Cartesian, cylindrical and SCARA robots are of Type
the machine in every conguration. These mathematical condi- (iv). Spherical robots can be classied as Type (v).
tions have been physically realized through clever engineering
such as: (a) Countermass on each body of the machine is used TABLE I
to inertially x the center of mass of the system ([3], [4]), (b) A RCHITECTURES OF SPATIAL INDUSTRIAL ROBOTS .
springs are used at appropriate places in the machine such
that the sum total of the gravitational potential energy and Type Trunk Shoulder Elbow Comment
spring potential energy becomes invariant with conguration (i): RR R R R Last two Rs are parallel
(ii): RRR R RR R Last two Rs are parallel
([4], [5] ), (c) auxiliary parallelograms based on knowledge of (iii): SR R S R Joint axes are not
geometry and inertia property are used to physically determine parallel or perpendicular
the center of mass of the machine [6]. (iv): PP R P P Two Ps are perpendicular
(v): RRP R R RP Last two Rs are parallel
In the literature, a number of methods have been proposed (vi): RRP R R RP Last two Rs are not parallel
for gravity balancing of industrial robots that include coun-
terweights [7] and springs ([8],[9],[10]). Diken proposed a
method to redistribute the mass of the manipulator links as In all these examples, the rst joint does not affect gravity
dynamically equivalent point masses at the joints and at the balancing of the robot, since its axis is parallel to the gravity
center of mass of link. Then, the gravity balancing of the new vector. Therefore, the rst link need not be considered in
model was achieved by adding countermasses [7]. Segla et al. the gravity balancing of the robot. Our approach to gravity
formulated the problem of gravity balancing of an industrial balancing is based on two steps: (i) locate the center of mass
2873
on an axis parallel to gravity vector, i.e., z0, passing through
O1 to compensate for the gravitational potential energy of the
system as shown in Fig. 2(a). The potential energy due to the
spring can be written as
1
Vs = krP C rP C . (5)
2
Here, rP C = rO1 C rO1 P , where rO1 P = h0z0 .
In this study, it is assumed that the undeformed length of
the spring is zero. In the physical implementation of zero free
length spring, a nonzero free length spring can be used with
a pulley, such that spring force is transmitted through a wire
[12].
Upon substitution of Eq. (2) into Eq. (5), one obtains Fig. 3. (a) A schematic of a PP robot, (b) Gravity balanced PP robot with
all springs
Vs = kh0 ($1z0 x2 + $2z0 z2 + $3 z0 x3) +
1
k($21 + $22 + $23 + h20 + 2$1 $3x2 x3 ). (6)
2
The total potential energy comprising gravitation and spring III. G RAVITY B ALANCING OF R OBOTS WITH P JOINTS
can be written using Eqs.(4) and (6) In this section, the gravity balancing of robots with prismatic
V = Vg + Vs joints is considered. First, we consider the robot with PP
architecture, i.e., Type (iv) of Table 1. Here, the rst joint axis
= (mg kh0 )($1z0 x2 + $2z0 z2 + $3 z0 x3) +
is along the gravity vector and the axes of two prismatic joints
1
k($21 + $22 + $23 + h20 + 2$1$3x2 x3 ). (7) are perpendicular. Next, we consider the RRP architecture,
2
namely, types (v) and (vi) of Table 1. Since we have shown
The rst term in the parenthesis in V is conguration de- in previous section that the rst joint does not affect gravity
pendent but vanishes when k = mg h0 . The only conguration balancing of the robot, we will not consider the rst joint in
variable term in V is Vvar = k$1 $3 x2 x3 . To compensate our gravity balancing of robots with prismatic joints.
for the conguration variable term Vvar , we add a spring with
stiffness k1 between the links along x2 and x3 axes shown in A. Type(iv): PP Architecture
Fig. 2(b). Here, d1 and d2 are the connection points of spring
Consider a PP robot as shown in Fig. 3(a). d2 and d3 are
k1. The total potential energy due to spring k1 and Vvar is
joint variables for links 2 and 3, respectively. m2 and l2 are
1
V = Vvar + k1 x21 (8) the mass and length of the moving part of link 2 and m3 is
2 the mass of link 3. The joint axis of the second link is along
1 2 2 z1 and parallel to gravity vector g = gz0 . The location of
= k$1$3 x2 x3 k1 d1d2 x2 x3 + k1(d1 + d2),
2 COM of two links is written as
where x1 is the extension of spring k1. V becomes congu-
ration invariant when k1 = k$ 1 $3 rOC = rOS + rSC = (d2 + $1)z1 + $2z2 , (9)
d1 d2 . Hence, the two-link robot
becomes gravity balanced by adding two springs k and k1 where $1 = m2 l2cm+m3 l2 and $2 = mm 3 l3c
with m = m2 + m3 .
shown in Fig. 2. Here, l2c is the COM of the moving part of link 2 from point
B. Balancing of Types (i), (ii) and (iii) Robots O1 and l3c is the COM of link 3 from point O2 which is a
The Type (i) of Table 1, namely, RR, is a special case of function of joint variable d3. Hence, $2 is a function of variable
the robots with two Rs explained in Section II-A where the d3. The potential energy of the robot due to the gravity can
two joint axes of Rs are parallel. Hence, it can be balanced be written as
using the same method described in Section II-A. Please note Vg = mg rOC = mg(d2 + $1 ). (10)
that the reference point O1 is at the shoulder for Type (i).
The Type (ii) of Table 1, i.e., RRR has an extra R at the The joint axis of the third link, i.e., z2 is perpendicular to the
shoulder compared to Type (i). Since our reference point for gravity vector. As a result, the second term in rOC , i.e., $2z2
gravity balancing is at the shoulder point O1, this extra R does does not have any contribution to the gravitational potential
not affect gravity balancing of the robot. energy. To compensate for the variable term in Vg , we add the
Finally, Type (iii) has spherical joint at the shoulder point following two springs k and k1 as shown in Fig. 3(b): (i) one
O1 instead of revolute joint in the robot with two Rs in spring k from point S to a point P . Point P is a xed point
Section II-A. The spherical joint at the reference point O1 located at an arbitrary distance h0 above the base. Please note
does not affect the gravity balancing of the robot. Therefore, that spring k is connected to point S instead of system COM
balancing procedure explained in Section II-A can be used for because rOS term in rOC affects the gravitational potential
Types (ii) and (iii) as well. energy, (ii) one spring k1 on the diagonal of a moving rhombus
2874
Fig. 4. (a) A cylindrical robot with RPP architecture. (b) A SCARA robot
with RRP architecture.
2875
potential energy V is written as
1
Vvar = k1($22 + 2$1$2c3 ). (23)
2
Fig. 6. A schematic of a similar triangle mechanism
We can add the following springs to compensate for the
variable terms in Vvar : (i) a spring k2 to take care of the
second term in Vvar , (ii) a second spring k3 on the diagonal
of a moving rhombus with side a and the other diagonal as
$2 to vanish the rst term of Vvar . These springs are shown
in Fig. 9(b).
The total potential energy of these two springs and Vvar is
1 1
V = k1($22 + 2$1 $2c3 ) + k2((l1 $1 )2 +
2 2
1
$2 2(l1 $1)$2 c3 ) + k3(4a2 $22).
2
(24)
2
Eq.(24) can be rewritten as
1
V = (k1 + k2 k3 )$22 + (k1$1 k2 (l1 $1 ))$2c3
2
Fig. 7. Location of COM of the RRP robot 1
+ k1$22 + 2k3a2. (25)
2
If we assume k2 = lk1 1$
$1
1
and k3 = k1 +k2, all conguration
variable terms in V vanish. As a result, the RRP robot is
where s2 and s23 stand for sin (2 ) and sin (2 + 3 ), respec- gravity balanced by using three springs. A spherical robot has
tively with 3 = 3 /2, as shown in Fig. 5.
We add a spring with stiffness k1 from robot COM, i.e.,
point C to point P vertically above point O1 along the gravity
vector shown in Fig. 9(a). The total potential energy due to
gravity and spring is given
V = Vg + Vk1 . (19)
1 2
Vk1 = k1 P C , (20)
2
where P C = O1 C O1P .
Upon substitution of O1P = h0y1 and Eq.(13) into Vk1 and Fig. 8. A spherical robot with RRP architecture.
simplifying, the result thus obtained is
1
Vk 1 = k1(h20 + $21 +
2
$22 2h0$1 s2 2h0$2s23 + 2$1$2c3 ). (21) RRP architecture as shown in Fig. 8. The rst revolute joint
axis is parallel to gravity vector. Hence, spherical robots are
Upon substitution of Eqs.(18) and (21) into Eq. (19), the total a subclass of RRP structure studied in this section.
2876
Fig. 9. (a) A schematic of the RRP robot with the attachment of spring k1
(b) Gravity balanced robot with all springs
2877