命令 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