命令 2001:通过门控运动以PTP动作移动

以门控运动PTP动作移动。

命令格式

  1. 选项
    指定目标位置的指定方法和各种选项。本命令通过选项的指定所需参数的数量可变。速度/加减速的指定和目标的指定方法对参数数量有影响。对其他选项没有影响。
    关于根据选项的参数2以后,请遵照 (2) 以后内容。
    通过参数1指定选项。
bit 名称 说明
参数1 15 Till/Find/Sense

指定Till、Find、Sense选项

0 = 不指定

1 = Till

2 = Find

3 = Sense

14
13 并行处理

选择是否进行并列处理

0 = 否

1 = 是

12 CP

指定是否进行路径运动

0 = 否

1 = 是

11 速度/加减速

指定动作执行前是否设置速度/加减速

0 = 不设置

1 = 只设置Speed

2 = 只设置SpeedS

3 = 只设置SpeedR

4 = 只设置Accel

5 = 只设置AccelS

6 = 只设置AccelR

7 = 设置Speed和Accel

8 = 设置SpeedS和AccelS

9 = 设置SpeedR和AccelR

10
9
8
7 预约 设置0
6 Arch

使用Arch 时:以0 — 6的整数指定Arch编号。

不使用Arch时:指定7

5
4
3 预约 设置0
2 目标位置指定方法

选择目标位置的指定方法

0 = 通过点编号指定

1 = 通过托盘指定位置

2 = 通过托盘指定坐标

1
0

  1. 从目标位置指定方法中选择通过点编号指定,不指定速度/加减速
    此时,最多使用到参数2。
    命令编号、参数1、参数2
bit 名称 说明
参数2 15 点编号 通过点编号指定目标位置
14
1
0

  1. 从目标位置指定方法中选择通过托盘指定位置,不指定速度/加减速
    此时,最多使用到参数3。
    命令编号、参数1、参数2、参数3
bit 名称 说明
参数2 15 托盘编号 指定要使用的托盘编号
14
1
0
bit 名称 说明
参数3 15 位置 指定托盘的位置
14
1
0

  1. 从目标位置指定方法中选择通过托盘指定坐标,不指定速度/加减速
    此时,最多使用到参数4。
    命令编号、参数1、参数2、参数3、参数4
bit 名称 说明
参数2 15 托盘编号 指定要使用的托盘编号
14
1
0
bit 名称 说明
参数3 15 指定托盘的列
14
1
0
bit 名称 说明
参数4 15 指定托盘的行
14
1
0

  1. 从目标位置指定方法中选择通过点编号指定,指定速度/加减速
    此时,最多使用到参数3。
    命令编号、参数1、参数2、参数3
bit 名称 说明
参数2 15 点编号 通过点编号指定目标位置
14
1
0
bit 名称 说明
参数3 15 Speed/SpeedS/SpeedR

以0 — 15的整数指定所选类别的速度表格编号

*没有设定时指定0

8
7 Accel/AccelS/AccelR

以0 — 15的整数指定所选类别的加减速度表格编号

*没有设定时指定0

0

  1. 从目标位置指定方法中选择通过托盘指定位置,指定速度/加减速
    此时,最多使用到参数4。
    命令编号、参数1、参数2、参数3、参数4
bit 名称 说明
参数2 15 托盘编号 指定要使用的托盘编号
14
1
0
bit 名称 说明
参数3 15 位置 指定托盘的位置
14
1
0
bit 名称 说明
参数4 15 Speed/SpeedS/SpeedR

以0 — 15的整数指定所选类别的速度表格编号

*没有设定时指定0

8
7 Accel/AccelS/AccelR

以0 — 15的整数指定所选类别的加减速度表格编号

*没有设定时指定0

0

  1. 从目标位置指定方法中选择通过托盘指定坐标,指定速度/加减速
    此时,最多使用到参数5。
    命令编号、参数1、参数2、参数3、参数4、参数5
bit 名称 说明
参数2 15 托盘编号 指定要使用的托盘编号
14
1
0
bit 名称 说明
参数3 15 指定托盘的列
14
1
0
bit 名称 说明
参数4 15 指定托盘的行
14
1
0
bit 名称 说明
参数5 15 Speed/SpeedS/SpeedR

