Download as pdf or txt
Download as pdf or txt
You are on page 1of 16

UNIVERSITY OF SOUTHAMPTON ELEC3201W1

SEMESTER 1 EXAMINATION 2020 - 2021

ROBOTIC SYSTEMS

DURATION 1440 MINS (24 Hours)

s
This paper contains 4 questions

Answer All questions

er
An outline marking scheme is shown in brackets to the right of each ques-
sw
tion.

This examination contributes 100% of the marks for the module.

This version of the exam paper has been prepared with student revi-
sion for the kinematics topicin mind. Answers are given to the kine-
An

matics questions only

Please note the solutions are indicative of what would be expected

A foreign language dictionary is permitted ONLY IF it is a paper version


of a direct Word to Word translation dictionary AND it contains no notes,
additions or annotations.

16 page examination paper.

Copyright 2021 c University of Southampton Page 1 of 16


ELEC3201W1

Question 1.

(a) The Denavit Hartenberg (DH) Method is a commonly used approach for
obtaining the forward kinematic equations of robot manipulators. Which
statement(s) is/are correct?

(i) The homogenous transformation matrix derived using the DH Method


is unique

s
(ii) The DH Method uses left-hand coordinate frames

(iii) The DH Method is not applicable to manipulators with only prismatic


joints

er
(iv) In the DH Method, only two axes need to be chosen for every joint.

[2 marks]

(b) Give two reasons why it is beneficial to derive a robot’s forward kinematic
sw
equations using the DH Method.
[2 marks]

(c) In the DH Method, the coordinate frame F0 is attached to the first joint.
What does the frame F1 represent? What do frames F2 , F3 , and so on,
represent (if present)?
[2 marks]
An

(d) Figure 1 depicts two joints of a robot manipulator. The coordinate frame
attached to the first joint is shown, along with three different possible
coordinate frames for the second joint. In the DH Method, which of
these coordinate frames are valid? Which is preferable?
[2 marks]

(e) Consider the diagram of the robot manipulator in Figure 2

(i) Determine the DH parameters of this manipulator, tabulate them,


and deduce three homogenous transformation matrices associated
with each joint. Marks will be awarded for the accuracy and clarity
of your working.
[6 marks]

Copyright 2021 c University of Southampton Page 2 of 16


ELEC3201W1

s
er Joint 1 Joint 2
sw
F IGURE 1: Robot joints with possible reference frames
An

Joint 2

Joint 1

Joint 3

F IGURE 2: Robotic manipulator with three joints, with joint variables θ1 , d2 and θ3 .

TURN OVER
Copyright 2021 c University of Southampton Page 3 of 16
ELEC3201W1

(ii) Use these matrices to derive the homogenous transformation matrix


from base frame to end-effector. Marks will only be awarded for an
accurate expression and clear working.
[2 marks]
(iii) In the final homogenous transformation matrix, identify the rotation
matrix and the vector describing the (x, y, z) positions of the end
effector with respect to the base. Deduce the orientation of the end-
effector w.r.t. the base frame using the Euler angle convention.

s
[2 marks]
(iv) With this robot is it possible to independently control the (x, y) posi-

er
tions? Explain your answer.
[2 marks]

(f) The forward kinematics of an experimental robot are described by the


equation    
sw
x1 l1 cos q1 + l2 cos q1 cos q2
x2  =  l1 sin q1 + l2 sin q1 cos q2 
x3 q3 − l2 sin q2
where qi are the joint variables, xi are the end-effector positions and li
the link lengths. Derive an equation describing the inverse kinematics of
the robot. Marks will be awarded for the accuracy and succinctness of
the final expression.
An

[5 marks]

Copyright 2021 c University of Southampton Page 4 of 16


ELEC3201W1

Indicative Solution for Question 1.

(a) The only statement which is correct is d) - only two axes (the z and the x axis need choosing, the y is
then determined since the coordinate frame is right-handed).

(b) Two reasons are:

• The DH method gives a systematic approach, which is useful for complex robotic systems
• It enables roboticists to communicate and exchange ideas in a common framework

s
(other answers also acceptable)

