puma6轴机器人的正逆解算法，从六个角度转化为末端执行器的位置和方向(The positive inverse solution of puma6 axis robot is converted from six angles to the position and direction of the end-effector)