Professional Documents
Culture Documents
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
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
110
follows.
90
J1
X = 1 _1 2 _2 T (1)
80
J2
70
lows. 50
0 5 10 15 20 25 30 35
= 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
350
530mm
340mm
100 100
50 50
x
0
x
-50 -50
-100 -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
351
0.15
m]
11[c
0.1
Case 3
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
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
Figure 12: Responses on conguration 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 conguration 2, the compliance cannot be changed nonlinear elastic link. Link E has a series of holes with
so much. In conguration 1, we measure the passive dierent 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 cong- 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: Denition of the experimental set thickness of halls are dierent, 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
Conguration 1 Case 1 Case 2 link, which clearly shows the nonlinear discrete elas-
Conguration 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
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 Stiness 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 specic 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