Introduction - If you have any usage issues, please Google them yourself
1 using inverse kinematics to calculate the linear path (320mm,-200mm, 480mm) to (320mm, 0mm, 480mm) and then to (320mm, 200mm, 480mm) corresponding to the angle of the robot arm.
This experiment will be worked out (320mm,-200mm, 480mm) to (320mm, 0mm, 480mm) of each joint angle into the q.mat. From (320mm, 0mm, 480mm) to (320mm, 200mm, 480mm) of each joint angle into the q2.mat.