六自由度机器人运动学正反解求解过程,十分详细,机器人运动学