Hi Jongwon,
I understand that you are trying to create a 3D motion. Please refer to the steps mentioned below to achieve your goal:
- Define the lengths of the three link
- Define the range of motion for joint 1
- Define the number of steps in the motion
- Calculate the step size for joint 1
- Define the initial position of the end effector
- Create a loop to move joint 1 and calculate the position of the end effector for each step
- Set the axis limits and labels for the plot
- Run the code and observe the motion of the end effector
I hope the above steps help you solve the problem.