ContactProbe物件

ContactProbe物件會使機器人往指定方向移動,直到其接觸工件等物件,並將已移動指定距離的位置偵測為孔洞位置。若機器人在未移動指定距離的情況下接觸物件,則會返回開始位置,並變更位置以重複接觸動作。

此物件用於偵測PressProbe難以偵測的工件洞口位置(如引線部分或連接器)。
即使工件的尺寸或抓取位置有誤差範圍,仍可穩定偵測孔洞位置。
画像

上圖為ContactProbe物件動作的示意圖。
機器人會從非接觸狀態往向下方向移動(白色箭頭)。機器人接觸物件後偵測到施加的力(紅色箭頭),其會移至下一個接觸起始位置(藍色箭頭)。重複這些動作以探測孔洞。

若在單一接觸動作指定時間內滿足位置結束條件,ContactProbe物件將執行成功。
ContactProbe物件一律使用與力及位置相關的結束條件。

  • 單一接觸動作中符合與力相關的結束條件時:
    判定為此位置無洞口,且機器人移至下一個開始接觸位置。
  • 單一接觸動作中符合與位置相關的結束條件時:
    判定為洞口位置,且偵測已成功。
  • 單一接觸動作期間,不符合與力及位置相關的結束條件時。
    偵測因錯誤狀態(機器人未與物件接觸,且移動量不足)失敗。

各條件如下:

結束條件
成功條件
力相關結束條件

單一接觸動作期間,滿足與位置相關的結束條件前,指定方向中的力絕對值不會大於ContactForceThresh的力絕對值。

若大於絕對值,機器人會判定為「已接觸」(= 無孔洞位置),並移至下一個接觸位置,以開始下一個接觸動作。

位置相關的

結束條件

接觸動作期間,在Timeout指定時間內滿足下列任一條件:

PosCheckType為RobotPlane時:

針對PlaneNumber設定的Plane,符合PlaneEndCondition設定的狀態。

PosCheckType為RelativePlane時:

應在ContactOrient方向移動ContactDist + ContactDistMargin