1.puma560的 ikines ,选取逆解的方法太low了,一般选取离某个关节角最近的一组为真实解比较好
2.angvec2tr目前看一直旋转轴和旋转角度求解旋转矩阵会有问题
避免此bug的方法,是使用quaternion 提供的interp(qs,qe,facotr)因子来求解相应的姿态四元数
然后用姿态四元数.R来求解矩阵比较合适,
1.puma560的 ikines ,选取逆解的方法太low了,一般选取离某个关节角最近的一组为真实解比较好
2.angvec2tr目前看一直旋转轴和旋转角度求解旋转矩阵会有问题
避免此bug的方法,是使用quaternion 提供的interp(qs,qe,facotr)因子来求解相应的姿态四元数
然后用姿态四元数.R来求解矩阵比较合适,