一般的KUKA程序:
1 PTP P0
2 SPLINE
3 SPL P1
4 SPL P2
5 SPL P3
6 SPL P4
7 SCIRC P5, P6
8 SPL P7
9 SLIN P8
10 ENDSPLINE
而大眾版的KUKA程序有很大的區(qū)別,它將真實的軌跡程序全都隱藏了你看到的只是一件外套.
程序外表基礎(chǔ)編程表單:
PTP VB=100% VE=0% ACC=100% RobWzg=1 Base=1 SPSTrig=5[1/100s]P軌跡段
1: FB PSPS = EIN SPS條件程序
2: A23 = AUS
3: WARTE BIS !E16 & E23
4: Tech_ EZSP Zange =Nr1 ProgNr = 99 Offset = 0 [1/10 mm] Weg = 0 [1/10 mm] S-Punkt =3428 Fzg-Typ = 81 EIN ---------------用戶程序
5: bin2 ( EIN ) = 103
6: WARTE BIS !E129 + E26
7: SPSMAKRO80 = EIN
8: WARTE BIS E23
9: A23 = EIN
10: FB PSPS = E42 & E44 & E45 & E46 &E49 & E80 & M30 & M95
實際程序:
VW_MPARA_ACT=P7_D 軌跡設(shè)置條件程序
DECL VW_MPARA_TYP P7_D={TOOL_NO 1,BASE_NO 1,VB 100,VE 0,ACC 100,TRG_TIME 5,MOVE_TYPE #PTP_MOTION}
Act_P1 =P7 軌跡坐標位置變量轉(zhuǎn)存
Act_P2 =P7 軌跡坐標位置變量轉(zhuǎn)存
DECL E6POS P7={X 450.032104,Y -206.769699,Z -16.95224,A -179.587296,B 81.4899063,C 85.0538025,S 6,T 59,E1 13.6000004,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
VW(#MPARA,TRUE) 執(zhí)行軌跡所需要的一些設(shè)置如:加速度,逼近,BASE/TOOL
SPS_FERTIG=FALSE
TRIGGER WHENDISTANCE=1 DELAY=-50 DO SPS_TRIG(7) PRIO=-1激活執(zhí)行SPS程序提前0.05S
VW_USR_R(#USR_ADV,101,10,99,0,0,3428,81,TRUE) 預(yù)執(zhí)行用戶程序
IF (($PRO_MODE==#GO) OR ($EXT)) THEN偏差計算
CONTINUE
act_P1.E1=(act_P1.E1-(MyCorrValue*SZ1_Z1_AHV))
MyTest=act_P1.E1
ENDIF
IF (VW_MPARA_ACT.MOVE_TYPE==#PTP_MOTION) THEN
CONTINUE
PTP act_P1 預(yù)執(zhí)行軌跡程序
PTP P7 執(zhí)行PTP軌跡程序
$ADVANCE=1
WAIT FORSPS_FERTIG 不是過渡步
VW_USER (#USR_MAIN,101,10,99,0,0,3428,81,TRUE)執(zhí)行P7步后的用戶程序
IF (($PRO_MODE==#GO) OR ($EXT)) THEN
Weg=PAR4 遠離的補償量
MyCorrWeg=$NULLFRAME變量歸零
MyCorrWeg.X=-(Weg*0.1)
IF (Weg>9) THEN遠離值大于9執(zhí)行軌跡偏移
PTP $Pos_act:MyCorrWeg C_PTP 執(zhí)行軌跡后
ENDIF
ENDIF
-
程序
+關(guān)注
關(guān)注
116文章
3762瀏覽量
80755 -
大眾
+關(guān)注
關(guān)注
1文章
779瀏覽量
33968 -
KUKA
+關(guān)注
關(guān)注
3文章
217瀏覽量
16471
原文標題:KUKA 大眾版本 軌跡程序分解
文章出處:【微信號:gh_a8b121171b08,微信公眾號:機器人及PLC自動化應(yīng)用】歡迎添加關(guān)注!文章轉(zhuǎn)載請注明出處。
發(fā)布評論請先 登錄
相關(guān)推薦
評論