1. 判断机器人是否在安全位置 （立方体干涉区）
2. 读取机器人当前位置 GETS PX000 $PX001 读取基座标下的机器人当前位置并放到位置型变量P000中 $PX000表示关节坐标下的机器人当前位置。
3. SETE P000(3) D000 将D000中的值赋值到P000的Z分量中
4. MOVL P000 V=80.0 垂直抬起一定高度
5. MOVJ P001 V=100 回原点 需根据实际情况增加过渡点
原文：https://www.cnblogs.com/davidshaw/p/10832685.html