Exercise 4, Problem 11

Given that the original position of the robot is always set to be (0,0,0) , we took the final position (-0.5, -0.5, 0), in order to compare with the previously simulated case. The result was more than satisfactory.