Question 1 (15 marks)
Design a PYTHON program to compute the forward kinematics of PUMA 560. The DH parameters are listed in the following table:
Requirements:
- Β The code should be able to take the joint variables and the pose (position and
orientation) of a position vector expressed in Frame {6} (i.e., 6ππ) as inputs, compute the forward kinematics mechanism, and output the pose of the position vector expressed in frame {0}. - Experiment the code by using the following input values:
[ππ1, ππ2, ππ3, ππ4, ππ5, ππ6] = [0, β20Β°, β30Β°, 45Β°, 15Β°, 30Β°] and 6ππ = [0.2, 0.2, 0.2]ππ. - Β List the code in the submission and provide the source code (.py) as an accompanying submission.
Question 2 (25 marks)
(a) Inverse kinematics is essential to design a controller of robotic system. Perform numerical calculation for inverse kinematics of the planner three-link manipulator whose algebraic solution procedure is given in Textbook Section 4.4. Figure Q2 shows the mechanism of the three-link planar manipulator and its link parameters. In the figure, the base frame {π΅π΅} is shown as Frame {0}, and the wrist frame {ππ} is shown as Frame {3}. The following fixed-length parameters are given: πΏπΏ1 = 1 ππ, πΏπΏ2 = 1 ππ, and πΏπΏ3 = 1 ππ. The homogeneous transformation of the wrist frame relative to the base frame (πππππ΅π΅ ) is given by
(i) Interpret the geometrical meanings in the following matrix and vector that are equipped numerical entities.
οΏ½
0.5000 β0.8660Β Β Β 0
0.8660 0.5000Β Β Β Β 0
0Β Β Β Β Β Β Β Β Β Β 0Β Β Β Β Β Β 1
οΏ½
Β Β Β Β Β and
{1.2
0.8
0}
(ii)Β Present a pseudocode in Python or Matlab style to show the procedure to calculate joint variables ππ1, ππ2 and ππ3. You are welcome to develop a true code to calculate the number values.
(iii)Β Solutions for ππ1, ππ2 and ππ3 can be obtained from the given numerical entities in πππππ΅π΅ . However, another set of numerical entities in πππππ΅π΅ might not yield solutions from the calculation. Explain your understanding on the non-solution issue.
(b)Β The inverse kinematics analysis is sometimes not straight forward as that in a forward kinematics analysis. There is no general approach that can be applied to different manipulator mechanism. The solution procedure in Textbook 4.7 for the PUMA 560 example demonstrates several patterns or manipulations that may inspire a solution procedure for another mechanism. Summarize what you have learnt from the example for an inverse kinematics analysis. You may use bullet points with text less than 400 words and only necessary equations.