You are on page 1of 6

Proceedings of the 2001 IEEE

International Conference on Robotics & Automation


Seoul, Korea • May 21-26, 2001

Design of Programmable Passive Compliance Shoulder Mechanism


Masafumi OKADA1 , Yoshihiko NAKAMURA12 and Shigeki BAN1
1
Dept. of Mechano-Informatics, University of Tokyo
7-3-1 Hongo Bunkyo-ku Tokyo, 113-8656 Japan
2
CREST Program, Japan Science and Technology Corporation
e-mail : okada@ynl.t.u-tokyo.ac.jp

Abstract arm or some special joint mechanisms. This compli-


ance works e ectively in all frequency (both fast and
Design of mechanical compliance would be one of the slow responses) but its programmability is low. For
most important technical foci in making humanoid the safety issue, the passive compliance is important
robots really interactive with the humans. For safety because there are many humans in the environments
insurance the mechanical compliance should be devel- of the humanoid robots.
oped to humanoid robots. The introduction of the pas- Our research focuses on the `Skill of Compliance',
sive compliance to humanoid robots has large possibil- which means (1) tuning of passive compliance, (2)
ity to achieve the human skill by using the dynami- planning of swing pattern and (3) design of the control
cal energy stored in the compliant members. The pro- law. In the casting of shing, for example, the poten-
grammable passive compliance plays an important role tial energy is accumulated in the rod by taking the
to cope with the changing environments and task ex- swing and the large kinetic energy is obtained by dis-
ecution. In this paper, we evaluate the e ectiveness charging the potential energy in the instant to throw
of the passive compliance for the realization of the hu- the prickle farer. In this motion, the passive compli-
man skill and design a programmable passive compli- ance of the rod is tuned, the swing pattern of the rod
ance mechanism 'PPC cybernetic shoulder' which is and the force control of our arm are well designed.
the four degree of freedom shoulder mechanism for hu- So far, we have developed the cybernetic shoulder[7]
manoid robots using a closed kinematic chain. The that is the three degree-of-freedom mechanism for hu-
programmability of the PPC cybernetic shoulder is manoid robots. It has human-like motion and pas-
evaluated by experiments. sive compliance using the closed kinematic chain. In
Key Words : Skill of compliance, Prgrammable this paper, we design the programmable passive com-
passive compliance, The cybernetic shoulder, Hu- pliance mechanism for the cybernetic shoulder (Pro-
manoid robot grammable Passive Compliance Cybernetic Shoulder)
that is useful to lling up the low programmability
of the passive compliance, and obtain the compliance
1 Introduction ellipsoid[4] of this mechanism that is helpful to design
the swing up pattern. The programmability of the
Humanoid robots that share the space and environ- designed mechanism is evaluated by experiments.
ments with human should have compliance for human
friendliness, safety issue and relief of impacts. There
are two strategies to develop the robot compliance.
One is active compliance on which many researches
2 Passive Compliance
have been reported [1][6], the other is passive com- 2.1 Compliance, control law and swing
pliance. The active compliance is realized by actua-
tors. The compliance of robot joints is developed using
pattern
control theories such as impedance matching method. In this section, we show the skill of the passive com-
It has high programmability of compliance, however pliance. Consider the two links manipulator in the
cannot cope with fast responses because of the low horizontal plane shown in Fig.1. One joint is actuated
resolution of sensors, a long sampling time of con- and another is free joint that has passive compliance.
trol and noises of sensors. The passive compliance `i are the length of links (we set `1 = 0.3 [m], `2 =
means mechanical compliance of members of robot 0.5 [m]), si are the positions of the center of gravity of

0-7803-6475-9/01/$10.00 © 2001 IEEE


348
we get the optimal spring constant kopt which mini-
y mizes the following cost function J .
l2 2
X
I2
J= wi Ji (11)
i=1
θ2
J1 = max (_1 (t) (t)) (12)

s2
I1
l1 d2 t
J2 = max 1(v (t))
τ
s1
k x (13)
d1 t y
θ1
vy (t) = _1 `1 cos 1 + (_1 + _2 )`2 cos (1 + 2 ) (14)
Figure 1: Two links manipulator in the horizontal w1 = 1; w2 = 500 (15)
plane
J1 aims at reduction of the actuator power. J2 aims

