以下KRL聲明允許在系統(tǒng)提交中使用,但不允許在擴(kuò)展提交中使用:
? ASYPTP
? VECTORMOVEON()
? VECTORMOVEOFF()
? SET_TORQUE_LIMITS()
? RESET_TORQUE_LIMITS()
本例中的外部軸的運(yùn)動(dòng)指令可以在SUB程序中使用,前提是它被分配給系統(tǒng)提交,而不是擴(kuò)展提交。 IF (($IN[12] == TRUE) AND ( NOT $IN[13] == TRUE)) THEN ASYPTP {E2 45} ASYPTP {E3 200} ... IF ((NOT $IN[12] == TRUE) AND ($IN[13] == TRUE)) THEN ASYPTP {E2 0} ASYPTP {E3 90} 外部軸E2和E3根據(jù)特定輸入進(jìn)行移動(dòng)。此處未使用WAIT語(yǔ)句或等待循環(huán),因?yàn)樗鼈儠?huì)停止循環(huán)。
IF $OUT[DEF_ZANGE[ZangeKeyNr].A_AUF] AND NOT FlagGunOpen[SgbGunNr] AND $COULD_START_MOTION THEN
機(jī)器人鉗工能被激活
SG_ActiveGunNumber = SgbGunNr
SG_ExtaxActive=ServoGun[SG_ActiveGunNumber].ExtAxNumber
FlagGunOpen[SgbGunNr]=TRUE
OvAsyncSaved = $OV_ASYNC
$OV_ASYNC = $OV_JOG
$ACC_EXTAX[ServoGun[SgbGunNr].ExtAxNumber]=30
$VEL_EXTAX[ServoGun[SgbGunNr].ExtAxNumber]=10
NewGunAxisPos = $AXIS_ACT當(dāng)前軸的位置
SGL_SET_AXIS_A_VALUE(NewGunAxisPos,SGL_GetOpenSoftEnd(SgbGunNr) * 0.99)計(jì)算要打開(kāi)電伺服焊鉗開(kāi)口的位置
ASYPTP NewGunAxisPos執(zhí)行新算出來(lái)的軌跡
ENDIF
伺服焊鉗建立壓力
? E1 在 ASYPTP {E1 10} 時(shí)已同步。
? 或者:$ASYNC_MODE 已配置 (位 0 = 1),以使在 ASYPTP 時(shí)在提交解釋器中隱含地將軸設(shè)定為同步。
...
1 IF $PRO_STATE1==#P_FREE
2 SET_TORQUE_LIMITS(7,{upper 1000, monitor #off })
限制正扭矩并關(guān)閉常規(guī)的監(jiān)控。
3 ASYPTP {E1 10}
沿工件后目標(biāo)點(diǎn) {E1 10} 方向移動(dòng)。建立對(duì)工件的壓力。
...
4 RESET_TORQUE_LIMITS(7)
取消扭矩限制并重新接通正式的監(jiān)控。此外,使額定位置與實(shí)際位置相適應(yīng)。
解釋器在 RESET_TORQUE_LIMITS(7) 中等至異步運(yùn)動(dòng)已結(jié)束。
只在如此之后才進(jìn)行額定 / 實(shí)際匹配。因此,不需要在RESET… 之前編程設(shè)定 WAIT FOR $ASYNC_STATE ==#IDLE。
5 ASYPTP {E1 -10}重新打開(kāi)焊鉗。
6 ENDIF
編輯:黃飛
-
機(jī)器人
+關(guān)注
關(guān)注
211文章
28641瀏覽量
208412 -
程序
+關(guān)注
關(guān)注
117文章
3795瀏覽量
81411 -
KUKA
+關(guān)注
關(guān)注
3文章
217瀏覽量
16605 -
KUKA機(jī)器人
+關(guān)注
關(guān)注
4文章
143瀏覽量
9179
原文標(biāo)題:KUKA機(jī)器人 執(zhí)行在SPS系統(tǒng)程序里的ASYPTP用法
文章出處:【微信號(hào):gh_a8b121171b08,微信公眾號(hào):機(jī)器人及PLC自動(dòng)化應(yīng)用】歡迎添加關(guān)注!文章轉(zhuǎn)載請(qǐng)注明出處。
發(fā)布評(píng)論請(qǐng)先 登錄
相關(guān)推薦
評(píng)論