关节空间轨迹规划 jtraj:已知始末的关节角度,利用五次多项式来规划轨迹 mdl_puma560; T1=transl(0.4,0.2,0)*trotx(pi); T2=transl(0.4,-0.2,0)*trotx(pi/2); q1=p560.ikine6s(T1); q2=p560.ikine6s(