Jump3, Jump3CP
用於以3維門形動作方式移動手臂。
Jump3為2個CP動作和1個PTP動作的組合。
Jump3CP為3個CP動作的組合。
格式
(1) Jump3 閃避坐標, 接近起始坐標, 目標坐標 [, C Arch編號] [, CP] [, LJM [, 選擇姿態旗標]] [, Sense | Till | Find] [, !平行處理!] [, SYNC]
(2) Jump3CP 閃避坐標, 接近起始坐標, 目標坐標 [, ROT] [, C Arch編號] [, CP] [, LJM [, 選擇姿態旗標]] [, Sense | Till | Find] [, !平行處理!] [, SYNC]
參數
- 閃避坐標
- 以點指定目前位置之上的閃避點。
- 接近起始坐標
- 以點指定目標坐標之上的接近開始點。
- 目標坐標
- 以點指定動作到達的目標坐標。
- ROT
- 以工具姿態變化為優先,決定動作速度和加減速度。可省略。
- Arch編號
- Arch編號用於指定Arch表,以決定Jump3命令的Arch型動作。請務必在Arch編號的開頭處附加大寫「C」。(有效值為C0~C7。)可省略Arch編號。
- CP
- 指定路徑運動。可省略。
- LJM
- 以LJM函數轉換閃避坐標、接近坐標、目標坐標。可省略。
- 選擇姿態旗標
- 指定賦予LJM函數的姿態旗標選擇參數。可省略。
- Sense | Till | Find
- 記述Sense、Till、Find中的任一運算式。可省略。
Sense | Till | Find Sense Sw(運算式) = {On | Off} Till Sw(運算式) = {On | Off} Find Sw(運算式) = {On | Off}
- !平行處理!
- 可在Jump3、Jump3CP命令中增加平行處理陳述式,以便在動作時執行I/O或其他命令。可省略。
- SYNC
- 用於預約動作命令。在以SyncRobots開始動作之前,機器人不進行動作。
說明
以3維門形動作方式,將手臂從目前位置移至目標坐標。3維門形動作由閃避動作、Span動作和接近動作構成。從目前位置閃避到閃避坐標的動作是CP動作。對於從閃避坐標到接近起始坐標的Span動作,在Jump3情況下為PTP動作;在Jump3CP情況下為CP動作。從接近起始坐標到目標坐標的接近動作是CP動作。
符號 | 說明 |
---|---|
a | 目前位置 |
b | 閃避動作 CP |
c | 閃避坐標 |
d | Span動作 PTP/CP |
e | 接近起始坐標 |
f | 接近動作 CP |
g | 目標坐標 |
依照Arch編號設定執行Arch動作。
下圖所示為Jump3以及Jump3CP的Arch動作。
請設定大於Arch上升距離的閃避距離以及大於Arch下降距離的接近距離。
符號 | 說明 |
---|---|
a | 閃避距離 |
b | Arch上升距離 |
c | 閃避坐標 |
d | 接近起始坐標 |
e | 接近距離 |
f | Arch下降距離 |
Jump3CP的速度和加減速度分別使用SpeedS和AccelS的設定值。關於速度和加減速度的關係,請參閱「注意」項目中的「連同CP一起使用Jump3、Jump3CP」。但是,指定ROT修飾參數時的速度和加減速度分別使用SpeedR和AccelR的設定值。此時,SpeedS和AccelS的設定值即呈停用狀態。
機器人的工具中心點位置固定為特定坐標,僅改變工具姿態時,或者相對於工具中心點的移動距離,工具姿態變化較大時,工具姿態變化速度可能會明顯變快。為防止這種情形,工具姿態變化速度大時,自動限制動作速度的功能就會啟用。
想要手動設定CP動作時的工具姿態變化速度的上限值時,請啟用SpeedRLimitation。啟用SpeedRLimitation時,CP動作時的工具姿態變化速度超過設定的SpeedR時,工具姿態變化速度會變為SpeedR來限制動作速度。工具姿態變化速度超過設定的SpeedR時,以設定的SpeedS進行動作。工具姿態變化速度的上限值,請事先在SpeedR設定。
注意
LimZ不會影響到Jump3及Jump3CP。
Span動作不一定垂直於坐標系的Z軸,因此LimZ不會影響到Jump3及Jump3CP。
Jump3的Span動作為PTP動作。
由於PTP動作難以預測到其軌跡,因此請充分注意機器人本體和週邊裝置之間的干擾情況。
連同CP一起使用Jump3、Jump3CP
若使用CP參數,則在開始減速的同時,移至下一個陳述式控制動作命令。其便利之處在於,使用者可連接數個動作命令,以恆定的速度執行連續動作。在未指定CP的Jump3命令、Jump3CP命令時,手臂務必減速,並停於指定的目標坐標上。
Jump3的Pass功能
若在接近動作量為0的Jump3上附加CP參數,可在不減速並停止該Jump3的Span動作之狀態下繼續順暢連上PTP動作。
此外,若在此前的PTP動作命令上附加CP參數,閃避動作量為0的Jump3可在不減速並停止該PTP動作之狀態下順暢連上Jump3的Span動作。
要將平常的Jump3的Span動作(1個PTP動作)替換成順暢連上數個PTP動作時,這個功能非常有用。
Jump3CP的Pass功能
若在接近動作量為0的Jump3CP上附加CP參數,可在不減速並停止該Jump3CP的Span動作之狀態下繼續順暢連上CP動作。
此外,若在此前的CP動作命令上附加CP參數,閃避動作量為0的Jump3CP可在不減速並停止該CP動作之狀態下順暢連上Jump3CP的Span動作。
要將平常的Jump3CP的Span動作(1個CP動作)替換成順暢連上數個CP動作時,這個功能非常有用。
(例1)
Jump3 P1,P2,P2 CP Go P3,P4 CP Jump3 P4,P5,P5+tlz(50)
(例2)
Jump3CP P1,P2,P2 CP Move P3,P4 CP Jump3CP P4,P5,P5+tlz(50)
連同LJM一起使用Jump3、Jump3CP
若使用LJM參數,則可簡化使用LJM函數的程式。
例如:
P11 = LJM(P1, Here, 2) P12 = LJM(P2, P11, 2) P13 = LJM(P3, P12, 2) Jump3 P11, P12, P13
可將上述4行的程式取代為
Jump3 P1, P2, P3 LJM 2
的1行程式。
LJM參數對於垂直6軸型機器人(包含N系列)以及RS系列機器人有效。
Jump3CP的Span動作為直線(CP)動作,因此不可在中途切換腕部姿態。請勿使用有可能切換腕部姿態之LJM函數的選擇姿態旗標(LJM 1)。
使用Arch時的重要事項
由於透過軌跡控制進行拱形動作的合成,因此不能保證實際軌跡。軌跡會因動作速度和手臂的動作方式而異。請以作業時使用的實際速度和姿態確認實際軌跡。
在相同位置上,即便執行帶有相同[C Arch編號]的Jump3命令,低速時的軌跡也會比高速動作時低。因此,請注意:即便確認不會因高速而撞擊干擾物,仍有可能在低速動作時發生撞擊。
相較於低速動作,高速動作會增加未合成的閃避移動量,呈現出減小未合成的接近移動量之傾向。未出現預期的移動距離時,請降低速度或減速度或將接近距離設得長一些。
即便是相同距離的動作,軌跡也會依手臂的動作方式而異。
常見錯誤
在閃避動作(接近動作)和Span動作中,主要動作的關節相同時
以Jump3、Jump3CP命令執行Arch動作時,有可能發生異常加速度錯誤。這在閃避動作(接近動作)和Span動作中,主要動作的關節相同時最為明顯。在這種情況下,請以下列命令降低Span動作的加減速度,避免出現這種狀況:若為Jump3,則用Accel命令;若為Jump3CP,則用AccelS命令。此外,對於部分動作姿態,以AccelS命令降低閃避動作(接近動作)的加減速度,也可能有效。
參照
Accel、Arc、Arch、Go、JS、JT、P# = 點指定、Pulse、Sense、Speed、Stat、Till
Jump3範例
'如同SCARA機器人的Jump動作之垂直6軸型機器人(包含N系列)動作
Jump3 Here :Z(100), P3 :Z(100), P3
'使用Z工具坐標的閃避動作和接近動作
Jump3 Here -TLZ(100), P3 -TLZ(100), P3
'使用Z基本坐標的閃避動作和使用Z工具坐標的接近動作
Jump3 Here +Z(100), P3 -TLZ(100), P3
以Tool1進行閃避動作,以Tool2進行接近動作的範例
Arch 0,20,20
Tool 1
Go P1
P2 = P1 -TLZ(100)
Tool 2
Jump3 P2, P3-TLZ(100), P3 C0