ABB机器人如何检测目标点的可达性

最新推荐文章于 2022-06-03 11:27:24 发布

雾都驼铃

最新推荐文章于 2022-06-03 11:27:24 发布

阅读量3.5k

点赞数 3

本文介绍了一种用于ABB机器人的可达性检测方法，通过特定函数判断目标点是否可由机器人到达，利用给定的工具和工件数据进行测试。若目标点超出机器人运动范围，则返回错误，否则确认为可达。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

对于ABB机器人，若目标点不可达，则会报错，因此可以使用一个检测功能，测试该点是否可达。下面是函数实现：

FUNC bool IsReachable(robtarget pReach, PERS tooldata ToolReach, PERS wobjdata WobjReach)

  ! Check if specified robtarget can be reach with given tool and wobj.
  ! 
  ! Output:
  !  Return TRUE if given robtarget is reachable with given tool and wobj
  !  otherwise return FALSE
  !
  ! Parameters:
  !  pReach     - robtarget to be checked, if robot can reach this robtarget
  !  ToolReach  - tooldata to be used for possible movement
  !  WobjReach  - wobjdata to be used for possible movement

  VAR bool bReachable;
  VAR jointtarget jntReach;

  bReachable := TRUE;

  jntReach := CalcJointT(pReach, ToolReach\Wobj:=WobjReach);

  RETURN bReachable;

  ERROR
   IF ERRNO = ERR_ROBLIMIT THEN
    bReachable := FALSE;
    TRYNEXT;
   ENDIF
  ENDFUNC