写成机器人正运动学方程将已知的末端位姿矩阵与求得的正运动学方程建立等式关系根据等式两端相应元素相等建立方程求解相应的关节变量