好像是T1 T2有问题，如果换成T1=transl(0.6,-0.5,0); T2=transl(0.4,0.5,0.2); 程序正常 也不太懂为什么。。
用D-H法则，这是最经典的机械臂坐标变换方法。