(c) The frame F1 represents the movement of link 1 with respect to the base frame. More generally, the
frame Fi represents the movement of link i with respect to link i − 1.

er
(d) In the Figure, the reference frame represented by the axes F1a = (x1a , y1a , z1a ) and
F1a = (x1b , y1b , z1b ) would both be equally valid choices of reference frame when applying the DH
method. Reference frame F1c = (x1c , y1c , z1c ) does not represent a valid frame since, although x1c
and z1c are oriented correctly, y1c does not enable a right-handed-reference frame to be formed
(re-orienting this axis would correct this). In practice, one would probably choose reference frame
F1b since the x-axes are coincident and hence there would not be an extra term (d) representing the
offset between the two axes in the DH equations.
sw
(e)

(i) The first part of the solution is to choose the z-axes and then one assigns reference frames to
each of these axes. Since F0 and FE have already been given, only two frames need to be
determined. Possible (but not unique) choices are shown below. Once the reference frames
have been chosen, the DH parameters can be deduced by inspection and tabulated

i θi di ai αi
1 θ1∗ −l1 l2 0
2 0 −d∗2 0 0
An

3 θ3∗ −l3 0 π

These DH parameters can then be used to find the homogenous transformation matrices as

 
cos θ1 − sin θ1 0 l2 cos θ1
0
 sin θ1 cos θ1 0 l2 sin θ1 
1T =  (1)
 
0 0 1 −l1 
0 0 0 1
 
1 0 0 0
1
 0 1 0 0 
2T =  0 0 (2)
 
1 −d2 
0 0 0 1
 
cos θ3 − sin θ3 0 0
2  sin θ3 cos θ3 0 0 

ET =  (3)

0 0 −1 −l3 
0 0 0 1

(different answers will result, depending on the choice of axes)

TURN OVER
Copyright 2021 c University of Southampton Page 5 of 16
ELEC3201W1

Joint 2

s
Joint 1

er
Joint 3
sw
F IGURE 3: Robotic manipulator with three joints, with joint variables θ1 , d2 and θ3 .

(ii) The homogenous transformation matrix representing the end-effector position w.r.t base is
then given by
0
ET =01 T 1 2
2T E T
   
cos θ1 − sin θ1 0 l2 cos θ1 1 0 0 0 cos θ3 − sin θ3 0 0
 sin θ1 cos θ1 0 l2 sin θ1  0 1 0 0   sin θ3 cos θ3 0 0 
=   
 0 0 1 −l1  0 0 1−d2   0 0 −1 −l3 
0 0 0 1 0 0 0 1 0 0 0 1
An

 
cos(θ1 + θ3 ) − sin(θ1 + θ3 ) 0 l2 cos θ1
 sin(θ1 + θ3 ) cos(θ1 + θ3 ) 0 l2 sin θ1 
= 
 0 0 −1 −(l1 + l3 + d2 ) 
0 0 0 1

(some trigonometric identities have been used)

(iii) The rotation matrix is easily identified as


 
cos(θ1 + θ3 ) − sin(θ1 + θ3 ) 0
0
E R = sin(θ1 + θ3 ) cos(θ1 + θ3 ) 0

0 0 −1

and the (x, y, z ) positions as  


l2 cos θ1
 l2 sin θ1 
−(l1 + l3 + d2 )
From the rotation matrix it is easy to see that the (yaw) orientation of the end effector will be
θ1 + θ3 radians around the z0 axis, and that the pitch of the manipulator will be π radians around
the y0 axis. This agrees with what can be expected intuitively.

Copyright 2021 c University of Southampton Page 6 of 16


ELEC3201W1

(iv) Independent control over the (x, y) positions is not possible with this robot since

px = l2 cos θ1 py = l2 sin θ1

Since, we can only control θ1 we can only control either px or py .

(f)

Note that the first two equations can be written as

px = (l1 + l2 cos q2 ) cos q1


py = (l1 + l2 cos q2 ) sin q1

s
Therefore
q1 = arctan(py /px )
This is the first of the IK equations. Note that the above two equations can also be squared and

