已投运动控制算法(机械臂)