Professional Documents
Culture Documents
d d /2
m2 , I 2 φ
Fig. 3. Measurement of Velocity, Angular Velocity, and Direction of the l r m1 , I1
Ball : Snapshots of Image Processing
θ Slipless θ
point contact
II. E XPERIMENTAL S YSTEM τ rg1
L τ
Figure 2 shows the experimental system developed for
this study. To simplify the problem, throwing motion in the Fig. 4. Finger-link contact model Fig. 5. Fingertip contact model
horizontal plane is considered. The planar manipulator has
a single DOF swing-arm mechanism driven by a DC motor.
A plastic disk (hereafter called a ball). is used instead of Initial condition
(common)
a 3-dimensional ball. The friction between the ball and the fh
Finger-link
link is assumed high enough so that the ball rolls on the link l Contact Model
surface without slip because of anti-skid rubber attached on
f h< 0
the link. To eliminate the friction between the ball and the Release
floor an air table is used. Therefore, we assume that the
l >L
velocity, angular velocity, and direction never change after ff
Fingertip
the release. A search algorithm described later and pllied to Contact Model
the DC motor generates the torque command to the joint. ff < 0
The stopper attached to the link is used to set a constant
initial condition between the link and the disk. As shown Release
in Fig. 3, the velocity, angular velocity, and direction of the Fig. 6. Transition of the Condition of Contact
ball after the release from the link are measured by image
processing using a camera.
III. C ONTACT M ODEL BETWEEN ROBOT FINGER AND
BALL
τ M11 M12 θ̈ h1
A. Contact Models and Transition = + (1)
0 M21 M22 ℓ̈ h2
Two dynamic models are presented based on the condition
of contact between the ball and robot link: (1) the finger-
link contact model, and (2) the fingertip contact model. The 2
1 2
M11 = m1 rg1 + m2 r2 + d + rd1 + ℓ2 + I1 + I2
finger-link contact model shown in Fig. 4 represents the 4
dynamics where the ball and link keep a rolling contact (2a)
1 I2
condition. The fingertip contact model shown in Fig. 5 M12 = −m2 r− d − (2b)
2 r
represents the dynamics where the ball is in contact with
1
I2
an edge of the link (fingertip). M21 = −m2 r− d − (2c)
2 r
The relationship between the two contact models is illus- I2
M22 = m2 + (2d)
trated in Fig. 6. The finger-link contact model is initially r2
applied since the initial condition (see the most-left image h1 = 2m2 ℓθ̇ℓ̇ (2e)
2
h2 = −m2 ℓθ̇ (2f)
in Fig. 3) is given under this condition. The ball is released
from the link if the contact force fh acting on the ball from
the link becomes zero. In this paper we don’t discuss the
case where the link contacts again with a ball once released. where θ is the angle of the link joint, ℓ is the translational
If the ball rolls up along the surface of the link keeping displacement of the ball along the longitudinal direction of
a rolling contact, and reaches the end of the link, then the the link, and τ is the joint torque. m1 and m2 denote the
condition of contact transits to the fingertip contact model. masses, and I1 and I2 denote the moment of inertia of the
This transition is unidirectional and never goes back to the link and ball respectively. L is the length, and d is the width
finger-link contact model. Similarly, the ball is released from of the link. rg1 is the distance from the center of the joint
the fingertip if the contact force ff acting on the ball from to the center of gravity of the link. Assume that the shape
the link becomes zero. of the ball is a perfect circle where r is the radius.
When the ball is released directly from the finger-link
B. Dynamic Equation contact model without the transition to the fingertip model,
1) Finger-link contact model: The dynamic equation of three kinematic variables, i.e., the velocity v, angular velocity
the finger-link contact model is given as follows. ω, and direction db , of the ball are given as follows.
1656
The goal is to obtain joint torque commands that change
q
2 2 2 any one of the three kinematic variables of interest, but keep
v = ℓ˙r + ℓ2r θ˙r + r2 θ˙r − 2ℓ˙r rθ˙r (3a) the remaining one or two variables unchanged.
!
ℓr sin θr + d2 + r cos θr
db = arctan + π (3b) B. Joint Torque Command using Radial Basis Functions
ℓr cos θr − d2 + r sin θr
Radial Basis Functions (RBF) are applied to represent a
ℓ˙r time function of joint torque as follows.
ω = − θ˙r (3c)
r 4
X
where the variables with subscript r denote the quantities at τ (t) = wi Ψi (7)
the time of the release. i=1
2) Fingertip contact model: The dynamic equation for the where Ψi is a RBF defined by
fingertip contact model is given as follows.
1 2
Ψi = exp − 2 (t − ci ) . (8)
2σi
τ M11 M12 θ̈ h1
= + (4) In this paper, we consider joint torque from 0.0 [s] ∼
0 M21 M22 φ̈ h2
1.0 [s] given by the summation of 4 weighted RBFs. To
2 1 2 reduce the dimension of search space for generating joint
M11 = m1 rg1 + m2 (r 2 + d + rd1 sin φ (5a)
4 torque commands, c1 = 2/7, c2 = 3/7, c3 = 4/7, c4 = 5/7,
2
+ L + 2Lr cos θ) + I1 + I2
(5b) σ1 = 0.08, σ2 = 0.08, σ3 = 0.08, and σ4 = 0.08 are given in
1 advance. Therefore, only the weights, W = [w1 , w2 , w3 , w4 ],
M12 = m2 Lr cos φ + d sin φr + r 2 + I2 (5c)
2
are free parameters. Expansion of the search area by freeing
1
M21 = m2 Lr cos φ + d sin φr + r 2 + I2 (5d) the parameters currently fixed will be conducted in a future
2
M22 =
2
m2 r + I2 (5e)
paper.
h1 = m2 (dr cos φ − 2Lr sin φ) θ̇ φ̇ C. Preliminary Global Search and Simulated Annealing
1 2
+ m2
2
dr cos φ − Lr sin φ φ̇ First, a preliminary global search for W
(5f) =
1
[w 1 , w 2 , w3 , w4 ] is performed. The range of individual
h 2 = m2 r θ̇ 2
L sin φ − d cos φ (5g)
2 parameters is determined as 0.0 ≦ w1 ≦ 1.0,
−1.0 ≦ w2,3,4 ≦ 1.0 and the normal step size is set to
where φ is the angle of the center of the ball measured from 0.1. The step size is decreased to 0.01 for 0.0 ≦ w1 ≦ 0.1
the point of contact. When the ball is released from the and −0.1 ≦ w2,3,4 ≦ 0.1. The velocity, angular velocity,
fingertip contact model, the velocity, angular velocity, and and direction for each torque command is calculated
direction of the ball are given as follows. using MATLAB simulation and the result is plotted in a
3-dimensional graph as shown in Fig. 7 (a).
p Next, to find a torque command that realizes a particular
v = X2 + Y 2 (6a)
2 set of kinematic variables of the ball, a search algorithm
X = −L sin θr θ˙r − r sin (θr + φr ) θ˙r + φ˙r based on simulated annealing (SA) is applied using the
2
Y = L cos θr θ˙r + r cos (θr + φr ) θ˙r + φ˙r following criterion function.
!
L cos θr θ˙r + r cos (θr + φr ) θ˙r + φ˙r
db = arctan +π
−L cos θr θ˙r − r sin (θr + φr ) θ˙r + φ˙r J = Kv |vd − v| + Kd |dd − db | + Kω |ωd − ω| (9)
1657
TABLE I
C OMPARISON BETWEEN S IMULATION AND E XPERIMENT FOR T HROWS
Angular velocity[deg/s]
A–E
Velocity[m/s]
Velocity Direction Angular velocity
[m/s] [deg] [deg/s]
A Simulation 1.00 179.9 855.8
Velocity[m/s] Direction[deg]
Experiment 1.07 183.5 810.8
Direction[deg]
Error [%] 6.9 2.0 5.3
B Simulation 1.00 190.0 659.0
(a) Search Result (b) Velocity-Direction Experiment 0.94 191.4 611.9
Error [%] 6.1 0.7 7.1
C Simulation 1.00 200.0 672.9
Experiment 1.01 200.2 696.5
Angular velocity[deg/s]
Angular velocity[deg/s]
Error [%] 1.2 0.1 3.5
D Simulation 2.00 200.1 1385.8
Experiment 1.90 199.8 1330.3
Error [%] 4.8 0.1 4.0
E Simulation 3.00 200.0 1886.8
Experiment 2.59 200.8 1760.9
Direction[deg] Velocity[m/s]
Error [%] 13.8 0.4 6.7
(c) Angular velocity-Direction (d) Angular velocity-Velocity
Fig. 7. Result of Preliminary Global Search
Joint torques for Throws 1 to 6 shown in Figs. 10 to 12
have been obtained using the SA method. Table II shows
the obtained kinematic variables. As shown in the table, the
independent control in terms of the three kinematic variables
is considered feasible even though the range is small.
Velocity[m/s]
E
D
f
lo
Angular velocity [deg/s]
ro
A B C n t i on
Co rect
Di
Co
n
Ve trol o
loc
ity f
Direction[deg]
Angular velocity
Control of
Fig. 8. Independent control of Velocity and Direction
Velocity [m/ s]
Direction [deg]
Base point
1658
TABLE II
I NDEPENDENT C ONTROL OF T HREE K INEMATIC VARIABLES
Throw 4
Throw 3
(E XPERIMENT )
1659
Throw A
0.3
0.25
0.2
0.15
0.1
y(m)
0.05
Throw B
0
-0.05
-0.1
-0.15
-0.2
-0.5 -0.4 -0.3 -0.2 -0.1 0 0.1
x(m)
Throw C
(a) Simulation (b) Experiment
Fig. 13. Throw A
0.3
0.25
0.2
0.15 Fig. 18. Throwing in the same velocity, but in different directions: Throws
0.1
A to C
y(m)
0.05
Throw D Throw C
-0.05
-0.1
-0.15
-0.2
-0.5 -0.4 -0.3 -0.2 -0.1 0 0.1
x(m)
0.3
Throw E
0.25
0.2
0.15
0.1
y(m)
0.05
-0.05
-0.1
-0.15 Fig. 19. Throwing in the same direction, but in different velocities: Throws
-0.2
-0.5 -0.4 -0.3
x(m)
-0.2 -0.1 0 0.1 C to E
0.3
0.25
0.2
0.15
0.1
y(m)
0.05
Base
-0.05
-0.1
-0.15
-0.2
-0.5 -0.4 -0.3 -0.2 -0.1 0 0.1
x(m)
Throw 2
0.3
0.25
0.2
0.15
Fig. 20. Throwing in the same direction and angular velocity, but in
0.1
different velocities
y(m)
0.05
-0.05
-0.1
-0.15
-0.2
Brain Research, vol. 103, no. 2, pp. 277–286, 1995.
-0.5 -0.4 -0.3
x(m)
-0.2 -0.1 0 0.1
[10] Y. Nakamura and G. Oriolo, “Control of mechanical systems with
second-order nonholonomic constraints: Underactuated manipulators,”
(a) Simulation (b) Experiment Decision and Control, 1991.,Proceedings of the 30th IEEE Conference
Fig. 17. Throw E on, no. 3, pp. 2398–2403, 1991.
[11] M. W. Spong, “Bipedal locomotion, robot gymnastics, and robot
air hockey: A rapprochement,” Super-Mechano Systems (SMS’99)
Workshop, Tokyo, Japan, 1999.
1660
Throw 3
0.0[s] 0.1[s]
Base
0.2[s]
Throw 4
0.3[s]
Fig. 21. Throwing in the same velocity and angular velocity, but in different
0.4[s] 0.5[s]
directions
0.6[s]
Throw 5
0.7[s]
0.0[s]
Fig. 22. Throwing in the same velocity and direction, but in different
angular velocities
0.1[s]
0.2[s]
x
0.3[s]
0.4[s]
Fig. 23. Experimental System for Vertical Throwing
Fig. 25. Throwing in the Vertical Plane: Throw V 2
1661