er
added to get
p2x + p2y = (l1 + l2 cos q2 )2
which implies
q 
p2x + p2y − l1
q2 = arccos  
l2

which is the second of the IK equations. Finally, noting that


sw
p
sin(arccos(x)) = 1 − x2

we have, from the third element of the equation in the question

q3 = x3 + l2 sin q2
v q
u
u
t p2x + p2y + l12 − 2l1 p2x + p2y
= x3 + l2 1 −
l22
r q
= x3 + l22 − l12 − p2x − p2y + 2l1 p2x + p2y
An

which is the third element of the IK equation.

TURN OVER
Copyright 2021 c University of Southampton Page 7 of 16
ELEC3201W1

[25 marks]

s
er
sw
An

Copyright 2021 c University of Southampton Page 8 of 16


ELEC3201W1

Question 2.

(a) Why would an engineer use the joint-space for trajectory planning? Ex-
plain your answer.
[2 marks]
(b) A robot has six joints and is required to move from a certain initial po-
sition to a final position, while passing through 5 intermediate points.
Assuming cubic splines are to be used to generate the trajectory, calcu-

s
late how many parameters will need to be calculated to enable this.
[1 mark]

er
(c) A robot is given a repetitive task to perform and a trajectory for a single
joint needs to be generated. The starting position of the joint is θ(0) =
45◦ and the starting velocity is θ̇(0) = 0. The end-point and velocity is
identical to that at the start. The robot must pass through a way point of
θ(tw ) = 90◦ with continuous velocity and acceleration of the joint. The
time to execute the task is 6 seconds with the way point to be reached
sw
at 3 seconds.

(i) Set up a matrix equation which needs to be solved for the parame-
ters of the cubic functions. Marks will be awarded for accuracy and
clarity. You do not need to solve the equation.
[5 marks]
(ii) Could a “smaller” matrix equation be solved instead? Explain your
An

answer.
[1 marks]
(iii) Assume now that the robot joint should stop at the way-point and not
travel to the end-point. An engineer wants to check the maximum
joint velocity over this portion of the trajectory. Derive the time of
interest which s/he should check.
[4 marks]

(d) The forward kinematics of a robotic manipulator are given by


   
px d1 cos θ2 cos θ3
py  =  d1 cos θ2 sin θ3 
pz −d1 sin θ2
TURN OVER
Copyright 2021 c University of Southampton Page 9 of 16
ELEC3201W1

where the joint positions are d1 , θ2 and θ3 . Calculate the analytic Jaco-
bian of this manipulator and identify any limitations in mobility
[4 marks]
(e) A roboticist is developing a new mobile robot and needs to choose ac-
tuators and sensors for the system.

(i) Compare and contrast hydraulic and electric actuators. Give rea-
sons why each may be suitable for the system under consideration.

s
[4 marks]
(ii) The mobile robot features a manipulator with a gripper at the end.

er
The gripper needs to carry delicate objects. Explain the sensing
capabilities such a gripper would ideally be equipped with.
[4 marks]
sw
An

Copyright 2021 c University of Southampton Page 10 of 16


ELEC3201W1

Indicative Solution for Question 2.

(a) Planning of trajectories in the task space involves choosing the end effector path directly in task
space and then determining the joint positions via inverse kinematics at each time-step. Planning of
trajectories in joint space involves choosing the start, end and possibly intermediate points in task
space. The joint positions corresponding to these points are then determined, but the trajectory of
the joints, from one point to another, is chosen in joint space. The advantages of task-space
trajectory planning is that more control over end-effector position is attained, but the drawback is
that the inverse kinematic equations have to be solved at each time instant to generate the
trajectories in joint space. Joint space removes these computational problems, but less control over
the end effector position is the drawback.

s
(Other answers possible)

(b) In total there are seven points, so 6 cubic functions are needed. Each cubic function has four
parameters to determine, so 24 parameters per joint and hence 6 × 24 = 144 parameters in total.

(c)

er
(i) First assign the two cubic polynomials, the first for the portion of the trajectory between
t ∈ [0, tw ] and the second for t ∈ [tw , tf ]:-

