设定机器人坐标系与编写运动轨迹程序