多自由度机械臂控制算法设计