Professional Documents
Culture Documents
I. I NTRODUCTION
future work that would be included in the final report and some
interesting work that can be possibly done on continuing the
project.
II. 5 DOF P ING -P ONG ROBOT
A. Physical Design
The robot of interest has 5 degrees of freedom. Physically
the robot has a base that can rotate in the XY plane between
and , three links in series with the lower attached to
the base with a revolute joint that can rotate along the x-axis,
a ping-pong racket that is attached to the final link that can
rotate between and . Thus having 5 DOF. Figure 4 shows
the home configuration of the robot.
A simulator, more of a GUI, has been developed in MATLAB which allows to insert end configuration of the robot by
changing the slider position corresponding to 1, 2, 3, 4
and 5 or by manually entering their values in the provided
editable boxes. The robot is moved from its initial to end
configuration and is shown as an animation. Figure 5 shows
a possible end configuration generated from the simulation.
Figure 6 shows the complete GUI with angle values manually
set and another possible end configuration of the robot.
(1)
0
1 = 5 = 0
1
1
2 = 3 = 4 = 0
0
e1 1 e2 2 e3 3 e4 4 e5 5 =
c1 c5 c234 s1 s5 c1 s5 c234 s1 c5
s1 c5 + c234 c1 s5 s1 s5 + c234 c1 c5
s234 s5
s234 c5
0
0
0
0
0
0
q1 = 0 q2 = 0 q3 =
0
l0
l0 + l1
0
0
q5 =
0
0
q4 =
l0 + l1 + l2
l0 + l1 + l2 + l3
The individual exponential terms can be evaluated as,
cos 1 sin 1 0 0
sin 1
cos 1 0 0
e 1 1 =
0
0
1 0
0
0
0 1
1
0
0
0
0 cos 2 sin 2
l0 sin 2
e2 2 =
0 sin 2
cos 2 l0 (1 cos 2 )
0
0
0
1
1
0
0
0
0 cos 3 sin 3
(l0 + l1 ) sin 3
e3 3 =
0 sin 3
cos 3 (l0 + l1 )(1 cos 3 )
0
0
0
1
1
0
0
0
0 cos 4 sin 4
(l l3 ) sin 4
e4 4 =
0 sin 4
cos 4 (l l3 )(1 cos 4 )
0
0
0
1
where l = l0 + l1 + l2 + l3
cos 5
sin 5
e5 5 =
0
0
sin 5
cos 5
0
0
0 0
0 0
1 0
0 1
c1 c5 c234 s1 s5 c1 s5 c234 s1 c5
s1 c5 + c234 c1 s5 s1 s5 + c234 c1 c5
gst () =
s234 s5
s234 c5
0
0
s1 s234
s234 c1
c234
0
p1
p2
p3
1
(2)
r1
r2
r3
1
1 0 0
0
0 1 0
0
1
Vsts = g st gst
s1 s234
s234 c1
c234
0
If V =
v3X1
3X1
1
Vstb = gst
g st
3X3 v3X1
then V =
0
0
(4)
and
is the skew symmetric representation of
R3X3 p3X1
Given g =
, as R is a member of SO(3)
0
1
T
R3X3 RT p3X1
we have R1 = RT and hence g 1 =
0
1
Therefore,
a11
a21
1
gst () =
a31
0
a12
a22
a32
0
a13
a23
a33
0
a14
a24
a34
1
= c1 c5 c234 s1 s5
= s1 c5 + c234 c1 s5
= s5 s234
= s5 (l0 s234 + l1 s34 + l2 s4 )
= c1 s5 c234 s1 c5
= s1 s5 + c234 c1 c5
= c5 s234
= c5 (l0 s234 + l1 s34 + l2 s4 )
= s1 s234
= c1 s234
= c234
= (l0 c234 + l1 c34 + l2 c4 + l3 )
and, g st () =
r31 r32 r33 r34
0
0
0
0
r11 = s1 c5 1 c1 s5 5 c234 c1 s5 1 c234 s1 c5 5
s234 s1 s5 (2 + 3 + 4 )
r12 = s1 s5 1 c1 c5 5 c234 c1 c5 1 + c234 s1 s5 5
s234 s1 c5 (2 + 3 + 4 )
r13 = s1 c234 (2 + 3 + 4 ) + c1 s234 1
r14 = c1 (l1 s2 + l2 s23 + l3 s234 )1 + s1 (l1 c2 2 + l2 c23 (2
3 ) + l3 c234 (2 + 3 + 4 ))
r21 = c1 c5 1 s1 s5 5 + c234 c1 c5 5 c234 s1 s5 1
s234 c1 s5 (2 + 3 + 4 )
r22 = c1 s5 1 s1 c5 5 c234 s1 c5 1 c234 c1 s5 5
s234 c1 c5 (2 + 3 + 4 )
r23 = s234 s1 1 c234 c1 (2 + 3 + 4 )
r24 = s1 (l1 s2 + l2 s23 + l3 s234 )1 c1 (l1 c2 2 + l2 c23 (2
3 ) + l3 c234 (2 + 3 + 4 ))
r31 = c234 s5 (2 + 3 + 4 ) + s234 c5 5
r32 = c234 c5 (2 + 3 + 4 ) s234 s5 5
r33 = s234 (2 + 3 + 4 )
r34 = (l1 s2 2 + l2 s23 (2 + 3 ) + l3 s234 (2 + 3 + 4 ))
a11
a12
a13
a14
a21
a22
a23
a24
a31
a32
a33
a34
Substituting g st and
1
gst
Vsts =
+
+
in equation 3
3X3
0
v3X1
0
v3 = l2 s23 4 + l1 s2 (3 + 4 )
v3X1
s
Vst =
3X1
(6)
(5)
where,
0
3 2
0
1
= 3
2 1
0
1 = c1 (2 + 3 + 4 ) + s234 s1 5
2 = s1 (2 + 3 + 4 ) s234 c1 5
3 = 1 + c234 5
1
v1
= 2 v = v2
3
v3
v1 = c1 5 (l2 s4 +l1 s34 +l0 s234 )s1 (l2 c23 4 +l1 c2 (3 + 4 )+
l0 (2 + 3 + 4 ))
v2 = s1 5 (l2 s4 +l1 s34 +l0 s234 )+c1 (l2 c23 4 +l1 c2 (3 + 4 )+
l0 (2 + 3 + 4 ))
R EFERENCES
[1] Acosta, Leopoldo, et al. Ping-pong player prototype. Robotics &
Automation Magazine, IEEE 10.4 (2003): 44-52.
[2] Li, Hailing, et al. Ping-pong robotics with high-speed vision system.
Control Automation Robotics & Vision (ICARCV), 2012 12th International Conference on. IEEE, 2012.
[3] [Book] Richard M. Murray, Zexiang Li, S. Shankar Sastry. A Mathematical Introduction to Robotic Manipulation
[4] [web link] for KUKA vs Timo Boll
http://spectrum.ieee.org/automaton/robotics/industrial-robots/robotsplaying-ping-pong-whats-real-and-whats-not