机械臂控制代码