300599 - Advanced Robotics Assessment Answer

This is a computer controlled six-joint robot, driven by six DC servomotors. The geometrical parameters of the PUMA.

Students are required to work individually to obtain the forward kinematic equations inverse kinematic solutions of the PUMA robot. Students will use Denavit-Hartenberg (DH) representation to establish the 6 coordinate frames of the robot.

Students should complete the following tasks for submission

1. Identify all links and joints of the PUMA as shown in Figure 1 (b) and establish (by drawing) DH coordinate frames for all links – you can use the coordinates as those in the lecture notes. You can also copy the figures from this assignment sheet and draw your own DH coordinates.

2. Identify all DH parameters and write into a table format.

3. Obtain the forward kinematic equations of the robot in matrix form using the link and joint parameters that you have already identified (no need to expand the multiplication).

4. Use MATLAB to calculate the robot end-effector’s position, i.e., the origin of the coordinate frame 6 of the robot, for the following joint positions.

5.When six joints are moving simultaneously, write a MATLAB program to determine and plot the robot end-effector’s position in a 3-dimensional plot (time t is 0 to 5 seconds at 0.2 second interval). In addition, the program should also plot the movement of the end-effector in XY, XZ, and YZ planes. The six joints are moving according to the following trajectories :

θ1 = −2(1− 0.1t) (rad)

θ2 = 2(1− 0.04t) (rad)

θ3 = 3(1− 0.2t) (rad)

θ4 =θ1

θ5 =θ2

θ6 =θ3

Calculate the inverse kinematic solutions for the first 3 joint angles (q1, q2, q3) if the PUMA’s wrist positions are at [0.5, -0.2, -0.2] m or at [-0.5, 0.2, 0.2] as given in the table below – list all possible solutions (for “Left”, “Right” arm and “Above” and “Below” elbow configurations).

In the written report, students can submit handwritten results for tasks 1 – 4. For task 5, students should submit a computer plot that shows the positions of the final link of the robot. For task 6, students should show clearly how the solutions are obtained – you can use MATLAB to complete this task. Students should also submit the MATLAB programs for both tasks 4 and 5 on vUWS.