以0 — 15的整数指定所选类别的速度表格编号

*没有设定时指定0

8
7 Accel/AccelS/AccelR

以0 — 15的整数指定所选类别的加减速度表格编号

*没有设定时指定0

0

响应格式

请参阅以下内容。

响应代码

说明

用于通过门控运动(首先垂直上升,然后水平移动,最后垂直下降的门型动作)使机械臂从当前位置向指定位置进行PTP动作。

Jump命令用于通过所谓的“Arch运动(Arch型动作)将机械臂从当前位置移动到目标坐标。”也就是说,可考虑为1次可进行3个动作的语句。比如,如果定义Arch编号,1次Jump命令则进行下述3个动作。

  1. 首先,仅第3关节动作到Jump命令期间的由Arch编号计算的Z轴高度位置。
  2. 其次,机械臂在到达由LimZ指定的Z限制位置之前,向Z轴方向上升,同时水平移动到目标坐标。然后,分别进行第1关节、第2关节、第4关节的动作,同时开始向Z轴方向下降。机械臂一直进行动作,直至获取最终的X、Y、U坐标位置。
  3. 机械臂仅向Z轴方向移动,直至获取目标Z坐标位置,在获取目标坐标时,Jump命令结束。
    由于不能在Jump命令中指定目标坐标(移动的目的位置),因此,执行Jump命令之前,需要进行示教。利用Accel进行Jump移动的加速和减速。另外,利用Speed控制移动速度。
    不能对垂直6轴型机械手执行Jump。请使用Jump3。
  • 关于CP
    如果附加了CP参数,则可在开始动作开始减速时叠加后续动作命令的加速。此时,不对目标坐标进行定位。

  • 关于Arch编号
    可利用Jump命令中指定的Arch编号变更Jump的Arch类型。这样的话,可在第1关节、第2关节、第4关节等各关节动作之前,确定要向Z轴方向移动多少程度。Jump命令中可有效使用的Arch编号为0 — 7之间的值。用户可利用Arch命令来定义Arch表格值相对于0 — 6之间值的设置。但7始终定义“门控运动”。门控运动摂是指机械手在移动第1关节、第2关节、第4关节等各关节之前,首先仅将第3关节移动到由LimZ定义的坐标位置处。进行这种“门控运动”时,首先移动到由LimZ定义的Z限制值位置,然后,开始第1关节、第2关节、第4关节等各关节动作。第1关节、第2关节、第4关节等各关节移动到各自的最终目标坐标位置之后,第3关节朝向由目标坐标定义的最终Z坐标位置进行下降动作。下图所示为“门控运动”的动作。

    符号 说明
    a 当前位置
    b 目标坐标
  • 关于LimZ
    LimZ Z坐标值指定当前设置的本地坐标系水平移动面上的Z坐标最高值。根据指定的Arch设置,达到LimZ值之前,也许第1关节、第2关节、第4关节等各关节已开始动作,但LimZ值始终用于定义该移动的Z坐标方向的上限值。
    由LimZ指定的高度方向限制值为本地机器人坐标系上的Z坐标值。并不是Arm、Tool坐标的Z坐标值。因此,使用作业高度不同的工具或夹具末端时,请充分注意并采取必要的措施。

  • 关于Sense
    Sense用于在第3关节进行最终下降动作之前,检查输入条件或存储器I/O条件等。如果没有问题,则将机械手机械臂停在目标坐标位置上(最终仅保留第3关节动作的位置),并视为该命令 (Jump) 执行结束。不过,即使检测到由Sense指定的条件,机械手的机械臂也不会立即停止,这点敬请注意。

    符号 说明
    a 条件检查
    b 动作结束
    c 目标坐标

使用命令编号952,可确认Sense条件成立并且机械臂停在目标坐标位置之前,或者Sense条件不成立并且机械臂直接停在目标坐标位置上。

  • 关于Till
    使用选项Till,可在执行Jump之前对机械手进行减速控制,设置停止条件。可根据事先通过Till命令设置的条件,检查输入为ON或OFF,对机械臂进行减速、停止控制。

