KUKA機器人力矩監(jiān)控變量的控制使用

關于KUKA的力矩監(jiān)控:可以利用變量$TORQMON[6]進行監(jiān)控范圍的編程和報警.

$TORQMON[]???? 程序模式中的扭矩監(jiān)視通道,程序模式下的扭矩監(jiān)控.

程序模式下扭矩監(jiān)控的電流因數(shù)（力感應扭矩）

如果機器人與物體碰撞，則機器人控制器會增加軸轉(zhuǎn)矩以克服阻力。這可能會損壞機器人，工具或其他物體。

變量$TORQMON包含程序模式下軸轉(zhuǎn)矩的當前公差范圍。該公差范圍是使用文件…STEU Mada $ custom.dat中的變量$TORQMON_DEF定義的。

默認值：200

$TORQMON[Axis number]=Factor

$TORQUE_AXIS_ACT[]

軸的當前電機扭矩（扭矩模式）僅當制動器松開時，顯示值才相關。如果應用制動器，則實際上為零。（可通過系統(tǒng)變量$BRAKE_SIG顯示制動器的狀態(tài)。$BRAKE_SIG的值為位數(shù)組：位0對應A1，位6對應E1。）變量受寫保護。它的值不依賴于解釋器。在robot程序中，變量觸發(fā)提前運行停止。

USER_INIT () 程序里初始化軸扭矩監(jiān)控值

FOR i=1 to 6? ? 通過改變KOLL_RED實現(xiàn)可調(diào)節(jié)軸的扭矩監(jiān)控

$TORQMON[i]=(200-KOLL_RED) ???KOLL_RED=0? ?$TORQMON扭矩間控制=200

ENDFOR

$TORQMON_TIME=0.0120000001運動扭矩監(jiān)視功能的響應時間

用法: 通過用戶程序測量軸的扭矩值從而設定監(jiān)控軸的扭矩監(jiān)控范圍.

機器人抓手USER：TECH2_ Koll_Ueb抓件/放件過載監(jiān)控程序

功能：--力矩報警--

例：

TECH2_ Koll_Ueb Betriebsart =Lernen Stop Bereich = 1 Offset = 5 EIN

------------

VW_USR_R (#USR_ADV,204,1,2,1,5,1,2,TRUE)

P1=1 P1=1 測量力矩 P1=2??? -激活使用力矩監(jiān)控

P2=2改變個軸的力矩范圍

P3=1使用的數(shù)組

P4=5偏差補償值

P5=1

P6=2

P7=TRUE

ADC : 預先執(zhí)行

CASE 204

IF(PAR7==TRUE)THEN

WHILE((PAR4<1) OR (PAR4>40)) --檢查P4的補償值-是否在（1-40）之間

MLD(29,#QuitMsg);

ENDWHILE

ENDIF

MAIN: 到達位置后停止?

CASE 204 ;

Index=PAR3????-P3=1使用的數(shù)組

KOLL_DAT[1]={A1 8,A2 19,A315,A4 9,A5 12,A6 13}

IF(PAR7==TRUE)THEN

WHILE(PAR2<1) OR (PAR2>2)? -檢查P2值得設置范圍

MLD(30,#QuitMsg)

ENDWHILE

;

SWITCH PAR1?? -P1=1

CASE 1

IF PAR2==1 THEN??? ?- P2 =1 初始化力矩值得范圍-

FOR i=1 to 6

$TORQ_DIFF[i]=0

ENDFOR

初始化值:

Koll_dat[Index].A1=0? ?

Koll_dat[Index].A2=0

Koll_dat[Index].A3=0

Koll_dat[Index].A4=0

Koll_dat[Index].A5=0

Koll_dat[Index].A6=0

ENDIF

IF PAR2==2 THEN?? 改變個軸的力矩范圍

IF($TORQ_DIFF[1])>(Koll_dat[Index].A1)THEN

編輯：黃飛