功能 INVERSE 從一個笛卡爾位置用附加軸角度計算合適的機器人軸角度。在
此不必為笛卡爾位置指定狀態和轉角值。
功能 INVERSE 可例如用于以 PTP 接近在卸碼垛時計算所得的點。用該功能可以檢查轉角值的有效性并在需要時在目標點上進行調整。
-
正確地考慮到機器人運動系統形式的和用作基坐標運動系統的附加軸。
-
該功能可通過 SHOWVAR 命令或 SETVAR 命令和在 KRL 程序中調用該功能。
result = INVERSE (position , start_axis , err_status )
結果 |
類型:E6AXIS 返回值的變量 傳遞的位置上軸角 |
位置 |
類型:E6POS 傳遞方式:IN 參數 基于基坐標系的笛卡爾位置 (必要時帶附加軸角度)為該位置計算機器人軸角度 |
start_axis |
類型:E6AXIS 傳遞方式:IN 參數 運動起點上的機器人軸角 |
err_status |
類型:INT 傳遞方式:OUT 參數 設置是否要在軟件限位開關上檢查傳遞的軸角度 (start_axis)。 0:檢查所有軸角度。如果它們不在軟件限位開關的極限之內,則 err_status 返還一個錯誤代碼。 <>0:不檢查軸角度。 在任何情況下,都要在軟件限位開關上檢查計算所得的軸角度 (result) |
在以下情況下,需要起點 start_axis :
1.目標點沒有狀態值。
通過系統變量 $TARGET_STATUS 定義目標點應得到哪個狀態值:
$TARGET_STATUS=#SOURCE該目標點將得到與起點一樣的狀態。從點 start_axis 的軸角度中計算狀態。
2.$TARGET_STATUS=#BEST
目標點將得到機器人在軸空間中必須盡量短地從起點至目標點時的狀
態。
3.目標點沒有轉角值。
為每個軸計算允許的、目標點可通過它擁有至起點的最短路徑的轉角值。
在此,允許表示在軟件限位開關之內。
4.目標點在奇點附近。
必須預定軸角度并且計算取決于此的值。通過系統變量
$SINGUL_POS[1...3] 設置目標點應得到哪個角度:
$SINGUL_POS[1...3]=0:軸的角度被確定為 0 度。
$SINGUL_POS[1...3]=1:角度從起始點一直到目標點保持不變。
KRL 程序 KUE_WEG 計算軸 5 的狀態,使軸 4 和 5 在 PTP 運動的起點和目標
點之間盡量少地運動。可以將其集成到一個運動程序中或者在離線生成笛卡爾
點時使用。
-
程序
+關注
關注
117文章
3787瀏覽量
81043 -
函數
+關注
關注
3文章
4331瀏覽量
62618 -
KUKA機器人
+關注
關注
4文章
143瀏覽量
9080
原文標題:KUKA機器人系統函數: INVERSE()
文章出處:【微信號:gh_a8b121171b08,微信公眾號:機器人及PLC自動化應用】歡迎添加關注!文章轉載請注明出處。
發布評論請先 登錄
相關推薦
評論