注意


Jump不能用于垂直6轴型机械手。

请使用Jump3或Jump3CP。

  • 不指定Arch编号时
    如果Arch编号选项中设置7,如上所述,Arch值为7时,“门控运动”移动(参照上述)。

  • Jump与Jump3及Jump3CP的差异
    可在垂直6轴型机械手中使用Jump3和Jump3CP,但不能使用Jump。在水平多关节型机械手(包括RS系列)上向Z轴方向进行上升/下降动作时,使用Jump可缩短动作时间。也可以在Z轴以外的方向进行Jump3的接近/转移动作。

  • Jump与Go的差异
    Jump与Go的最大差异在于:Go时,所有关节动作同步,各关节同时开始动作并同时停止。而Jump时,动作的开始和结束仅限于垂直方向第3关节。进行类似装置的吸附和配置等作用时,请使用该命令。

  • Jump的减速停止
    使用Jump时,机械臂必须在减速的同时,停在目标坐标位置上。

  • Jump的适当速度和加速指示
    分别利用Speed和Accel设置Jump动作时的机械手速度和加减速。仅可在要利用Jump、Go等进行点到点的动作时设置Speed和Accel命令,这点敬请注意。比如,要执行类似Move或Arc等进行直线和圆弧插补动作的命令时,请使用SpeedS或AccelS命令。另外,Jump时,可分别针对第3关节的上升移动、第4关节的水平移动(包括旋转)以及第3关节的下降等设置速度和加减速。

  • Jump的Pass功能
    在下降动作量为0的Jump上设置CP参数时,由于该Jump的水平动作不减速停止,因此,可平滑地连接后续的PTP动作。
    另外,在此前的PTP动作命令上附加CP参数时,由于上升动作量为0的Jump的PTP动作不减速停止,因此,可平滑地连接Jump的水平动作。
    这在希望将通常的Jump水平动作(1个PTP动作)切换为平滑连接几个PTP动作时非常便利。

  • 使用Arch时的重要事项
    由于Arch运动是通过轨迹控制来合成第3关节的上升或下降动作以及横向动作,因此,并不能保证实际的轨迹。其轨迹会因动作速度或机械臂的移动方式而异。请通过作业使用的实际速度和姿势确认实际轨迹。

    • 即使在相同位置上执行带有相同Arch编号的Jump命令,低速时的轨迹也会低于高速动作时的轨迹。因此,即使确认没有高速碰撞到障碍物,但低速动作时也可能会发生碰撞,敬请注意。
    • 与低速动作时相比,会出现高速动作时垂直上升量增大、垂直下降量减小的倾向。没有达到期待的垂直下降距离时,请降低速度和减速度,或将下降距离设置得长一些。
    • 即使是相同距离的动作,轨迹也会因机械臂的移动方式而异。虽然因机械臂的移动方式而导致的轨迹变化多种多样,但是,如果以一般的水平过关节型机械手为例,第1机械臂的移动幅度越大,垂直上升量也越大,而垂直下降量则越小。没有达到期待的垂直下降距离时,请降低速度和减速度,或将下降距离设置得长一些。
  • 易引起的错误
    LimZ值设置过低时
    在第3关节机械臂位置处于比LimZ设定值还高的位置状态下,如果执行Jump,则会发生错误4005。

使用示例

通过“点编号指定”指定点1,设置为无选项

命令 响应
07D1H 0070H 0001H 07D1H 0000H 0000H

通过“托盘位置指定”指定托盘15,设置为位置10、无选项

命令 响应
07D1H 0071H 000FH 000AH 07D1H 0000H 0000H

通过“托盘坐标指定”指定托盘15,设置为列 = 1、行 = 3、无选项

命令 响应
07D1H 0072H 000FH 0001H 0003H 07D1H 0000H 0000H

通过“点编号指定”指定点1,设置为只设置速度/加减速 = Speed、表格编号 = 8

命令 响应
07D1H 0170H 0001H 0800H 07D1H 0000H 0000H