6.3.1 基于多项式插值的关节自由摆动故障空间机械臂轨迹优化