6轴机器人运动学（正解）