3.4.1 关节锁定故障空间机械臂运动学模型