我应该是已经定好end effector的初始位置了,然后目标位置与初始位置相差0.1m,我是选的y轴负向运动0.1m。
具体思路周末补充吧。
下图是简图,就是把手臂简化成二维空间内的一个开环链。
下面的图是仿真结果,修改不同的K值可以改变关节控制系统的稳定性从而影响结果。但是最终end effector的位置到达target position。
## Calculate and draw the trajectory of the hand form initial position (Xs, Ys) to target positon (Xe, Ye) by numerical simulation
import tinyik as ti
import math as