Algorithm——逆解算三轴机械臂运动公式得到运动坐标