激活轉(zhuǎn)矩運行:SET_TORQUE_LIMITS()
用該功能可以為特定的軸執(zhí)行以下操作:
在正向和 / 或負向方向上限制轉(zhuǎn)矩。
關(guān)閉在滯后誤差變大時要響應(yīng)的常規(guī)監(jiān)控。
如果常規(guī)監(jiān)控已關(guān)閉:更改專用監(jiān)控的值。
SET_TORQUE_LIMITS (axis: in, values : in)
axis 類型:INT 該指令適用的軸.
values 類型:TorqLimitParam 要為該軸設(shè)定的值.
TorqLimitParam :
STRUC TorqLimitParam REAL lower 、upper、SW_ONOFF monitor 、REAL max_vel、max_lag.
lower |
扭矩下限 單位:Nm (線性軸:N) 默認值:-1E10 (即無限制) |
upper |
扭矩上限 單位:Nm (線性軸:N) 默認值:1E10 (即無限制) |
monitor |
#ON (默認):接通常規(guī)的監(jiān)控。 #OFF:關(guān)閉常規(guī)的監(jiān)控。相反,監(jiān)控 max_vel 和 max_lag 已激活 |
max_vel |
力矩運行下允許的最大實際速度 (只在常規(guī)的監(jiān)控關(guān)閉時相關(guān)) 只允許編程一個正值。 單位:度 (對于直線軸:mm) 默認值 (在所有運行方式下適用):T1 腕部運行速度 * 內(nèi)部安全系數(shù) 即使在編程設(shè)定了一個更高值時,最大也可用該默認值在 T1 下運行。 提示:只在必需時,才能將一個更高的值設(shè)定為默認值。 |
max_lag |
力矩運行下允許的最大滯后誤差 (只在常規(guī)的監(jiān)控關(guān)閉時相關(guān))只允許編程一個正值。 單位:度 (對于直線軸:mm) 默認值:5 度 (對于直線軸:100mm) 提示:只在必需時,才能將一個更高的值設(shè)定為默認值。 |
可以在機器人程序和提交程序中使用 SET_TORQUE_LIMITS()。
預(yù)進停止:在機器人程序中,該指令會觸發(fā)預(yù)進停止。
Values 有時允許保持未初始化狀態(tài)。未初始化組件表示現(xiàn)有值應(yīng)保持未更改狀態(tài)。
如果設(shè)定兩個極限,則必須為 upper >= lower
如果一個極限已設(shè)定 (或兩個)并且然后設(shè)定另一個極限,和現(xiàn)在通過新的極限得出一個空的區(qū)間,則新的極限值變?yōu)閮蓚€極限的值。示例:
已設(shè)定:{lower 1, upper 2}
已重新設(shè)定:{lower 3}
由此,以下適用:{lower 3, upper 3}
允許設(shè)定一個正的 lower 或一個負的 upper。
必須設(shè)定極限,使它們含有當前的保持轉(zhuǎn)矩 $HOLDING_TORQUE。如果它們另外設(shè)定,則機器人控制系統(tǒng)輸出用戶必須應(yīng)答的錯誤信息。
lower 必須小于或等于 $TORQUE_AXIS_MAX_0 區(qū)間的上限值。
upper 必須大于或等于 $TORQUE_AXIS_MAX_0 區(qū)間的下限值。
如果極限另外設(shè)定,則機器人控制系統(tǒng)輸出用戶必須應(yīng)答的錯誤信息.
示例 1:
對于 A1 將允許的轉(zhuǎn)矩范圍限制到區(qū)間 800 … 1 400 Nm 上。
SET_TORQUE_LIMITS(1, {lower 800, upper 1400} )
示例 2:
對于 A3 將轉(zhuǎn)矩上限設(shè)定為 1200 Nm。
SET_TORQUE_LIMITS(3, {upper 1200} )
轉(zhuǎn)矩模式實例:
可以使用扭矩限制避免在碰撞時發(fā)生損壞。
優(yōu)勢:確保了機器人只用特定的有限作用力壓向障礙物。
缺點:機器人邊遲鈍。不再能高加速。
機器人從箱子中取出工件。在運動至點 P7、P8 和 P9 時,可以排除機器人與工件一起掛在箱子上。應(yīng)確保機器人不會大力壓緊致使形成損壞。為此,在臨界點之前限制作用力。
關(guān)閉常規(guī)的監(jiān)控。不因為否則將不必要地觸發(fā)監(jiān)控,而是因為與該示例相反它們不夠嚴格。取而代之,將其中一個專用監(jiān)控設(shè)定為一個很小的值。(取決于具體的應(yīng)用情況,這對使用常規(guī)監(jiān)控也很有意義。)
2 FOR i = 1 to 6循環(huán)語句
3 myParams.lower = $holding_torque[i] - 500
4 myParams.upper = $holding_torque[i] + 500
3,4點用中間的保持轉(zhuǎn)矩將限制設(shè)定為一個很小的區(qū)間。
5 myParams.monitor = #off
6 myParams.max_lag = 0.1
5.6點關(guān)閉常規(guī)的監(jiān)控。Max_lag = 0.1 的作用是在滯后誤差為 0.1° 時已經(jīng)觸發(fā)了停止。
7 SET_TORQUE_LIMITS(i, myParams)
2-7點限制 A1 … A6 的轉(zhuǎn)矩。
8 ENDFOR
9 $acc.cp = my_low_acceleration
10 $vel.cp = my_low_velocity
9-10點減小加速度和速度,以便機器人緩慢地移到臨界點。
11 LIN P7
12 LIN P8
13 LIN P9
11-13 點可能出現(xiàn)碰撞的點如果出現(xiàn)碰撞,則監(jiān)控 max_lag 響應(yīng)并且設(shè)備操作人員可以干預(yù)。
原文標題:KUKA 激活轉(zhuǎn)矩運行:SET_TORQUE_LIMITS
文章出處:【微信公眾號:機器人及PLC自動化應(yīng)用】歡迎添加關(guān)注!文章轉(zhuǎn)載請注明出處。
-
控制系統(tǒng)
+關(guān)注
關(guān)注
41文章
6622瀏覽量
110614 -
機器人
+關(guān)注
關(guān)注
211文章
28423瀏覽量
207146 -
程序
+關(guān)注
關(guān)注
117文章
3787瀏覽量
81060
原文標題:KUKA 激活轉(zhuǎn)矩運行:SET_TORQUE_LIMITS
文章出處:【微信號:gh_a8b121171b08,微信公眾號:機器人及PLC自動化應(yīng)用】歡迎添加關(guān)注!文章轉(zhuǎn)載請注明出處。
發(fā)布評論請先 登錄
相關(guān)推薦
評論