θ(t) = a10 + a11 t + a12 t2 + a13 t3


θ(t) = a20 + a21 (t − tw ) + a22 (t − t2 )2 + a23 (t − tw )3
sw
Joint velocity is then given by

θ̇(t) = a11 + 2a12 t + 3a13 t2


θ̇(t) = a21 + 2a22 (t − t2 ) + 3a23 (t − tw )2

and acceleration by

θ̈(t) = 2a12 + 6a13 t


θ̈(t) = 2a22 + 6a23 (t − tw )
An

Using the information about the start position and velocity - t = 0 - we have

45 = a10 (4)
0 = a11 (5)

Similarly using information about the finish position and velocity - t = tf - we have

45 = a20 + a21 (tf − tw ) + a22 (tf − t2 )2 + a23 (tf − tw )3 (6)


2
0 = a21 + 2a22 (tf − t2 ) + 3a23 (tf − tw ) (7)

Next, at t = tw we know that θ(tf ) = 90; thus we have

90 = a10 + a11 tw + a12 t2w + a13 t3w (8)


90 = a20 (9)

Finally, because velocity and acceleration are continuous at the way point we have

a11 + 2a12 tw + 3a13 t2w = a21 (10)


2a12 + 6a13 tw = 2a22 (11)

TURN OVER
Copyright 2021 c University of Southampton Page 11 of 16
ELEC3201W1

Noting that tf = 6 and tw = 3 we can stack equations (4)-(11) in matrix-vector form as


    
45 1 0 0 0 0 0 0 0 a10
 0  0 1 0 0 0 0 0 0 a11 
    
45 0 0 0 0 1 3 9 27 a12 
 
  
 0  0 0 0 0 0 1 6 27 a13 
 
 = (12)
90 1 3 9 27 0 0 0 0  a20 
 
   
90 1 0 0 0 0 0 0 0 a21 
 
  
 0  0 1 6 27 0 −1 0 0  a22 
0 0 0 2 18 0 0 −2 0 a23

(Other matrices possible, depending on the order of “stacking”)

s
(ii) Yes, a small matrix equation could be solved. From the working above, it is clear that we have
expressions for a10 , a11 and a20 directly. Therefore we could set up an expression in the

er
unknowns a12 , a13 , a21 , a22 and a23 - this would lead to a matrix-vector equation involving a 5 × 5
matrix.

(iii) We effectively ignore the second portion of the trajectory and just consider the part between
θ(0) = 45 and θ(tw ) = 90. At both points the velocities are zero. From the expressions above we
have
sw
θ̇(t) = a11 + 2a12 t + 3a13 t2
which is actually
θ̇(t) = 2a12 t + 3a13 t2
since a11 = 0. Now the maximum/minimum of this function occurs when

2a12 + 6a13 t = 0

Also from our expression for velocity, we have that, at t = tw :

0 = 2a12 (tw ) + 3a13 t2w = tw (2a12 + 3a13 tw )


An

So since tw 6= 0, we have
3
a12 = − a13 tw
2
Using this in our expression for max/min velocity we have
a12
t=−
3a13
1
= tw
2
So we need to check the velocity at the half-way time i.e 1.5 seconds.

(d) The Jacobian matrix is easily calculated from basic differentiation


 
cos θ2 cos θ3 −d1 sin θ2 cos θ3 −d1 cos θ2 sin θ3
J(q) =  cos θ2 sin θ3 −d1 sin θ2 sin θ3 d1 cos θ2 cos θ3 
− sin θ2 −d1 cos θ2 0

Copyright 2021 c University of Southampton Page 12 of 16


ELEC3201W1

To determine constraints on the velocity we need to calculate |J(q)| and determine it is zero.

−d1 sin θ2 sin θ3 d1 cos θ2 cos θ3


