You are on page 1of 4

Dương Quang Nam 20162788

Set TCP
Set Xilanhkep=Off

MoveJ: (Joint Speed: 60° / s2 – Joint Acceleration 80° / s2 )


 Wp1
MoveL: (Joint Speed: 40° / s2 – Joint Acceleration 60° / s2 )
 Wp2
 Wp3
 Wp4
MoveJ: (Joint Speed: 60° / s2 – Joint Acceleration 80° / s2 )
 Wp17
 Wp12
MoveL: (Joint Speed: 40° / s2 – Joint Acceleration 60° / s2 )
 Wp5
 Wait: 0.5
 Set Xilanhkep=On
 Wait Xilanhkep=High
 Wp6
MoveP:
MoveC:
 Wp7
 Wp8
MoveC:
If CB1=On
lap:=1
Loop 5 time :
MoveC:
 Wp9
 Wp10
MoveJ:
 Wp30 ( điểm p30 (60,6;39,4; 5) )
 Wp9

 Switch lap
Case 1:
Popup: da lap lan 1
Case 2:
Popup: da lap lan 2
Case 3:
Popup: da lap lan 3
Case 4:
Popup: da lap lan 4
Case 5:
Popup: da lap lan 5
 lap:=lap+1
ElseIf CB1=Off
lap:=1
Loop 3 time :
MoveC:
 Wp9
 Wp10
MoveJ:
 Wp30 ( điểm p30 (60,6;39,4; 5) )
 Wp9
 Switch lap
Case 1:
Popup: da lap lan 1
Case 2:
Popup: da lap lan 2
Case 3:
Popup: da lap lan 3
 lap:=lap+1

MoveC:
 Wp11
 Wp12
MoveJ: (Joint Speed: 60° / s2 – Joint Acceleration 80° / s2 )
 Wp18
 Wait: 0.5
 Set Xilanhkep=Off
 Wait Xilanhkep=Low
 Wp13
MoveP:
MoveC:
 Wp14
 Wp15
MoveC:
 Wp16
 Wp13
MoveJ: (Joint Speed: 60° / s2 – Joint Acceleration 80° / s2 )
 Wp19

You might also like