ABB机器人力保持程序

原创于 2021-04-14 16:24:39 发布 · 379 阅读

CC 4.0 BY-SA版权

文章标签：

该博客介绍了ABB机器人ForceRout模块中的ForceHold过程，用于力控操作。在ForceHold过程中，机器人会根据设定的力值进行按压和释放动作，涉及FCPress1LStart、FCPressL和FCPressEnd等指令，适用于精密装配等场景。博客还提到了相关参考文档和ForceControl选项的硬件需求。

MODULE ForceRout
    PROC ForceHold(PERS robtarget ForceHoldP10, PERS num MoveNum,INOUT tooldata toolName,INOUT num ForceNum)
        ForceHoldP10:=CRobT(\Tool:=toolName);
        FCPress1LStart RelTool(ForceHoldP10,0,30,0),v60\Fz:=ForceNum,80\ForceFrameRef:=FC_REFFRAME_TOOL\ForceChange:=200\DampingTune:=100\TimeOut:=5\UseSpdFFW\PosSupvDist:=9e9,fine,toolName;
        FCPressL RelTool(ForceHoldP10,MoveNum,30,0),v60,ForceNum,z30,toolName;
        !ForceHoldP20 := CRobT(\Tool:=toolName);
        !speedend.v_ori := vSetNum.v_ori;
        FCPressEnd RelTool(ForceHoldP10,MoveNum-10,30,-40),v60\ForceChange:=400\ZeroContactValue:=-130,toolName;
        !MoveL RelTool(ForceHoldP10,MoveNum - 30,30,-50\Rz:=20), vSetNum, z50, toolPut;
    ENDPROC
ENDMODULE

写入一个点位然后进行后续点位的偏移，力值可以自己进行设定

参考文档：应用手册→RobotWare选项→Application manual-ForceControl

需要ABB机器人baseForceControl选项及相关硬件