|J(q)| = cos θ2 cos θ3
−d1 cos θ2 0
cos θ2 sin θ3 d1 cos θ2 cos θ3
+ d1 sin θ2 cos θ3
− sin θ2 0
cos θ2 sin θ3 −d1 sin θ2 sin θ3
− d1 cos θ2 sin θ3
− sin θ2 −d1 cos θ2
= cos θ2 cos θ3 (d21 cos2 θ1 cos θ3 )
+ d1 sin θ2 cos θ3 (d1 cos θ2 cos θ3 sin θ2 )
− d1 cos θ2 sin θ3 (−d1 cos2 θ2 sin θ3 − d1 sin2 θ2 sin θ3 )

s
= d21 cos3 θ2 + cos2 θ3 + d21 sin2 θ2 cos2 θ2 cos θ2 + d21 (cos3 θ2 sin2 θ3 + cos θ2 sin2 θ2 sin2 θ3 )
= d21 cos3 θ3 (sin2 θ3 + cos2 θ3 ) + d21 cos θ2 sin2 (θ2 (sin2 θ3 + cos2 θ3 )
= d21 cos θ2 (sin2 θ2 + cos2 θ2 )

(e)
= d21 cos θ2

er
So singularity when d1 = 0 and θ2 = π, 3π/2

(i) Students would be expected to provide advantages of electric actuators (convenience, precise
sw
control, ease of maintenance etc), disadvantages of electric actuators (poor force/torque levels,
size/power issues etc) and then also discuss the advantages of hydraulic actuators (high levels
of force production, maintenance of force under “zero” power, good size/force ratio) and their
disadvantages (difficulty in control, maintenance issues, cleanliness issues etc).
Somewhat open-ended question with different answers acceptable.

(ii) Students would be expected to suggest that the manipulator behaviour would be improved with
sensors which can detect object proximity, the force exerted on an object, and whether or not
an object is slipping or deforming. This information can then be used to adjust gripper force or
orientation. The concept of soft robotics could also be discussed.
Somewhat open-ended question with different answers acceptable.
An

TURN OVER
Copyright 2021 c University of Southampton Page 13 of 16
ELEC3201W1

[25 marks]

s
er
sw
An

Copyright 2021 c University of Southampton Page 14 of 16


ELEC3201W1

Question 3.
A camera is taking images of a working area in a robotic system as shown
in Figure 4.

(a) Due to technical difficulties, the images taken by the camera have low
contrast with low visibility. Propose and describe techniques to in-
crease the visibility of images.
[4 marks]

s
(b) Also, due to low light and radiation, images are contaminated with some
noise. Propose and describe filters to remove or to reduce the noise.

er [5 marks]
(c) In the manufacturing process, there are three kinds of objects with three
different shapes appearing in front of the camera in the working area.
The colour and intensity of the objects are distinctively different from the
background.
sw
(i) Advance an algorithm which can recognise these three objects.
[11 marks]
(ii) Explain if it would be possible to use deep learning methods to
classify these three objects.
[5 marks]
An

[25 marks]

F IGURE 4: Robotic system with camera

TURN OVER
Copyright 2021 c University of Southampton Page 15 of 16
ELEC3201W1

Question 4.

(a) Consider a swarm of ground robots operating in the New Forest, per-
forming a monitoring task - the robots have to approach a number of
pre-specified GPS marked trees and take pictures of the tree barks for
further analysis. For the task, the robots of the swarm have to traverse
large distances in an energy efficient manner. Describe the three main
approaches that you would employ for your ground robots to traverse

s
the forest, along with their individual merits and demerits.
[10 marks]
(b) In tuning the parameters for your robot controllers for the above task, you

er
decide to use an evolutionary algorithm. Describe the genetic operators
employed in your algorithm and provide an example of how they work.
[5 marks]
(c) Besides the above mentioned forest monitoring application, briefly ex-
sw
plain two other application scenarios for robot swarms.
[2 marks]
(d) Explain with justification, which of the following is/are NOT a self-organizing
system.

(i) A Swiss watch comprising over 1000 components.


(ii) An ant colony comprising over 100,000 ants.
An

(iii) A flock of over a 100 starlings.


(iv) The development of a multicellular organism with over 30 trillion
cells.

[8 marks]

[25 marks]

END OF PAPER
Copyright 2021 c University of Southampton Page 16 of 16

You might also like