SetCompEralw
（ライブラリ）
【Ver.1.4 以降】
力制限時のツール端の位置、姿勢偏差許容値を設定します。(６軸専用命令)
SetCompEralw(<X方向偏差許容値>,<Y方向偏差許容値>,<Z方向偏差許容値>,<X回り偏差許容値>,<Y回り偏差許容値>,<Z回り偏差許容値>)
力制限時のツール端の位置、姿勢偏差許容値を設定します。X,Y,Z方向の偏差許容値の単位は、(mm)、X,Y,Z回りの偏差許容値の単位は、(度)です。小数点１桁まで有効です。
<pacman.h>ファイルが必要です。
-
ロボット制御権を取得(TAKEARM)したタスクにて実行下さい。ロボット制御権未取得の場合は、エラー「21F7アームセマフォを取得できません」が発生します。
-
コントローラ電源立ち上げ直後の偏差許容値の初期値は、X,Y,Z方向が100(mm)、X,Y,Z回りが30(度)です。X,Y,Z周りは、最大値が175(度)です。最大値を超える設定をした場合、エラー「6003 有効な数値範囲を超えた」が発生します。
-
ツール端の位置、姿勢偏差が設定した許容値を超えた場合、エラー「60f8 力制限時位置偏差過大異常」が発生します。
-
偏差設定座標系は、SetFrcCoordにて設定された座標系となります。例えばSetFrcCoord(1)と設定した場合は、SetCompEralwの設定座標系は、ツール座標系となります。
|
CALL SetFrcCoord(2)
|
'力制限座標系をワーク座標にします。
|
|
CALL SetFrcLimit(100,0,100,100,100,100)
|
|
|
|
'ワーク座標のY方向の力制限割合を0%にします。
|
|
CALL SetCompEralw(10,150,10,5,5,5)
|
|
|
|
'ワーク座標X,Z方向の偏差許容値を10(mm)、
'Y方向の偏差許容値を150(mm)、
'X,Y,Z回りの偏差許容値を5(度)にします。
|