links (= `i =2), Ii are the inertias of links, di are the co- 175

ecients of the viscosity of joints (d1 = 0.3 [Nms/rad],


d2 = 1.0 [Nms/rad]), i are the rotation angles of the
170

links, k is the spring constant of the passive joint and 165

 is the torque of the motor. 1 is controlled by PD

J
controller K as shown in Fig.2. P is the two links ma-
160

155

150

τ X
r+ 145
0 5 10 15 20 25 30 35

K P Spring Constant [Nm/rad]


Figure 3: Value of J versus spring constant k


θ1
130

Figure 2: Control system of the two links manipulator 120

110

nipulator, r is the reference signal for 1 and X is as


100
Ji

follows.
90
J1
 
X = 1 _1 2 _2 T (1)
80
J2
70

The dynamics of the two links manipulator is as fal- 60

lows. 50
0 5 10 15 20 25 30 35

M (2 ) + C (; )_ =U (2)


Spring Constant [Nm/rad]


 = 1 2
T
(3) Figure 4: Value of Ji versus spring constant k
 
M = a +b cos 2b cos 2 + c b cos 2 + c
2 + c c (4)
at maximizing the velocity of the end of the arm along
 
C = ;b cos 2 (2_12 + _22 )_2 b sin 2  _12 T (5) with y axis. Maximization of the velocity means that
  the two links manipulator can throw fastball. Though
U =  ; d1 _1 ;k2 ; d2 _2 T (6) the optimized spring constant depends on the motor
a = m1 s1 + m2 `1 + I1
2 2
(7) controller (control law) and reference signal in equa-
tion (10) (swing pattern), we optimize only the spring
b = m2 s2 `1 (8) constant (compliance) in one situation that xes con-
c = m2 s2 + I2
2
(9) trol law and swing pattern. The values of J and J1 ,
Setting the reference signal as J2 due to the spring constant k are shown in Fig.3, 4
respectively, which are given from the numerical sim-
r(t) = ; sin (2t); 0  t  1 (10) ulations. These gures show that the optimal spring

349
constant kopt is given as 3 Programmable Passive Com-
kopt = 2:15 (16) pliance (PPC) Cybernetic
and the maximum velocity is 6.19 [m/s]. These results Shoulder
show that by using the passive compliance, the two
links manipulator can throw the faster ball by small 3.1 Design and mechanism
consumption of the motor energy. We have designed the cybernetic shoulder[7] that is
the three DOF shoulder mechanism for humanoid
2.2 Programmable passive compliance robots. The passive compliance mechanisms using
mechanism closed kinematic chain have been developed. The
Because the optimal spring constant given in the pre- model of the cybernetic shoulder is shown in Fig.6.
vious section depends on the weight of links and tra-
jectory of the reference signal, the spring constant
should be changed adaptively, which is achieved by
the programmable passive compliance. Figure 5 shows
the example of the programmable passive compliance E F
mechanism using a closed kinematic chain. There D b
a
δ B
e β A
d
C C
C
B A B A

τ2 τ1 Figure 6: The cybernetic shoulder


Motor
and  are two degree of freedom gimbal mechanisms,
Figure 5: Programmable passive compliance mecha- d is a three degree of freedom ball joint, b is a two
nism degree of freedom universal joint, a is a four degree of
freedom joint of spherical and prismatic motion, and
e is a prismatic joint. Moving point A within vertical
are two redundant actuators. When the members plane alters the pointing direction of the main shaft
A and B have a nonlinear relationship between the G, which determines, along with the constraints due to
strain and stress, the compliance of the position C the free curved links E between points b and d, the di-
can be changed by giving tension to members A and rection of the normal vector of D. The rotation about
B . These types of PPC mechanisms have been devel- the normal of D is mainly determined by the rotation
oped [6, 8, 9]. The drawbacks of these mechanisms are of C through B and G. Note that the rotation of C
as follows. is coupled with the pointing direction of D when B
and D are not parallel. Based on this mechanism, we
Development of the multi-DOF mechanism design the PPC cybernetic shoulder shown in Fig.7.
If we develop the multi-degree of freedom mech- The advantages of this mechanism are as follows.
anism assembling the single degree of freedom
mechanism, it gets heavy weight and large vol- PPC mechanism We replace the prismatic joint e
ume. in Fig.6 with a linear actuator (4.5[W] DC motor
Control of redundant actuators The and ball screw) as shown in Fig.8. By changing
programmable passive compliance is realized by the length of L in L, the internal force is applied
two redundant actuators whose outputs should to members E , which causes the programmable
be exactly same. Otherwise the joint may rotate passive compliance when E have nonlinear rela-
or has an oscillation. tionship between strain and stress.
To overcome these problems, we develop the pro- Compactness and small backlash The universal
grammable passive compliance mechanism using a joints on the point b and d are replaced with elas-
closed kinematic chain. tic universal joints as shown in Fig.9. It has the

350
530mm

340mm

Figure 9: Elastic universal joint

100 100

50 50

x
0

x
-50 -50

-100 -100

Figure 7: The PPC cybernetic shoulder 0


50
100 0
-50
-100 0
50
100 0
-50
-100

z 150 50 y
z 150 50 y
200 100 200 100

100 100

50 50

0 0

x
DC Motor Ball screw -50 -50

-100 -100

E D 0
50
100 0
-50
-100 0
50 -50
-100

100 0
z 150 50 y z 150 50 y
200 100 200 100

G Figure 10: Compliance ellipsoid of the cybernetic


shoulder
L
of C ,
Figure 8: PPC mechanism
C = USV

T
  T
(18)
= 1 U    U n diag s 1    s n V
same structure as a exible coupling. This is for (19)
the compactness and the small backlash. the compliance ellipsoid is de ned in the n dimen-
Multi-DOF compliance Because the end disk D sional space whose axes are si Ui (i = 1; 2;    n). In
has a gimble mechanism on its center, the PPC this paper, we consider the two-dimensional compli-
cybernetic shoulder has two degree of freedom ance ellipsoid of the cybernetic shoulder. Figure 10
compliance around the rotation axis of the gim- shows the compliance ellipsoid in accordance with the
ble mechanism. Because the center rod G is rigid, motion of the cybernetic shoulder. These ellipsoids
the PPC cybernetic shoulder has high sti ness for are calculated in each orientation using equation (19).
any other degree of freedom of compliance.
3.3 Evaluation of the programmability
3.2 Compliance ellipsoid of the cyber- Each occasion is de ned as Table 1. In this section,
netic shoulder we evaluate the programmability of the passive com-
The compliance ellipsoid [4] is helpful for the founda- pliance on PPC cybernetic shoulder. We set two con-
tion of the swing pattern and motor control law. gurations of the PPC cybernetic shoulder as shown
Consider the compliance matrix C de ned as in Fig.11. By cutting the 500[g] weight hung from
the end of the arm, the external force is applied. The
C = JK ;1 J T (17) torque of the external force becomes 0.539 [Nm]. Two
cases are adopted on each con guration, in one case
Here, J is the jacobian matrix and K is the spring con- L = 0 [mm], in another case L = {3 [mm]. The
stant matrix. Using the singular value decomposition responses of each case are shown in Fig.12 and 13.

351
0.15
m]
11[c
0.1
Case 3

Rotation Angle [rad]


Case 4
0.05

60[degree] 0

500[g]
-0.05

Configration 1 Configration 2
-0.1
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6

Figure 11: Con gurations of the PPC cybernetic


Time [sec]

shoulder Figure 13: Responses on con guration 2

0.15
0.24

Compliance [rad/Nm]
0.1 Case 1 0.22

Case 2
Rotation Angle [rad]

0.2
0.05
0.18

0 0.16

-3 -2 -1 0 1 2 3
Length of L [mm]
-0.05

-0.1 Figure 14: PPC due to L


0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6
Time [sec]

Figure 12: Responses on con guration 1 The elastic universal joints have high compliance for
yaw and pitch direction but have low compliance on
thrust direction, that yield the passive compliance of
In this prototype, the members E are rigid but joints the PPC cybernetic shoulder. The more dominant
(elastic joints) have compliance. The passive compli- the thrust compliance becomes, the lower the passive
ance of this mechanism is caused by the joint compli- compliance of the PPC cybernetic shoulder becomes.
ance. The compliance on each case is as follows which
is calculated from the rotation angle in time zero. 3.4 Design of elastic members
Case 1 : 0:202 [rad/Nm] The programmable passive compliance in the previ-
Case 2 : 0:237 [rad/Nm] ous section was realized adopting the elastic universal
Case 3 : 0:156 [rad/Nm] joint in Fig.9. In this section, we design the nonlinear
Case 4 : 0:170 [rad/Nm] elasticity as a property of link E in Fig.8.
Figures 15 and 16 illustrate the idea and design of
In con guration 2, the compliance cannot be changed nonlinear elastic link. Link E has a series of holes with
so much. In con guration 1, we measure the passive di erent diameters and small cuts. As seen in Fig.16,
compliance by small resolution of changing L. Fig- the largest hole has the minimum thickness and, there-
ure 14 shows the compliance due to L in the con g- fore, bends rst when bending moment is applied until
uration 1. The shorter L yields the higher compliance. the cut C -shaped hole deforms and becomes closed. If
the bending moment exceeds, it further deforms the
second largest C -shaped hole and so on. Since the
Table 1: De nition of the experimental set thickness of halls are di erent, the elastic coecient
of link E changes in a discrete manner. Figure 17
L = 0 [mm] L = -3 [mm] shows the result of measurements of the fabricated
Con guration 1 Case 1 Case 2 link, which clearly shows the nonlinear discrete elas-
Con guration 2 Case 3 Case 4 ticity. The spring constant in each area is as Table 2.
The diameters, thickness, and width of cut would need

352
Table 2: Tunable spring constant
Area Spring constant [N/m]
A 4:009  103
135
B 6:203  103
C 6:303  103

2. We design the programmable passive compliance


cybernetic shoulder which is the shoulder mecha-
nism for humanoid robots.
Figure 15: Elastic link 3. The programmable passive compliance cybernetic
shoulder has high programmability of the passive
compliance by using the elastic joint and elastic
minimum thickness
minimum thickness link.
This research is supported by the Research for the
Future Program, the Japan Society for the Promotion
of Science (Project No. JSPS-RFTF96P00801).
Figure 16: Change of the spring constant References
[1] R.P.C.Paul and B.Shimano:Compliance and Control,
Proc. of the 1976 Joint Automatic Control Confer-
0.016
A B C

ence, pp.694{699, 1976.


0.014

[2] H.Hanafusa and H.Asada:Stable Pretension by a


0.012

Robot Hand with Elastic Fingers, Proc. of the 7th In-


Change of length [m]

0.01

0.008
ternational Symposium on Industrial Robots, pp.361{
0.006
368, 1977.
0.004
[3] N.Hogan:Mechanical Impedance Control in Assistive
0.002
Devices and Manipulators, Proc. of the 1980 Joint
0
0 10 20 30 40 50 60 70 80 90 Automatic Control Conference, pp.TA10-B, 1980.
[4] J.K.Salisbury:Active Sti ness Control of a Manip-
Applied Force [N]

Figure 17: Applied force and change of length ulator in Cartesian Coordinates, Proc. of the IEEE
Conference on Decision and Control, 1980.
[5] N.Hogan:Impedance Control: An Approach to Ma-
nipulation: Part 13, ASME Journal of Dynamic
more careful design using FEM numerical analysis if Systems, Measurement and Control, Vol.107, pp.1{
it requires a speci c shape of elastic curve. 24, 1985.
The redundant actuator of "DC Motor" in Fig.8 [6] K.F.L-Kovitz, J.E.Colgate and S.D.R.Carnes: Design
determines length L. When it shortens, it is accom- of Components for Programmable Passive Impedance,
panied by the bends of three of link E , which deter- Proc. of IEEE International Conference on Robotics
mines the mechanical compliance of the PPC cyber- and Automation, pp.1476{1481, 1991.
netic shoulder mechanism. [7] M.Okada and Y.Nakamura: Development of the
Cybernetic Shoulder { A Three DOF Mechanism
that Imitates Biological Shoulder-Motion {, Proc.
4 Conclusions of IEEE/RSJ International Conference on Intelligent
Robots and Systems , Vol.2, pp.543-548 (1999)
In this paper, we discuss on the skill of compliance, [8] T.Morita and S.Sugano: Design and Development of
which is tuning of the passive compliance, planning of a new Robot Joint using a Mechanical Impedance
the swing pattern and design of the control law, and Adjuster, Proc. of IEEE International Conference on
design the programmable passove compliance cyber- Robotics and Automation, pp.2469-2475 (1995)
netic shoulder. The results are as follows. [9] H.Kobayashi, K.Hyodo and D.Ogane: On Tendon-
1. By using the passive compliance mechanism, Driven Robotic Mechanism with Redundant Tendons,
robots can throw a ball faster by small actuator Int. J. of Robotics Research, Vol.17, No.5, pp.561-571
(1998)
power.

353

You might also like