5.2 子程序应用案例：简易机械手控制