附录B 机械臂四舵机动作控制程序